From 8a4ffc8193a092f13494257ed4f3d239565a6ee3 Mon Sep 17 00:00:00 2001 From: Scorchify <139656419+Scorchify@users.noreply.github.com> Date: Sat, 7 Dec 2024 12:01:19 -0500 Subject: [PATCH] push --- src/main/deploy/choreo/IntakeAltStack1.traj | 584 ++--- src/main/deploy/choreo/KO.traj | 897 ++++---- src/main/deploy/choreo/ScoreAltStack1.traj | 615 +++--- src/main/deploy/choreo/ScoreStack1.traj | 305 ++- team5115.chor | 2136 ++++++++++--------- 5 files changed, 2468 insertions(+), 2069 deletions(-) diff --git a/src/main/deploy/choreo/IntakeAltStack1.traj b/src/main/deploy/choreo/IntakeAltStack1.traj index 8d7cdcf..f7939f8 100644 --- a/src/main/deploy/choreo/IntakeAltStack1.traj +++ b/src/main/deploy/choreo/IntakeAltStack1.traj @@ -1,12 +1,12 @@ { "samples": [ { - "x": 1.225, + "x": 1.225000000000017, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 5.571667604430733e-17, - "velocityY": 0, + "heading": 1.333907624287153e-28, + "angularVelocity": 6.76869812381367e-29, + "velocityX": -1.279975862363891e-15, + "velocityY": -6.283924189430902e-45, "moduleForcesX": [ 0, 0, @@ -22,403 +22,445 @@ "timestamp": 0 }, { - "x": 1.252509667071736, + "x": 1.2547830613499884, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.2870082542576082, - "velocityY": 0, + "heading": 4.435738168561203e-20, + "angularVelocity": 4.447719567475508e-19, + "velocityX": 0.2986348628168654, + "velocityY": -9.787491949916075e-36, "moduleForcesX": [ - 29.943560493551253, - 29.943560493551253, - 29.943560493551253, - 29.943560493551253 + 29.94412838953491, + 29.94412838953491, + 29.94412838953491, + 29.94412838953491 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8044103254370303e-16, + 3.8044103254370303e-16, + -3.8044103254370303e-16, + -3.8044103254370303e-16 ], - "timestamp": 0.0958497418232613 + "timestamp": 0.09973069141702882 }, { - "x": 1.3075274905381924, + "x": 1.3143477894526874, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.5740007476277683, - "velocityY": 0, + "heading": 1.2842111410913485e-19, + "angularVelocity": 8.429079842826135e-19, + "velocityX": 0.5972557420023291, + "velocityY": -1.942799795986437e-35, "moduleForcesX": [ - 29.94191616074935, - 29.94191616074935, - 29.94191616074935, - 29.94191616074935 + 29.942726250311168, + 29.942726250311168, + 29.942726250311168, + 29.942726250311168 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8079343149840805e-16, + 3.8079343149840805e-16, + -3.8079343149840805e-16, + -3.8079343149840805e-16 ], - "timestamp": 0.1916994836465226 + "timestamp": 0.19946138283405765 }, { - "x": 1.3900515280394377, + "x": 1.4036924400592825, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.8609729763629331, - "velocityY": 0, + "heading": 2.463555918927614e-19, + "angularVelocity": 1.182530338098165e-18, + "velocityX": 0.8958591312970421, + "velocityY": -2.8974550258705703e-35, "moduleForcesX": [ - 29.93980195213383, - 29.93980195213383, - 29.93980195213383, - 29.93980195213383 + 29.940972538344575, + 29.940972538344575, + 29.940972538344575, + 29.940972538344575 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8123070418893336e-16, + 3.8123070418893336e-16, + -3.8123070418893336e-16, + -3.8123070418893336e-16 ], - "timestamp": 0.2875492254697839 + "timestamp": 0.29919207425108646 }, { - "x": 1.5000791896812358, + "x": 1.522814768880177, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.1479181847431392, - "velocityY": 0, + "heading": 3.9061751387218276e-19, + "angularVelocity": 1.4465159350726166e-18, + "velocityX": 1.194440016952132, + "velocityY": -3.8524871235365484e-35, "moduleForcesX": [ - 29.936982919505784, - 29.936982919505784, - 29.936982919505784, - 29.936982919505784 + 29.938716097590557, + 29.938716097590557, + 29.938716097590557, + 29.938716097590557 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8178886042689316e-16, + 3.8178886042689316e-16, + -3.8178886042689316e-16, + -3.8178886042689316e-16 ], - "timestamp": 0.3833989672930452 + "timestamp": 0.3989227656681153 }, { - "x": 1.6376068495234364, + "x": 1.6717117804277626, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.4348255637016203, - "velocityY": 0, + "heading": 5.510781406993138e-19, + "angularVelocity": 1.6089405607192304e-18, + "velocityX": 1.4929908692820462, + "velocityY": -4.784287581117904e-35, "moduleForcesX": [ - 29.933036177343787, - 29.933036177343787, - 29.933036177343787, - 29.933036177343787 + 29.935704654991618, + 29.935704654991618, + 29.935704654991618, + 29.935704654991618 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8252758945500703e-16, + 3.8252758945500703e-16, + -3.825275894550071e-16, + -3.825275894550071e-16 ], - "timestamp": 0.47924870911630646 + "timestamp": 0.49865345708514414 }, { - "x": 1.8026290686364108, + "x": 1.850379276363555, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.7216761983273914, - "velocityY": 0, + "heading": 7.134094095528736e-19, + "angularVelocity": 1.627697556318014e-18, + "velocityX": 1.7914996218895902, + "velocityY": -5.697468195588865e-35, "moduleForcesX": [ - 29.927116043222046, - 29.927116043222046, - 29.927116043222046, - 29.927116043222046 + 29.93148331432507, + 29.93148331432507, + 29.93148331432507, + 29.93148331432507 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.83553639511066e-16, + 3.83553639511066e-16, + -3.83553639511066e-16, + -3.83553639511066e-16 ], - "timestamp": 0.5750984509395678 + "timestamp": 0.5983841485021729 }, { - "x": 1.9951367826254982, + "x": 2.0588109475855214, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.0084322641575305, - "velocityY": 0, + "heading": 8.558157292954081e-19, + "angularVelocity": 1.4279099394802959e-18, + "velocityX": 2.089945113315875, + "velocityY": -6.604219024578338e-35, "moduleForcesX": [ - 29.917249684289892, - 29.917249684289892, - 29.917249684289892, - 29.917249684289892 + 29.925140113409057, + 29.925140113409057, + 29.925140113409057, + 29.925140113409057 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8507911969424974e-16, + 3.8507911969424974e-16, + -3.8507911969424974e-16, + -3.8507911969424974e-16 ], - "timestamp": 0.6709481927628291 + "timestamp": 0.6981148399192018 }, { - "x": 2.2151118668144223, + "x": 2.296996250720342, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.2949992353092554, - "velocityY": 0, + "heading": 9.411153977193477e-19, + "angularVelocity": 8.553010167336687e-19, + "velocityX": 2.3882848876551863, + "velocityY": -7.457737051461316e-35, "moduleForcesX": [ - 29.897521443519583, - 29.897521443519583, - 29.897521443519583, - 29.897521443519583 + 29.914539857309176, + 29.914539857309176, + 29.914539857309176, + 29.914539857309176 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.875942100573936e-16, + 3.875942100573936e-16, + -3.875942100573936e-16, + -3.875942100573936e-16 ], - "timestamp": 0.7667979345860905 + "timestamp": 0.7978455313362306 }, { - "x": 2.4625000000000052, + "x": 2.564914002502624, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.5809994735479793, - "velocityY": 0, + "heading": 8.914861579617697e-19, + "angularVelocity": -4.976324891689237e-19, + "velocityX": 2.6864122563550237, + "velocityY": -1.032724362015068e-34, "moduleForcesX": [ - 29.838394219742327, - 29.838394219742327, - 29.838394219742327, - 29.838394219742327 + 29.89324193627562, + 29.89324193627562, + 29.89324193627562, + 29.89324193627562 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.925485691196194e-16, + 3.925485691196194e-16, + -3.925485691196194e-16, + -3.925485691196194e-16 ], - "timestamp": 0.8626476764093518 + "timestamp": 0.8975762227532594 }, { - "x": 2.7098881331855686, + "x": 2.8625000000058085, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.5809994735479833, - "velocityY": 0, + "heading": 4.437476838988911e-19, + "angularVelocity": -4.4894778047993694e-18, + "velocityX": 2.983895862737148, + "velocityY": -1.1000360170692858e-34, "moduleForcesX": [ - 4.5071058537614364e-13, - 4.5071058537614364e-13, - 4.5071058537614364e-13, - 4.5071058537614364e-13 + 29.828691865536857, + 29.828691865536857, + 29.828691865536857, + 29.828691865536857 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 4.069185552959855e-16, + 4.0691855529598557e-16, + -4.069185552959855e-16, + -4.0691855529598557e-16 ], - "timestamp": 0.9584974182326131 + "timestamp": 0.9973069141702883 }, { - "x": 2.929863217374646, + "x": 3.1600859975124576, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.29499923530926, - "velocityY": 0, + "heading": -2.7780968254587014e-19, + "angularVelocity": -7.235063930801634e-18, + "velocityX": 2.983895862737161, + "velocityY": 4.389962466076309e-34, "moduleForcesX": [ - -29.838394219742327, - -29.838394219742327, - -29.838394219742327, - -29.838394219742327 + 1.315475344589543e-12, + 1.3153365376998885e-12, + 1.315475344589543e-12, + 1.3153365376998885e-12 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -6.940344482674305e-17, + -6.940344482674305e-17, + 6.94034448267431e-17, + 6.94034448267431e-17 ], - "timestamp": 1.0543471600558745 + "timestamp": 1.097037605587317 }, { - "x": 3.1223709313635926, + "x": 3.4280037492383437, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.008432264157535, - "velocityY": 0, + "heading": -4.923590704083348e-19, + "angularVelocity": -2.151289433684519e-18, + "velocityX": 2.686412256355038, + "velocityY": 2.1382352814057525e-34, "moduleForcesX": [ - -29.897521443519587, - -29.897521443519587, - -29.897521443519587, - -29.897521443519587 + -29.828691865536854, + -29.828691865536854, + -29.828691865536854, + -29.828691865536854 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -4.368466622002329e-16, + -4.3684666220023285e-16, + 4.368466622002329e-16, + 4.3684666220023285e-16 ], - "timestamp": 1.1501969018791358 + "timestamp": 1.1967682970043458 }, { - "x": 3.287393150476552, + "x": 3.666189052409887, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.7216761983273956, - "velocityY": 0, + "heading": -5.339633713220123e-19, + "angularVelocity": -4.1716710425673114e-19, + "velocityX": 2.3882848876552, + "velocityY": 1.465626208115563e-35, "moduleForcesX": [ - -29.917249684289896, - -29.917249684289896, - -29.917249684289896, - -29.917249684289896 + -29.89324193627562, + -29.89324193627562, + -29.89324193627562, + -29.89324193627562 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -4.0766010308870794e-16, + -4.07660103088708e-16, + 4.0766010308870794e-16, + 4.07660103088708e-16 ], - "timestamp": 1.2460466437023971 + "timestamp": 1.2964989884213747 }, { - "x": 3.424920810318656, + "x": 3.8746207236253465, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.434825563701624, - "velocityY": 0, + "heading": -4.875704320945534e-19, + "angularVelocity": 4.651822247510394e-19, + "velocityX": 2.089945113315887, + "velocityY": 3.034082848899946e-35, "moduleForcesX": [ - -29.927116043222046, - -29.927116043222046, - -29.927116043222046, - -29.927116043222046 + -29.914539857309176, + -29.914539857309176, + -29.914539857309176, + -29.914539857309176 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.976806692395584e-16, + -3.976806692395584e-16, + 3.976806692395584e-16, + 3.976806692395584e-16 ], - "timestamp": 1.3418963855256585 + "timestamp": 1.3962296798384035 }, { - "x": 3.534948471960649, + "x": 4.053288219569209, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.1479181847431432, - "velocityY": 0, + "heading": -3.987222793761106e-19, + "angularVelocity": 8.908811570369878e-19, + "velocityX": 1.7914996218896007, + "velocityY": 4.520836242515374e-35, "moduleForcesX": [ - -29.933036177343787, - -29.933036177343787, - -29.933036177343787, - -29.933036177343787 + -29.925140113409054, + -29.925140113409054, + -29.925140113409054, + -29.925140113409054 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.9264413446048777e-16, + -3.9264413446048777e-16, + 3.9264413446048777e-16, + 3.9264413446048777e-16 ], - "timestamp": 1.4377461273489198 + "timestamp": 1.4959603712554324 }, { - "x": 3.6174725094617, + "x": 4.202185231271973, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.860972976362937, - "velocityY": 0, + "heading": -2.9403938648169577e-19, + "angularVelocity": 1.049656312088076e-18, + "velocityX": 1.4929908692820562, + "velocityY": -6.34377494002748e-35, "moduleForcesX": [ - -29.936982919505784, - -29.936982919505784, - -29.936982919505784, - -29.936982919505784 + -29.93148331432507, + -29.93148331432507, + -29.93148331432507, + -29.93148331432507 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.8960432135095593e-16, + -3.8960432135095593e-16, + 3.8960432135095593e-16, + 3.8960432135095593e-16 ], - "timestamp": 1.5335958691721812 + "timestamp": 1.5956910626724612 }, { - "x": 3.6724903329283403, + "x": 4.321307559958148, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.5740007476277722, - "velocityY": 0, + "heading": -1.909742612633779e-19, + "angularVelocity": 1.0334349795240745e-18, + "velocityX": 1.1944400169521414, + "velocityY": -5.023256964940812e-35, "moduleForcesX": [ - -29.93980195213383, - -29.93980195213383, - -29.93980195213383, - -29.93980195213383 + -29.935704654991618, + -29.935704654991618, + -29.935704654991618, + -29.935704654991618 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.875684232160756e-16, + -3.875684232160756e-16, + 3.875684232160756e-16, + 3.875684232160756e-16 ], - "timestamp": 1.6294456109954425 + "timestamp": 1.69542175408949 }, { - "x": 3.7, + "x": 4.410652210506399, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.2870082542576128, - "velocityY": 0, + "heading": -1.0184849690233774e-19, + "angularVelocity": 8.93664896759709e-19, + "velocityX": 0.8958591312970524, + "velocityY": -3.714887807090576e-35, "moduleForcesX": [ - -29.94191616074935, - -29.94191616074935, - -29.94191616074935, - -29.94191616074935 + -29.938716097590557, + -29.938716097590557, + -29.938716097590557, + -29.938716097590557 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.861083787357064e-16, + -3.861083787357064e-16, + 3.861083787357064e-16, + 3.861083787357064e-16 ], - "timestamp": 1.7252953528187038 + "timestamp": 1.7951524455065189 }, { - "x": 3.7, + "x": 4.470216938649993, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 5.636961914080804e-17, - "velocityY": 0, + "heading": -3.5829088636627997e-20, + "angularVelocity": 6.619772513811735e-19, + "velocityX": 0.5972557420023403, + "velocityY": -2.4584544278339557e-35, "moduleForcesX": [ - -29.943560493551256, - -29.943560493551256, - -29.943560493551256, - -29.943560493551256 + -29.940972538344575, + -29.940972538344575, + -29.940972538344575, + -29.940972538344575 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.8500926775426836e-16, + -3.8500926775426836e-16, + 3.8500926775426836e-16, + 3.8500926775426836e-16 + ], + "timestamp": 1.8948831369235477 + }, + { + "x": 4.499999999999966, + "y": 7.915, + "heading": -2.735635807996967e-28, + "angularVelocity": 3.5925862288720407e-19, + "velocityX": 0.29863486281687684, + "velocityY": -1.2194070080115564e-35, + "moduleForcesX": [ + -29.942726250311168, + -29.942726250311168, + -29.942726250311168, + -29.942726250311168 + ], + "moduleForcesY": [ + -3.841512849965487e-16, + -3.841512849965487e-16, + 3.841512849965487e-16, + 3.841512849965487e-16 + ], + "timestamp": 1.9946138283405765 + }, + { + "x": 4.499999999999983, + "y": 7.915, + "heading": -1.333908710952396e-28, + "angularVelocity": 6.800156366469428e-29, + "velocityX": 4.008827675901694e-16, + "velocityY": -8.329786019881148e-45, + "moduleForcesX": [ + -29.94412838953491, + -29.94412838953491, + -29.94412838953491, + -29.94412838953491 + ], + "moduleForcesY": [ + -3.834623352843727e-16, + -3.834623352843727e-16, + 3.834623352843727e-16, + 3.834623352843727e-16 ], - "timestamp": 1.8211450946419652 + "timestamp": 2.0943445197576054 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/KO.traj b/src/main/deploy/choreo/KO.traj index e60249d..dc1e2d0 100644 --- a/src/main/deploy/choreo/KO.traj +++ b/src/main/deploy/choreo/KO.traj @@ -3,10 +3,10 @@ { "x": 1.25, "y": 7.85, - "heading": -5.042419579190194e-28, - "angularVelocity": -4.765891770216821e-28, - "velocityX": 4.0908119604167003e-17, - "velocityY": 1.0212967772619285e-16, + "heading": -9.510438227191655e-28, + "angularVelocity": -9.112042864532664e-28, + "velocityX": 2.030641276522843e-17, + "velocityY": -5.4400794333658375e-17, "moduleForcesX": [ 0, 0, @@ -22,613 +22,634 @@ "timestamp": 0 }, { - "x": 1.262850033482311, - "y": 7.848420800951572, - "heading": 4.897373376403742e-20, - "angularVelocity": 7.4471414220086765e-19, - "velocityX": 0.1954028704749021, - "velocityY": -0.024013947320761456, + "x": 1.2640480832016254, + "y": 7.848653117376031, + "heading": -1.121450453095151e-19, + "angularVelocity": -1.6333933250978822e-18, + "velocityX": 0.20461042737661647, + "velocityY": -0.019617354578624183, "moduleForcesX": [ - 29.713760545753452, - 29.713760545753452, - 29.713760545753452, - 29.713760545753452 + 29.801522663531106, + 29.801522663531106, + 29.801522663531106, + 29.801522663531106 ], "moduleForcesY": [ - -3.6516591527726097, - -3.65165915277261, - -3.6516591527726097, - -3.651659152772609 + -2.8572690286077913, + -2.8572690286077913, + -2.857269028607792, + -2.857269028607792 ], - "timestamp": 0.06576174367899924 + "timestamp": 0.06865770909987891 }, { - "x": 1.2885510441658452, - "y": 7.8452753640913135, - "heading": -2.191109078187436e-19, - "angularVelocity": -4.076604004180981e-18, - "velocityX": 0.3908200915329965, - "velocityY": -0.047830800716292234, + "x": 1.2921437043867348, + "y": 7.845960690499111, + "heading": -1.3546118188505236e-19, + "angularVelocity": -3.3959964719798475e-19, + "velocityX": 0.40921291365188467, + "velocityY": -0.03921521577469119, "moduleForcesX": [ - 29.715942754190923, - 29.715942754190923, - 29.715942754190923, - 29.715942754190923 + 29.800366041579718, + 29.800366041579718, + 29.800366041579718, + 29.800366041579718 ], "moduleForcesY": [ - -3.621688243516662, - -3.621688243516662, - -3.621688243516662, - -3.621688243516662 + -2.8544298161129453, + -2.8544298161129453, + -2.8544298161129467, + -2.8544298161129467 ], - "timestamp": 0.1315234873579985 + "timestamp": 0.13731541819975782 }, { - "x": 1.3271041147011384, - "y": 7.84057878392152, - "heading": 3.795271134514633e-19, - "angularVelocity": 9.103135085205585e-18, - "velocityX": 0.5862537757981506, - "velocityY": -0.07141812115272106, + "x": 1.3342862275889278, + "y": 7.84192428021855, + "heading": -7.789555696099368e-19, + "angularVelocity": -9.372500208291995e-18, + "velocityX": 0.6138061370592178, + "velocityY": -0.058790343187582056, "moduleForcesX": [ - 29.71844621686372, - 29.71844621686372, - 29.71844621686372, - 29.71844621686372 + 29.799016904235025, + 29.799016904235025, + 29.799016904235025, + 29.799016904235025 ], "moduleForcesY": [ - -3.5867845219511554, - -3.5867845219511554, - -3.586784521951155, - -3.586784521951155 + -2.8511186390471694, + -2.85111863904717, + -2.8511186390471694, + -2.85111863904717 ], - "timestamp": 0.19728523103699774 + "timestamp": 0.20597312729963674 }, { - "x": 1.378510499208546, - "y": 7.834348861707045, - "heading": 6.285184730422139e-19, - "angularVelocity": 3.786264882765975e-18, - "velocityX": 0.781706530752559, - "velocityY": -0.09473474798376291, + "x": 1.3904749013791047, + "y": 7.83654573033852, + "heading": 9.894224895413843e-19, + "angularVelocity": 2.5756438754452687e-17, + "velocityX": 0.8183884159024585, + "velocityY": -0.0783386155840313, "moduleForcesX": [ - 29.721346183955035, - 29.721346183955035, - 29.721346183955035, - 29.721346183955035 + 29.797422827730635, + 29.797422827730635, + 29.797422827730635, + 29.797422827730635 ], "moduleForcesY": [ - -3.5456217439824975, - -3.5456217439824975, - -3.545621743982497, - -3.545621743982497 + -2.8472072040759646, + -2.8472072040759646, + -2.8472072040759646, + -2.847207204075965 ], - "timestamp": 0.263046974715997 + "timestamp": 0.27463083639951563 }, { - "x": 1.4427716665549928, - "y": 7.826606904829184, - "heading": 5.067226283497897e-19, - "angularVelocity": -1.8520767698243424e-18, - "velocityX": 0.9771816219034107, - "velocityY": -0.11772736605871548, + "x": 1.4607088242889112, + "y": 7.829827252189452, + "heading": 2.4721119424605503e-18, + "angularVelocity": 2.1595382176529026e-17, + "velocityX": 1.0229575648700016, + "velocityY": -0.0978546799373951, "moduleForcesX": [ - 29.72474271744, - 29.72474271744, - 29.72474271744, - 29.72474271744 + 29.79551046044229, + 29.79551046044229, + 29.79551046044229, + 29.79551046044229 ], "moduleForcesY": [ - -3.4963516459035304, - -3.4963516459035304, - -3.49635164590353, - -3.49635164590353 + -2.8425161004100796, + -2.8425161004100796, + -2.8425161004100805, + -2.8425161004100805 ], - "timestamp": 0.3288087183949962 + "timestamp": 0.3432885454993945 }, { - "x": 1.5198893589551528, - "y": 7.817378874976692, - "heading": -1.162732145436115e-20, - "angularVelocity": -7.882240530921134e-18, - "velocityX": 1.172683205812159, - "velocityY": -0.14032520035588117, + "x": 1.5449868949041814, + "y": 7.821771546621253, + "heading": 6.189965151949987e-18, + "angularVelocity": 5.415055755260137e-17, + "velocityX": 1.2275106717128321, + "velocityY": -0.11733140638864904, "moduleForcesX": [ - 29.728771314678447, - 29.728771314678447, - 29.728771314678447, - 29.728771314678447 + 29.793173923886805, + 29.793173923886805, + 29.793173923886805, + 29.793173923886805 ], "moduleForcesY": [ - -3.4363192082424168, - -3.4363192082424168, - -3.436319208242416, - -3.4363192082424163 + -2.8367865322922747, + -2.8367865322922747, + -2.836786532292275, + -2.836786532292275 ], - "timestamp": 0.39457046207399543 + "timestamp": 0.4119462545992734 }, { - "x": 1.609865672804627, - "y": 7.8066970987317665, - "heading": -2.191402666064841e-19, - "angularVelocity": -3.1555265819220572e-18, - "velocityX": 1.3682166685073873, - "velocityY": -0.1624314631185448, + "x": 1.6433077370622162, + "y": 7.812381986682936, + "heading": 9.622702822557616e-18, + "angularVelocity": 4.999784772331271e-17, + "velocityX": 1.4320437347314487, + "velocityY": -0.13675900436326435, "moduleForcesX": [ - 29.733618933475498, - 29.733618933475498, - 29.733618933475498, - 29.733618933475498 + 29.790254539526853, + 29.790254539526853, + 29.790254539526853, + 29.790254539526853 ], "moduleForcesY": [ - -3.36156882800544, - -3.3615688280054403, - -3.36156882800544, - -3.36156882800544 + -2.829630966328549, + -2.829630966328549, + -2.82963096632855, + -2.82963096632855 ], - "timestamp": 0.46033220575299466 + "timestamp": 0.4806039636991523 }, { - "x": 1.7127031722068122, - "y": 7.794602932942712, - "heading": -7.314558200489186e-19, - "angularVelocity": -7.790479769235267e-18, - "velocityX": 1.5637891218968967, - "velocityY": -0.18390883691940063, + "x": 1.7556695824424235, + "y": 7.8016629040639245, + "heading": 1.2787142047031391e-17, + "angularVelocity": 4.609007855083181e-17, + "velocityX": 1.636551042169287, + "velocityY": -0.15612351125111126, "moduleForcesX": [ - 29.739548018092375, - 29.739548018092375, - 29.739548018092375, - 29.739548018092375 + 29.786503237434776, + 29.786503237434776, + 29.786503237434776, + 29.786503237434776 ], "moduleForcesY": [ - -3.2659373975371992, - -3.2659373975371992, - -3.265937397537199, - -3.2659373975371992 + -2.82044174524982, + -2.82044174524982, + -2.82044174524982, + -2.82044174524982 ], - "timestamp": 0.526093949431994 + "timestamp": 0.5492616727990313 }, { - "x": 1.8284050497786541, - "y": 7.781151157925, - "heading": -1.57611444295976e-18, - "angularVelocity": -1.284422438239318e-17, - "velocityX": 1.7594101235628865, - "velocityY": -0.20455319855179577, + "x": 1.8820700751843558, + "y": 7.789620065130796, + "heading": 1.8484542588024938e-17, + "angularVelocity": 8.298267778479734e-17, + "velocityX": 1.841024036472068, + "velocityY": -0.17540403096238666, "moduleForcesX": [ - 29.74693046779095, - 29.74693046779095, - 29.74693046779095, - 29.74693046779095 + 29.781505526979927, + 29.781505526979927, + 29.781505526979927, + 29.781505526979927 ], "moduleForcesY": [ - -3.139266156499061, - -3.139266156499061, - -3.1392661564990605, - -3.1392661564990605 + -2.8082090072699204, + -2.8082090072699204, + -2.808209007269921, + -2.808209007269921 ], - "timestamp": 0.5918556931109932 + "timestamp": 0.6179193818989102 }, { - "x": 1.9569753502684142, - "y": 7.766417768168256, - "heading": -2.525887916260645e-18, - "angularVelocity": -1.4442643818200287e-17, - "velocityX": 1.955092631308721, - "velocityY": -0.22404195715977315, + "x": 2.022505920926726, + "y": 7.776261524431083, + "heading": 2.414058993971997e-17, + "angularVelocity": 8.238036830833205e-17, + "velocityX": 2.045449048383157, + "velocityY": -0.19456723614940916, "moduleForcesX": [ - 29.75628333412366, - 29.75628333412366, - 29.75628333412366, - 29.75628333412366 + 29.774516888366673, + 29.774516888366673, + 29.774516888366673, + 29.774516888366673 ], "moduleForcesY": [ - -2.96354042908121, - -2.9635404290812106, - -2.96354042908121, - -2.9635404290812106 + -2.7911221388337615, + -2.7911221388337615, + -2.7911221388337615, + -2.791122138833762 ], - "timestamp": 0.6576174367899924 + "timestamp": 0.686577090998789 }, { - "x": 2.098419240523649, - "y": 7.7505152252297, - "heading": -2.4026915340796807e-18, - "angularVelocity": 1.8733740798056096e-18, - "velocityX": 2.1508537082924852, - "velocityY": -0.24182057902327952, + "x": 2.176972187057768, + "y": 7.761599321980379, + "heading": 2.952758509590821e-17, + "angularVelocity": 7.846162113480829e-17, + "velocityX": 2.249802216766555, + "velocityY": -0.21355507841671462, "moduleForcesX": [ - 29.768230894138874, - 29.768230894138874, - 29.768230894138874, - 29.768230894138874 + 29.76405287367224, + 29.76405287367224, + 29.76405287367224, + 29.76405287367224 ], "moduleForcesY": [ - -2.7034900336982504, - -2.7034900336982504, - -2.70349003369825, - -2.70349003369825 + -2.765580517650034, + -2.7655805176500334, + -2.7655805176500343, + -2.7655805176500334 ], - "timestamp": 0.7233791804689916 + "timestamp": 0.755234800098668 }, { - "x": 2.2527430512539843, - "y": 7.73362689309203, - "heading": -2.6116047950155244e-18, - "angularVelocity": -3.1768209778600352e-18, - "velocityX": 2.346711052601558, - "velocityY": -0.2568108932842428, + "x": 2.345460678031868, + "y": 7.745653408147962, + "heading": 3.423073707449936e-17, + "angularVelocity": 6.850144057835636e-17, + "velocityX": 2.4540360169667514, + "velocityY": -0.23225234342153356, "moduleForcesX": [ - 29.782869697784346, - 29.782869697784346, - 29.782869697784346, - 29.782869697784346 + 29.74666688967039, + 29.74666688967039, + 29.74666688967039, + 29.74666688967039 ], "moduleForcesY": [ - -2.2794885631521082, - -2.2794885631521082, - -2.279488563152108, - -2.279488563152108 + -2.7232579196061613, + -2.7232579196061613, + -2.7232579196061604, + -2.7232579196061604 ], - "timestamp": 0.7891409241479909 + "timestamp": 0.8238925091985468 }, { - "x": 2.4199516704661956, - "y": 7.71610443577177, - "heading": -2.831672952395275e-18, - "angularVelocity": -3.346447077206314e-18, - "velocityX": 2.5426427259763447, - "velocityY": -0.26645366049962665, + "x": 2.5279551059495247, + "y": 7.7284632275019565, + "heading": 3.835164630367467e-17, + "angularVelocity": 6.002107054607537e-17, + "velocityX": 2.6580325838263668, + "velocityY": -0.25037509802600766, "moduleForcesX": [ - 29.794172479851817, - 29.794172479851817, - 29.794172479851817, - 29.794172479851817 + 29.712113837479873, + 29.712113837479873, + 29.712113837479873, + 29.712113837479873 ], "moduleForcesY": [ - -1.4663186642945358, - -1.4663186642945358, - -1.4663186642945363, - -1.4663186642945363 + -2.639580440722149, + -2.639580440722149, + -2.639580440722148, + -2.6395804407221477 ], - "timestamp": 0.8549026678269901 + "timestamp": 0.8925502182984257 }, { - "x": 2.600011220083244, - "y": 7.698889469685726, - "heading": -3.1756289850171968e-18, - "angularVelocity": -5.2303366513778645e-18, - "velocityX": 2.738059235415646, - "velocityY": -0.2617778228513173, + "x": 2.7244075093266695, + "y": 7.710143326200207, + "heading": 4.0545001861479775e-17, + "angularVelocity": 3.1946238290310474e-17, + "velocityX": 2.8613305913131573, + "velocityY": -0.26682948705944703, "moduleForcesX": [ - 29.715834542523574, - 29.715834542523574, - 29.715834542523574, - 29.715834542523574 + 29.610368617316485, + 29.610368617316485, + 29.610368617316485, + 29.610368617316485 ], "moduleForcesY": [ - 0.7110270176721438, - 0.7110270176721438, - 0.711027017672143, - 0.711027017672143 + -2.3965828818321935, + -2.3965828818321935, + -2.396582881832191, + -2.3965828818321904 ], - "timestamp": 0.9206644115059893 + "timestamp": 0.9612079273983046 }, { - "x": 2.789606747587573, - "y": 7.689743795287642, - "heading": -7.888964430259046e-19, - "angularVelocity": 3.6293630276429175e-17, - "velocityX": 2.883067219573285, - "velocityY": -0.1390728695129531, + "x": 2.93241029163112, + "y": 7.694657309863743, + "heading": 3.3909393653904682e-18, + "angularVelocity": -5.41149172917068e-16, + "velocityX": 3.029561938948279, + "velocityY": -0.2255539332622711, "moduleForcesX": [ - 22.05050779451131, - 22.05050779451131, - 22.05050779451131, - 22.050507794511315 + 24.502907224942238, + 24.502907224942224, + 24.502907224942227, + 24.50290722494221 ], "moduleForcesY": [ - 18.659017610104875, - 18.659017610104872, - 18.659017610104872, - 18.65901761010487 + 6.011787217851106, + 6.01178721785112, + 6.011787217851177, + 6.011787217851191 ], - "timestamp": 0.9864261551849886 + "timestamp": 1.0298656364981835 }, { - "x": 2.967213392257691, - "y": 7.685123920440673, - "heading": 4.745649295344761e-28, - "angularVelocity": 1.1996282234435421e-17, - "velocityX": 2.7007593584788383, - "velocityY": -0.07025170847495492, + "x": 3.13550867397051, + "y": 7.689670458405492, + "heading": 2.3700654686943004e-18, + "angularVelocity": -1.4869035170145797e-17, + "velocityX": 2.958129320111599, + "velocityY": -0.07263352540708297, "moduleForcesX": [ - -27.72247980287612, - -27.72247980287612, - -27.722479802876123, - -27.722479802876123 + -10.404165791895908, + -10.404165791895853, + -10.404165791895927, + -10.404165791895874 ], "moduleForcesY": [ - 10.465227530169143, - 10.465227530169143, - 10.465227530169143, - 10.465227530169143 + 22.272867804632124, + 22.272867804632142, + 22.2728678046321, + 22.27286780463212 ], - "timestamp": 1.052187898863988 + "timestamp": 1.0985233455980625 }, { - "x": 3.1413251938672926, - "y": 7.68365614716633, - "heading": 6.464502773186125e-20, - "angularVelocity": 9.278149747726005e-19, - "velocityX": 2.498931873622686, - "velocityY": -0.021066150561468423, + "x": 3.3247365780348797, + "y": 7.686579288083217, + "heading": 1.2518606947608097e-18, + "angularVelocity": -1.6286660008708956e-17, + "velocityX": 2.7561057096745825, + "velocityY": -0.0450229167686534, "moduleForcesX": [ - -28.967199822820394, - -28.967199822820394, - -28.967199822820394, - -28.967199822820394 + -29.424752600341673, + -29.424752600341673, + -29.424752600341673, + -29.424752600341673 ], "moduleForcesY": [ - 7.059335280783723, - 7.059335280783723, - 7.059335280783723, - 7.059335280783723 + 4.021487026061436, + 4.021487026061437, + 4.021487026061434, + 4.021487026061434 ], - "timestamp": 1.121862387972582 + "timestamp": 1.1671810546979415 }, { - "x": 3.301045698440975, - "y": 7.683954538378008, - "heading": 1.421209171748835e-19, - "angularVelocity": 1.1119693716824987e-18, - "velocityX": 2.2923814241692906, - "velocityY": 0.004282646638499632, + "x": 3.5, + "y": 7.685123920440674, + "heading": 1.3450441301012e-27, + "angularVelocity": -1.8233359839203593e-17, + "velocityX": 2.552712932942728, + "velocityY": -0.021197439610658276, "moduleForcesX": [ - -29.645061211925828, - -29.645061211925828, - -29.645061211925828, - -29.645061211925828 + -29.624171764305668, + -29.624171764305668, + -29.624171764305668, + -29.624171764305668 ], "moduleForcesY": [ - 3.6381748218436845, - 3.638174821843685, - 3.6381748218436845, - 3.6381748218436845 + 3.470182368498979, + 3.470182368498979, + 3.4701823684989788, + 3.4701823684989788 ], - "timestamp": 1.191536877081176 + "timestamp": 1.2358387637978205 }, { - "x": 3.446289399224634, - "y": 7.685250406565696, - "heading": -1.8650220971302436e-20, - "angularVelocity": -2.307460621227609e-18, - "velocityX": 2.0846037429372988, - "velocityY": 0.01859889033401606, + "x": 3.66660979295668, + "y": 7.685277503249667, + "heading": -7.366679508948587e-19, + "angularVelocity": -1.0352679805094467e-17, + "velocityX": 2.3414318946180472, + "velocityY": 0.0021583586491987473, "moduleForcesX": [ - -29.82119910605288, - -29.82119910605288, - -29.82119910605288, - -29.82119910605288 + -29.69214192530745, + -29.69214192530745, + -29.69214192530745, + -29.69214192530745 ], "moduleForcesY": [ - 2.054732496596391, - 2.054732496596391, - 2.054732496596391, - 2.054732496596391 + 3.2822807110822207, + 3.2822807110822207, + 3.28228071108222, + 3.28228071108222 ], - "timestamp": 1.2612113661897701 + "timestamp": 1.306995987435028 }, { - "x": 3.5770259120173957, - "y": 7.687104461095777, - "heading": -1.173563503268423e-19, - "angularVelocity": -1.416675352937903e-18, - "velocityX": 1.8763899738194805, - "velocityY": 0.026610235034621205, + "x": 3.8181130477302205, + "y": 7.686389674690213, + "heading": -1.0052470940503514e-18, + "angularVelocity": -3.774446634956245e-18, + "velocityX": 2.1291338676457943, + "velocityY": 0.015629775637383256, "moduleForcesX": [ - -29.883788425530653, - -29.883788425530653, - -29.883788425530653, - -29.883788425530653 + -29.83506327546548, + -29.83506327546548, + -29.83506327546548, + -29.83506327546548 ], "moduleForcesY": [ - 1.1498246780278856, - 1.1498246780278856, - 1.1498246780278853, - 1.1498246780278856 + 1.8931903606678264, + 1.8931903606678264, + 1.893190360667826, + 1.8931903606678262 ], - "timestamp": 1.3308858552983642 + "timestamp": 1.3781532110722357 }, { - "x": 3.6932427083988193, - "y": 7.689233224603489, - "heading": -2.143519849151234e-19, - "angularVelocity": -1.3921255504376119e-18, - "velocityX": 1.6679963910140032, - "velocityY": 0.030552983529645465, + "x": 3.9544827559802536, + "y": 7.688049683677874, + "heading": -1.1160390053949122e-18, + "angularVelocity": -1.557001607826288e-18, + "velocityX": 1.9164562820117013, + "velocityY": 0.02332874868790862, "moduleForcesX": [ - -29.909596104921132, - -29.909596104921132, - -29.909596104921132, - -29.909596104921132 + -29.888404123019413, + -29.888404123019413, + -29.888404123019413, + -29.888404123019413 ], "moduleForcesY": [ - 0.5658812207266298, - 0.5658812207266298, - 0.5658812207266299, - 0.5658812207266299 + 1.0819664760641052, + 1.0819664760641052, + 1.081966476064105, + 1.081966476064105 ], - "timestamp": 1.4005603444069583 + "timestamp": 1.4493104347094432 }, { - "x": 3.794934324336777, - "y": 7.691438850943431, - "heading": -2.5442565992896705e-19, - "angularVelocity": -5.751556609829351e-19, - "velocityX": 1.459524386008453, - "velocityY": 0.0316561536274656, + "x": 4.0757072948411, + "y": 7.689988843265152, + "heading": -1.1154255698059989e-18, + "angularVelocity": 8.620842587319347e-21, + "velocityX": 1.7036153557492033, + "velocityY": 0.027251760094771964, "moduleForcesX": [ - -29.920851616238835, - -29.920851616238835, - -29.920851616238835, - -29.920851616238835 + -29.911359013620217, + -29.911359013620217, + -29.911359013620217, + -29.911359013620217 ], "moduleForcesY": [ - 0.15833199667958303, - 0.15833199667958303, - 0.15833199667958311, - 0.15833199667958311 + 0.5513159741679446, + 0.5513159741679446, + 0.5513159741679446, + 0.5513159741679446 ], - "timestamp": 1.4702348335155524 + "timestamp": 1.5204676583466508 }, { - "x": 3.8820984561769913, - "y": 7.693575500180637, - "heading": -2.5324350459741614e-19, - "angularVelocity": 1.6966806512526577e-20, - "velocityX": 1.2510193179461728, - "velocityY": 0.03066616297442321, + "x": 4.18178133884055, + "y": 7.692017881304884, + "heading": -1.0251515894825497e-18, + "angularVelocity": 1.2686551735523382e-18, + "velocityX": 1.4906995885649266, + "velocityY": 0.02851485676050525, "moduleForcesX": [ - -29.925596976722087, - -29.925596976722087, - -29.925596976722087, - -29.925596976722087 + -29.921876697975197, + -29.921876697975197, + -29.921876697975197, + -29.921876697975197 ], "moduleForcesY": [ - -0.1420879673045332, - -0.1420879673045332, - -0.14208796730453307, - -0.14208796730453307 + 0.17750786233217195, + 0.17750786233217195, + 0.17750786233217192, + 0.17750786233217192 ], - "timestamp": 1.5399093226241465 + "timestamp": 1.5916248819838583 }, { - "x": 3.954734327805857, - "y": 7.6955312510952805, - "heading": -2.2118758460991037e-19, - "angularVelocity": 4.60081145250412e-19, - "velocityX": 1.0425031106305602, - "velocityY": 0.028069827783906147, + "x": 4.272702463280462, + "y": 7.693996335665616, + "heading": -8.85146828846673e-19, + "angularVelocity": 1.9675410734757282e-18, + "velocityX": 1.2777497461611191, + "velocityY": 0.02780398475329726, "moduleForcesX": [ - -29.927195733092546, - -29.927195733092546, - -29.927195733092546, - -29.927195733092546 + -29.92666542043912, + -29.92666542043912, + -29.92666542043912, + -29.92666542043912 ], "moduleForcesY": [ - -0.372637851204075, - -0.372637851204075, - -0.37263785120407483, - -0.37263785120407483 + -0.09990159408584362, + -0.09990159408584362, + -0.09990159408584365, + -0.09990159408584365 ], - "timestamp": 1.6095838117327406 + "timestamp": 1.6627821056210659 }, { - "x": 4.012841935399933, - "y": 7.69721751820016, - "heading": -1.544604135447017e-19, - "angularVelocity": 9.576987258007982e-19, - "velocityX": 0.8339868485758819, - "velocityY": 0.02420207357545785, + "x": 4.348469686389936, + "y": 7.695815860635135, + "heading": -7.093341639933162e-19, + "angularVelocity": 2.4707634080914777e-18, + "velocityX": 1.0647861065479056, + "velocityY": 0.02557048850941353, "moduleForcesX": [ - -29.927203589492557, - -29.927203589492557, - -29.927203589492557, - -29.927203589492557 + -29.928604395669055, + -29.928604395669055, + -29.928604395669055, + -29.928604395669055 ], "moduleForcesY": [ - -0.5551176991653127, - -0.5551176991653127, - -0.5551176991653126, - -0.5551176991653126 + -0.3138818702751991, + -0.3138818702751991, + -0.31388187027519915, + -0.31388187027519915 ], - "timestamp": 1.6792583008413347 + "timestamp": 1.7339393292582734 }, { - "x": 4.056421672062467, - "y": 7.698562451628175, - "heading": -5.419193690793024e-20, - "angularVelocity": 1.4390988214903013e-18, - "velocityX": 0.6254762282830563, - "velocityY": 0.019303097055838256, + "x": 4.4090827796581005, + "y": 7.697390357009512, + "heading": -5.125690877607844e-19, + "angularVelocity": 2.76521575318147e-18, + "velocityX": 0.8518192555861492, + "velocityY": 0.022127006842417533, "moduleForcesX": [ - -29.926393858136848, - -29.926393858136848, - -29.926393858136848, - -29.926393858136848 + -29.929055698906968, + -29.929055698906968, + -29.929055698906968, + -29.929055698906968 ], "moduleForcesY": [ - -0.7031234218285176, - -0.7031234218285176, - -0.7031234218285174, - -0.7031234218285174 + -0.48392580415341463, + -0.48392580415341463, + -0.4839258041534147, + -0.4839258041534147 ], - "timestamp": 1.7489327899499287 + "timestamp": 1.805096552895481 }, { - "x": 4.085474131217841, - "y": 7.699506608982952, - "heading": 2.7187783763224124e-20, - "angularVelocity": 1.1679987967787588e-18, - "velocityX": 0.41697412538775014, - "velocityY": 0.0135509763802512, + "x": 4.454541917622047, + "y": 7.698649766258782, + "heading": -3.0693954250775033e-19, + "angularVelocity": 2.889791566683448e-18, + "velocityX": 0.6388548574600323, + "velocityY": 0.01769896554444152, "moduleForcesX": [ - -29.925171402453582, - -29.925171402453582, - -29.925171402453582, - -29.925171402453582 + -29.928710992422637, + -29.928710992422637, + -29.928710992422637, + -29.928710992422637 ], "moduleForcesY": [ - -0.8255705566240068, - -0.8255705566240068, - -0.8255705566240065, - -0.8255705566240065 + -0.6222897791167649, + -0.6222897791167649, + -0.6222897791167649, + -0.6222897791167649 ], - "timestamp": 1.8186072790585228 + "timestamp": 1.8762537765326885 }, { - "x": 4.099999999999999, - "y": 7.700000000000001, - "heading": 7.046657587318804e-29, - "angularVelocity": -3.9021145698260385e-19, - "velocityX": 0.20848188439036744, - "velocityY": 0.007081372592684751, + "x": 4.484847490490274, + "y": 7.699535974400896, + "heading": -1.0247249988989415e-19, + "angularVelocity": 2.8734544674071763e-18, + "velocityX": 0.4258959430827974, + "velocityY": 0.012454225960910713, "moduleForcesX": [ - -29.923755977948908, - -29.923755977948908, - -29.923755977948908, - -29.923755977948908 + -29.927940339971396, + -29.927940339971396, + -29.927940339971396, + -29.927940339971396 ], "moduleForcesY": [ - -0.9285470005363222, - -0.9285470005363222, - -0.9285470005363218, - -0.9285470005363217 + -0.7370635496222995, + -0.7370635496222995, + -0.7370635496222995, + -0.7370635496222995 ], - "timestamp": 1.888281768167117 + "timestamp": 1.947411000169896 }, { - "x": 4.1, + "x": 4.5, "y": 7.700000000000001, - "heading": 3.2045159969045717e-29, - "angularVelocity": -9.151492845773918e-29, - "velocityX": 2.2287955073955105e-17, - "velocityY": -1.8794204571145243e-16, + "heading": -7.064779315924063e-28, + "angularVelocity": 1.4400856798866269e-18, + "velocityX": 0.21294407981721789, + "velocityY": 0.006521131312349581, + "moduleForcesX": [ + -29.92694941996426, + -29.92694941996426, + -29.92694941996426, + -29.92694941996426 + ], + "moduleForcesY": [ + -0.8338007506884793, + -0.8338007506884793, + -0.8338007506884791, + -0.8338007506884791 + ], + "timestamp": 2.0185682238071037 + }, + { + "x": 4.5, + "y": 7.7, + "heading": -3.5046617389724685e-28, + "angularVelocity": 7.7934235041127e-29, + "velocityX": 9.122485788705435e-19, + "velocityY": -1.2473644372179643e-17, "moduleForcesX": [ - -29.922269550542303, - -29.922269550542303, - -29.922269550542303, - -29.922269550542303 + -29.925855581845823, + -29.925855581845823, + -29.925855581845823, + -29.925855581845823 ], "moduleForcesY": [ - -1.0163508456660588, - -1.0163508456660588, - -1.0163508456660586, - -1.0163508456660586 + -0.9164398186187475, + -0.9164398186187475, + -0.9164398186187476, + -0.9164398186187476 ], - "timestamp": 1.957956257275711 + "timestamp": 2.089725447444311 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/ScoreAltStack1.traj b/src/main/deploy/choreo/ScoreAltStack1.traj index b12f3fd..d981fdb 100644 --- a/src/main/deploy/choreo/ScoreAltStack1.traj +++ b/src/main/deploy/choreo/ScoreAltStack1.traj @@ -1,12 +1,12 @@ { "samples": [ { - "x": 3.7, - "y": 7.915, - "heading": -8.857685423615453e-28, - "angularVelocity": -6.899974613937114e-28, - "velocityX": -2.113567356761841e-16, - "velocityY": -2.7741436758646538e-17, + "x": 4.499999999999995, + "y": 7.914999999999999, + "heading": -4.638339058629045e-28, + "angularVelocity": -4.6962216121188425e-28, + "velocityX": 2.6224481276471926e-16, + "velocityY": 2.581223045696416e-17, "moduleForcesX": [ 0, 0, @@ -22,382 +22,445 @@ "timestamp": 0 }, { - "x": 3.6703592062351653, - "y": 7.911109645818366, - "heading": 7.616414564532622e-19, - "angularVelocity": 7.622660792084474e-18, - "velocityX": -0.2966508230953476, - "velocityY": -0.038935420531261214, + "x": 4.470898934241406, + "y": 7.912135363839381, + "heading": 2.496430291884428e-19, + "angularVelocity": 2.5262310074100717e-18, + "velocityX": -0.29448450280018673, + "velocityY": -0.028988318244463337, "moduleForcesX": [ - -29.689390756976636, - -29.689390756976636, - -29.689390756976636, - -29.689390756976636 + -29.799981591357007, + -29.799981591357007, + -29.799981591357007, + -29.799981591357007 ], "moduleForcesY": [ - -3.896732536852825, - -3.896732536852825, - -3.896732536852825, - -3.8967325368528245 + -2.9334356879062806, + -2.9334356879062806, + -2.9334356879062806, + -2.9334356879062806 ], - "timestamp": 0.09991812412844604 + "timestamp": 0.09882036399834276 }, { - "x": 3.6110792939397647, - "y": 7.903329157329628, - "heading": 1.3924771036973263e-18, - "angularVelocity": 6.313530326074628e-18, - "velocityX": -0.5932848801182579, - "velocityY": -0.07786864051551397, + "x": 4.412698176655327, + "y": 7.906406226764488, + "heading": 4.891365769160474e-19, + "angularVelocity": 2.4235257989579454e-18, + "velocityX": -0.5889551022808781, + "velocityY": -0.05797526788091311, "moduleForcesX": [ - -29.68771277587098, - -29.68771277587098, - -29.68771277587098, - -29.68771277587098 + -29.798574662769983, + -29.798574662769983, + -29.798574662769983, + -29.798574662769983 ], "moduleForcesY": [ - -3.896512301832707, - -3.896512301832707, - -3.8965123018327064, - -3.8965123018327064 + -2.9332971933734906, + -2.933297193373491, + -2.9332971933734906, + -2.9332971933734906 ], - "timestamp": 0.19983624825689209 + "timestamp": 0.19764072799668553 }, { - "x": 3.522162453880418, - "y": 7.891658822071787, - "heading": 3.0562730144599226e-18, - "angularVelocity": 1.6651604268245938e-17, - "velocityX": -0.8898970115352512, - "velocityY": -0.11679898276399112, + "x": 4.325399445343049, + "y": 7.897812757900665, + "heading": 3.655634140040506e-18, + "angularVelocity": 3.204296968181486e-17, + "velocityX": -0.8834083156564232, + "velocityY": -0.08696050607263796, "moduleForcesX": [ - -29.685518418630103, - -29.685518418630103, - -29.685518418630103, - -29.685518418630103 + -29.796815298157618, + -29.796815298157618, + -29.796815298157618, + -29.796815298157618 ], "moduleForcesY": [ - -3.896224292444841, - -3.896224292444841, - -3.8962242924448405, - -3.8962242924448405 + -2.9331240059194625, + -2.933124005919462, + -2.933124005919462, + -2.9331240059194617 ], - "timestamp": 0.29975437238533814 + "timestamp": 0.2964610919950283 }, { - "x": 3.4036116735643516, - "y": 7.87609903215534, - "heading": 4.284984789615624e-18, - "angularVelocity": 1.2297193424363515e-17, - "velocityX": -1.1864792433767892, - "velocityY": -0.15572540069318988, + "x": 4.209004950391425, + "y": 7.886355174803512, + "heading": 3.9790958580592245e-18, + "angularVelocity": 3.273228142849478e-18, + "velocityX": -1.1778391643743693, + "velocityY": -0.11594354274337776, "moduleForcesX": [ - -29.68252601102455, - -29.68252601102455, - -29.68252601102455, - -29.68252601102455 + -29.794552135311253, + -29.794552135311253, + -29.794552135311253, + -29.794552135311253 ], "moduleForcesY": [ - -3.8958315389466107, - -3.8958315389466107, - -3.8958315389466103, - -3.8958315389466103 + -2.9329012258267713, + -2.9329012258267713, + -2.932901225826771, + -2.932901225826771 ], - "timestamp": 0.39967249651378417 + "timestamp": 0.39528145599337106 }, { - "x": 3.2554312684038718, - "y": 7.856650353978022, - "heading": 4.88713080927974e-18, - "angularVelocity": 6.026395683160927e-18, - "velocityX": -1.483018285749852, - "velocityY": -0.1946461500046506, + "x": 4.063517640413706, + "y": 7.872033767729362, + "heading": 4.407813999535086e-18, + "angularVelocity": 4.338355520630196e-18, + "velocityX": -1.4722401747721297, + "velocityY": -0.14492364220448076, "moduleForcesX": [ - -29.678203525103136, - -29.678203525103136, - -29.678203525103136, - -29.678203525103136 + -29.791532684768715, + -29.791532684768715, + -29.791532684768715, + -29.791532684768715 ], "moduleForcesY": [ - -3.8952642126694257, - -3.8952642126694257, - -3.8952642126694252, - -3.8952642126694252 + -2.9326039986639896, + -2.9326039986639896, + -2.9326039986639896, + -2.932603998663989 ], - "timestamp": 0.4995906206422302 + "timestamp": 0.4941018199917138 }, { - "x": 3.0776280197895494, - "y": 7.833313677597383, - "heading": 4.452250502602634e-18, - "angularVelocity": -4.35237203301742e-18, - "velocityX": -1.7794894586497152, - "velocityY": -0.23355799144775333, + "x": 3.8889416469282945, + "y": 7.854848943371605, + "heading": 5.0219613363697e-18, + "angularVelocity": 6.214784160541381e-18, + "velocityX": -1.7665993770490904, + "velocityY": -0.1738996261786864, "moduleForcesX": [ - -29.671411016355503, - -29.671411016355503, - -29.671411016355503, - -29.671411016355503 + -29.787301965598665, + -29.787301965598665, + -29.787301965598665, + -29.787301965598665 ], "moduleForcesY": [ - -3.894372695896298, - -3.894372695896298, - -3.8943726958962976, - -3.8943726958962976 + -2.9321875372456865, + -2.9321875372456865, + -2.9321875372456865, + -2.9321875372456865 ], - "timestamp": 0.5995087447706763 + "timestamp": 0.5929221839900566 }, { - "x": 2.8702141334228277, - "y": 7.80609060501178, - "heading": 4.0844435739069476e-18, - "angularVelocity": -3.6810809222487295e-18, - "velocityX": -2.0758384745095704, - "velocityY": -0.27245379977935613, + "x": 3.6852831742101206, + "y": 7.83480131246111, + "heading": 5.322867972117647e-18, + "angularVelocity": 3.0449854941810913e-18, + "velocityX": -2.060895796134092, + "velocityY": -0.20286942993243606, "moduleForcesX": [ - -29.659185302439916, - -29.659185302439916, - -29.659185302439916, - -29.659185302439916 + -29.780948701005272, + -29.780948701005272, + -29.780948701005272, + -29.780948701005272 ], "moduleForcesY": [ - -3.892768070944876, - -3.892768070944876, - -3.8927680709448755, - -3.8927680709448755 + -2.9315621377622727, + -2.9315621377622727, + -2.9315621377622723, + -2.9315621377622723 ], - "timestamp": 0.6994268688991223 + "timestamp": 0.6917425479883994 }, { - "x": 2.6332180803157414, - "y": 7.774984873041552, - "heading": 2.6832322245167815e-18, - "angularVelocity": -1.402360617948463e-17, - "velocityX": -2.3719025469505195, - "velocityY": -0.3113122092872268, + "x": 3.4525525798402876, + "y": 7.811891894578838, + "heading": 4.890981808967791e-18, + "angularVelocity": -4.370418601700563e-18, + "velocityX": -2.355087402545218, + "velocityY": -0.2318289161886001, "moduleForcesX": [ - -29.63066761140782, - -29.63066761140782, - -29.63066761140782, - -29.63066761140782 + -29.770342316892076, + -29.770342316892076, + -29.770342316892076, + -29.770342316892076 ], "moduleForcesY": [ - -3.8890251239969107, - -3.8890251239969107, - -3.8890251239969107, - -3.8890251239969107 + -2.930518071826127, + -2.9305180718261266, + -2.9305180718261266, + -2.9305180718261266 ], - "timestamp": 0.7993449930275683 + "timestamp": 0.7905629119867421 }, { - "x": 2.3667819196836817, - "y": 7.740015126958444, - "heading": 1.2523360861115753e-18, - "angularVelocity": -1.432069097101314e-17, - "velocityX": -2.666544863157521, - "velocityY": -0.3499840132893921, + "x": 3.1907706355776666, + "y": 7.7861227344399415, + "heading": 4.74737406551849e-18, + "angularVelocity": -1.4532281737363371e-18, + "velocityX": -2.6490688120600145, + "velocityY": -0.2607677111877834, "moduleForcesX": [ - -29.48837548349919, - -29.48837548349919, - -29.48837548349919, - -29.48837548349919 + -29.74907171155665, + -29.74907171155665, + -29.74907171155665, + -29.74907171155665 ], "moduleForcesY": [ - -3.8703492822088994, - -3.8703492822088994, - -3.8703492822088994, - -3.8703492822088994 + -2.9284242466134156, + -2.9284242466134156, + -2.9284242466134156, + -2.9284242466134156 ], - "timestamp": 0.8992631171560144 + "timestamp": 0.8893832759850848 }, { - "x": 2.129785866576617, - "y": 7.708909394988331, - "heading": 5.829284819779899e-19, - "angularVelocity": -6.699569626494213e-18, - "velocityX": -2.371902546950514, - "velocityY": -0.31131220928722614, + "x": 2.9000000000085278, + "y": 7.7575000000011185, + "heading": 4.849177353452629e-18, + "angularVelocity": 1.030183522414544e-18, + "velocityX": -2.942416156030418, + "velocityY": -0.28964409035993643, "moduleForcesX": [ - 29.48837548349971, - 29.48837548349971, - 29.48837548349971, - 29.48837548349971 + -29.684908261798405, + -29.684908261798405, + -29.684908261798405, + -29.684908261798405 ], "moduleForcesY": [ - 3.87034928220899, - 3.87034928220899, - 3.870349282208988, - 3.8703492822089878 + -2.9221081570278518, + -2.9221081570278518, + -2.9221081570278513, + -2.9221081570278513 ], - "timestamp": 0.9991812412844604 + "timestamp": 0.9882036399834275 }, { - "x": 1.9223719802105972, - "y": 7.681686322402585, - "heading": 6.437037611704664e-19, - "angularVelocity": 6.082528675476605e-19, - "velocityX": -2.0758384745095655, - "velocityY": -0.2724537997793555, + "x": 2.609229364411349, + "y": 7.728877265560418, + "heading": 2.265542225441438e-18, + "angularVelocity": -2.61447688749586e-17, + "velocityX": -2.94241615603042, + "velocityY": -0.28964409035993643, "moduleForcesX": [ - 29.63066761140773, - 29.63066761140773, - 29.63066761140773, - 29.63066761140773 + -1.7199540695637513e-13, + -1.7338192867140007e-13, + -1.7199540695637513e-13, + -1.7338192867140007e-13 ], "moduleForcesY": [ - 3.8890251239969085, - 3.8890251239969085, - 3.8890251239969076, - 3.8890251239969076 + -4.329225362489891e-15, + -4.329225362489891e-15, + -2.9427036475263487e-15, + -2.9427036475263487e-15 ], - "timestamp": 1.0990993654129064 + "timestamp": 1.0870240039817702 }, { - "x": 1.744568731595447, - "y": 7.658349646021965, - "heading": 9.15686449036186e-19, - "angularVelocity": 2.7220549588614654e-18, - "velocityX": -1.7794894586497105, - "velocityY": -0.23355799144775258, + "x": 2.3474474201316267, + "y": 7.70310810542016, + "heading": 4.5901616609339586e-20, + "angularVelocity": -2.2461371867793742e-17, + "velocityX": -2.649068812060015, + "velocityY": -0.2607677111877836, "moduleForcesX": [ - 29.659185302439884, - 29.659185302439884, - 29.659185302439884, - 29.659185302439884 + 29.684908261798398, + 29.684908261798398, + 29.684908261798398, + 29.684908261798398 ], "moduleForcesY": [ - 3.8927680709448764, - 3.8927680709448764, - 3.892768070944876, - 3.892768070944876 + 2.9221081570278504, + 2.92210815702785, + 2.9221081570278504, + 2.92210815702785 ], - "timestamp": 1.1990174895413526 + "timestamp": 1.185844367980113 }, { - "x": 1.5963883264356444, - "y": 7.638900967844622, - "heading": 1.784973792378466e-18, - "angularVelocity": 8.700000837342484e-18, - "velocityX": -1.4830182857498488, - "velocityY": -0.19464615000464972, + "x": 2.114716825803177, + "y": 7.680198687539856, + "heading": -1.9291784515592082e-19, + "angularVelocity": -2.416699618207275e-18, + "velocityX": -2.3550874025452173, + "velocityY": -0.23182891618860033, "moduleForcesX": [ - 29.67141101635549, - 29.67141101635549, - 29.67141101635549, - 29.67141101635549 + 29.749071711556653, + 29.749071711556653, + 29.749071711556653, + 29.749071711556653 ], "moduleForcesY": [ - 3.894372695896298, - 3.894372695896298, - 3.8943726958962976, - 3.8943726958962976 + 2.928424246613416, + 2.928424246613416, + 2.928424246613416, + 2.928424246613416 ], - "timestamp": 1.2989356136697987 + "timestamp": 1.2846647319784557 }, { - "x": 1.4778375461205624, - "y": 7.623341177928205, - "heading": 2.7560148106955593e-18, - "angularVelocity": 9.71837343672516e-18, - "velocityX": -1.1864792433767861, - "velocityY": -0.155725400693189, + "x": 1.911058353078909, + "y": 7.660151056632104, + "heading": -3.377731085102079e-19, + "angularVelocity": -1.4658416636877928e-18, + "velocityX": -2.0608957961340906, + "velocityY": -0.20286942993243623, "moduleForcesX": [ - 29.678203525103125, - 29.678203525103125, - 29.678203525103125, - 29.678203525103125 + 29.770342316892076, + 29.770342316892076, + 29.770342316892076, + 29.770342316892076 ], "moduleForcesY": [ - 3.8952642126694266, - 3.8952642126694266, - 3.895264212669426, - 3.895264212669426 + 2.930518071826126, + 2.930518071826126, + 2.930518071826126, + 2.930518071826126 ], - "timestamp": 1.3988537377982448 + "timestamp": 1.3834850959767984 }, { - "x": 1.388920706059698, - "y": 7.6116708426704, - "heading": 1.9252422657120355e-18, - "angularVelocity": -8.314537158425022e-18, - "velocityX": -0.8898970115352483, - "velocityY": -0.11679898276399021, + "x": 1.7364823595714767, + "y": 7.6429662322704175, + "heading": -1.6792972151820533e-19, + "angularVelocity": 1.7187116258215607e-18, + "velocityX": -1.766599377049088, + "velocityY": -0.17389962617868657, "moduleForcesX": [ - 29.682526011024542, - 29.682526011024542, - 29.682526011024542, - 29.682526011024542 + 29.780948701005272, + 29.780948701005272, + 29.780948701005272, + 29.780948701005272 ], "moduleForcesY": [ - 3.8958315389466116, - 3.8958315389466116, - 3.895831538946611, - 3.8958315389466107 + 2.931562137762272, + 2.931562137762272, + 2.9315621377622714, + 2.9315621377622714 ], - "timestamp": 1.498771861926691 + "timestamp": 1.482305459975141 }, { - "x": 1.3296407937654542, - "y": 7.603890354181709, - "heading": 5.384929038425166e-19, - "angularVelocity": -1.3878863788738055e-17, - "velocityX": -0.5932848801182574, - "velocityY": -0.07786864051551337, + "x": 1.5909950496159164, + "y": 7.628644825195066, + "heading": -1.8114858810608142e-19, + "angularVelocity": -1.337648175981526e-19, + "velocityX": -1.4722401747721263, + "velocityY": -0.14492364220448103, "moduleForcesX": [ - 29.6855184186301, - 29.6855184186301, - 29.6855184186301, - 29.6855184186301 + 29.78730196559866, + 29.78730196559866, + 29.78730196559866, + 29.78730196559866 ], "moduleForcesY": [ - 3.8962242924448414, - 3.8962242924448414, - 3.896224292444841, - 3.8962242924448405 + 2.9321875372456865, + 2.9321875372456865, + 2.932187537245686, + 2.932187537245686 ], - "timestamp": 1.5986899860551371 + "timestamp": 1.5811258239734838 }, { - "x": 1.2999999999999998, - "y": 7.6, - "heading": 1.856919521594944e-27, - "angularVelocity": -5.3893457370246385e-18, - "velocityX": -0.2966508230953496, - "velocityY": -0.038935420531260624, + "x": 1.4746005546489325, + "y": 7.617187242098636, + "heading": 1.1492887553656064e-19, + "angularVelocity": 2.99612188531174e-18, + "velocityX": -1.177839164374366, + "velocityY": -0.11594354274337797, "moduleForcesX": [ - 29.687712775870978, - 29.687712775870978, - 29.687712775870978, - 29.687712775870978 + 29.79153268476871, + 29.79153268476871, + 29.79153268476871, + 29.79153268476871 ], "moduleForcesY": [ - 3.896512301832707, - 3.8965123018327064, - 3.896512301832706, - 3.896512301832706 + 2.9326039986639896, + 2.9326039986639896, + 2.932603998663989, + 2.932603998663989 ], - "timestamp": 1.6986081101835833 + "timestamp": 1.6799461879718265 }, { - "x": 1.2999999999999998, - "y": 7.6, - "heading": 8.8348251998797e-28, - "angularVelocity": -9.002826196705125e-28, - "velocityX": -2.1138841235156355e-16, - "velocityY": -2.7745693838680483e-17, + "x": 1.3873018233478802, + "y": 7.608593773234277, + "heading": 3.655540340618568e-19, + "angularVelocity": 2.536173196431411e-18, + "velocityX": -0.88340831565642, + "velocityY": -0.08696050607263801, "moduleForcesX": [ - 29.689390756976636, - 29.689390756976636, - 29.689390756976636, - 29.689390756976636 + 29.794552135311253, + 29.794552135311253, + 29.794552135311253, + 29.794552135311253 ], "moduleForcesY": [ - 3.896732536852825, - 3.8967325368528245, - 3.896732536852824, - 3.896732536852824 + 2.932901225826772, + 2.9329012258267717, + 2.9329012258267717, + 2.9329012258267717 ], - "timestamp": 1.7985262343120294 + "timestamp": 1.7787665519701692 + }, + { + "x": 1.3291010657585993, + "y": 7.602864636160619, + "heading": 3.0467259837923257e-19, + "angularVelocity": -6.160799067151849e-19, + "velocityX": -0.5889551022808759, + "velocityY": -0.05797526788091317, + "moduleForcesX": [ + 29.796815298157618, + 29.796815298157618, + 29.796815298157618, + 29.796815298157618 + ], + "moduleForcesY": [ + 2.933124005919461, + 2.933124005919461, + 2.933124005919461, + 2.933124005919461 + ], + "timestamp": 1.877586915968512 + }, + { + "x": 1.3000000000000107, + "y": 7.6000000000000005, + "heading": 9.917870531529092e-28, + "angularVelocity": -3.0830964027267292e-18, + "velocityX": -0.2944845028001849, + "velocityY": -0.028988318244463407, + "moduleForcesX": [ + 29.798574662769983, + 29.798574662769983, + 29.798574662769983, + 29.798574662769983 + ], + "moduleForcesY": [ + 2.933297193373492, + 2.933297193373492, + 2.933297193373492, + 2.933297193373492 + ], + "timestamp": 1.9764072799668546 + }, + { + "x": 1.3000000000000054, + "y": 7.6000000000000005, + "heading": 4.701482456046991e-28, + "angularVelocity": -5.210521550023728e-28, + "velocityX": -2.6451906839746297e-16, + "velocityY": -2.6041349607583192e-17, + "moduleForcesX": [ + 29.799981591357007, + 29.799981591357007, + 29.799981591357007, + 29.799981591357007 + ], + "moduleForcesY": [ + 2.9334356879062784, + 2.9334356879062784, + 2.9334356879062784, + 2.9334356879062784 + ], + "timestamp": 2.0752276439651975 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/ScoreStack1.traj b/src/main/deploy/choreo/ScoreStack1.traj index 1a9e5b4..8c2e7dd 100644 --- a/src/main/deploy/choreo/ScoreStack1.traj +++ b/src/main/deploy/choreo/ScoreStack1.traj @@ -1,11 +1,11 @@ { "samples": [ { - "x": 3.400000000000001, + "x": 3.7, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -9.407546867814934e-17, + "velocityX": -2.1223019497204737e-16, "velocityY": 0, "moduleForcesX": [ 0, @@ -22,17 +22,17 @@ "timestamp": 0 }, { - "x": 3.3297074111184566, + "x": 3.6703591590577123, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -0.7653890649196098, + "velocityX": -0.29792018801620485, "velocityY": 0, "moduleForcesX": [ - -154.36282311992616, - -154.36282311992616, - -154.36282311992616, - -154.36282311992616 + -29.943967716838138, + -29.943967716838138, + -29.943967716838138, + -29.943967716838138 ], "moduleForcesY": [ 0, @@ -40,20 +40,20 @@ 0, 0 ], - "timestamp": 0.0918390294600401 + "timestamp": 0.09949255584078534 }, { - "x": 3.1891336601082934, + "x": 3.611079159545517, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -1.5306537086365442, + "velocityX": -0.5958234665033081, "velocityY": 0, "moduleForcesX": [ - -154.33772998889862, - -154.33772998889862, - -154.33772998889862, - -154.33772998889862 + -29.942268139521204, + -29.942268139521204, + -29.942268139521204, + -29.942268139521204 ], "moduleForcesY": [ 0, @@ -61,20 +61,20 @@ 0, 0 ], - "timestamp": 0.1836780589200802 + "timestamp": 0.19898511168157068 }, { - "x": 2.9783014144979076, + "x": 3.522162201555006, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -2.2956715331997852, + "velocityX": -0.8937046318550901, "velocityY": 0, "moduleForcesX": [ - -154.2879517739881, - -154.2879517739881, - -154.2879517739881, - -154.2879517739881 + -29.940045547576133, + -29.940045547576133, + -29.940045547576133, + -29.940045547576133 ], "moduleForcesY": [ 0, @@ -82,20 +82,20 @@ 0, 0 ], - "timestamp": 0.27551708838012035 + "timestamp": 0.29847766752235605 }, { - "x": 2.697277204972547, + "x": 3.4036112853033273, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -3.05996493209254, + "velocityX": -1.191555642031464, "velocityY": 0, "moduleForcesX": [ - -154.1418504031152, - -154.1418504031152, - -154.1418504031152, - -154.1418504031152 + -29.9370146499214, + -29.9370146499214, + -29.9370146499214, + -29.9370146499214 ], "moduleForcesY": [ 0, @@ -103,20 +103,20 @@ 0, 0 ], - "timestamp": 0.3673561178401604 + "timestamp": 0.39797022336314136 }, { - "x": 2.3499999999955428, + "x": 3.255430744528146, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -3.781368411810337, + "velocityX": -1.489363093781487, "velocityY": 0, "moduleForcesX": [ - -145.4918587705222, - -145.4918587705222, - -145.4918587705222, - -145.4918587705222 + -29.932636591081764, + -29.932636591081764, + -29.932636591081764, + -29.932636591081764 ], "moduleForcesY": [ 0, @@ -124,20 +124,20 @@ 0, 0 ], - "timestamp": 0.4591951473002005 + "timestamp": 0.4974627792039267 }, { - "x": 2.0027227950320547, + "x": 3.0776273893666106, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -3.7813684118103366, + "velocityX": -1.787102096820726, "velocityY": 0, "moduleForcesX": [ - 7.397478932266691e-14, - 7.397478932266691e-14, - 7.397478932266691e-14, - 7.397478932266691e-14 + -29.92575680894927, + -29.92575680894927, + -29.92575680894927, + -29.92575680894927 ], "moduleForcesY": [ 0, @@ -145,20 +145,20 @@ 0, 0 ], - "timestamp": 0.5510341767602406 + "timestamp": 0.596955335044712 }, { - "x": 1.7216985855048654, + "x": 2.8702134771129013, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -3.0599649320924875, + "velocityX": -2.084717901774596, "velocityY": 0, "moduleForcesX": [ - 145.4918587705386, - 145.4918587705386, - 145.4918587705386, - 145.4918587705386 + -29.913374165405493, + -29.913374165405493, + -29.913374165405493, + -29.913374165405493 ], "moduleForcesY": [ 0, @@ -166,20 +166,20 @@ 0, 0 ], - "timestamp": 0.6428732062202807 + "timestamp": 0.6964478908854973 }, { - "x": 1.5108663398771738, + "x": 2.63321759850265, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -2.295671533199748, + "velocityX": -2.3820463411279955, "velocityY": 0, "moduleForcesX": [ - 154.14185040311517, - 154.14185040311517, - 154.14185040311517, - 154.14185040311517 + -29.884491039590547, + -29.884491039590547, + -29.884491039590547, + -29.884491039590547 ], "moduleForcesY": [ 0, @@ -187,20 +187,20 @@ 0, 0 ], - "timestamp": 0.7347122356803207 + "timestamp": 0.7959404467262826 }, { - "x": 1.370292588887788, + "x": 2.3667824014974026, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -1.53065370863651, + "velocityX": -2.677941025353704, "velocityY": 0, "moduleForcesX": [ - 154.2879517739881, - 154.2879517739881, - 154.2879517739881, - 154.2879517739881 + -29.740384263813567, + -29.740384263813567, + -29.740384263813567, + -29.740384263813567 ], "moduleForcesY": [ 0, @@ -208,20 +208,20 @@ 0, 0 ], - "timestamp": 0.8265512651403608 + "timestamp": 0.8954330025670679 }, { - "x": 1.2999999999999985, + "x": 2.129786522887132, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -0.7653890649195804, + "velocityX": -2.382046341127999, "velocityY": 0, "moduleForcesX": [ - 154.33772998889862, - 154.33772998889862, - 154.33772998889862, - 154.33772998889862 + 29.74038426381322, + 29.74038426381322, + 29.74038426381322, + 29.74038426381322 ], "moduleForcesY": [ 0, @@ -229,20 +229,20 @@ 0, 0 ], - "timestamp": 0.9183902946004009 + "timestamp": 0.9949255584078532 }, { - "x": 1.2999999999999994, + "x": 1.9223726106332406, "y": 5.8, "heading": 0, "angularVelocity": 0, - "velocityX": -1.5609122905701728e-17, + "velocityX": -2.084717901774599, "velocityY": 0, "moduleForcesX": [ - 154.3628231199262, - 154.3628231199262, - 154.3628231199262, - 154.3628231199262 + 29.88449103959053, + 29.88449103959053, + 29.88449103959053, + 29.88449103959053 ], "moduleForcesY": [ 0, @@ -250,7 +250,154 @@ 0, 0 ], - "timestamp": 1.010229324060441 + "timestamp": 1.0944181142486387 + }, + { + "x": 1.7445692554719296, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -1.7871020968207303, + "velocityY": 0, + "moduleForcesX": [ + 29.91337416540549, + 29.91337416540549, + 29.91337416540549, + 29.91337416540549 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.193910670089424 + }, + { + "x": 1.5963887146963893, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -1.4893630937814928, + "velocityY": 0, + "moduleForcesX": [ + 29.925756808949266, + 29.925756808949266, + 29.925756808949266, + 29.925756808949266 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.2934032259302093 + }, + { + "x": 1.4778377984444975, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -1.1915556420314695, + "velocityY": 0, + "moduleForcesX": [ + 29.93263659108176, + 29.93263659108176, + 29.93263659108176, + 29.93263659108176 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.3928957817709946 + }, + { + "x": 1.388920840454741, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -0.8937046318550956, + "velocityY": 0, + "moduleForcesX": [ + 29.9370146499214, + 29.9370146499214, + 29.9370146499214, + 29.9370146499214 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.49238833761178 + }, + { + "x": 1.3296408409423432, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -0.5958234665033137, + "velocityY": 0, + "moduleForcesX": [ + 29.940045547576133, + 29.940045547576133, + 29.940045547576133, + 29.940045547576133 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.5918808934525652 + }, + { + "x": 1.2999999999999998, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -0.2979201880162081, + "velocityY": 0, + "moduleForcesX": [ + 29.9422681395212, + 29.9422681395212, + 29.9422681395212, + 29.9422681395212 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.6913734492933505 + }, + { + "x": 1.2999999999999998, + "y": 5.8, + "heading": 0, + "angularVelocity": 0, + "velocityX": -1.0698355883926944e-16, + "velocityY": 0, + "moduleForcesX": [ + 29.943967716838138, + 29.943967716838138, + 29.943967716838138, + 29.943967716838138 + ], + "moduleForcesY": [ + 0, + 0, + 0, + 0 + ], + "timestamp": 1.7908660051341359 } ], "eventMarkers": [] diff --git a/team5115.chor b/team5115.chor index 9e5b295..7e9ebf7 100644 --- a/team5115.chor +++ b/team5115.chor @@ -17027,10 +17027,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 19 + "controlIntervalCount": 21 }, { - "x": 3.7, + "x": 4.5, "y": 7.915, "heading": 0, "isInitialGuess": false, @@ -17041,12 +17041,12 @@ ], "trajectory": [ { - "x": 1.225, + "x": 1.225000000000017, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 5.571667604430733e-17, - "velocityY": 0, + "heading": 1.333907624287153e-28, + "angularVelocity": 6.76869812381367e-29, + "velocityX": -1.279975862363891e-15, + "velocityY": -6.283924189430902e-45, "moduleForcesX": [ 0, 0, @@ -17062,403 +17062,445 @@ "timestamp": 0 }, { - "x": 1.252509667071736, + "x": 1.2547830613499884, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.2870082542576082, - "velocityY": 0, + "heading": 4.435738168561203e-20, + "angularVelocity": 4.447719567475508e-19, + "velocityX": 0.2986348628168654, + "velocityY": -9.787491949916075e-36, "moduleForcesX": [ - 29.943560493551253, - 29.943560493551253, - 29.943560493551253, - 29.943560493551253 + 29.94412838953491, + 29.94412838953491, + 29.94412838953491, + 29.94412838953491 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8044103254370303e-16, + 3.8044103254370303e-16, + -3.8044103254370303e-16, + -3.8044103254370303e-16 ], - "timestamp": 0.0958497418232613 + "timestamp": 0.09973069141702882 }, { - "x": 1.3075274905381924, + "x": 1.3143477894526874, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.5740007476277683, - "velocityY": 0, + "heading": 1.2842111410913485e-19, + "angularVelocity": 8.429079842826135e-19, + "velocityX": 0.5972557420023291, + "velocityY": -1.942799795986437e-35, "moduleForcesX": [ - 29.94191616074935, - 29.94191616074935, - 29.94191616074935, - 29.94191616074935 + 29.942726250311168, + 29.942726250311168, + 29.942726250311168, + 29.942726250311168 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8079343149840805e-16, + 3.8079343149840805e-16, + -3.8079343149840805e-16, + -3.8079343149840805e-16 ], - "timestamp": 0.1916994836465226 + "timestamp": 0.19946138283405765 }, { - "x": 1.3900515280394377, + "x": 1.4036924400592825, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.8609729763629331, - "velocityY": 0, + "heading": 2.463555918927614e-19, + "angularVelocity": 1.182530338098165e-18, + "velocityX": 0.8958591312970421, + "velocityY": -2.8974550258705703e-35, "moduleForcesX": [ - 29.93980195213383, - 29.93980195213383, - 29.93980195213383, - 29.93980195213383 + 29.940972538344575, + 29.940972538344575, + 29.940972538344575, + 29.940972538344575 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8123070418893336e-16, + 3.8123070418893336e-16, + -3.8123070418893336e-16, + -3.8123070418893336e-16 ], - "timestamp": 0.2875492254697839 + "timestamp": 0.29919207425108646 }, { - "x": 1.5000791896812358, + "x": 1.522814768880177, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.1479181847431392, - "velocityY": 0, + "heading": 3.9061751387218276e-19, + "angularVelocity": 1.4465159350726166e-18, + "velocityX": 1.194440016952132, + "velocityY": -3.8524871235365484e-35, "moduleForcesX": [ - 29.936982919505784, - 29.936982919505784, - 29.936982919505784, - 29.936982919505784 + 29.938716097590557, + 29.938716097590557, + 29.938716097590557, + 29.938716097590557 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8178886042689316e-16, + 3.8178886042689316e-16, + -3.8178886042689316e-16, + -3.8178886042689316e-16 ], - "timestamp": 0.3833989672930452 + "timestamp": 0.3989227656681153 }, { - "x": 1.6376068495234364, + "x": 1.6717117804277626, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.4348255637016203, - "velocityY": 0, + "heading": 5.510781406993138e-19, + "angularVelocity": 1.6089405607192304e-18, + "velocityX": 1.4929908692820462, + "velocityY": -4.784287581117904e-35, "moduleForcesX": [ - 29.933036177343787, - 29.933036177343787, - 29.933036177343787, - 29.933036177343787 + 29.935704654991618, + 29.935704654991618, + 29.935704654991618, + 29.935704654991618 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8252758945500703e-16, + 3.8252758945500703e-16, + -3.825275894550071e-16, + -3.825275894550071e-16 ], - "timestamp": 0.47924870911630646 + "timestamp": 0.49865345708514414 }, { - "x": 1.8026290686364108, + "x": 1.850379276363555, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.7216761983273914, - "velocityY": 0, + "heading": 7.134094095528736e-19, + "angularVelocity": 1.627697556318014e-18, + "velocityX": 1.7914996218895902, + "velocityY": -5.697468195588865e-35, "moduleForcesX": [ - 29.927116043222046, - 29.927116043222046, - 29.927116043222046, - 29.927116043222046 + 29.93148331432507, + 29.93148331432507, + 29.93148331432507, + 29.93148331432507 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.83553639511066e-16, + 3.83553639511066e-16, + -3.83553639511066e-16, + -3.83553639511066e-16 ], - "timestamp": 0.5750984509395678 + "timestamp": 0.5983841485021729 }, { - "x": 1.9951367826254982, + "x": 2.0588109475855214, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.0084322641575305, - "velocityY": 0, + "heading": 8.558157292954081e-19, + "angularVelocity": 1.4279099394802959e-18, + "velocityX": 2.089945113315875, + "velocityY": -6.604219024578338e-35, "moduleForcesX": [ - 29.917249684289892, - 29.917249684289892, - 29.917249684289892, - 29.917249684289892 + 29.925140113409057, + 29.925140113409057, + 29.925140113409057, + 29.925140113409057 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.8507911969424974e-16, + 3.8507911969424974e-16, + -3.8507911969424974e-16, + -3.8507911969424974e-16 ], - "timestamp": 0.6709481927628291 + "timestamp": 0.6981148399192018 }, { - "x": 2.2151118668144223, + "x": 2.296996250720342, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.2949992353092554, - "velocityY": 0, + "heading": 9.411153977193477e-19, + "angularVelocity": 8.553010167336687e-19, + "velocityX": 2.3882848876551863, + "velocityY": -7.457737051461316e-35, "moduleForcesX": [ - 29.897521443519583, - 29.897521443519583, - 29.897521443519583, - 29.897521443519583 + 29.914539857309176, + 29.914539857309176, + 29.914539857309176, + 29.914539857309176 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.875942100573936e-16, + 3.875942100573936e-16, + -3.875942100573936e-16, + -3.875942100573936e-16 ], - "timestamp": 0.7667979345860905 + "timestamp": 0.7978455313362306 }, { - "x": 2.4625000000000052, + "x": 2.564914002502624, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.5809994735479793, - "velocityY": 0, + "heading": 8.914861579617697e-19, + "angularVelocity": -4.976324891689237e-19, + "velocityX": 2.6864122563550237, + "velocityY": -1.032724362015068e-34, "moduleForcesX": [ - 29.838394219742327, - 29.838394219742327, - 29.838394219742327, - 29.838394219742327 + 29.89324193627562, + 29.89324193627562, + 29.89324193627562, + 29.89324193627562 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 3.925485691196194e-16, + 3.925485691196194e-16, + -3.925485691196194e-16, + -3.925485691196194e-16 ], - "timestamp": 0.8626476764093518 + "timestamp": 0.8975762227532594 }, { - "x": 2.7098881331855686, + "x": 2.8625000000058085, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.5809994735479833, - "velocityY": 0, + "heading": 4.437476838988911e-19, + "angularVelocity": -4.4894778047993694e-18, + "velocityX": 2.983895862737148, + "velocityY": -1.1000360170692858e-34, "moduleForcesX": [ - 4.5071058537614364e-13, - 4.5071058537614364e-13, - 4.5071058537614364e-13, - 4.5071058537614364e-13 + 29.828691865536857, + 29.828691865536857, + 29.828691865536857, + 29.828691865536857 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + 4.069185552959855e-16, + 4.0691855529598557e-16, + -4.069185552959855e-16, + -4.0691855529598557e-16 ], - "timestamp": 0.9584974182326131 + "timestamp": 0.9973069141702883 }, { - "x": 2.929863217374646, + "x": 3.1600859975124576, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.29499923530926, - "velocityY": 0, + "heading": -2.7780968254587014e-19, + "angularVelocity": -7.235063930801634e-18, + "velocityX": 2.983895862737161, + "velocityY": 4.389962466076309e-34, "moduleForcesX": [ - -29.838394219742327, - -29.838394219742327, - -29.838394219742327, - -29.838394219742327 + 1.315475344589543e-12, + 1.3153365376998885e-12, + 1.315475344589543e-12, + 1.3153365376998885e-12 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -6.940344482674305e-17, + -6.940344482674305e-17, + 6.94034448267431e-17, + 6.94034448267431e-17 ], - "timestamp": 1.0543471600558745 + "timestamp": 1.097037605587317 }, { - "x": 3.1223709313635926, + "x": 3.4280037492383437, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 2.008432264157535, - "velocityY": 0, + "heading": -4.923590704083348e-19, + "angularVelocity": -2.151289433684519e-18, + "velocityX": 2.686412256355038, + "velocityY": 2.1382352814057525e-34, "moduleForcesX": [ - -29.897521443519587, - -29.897521443519587, - -29.897521443519587, - -29.897521443519587 + -29.828691865536854, + -29.828691865536854, + -29.828691865536854, + -29.828691865536854 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -4.368466622002329e-16, + -4.3684666220023285e-16, + 4.368466622002329e-16, + 4.3684666220023285e-16 ], - "timestamp": 1.1501969018791358 + "timestamp": 1.1967682970043458 }, { - "x": 3.287393150476552, + "x": 3.666189052409887, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.7216761983273956, - "velocityY": 0, + "heading": -5.339633713220123e-19, + "angularVelocity": -4.1716710425673114e-19, + "velocityX": 2.3882848876552, + "velocityY": 1.465626208115563e-35, "moduleForcesX": [ - -29.917249684289896, - -29.917249684289896, - -29.917249684289896, - -29.917249684289896 + -29.89324193627562, + -29.89324193627562, + -29.89324193627562, + -29.89324193627562 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -4.0766010308870794e-16, + -4.07660103088708e-16, + 4.0766010308870794e-16, + 4.07660103088708e-16 ], - "timestamp": 1.2460466437023971 + "timestamp": 1.2964989884213747 }, { - "x": 3.424920810318656, + "x": 3.8746207236253465, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.434825563701624, - "velocityY": 0, + "heading": -4.875704320945534e-19, + "angularVelocity": 4.651822247510394e-19, + "velocityX": 2.089945113315887, + "velocityY": 3.034082848899946e-35, "moduleForcesX": [ - -29.927116043222046, - -29.927116043222046, - -29.927116043222046, - -29.927116043222046 + -29.914539857309176, + -29.914539857309176, + -29.914539857309176, + -29.914539857309176 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.976806692395584e-16, + -3.976806692395584e-16, + 3.976806692395584e-16, + 3.976806692395584e-16 ], - "timestamp": 1.3418963855256585 + "timestamp": 1.3962296798384035 }, { - "x": 3.534948471960649, + "x": 4.053288219569209, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 1.1479181847431432, - "velocityY": 0, + "heading": -3.987222793761106e-19, + "angularVelocity": 8.908811570369878e-19, + "velocityX": 1.7914996218896007, + "velocityY": 4.520836242515374e-35, "moduleForcesX": [ - -29.933036177343787, - -29.933036177343787, - -29.933036177343787, - -29.933036177343787 + -29.925140113409054, + -29.925140113409054, + -29.925140113409054, + -29.925140113409054 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.9264413446048777e-16, + -3.9264413446048777e-16, + 3.9264413446048777e-16, + 3.9264413446048777e-16 ], - "timestamp": 1.4377461273489198 + "timestamp": 1.4959603712554324 }, { - "x": 3.6174725094617, + "x": 4.202185231271973, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.860972976362937, - "velocityY": 0, + "heading": -2.9403938648169577e-19, + "angularVelocity": 1.049656312088076e-18, + "velocityX": 1.4929908692820562, + "velocityY": -6.34377494002748e-35, "moduleForcesX": [ - -29.936982919505784, - -29.936982919505784, - -29.936982919505784, - -29.936982919505784 + -29.93148331432507, + -29.93148331432507, + -29.93148331432507, + -29.93148331432507 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.8960432135095593e-16, + -3.8960432135095593e-16, + 3.8960432135095593e-16, + 3.8960432135095593e-16 ], - "timestamp": 1.5335958691721812 + "timestamp": 1.5956910626724612 }, { - "x": 3.6724903329283403, + "x": 4.321307559958148, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.5740007476277722, - "velocityY": 0, + "heading": -1.909742612633779e-19, + "angularVelocity": 1.0334349795240745e-18, + "velocityX": 1.1944400169521414, + "velocityY": -5.023256964940812e-35, "moduleForcesX": [ - -29.93980195213383, - -29.93980195213383, - -29.93980195213383, - -29.93980195213383 + -29.935704654991618, + -29.935704654991618, + -29.935704654991618, + -29.935704654991618 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.875684232160756e-16, + -3.875684232160756e-16, + 3.875684232160756e-16, + 3.875684232160756e-16 ], - "timestamp": 1.6294456109954425 + "timestamp": 1.69542175408949 }, { - "x": 3.7, + "x": 4.410652210506399, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 0.2870082542576128, - "velocityY": 0, + "heading": -1.0184849690233774e-19, + "angularVelocity": 8.93664896759709e-19, + "velocityX": 0.8958591312970524, + "velocityY": -3.714887807090576e-35, "moduleForcesX": [ - -29.94191616074935, - -29.94191616074935, - -29.94191616074935, - -29.94191616074935 + -29.938716097590557, + -29.938716097590557, + -29.938716097590557, + -29.938716097590557 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.861083787357064e-16, + -3.861083787357064e-16, + 3.861083787357064e-16, + 3.861083787357064e-16 ], - "timestamp": 1.7252953528187038 + "timestamp": 1.7951524455065189 }, { - "x": 3.7, + "x": 4.470216938649993, "y": 7.915, - "heading": 0, - "angularVelocity": 0, - "velocityX": 5.636961914080804e-17, - "velocityY": 0, + "heading": -3.5829088636627997e-20, + "angularVelocity": 6.619772513811735e-19, + "velocityX": 0.5972557420023403, + "velocityY": -2.4584544278339557e-35, "moduleForcesX": [ - -29.943560493551256, - -29.943560493551256, - -29.943560493551256, - -29.943560493551256 + -29.940972538344575, + -29.940972538344575, + -29.940972538344575, + -29.940972538344575 ], "moduleForcesY": [ - 0, - 0, - 0, - 0 + -3.8500926775426836e-16, + -3.8500926775426836e-16, + 3.8500926775426836e-16, + 3.8500926775426836e-16 + ], + "timestamp": 1.8948831369235477 + }, + { + "x": 4.499999999999966, + "y": 7.915, + "heading": -2.735635807996967e-28, + "angularVelocity": 3.5925862288720407e-19, + "velocityX": 0.29863486281687684, + "velocityY": -1.2194070080115564e-35, + "moduleForcesX": [ + -29.942726250311168, + -29.942726250311168, + -29.942726250311168, + -29.942726250311168 ], - "timestamp": 1.8211450946419652 + "moduleForcesY": [ + -3.841512849965487e-16, + -3.841512849965487e-16, + 3.841512849965487e-16, + 3.841512849965487e-16 + ], + "timestamp": 1.9946138283405765 + }, + { + "x": 4.499999999999983, + "y": 7.915, + "heading": -1.333908710952396e-28, + "angularVelocity": 6.800156366469428e-29, + "velocityX": 4.008827675901694e-16, + "velocityY": -8.329786019881148e-45, + "moduleForcesX": [ + -29.94412838953491, + -29.94412838953491, + -29.94412838953491, + -29.94412838953491 + ], + "moduleForcesY": [ + -3.834623352843727e-16, + -3.834623352843727e-16, + 3.834623352843727e-16, + 3.834623352843727e-16 + ], + "timestamp": 2.0943445197576054 } ], "trajectoryWaypoints": [ @@ -17471,12 +17513,12 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 19 + "controlIntervalCount": 21 }, { - "timestamp": 1.8211450946419652, + "timestamp": 2.0943445197576054, "isStopPoint": true, - "x": 3.7, + "x": 4.5, "y": 7.915, "heading": 0, "isInitialGuess": false, @@ -17509,13 +17551,13 @@ "ScoreAltStack1": { "waypoints": [ { - "x": 3.7, + "x": 4.5, "y": 7.915, "heading": 0, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 18 + "controlIntervalCount": 21 }, { "x": 1.3, @@ -17529,12 +17571,12 @@ ], "trajectory": [ { - "x": 3.7, - "y": 7.915, - "heading": -8.857685423615453e-28, - "angularVelocity": -6.899974613937114e-28, - "velocityX": -2.113567356761841e-16, - "velocityY": -2.7741436758646538e-17, + "x": 4.499999999999995, + "y": 7.914999999999999, + "heading": -4.638339058629045e-28, + "angularVelocity": -4.6962216121188425e-28, + "velocityX": 2.6224481276471926e-16, + "velocityY": 2.581223045696416e-17, "moduleForcesX": [ 0, 0, @@ -17550,398 +17592,461 @@ "timestamp": 0 }, { - "x": 3.6703592062351653, - "y": 7.911109645818366, - "heading": 7.616414564532622e-19, - "angularVelocity": 7.622660792084474e-18, - "velocityX": -0.2966508230953476, - "velocityY": -0.038935420531261214, + "x": 4.470898934241406, + "y": 7.912135363839381, + "heading": 2.496430291884428e-19, + "angularVelocity": 2.5262310074100717e-18, + "velocityX": -0.29448450280018673, + "velocityY": -0.028988318244463337, "moduleForcesX": [ - -29.689390756976636, - -29.689390756976636, - -29.689390756976636, - -29.689390756976636 + -29.799981591357007, + -29.799981591357007, + -29.799981591357007, + -29.799981591357007 ], "moduleForcesY": [ - -3.896732536852825, - -3.896732536852825, - -3.896732536852825, - -3.8967325368528245 + -2.9334356879062806, + -2.9334356879062806, + -2.9334356879062806, + -2.9334356879062806 ], - "timestamp": 0.09991812412844604 + "timestamp": 0.09882036399834276 }, { - "x": 3.6110792939397647, - "y": 7.903329157329628, - "heading": 1.3924771036973263e-18, - "angularVelocity": 6.313530326074628e-18, - "velocityX": -0.5932848801182579, - "velocityY": -0.07786864051551397, + "x": 4.412698176655327, + "y": 7.906406226764488, + "heading": 4.891365769160474e-19, + "angularVelocity": 2.4235257989579454e-18, + "velocityX": -0.5889551022808781, + "velocityY": -0.05797526788091311, "moduleForcesX": [ - -29.68771277587098, - -29.68771277587098, - -29.68771277587098, - -29.68771277587098 + -29.798574662769983, + -29.798574662769983, + -29.798574662769983, + -29.798574662769983 ], "moduleForcesY": [ - -3.896512301832707, - -3.896512301832707, - -3.8965123018327064, - -3.8965123018327064 + -2.9332971933734906, + -2.933297193373491, + -2.9332971933734906, + -2.9332971933734906 ], - "timestamp": 0.19983624825689209 + "timestamp": 0.19764072799668553 }, { - "x": 3.522162453880418, - "y": 7.891658822071787, - "heading": 3.0562730144599226e-18, - "angularVelocity": 1.6651604268245938e-17, - "velocityX": -0.8898970115352512, - "velocityY": -0.11679898276399112, + "x": 4.325399445343049, + "y": 7.897812757900665, + "heading": 3.655634140040506e-18, + "angularVelocity": 3.204296968181486e-17, + "velocityX": -0.8834083156564232, + "velocityY": -0.08696050607263796, "moduleForcesX": [ - -29.685518418630103, - -29.685518418630103, - -29.685518418630103, - -29.685518418630103 + -29.796815298157618, + -29.796815298157618, + -29.796815298157618, + -29.796815298157618 ], "moduleForcesY": [ - -3.896224292444841, - -3.896224292444841, - -3.8962242924448405, - -3.8962242924448405 + -2.9331240059194625, + -2.933124005919462, + -2.933124005919462, + -2.9331240059194617 ], - "timestamp": 0.29975437238533814 + "timestamp": 0.2964610919950283 }, { - "x": 3.4036116735643516, - "y": 7.87609903215534, - "heading": 4.284984789615624e-18, - "angularVelocity": 1.2297193424363515e-17, - "velocityX": -1.1864792433767892, - "velocityY": -0.15572540069318988, + "x": 4.209004950391425, + "y": 7.886355174803512, + "heading": 3.9790958580592245e-18, + "angularVelocity": 3.273228142849478e-18, + "velocityX": -1.1778391643743693, + "velocityY": -0.11594354274337776, "moduleForcesX": [ - -29.68252601102455, - -29.68252601102455, - -29.68252601102455, - -29.68252601102455 + -29.794552135311253, + -29.794552135311253, + -29.794552135311253, + -29.794552135311253 ], "moduleForcesY": [ - -3.8958315389466107, - -3.8958315389466107, - -3.8958315389466103, - -3.8958315389466103 + -2.9329012258267713, + -2.9329012258267713, + -2.932901225826771, + -2.932901225826771 ], - "timestamp": 0.39967249651378417 + "timestamp": 0.39528145599337106 }, { - "x": 3.2554312684038718, - "y": 7.856650353978022, - "heading": 4.88713080927974e-18, - "angularVelocity": 6.026395683160927e-18, - "velocityX": -1.483018285749852, - "velocityY": -0.1946461500046506, + "x": 4.063517640413706, + "y": 7.872033767729362, + "heading": 4.407813999535086e-18, + "angularVelocity": 4.338355520630196e-18, + "velocityX": -1.4722401747721297, + "velocityY": -0.14492364220448076, "moduleForcesX": [ - -29.678203525103136, - -29.678203525103136, - -29.678203525103136, - -29.678203525103136 + -29.791532684768715, + -29.791532684768715, + -29.791532684768715, + -29.791532684768715 ], "moduleForcesY": [ - -3.8952642126694257, - -3.8952642126694257, - -3.8952642126694252, - -3.8952642126694252 + -2.9326039986639896, + -2.9326039986639896, + -2.9326039986639896, + -2.932603998663989 ], - "timestamp": 0.4995906206422302 + "timestamp": 0.4941018199917138 }, { - "x": 3.0776280197895494, - "y": 7.833313677597383, - "heading": 4.452250502602634e-18, - "angularVelocity": -4.35237203301742e-18, - "velocityX": -1.7794894586497152, - "velocityY": -0.23355799144775333, + "x": 3.8889416469282945, + "y": 7.854848943371605, + "heading": 5.0219613363697e-18, + "angularVelocity": 6.214784160541381e-18, + "velocityX": -1.7665993770490904, + "velocityY": -0.1738996261786864, "moduleForcesX": [ - -29.671411016355503, - -29.671411016355503, - -29.671411016355503, - -29.671411016355503 + -29.787301965598665, + -29.787301965598665, + -29.787301965598665, + -29.787301965598665 ], "moduleForcesY": [ - -3.894372695896298, - -3.894372695896298, - -3.8943726958962976, - -3.8943726958962976 + -2.9321875372456865, + -2.9321875372456865, + -2.9321875372456865, + -2.9321875372456865 ], - "timestamp": 0.5995087447706763 + "timestamp": 0.5929221839900566 }, { - "x": 2.8702141334228277, - "y": 7.80609060501178, - "heading": 4.0844435739069476e-18, - "angularVelocity": -3.6810809222487295e-18, - "velocityX": -2.0758384745095704, - "velocityY": -0.27245379977935613, + "x": 3.6852831742101206, + "y": 7.83480131246111, + "heading": 5.322867972117647e-18, + "angularVelocity": 3.0449854941810913e-18, + "velocityX": -2.060895796134092, + "velocityY": -0.20286942993243606, "moduleForcesX": [ - -29.659185302439916, - -29.659185302439916, - -29.659185302439916, - -29.659185302439916 + -29.780948701005272, + -29.780948701005272, + -29.780948701005272, + -29.780948701005272 ], "moduleForcesY": [ - -3.892768070944876, - -3.892768070944876, - -3.8927680709448755, - -3.8927680709448755 + -2.9315621377622727, + -2.9315621377622727, + -2.9315621377622723, + -2.9315621377622723 ], - "timestamp": 0.6994268688991223 + "timestamp": 0.6917425479883994 }, { - "x": 2.6332180803157414, - "y": 7.774984873041552, - "heading": 2.6832322245167815e-18, - "angularVelocity": -1.402360617948463e-17, - "velocityX": -2.3719025469505195, - "velocityY": -0.3113122092872268, + "x": 3.4525525798402876, + "y": 7.811891894578838, + "heading": 4.890981808967791e-18, + "angularVelocity": -4.370418601700563e-18, + "velocityX": -2.355087402545218, + "velocityY": -0.2318289161886001, "moduleForcesX": [ - -29.63066761140782, - -29.63066761140782, - -29.63066761140782, - -29.63066761140782 + -29.770342316892076, + -29.770342316892076, + -29.770342316892076, + -29.770342316892076 ], "moduleForcesY": [ - -3.8890251239969107, - -3.8890251239969107, - -3.8890251239969107, - -3.8890251239969107 + -2.930518071826127, + -2.9305180718261266, + -2.9305180718261266, + -2.9305180718261266 ], - "timestamp": 0.7993449930275683 + "timestamp": 0.7905629119867421 }, { - "x": 2.3667819196836817, - "y": 7.740015126958444, - "heading": 1.2523360861115753e-18, - "angularVelocity": -1.432069097101314e-17, - "velocityX": -2.666544863157521, - "velocityY": -0.3499840132893921, + "x": 3.1907706355776666, + "y": 7.7861227344399415, + "heading": 4.74737406551849e-18, + "angularVelocity": -1.4532281737363371e-18, + "velocityX": -2.6490688120600145, + "velocityY": -0.2607677111877834, "moduleForcesX": [ - -29.48837548349919, - -29.48837548349919, - -29.48837548349919, - -29.48837548349919 + -29.74907171155665, + -29.74907171155665, + -29.74907171155665, + -29.74907171155665 ], "moduleForcesY": [ - -3.8703492822088994, - -3.8703492822088994, - -3.8703492822088994, - -3.8703492822088994 + -2.9284242466134156, + -2.9284242466134156, + -2.9284242466134156, + -2.9284242466134156 ], - "timestamp": 0.8992631171560144 + "timestamp": 0.8893832759850848 }, { - "x": 2.129785866576617, - "y": 7.708909394988331, - "heading": 5.829284819779899e-19, - "angularVelocity": -6.699569626494213e-18, - "velocityX": -2.371902546950514, - "velocityY": -0.31131220928722614, + "x": 2.9000000000085278, + "y": 7.7575000000011185, + "heading": 4.849177353452629e-18, + "angularVelocity": 1.030183522414544e-18, + "velocityX": -2.942416156030418, + "velocityY": -0.28964409035993643, "moduleForcesX": [ - 29.48837548349971, - 29.48837548349971, - 29.48837548349971, - 29.48837548349971 + -29.684908261798405, + -29.684908261798405, + -29.684908261798405, + -29.684908261798405 ], "moduleForcesY": [ - 3.87034928220899, - 3.87034928220899, - 3.870349282208988, - 3.8703492822089878 + -2.9221081570278518, + -2.9221081570278518, + -2.9221081570278513, + -2.9221081570278513 ], - "timestamp": 0.9991812412844604 + "timestamp": 0.9882036399834275 }, { - "x": 1.9223719802105972, - "y": 7.681686322402585, - "heading": 6.437037611704664e-19, - "angularVelocity": 6.082528675476605e-19, - "velocityX": -2.0758384745095655, - "velocityY": -0.2724537997793555, + "x": 2.609229364411349, + "y": 7.728877265560418, + "heading": 2.265542225441438e-18, + "angularVelocity": -2.61447688749586e-17, + "velocityX": -2.94241615603042, + "velocityY": -0.28964409035993643, "moduleForcesX": [ - 29.63066761140773, - 29.63066761140773, - 29.63066761140773, - 29.63066761140773 + -1.7199540695637513e-13, + -1.7338192867140007e-13, + -1.7199540695637513e-13, + -1.7338192867140007e-13 ], "moduleForcesY": [ - 3.8890251239969085, - 3.8890251239969085, - 3.8890251239969076, - 3.8890251239969076 + -4.329225362489891e-15, + -4.329225362489891e-15, + -2.9427036475263487e-15, + -2.9427036475263487e-15 ], - "timestamp": 1.0990993654129064 + "timestamp": 1.0870240039817702 }, { - "x": 1.744568731595447, - "y": 7.658349646021965, - "heading": 9.15686449036186e-19, - "angularVelocity": 2.7220549588614654e-18, - "velocityX": -1.7794894586497105, - "velocityY": -0.23355799144775258, + "x": 2.3474474201316267, + "y": 7.70310810542016, + "heading": 4.5901616609339586e-20, + "angularVelocity": -2.2461371867793742e-17, + "velocityX": -2.649068812060015, + "velocityY": -0.2607677111877836, "moduleForcesX": [ - 29.659185302439884, - 29.659185302439884, - 29.659185302439884, - 29.659185302439884 + 29.684908261798398, + 29.684908261798398, + 29.684908261798398, + 29.684908261798398 ], "moduleForcesY": [ - 3.8927680709448764, - 3.8927680709448764, - 3.892768070944876, - 3.892768070944876 + 2.9221081570278504, + 2.92210815702785, + 2.9221081570278504, + 2.92210815702785 ], - "timestamp": 1.1990174895413526 + "timestamp": 1.185844367980113 }, { - "x": 1.5963883264356444, - "y": 7.638900967844622, - "heading": 1.784973792378466e-18, - "angularVelocity": 8.700000837342484e-18, - "velocityX": -1.4830182857498488, - "velocityY": -0.19464615000464972, + "x": 2.114716825803177, + "y": 7.680198687539856, + "heading": -1.9291784515592082e-19, + "angularVelocity": -2.416699618207275e-18, + "velocityX": -2.3550874025452173, + "velocityY": -0.23182891618860033, "moduleForcesX": [ - 29.67141101635549, - 29.67141101635549, - 29.67141101635549, - 29.67141101635549 + 29.749071711556653, + 29.749071711556653, + 29.749071711556653, + 29.749071711556653 ], "moduleForcesY": [ - 3.894372695896298, - 3.894372695896298, - 3.8943726958962976, - 3.8943726958962976 + 2.928424246613416, + 2.928424246613416, + 2.928424246613416, + 2.928424246613416 ], - "timestamp": 1.2989356136697987 + "timestamp": 1.2846647319784557 }, { - "x": 1.4778375461205624, - "y": 7.623341177928205, - "heading": 2.7560148106955593e-18, - "angularVelocity": 9.71837343672516e-18, - "velocityX": -1.1864792433767861, - "velocityY": -0.155725400693189, + "x": 1.911058353078909, + "y": 7.660151056632104, + "heading": -3.377731085102079e-19, + "angularVelocity": -1.4658416636877928e-18, + "velocityX": -2.0608957961340906, + "velocityY": -0.20286942993243623, "moduleForcesX": [ - 29.678203525103125, - 29.678203525103125, - 29.678203525103125, - 29.678203525103125 + 29.770342316892076, + 29.770342316892076, + 29.770342316892076, + 29.770342316892076 ], "moduleForcesY": [ - 3.8952642126694266, - 3.8952642126694266, - 3.895264212669426, - 3.895264212669426 + 2.930518071826126, + 2.930518071826126, + 2.930518071826126, + 2.930518071826126 ], - "timestamp": 1.3988537377982448 + "timestamp": 1.3834850959767984 }, { - "x": 1.388920706059698, - "y": 7.6116708426704, - "heading": 1.9252422657120355e-18, - "angularVelocity": -8.314537158425022e-18, - "velocityX": -0.8898970115352483, - "velocityY": -0.11679898276399021, + "x": 1.7364823595714767, + "y": 7.6429662322704175, + "heading": -1.6792972151820533e-19, + "angularVelocity": 1.7187116258215607e-18, + "velocityX": -1.766599377049088, + "velocityY": -0.17389962617868657, "moduleForcesX": [ - 29.682526011024542, - 29.682526011024542, - 29.682526011024542, - 29.682526011024542 + 29.780948701005272, + 29.780948701005272, + 29.780948701005272, + 29.780948701005272 ], "moduleForcesY": [ - 3.8958315389466116, - 3.8958315389466116, - 3.895831538946611, - 3.8958315389466107 + 2.931562137762272, + 2.931562137762272, + 2.9315621377622714, + 2.9315621377622714 ], - "timestamp": 1.498771861926691 + "timestamp": 1.482305459975141 }, { - "x": 1.3296407937654542, - "y": 7.603890354181709, - "heading": 5.384929038425166e-19, - "angularVelocity": -1.3878863788738055e-17, - "velocityX": -0.5932848801182574, - "velocityY": -0.07786864051551337, + "x": 1.5909950496159164, + "y": 7.628644825195066, + "heading": -1.8114858810608142e-19, + "angularVelocity": -1.337648175981526e-19, + "velocityX": -1.4722401747721263, + "velocityY": -0.14492364220448103, "moduleForcesX": [ - 29.6855184186301, - 29.6855184186301, - 29.6855184186301, - 29.6855184186301 + 29.78730196559866, + 29.78730196559866, + 29.78730196559866, + 29.78730196559866 ], "moduleForcesY": [ - 3.8962242924448414, - 3.8962242924448414, - 3.896224292444841, - 3.8962242924448405 + 2.9321875372456865, + 2.9321875372456865, + 2.932187537245686, + 2.932187537245686 ], - "timestamp": 1.5986899860551371 + "timestamp": 1.5811258239734838 }, { - "x": 1.2999999999999998, - "y": 7.6, - "heading": 1.856919521594944e-27, - "angularVelocity": -5.3893457370246385e-18, - "velocityX": -0.2966508230953496, - "velocityY": -0.038935420531260624, + "x": 1.4746005546489325, + "y": 7.617187242098636, + "heading": 1.1492887553656064e-19, + "angularVelocity": 2.99612188531174e-18, + "velocityX": -1.177839164374366, + "velocityY": -0.11594354274337797, "moduleForcesX": [ - 29.687712775870978, - 29.687712775870978, - 29.687712775870978, - 29.687712775870978 + 29.79153268476871, + 29.79153268476871, + 29.79153268476871, + 29.79153268476871 ], "moduleForcesY": [ - 3.896512301832707, - 3.8965123018327064, - 3.896512301832706, - 3.896512301832706 + 2.9326039986639896, + 2.9326039986639896, + 2.932603998663989, + 2.932603998663989 ], - "timestamp": 1.6986081101835833 + "timestamp": 1.6799461879718265 }, { - "x": 1.2999999999999998, - "y": 7.6, - "heading": 8.8348251998797e-28, - "angularVelocity": -9.002826196705125e-28, - "velocityX": -2.1138841235156355e-16, - "velocityY": -2.7745693838680483e-17, + "x": 1.3873018233478802, + "y": 7.608593773234277, + "heading": 3.655540340618568e-19, + "angularVelocity": 2.536173196431411e-18, + "velocityX": -0.88340831565642, + "velocityY": -0.08696050607263801, + "moduleForcesX": [ + 29.794552135311253, + 29.794552135311253, + 29.794552135311253, + 29.794552135311253 + ], + "moduleForcesY": [ + 2.932901225826772, + 2.9329012258267717, + 2.9329012258267717, + 2.9329012258267717 + ], + "timestamp": 1.7787665519701692 + }, + { + "x": 1.3291010657585993, + "y": 7.602864636160619, + "heading": 3.0467259837923257e-19, + "angularVelocity": -6.160799067151849e-19, + "velocityX": -0.5889551022808759, + "velocityY": -0.05797526788091317, + "moduleForcesX": [ + 29.796815298157618, + 29.796815298157618, + 29.796815298157618, + 29.796815298157618 + ], + "moduleForcesY": [ + 2.933124005919461, + 2.933124005919461, + 2.933124005919461, + 2.933124005919461 + ], + "timestamp": 1.877586915968512 + }, + { + "x": 1.3000000000000107, + "y": 7.6000000000000005, + "heading": 9.917870531529092e-28, + "angularVelocity": -3.0830964027267292e-18, + "velocityX": -0.2944845028001849, + "velocityY": -0.028988318244463407, "moduleForcesX": [ - 29.689390756976636, - 29.689390756976636, - 29.689390756976636, - 29.689390756976636 + 29.798574662769983, + 29.798574662769983, + 29.798574662769983, + 29.798574662769983 ], "moduleForcesY": [ - 3.896732536852825, - 3.8967325368528245, - 3.896732536852824, - 3.896732536852824 + 2.933297193373492, + 2.933297193373492, + 2.933297193373492, + 2.933297193373492 ], - "timestamp": 1.7985262343120294 + "timestamp": 1.9764072799668546 + }, + { + "x": 1.3000000000000054, + "y": 7.6000000000000005, + "heading": 4.701482456046991e-28, + "angularVelocity": -5.210521550023728e-28, + "velocityX": -2.6451906839746297e-16, + "velocityY": -2.6041349607583192e-17, + "moduleForcesX": [ + 29.799981591357007, + 29.799981591357007, + 29.799981591357007, + 29.799981591357007 + ], + "moduleForcesY": [ + 2.9334356879062784, + 2.9334356879062784, + 2.9334356879062784, + 2.9334356879062784 + ], + "timestamp": 2.0752276439651975 } ], "trajectoryWaypoints": [ { "timestamp": 0, "isStopPoint": true, - "x": 3.7, + "x": 4.5, "y": 7.915, "heading": 0, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 18 + "controlIntervalCount": 21 }, { - "timestamp": 1.7985262343120294, + "timestamp": 2.0752276439651975, "isStopPoint": true, "x": 1.3, "y": 7.6, @@ -20058,19 +20163,19 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 18 }, { - "x": 2.9672133922576904, + "x": 3.5, "y": 7.685123920440674, "heading": 0, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 13 + "controlIntervalCount": 12 }, { - "x": 4.1, + "x": 4.5, "y": 7.7, "heading": 0, "isInitialGuess": false, @@ -20083,10 +20188,10 @@ { "x": 1.25, "y": 7.85, - "heading": -5.042419579190194e-28, - "angularVelocity": -4.765891770216821e-28, - "velocityX": 4.0908119604167003e-17, - "velocityY": 1.0212967772619285e-16, + "heading": -9.510438227191655e-28, + "angularVelocity": -9.112042864532664e-28, + "velocityX": 2.030641276522843e-17, + "velocityY": -5.4400794333658375e-17, "moduleForcesX": [ 0, 0, @@ -20102,613 +20207,634 @@ "timestamp": 0 }, { - "x": 1.262850033482311, - "y": 7.848420800951572, - "heading": 4.897373376403742e-20, - "angularVelocity": 7.4471414220086765e-19, - "velocityX": 0.1954028704749021, - "velocityY": -0.024013947320761456, + "x": 1.2640480832016254, + "y": 7.848653117376031, + "heading": -1.121450453095151e-19, + "angularVelocity": -1.6333933250978822e-18, + "velocityX": 0.20461042737661647, + "velocityY": -0.019617354578624183, "moduleForcesX": [ - 29.713760545753452, - 29.713760545753452, - 29.713760545753452, - 29.713760545753452 + 29.801522663531106, + 29.801522663531106, + 29.801522663531106, + 29.801522663531106 ], "moduleForcesY": [ - -3.6516591527726097, - -3.65165915277261, - -3.6516591527726097, - -3.651659152772609 + -2.8572690286077913, + -2.8572690286077913, + -2.857269028607792, + -2.857269028607792 ], - "timestamp": 0.06576174367899924 + "timestamp": 0.06865770909987891 }, { - "x": 1.2885510441658452, - "y": 7.8452753640913135, - "heading": -2.191109078187436e-19, - "angularVelocity": -4.076604004180981e-18, - "velocityX": 0.3908200915329965, - "velocityY": -0.047830800716292234, + "x": 1.2921437043867348, + "y": 7.845960690499111, + "heading": -1.3546118188505236e-19, + "angularVelocity": -3.3959964719798475e-19, + "velocityX": 0.40921291365188467, + "velocityY": -0.03921521577469119, "moduleForcesX": [ - 29.715942754190923, - 29.715942754190923, - 29.715942754190923, - 29.715942754190923 + 29.800366041579718, + 29.800366041579718, + 29.800366041579718, + 29.800366041579718 ], "moduleForcesY": [ - -3.621688243516662, - -3.621688243516662, - -3.621688243516662, - -3.621688243516662 + -2.8544298161129453, + -2.8544298161129453, + -2.8544298161129467, + -2.8544298161129467 ], - "timestamp": 0.1315234873579985 + "timestamp": 0.13731541819975782 }, { - "x": 1.3271041147011384, - "y": 7.84057878392152, - "heading": 3.795271134514633e-19, - "angularVelocity": 9.103135085205585e-18, - "velocityX": 0.5862537757981506, - "velocityY": -0.07141812115272106, + "x": 1.3342862275889278, + "y": 7.84192428021855, + "heading": -7.789555696099368e-19, + "angularVelocity": -9.372500208291995e-18, + "velocityX": 0.6138061370592178, + "velocityY": -0.058790343187582056, "moduleForcesX": [ - 29.71844621686372, - 29.71844621686372, - 29.71844621686372, - 29.71844621686372 + 29.799016904235025, + 29.799016904235025, + 29.799016904235025, + 29.799016904235025 ], "moduleForcesY": [ - -3.5867845219511554, - -3.5867845219511554, - -3.586784521951155, - -3.586784521951155 + -2.8511186390471694, + -2.85111863904717, + -2.8511186390471694, + -2.85111863904717 ], - "timestamp": 0.19728523103699774 + "timestamp": 0.20597312729963674 }, { - "x": 1.378510499208546, - "y": 7.834348861707045, - "heading": 6.285184730422139e-19, - "angularVelocity": 3.786264882765975e-18, - "velocityX": 0.781706530752559, - "velocityY": -0.09473474798376291, + "x": 1.3904749013791047, + "y": 7.83654573033852, + "heading": 9.894224895413843e-19, + "angularVelocity": 2.5756438754452687e-17, + "velocityX": 0.8183884159024585, + "velocityY": -0.0783386155840313, "moduleForcesX": [ - 29.721346183955035, - 29.721346183955035, - 29.721346183955035, - 29.721346183955035 + 29.797422827730635, + 29.797422827730635, + 29.797422827730635, + 29.797422827730635 ], "moduleForcesY": [ - -3.5456217439824975, - -3.5456217439824975, - -3.545621743982497, - -3.545621743982497 + -2.8472072040759646, + -2.8472072040759646, + -2.8472072040759646, + -2.847207204075965 ], - "timestamp": 0.263046974715997 + "timestamp": 0.27463083639951563 }, { - "x": 1.4427716665549928, - "y": 7.826606904829184, - "heading": 5.067226283497897e-19, - "angularVelocity": -1.8520767698243424e-18, - "velocityX": 0.9771816219034107, - "velocityY": -0.11772736605871548, + "x": 1.4607088242889112, + "y": 7.829827252189452, + "heading": 2.4721119424605503e-18, + "angularVelocity": 2.1595382176529026e-17, + "velocityX": 1.0229575648700016, + "velocityY": -0.0978546799373951, "moduleForcesX": [ - 29.72474271744, - 29.72474271744, - 29.72474271744, - 29.72474271744 + 29.79551046044229, + 29.79551046044229, + 29.79551046044229, + 29.79551046044229 ], "moduleForcesY": [ - -3.4963516459035304, - -3.4963516459035304, - -3.49635164590353, - -3.49635164590353 + -2.8425161004100796, + -2.8425161004100796, + -2.8425161004100805, + -2.8425161004100805 ], - "timestamp": 0.3288087183949962 + "timestamp": 0.3432885454993945 }, { - "x": 1.5198893589551528, - "y": 7.817378874976692, - "heading": -1.162732145436115e-20, - "angularVelocity": -7.882240530921134e-18, - "velocityX": 1.172683205812159, - "velocityY": -0.14032520035588117, + "x": 1.5449868949041814, + "y": 7.821771546621253, + "heading": 6.189965151949987e-18, + "angularVelocity": 5.415055755260137e-17, + "velocityX": 1.2275106717128321, + "velocityY": -0.11733140638864904, "moduleForcesX": [ - 29.728771314678447, - 29.728771314678447, - 29.728771314678447, - 29.728771314678447 + 29.793173923886805, + 29.793173923886805, + 29.793173923886805, + 29.793173923886805 ], "moduleForcesY": [ - -3.4363192082424168, - -3.4363192082424168, - -3.436319208242416, - -3.4363192082424163 + -2.8367865322922747, + -2.8367865322922747, + -2.836786532292275, + -2.836786532292275 ], - "timestamp": 0.39457046207399543 + "timestamp": 0.4119462545992734 }, { - "x": 1.609865672804627, - "y": 7.8066970987317665, - "heading": -2.191402666064841e-19, - "angularVelocity": -3.1555265819220572e-18, - "velocityX": 1.3682166685073873, - "velocityY": -0.1624314631185448, + "x": 1.6433077370622162, + "y": 7.812381986682936, + "heading": 9.622702822557616e-18, + "angularVelocity": 4.999784772331271e-17, + "velocityX": 1.4320437347314487, + "velocityY": -0.13675900436326435, "moduleForcesX": [ - 29.733618933475498, - 29.733618933475498, - 29.733618933475498, - 29.733618933475498 + 29.790254539526853, + 29.790254539526853, + 29.790254539526853, + 29.790254539526853 ], "moduleForcesY": [ - -3.36156882800544, - -3.3615688280054403, - -3.36156882800544, - -3.36156882800544 + -2.829630966328549, + -2.829630966328549, + -2.82963096632855, + -2.82963096632855 ], - "timestamp": 0.46033220575299466 + "timestamp": 0.4806039636991523 }, { - "x": 1.7127031722068122, - "y": 7.794602932942712, - "heading": -7.314558200489186e-19, - "angularVelocity": -7.790479769235267e-18, - "velocityX": 1.5637891218968967, - "velocityY": -0.18390883691940063, + "x": 1.7556695824424235, + "y": 7.8016629040639245, + "heading": 1.2787142047031391e-17, + "angularVelocity": 4.609007855083181e-17, + "velocityX": 1.636551042169287, + "velocityY": -0.15612351125111126, "moduleForcesX": [ - 29.739548018092375, - 29.739548018092375, - 29.739548018092375, - 29.739548018092375 + 29.786503237434776, + 29.786503237434776, + 29.786503237434776, + 29.786503237434776 ], "moduleForcesY": [ - -3.2659373975371992, - -3.2659373975371992, - -3.265937397537199, - -3.2659373975371992 + -2.82044174524982, + -2.82044174524982, + -2.82044174524982, + -2.82044174524982 ], - "timestamp": 0.526093949431994 + "timestamp": 0.5492616727990313 }, { - "x": 1.8284050497786541, - "y": 7.781151157925, - "heading": -1.57611444295976e-18, - "angularVelocity": -1.284422438239318e-17, - "velocityX": 1.7594101235628865, - "velocityY": -0.20455319855179577, + "x": 1.8820700751843558, + "y": 7.789620065130796, + "heading": 1.8484542588024938e-17, + "angularVelocity": 8.298267778479734e-17, + "velocityX": 1.841024036472068, + "velocityY": -0.17540403096238666, "moduleForcesX": [ - 29.74693046779095, - 29.74693046779095, - 29.74693046779095, - 29.74693046779095 + 29.781505526979927, + 29.781505526979927, + 29.781505526979927, + 29.781505526979927 ], "moduleForcesY": [ - -3.139266156499061, - -3.139266156499061, - -3.1392661564990605, - -3.1392661564990605 + -2.8082090072699204, + -2.8082090072699204, + -2.808209007269921, + -2.808209007269921 ], - "timestamp": 0.5918556931109932 + "timestamp": 0.6179193818989102 }, { - "x": 1.9569753502684142, - "y": 7.766417768168256, - "heading": -2.525887916260645e-18, - "angularVelocity": -1.4442643818200287e-17, - "velocityX": 1.955092631308721, - "velocityY": -0.22404195715977315, + "x": 2.022505920926726, + "y": 7.776261524431083, + "heading": 2.414058993971997e-17, + "angularVelocity": 8.238036830833205e-17, + "velocityX": 2.045449048383157, + "velocityY": -0.19456723614940916, "moduleForcesX": [ - 29.75628333412366, - 29.75628333412366, - 29.75628333412366, - 29.75628333412366 + 29.774516888366673, + 29.774516888366673, + 29.774516888366673, + 29.774516888366673 ], "moduleForcesY": [ - -2.96354042908121, - -2.9635404290812106, - -2.96354042908121, - -2.9635404290812106 + -2.7911221388337615, + -2.7911221388337615, + -2.7911221388337615, + -2.791122138833762 ], - "timestamp": 0.6576174367899924 + "timestamp": 0.686577090998789 }, { - "x": 2.098419240523649, - "y": 7.7505152252297, - "heading": -2.4026915340796807e-18, - "angularVelocity": 1.8733740798056096e-18, - "velocityX": 2.1508537082924852, - "velocityY": -0.24182057902327952, + "x": 2.176972187057768, + "y": 7.761599321980379, + "heading": 2.952758509590821e-17, + "angularVelocity": 7.846162113480829e-17, + "velocityX": 2.249802216766555, + "velocityY": -0.21355507841671462, "moduleForcesX": [ - 29.768230894138874, - 29.768230894138874, - 29.768230894138874, - 29.768230894138874 + 29.76405287367224, + 29.76405287367224, + 29.76405287367224, + 29.76405287367224 ], "moduleForcesY": [ - -2.7034900336982504, - -2.7034900336982504, - -2.70349003369825, - -2.70349003369825 + -2.765580517650034, + -2.7655805176500334, + -2.7655805176500343, + -2.7655805176500334 ], - "timestamp": 0.7233791804689916 + "timestamp": 0.755234800098668 }, { - "x": 2.2527430512539843, - "y": 7.73362689309203, - "heading": -2.6116047950155244e-18, - "angularVelocity": -3.1768209778600352e-18, - "velocityX": 2.346711052601558, - "velocityY": -0.2568108932842428, + "x": 2.345460678031868, + "y": 7.745653408147962, + "heading": 3.423073707449936e-17, + "angularVelocity": 6.850144057835636e-17, + "velocityX": 2.4540360169667514, + "velocityY": -0.23225234342153356, "moduleForcesX": [ - 29.782869697784346, - 29.782869697784346, - 29.782869697784346, - 29.782869697784346 + 29.74666688967039, + 29.74666688967039, + 29.74666688967039, + 29.74666688967039 ], "moduleForcesY": [ - -2.2794885631521082, - -2.2794885631521082, - -2.279488563152108, - -2.279488563152108 + -2.7232579196061613, + -2.7232579196061613, + -2.7232579196061604, + -2.7232579196061604 ], - "timestamp": 0.7891409241479909 + "timestamp": 0.8238925091985468 }, { - "x": 2.4199516704661956, - "y": 7.71610443577177, - "heading": -2.831672952395275e-18, - "angularVelocity": -3.346447077206314e-18, - "velocityX": 2.5426427259763447, - "velocityY": -0.26645366049962665, + "x": 2.5279551059495247, + "y": 7.7284632275019565, + "heading": 3.835164630367467e-17, + "angularVelocity": 6.002107054607537e-17, + "velocityX": 2.6580325838263668, + "velocityY": -0.25037509802600766, "moduleForcesX": [ - 29.794172479851817, - 29.794172479851817, - 29.794172479851817, - 29.794172479851817 + 29.712113837479873, + 29.712113837479873, + 29.712113837479873, + 29.712113837479873 ], "moduleForcesY": [ - -1.4663186642945358, - -1.4663186642945358, - -1.4663186642945363, - -1.4663186642945363 + -2.639580440722149, + -2.639580440722149, + -2.639580440722148, + -2.6395804407221477 ], - "timestamp": 0.8549026678269901 + "timestamp": 0.8925502182984257 }, { - "x": 2.600011220083244, - "y": 7.698889469685726, - "heading": -3.1756289850171968e-18, - "angularVelocity": -5.2303366513778645e-18, - "velocityX": 2.738059235415646, - "velocityY": -0.2617778228513173, + "x": 2.7244075093266695, + "y": 7.710143326200207, + "heading": 4.0545001861479775e-17, + "angularVelocity": 3.1946238290310474e-17, + "velocityX": 2.8613305913131573, + "velocityY": -0.26682948705944703, "moduleForcesX": [ - 29.715834542523574, - 29.715834542523574, - 29.715834542523574, - 29.715834542523574 + 29.610368617316485, + 29.610368617316485, + 29.610368617316485, + 29.610368617316485 ], "moduleForcesY": [ - 0.7110270176721438, - 0.7110270176721438, - 0.711027017672143, - 0.711027017672143 + -2.3965828818321935, + -2.3965828818321935, + -2.396582881832191, + -2.3965828818321904 ], - "timestamp": 0.9206644115059893 + "timestamp": 0.9612079273983046 }, { - "x": 2.789606747587573, - "y": 7.689743795287642, - "heading": -7.888964430259046e-19, - "angularVelocity": 3.6293630276429175e-17, - "velocityX": 2.883067219573285, - "velocityY": -0.1390728695129531, + "x": 2.93241029163112, + "y": 7.694657309863743, + "heading": 3.3909393653904682e-18, + "angularVelocity": -5.41149172917068e-16, + "velocityX": 3.029561938948279, + "velocityY": -0.2255539332622711, "moduleForcesX": [ - 22.05050779451131, - 22.05050779451131, - 22.05050779451131, - 22.050507794511315 + 24.502907224942238, + 24.502907224942224, + 24.502907224942227, + 24.50290722494221 ], "moduleForcesY": [ - 18.659017610104875, - 18.659017610104872, - 18.659017610104872, - 18.65901761010487 + 6.011787217851106, + 6.01178721785112, + 6.011787217851177, + 6.011787217851191 ], - "timestamp": 0.9864261551849886 + "timestamp": 1.0298656364981835 }, { - "x": 2.967213392257691, - "y": 7.685123920440673, - "heading": 4.745649295344761e-28, - "angularVelocity": 1.1996282234435421e-17, - "velocityX": 2.7007593584788383, - "velocityY": -0.07025170847495492, + "x": 3.13550867397051, + "y": 7.689670458405492, + "heading": 2.3700654686943004e-18, + "angularVelocity": -1.4869035170145797e-17, + "velocityX": 2.958129320111599, + "velocityY": -0.07263352540708297, "moduleForcesX": [ - -27.72247980287612, - -27.72247980287612, - -27.722479802876123, - -27.722479802876123 + -10.404165791895908, + -10.404165791895853, + -10.404165791895927, + -10.404165791895874 ], "moduleForcesY": [ - 10.465227530169143, - 10.465227530169143, - 10.465227530169143, - 10.465227530169143 + 22.272867804632124, + 22.272867804632142, + 22.2728678046321, + 22.27286780463212 ], - "timestamp": 1.052187898863988 + "timestamp": 1.0985233455980625 }, { - "x": 3.1413251938672926, - "y": 7.68365614716633, - "heading": 6.464502773186125e-20, - "angularVelocity": 9.278149747726005e-19, - "velocityX": 2.498931873622686, - "velocityY": -0.021066150561468423, + "x": 3.3247365780348797, + "y": 7.686579288083217, + "heading": 1.2518606947608097e-18, + "angularVelocity": -1.6286660008708956e-17, + "velocityX": 2.7561057096745825, + "velocityY": -0.0450229167686534, "moduleForcesX": [ - -28.967199822820394, - -28.967199822820394, - -28.967199822820394, - -28.967199822820394 + -29.424752600341673, + -29.424752600341673, + -29.424752600341673, + -29.424752600341673 ], "moduleForcesY": [ - 7.059335280783723, - 7.059335280783723, - 7.059335280783723, - 7.059335280783723 + 4.021487026061436, + 4.021487026061437, + 4.021487026061434, + 4.021487026061434 ], - "timestamp": 1.121862387972582 + "timestamp": 1.1671810546979415 }, { - "x": 3.301045698440975, - "y": 7.683954538378008, - "heading": 1.421209171748835e-19, - "angularVelocity": 1.1119693716824987e-18, - "velocityX": 2.2923814241692906, - "velocityY": 0.004282646638499632, + "x": 3.5, + "y": 7.685123920440674, + "heading": 1.3450441301012e-27, + "angularVelocity": -1.8233359839203593e-17, + "velocityX": 2.552712932942728, + "velocityY": -0.021197439610658276, "moduleForcesX": [ - -29.645061211925828, - -29.645061211925828, - -29.645061211925828, - -29.645061211925828 + -29.624171764305668, + -29.624171764305668, + -29.624171764305668, + -29.624171764305668 ], "moduleForcesY": [ - 3.6381748218436845, - 3.638174821843685, - 3.6381748218436845, - 3.6381748218436845 + 3.470182368498979, + 3.470182368498979, + 3.4701823684989788, + 3.4701823684989788 ], - "timestamp": 1.191536877081176 + "timestamp": 1.2358387637978205 }, { - "x": 3.446289399224634, - "y": 7.685250406565696, - "heading": -1.8650220971302436e-20, - "angularVelocity": -2.307460621227609e-18, - "velocityX": 2.0846037429372988, - "velocityY": 0.01859889033401606, + "x": 3.66660979295668, + "y": 7.685277503249667, + "heading": -7.366679508948587e-19, + "angularVelocity": -1.0352679805094467e-17, + "velocityX": 2.3414318946180472, + "velocityY": 0.0021583586491987473, "moduleForcesX": [ - -29.82119910605288, - -29.82119910605288, - -29.82119910605288, - -29.82119910605288 + -29.69214192530745, + -29.69214192530745, + -29.69214192530745, + -29.69214192530745 ], "moduleForcesY": [ - 2.054732496596391, - 2.054732496596391, - 2.054732496596391, - 2.054732496596391 + 3.2822807110822207, + 3.2822807110822207, + 3.28228071108222, + 3.28228071108222 ], - "timestamp": 1.2612113661897701 + "timestamp": 1.306995987435028 }, { - "x": 3.5770259120173957, - "y": 7.687104461095777, - "heading": -1.173563503268423e-19, - "angularVelocity": -1.416675352937903e-18, - "velocityX": 1.8763899738194805, - "velocityY": 0.026610235034621205, + "x": 3.8181130477302205, + "y": 7.686389674690213, + "heading": -1.0052470940503514e-18, + "angularVelocity": -3.774446634956245e-18, + "velocityX": 2.1291338676457943, + "velocityY": 0.015629775637383256, "moduleForcesX": [ - -29.883788425530653, - -29.883788425530653, - -29.883788425530653, - -29.883788425530653 + -29.83506327546548, + -29.83506327546548, + -29.83506327546548, + -29.83506327546548 ], "moduleForcesY": [ - 1.1498246780278856, - 1.1498246780278856, - 1.1498246780278853, - 1.1498246780278856 + 1.8931903606678264, + 1.8931903606678264, + 1.893190360667826, + 1.8931903606678262 ], - "timestamp": 1.3308858552983642 + "timestamp": 1.3781532110722357 }, { - "x": 3.6932427083988193, - "y": 7.689233224603489, - "heading": -2.143519849151234e-19, - "angularVelocity": -1.3921255504376119e-18, - "velocityX": 1.6679963910140032, - "velocityY": 0.030552983529645465, + "x": 3.9544827559802536, + "y": 7.688049683677874, + "heading": -1.1160390053949122e-18, + "angularVelocity": -1.557001607826288e-18, + "velocityX": 1.9164562820117013, + "velocityY": 0.02332874868790862, "moduleForcesX": [ - -29.909596104921132, - -29.909596104921132, - -29.909596104921132, - -29.909596104921132 + -29.888404123019413, + -29.888404123019413, + -29.888404123019413, + -29.888404123019413 ], "moduleForcesY": [ - 0.5658812207266298, - 0.5658812207266298, - 0.5658812207266299, - 0.5658812207266299 + 1.0819664760641052, + 1.0819664760641052, + 1.081966476064105, + 1.081966476064105 ], - "timestamp": 1.4005603444069583 + "timestamp": 1.4493104347094432 }, { - "x": 3.794934324336777, - "y": 7.691438850943431, - "heading": -2.5442565992896705e-19, - "angularVelocity": -5.751556609829351e-19, - "velocityX": 1.459524386008453, - "velocityY": 0.0316561536274656, + "x": 4.0757072948411, + "y": 7.689988843265152, + "heading": -1.1154255698059989e-18, + "angularVelocity": 8.620842587319347e-21, + "velocityX": 1.7036153557492033, + "velocityY": 0.027251760094771964, "moduleForcesX": [ - -29.920851616238835, - -29.920851616238835, - -29.920851616238835, - -29.920851616238835 + -29.911359013620217, + -29.911359013620217, + -29.911359013620217, + -29.911359013620217 ], "moduleForcesY": [ - 0.15833199667958303, - 0.15833199667958303, - 0.15833199667958311, - 0.15833199667958311 + 0.5513159741679446, + 0.5513159741679446, + 0.5513159741679446, + 0.5513159741679446 ], - "timestamp": 1.4702348335155524 + "timestamp": 1.5204676583466508 }, { - "x": 3.8820984561769913, - "y": 7.693575500180637, - "heading": -2.5324350459741614e-19, - "angularVelocity": 1.6966806512526577e-20, - "velocityX": 1.2510193179461728, - "velocityY": 0.03066616297442321, + "x": 4.18178133884055, + "y": 7.692017881304884, + "heading": -1.0251515894825497e-18, + "angularVelocity": 1.2686551735523382e-18, + "velocityX": 1.4906995885649266, + "velocityY": 0.02851485676050525, "moduleForcesX": [ - -29.925596976722087, - -29.925596976722087, - -29.925596976722087, - -29.925596976722087 + -29.921876697975197, + -29.921876697975197, + -29.921876697975197, + -29.921876697975197 ], "moduleForcesY": [ - -0.1420879673045332, - -0.1420879673045332, - -0.14208796730453307, - -0.14208796730453307 + 0.17750786233217195, + 0.17750786233217195, + 0.17750786233217192, + 0.17750786233217192 ], - "timestamp": 1.5399093226241465 + "timestamp": 1.5916248819838583 }, { - "x": 3.954734327805857, - "y": 7.6955312510952805, - "heading": -2.2118758460991037e-19, - "angularVelocity": 4.60081145250412e-19, - "velocityX": 1.0425031106305602, - "velocityY": 0.028069827783906147, + "x": 4.272702463280462, + "y": 7.693996335665616, + "heading": -8.85146828846673e-19, + "angularVelocity": 1.9675410734757282e-18, + "velocityX": 1.2777497461611191, + "velocityY": 0.02780398475329726, "moduleForcesX": [ - -29.927195733092546, - -29.927195733092546, - -29.927195733092546, - -29.927195733092546 + -29.92666542043912, + -29.92666542043912, + -29.92666542043912, + -29.92666542043912 ], "moduleForcesY": [ - -0.372637851204075, - -0.372637851204075, - -0.37263785120407483, - -0.37263785120407483 + -0.09990159408584362, + -0.09990159408584362, + -0.09990159408584365, + -0.09990159408584365 ], - "timestamp": 1.6095838117327406 + "timestamp": 1.6627821056210659 }, { - "x": 4.012841935399933, - "y": 7.69721751820016, - "heading": -1.544604135447017e-19, - "angularVelocity": 9.576987258007982e-19, - "velocityX": 0.8339868485758819, - "velocityY": 0.02420207357545785, + "x": 4.348469686389936, + "y": 7.695815860635135, + "heading": -7.093341639933162e-19, + "angularVelocity": 2.4707634080914777e-18, + "velocityX": 1.0647861065479056, + "velocityY": 0.02557048850941353, "moduleForcesX": [ - -29.927203589492557, - -29.927203589492557, - -29.927203589492557, - -29.927203589492557 + -29.928604395669055, + -29.928604395669055, + -29.928604395669055, + -29.928604395669055 ], "moduleForcesY": [ - -0.5551176991653127, - -0.5551176991653127, - -0.5551176991653126, - -0.5551176991653126 + -0.3138818702751991, + -0.3138818702751991, + -0.31388187027519915, + -0.31388187027519915 ], - "timestamp": 1.6792583008413347 + "timestamp": 1.7339393292582734 }, { - "x": 4.056421672062467, - "y": 7.698562451628175, - "heading": -5.419193690793024e-20, - "angularVelocity": 1.4390988214903013e-18, - "velocityX": 0.6254762282830563, - "velocityY": 0.019303097055838256, + "x": 4.4090827796581005, + "y": 7.697390357009512, + "heading": -5.125690877607844e-19, + "angularVelocity": 2.76521575318147e-18, + "velocityX": 0.8518192555861492, + "velocityY": 0.022127006842417533, "moduleForcesX": [ - -29.926393858136848, - -29.926393858136848, - -29.926393858136848, - -29.926393858136848 + -29.929055698906968, + -29.929055698906968, + -29.929055698906968, + -29.929055698906968 ], "moduleForcesY": [ - -0.7031234218285176, - -0.7031234218285176, - -0.7031234218285174, - -0.7031234218285174 + -0.48392580415341463, + -0.48392580415341463, + -0.4839258041534147, + -0.4839258041534147 ], - "timestamp": 1.7489327899499287 + "timestamp": 1.805096552895481 }, { - "x": 4.085474131217841, - "y": 7.699506608982952, - "heading": 2.7187783763224124e-20, - "angularVelocity": 1.1679987967787588e-18, - "velocityX": 0.41697412538775014, - "velocityY": 0.0135509763802512, + "x": 4.454541917622047, + "y": 7.698649766258782, + "heading": -3.0693954250775033e-19, + "angularVelocity": 2.889791566683448e-18, + "velocityX": 0.6388548574600323, + "velocityY": 0.01769896554444152, "moduleForcesX": [ - -29.925171402453582, - -29.925171402453582, - -29.925171402453582, - -29.925171402453582 + -29.928710992422637, + -29.928710992422637, + -29.928710992422637, + -29.928710992422637 ], "moduleForcesY": [ - -0.8255705566240068, - -0.8255705566240068, - -0.8255705566240065, - -0.8255705566240065 + -0.6222897791167649, + -0.6222897791167649, + -0.6222897791167649, + -0.6222897791167649 ], - "timestamp": 1.8186072790585228 + "timestamp": 1.8762537765326885 }, { - "x": 4.099999999999999, - "y": 7.700000000000001, - "heading": 7.046657587318804e-29, - "angularVelocity": -3.9021145698260385e-19, - "velocityX": 0.20848188439036744, - "velocityY": 0.007081372592684751, + "x": 4.484847490490274, + "y": 7.699535974400896, + "heading": -1.0247249988989415e-19, + "angularVelocity": 2.8734544674071763e-18, + "velocityX": 0.4258959430827974, + "velocityY": 0.012454225960910713, "moduleForcesX": [ - -29.923755977948908, - -29.923755977948908, - -29.923755977948908, - -29.923755977948908 + -29.927940339971396, + -29.927940339971396, + -29.927940339971396, + -29.927940339971396 ], "moduleForcesY": [ - -0.9285470005363222, - -0.9285470005363222, - -0.9285470005363218, - -0.9285470005363217 + -0.7370635496222995, + -0.7370635496222995, + -0.7370635496222995, + -0.7370635496222995 ], - "timestamp": 1.888281768167117 + "timestamp": 1.947411000169896 }, { - "x": 4.1, + "x": 4.5, "y": 7.700000000000001, - "heading": 3.2045159969045717e-29, - "angularVelocity": -9.151492845773918e-29, - "velocityX": 2.2287955073955105e-17, - "velocityY": -1.8794204571145243e-16, + "heading": -7.064779315924063e-28, + "angularVelocity": 1.4400856798866269e-18, + "velocityX": 0.21294407981721789, + "velocityY": 0.006521131312349581, + "moduleForcesX": [ + -29.92694941996426, + -29.92694941996426, + -29.92694941996426, + -29.92694941996426 + ], + "moduleForcesY": [ + -0.8338007506884793, + -0.8338007506884793, + -0.8338007506884791, + -0.8338007506884791 + ], + "timestamp": 2.0185682238071037 + }, + { + "x": 4.5, + "y": 7.7, + "heading": -3.5046617389724685e-28, + "angularVelocity": 7.7934235041127e-29, + "velocityX": 9.122485788705435e-19, + "velocityY": -1.2473644372179643e-17, "moduleForcesX": [ - -29.922269550542303, - -29.922269550542303, - -29.922269550542303, - -29.922269550542303 + -29.925855581845823, + -29.925855581845823, + -29.925855581845823, + -29.925855581845823 ], "moduleForcesY": [ - -1.0163508456660588, - -1.0163508456660588, - -1.0163508456660586, - -1.0163508456660586 + -0.9164398186187475, + -0.9164398186187475, + -0.9164398186187476, + -0.9164398186187476 ], - "timestamp": 1.957956257275711 + "timestamp": 2.089725447444311 } ], "trajectoryWaypoints": [ @@ -20721,23 +20847,23 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 18 }, { - "timestamp": 1.052187898863988, + "timestamp": 1.2358387637978205, "isStopPoint": false, - "x": 2.9672133922576904, + "x": 3.5, "y": 7.685123920440674, "heading": 0, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 13 + "controlIntervalCount": 12 }, { - "timestamp": 1.957956257275711, + "timestamp": 2.089725447444311, "isStopPoint": true, - "x": 4.1, + "x": 4.5, "y": 7.7, "heading": 0, "isInitialGuess": false,