From f8e967099d212a7d78789730190a79e2bf30e3d4 Mon Sep 17 00:00:00 2001 From: Daniel Burke Date: Mon, 5 Aug 2024 22:10:50 -0400 Subject: [PATCH] Fixed auto pathing and bug --- choreo.chor | 3991 ++++++++--------- .../deploy/choreo/SourceSpit54Source.1.traj | 680 +-- .../deploy/choreo/SourceSpit54Source.2.traj | 442 +- .../deploy/choreo/SourceSpit54Source.3.traj | 961 ++-- .../deploy/choreo/SourceSpit54Source.4.traj | 480 +- .../deploy/choreo/SourceSpit54Source.5.traj | 678 ++- .../deploy/choreo/SourceSpit54Source.6.traj | 697 ++- .../deploy/choreo/SourceSpit54Source.traj | 3949 ++++++++-------- 8 files changed, 6083 insertions(+), 5795 deletions(-) diff --git a/choreo.chor b/choreo.chor index b17f001..3b91a41 100644 --- a/choreo.chor +++ b/choreo.chor @@ -87802,13 +87802,13 @@ "controlIntervalCount": 20 }, { - "x": 5.720109462738037, - "y": 1.5596987009048462, + "x": 5.6509270668029785, + "y": 1.8346644639968872, "heading": 2.339802238554342, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 12 + "controlIntervalCount": 11 }, { "x": 4.202682018280029, @@ -87879,9 +87879,9 @@ "x": 1.3093055486679075, "y": 1.4855375289916992, "heading": 3.1415, - "angularVelocity": -0.00020611047214952728, - "velocityX": 4.247624054998792, - "velocityY": -0.45156582763286957, + "angularVelocity": -0.00020611047215007977, + "velocityX": 4.247624054998791, + "velocityY": -0.45156582763287095, "moduleForcesX": [ 0, 0, @@ -87898,725 +87898,725 @@ }, { "x": 1.6776912225328318, - "y": 1.4463743687041792, + "y": 1.446374368704179, "heading": 3.141472282141126, - "angularVelocity": -0.0003391512485237624, + "angularVelocity": -0.0003391512485240895, "velocityX": 4.5075076612628155, - "velocityY": -0.4791941097578826, + "velocityY": -0.479194109757884, "moduleForcesX": [ - 58.894651333366134, - 58.902040993577, - 58.89391091497932, - 58.901300701642334 + 58.89465133336612, + 58.902040993576975, + 58.8939109149793, + 58.90130070164229 ], "moduleForcesY": [ - -6.254691452649277, - -6.253954535213562, - -6.26895930675167, - -6.268220727628237 + -6.2546914526492765, + -6.253954535213559, + -6.2689593067516585, + -6.268220727628227 ], - "timestamp": 0.08172713205366311 + "timestamp": 0.08172713205366312 }, { - "x": 2.0460782805856987, - "y": 1.4072110612618156, - "heading": 3.141444998150414, - "angularVelocity": -0.0003338425076975475, + "x": 2.04607828058528, + "y": 1.4072110612618527, + "heading": 3.1414449981504142, + "angularVelocity": -0.0003338425076962522, "velocityX": 4.507524597961855, - "velocityY": -0.4791959103204973, + "velocityY": -0.4791959103204976, "moduleForcesX": [ - 0.004054411185247945, - 0.0036223253849391474, - 0.004054475069004705, - 0.0036223892690657507 + 0.0040544111854116495, + 0.003622325384970821, + 0.004054475069168368, + 0.003622389269097384 ], "moduleForcesY": [ - -0.0006241401719434498, - -0.0006240762768495998, - -0.00019205441259517473, - -0.00019199052157958934 + -0.0006241401717500891, + -0.0006240762766562905, + -0.00019205441226977354, + -0.00019199052125422377 ], - "timestamp": 0.16345426410732622 + "timestamp": 0.16345426410732625 }, { - "x": 2.4144653386990167, - "y": 1.3680477538129143, - "heading": 3.1414177142020585, - "angularVelocity": -0.0003338419894377083, - "velocityX": 4.507524598705652, - "velocityY": -0.4791959104011729, + "x": 2.414465338699188, + "y": 1.3680477538128972, + "heading": 3.141417714202059, + "angularVelocity": -0.00033384198943655095, + "velocityX": 4.507524598705653, + "velocityY": -0.4791959104011735, "moduleForcesX": [ - 1.8965212607030153e-7, - 1.4747024014620896e-7, - 1.8966659941626728e-7, - 1.4748471350632016e-7 + 1.8965220181163422e-7, + 1.474703271181504e-7, + 1.8966667527279182e-7, + 1.4748480059345372e-7 ], "moduleForcesY": [ - -3.9381860338036625e-8, - -3.936738687005518e-8, - 2.800025123487072e-9, - 2.8144985669772043e-9 + -3.938192729235327e-8, + -3.936745370918043e-8, + 2.7999469385635256e-9, + 2.814420497246649e-9 ], - "timestamp": 0.24518139616098933 + "timestamp": 0.24518139616098938 }, { - "x": 2.782852396812763, - "y": 1.328884446363913, - "heading": 3.1413904302531392, - "angularVelocity": -0.00033384199633377203, + "x": 2.782852396813364, + "y": 1.3288844463639362, + "heading": 3.1413904302531397, + "angularVelocity": -0.00033384199633044927, "velocityX": 4.50752459870562, - "velocityY": -0.47919591040144593, + "velocityY": -0.4791959104014461, "moduleForcesX": [ - -2.8808071498004513e-10, - 2.7319951370204496e-10, - -2.8794927631594204e-10, - 2.733309522445748e-10 + -2.8803563446343644e-10, + 2.7306834504483674e-10, + -2.8790426266076945e-10, + 2.7319971672592943e-10 ], "moduleForcesY": [ - 2.1869323715156544e-10, - 2.1882467936106666e-10, - -3.4258700998575654e-10, - -3.4245556750246296e-10 + 2.1870178685671868e-10, + 2.1883316220478742e-10, + -3.424022111068235e-10, + -3.4227083548495593e-10 ], - "timestamp": 0.32690852821465244 + "timestamp": 0.3269085282146525 }, { - "x": 3.1512394549262512, - "y": 1.289721138915009, - "heading": 3.1413631463036533, - "angularVelocity": -0.000333842003262993, + "x": 3.1512394549258516, + "y": 1.2897211389149879, + "heading": 3.1413631463036538, + "angularVelocity": -0.00033384200326365063, "velocityX": 4.507524598705565, - "velocityY": -0.47919591040160886, + "velocityY": -0.4791959104016092, "moduleForcesX": [ - -2.9425289616999354e-10, - 2.6972600228707847e-10, - -2.943766041628635e-10, - 2.6960229431046965e-10 + -2.945523994192452e-10, + 2.697504660509287e-10, + -2.946761066760521e-10, + 2.6962675881038304e-10 ], "moduleForcesY": [ - 2.4512765070974995e-10, - 2.4500394281245953e-10, - -3.188512480187098e-10, - -3.189749559340506e-10 + 2.4525625397135997e-10, + 2.4513254681013373e-10, + -3.1904661177020595e-10, + -3.191703189494828e-10 ], - "timestamp": 0.40863566026831555 + "timestamp": 0.4086356602683156 }, { - "x": 3.51962651304027, - "y": 1.250557831466011, - "heading": 3.1413358623536007, - "angularVelocity": -0.000333842010196935, + "x": 3.5196265130398467, + "y": 1.2505578314660648, + "heading": 3.1413358623536016, + "angularVelocity": -0.0003338420101929837, "velocityX": 4.507524598705517, - "velocityY": -0.4791959104017224, + "velocityY": -0.47919591040172266, "moduleForcesX": [ - -2.9319524605502616e-10, - 2.7116789785781755e-10, - -2.9334050125477524e-10, - 2.7102264266190907e-10 + -2.9283289574986723e-10, + 2.7115512516572705e-10, + -2.929781114118843e-10, + 2.7100990950755063e-10 ], "moduleForcesY": [ - 2.565256487745166e-10, - 2.5638039353513226e-10, - -3.0783749498208265e-10, - -3.0798275019898476e-10 + 2.5635051689420785e-10, + 2.5620530119255553e-10, + -3.0763750386514194e-10, + -3.0778271954431195e-10 ], - "timestamp": 0.49036279232197866 + "timestamp": 0.4903627923219787 }, { - "x": 3.8880135711533463, - "y": 1.2113945240170787, - "heading": 3.141308578402982, - "angularVelocity": -0.0003338420171260208, + "x": 3.8880135711535515, + "y": 1.2113945240170145, + "heading": 3.1413085784029833, + "angularVelocity": -0.00033384201712058706, "velocityX": 4.507524598705524, - "velocityY": -0.4791959104013023, + "velocityY": -0.47919591040130255, "moduleForcesX": [ - -2.8017365622927923e-10, - 2.8379423080040176e-10, - -2.803342617801993e-10, - 2.8363362524959436e-10 + -2.80192725101816e-10, + 2.836545029382628e-10, + -2.803532608136775e-10, + 2.83493967226514e-10 ], "moduleForcesY": [ - 3.7727704785442104e-10, - 3.771164423033856e-10, - -1.8669083917433548e-10, - -1.8685144472525347e-10 + 3.772119807760254e-10, + 3.770514450640486e-10, + -1.8663524726312927e-10, + -1.867957829749886e-10 ], - "timestamp": 0.5720899243756418 + "timestamp": 0.5720899243756419 }, { - "x": 4.256400629267179, - "y": 1.1722312165687208, - "heading": 3.1412812944517974, - "angularVelocity": -0.00033384202405161144, + "x": 4.256400629267131, + "y": 1.1722312165687518, + "heading": 3.1412812944517987, + "angularVelocity": -0.00033384202405156797, "velocityX": 4.507524598706256, - "velocityY": -0.4791959103940783, + "velocityY": -0.47919591039407844, "moduleForcesX": [ - -1.1601533840227877e-10, - 4.476680699088195e-10, - -1.1619133319256263e-10, - 4.474920751185415e-10 + -1.1635902338158833e-10, + 4.477631051174233e-10, + -1.165351535479574e-10, + 4.475869749510601e-10 ], "moduleForcesY": [ - 1.9191264638326385e-9, - 1.918950469047209e-9, - 1.3554430555132117e-9, - 1.3552670607222244e-9 + 1.9193651862238043e-9, + 1.9191890560622896e-9, + 1.3552430577164645e-9, + 1.3550669275493915e-9 ], - "timestamp": 0.6538170564293049 + "timestamp": 0.653817056429305 }, { - "x": 4.624787687381106, - "y": 1.1330679091280322, - "heading": 3.1412540105000466, - "angularVelocity": -0.00033384203097612254, + "x": 4.6247876873816365, + "y": 1.1330679091279792, + "heading": 3.141254010500048, + "angularVelocity": -0.00033384203097711876, "velocityX": 4.507524598716221, - "velocityY": -0.4791959103000003, + "velocityY": -0.4791959103000007, "moduleForcesX": [ - 1.9765770134900176e-9, - 2.5401725437966218e-9, - 1.976385590478481e-9, - 2.5399811207741598e-9 + 1.9765153355534307e-9, + 2.5401954963740974e-9, + 1.976323873007331e-9, + 2.5400040338170728e-9 ], "moduleForcesY": [ - 2.1602981176742383e-8, - 2.1602789753868992e-8, - 2.1039385646053967e-8, - 2.1039194223054364e-8 + 2.160298396904306e-8, + 2.16027925066351e-8, + 2.103930380784058e-8, + 2.103911234530641e-8 ], - "timestamp": 0.735544188482968 + "timestamp": 0.7355441884829681 }, { - "x": 4.993174745507101, - "y": 1.093904601785636, - "heading": 3.14122672654773, - "angularVelocity": -0.00033384203790308084, + "x": 4.993174745506862, + "y": 1.0939046017857066, + "heading": 3.1412267265477314, + "angularVelocity": -0.00033384203789967075, "velocityX": 4.507524598844053, - "velocityY": -0.4791959090972083, + "velocityY": -0.47919590909720844, "moduleForcesX": [ - 2.868929446678408e-8, - 2.9253089173942963e-8, - 2.868908394171876e-8, - 2.9252878648747433e-8 + 2.8689184983444446e-8, + 2.9252621055977716e-8, + 2.8688974602268402e-8, + 2.925241067467146e-8 ], "moduleForcesY": [ - 2.728733268257027e-7, - 2.7287311630124865e-7, - 2.723095321160976e-7, - 2.723093215911679e-7 + 2.7287318449784567e-7, + 2.72872974117281e-7, + 2.723097484228662e-7, + 2.723095380418258e-7 ], - "timestamp": 0.8172713205366311 + "timestamp": 0.8172713205366312 }, { - "x": 5.361561803764487, - "y": 1.0547412956983473, - "heading": 3.1411994425948473, - "angularVelocity": -0.0003338420448259796, + "x": 5.361561803764377, + "y": 1.0547412956983293, + "heading": 3.1411994425948486, + "angularVelocity": -0.0003338420448248998, "velocityX": 4.507524600476514, - "velocityY": -0.47919589374122556, + "velocityY": -0.4791958937412259, "moduleForcesX": [ - 3.696865577304178e-7, - 3.702500219545937e-7, - 3.6968613763840057e-7, - 3.702496018625516e-7 + 3.696867015506992e-7, + 3.7025035543909504e-7, + 3.696862813689362e-7, + 3.702499352573073e-7 ], "moduleForcesY": [ - 0.0000034804410489130244, - 0.0000034804406288175047, - 0.000003479877584702018, - 0.0000034798771646076077 + 0.0000034804411290891762, + 0.00000348044070890391, + 0.0000034798774752139487, + 0.0000034798770550297925 ], - "timestamp": 0.8989984525902942 + "timestamp": 0.8989984525902943 }, { - "x": 5.729948863726285, - "y": 1.015578005631815, - "heading": 3.1411721586413393, - "angularVelocity": -0.00033384205247850694, - "velocityX": 4.507524621316063, - "velocityY": -0.47919569771268744, + "x": 5.729948863726064, + "y": 1.0155780056318247, + "heading": 3.141172158641341, + "angularVelocity": -0.0003338420524782025, + "velocityX": 4.507524621316062, + "velocityY": -0.4791956977126878, "moduleForcesX": [ - 0.000004722605910888902, - 0.000004723228755826117, - 0.000004722593901597685, - 0.000004723216746540372 + 0.000004722605717249217, + 0.000004723228625294551, + 0.000004722593707959265, + 0.00000472321661601007 ], "moduleForcesY": [ - 0.00004442668313336451, - 0.00004442667112405076, - 0.00004442606028868228, - 0.00004442604827933517 + 0.000044426683151454254, + 0.00004442667114214177, + 0.00004442606024366391, + 0.000044426048234318074 ], - "timestamp": 0.9807255846439573 + "timestamp": 0.9807255846439574 }, { - "x": 6.098335944993547, - "y": 0.9764149201272616, - "heading": 3.141144873733055, - "angularVelocity": -0.0003338537349670905, - "velocityX": 4.507524882009698, - "velocityY": -0.4791931947257305, + "x": 6.098335944993564, + "y": 0.9764149201272568, + "heading": 3.1411448737330567, + "angularVelocity": -0.00033385373496601367, + "velocityX": 4.507524882009697, + "velocityY": -0.47919319472573085, "moduleForcesX": [ - 0.000058606608936925306, - 0.00005955746287124728, - 0.00005860564622522572, - 0.00005955650005937791 + 0.000058606609209525885, + 0.00005955746308098625, + 0.000058605646496038295, + 0.000059556500267328035 ], "moduleForcesY": [ - 0.0005677331808062003, - 0.0005677322177464595, - 0.0005667823272709411, - 0.0005667813645585504 + 0.0005677331807728031, + 0.0005677322177112738, + 0.000566782327300406, + 0.0005667813645862271 ], - "timestamp": 1.0624527166976203 + "timestamp": 1.0624527166976205 }, { - "x": 6.466713606551941, - "y": 0.9372554763119637, - "heading": 3.1411027380347774, - "angularVelocity": -0.0005155656049507016, + "x": 6.46671360655173, + "y": 0.9372554763119341, + "heading": 3.1411027380347787, + "angularVelocity": -0.0005155656049492363, "velocityX": 4.50740962396997, - "velocityY": -0.4791486356035406, + "velocityY": -0.47914863560354054, "moduleForcesX": [ - -0.033512437082181865, - -0.018722651292121043, - -0.03351970042077828, - -0.01872991270097043 + -0.03351243708215853, + -0.018722651292127624, + -0.03351970042075507, + -0.01872991270097627 ], "moduleForcesY": [ - 0.017497044920547423, - 0.01748978512288604, - 0.0027072770317358424, - 0.002700008527818997 + 0.017497044920615233, + 0.017489785122957475, + 0.002707277031841645, + 0.0027000085279199264 ], - "timestamp": 1.1441798487512833 + "timestamp": 1.1441798487512838 }, { - "x": 6.801579450679335, - "y": 0.9016550002248332, - "heading": 3.1232438571056225, - "angularVelocity": -0.21851838527048875, + "x": 6.801579450679561, + "y": 0.9016550002248982, + "heading": 3.12324385710561, + "angularVelocity": -0.21851838527065992, "velocityX": 4.097364433494548, - "velocityY": -0.4356016807700555, + "velocityY": -0.43560168077005584, "moduleForcesX": [ - -93.69834450297687, - -89.01513972710934, - -96.03922536165108, - -92.96495477245452 + -93.69834450297753, + -89.01513972710512, + -96.03922536165277, + -92.96495477245534 ], "moduleForcesY": [ - 22.28341658989289, - 29.051835313736024, - -4.744060783787519, - -7.114634103996269 + 22.28341658989852, + 29.051835313755163, + -4.744060783792586, + -7.114634104016339 ], - "timestamp": 1.2259069808049463 + "timestamp": 1.225906980804947 }, { - "x": 7.099346531012958, - "y": 0.8699987853286542, - "heading": 3.106691367168923, - "angularVelocity": -0.20253359589115869, - "velocityX": 3.6434299461030673, - "velocityY": -0.3873403373002619, + "x": 7.099346531013058, + "y": 0.869998785328631, + "heading": 3.1066913671689087, + "angularVelocity": -0.20253359589117298, + "velocityX": 3.6434299461030677, + "velocityY": -0.38734033730026224, "moduleForcesX": [ - -102.99949769077502, - -103.02513937963398, - -102.72151509322181, - -102.75841208178751 + -102.99949769077611, + -103.02513937963529, + -102.72151509322009, + -102.75841208178622 ], "moduleForcesY": [ - 9.727922777809646, - 9.578030116265486, - 12.328637537836405, - 12.115694391256039 + 9.727922777797522, + 9.578030116252217, + 12.328637537850282, + 12.115694391267553 ], - "timestamp": 1.3076341128586093 + "timestamp": 1.3076341128586102 }, { - "x": 7.359936597959423, - "y": 0.8422950114060971, - "heading": 3.0919308976796085, - "angularVelocity": -0.18060672286435264, + "x": 7.359936597959464, + "y": 0.8422950114061555, + "heading": 3.0919308976795943, + "angularVelocity": -0.18060672286435828, "velocityX": 3.1885380093254865, - "velocityY": -0.33897890732615193, + "velocityY": -0.3389789073261522, "moduleForcesX": [ - -103.27059619944963, - -103.29104696246749, - -102.8854236951988, - -102.92545257425414 + -103.2705961994497, + -103.29104696246755, + -102.88542369519871, + -102.92545257425405 ], "moduleForcesY": [ - 9.261942170050276, - 9.123903472256336, - 12.8564729825216, - 12.59869747011876 + 9.261942170049517, + 9.123903472255591, + 12.856472982522407, + 12.59869747011948 ], - "timestamp": 1.3893612449122723 + "timestamp": 1.3893612449122734 }, { - "x": 7.58332287276895, - "y": 0.8185464774785829, - "heading": 3.0791309749028772, - "angularVelocity": -0.1566177896506479, - "velocityX": 2.733318412085363, - "velocityY": -0.29058322898184225, + "x": 7.58332287276877, + "y": 0.818546477478533, + "heading": 3.079130974902868, + "angularVelocity": -0.15661778965058812, + "velocityX": 2.7333184120853633, + "velocityY": -0.2905832289818426, "moduleForcesX": [ - -103.36594951172025, - -103.38028751192688, - -102.94365368980282, - -102.97966227585505 + -103.3659495117207, + -103.38028751192735, + -102.94365368980209, + -102.97966227585444 ], "moduleForcesY": [ - 9.079616014969533, - 8.984237326802269, - 13.023827383874401, - 12.784382494043633 + 9.079616014964232, + 8.984237326796942, + 13.023827383880123, + 12.78438249404854 ], - "timestamp": 1.4710883769659353 + "timestamp": 1.4710883769659366 }, { - "x": 7.769491837116803, - "y": 0.7987545966176683, - "heading": 3.0683771471345906, - "angularVelocity": -0.1315821012931888, - "velocityX": 2.277933406815666, - "velocityY": -0.24217026051927823, + "x": 7.7694918371165045, + "y": 0.7987545966176534, + "heading": 3.0683771471345858, + "angularVelocity": -0.1315821012931304, + "velocityX": 2.277933406815667, + "velocityY": -0.2421702605192785, "moduleForcesX": [ -103.41515460878193, - -103.42443760342492, - -102.97433378125582, - -103.005574093989 + -103.4244376034249, + -102.97433378125584, + -103.00557409398901 ], "moduleForcesY": [ - 8.976218196001655, - 8.923469974360179, - 13.099124861119694, - 12.88892417371863 + 8.976218196001748, + 8.923469974360286, + 13.099124861119599, + 12.888924173718566 ], - "timestamp": 1.5528155090195983 + "timestamp": 1.5528155090195999 }, { - "x": 7.918435339366071, - "y": 0.7829202209960606, - "heading": 3.0597211380125815, - "angularVelocity": -0.10591353084953188, - "velocityX": 1.8224486594111562, - "velocityY": -0.19374686500967267, + "x": 7.918435339365923, + "y": 0.7829202209960395, + "heading": 3.0597211380125793, + "angularVelocity": -0.10591353084949826, + "velocityX": 1.8224486594111566, + "velocityY": -0.19374686500967284, "moduleForcesX": [ - -103.44532754676128, - -103.45059106507556, - -102.99353139152261, - -103.02046917509142 + -103.44532754676109, + -103.45059106507539, + -102.9935313915229, + -103.02046917509165 ], "moduleForcesY": [ - 8.908204125136255, - 8.89210265995939, - 13.139438738048499, - 12.957444097698344 + 8.908204125138308, + 8.892102659961388, + 13.139438738046369, + 12.957444097696476 ], - "timestamp": 1.6345426410732613 + "timestamp": 1.634542641073263 }, { - "x": 8.030147928353161, - "y": 0.7710439205191237, + "x": 8.030147928353294, + "y": 0.7710439205191398, "heading": 3.053197581935371, - "angularVelocity": -0.07982117949430736, - "velocityX": 1.3668972124774883, - "velocityY": -0.14531649622907394, + "angularVelocity": -0.07982117949428515, + "velocityX": 1.3668972124774887, + "velocityY": -0.14531649622907405, "moduleForcesX": [ - -103.46568344315243, - -103.46789643910462, - -103.00664909946575, - -103.03015522294537 + -103.46568344315234, + -103.46789643910454, + -103.00664909946587, + -103.03015522294548 ], "moduleForcesY": [ - 8.86063249043144, - 8.873193949089648, - 13.164397740662087, - 13.00528690977233 + 8.860632490432424, + 8.873193949090584, + 13.164397740661096, + 13.005286909771451 ], - "timestamp": 1.7162697731269243 + "timestamp": 1.7162697731269263 }, { - "x": 8.104625702260256, - "y": 0.7631261031139874, + "x": 8.10462570226017, + "y": 0.7631261031139884, "heading": 3.0488312843564214, - "angularVelocity": -0.053425312613233654, - "velocityX": 0.9112980234968839, - "velocityY": -0.09688113611971519, + "angularVelocity": -0.05342531261322825, + "velocityX": 0.911298023496884, + "velocityY": -0.09688113611971526, "moduleForcesX": [ - -103.48021692002517, - -103.48030657193449, - -103.01600852054571, - -103.03713171986256 + -103.48021692002504, + -103.48030657193438, + -103.01600852054591, + -103.03713171986273 ], "moduleForcesY": [ - 8.826978887492562, - 8.859337121264703, - 13.18260602174957, - 13.039113841379665 + 8.826978887494013, + 8.859337121266073, + 13.182606021748102, + 13.039113841378352 ], - "timestamp": 1.7979969051805873 + "timestamp": 1.7979969051805895 }, { - "x": 8.14186573028563, - "y": 0.7591670751571251, + "x": 8.14186573028574, + "y": 0.7591670751571266, "heading": 3.0466408807888117, - "angularVelocity": -0.02680142460120989, - "velocityX": 0.4556629737236343, - "velocityY": -0.04844202723516076, + "angularVelocity": -0.026801424601212133, + "velocityX": 0.4556629737236342, + "velocityY": -0.04844202723516079, "moduleForcesX": [ - -103.490940054563, - -103.4898092444739, - -103.0227710663496, - -103.04265219867469 + -103.49094005456293, + -103.48980924447385, + -103.02277106634969, + -103.04265219867477 ], "moduleForcesY": [ - 8.803943328885603, - 8.846770557986561, - 13.198440061449329, - 13.062280295237983 + 8.803943328886316, + 8.846770557987233, + 13.198440061448613, + 13.062280295237343 ], - "timestamp": 1.8797240372342503 + "timestamp": 1.8797240372342527 }, { "x": 8.141865730285645, "y": 0.7591670751571655, "heading": 3.0466408807888117, - "angularVelocity": -2.2162561306828634e-18, - "velocityX": 6.0719591465516605e-18, - "velocityY": 3.7191933332762756e-19, + "angularVelocity": -2.216413397491607e-18, + "velocityX": 6.071801473157301e-18, + "velocityY": 3.719160099439509e-19, "moduleForcesX": [ -103.49897514652822, - -103.497512630357, - -103.02758277721088, - -103.04741586769943 + -103.49751263035701, + -103.02758277721087, + -103.04741586769941 ], "moduleForcesY": [ - 8.789691125263571, - 8.833386151441184, - 13.214354544577951, - 13.076647990366267 + 8.789691125263493, + 8.833386151441111, + 13.214354544578041, + 13.076647990366352 ], - "timestamp": 1.9614511692879133 + "timestamp": 1.961451169287916 }, { "x": 8.12139177192427, - "y": 0.7686524008245413, - "heading": 3.056527253089306, - "angularVelocity": 0.15490715137698402, - "velocityX": -0.3208014497909542, - "velocityY": 0.14862324969723603, + "y": 0.7686524008245414, + "heading": 3.0565272530893055, + "angularVelocity": 0.15490715137698394, + "velocityX": -0.32080144979095415, + "velocityY": 0.14862324969723617, "moduleForcesX": [ - -98.54262377114843, - -100.4770509117282, - -82.79137566578632, - -90.59657531971158 + -98.54262377114841, + -100.47705091172818, + -82.7913756657863, + -90.59657531971156 ], "moduleForcesY": [ - 32.73797497154649, - 26.30090387431019, - 62.69281274939932, - 50.800045948114445 + 32.737974971546535, + 26.300903874310222, + 62.69281274939936, + 50.80004594811448 ], - "timestamp": 2.0252724468248977 + "timestamp": 2.0252724468249004 }, { "x": 8.080660351142782, "y": 0.7880598204655119, "heading": 3.076375749087686, - "angularVelocity": 0.31100123288629355, - "velocityX": -0.638210677589206, - "velocityY": 0.30409011523976287, + "angularVelocity": 0.31100123288629333, + "velocityX": -0.6382106775892058, + "velocityY": 0.304090115239763, "moduleForcesX": [ -97.51013510987994, - -100.05875562562483, - -81.09999788338129, + -100.05875562562481, + -81.09999788338128, -89.80082050059022 ], "moduleForcesY": [ - 35.64906123251604, - 27.807073480632145, + 35.64906123251607, + 27.807073480632162, 64.84604210021749, - 52.17408445205142 + 52.174084452051424 ], - "timestamp": 2.089093724361882 + "timestamp": 2.089093724361885 }, { - "x": 8.019993961475123, + "x": 8.019993961475121, "y": 0.8180013901296872, "heading": 3.1062742720333283, - "angularVelocity": 0.46847264892677243, - "velocityX": -0.9505668330206076, - "velocityY": 0.46914713743898434, + "angularVelocity": 0.46847264892677226, + "velocityX": -0.9505668330206073, + "velocityY": 0.4691471374389845, "moduleForcesX": [ - -95.83367751055793, + -95.83367751055792, -99.42042191041061, - -78.67293358001308, + -78.67293358001307, -88.676734166875 ], "moduleForcesY": [ - 39.87717934463128, - 29.95217527604755, - 67.74395166278366, - 54.03584566132871 + 39.8771793446313, + 29.952175276047576, + 67.74395166278367, + 54.03584566132872 ], - "timestamp": 2.1529150018988665 + "timestamp": 2.152915001898869 }, { - "x": 7.9399197688128345, + "x": 7.939919768812834, "y": 0.8593922232548926, "heading": 3.1463376298650596, - "angularVelocity": 0.627742962502038, - "velocityX": -1.2546629549351198, - "velocityY": 0.6485428484445409, + "angularVelocity": 0.6277429625020375, + "velocityX": -1.2546629549351196, + "velocityY": 0.6485428484445411, "moduleForcesX": [ - -92.88000464654638, + -92.88000464654637, -98.30849263529356, -74.94629470181758, -86.88017977205095 ], "moduleForcesY": [ - 46.26239074940662, - 33.34169675064432, + 46.262390749406656, + 33.34169675064433, 71.8090336983567, - 56.841332870312876 + 56.84133287031288 ], - "timestamp": 2.216736279435851 + "timestamp": 2.2167362794358536 }, { - "x": 7.84143071939511, + "x": 7.841430719395109, "y": 0.9137307885891377, - "heading": 3.1967482621269068, - "angularVelocity": 0.7898718767049805, - "velocityX": -1.5432008449008328, - "velocityY": 0.8514177000414278, + "heading": 3.196748262126907, + "angularVelocity": 0.78987187670498, + "velocityX": -1.5432008449008323, + "velocityY": 0.8514177000414281, "moduleForcesX": [ - -86.89087334993594, - -95.98833796115419, + -86.89087334993593, + -95.98833796115417, -68.54914547471209, - -83.52558618270564 + -83.52558618270562 ], "moduleForcesY": [ - 56.60723624372076, - 39.41093811953867, + 56.6072362437208, + 39.4109381195387, 77.88580562900931, - 61.606619602131445 + 61.60661960213146 ], - "timestamp": 2.2805575569728354 + "timestamp": 2.280557556972838 }, { - "x": 7.726890294226319, + "x": 7.726890294226318, "y": 0.9837916600371955, - "heading": 3.2578934429620614, - "angularVelocity": 0.9580688948089633, - "velocityX": -1.794705928636651, - "velocityY": 1.097766672054747, + "heading": 3.257893442962062, + "angularVelocity": 0.9580688948089631, + "velocityX": -1.7947059286366505, + "velocityY": 1.0977666720547472, "moduleForcesX": [ - -71.52639870627524, - -89.45838724827226, - -55.36209082390232, - -75.61692556289127 + -71.5263987062752, + -89.45838724827225, + -55.36209082390229, + -75.61692556289125 ], "moduleForcesY": [ - 74.9291777122655, - 52.39133519711495, - 87.66530845618459, - 70.99242409781272 + 74.92917771226554, + 52.39133519711497, + 87.6653084561846, + 70.99242409781274 ], - "timestamp": 2.3443788345098198 + "timestamp": 2.3443788345098224 }, { - "x": 7.604447006986396, - "y": 1.0748288274783149, + "x": 7.604447006986394, + "y": 1.0748288274783147, "heading": 3.330112940587566, - "angularVelocity": 1.1315896580674487, - "velocityX": -1.9185339429936596, - "velocityY": 1.4264391274267907, + "angularVelocity": 1.1315896580674483, + "velocityX": -1.9185339429936592, + "velocityY": 1.426439127426791, "moduleForcesX": [ - -19.766010110953378, + -19.766010110953335, -56.93061698323477, - -19.68184871481916, + -19.68184871481914, -47.36930602917605 ], "moduleForcesY": [ 101.47075361978412, - 86.34001229995955, - 101.64986956083462, + 86.34001229995954, + 101.6498695608346, 92.08417613875184 ], - "timestamp": 2.408200112046804 + "timestamp": 2.408200112046807 }, { - "x": 7.496600987086121, - "y": 1.1832751788415659, + "x": 7.49660098708612, + "y": 1.1832751788415656, "heading": 3.4049089717941157, - "angularVelocity": 1.171960733051846, - "velocityX": -1.689812928576642, - "velocityY": 1.6992193755508294, + "angularVelocity": 1.1719607330518458, + "velocityX": -1.6898129285766412, + "velocityY": 1.6992193755508296, "moduleForcesX": [ - 70.7545238307989, + 70.75452383079893, 67.2502135728131, - 65.69679627017268, - 61.81300803108725 + 65.69679627017267, + 61.81300803108722 ], "moduleForcesY": [ - 75.40519753122972, + 75.4051975312297, 78.49699682759936, 79.87907669757777, - 82.88015487947983 + 82.88015487947986 ], - "timestamp": 2.4720213895837886 + "timestamp": 2.4720213895837913 }, { "x": 7.410809145133341, - "y": 1.2972469395306558, + "y": 1.2972469395306556, "heading": 3.4754003948557055, - "angularVelocity": 1.1045128800616704, - "velocityX": -1.3442514042916571, - "velocityY": 1.7857956638840902, + "angularVelocity": 1.1045128800616708, + "velocityX": -1.3442514042916565, + "velocityY": 1.7857956638840904, "moduleForcesX": [ 98.62488839987037, 98.5728623639948, 102.14680103093937, - 101.80621253364352 + 101.8062125336435 ], "moduleForcesY": [ - 31.723120096729687, - 32.017438994516304, - 17.325158702635157, - 19.43778678310921 + 31.723120096729684, + 32.0174389945163, + 17.32515870263519, + 19.437786783109235 ], - "timestamp": 2.535842667120773 + "timestamp": 2.5358426671207757 }, { - "x": 7.347703161601463, - "y": 1.4119343387372154, + "x": 7.347703161601462, + "y": 1.4119343387372152, "heading": 3.5395016960037164, - "angularVelocity": 1.0043876215242498, - "velocityX": -0.9887922330496858, - "velocityY": 1.797008828914432, + "angularVelocity": 1.00438762152425, + "velocityX": -0.9887922330496852, + "velocityY": 1.7970088289144321, "moduleForcesX": [ 103.21492466040641, 102.5340444041503, 103.15479218615785, - 103.73684891651338 + 103.7368489165134 ], "moduleForcesY": [ - 10.084977865190455, - 15.81269263577463, - -10.857317716288517, - -2.0233662096521496 + 10.084977865190448, + 15.812692635774624, + -10.857317716288497, + -2.02336620965214 ], - "timestamp": 2.5996639446577574 + "timestamp": 2.59966394465776 }, { - "x": 7.307225519445186, - "y": 1.5251286705269973, - "heading": 3.5964095924585773, - "angularVelocity": 0.8916759214336103, - "velocityX": -0.6342342823335027, - "velocityY": 1.7736143204620987, + "x": 7.307225519445185, + "y": 1.525128670526997, + "heading": 3.5964095924585777, + "angularVelocity": 0.8916759214336106, + "velocityX": -0.6342342823335022, + "velocityY": 1.7736143204620993, "moduleForcesX": [ 103.74866093971778, 103.44945570252287, @@ -88624,41 +88624,41 @@ 103.26271541637972 ], "moduleForcesY": [ - -1.704103468345933, - 8.460590728388368, - -23.303196470017358, - -10.611189708777841 + -1.7041034683459535, + 8.46059072838836, + -23.303196470017355, + -10.611189708777834 ], - "timestamp": 2.663485222194742 + "timestamp": 2.6634852221947445 }, { "x": 7.289250021057145, - "y": 1.6355954194055542, + "y": 1.635595419405554, "heading": 3.6457195990819606, - "angularVelocity": 0.7726264425654572, - "velocityX": -0.28165369108482585, - "velocityY": 1.730876490439123, + "angularVelocity": 0.7726264425654574, + "velocityX": -0.2816536910848256, + "velocityY": 1.7308764904391236, "moduleForcesX": [ 103.3950377520685, 103.7321422456981, - 99.41424789462361, + 99.4142478946236, 102.75753546713821 ], "moduleForcesY": [ - -9.12218556394263, - 4.334969983631569, - -29.912958244672346, + -9.122185563942644, + 4.334969983631551, + -29.912958244672343, -14.912737262065388 ], - "timestamp": 2.7273064997317262 + "timestamp": 2.727306499731729 }, { "x": 7.293661117553711, "y": 1.7425522804260254, "heading": 3.687185307179586, - "angularVelocity": 0.649716046088176, - "velocityX": 0.06911639294606202, - "velocityY": 1.675880915396745, + "angularVelocity": 0.6497160460881763, + "velocityX": 0.06911639294606219, + "velocityY": 1.6758809153967456, "moduleForcesX": [ 102.83835381995104, 103.82690448841359, @@ -88666,2238 +88666,2217 @@ 102.38468452490544 ], "moduleForcesY": [ - -14.237709698132518, - 1.6908860682116789, + -14.237709698132527, + 1.6908860682116629, -33.90397753188714, - -17.391714316675273 + -17.39171431667528 ], - "timestamp": 2.7911277772687106 + "timestamp": 2.7911277772687133 }, { - "x": 7.337238709014604, - "y": 1.87500903823816, - "heading": 3.7276018871038197, - "angularVelocity": 0.4861440875001379, - "velocityX": 0.5241657873061937, - "velocityY": 1.5932340089270574, + "x": 7.337238709014603, + "y": 1.8750090382381601, + "heading": 3.7276018871038192, + "angularVelocity": 0.4861440875001382, + "velocityX": 0.5241657873061938, + "velocityY": 1.593234008927058, "moduleForcesX": [ - 102.26407313635566, - 103.87008588403226, + 102.26407313635565, + 103.87008588403228, 97.23651288613812, 102.14881136766725 ], "moduleForcesY": [ - -18.1167751960945, - -0.13662685931345306, - -36.523872030709605, - -18.873918995735348 + -18.116775196094515, + -0.13662685931346932, + -36.52387203070962, + -18.873918995735366 ], - "timestamp": 2.874264816190781 + "timestamp": 2.8742648161907836 }, { - "x": 7.418144617115574, - "y": 1.9984157113823813, + "x": 7.418144617115573, + "y": 1.9984157113823817, "heading": 3.7537024581651615, - "angularVelocity": 0.3139463637357569, - "velocityX": 0.973163215216371, - "velocityY": 1.4843765756427652, + "angularVelocity": 0.31394636373575724, + "velocityX": 0.9731632152163713, + "velocityY": 1.4843765756427656, "moduleForcesX": [ - 100.52939508517865, - 103.73438246873789, - 94.67434050174212, + 100.52939508517862, + 103.7343824687379, + 94.67434050174211, 101.1881258515662 ], "moduleForcesY": [ - -25.98258070015821, - -4.920905115133015, - -42.6869167197914, - -23.418429128288864 + -25.98258070015823, + -4.920905115133046, + -42.68691671979141, + -23.41842912828889 ], - "timestamp": 2.957401855112851 + "timestamp": 2.957401855112854 }, { "x": 7.535048231941541, - "y": 2.108654455088382, + "y": 2.1086544550883826, "heading": 3.764158105558933, - "angularVelocity": 0.12576400999285073, - "velocityX": 1.4061556237954207, - "velocityY": 1.32598833366359, + "angularVelocity": 0.12576400999285112, + "velocityX": 1.406155623795421, + "velocityY": 1.3259883336635903, "moduleForcesX": [ - 95.63931861838329, - 102.78237917887598, + 95.63931861838326, + 102.78237917887597, 88.81788214328411, 98.62371306642002 ], "moduleForcesY": [ - -40.31051152213473, - -14.596292935414386, - -53.76177775288337, - -32.47987077107174 + -40.31051152213476, + -14.596292935414418, + -53.761777752883376, + -32.47987077107177 ], - "timestamp": 3.0405388940349214 + "timestamp": 3.040538894034924 }, { "x": 7.682469399516894, "y": 2.196017238119042, - "heading": 3.7560195778482997, - "angularVelocity": -0.09789292253073484, - "velocityX": 1.7732309147255072, - "velocityY": 1.0508286578807635, + "heading": 3.7560195778483, + "angularVelocity": -0.09789292253073449, + "velocityX": 1.7732309147255074, + "velocityY": 1.0508286578807637, "moduleForcesX": [ - 73.74963298837837, + 73.74963298837834, 95.21787023816454, - 69.85213902700369, - 88.30129043115058 + 69.85213902700366, + 88.30129043115056 ], "moduleForcesY": [ - -72.87651101750657, - -41.11318054758713, - -76.71810896892563, - -54.50208420442406 + -72.87651101750659, + -41.11318054758717, + -76.71810896892566, + -54.502084204424094 ], - "timestamp": 3.1236759329569916 + "timestamp": 3.1236759329569943 }, { "x": 7.827046544355028, "y": 2.245170461645328, - "heading": 3.7335207343789736, - "angularVelocity": -0.2706235843979915, + "heading": 3.733520734378974, + "angularVelocity": -0.2706235843979911, "velocityX": 1.7390220617991428, - "velocityY": 0.5912313472261188, + "velocityY": 0.591231347226119, "moduleForcesX": [ - -27.243123321085665, - -4.814624290303508, - -9.68112654908082, - 11.253488323161408 + -27.24312332108567, + -4.8146242903035255, + -9.681126549080819, + 11.253488323161399 ], "moduleForcesY": [ -99.95478411862625, -103.41484563118533, -103.20086487986812, - -103.00188639272085 + -103.00188639272083 ], - "timestamp": 3.206812971879062 + "timestamp": 3.2068129718790646 }, { "x": 7.939432858680839, "y": 2.2728190012561487, - "heading": 3.711795290511636, - "angularVelocity": -0.2613208763389104, - "velocityX": 1.351820028509299, - "velocityY": 0.3325658451311618, + "heading": 3.7117952905116365, + "angularVelocity": -0.2613208763389101, + "velocityX": 1.3518200285092992, + "velocityY": 0.3325658451311619, "moduleForcesX": [ -85.83973955060614, - -85.86349337551788, - -86.67105675311807, - -86.682687450033 + -85.86349337551786, + -86.67105675311805, + -86.68268745003297 ], "moduleForcesY": [ - -58.26066678399723, - -58.230272160397995, - -57.01652209858838, - -57.003560508651326 + -58.260666783997245, + -58.230272160398, + -57.0165220985884, + -57.003560508651354 ], - "timestamp": 3.289950010801132 + "timestamp": 3.289950010801135 }, { "x": 8.015204219703966, - "y": 2.2879711195258747, + "y": 2.287971119525875, "heading": 3.695746234916774, - "angularVelocity": -0.1930433871948052, - "velocityX": 0.9114031724674717, - "velocityY": 0.1822547262469813, + "angularVelocity": -0.19304338719480513, + "velocityX": 0.9114031724674719, + "velocityY": 0.18225472624698136, "moduleForcesX": [ -96.75469117814397, -96.05837459678298, -100.23022297352226, - -99.43633676223166 + -99.43633676223165 ], "moduleForcesY": [ -37.62667070086972, - -39.39983844031861, - -27.05066205494617, - -29.87331421433262 + -39.39983844031862, + -27.050662054946198, + -29.873314214332638 ], - "timestamp": 3.3730870497232024 + "timestamp": 3.373087049723205 }, { "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -0.10222248797976585, - "velocityX": 0.458089926796231, - "velocityY": 0.07860746516215023, + "angularVelocity": -0.10222248797976584, + "velocityX": 0.4580899267962311, + "velocityY": 0.07860746516215021, "moduleForcesX": [ -99.99595652451094, -98.93838085703482, - -102.93566476550784, + -102.93566476550782, -102.1023037702812 ], "moduleForcesY": [ - -28.01425430205255, + -28.014254302052557, -31.58059735167417, - -13.749709895364493, - -19.02119979206612 + -13.749709895364512, + -19.021199792066128 ], - "timestamp": 3.4562240886452726 + "timestamp": 3.4562240886452753 }, { "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -2.2487070096555965e-24, - "velocityX": -6.586009418122838e-24, - "velocityY": -6.745594827234793e-23, + "angularVelocity": 4.746550318316871e-18, + "velocityX": 3.830709578831724e-18, + "velocityY": -3.790242714904371e-17, "moduleForcesX": [ - -101.38094391616681, + -101.3809439161668, -100.18837572868954, -103.65752574347157, - -103.00222316967671 + -103.0022231696767 ], "moduleForcesY": [ -22.57602378649472, -27.420895846258933, - -6.612215074301221, - -13.442290586836583 + -6.612215074301234, + -13.442290586836586 ], - "timestamp": 3.539361127567343 + "timestamp": 3.5393611275673456 }, { - "x": 8.042267379204025, - "y": 2.286920400255937, - "heading": 3.6839492904550912, - "angularVelocity": -0.06738828727279574, - "velocityX": -0.22516253183784973, - "velocityY": -0.15498144231857655, - "moduleForcesX": [ - -90.23310642233936, - -90.46015989642483, - -80.90721847317343, - -79.21224337558162 - ], - "moduleForcesY": [ - -51.39622974657535, - -50.96352690092429, - -65.09806908584876, - -67.12671078256284 - ], - "timestamp": 3.5883083501973645 - }, - { - "x": 8.020118260548989, - "y": 2.27191020601647, - "heading": 3.67731157995458, - "angularVelocity": -0.1356095431743696, - "velocityX": -0.452510223561754, - "velocityY": -0.30666079570897453, + "x": 8.04155600019783, + "y": 2.2900230804484996, + "heading": 3.6835314194357935, + "angularVelocity": -0.07829646151040115, + "velocityX": -0.24718135110639422, + "velocityY": -0.09445343317829462, "moduleForcesX": [ - -90.97734104538547, - -91.27768795879761, - -81.73935810599804, - -80.12586427698638 + -99.51138063972249, + -101.00703312365503, + -92.29762670645609, + -93.00870017418045 ], "moduleForcesY": [ - -50.05478323953953, - -49.46918914887244, - -64.04043461006067, - -66.02198916487437 + -29.683224012710998, + -24.030989118219587, + -47.584016472907386, + -46.13389339344374 ], - "timestamp": 3.637255572827386 + "timestamp": 3.5868261144569775 }, { - "x": 7.986720121618324, - "y": 2.2496648858012405, - "heading": 3.667288353892784, - "angularVelocity": -0.20477619614005485, - "velocityX": -0.6823296018879611, - "velocityY": -0.4544756376347613, + "x": 8.018057195518905, + "y": 2.2811494373882057, + "heading": 3.6760894228573657, + "angularVelocity": -0.15678918432512154, + "velocityX": -0.49507660715139173, + "velocityY": -0.18695134325515003, "moduleForcesX": [ - -91.82209642527894, - -92.18311514570865, - -82.69994324479192, - -81.15631518014195 + -99.74002296606275, + -101.19538000468857, + -92.65070099257755, + -93.35296907893509 ], "moduleForcesY": [ - -48.47312480864625, - -47.74251349400657, - -62.783720018414115, - -64.73759795306572 + -28.886290968520573, + -23.19555788366235, + -46.88051907476131, + -45.41738404777075 ], - "timestamp": 3.6862027954574077 + "timestamp": 3.6342911013466095 }, { - "x": 7.941935287270955, - "y": 2.2204085553192443, - "heading": 3.653826669659306, - "angularVelocity": -0.27502447555055315, - "velocityX": -0.9149617065279765, - "velocityY": -0.5977117578894477, + "x": 7.982754275427238, + "y": 2.2679916233265414, + "heading": 3.664910946533458, + "angularVelocity": -0.23550994230548836, + "velocityX": -0.7437676148626708, + "velocityY": -0.2772109491597683, "moduleForcesX": [ - -92.78130460539496, - -93.19410470384004, - -83.81128188925368, - -82.33220529185469 + -100.00155441797193, + -101.39729726358, + -93.0583355862382, + -93.72397252125086 ], "moduleForcesY": [ - -46.59314409733099, - -45.71536994844289, - -61.27877787721252, - -63.21917457778012 + -27.944614997839846, + -22.261085973038842, + -46.051832228917284, + -44.62845550001454 ], - "timestamp": 3.7351500180874293 + "timestamp": 3.6817560882362415 }, { - "x": 7.885606145012031, - "y": 2.184410544194298, - "heading": 3.6368654595761822, - "angularVelocity": -0.34652037790435614, - "velocityX": -1.1508138609763638, - "velocityY": -0.7354454285801943, + "x": 7.93560492757735, + "y": 2.250672393954877, + "heading": 3.6499835048582434, + "angularVelocity": -0.31449374904337585, + "velocityX": -0.9933500661146728, + "velocityY": -0.36488431800970306, "moduleForcesX": [ - -93.87058194700928, - -94.3305748926031, - -85.10140955008177, - -83.69029359301578 + -100.29788416314965, + -101.61561762433931, + -93.52735002862231, + -94.13175992251685 ], "moduleForcesY": [ - -44.33581141832799, - -43.29398533047087, - -59.45771041589864, - -61.39028745543386 + -26.834219228647218, + -21.19949127166946, + -45.07503931940974, + -43.74038805618346 ], - "timestamp": 3.784097240717451 + "timestamp": 3.7292210751258734 }, { - "x": 7.817551278486936, - "y": 2.141999892045337, - "heading": 3.616333715880149, - "angularVelocity": -0.4194669808178373, - "velocityX": -1.3903723820961815, - "velocityY": -0.8664567644528267, + "x": 7.876561507986373, + "y": 2.2293351295184527, + "heading": 3.6312927818612053, + "angularVelocity": -0.39377916695729515, + "velocityX": -1.2439362877748312, + "velocityY": -0.44953692889872054, "moduleForcesX": [ - -95.10628659732889, - -95.61338727553908, - -86.60546294692051, - -85.27779037334444 + -100.63091275931306, + -101.85325235990693, + -94.0662420635145, + -94.58898722643158 ], "moduleForcesY": [ - -41.59126226883808, - -40.34628817483284, - -57.22442878703077, - -59.140688780590104 + -25.523497466552957, + -19.97371276998484, + -43.91957692503486, + -42.71725731589675 ], - "timestamp": 3.8330444633474725 + "timestamp": 3.7766860620155054 }, { - "x": 7.737561088001236, - "y": 2.0935863858643846, - "heading": 3.592148279739013, - "angularVelocity": -0.4941125326751832, - "velocityX": -1.6342130602654035, - "velocityY": -0.9890960830790406, + "x": 7.8055701014577625, + "y": 2.204149410872242, + "heading": 3.6088224461535567, + "angularVelocity": -0.4734086572044736, + "velocityX": -1.4956584035616685, + "velocityY": -0.5306167830756522, "moduleForcesX": [ - -96.50269363466799, - -97.06027029285035, - -88.36685045612268, - -87.1547135204852 + -101.00228721734821, + -102.1128986440163, + -94.68559764988736, + -95.11162514377558 ], "moduleForcesY": [ - -38.20314229261208, - -36.681729663577826, - -54.43913458067309, - -56.30652630732109 + -23.969873712700704, + -18.533565956987044, + -42.54396152487971, + -41.509936441328755 ], - "timestamp": 3.881991685977494 + "timestamp": 3.8241510489051374 }, { - "x": 7.645393467684546, - "y": 2.03969197754913, - "heading": 3.5642113237831787, - "angularVelocity": -0.5707567141654175, - "velocityX": -1.883000002132083, - "velocityY": -1.1010718365499048, + "x": 7.722569430006346, + "y": 2.1753187660940543, + "heading": 3.5825539547204364, + "angularVelocity": -0.553428814679775, + "velocityX": -1.7486715343285755, + "velocityY": -0.6074086745922084, "moduleForcesX": [ - -98.0646712363435, - -98.67496193551976, - -90.43697519136059, - -89.39473189465788 + -101.412834147822, + -102.3963066503469, + -95.39857355561514, + -95.71983629162236 ], "moduleForcesY": [ - -33.94342733722026, - -32.01865968778751, - -50.89195526213231, - -52.63580008371086 + -22.1146138290831, + -16.80930630512557, + -40.89061643024383, + -40.04973108891953 ], - "timestamp": 3.9309389086075157 + "timestamp": 3.8716160357947693 }, { - "x": 7.540771392641462, - "y": 1.9809991176716732, - "heading": 3.5324080450033617, - "angularVelocity": -0.6497463404657143, - "velocityX": -2.1374466092569384, - "velocityY": -1.1991050099226261, + "x": 7.627489656477081, + "y": 2.1430917308500237, + "heading": 3.552466371319351, + "angularVelocity": -0.63389006028899, + "velocityX": -2.0031560052914554, + "velocityY": -0.6789643768513749, "moduleForcesX": [ - -99.76955042301674, - -100.41971785352567, - -92.86965725890394, - -92.0790529699704 + -101.86129240177104, + -102.70256768115746, + -96.22136667221518, + -96.43893505032159 ], "moduleForcesY": [ - -28.4715548192435, - -25.931723671972655, - -46.25668565248566, - -47.72597287417353 + -19.87450898790123, + -14.701329976881233, + -38.877400569033554, + -38.237873659673255 ], - "timestamp": 3.9798861312375373 + "timestamp": 3.9190810226844013 }, { - "x": 7.423387798901581, - "y": 1.9184271511492825, - "heading": 3.496606398639386, - "angularVelocity": -0.7314336634499311, - "velocityX": -2.3981665850001437, - "velocityY": -1.27835581183747, + "x": 7.520251265886663, + "y": 2.1077781488351413, + "heading": 3.5185362794379946, + "angularVelocity": -0.714844648756607, + "velocityX": -2.259315710866347, + "velocityY": -0.7439922419123983, "moduleForcesX": [ - -101.52272463385668, - -102.1469107017657, - -95.69853790300179, - -95.26536323626863 + -102.34147627267791, + -103.02417396799694, + -97.17334997690496, + -97.30003102204127 ], "moduleForcesY": [ - -21.269168958218934, - -17.770998122924084, - -40.007572924195685, - -40.90863901385157 + -17.128069363556765, + -12.063145744424151, + -36.38316192720738, + -35.92745172132362 ], - "timestamp": 4.028833353867559 + "timestamp": 3.9665460095740332 }, { - "x": 7.292932816380647, - "y": 1.8532547705946691, - "heading": 3.4566645498803235, - "angularVelocity": -0.8160186955033512, - "velocityX": -2.6652172587402316, - "velocityY": -1.3314827083700613, + "x": 7.400764572383453, + "y": 2.0697740988296585, + "heading": 3.4807380145196527, + "angularVelocity": -0.796339942244816, + "velocityX": -2.51736493201164, + "velocityY": -0.8006754556693165, "moduleForcesX": [ - -103.04921333228688, - -103.43213563525939, - -98.86159408086765, - -98.87292685429789 + -102.83577382732888, + -103.33781837709795, + -98.27583595511979, + -98.33894311574731 ], "moduleForcesY": [ - -11.544949271307244, - -6.560069407755689, - -31.269777895580606, - -31.039659589782794 + -13.691698596586228, + -8.672231017023337, + -33.221926437578354, + -32.89082776312146 ], - "timestamp": 4.07778057649758 + "timestamp": 4.014010996463665 }, { - "x": 7.14918408141944, - "y": 1.7873106738525886, - "heading": 3.4124618351481057, - "angularVelocity": -0.903068904773904, - "velocityX": -2.9368108594794906, - "velocityY": -1.347249000020567, + "x": 7.2689314106331135, + "y": 2.0296016810214934, + "heading": 3.439044836951077, + "angularVelocity": -0.8783985902181007, + "velocityX": -2.777482317048192, + "velocityY": -0.8463589783696349, "moduleForcesX": [ - -103.63562609216031, - -103.19508156086872, - -101.9636791247673, - -102.297793014557 + -103.29961496935752, + -103.58217004765575, + -99.54614904632459, + -99.58862895612812 ], "moduleForcesY": [ - 1.8578199404637532, - 9.026980369120835, - -18.574046448195194, - -16.175083448707877 + -9.276827219626885, + -4.178448909532042, + -29.094262330489535, + -28.757755632981716 ], - "timestamp": 4.126727799127601 + "timestamp": 4.061475983353297 }, { - "x": 6.992257977502523, - "y": 1.7232224565630139, - "heading": 3.3639866140947756, - "angularVelocity": -0.9903569283131962, - "velocityX": -3.2060267260326114, - "velocityY": -1.3093330703153447, + "x": 7.124653502119942, + "y": 1.9879756803908264, + "heading": 3.393432804978208, + "angularVelocity": -0.9609616469277636, + "velocityX": -3.0396702486996596, + "velocityY": -0.8769832955485592, "moduleForcesX": [ - -101.58700144053036, - -99.04092706549442, - -103.57948992890111, - -103.28575192979112 + -103.62216827811297, + -103.60152394447236, + -100.97600742467284, + -101.04877430364988 ], "moduleForcesY": [ - 20.333355715385643, - 30.164112642791856, - 0.3712746034261658, - 6.521939841477385 + -3.4095505625262734, + 1.9894522183883672, + -23.490052769531545, + -22.89126748071193 ], - "timestamp": 4.175675021757622 + "timestamp": 4.108940970242929 }, { - "x": 6.823161968060095, - "y": 1.6645227955369413, - "heading": 3.3115006930198336, - "angularVelocity": -1.0722962050711007, - "velocityX": -3.4546599450714037, - "velocityY": -1.1992439585340129, + "x": 6.967861097841668, + "y": 1.9459210882345401, + "heading": 3.3438925458224324, + "angularVelocity": -1.0437221708490971, + "velocityX": -3.3033276643529277, + "velocityY": -0.8860129310508679, "moduleForcesX": [ - -93.54862615603459, - -87.12505304198946, - -99.68478228184767, - -95.98019931786078 + -103.51947999165917, + -102.99468331816422, + -102.45505555668103, + -102.57296891571525 ], "moduleForcesY": [ - 44.39868763909986, - 55.84311796842087, - 27.881573322185066, - 38.51078627303082 + 4.724347773856147, + 10.791054603518292, + -15.482230188456697, + -14.127507219444064 ], - "timestamp": 4.2246222443876436 + "timestamp": 4.156405957132561 }, { - "x": 6.64442651702477, - "y": 1.6150301081248706, - "heading": 3.2556875029374615, - "angularVelocity": -1.1402728711340493, - "velocityX": -3.6515953598907216, - "velocityY": -1.011143937341902, + "x": 6.798605926608696, + "y": 1.904988087661922, + "heading": 3.290464815782709, + "angularVelocity": -1.125624034489893, + "velocityX": -3.5658952488008056, + "velocityY": -0.8623830588172553, "moduleForcesX": [ - -75.58670515218044, - -65.41341394673287, - -83.26129301433434, - -73.82590929646548 + -102.22032427708363, + -100.69148391011608, + -103.48690787316097, + -103.44235697238129 ], "moduleForcesY": [ - 70.7269627500392, - 80.17399602370682, - 61.418213629826944, - 72.39463351959833 + 16.569411418577502, + 23.827896852783, + -3.273936939739203, + -0.23956401697252558 ], - "timestamp": 4.273569467017665 + "timestamp": 4.203870944022193 }, { - "x": 6.459747955634086, - "y": 1.5775049558527945, - "heading": 3.1976078744797825, - "angularVelocity": -1.1865765887614697, - "velocityX": -3.773014105143794, - "velocityY": -0.7666451793540634, + "x": 6.617365994453179, + "y": 1.867626940195305, + "heading": 3.233345431363907, + "angularVelocity": -1.2034004044204083, + "velocityX": -3.818392124836544, + "velocityY": -0.7871306813093759, "moduleForcesX": [ - -48.754658545853765, - -38.78516132328316, - -53.451745855433785, - -42.79147083400311 + -97.4964351201358, + -93.81211585906499, + -102.06328549780508, + -100.74989347493035 ], "moduleForcesY": [ - 91.32367097930855, - 95.96411440332321, - 88.60385895496529, - 94.18897282038556 + 34.58607042006599, + 43.38012581746179, + 16.68289517028768, + 22.81215275508421 ], - "timestamp": 4.322516689647686 + "timestamp": 4.251335930911825 }, { - "x": 6.272669917195343, - "y": 1.5531505703892592, - "heading": 3.1383417150669244, - "angularVelocity": -1.2108176159622883, - "velocityX": -3.8220358252563957, - "velocityY": -0.49756419577926697, + "x": 6.425959539225168, + "y": 1.8375524189497474, + "heading": 3.173140969039124, + "angularVelocity": -1.2683973233735604, + "velocityX": -4.0325820737484745, + "velocityY": -0.6336148647008714, "moduleForcesX": [ - -21.047088345037217, - -14.88450612601458, - -22.399140974726627, - -15.870003170324972 + -83.0793580408409, + -75.74454164980041, + -90.56807884095008, + -84.9365665532044 ], "moduleForcesY": [ - 101.40262934316833, - 102.48466604056495, - 101.08906364862342, - 102.31264843078472 + 61.40607447858171, + 70.1333997647084, + 49.57748404754354, + 58.505488397082836 ], - "timestamp": 4.371463912277707 + "timestamp": 4.298800917801457 }, { - "x": 6.085876927840109, - "y": 1.5421947938918785, - "heading": 3.0787272867385784, - "angularVelocity": -1.2179328085467576, - "velocityX": -3.8162122244841195, - "velocityY": -0.2238283585606515, + "x": 6.228897688944246, + "y": 1.8186603576908584, + "heading": 3.1111720980598196, + "angularVelocity": -1.3055701695100008, + "velocityX": -4.151730848027373, + "velocityY": -0.39802099372859684, "moduleForcesX": [ - 1.28984663500939, - 3.1977958082791926, - 1.1917630490161586, - 3.1353704420291226 + -48.29802014497603, + -40.33132670698785, + -52.811490595206955, + -44.53818050230527 ], "moduleForcesY": [ - 103.60661623587562, - 103.56505077845577, - 103.60195655485191, - 103.56110929339067 + 91.20355568795507, + 94.96047101888112, + 88.59300740140523, + 92.98083834186113 ], - "timestamp": 4.420411134907728 + "timestamp": 4.346265904691089 }, { - "x": 5.9012506330843415, - "y": 1.544471272265801, - "heading": 3.019361976734124, - "angularVelocity": -1.2128432792434443, - "velocityX": -3.7719462889918423, - "velocityY": 0.04650883648965221, + "x": 6.031703753180514, + "y": 1.812324789891614, + "heading": 3.048787154019588, + "angularVelocity": -1.3143360638712303, + "velocityX": -4.1545136460626555, + "velocityY": -0.1334787645738432, "moduleForcesX": [ - 17.462293324811608, - 16.0927923319585, - 17.39937814131849, - 16.04777728025772 + -2.1599097042320587, + 0.23951217753484877, + -2.4393520274010894, + 0.0160871967695788 ], "moduleForcesY": [ - 102.17914754620458, - 102.40362384187102, - 102.19343457298935, - 102.41424068304686 + 103.22994984050744, + 103.25066468571664, + 103.20778601077548, + 103.23489038346442 ], - "timestamp": 4.469358357537749 + "timestamp": 4.393730891580721 }, { - "x": 5.720109462738037, - "y": 1.5596987009048462, - "heading": 2.960670957642772, - "angularVelocity": -1.1990674023525598, - "velocityX": -3.7007446104858777, - "velocityY": 0.3110989310700059, + "x": 5.838288005789171, + "y": 1.8179815794617071, + "heading": 2.987084814881381, + "angularVelocity": -1.2999548336898101, + "velocityX": -4.074914164711231, + "velocityY": 0.1191781553091145, "moduleForcesX": [ - 28.918155728680293, - 25.26090248672073, - 28.563093727712385, - 25.03083365823741 + 33.269109007803046, + 29.421028827707513, + 32.63531064252144, + 28.92117898933171 ], "moduleForcesY": [ - 99.58409972188349, - 100.5733296943564, - 99.69486169755311, - 100.63917273673817 + 97.88150666677997, + 99.10269370028429, + 98.11607395134999, + 99.27126766658209 ], - "timestamp": 4.5183055801677705 + "timestamp": 4.441195878470353 }, { - "x": 5.467086369754889, - "y": 1.608315943409953, - "heading": 2.8777398443490734, - "angularVelocity": -1.1699447896759345, - "velocityX": -3.569505310449224, - "velocityY": 0.6858642950544216, + "x": 5.6509270668029785, + "y": 1.8346644639968877, + "heading": 2.9268466161891644, + "angularVelocity": -1.2691080866046227, + "velocityX": -3.9473504841914, + "velocityY": 0.3514777023129056, "moduleForcesX": [ - 37.110633318213495, - 31.845579277279175, - 36.60935471340153, - 31.604551220999983 + 54.557219185525284, + 47.10662649560467, + 52.23481946428302, + 45.215158498074324 ], "moduleForcesY": [ - 96.92740942126741, - 98.78190883714102, - 97.1253146659255, - 98.8667048935603 + 87.9480109752448, + 92.14125457174697, + 89.38412725469736, + 93.12237776631163 ], - "timestamp": 4.589190218507559 + "timestamp": 4.488660865359985 }, { - "x": 5.228866992709924, - "y": 1.6808350936944374, - "heading": 2.7987184964204332, - "angularVelocity": -1.1147880525234262, - "velocityX": -3.360662939451719, - "velocityY": 1.0230587611502073, + "x": 5.38507100164977, + "y": 1.8830556799414413, + "heading": 2.8404188381427997, + "angularVelocity": -1.206964524044126, + "velocityX": -3.7126818066149396, + "velocityY": 0.6757836684655287, "moduleForcesX": [ - 59.93331425285257, - 51.01709215758398, - 57.78209023791096, - 49.547643338616176 + 66.72846331028158, + 57.59774579035315, + 63.503281618778075, + 54.96790246952051 ], "moduleForcesY": [ - 84.70174546991043, - 90.34848029716736, - 86.20162312446539, - 91.18072937628781 + 79.37288585131948, + 86.21672384257603, + 82.00415549354298, + 87.94587304069235 ], - "timestamp": 4.660074856847348 + "timestamp": 4.5602684199522034 }, { - "x": 5.011723742658711, - "y": 1.7718777634914877, - "heading": 2.7257838036773063, - "angularVelocity": -1.0289209968669253, - "velocityX": -3.0633329750562632, - "velocityY": 1.284377996832451, + "x": 5.143346384858564, + "y": 1.9467965849215205, + "heading": 2.761004546429683, + "angularVelocity": -1.1090211384168227, + "velocityX": -3.375685961785028, + "velocityY": 0.8901421834091305, "moduleForcesX": [ - 84.76572357068362, - 74.96765408925388, - 80.2383461943941, - 70.79484109399709 + 93.74953605342704, + 86.18692065004286, + 88.50666550737564, + 80.22596087781076 ], "moduleForcesY": [ - 59.80528809358341, - 71.6849991388353, - 65.79112728880133, - 75.84706545896569 + 44.334189316001165, + 57.62394594710871, + 54.09828635812438, + 65.72728284950935 ], - "timestamp": 4.730959495187136 + "timestamp": 4.631875974544422 }, { - "x": 4.820647432846547, - "y": 1.873141713864737, - "heading": 2.6607448349840026, - "angularVelocity": -0.9175326307166438, - "velocityX": -2.6955954673314677, - "velocityY": 1.428573986479781, + "x": 4.929333767387997, + "y": 2.0174366654365876, + "heading": 2.690018539768091, + "angularVelocity": -0.9913200788076207, + "velocityX": -2.9886876975747554, + "velocityY": 0.9864892176106754, "moduleForcesX": [ - 101.00986249777799, - 96.10854339543843, - 96.9286920524181, - 90.30878865548299 + 103.24738699653997, + 101.0121859942123, + 100.38393572494448, + 95.76003337310947 ], "moduleForcesY": [ - 23.644613389650427, - 38.97112673980988, - 37.036581210585425, - 51.060010910549146 + 10.088544648544431, + 23.460609845249287, + 26.250656903011137, + 39.88459892674545 ], - "timestamp": 4.801844133526925 + "timestamp": 4.703483529136641 }, { - "x": 4.657509621107699, - "y": 1.9756961760175065, - "heading": 2.604521572828749, - "angularVelocity": -0.7931656769657904, - "velocityX": -2.3014550904081728, - "velocityY": 1.44677978973625, + "x": 4.7438644840225095, + "y": 2.0884223679161025, + "heading": 2.6280208337517874, + "angularVelocity": -0.8657983975202782, + "velocityX": -2.5900798378039753, + "velocityY": 0.9913158310575519, "moduleForcesX": [ - 103.19738359227847, - 103.72054443575398, - 103.49434008790791, - 101.5396563829404 + 102.83526119368163, + 103.67090860218237, + 103.67025296676273, + 102.23886101741424 ], "moduleForcesY": [ - -10.817553101285721, - 0.8550148862546341, - 7.678543308436053, - 21.312534299325236 + -13.933835689919919, + -3.7386929134956266, + 4.950653494760573, + 17.715678179992125 ], - "timestamp": 4.872728771866713 + "timestamp": 4.775091083728859 }, { - "x": 4.52173266583132, - "y": 2.07244812277131, - "heading": 2.557278720564778, - "angularVelocity": -0.6664751823591233, - "velocityX": -1.915463751476393, - "velocityY": 1.3649212159342432, + "x": 4.5866372251458625, + "y": 2.1552385034426114, + "heading": 2.575144646059974, + "angularVelocity": -0.7384163304125048, + "velocityX": -2.19567976805722, + "velocityY": 0.9330877990775547, "moduleForcesX": [ - 97.61435766859866, - 99.6011131749049, - 102.58825345734893, - 103.63090006850514 + 99.54412665319884, + 101.40753250877371, + 103.32899619969018, + 103.78108426641127 ], "moduleForcesY": [ - -35.268770461587025, - -29.065839121035793, - -15.80955389013574, - -5.413670712377771 + -29.427597778899138, + -22.02325540050219, + -9.999738927376326, + 1.2055925555842326 ], - "timestamp": 4.943613410206502 + "timestamp": 4.846698638321078 }, { - "x": 4.411830591378865, - "y": 2.1585354918951616, - "heading": 2.51876748636365, - "angularVelocity": -0.5432945007989202, - "velocityX": -1.5504357083072682, - "velocityY": 1.2144714445912563, + "x": 4.45702944180966, + "y": 2.2148008989688965, + "heading": 2.531346475674566, + "angularVelocity": -0.6116417553261012, + "velocityX": -1.8099735999287732, + "velocityY": 0.8317892696043293, "moduleForcesX": [ - 90.47854282502254, - 91.83285534237497, - 98.58812625350899, - 100.62445455688419 + 95.96812342989033, + 98.04572669881219, + 101.79189444348697, + 103.26094436840614 ], "moduleForcesY": [ - -50.901475267722624, - -48.35511926084885, - -32.53677718349569, - -25.45535608630757 + -39.61546892739203, + -34.07129292769581, + -20.46914580913734, + -10.651513351600967 ], - "timestamp": 5.01449804854629 + "timestamp": 4.918306192913296 }, { - "x": 4.3262415482856165, - "y": 2.230721782989921, - "heading": 2.488611108566075, - "angularVelocity": -0.42542895758343663, - "velocityX": -1.2074413455137303, - "velocityY": 1.0183629737762252, + "x": 4.354388254594759, + "y": 2.2649421325832035, + "heading": 2.496522874025983, + "angularVelocity": -0.48631184023641394, + "velocityX": -1.4333848962381666, + "velocityY": 0.7002226776455226, "moduleForcesX": [ - 84.07525354896863, - 84.42849078503647, - 93.9888010492201, - 96.0020319753479 + 92.7907537763575, + 94.8155739460098, + 100.00318758141623, + 102.02388828803367 ], "moduleForcesY": [ - -60.92976824507471, - -60.40104086303051, - -44.13196396617181, - -39.50801066886383 + -46.60791622206078, + -42.282733802481594, + -27.97777559095913, + -19.25551682225231 ], - "timestamp": 5.085382686886079 + "timestamp": 4.989913747505515 }, { - "x": 4.263589020412451, - "y": 2.2868059201143556, - "heading": 2.466437553417309, - "angularVelocity": -0.3128118541351126, - "velocityX": -0.8838660863703308, - "velocityY": 0.7912029804764343, + "x": 4.278118050279357, + "y": 2.3040837289983593, + "heading": 2.4705582318655237, + "angularVelocity": -0.36259640911227725, + "velocityX": -1.0651139355949073, + "velocityY": 0.5466126669277778, "moduleForcesX": [ - 78.82081144473382, - 78.2947277286741, - 89.72768925430235, - 91.35467904089971 + 90.1187469058319, + 91.995376602234, + 98.29771671442934, + 100.61570105327873 ], "moduleForcesY": [ - -67.61078851767357, - -68.19198593943935, - -52.27861117061747, - -49.344165998038456 + -51.60847738463325, + -48.14285693742628, + -33.513140486900426, + -25.666450933577256 ], - "timestamp": 5.156267325225867 + "timestamp": 5.061521302097733 }, { - "x": 4.222720463089765, - "y": 2.325236543036976, - "heading": 2.451919310286384, - "angularVelocity": -0.20481508364804626, - "velocityX": -0.576550269280934, - "velocityY": 0.5421572829136999, + "x": 4.227698728083314, + "y": 2.3310369086387626, + "heading": 2.4533426833893883, + "angularVelocity": -0.2404152547055344, + "velocityX": -0.7041061865523344, + "velocityY": 0.37640134201140235, "moduleForcesX": [ - 74.60403531213795, - 73.36398730793962, - 86.04738983964184, - 87.18827457983765 + 87.90888243626851, + 89.58265687469483, + 96.7811494551446, + 99.2400496777036 ], "moduleForcesY": [ - -72.2521437562441, - -73.49008857932517, - -58.15497382694532, - -56.40308380016812 + -55.30576952737938, + -52.51878339626849, + -37.692133911621376, + -30.590607959006878 ], - "timestamp": 5.227151963565656 + "timestamp": 5.133128856689952 }, { - "x": 4.202682018280029, - "y": 2.3448798656463623, - "heading": 2.4447778743923783, - "angularVelocity": -0.10074729957389103, - "velocityX": -0.2826909366974499, - "velocityY": 0.27711677832402926, + "x": 4.2026820182780895, + "y": 2.3448798656255554, + "heading": 2.444777874392378, + "angularVelocity": -0.11960761746132077, + "velocityX": -0.34935852732262185, + "velocityY": 0.19331699150554127, "moduleForcesX": [ - 71.22468650853797, - 69.3870865231279, - 82.9455645855158, - 83.58175463898205 + 86.09072271913463, + 87.50803229096606, + 95.47488145367366, + 97.96216818816397 ], "moduleForcesY": [ - -75.5969633085211, - -77.27040216937355, - -62.51253196312979, - -61.63801883584066 + -58.108421977440734, + -55.92431623005057, + -40.90491902309583, + -34.48857338358015 ], - "timestamp": 5.298036601905444 + "timestamp": 5.204736411282171 }, { "x": 4.202682018280029, - "y": 2.3448798656463623, + "y": 2.344879865646362, "heading": 2.4447778743923783, - "angularVelocity": -5.80382960829085e-23, - "velocityX": 1.3673447485380094e-21, - "velocityY": -7.76305297216273e-23, + "angularVelocity": 5.168003878366018e-17, + "velocityX": 4.1453752254911594e-17, + "velocityY": 8.192712538061972e-17, "moduleForcesX": [ - 68.50416083765214, - 66.13446697456098, - 80.349821554819, - 80.4775374470252 + 84.5994600681018, + 85.69781853498485, + 94.37037678492582, + 96.79234259000295 ], "moduleForcesY": [ - -78.07954947028286, - -80.08289970808126, - -65.825574909368, - -65.65190327177945 + -60.26906063131338, + -58.67389816054446, + -43.40532121869834, + -37.66504124484338 ], - "timestamp": 5.368921240245233 + "timestamp": 5.276343965874389 }, { - "x": 4.201703407238958, + "x": 4.201703407238959, "y": 2.344928891411713, "heading": 2.4109202649275003, - "angularVelocity": -0.8588869565571112, - "velocityX": -0.02482503259982727, - "velocityY": 0.0012436669647010426, + "angularVelocity": -0.8588869565571109, + "velocityX": -0.024825032599826515, + "velocityY": 0.00124366696470136, "moduleForcesX": [ - -28.227322752614786, - 103.42278400099644, - -103.75844967549132, - -18.094061998184152 + -28.22732275261409, + 103.42278400099643, + -103.75844967549133, + -18.094061998183502 ], "moduleForcesY": [ - 99.90321784851972, - 8.536606790573616, - -3.8816893662670853, - -102.22074328548473 + 99.90321784851992, + 8.53660679057382, + -3.8816893662669205, + -102.22074328548484 ], - "timestamp": 5.40834157281216 + "timestamp": 5.315764298441317 }, { "x": 4.19960599570747, "y": 2.344567972526076, - "heading": 2.3434151950983257, + "heading": 2.343415195098326, "angularVelocity": -1.7124429306770592, - "velocityX": -0.05320633781888569, - "velocityY": -0.009155652987557033, + "velocityX": -0.05320633781888414, + "velocityY": -0.009155652987556358, "moduleForcesX": [ - -27.118032037334096, - 102.87897965174633, + -27.118032037333307, + 102.87897965174639, -103.65492919654237, - -25.446854262350335 + -25.446854262349746 ], "moduleForcesY": [ - 100.17273398636637, - -13.32089023629324, - -5.763677170586516, - -100.6330188752554 + 100.17273398636658, + -13.320890236292788, + -5.763677170586371, + -100.63301887525554 ], - "timestamp": 5.447761905379088 + "timestamp": 5.355184631008244 }, { "x": 4.1960512028500485, - "y": 2.3431299343053045, - "heading": 2.243041963319051, - "angularVelocity": -2.546229959091813, - "velocityX": -0.09017663286798999, - "velocityY": -0.03647960651602133, - "moduleForcesX": [ - -25.33343532040246, - 93.27197212593993, + "y": 2.343129934305304, + "heading": 2.2430419633190515, + "angularVelocity": -2.546229959091814, + "velocityX": -0.09017663286798745, + "velocityY": -0.03647960651602015, + "moduleForcesX": [ + -25.333435320401506, + 93.27197212594027, -103.44021230394544, - -33.98161373425351 + -33.98161373425298 ], "moduleForcesY": [ - 100.56440767021368, - -45.312631622641916, - -8.536330867305994, - -98.06905659928213 + 100.56440767021392, + -45.312631622641206, + -8.536330867305882, + -98.0690565992823 ], - "timestamp": 5.487182237946016 + "timestamp": 5.394604963575172 }, { "x": 4.190293529660696, - "y": 2.3398051514706095, - "heading": 2.111921828848045, - "angularVelocity": -3.326205689624509, - "velocityX": -0.1460584630933037, - "velocityY": -0.08434182611347482, + "y": 2.339805151470608, + "heading": 2.1119218288480455, + "angularVelocity": -3.3262056896245125, + "velocityX": -0.14605846309329973, + "velocityY": -0.08434182611347314, "moduleForcesX": [ - -27.49060665939882, - 66.97560497296121, - -102.56378310330503, - -41.947517197804814 + -27.490606659397372, + 66.97560497296193, + -102.56378310330504, + -41.94751719780439 ], "moduleForcesY": [ - 99.77621827507902, - -79.12850743515231, - -15.681873461362015, - -94.91979752927205 + 99.77621827507942, + -79.12850743515172, + -15.681873461361965, + -94.91979752927223 ], - "timestamp": 5.526602570512943 + "timestamp": 5.434025296142099 }, { "x": 4.180004921895993, "y": 2.331957993445509, - "heading": 1.9628540404616008, - "angularVelocity": -3.7814949463796665, - "velocityX": -0.260997487711088, - "velocityY": -0.19906371951014543, + "heading": 1.9628540404616013, + "angularVelocity": -3.781494946379674, + "velocityX": -0.2609974877110832, + "velocityY": -0.1990637195101428, "moduleForcesX": [ - -101.10990652767909, - 29.517572053746953, - -97.66177710983962, - -46.76638489941762 + -101.10990652767879, + 29.517572053747624, + -97.66177710983959, + -46.7663848994173 ], "moduleForcesY": [ - 11.251940941172409, - -99.37458530974946, - -34.87193793205709, - -92.61783003234635 + 11.251940941173997, + -99.37458530974925, + -34.87193793205716, + -92.61783003234652 ], - "timestamp": 5.566022903079871 + "timestamp": 5.473445628709027 }, { - "x": 4.166361351302606, - "y": 2.3164379306505576, - "heading": 1.8072932986079373, - "angularVelocity": -3.9462057198414553, - "velocityX": -0.3461049084307693, - "velocityY": -0.3937070487318249, + "x": 4.166361351302605, + "y": 2.3164379306505567, + "heading": 1.8072932986079375, + "angularVelocity": -3.946205719841463, + "velocityX": -0.3461049084307636, + "velocityY": -0.3937070487318224, "moduleForcesX": [ - -33.36951073216951, - -5.706270650379014, - -75.36467871982056, - -45.51345754575896 + -33.369510732168834, + -5.706270650378617, + -75.36467871982032, + -45.51345754575867 ], "moduleForcesY": [ - -97.93226744361932, - -103.51923261668531, - -71.1617240805949, - -93.20638112745955 + -97.93226744361955, + -103.51923261668534, + -71.16172408059515, + -93.2063811274597 ], - "timestamp": 5.605443235646798 + "timestamp": 5.5128659612759545 }, { "x": 4.149916591020042, - "y": 2.2926823181951774, - "heading": 1.65181054109108, - "angularVelocity": -3.944227442852698, - "velocityX": -0.41716442281767707, - "velocityY": -0.602623339492322, + "y": 2.292682318195177, + "heading": 1.6518105410910802, + "angularVelocity": -3.9442274428527058, + "velocityX": -0.41716442281767085, + "velocityY": -0.6026233394923195, "moduleForcesX": [ - -33.55166682694357, - -33.80304782175004, - -32.97397566453504, - -33.22309184918086 + -33.551666826943425, + -33.80304782174995, + -32.97397566453473, + -33.22309184918061 ], "moduleForcesY": [ - -98.10698033320081, - -98.01915041897836, - -98.30200452433485, - -98.21658224726805 + -98.10698033320087, + -98.01915041897838, + -98.30200452433495, + -98.21658224726814 ], - "timestamp": 5.644863568213726 + "timestamp": 5.552286293842882 }, { - "x": 4.131295062523411, - "y": 2.2607333178953537, - "heading": 1.5019050907593101, - "angularVelocity": -3.80274443593949, - "velocityX": -0.472383850770812, - "velocityY": -0.8104700853444186, + "x": 4.13129506252341, + "y": 2.2607333178953555, + "heading": 1.5019050907593103, + "angularVelocity": -3.802744435939497, + "velocityX": -0.47238385077080564, + "velocityY": -0.8104700853444158, "moduleForcesX": [ - -40.2168329104546, - -55.21625645355153, - -4.835470491948852, - -3.5127997094387298 + -40.21683291045461, + -55.21625645355164, + -4.835470491948728, + -3.5127997094385286 ], "moduleForcesY": [ - -95.64897949611914, - -87.757099641864, + -95.64897949611913, + -87.75709964186395, -103.63779020013178, -103.59070739238904 ], - "timestamp": 5.684283900780653 + "timestamp": 5.59170662640981 }, { "x": 4.111026763916016, "y": 2.221068859100342, "heading": 1.3630312678774887, - "angularVelocity": -3.5228983075178477, - "velocityX": -0.5141584884648978, - "velocityY": -1.0061929012818376, + "angularVelocity": -3.522898307517854, + "velocityX": -0.5141584884648915, + "velocityY": -1.0061929012818345, "moduleForcesX": [ - -47.929085434488584, - -71.96458253113931, - 6.298074117284643, - 35.08285193940007 + -47.92908543448869, + -71.96458253113951, + 6.29807411728461, + 35.082851939400115 ], "moduleForcesY": [ - -92.06794236589327, - -74.62301016758721, - -103.60506557630978, - -97.55241293864256 + -92.06794236589322, + -74.62301016758703, + -103.60506557630977, + -97.55241293864255 ], - "timestamp": 5.723704233347581 + "timestamp": 5.631126958976737 }, { - "x": 4.062724486802488, - "y": 2.110555894865889, - "heading": 1.1420372292372407, - "angularVelocity": -2.7416930766221763, - "velocityX": -0.5992470184357392, - "velocityY": -1.3710443538788295, + "x": 4.062724486802489, + "y": 2.1105558948658896, + "heading": 1.1420372292372403, + "angularVelocity": -2.7416930766221816, + "velocityX": -0.5992470184357338, + "velocityY": -1.3710443538788264, "moduleForcesX": [ - -58.73772933370447, - -84.11029030603055, - 5.233285508187558, - 59.405679960771735 + -58.737729333704614, + -84.11029030603079, + 5.2332855081874134, + 59.40567996077163 ], "moduleForcesY": [ - -85.66951767872665, - -60.775439425919956, - -103.74545811129138, - -85.16250520967935 + -85.66951767872655, + -60.77543942591964, + -103.7454581112914, + -85.16250520967942 ], - "timestamp": 5.804309185274774 + "timestamp": 5.71173191090393 }, { "x": 4.007017393904712, "y": 1.9705835820032092, - "heading": 0.9812050036884946, - "angularVelocity": -1.9953144528145002, - "velocityX": -0.6911125379504645, - "velocityY": -1.7365225028495959, + "heading": 0.9812050036884937, + "angularVelocity": -1.9953144528145033, + "velocityX": -0.69111253795046, + "velocityY": -1.7365225028495925, "moduleForcesX": [ - -64.22141665906422, - -80.12397623088805, - -0.09600908354098996, - 60.003283291507636 + -64.22141665906439, + -80.12397623088835, + -0.09600908354117038, + 60.0032832915075 ], "moduleForcesY": [ - -81.61082059327089, - -65.73350813646502, + -81.61082059327076, + -65.73350813646466, -103.8621786778673, - -84.72244048801421 + -84.72244048801433 ], - "timestamp": 5.884914137201967 + "timestamp": 5.792336862831124 }, { "x": 3.943851323495702, - "y": 1.8018787684532644, - "heading": 0.8821659959765331, - "angularVelocity": -1.2286963188244244, - "velocityX": -0.7836499979066395, - "velocityY": -2.092983241306668, + "y": 1.8018787684532651, + "heading": 0.882165995976532, + "angularVelocity": -1.2286963188244255, + "velocityX": -0.7836499979066361, + "velocityY": -2.0929832413066642, "moduleForcesX": [ - -68.62017364940806, - -80.1006769069396, - -1.411311275947935, - 65.07642963174425 + -68.62017364940823, + -80.10067690694001, + -1.4113112759481592, + 65.07642963174403 ], "moduleForcesY": [ - -77.88958304459304, - -65.089910548468, - -103.82208570578915, - -80.83902294562851 + -77.8895830445929, + -65.0899105484675, + -103.82208570578916, + -80.83902294562868 ], - "timestamp": 5.9655190891291605 + "timestamp": 5.872941814758317 }, { - "x": 3.8781108764118923, - "y": 1.62015655248617, - "heading": 0.9059483264084738, - "angularVelocity": 0.2950480071425667, - "velocityX": -0.8155881929337341, - "velocityY": -2.2544795527108175, + "x": 3.8781108764118932, + "y": 1.6201565524861705, + "heading": 0.9059483264084722, + "angularVelocity": 0.29504800714256113, + "velocityX": -0.815588192933734, + "velocityY": -2.2544795527108152, "moduleForcesX": [ - -72.70004868646518, - -50.250066546788176, - 8.938812986150849, - 84.6553358689454 + -72.70004868646532, + -50.25006654679044, + 8.938812986150491, + 84.65533586894512 ], "moduleForcesY": [ - -73.92227873323378, - 88.67129288393822, - -103.36018720677365, - -59.82803222008088 + -73.92227873323364, + 88.67129288393693, + -103.36018720677367, + -59.828032220081276 ], - "timestamp": 6.046124041056354 + "timestamp": 5.95354676668551 }, { "x": 3.82485357780854, - "y": 1.4531042418213815, - "heading": 1.0372615296620737, - "angularVelocity": 1.6290959812519923, - "velocityX": -0.660719935066242, - "velocityY": -2.0724819836835775, + "y": 1.4531042418213824, + "heading": 1.0372615296620726, + "angularVelocity": 1.6290959812519983, + "velocityX": -0.6607199350662438, + "velocityY": -2.072481983683578, "moduleForcesX": [ - -73.9628963267555, - 29.478911488108032, - 92.80376149106614, - 94.02725852427287 + -73.96289632675686, + 29.47891148810785, + 92.80376149106574, + 94.02725852427297 ], "moduleForcesY": [ - 69.9865243622358, - 99.10987378380912, - -45.02524501367293, - 43.211766667495525 + 69.98652436223436, + 99.10987378380918, + -45.02524501367373, + 43.211766667495276 ], - "timestamp": 6.126728992983547 + "timestamp": 6.034151718612703 }, { "x": 3.7854736830756957, - "y": 1.3195187350370476, - "heading": 1.1596419881635687, - "angularVelocity": 1.5182746912625922, - "velocityX": -0.4885542859502548, - "velocityY": -1.6572866007661222, + "y": 1.3195187350370479, + "heading": 1.1596419881635682, + "angularVelocity": 1.5182746912625973, + "velocityX": -0.48855428595025646, + "velocityY": -1.6572866007661224, "moduleForcesX": [ - 47.382251388920984, - 48.46951456581909, - 32.104806016987034, - 30.2893465166195 + 47.38225138892106, + 48.46951456581919, + 32.104806016986984, + 30.2893465166194 ], "moduleForcesY": [ - 92.24628285703518, - 91.63195838513802, - 98.60962299241723, - 99.13863942195309 + 92.24628285703513, + 91.63195838513796, + 98.60962299241726, + 99.13863942195313 ], - "timestamp": 6.20733394491074 + "timestamp": 6.114756670539896 }, { - "x": 3.7572242233614133, + "x": 3.7572242233614137, "y": 1.2196002881884476, - "heading": 1.2584600862248756, - "angularVelocity": 1.22595567268082, - "velocityX": -0.3504680424572255, + "heading": 1.2584600862248754, + "angularVelocity": 1.2259556726808236, + "velocityX": -0.35046804245722674, "velocityY": -1.2396068040441512, "moduleForcesX": [ - 49.28365457148797, - 57.86750411793015, - 14.612587070047223, - 5.158114346545566 + 49.283654571488064, + 57.86750411793033, + 14.612587070047217, + 5.158114346545502 ], "moduleForcesY": [ - 91.37280556707458, - 86.12414163106692, - 102.782755901925, + 91.37280556707454, + 86.1241416310668, + 102.78275590192501, 103.63034751499849 ], - "timestamp": 6.287938896837933 + "timestamp": 6.1953616224670895 }, { "x": 3.738947473265417, - "y": 1.153151514149799, - "heading": 1.3274153889759315, - "angularVelocity": 0.8554722892625776, - "velocityX": -0.22674475524164925, + "y": 1.1531515141497997, + "heading": 1.3274153889759313, + "angularVelocity": 0.8554722892625797, + "velocityX": -0.2267447552416501, "velocityY": -0.8243758286546562, "moduleForcesX": [ - 48.61931337934166, - 62.846738605842184, - 7.378601440653287, - -5.124493078192649 + 48.61931337934176, + 62.84673860584237, + 7.3786014406533145, + -5.124493078192651 ], "moduleForcesY": [ - 91.7705326878624, - 82.62185421955228, + 91.77053268786236, + 82.62185421955213, 103.59052194670481, - 103.67630959459125 + 103.67630959459123 ], - "timestamp": 6.3685438487651265 + "timestamp": 6.275966574394283 }, { "x": 3.73, - "y": 1.12, + "y": 1.1199999999999999, "heading": 1.3630312678774887, - "angularVelocity": 0.44185720666055006, - "velocityX": -0.11100401466027994, - "velocityY": -0.41128383997727014, + "angularVelocity": 0.4418572066605511, + "velocityX": -0.11100401466028038, + "velocityY": -0.4112838399772702, "moduleForcesX": [ - 48.05959947460402, - 65.55089466299441, - 3.545184653333839, - -10.772669788473484 + 48.05959947460411, + 65.55089466299457, + 3.54518465333388, + -10.772669788473445 ], "moduleForcesY": [ - 92.08571544205489, - 80.52833862168941, + 92.08571544205485, + 80.52833862168929, 103.81078891723752, 103.268327544522 ], - "timestamp": 6.44914880069232 + "timestamp": 6.356571526321476 }, { "x": 3.73, "y": 1.12, "heading": 1.3630312678774887, - "angularVelocity": 3.806016005451674e-22, - "velocityX": 1.1811367619243883e-22, - "velocityY": 1.878055725323778e-21, + "angularVelocity": -3.589610570804574e-21, + "velocityX": 5.339550258707543e-21, + "velocityY": -2.502223964641149e-20, "moduleForcesX": [ - 48.217410638261995, - 66.96008834120764, - 1.7871900274204235, - -14.935437840905193 + 48.2174106382621, + 66.96008834120781, + 1.7871900274204708, + -14.935437840905156 ], "moduleForcesY": [ - 92.01539367318387, - 79.38179672545625, + 92.01539367318382, + 79.38179672545613, 103.86711250635297, 102.76690919104156 ], - "timestamp": 6.529753752619513 + "timestamp": 6.437176478248669 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.5095116837609095, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.709497073488135e-16, - "velocityY": -1.4947758853647621e-16, + "x": 3.72087766585563, + "y": 1.1208176986079128, + "heading": 1.431626602021572, + "angularVelocity": 1.1235612635077608, + "velocityX": -0.14941980245858624, + "velocityY": 0.013393541886655683, "moduleForcesX": [ - -77.80402381445582, - -68.80771039095391, - 68.8077103909537, - 77.80402381445577 + -96.6383007361533, + -88.19573664846793, + -12.8532068373394, + 16.362081392441013 ], "moduleForcesY": [ - -68.80771039095379, - 77.8040238144557, - -77.80402381445587, - 68.80771039095383 + -38.07025222846023, + 54.85615378968718, + -103.0065453160445, + 102.47408622697547 ], - "timestamp": 6.611199748130065 + "timestamp": 6.498228186216892 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.802386311093262, - "angularVelocity": 3.595936491370013, - "velocityX": -5.571400134063502e-16, - "velocityY": -3.009483254088862e-16, + "x": 3.7060685799077318, + "y": 1.1216188501069515, + "heading": 1.5768366563753402, + "angularVelocity": 2.3784765272963293, + "velocityX": -0.24256628423237084, + "velocityY": 0.013122507554436695, "moduleForcesX": [ - -54.593644788232, - -88.28820574759457, - 88.28820574759443, - 54.593644788231884 + -88.8285234526177, + -89.30381940223486, + 33.24862083207597, + 31.84782787273839 ], "moduleForcesY": [ - -88.28820574759447, - 54.593644788231835, - -54.593644788232055, - 88.28820574759455 + -53.74418536835451, + 52.95104455482856, + -98.25981269878262, + 98.72404567269594 ], - "timestamp": 6.692645743640616 + "timestamp": 6.5592798941851145 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.0952609384256147, - "angularVelocity": 3.5959364913700127, - "velocityX": -5.444414637967877e-16, - "velocityY": -2.972769677792861e-16, + "x": 3.6934340527017753, + "y": 1.1220954757151458, + "heading": 1.8032677618817912, + "angularVelocity": 3.708841456561832, + "velocityX": -0.20694797289753816, + "velocityY": 0.00780691685910522, "moduleForcesX": [ - 8.817109797269002e-15, - 2.5092224152930147e-14, - -1.931655743496392e-14, - -3.041443079302774e-15 + -35.05819106953644, + -82.5405267662809, + 91.56935681606274, + 69.25319076809818 ], "moduleForcesY": [ - 2.303931047982611e-14, - -5.0943567524068115e-15, - 6.764196124164912e-15, - -2.1369471108068058e-14 + -97.51255338667491, + 62.56571622690056, + -48.643052215626845, + 77.13926949432349 ], - "timestamp": 6.774091739151168 + "timestamp": 6.620331602153337 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.2417413543090356, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.6928205770985715e-16, - "velocityY": -1.3976239164731637e-16, + "x": 3.7016410085682656, + "y": 1.1214615431425257, + "heading": 2.0300291224213423, + "angularVelocity": 3.714250888076378, + "velocityX": 0.1344263107389409, + "velocityY": -0.010383535428491778, "moduleForcesX": [ - 11.854773337595287, - 103.12486448237142, - -103.1248644823714, - -11.85477333759506 + 103.52224314206727, + 103.57865086400795, + 103.55804416719118, + 103.60842497193357 ], "moduleForcesY": [ - 103.1248644823714, - -11.85477333759509, - 11.854773337595256, - -103.12486448237142 + -6.3201721524407395, + -5.293000752987987, + -5.7410129870185775, + -4.720443231127713 ], - "timestamp": 6.85553773466172 + "timestamp": 6.68138331012156 }, { "x": 3.73, "y": 1.12, "heading": 2.2417413543090356, - "angularVelocity": -1.621613980672119e-23, - "velocityX": -2.040896989344763e-21, - "velocityY": 2.209371111140419e-21, + "angularVelocity": 3.467752810419143, + "velocityX": 0.46450774884957136, + "velocityY": -0.02393943087174043, "moduleForcesX": [ - 11.861754037319995, - 103.18558970187604, - -103.18558970187601, - -11.861754037319772 + 98.57622997589631, + 103.63716028828135, + 103.73909202920692, + 94.61069291895654 ], "moduleForcesY": [ - 103.185589701876, - -11.8617540373198, - 11.861754037319967, - -103.18558970187604 + 32.58548347862939, + -6.552674898718845, + 0.25821976705337374, + -42.74149145896195 ], - "timestamp": 6.936983730172272 + "timestamp": 6.7424350180897825 }, { - "x": 3.7420257087402713, - "y": 1.119395565443157, - "heading": 2.250679174338871, - "angularVelocity": 0.18951813820310662, - "velocityX": 0.25499393850188956, - "velocityY": -0.01281647107416695, + "x": 3.7595235837147456, + "y": 1.1185280268961153, + "heading": 2.3805165275370834, + "angularVelocity": 3.241748643389131, + "velocityX": 0.6896625327778686, + "velocityY": -0.03438487376134009, "moduleForcesX": [ - 94.39176645951244, - 103.75042896292366, - 103.62407770654451, - 98.82065097544032 + 92.63480916068393, + 103.83855124027123, + 103.02064063619865, + 90.17555347900034 ], "moduleForcesY": [ - -43.26174671623899, - -1.821110039816679, - -6.93478963585717, - 31.88340023830956 + 46.88788427101869, + -1.7717146795353886, + -11.72405596945411, + -51.469771162765475 ], - "timestamp": 6.984144493329711 + "timestamp": 6.785243757598643 }, { - "x": 3.7660834861885943, - "y": 1.1181790558565958, - "heading": 2.2684739284287843, - "angularVelocity": 0.37732116485282313, - "velocityX": 0.510122734189237, - "velocityY": -0.025794951250046723, + "x": 3.7986214441040707, + "y": 1.1164937101985923, + "heading": 2.509065602848367, + "angularVelocity": 3.0028698996072096, + "velocityX": 0.9133149174197912, + "velocityY": -0.047521060438719384, "moduleForcesX": [ - 94.60878216272674, - 103.70988945367432, - 103.65165670870203, - 98.82845189414677 + 91.30030171363514, + 103.80690678446062, + 100.27353405465394, + 91.68864842073944 ], "moduleForcesY": [ - -42.76818746342199, - -3.0383973887514557, - -6.41564735852772, - 31.833475192591276 + 49.406044695641285, + 2.918795853575125, + -26.34108710491625, + -48.71821158597372 ], - "timestamp": 7.03130525648715 + "timestamp": 6.828052497107503 }, { - "x": 3.8021804586038193, - "y": 1.116340174110553, - "heading": 2.2950337283480158, - "angularVelocity": 0.5631757872654675, - "velocityX": 0.7654026355493844, - "velocityY": -0.038991772459324274, + "x": 3.847205006575031, + "y": 1.1138399376381436, + "heading": 2.6265825725100256, + "angularVelocity": 2.745163044039986, + "velocityX": 1.1348982247159145, + "velocityY": -0.06199137351157865, "moduleForcesX": [ - 94.8944561275941, - 103.62991439772085, - 103.68917333070299, - 98.822618306651 + 90.2042873084176, + 103.58978446340055, + 96.57875922239813, + 93.11566139239736 ], "moduleForcesY": [ - -42.11106179846348, - -4.788890326585848, - -5.652040565410073, - 31.820229232712332 + 51.344934793162416, + 7.2187104736979055, + -37.68389178110523, + -45.92314963498386 ], - "timestamp": 7.07846601964459 + "timestamp": 6.8708612366163635 }, { - "x": 3.8503241618605326, - "y": 1.1138665667296608, - "heading": 2.3302610133197463, - "angularVelocity": 0.7469617243921487, - "velocityX": 1.0208423281021242, - "velocityY": -0.05245053759274676, + "x": 3.9051896953007397, + "y": 1.110564122158419, + "heading": 2.732274631293762, + "angularVelocity": 2.4689364834453884, + "velocityX": 1.35450586471335, + "velocityY": -0.07652211948572567, "moduleForcesX": [ - 95.25359220944863, - 103.48669966827966, - 103.73034024206368, - 98.81655664655072 + 89.3927835844053, + 103.23979633546678, + 93.02671273614925, + 94.40996349354707 ], "moduleForcesY": [ - -41.26925009772418, - -7.018269244384779, - -4.656152780003914, - 31.800403545940096 + 52.70412794820037, + 11.079320727564896, + -45.74514083121305, + -43.186293651224865 ], - "timestamp": 7.125626782802029 + "timestamp": 6.913669976125224 }, { - "x": 3.9105222915906985, - "y": 1.1107447960198984, - "heading": 2.374057057087477, - "angularVelocity": 0.9286542633231647, - "velocityX": 1.276445199353584, - "velocityY": -0.06619423649572619, + "x": 3.9725090760296573, + "y": 1.1066998807874662, + "heading": 2.8255063011841965, + "angularVelocity": 2.1778653368463976, + "velocityX": 1.5725616194552194, + "velocityY": -0.09026758122959308, "moduleForcesX": [ - 95.6913636594475, - 103.25613890552566, - 103.76742989536034, - 98.82860456818229 + 88.88037952242793, + 102.81005176007353, + 90.15112154865182, + 95.54189569023103 ], "moduleForcesY": [ - -40.215687472750055, - -9.644987734666467, - -3.44472063684618, - 31.714505873672152 + 53.51505450468626, + 14.462722838276617, + -51.165484322274246, + -40.60120774371482 ], - "timestamp": 7.172787545959468 + "timestamp": 6.956478715634084 }, { - "x": 3.9827828266678518, - "y": 1.106961759031523, - "heading": 2.4263221397090615, - "angularVelocity": 1.108232333881124, - "velocityX": 1.5322172551772217, - "velocityY": -0.08021577122801049, + "x": 4.04911754604587, + "y": 1.1022980104803026, + "heading": 2.905836418420014, + "angularVelocity": 1.8764887300452011, + "velocityX": 1.7895521077032517, + "velocityY": -0.1028264405272802, "moduleForcesX": [ - 96.21274681913333, - 102.92117372125647, - 103.79170757840996, - 98.88369219763595 + 88.6435849529272, + 102.35009226005988, + 88.04981715271404, + 96.49632501819781 ], "moduleForcesY": [ - -38.9163675493585, - -12.5495178250086, - -2.0417028183548362, - 31.480227453762826 + 53.8478227107517, + 17.346843483393773, + -54.67995276264344, + -38.25000602612566 ], - "timestamp": 7.219948309116908 + "timestamp": 6.9992874551429445 }, { - "x": 4.067114900352871, - "y": 1.1025064837995016, - "heading": 2.4869458369938227, - "angularVelocity": 1.2854689624588427, - "velocityX": 1.7881829732798544, - "velocityY": -0.09446995624621968, + "x": 4.134987194671327, + "y": 1.0974123372446702, + "heading": 2.972996577285001, + "angularVelocity": 1.568842241923198, + "velocityX": 2.005890610438106, + "velocityY": -0.11412793956759826, "moduleForcesX": [ - 96.82210060607143, - 102.48186327897088, - 103.79411466441147, - 99.01547871125396 + 88.62476323392177, + 101.90241204467951, + 86.61463584529837, + 97.26963381448 ], "moduleForcesY": [ - -37.327787018091406, - -15.562895960409582, - -0.48329422551997087, - 30.98113066968098 + 53.80724235029578, + 19.724948998303372, + -56.891541867481344, + -36.19986123567652 ], - "timestamp": 7.267109072274347 + "timestamp": 7.042096194651805 }, { - "x": 4.163530889459729, - "y": 1.0973719786562688, - "heading": 2.5557791619374997, - "angularVelocity": 1.4595464605584618, - "velocityX": 2.044411130180125, - "velocityY": -0.1088723930546053, + "x": 4.230102691196206, + "y": 1.0920909550243076, + "heading": 3.0268475265496417, + "angularVelocity": 1.2579428846180885, + "velocityX": 2.2218709921405915, + "velocityY": -0.12430597773782255, "moduleForcesX": [ - 97.52307759296336, - 101.96757166187002, - 103.76643805404562, - 99.2687524999127 + 88.74379947495026, + 101.50047511959417, + 85.68172812373263, + 97.86565142236238 ], "moduleForcesY": [ - -35.391087956730566, - -18.45337114743011, - 1.1721764204605787, - 30.046537559814595 + 53.52138370855977, + 21.601735994041906, + -58.23596611496595, + -34.502020704573155 ], - "timestamp": 7.314269835431786 + "timestamp": 7.084904934160665 }, { - "x": 4.27205024518103, - "y": 1.0915564372377649, - "heading": 2.6325761862157253, - "angularVelocity": 1.628409277895895, - "velocityX": 2.3010517314791077, - "velocityY": -0.1233131321282886, + "x": 4.334456113781515, + "y": 1.086371616052347, + "heading": 3.0673336474081494, + "angularVelocity": 0.9457442878019748, + "velocityX": 2.437666321936928, + "velocityY": -0.1336021344607505, "moduleForcesX": [ - 98.3192725604474, - 101.45005517054383, - 103.70343609036856, - 99.70101230315205 + 88.91294242841904, + 101.16809361041918, + 85.0990600378489, + 98.29129352160717 ], "moduleForcesY": [ - -33.018357864516105, - -20.904618562351715, - 2.823282264089796, - 28.413777464885822 + 53.12500412966054, + 22.988179743010008, + -59.00882911377455, + -33.19297248992892 ], - "timestamp": 7.361430598589226 + "timestamp": 7.1277136736695255 }, { - "x": 4.392705551657881, - "y": 1.0850626109406343, - "heading": 2.7168841340917256, - "angularVelocity": 1.7876714079997014, - "velocityX": 2.5583832491017766, - "velocityY": -0.13769553040208768, + "x": 4.448042469034826, + "y": 1.0802797732534677, + "heading": 3.0944451868788407, + "angularVelocity": 0.6333178641029511, + "velocityX": 2.653345007502878, + "velocityY": -0.14230371809045952, "moduleForcesX": [ - 99.21668025263472, - 101.05663190107522, - 103.60675985804505, - 100.37911048180725 + 89.05028068668823, + 100.91938488804666, + 84.74746616957619, + 98.55238470477299 ], "moduleForcesY": [ - -30.057161726527582, - -22.46386652016153, - 4.275852534155649, - 25.65091045432924 + 52.73979656003988, + 23.896465943972522, + -59.39938458297941, + -32.29648339516581 ], - "timestamp": 7.408591361746665 + "timestamp": 7.170522413178386 }, { - "x": 4.525550892595546, - "y": 1.0778935325462906, - "heading": 2.80783510466324, - "angularVelocity": 1.9285305088869589, - "velocityX": 2.8168615612554824, - "velocityY": -0.1520136213744107, + "x": 4.570855977052453, + "y": 1.0738280106171412, + "heading": 3.1081926381636182, + "angularVelocity": 0.32113655862097673, + "velocityX": 2.868888676158945, + "velocityY": -0.1507113432992367, "moduleForcesX": [ - 100.23079205968564, - 100.98392888115625, - 103.49130741231629, - 101.35472988164179 + 89.08809122726427, + 100.7579318929463, + 84.54064179908963, + 98.64918125989954 ], "moduleForcesY": [ - -26.181867508904073, - -22.390549955983754, - 5.102781651117579, - 20.97639516911996 + 52.453084161766014, + 24.33536809116126, + -59.51415041556405, + -31.82516108397966 ], - "timestamp": 7.455752124904104 + "timestamp": 7.213331152687246 }, { - "x": 4.6706692184978085, - "y": 1.0700419744774925, - "heading": 2.9036900081376484, - "angularVelocity": 2.032513832619933, - "velocityX": 3.077098761481141, - "velocityY": -0.16648496638163585, + "x": 4.702886478240266, + "y": 1.0670159670138122, + "heading": 3.108595947975067, + "angularVelocity": 0.009421202681421935, + "velocityX": 3.0841950195825003, + "velocityY": -0.15912740439179773, "moduleForcesX": [ - 101.4022901583631, - 101.49973712392797, - 103.38179356673183, - 102.54009154829254 + 88.97153279637656, + 100.67185170490919, + 84.41297414011797, + 98.56875490305062 ], "moduleForcesY": [ - -20.460130196971843, - -19.145861980841424, - 4.12011250952299, - 12.751882075421097 + 52.29316044520558, + 24.305030951948087, + -59.383999366054645, + -31.779651043346263 ], - "timestamp": 7.502912888061544 + "timestamp": 7.2561398921961064 }, { - "x": 4.828133141104835, - "y": 1.061470786457346, - "heading": 3.0003548656233874, - "angularVelocity": 2.0496881520563304, - "velocityX": 3.3388756259383423, - "velocityY": -0.18174404836350594, + "x": 4.844113025567038, + "y": 1.0598302236654258, + "heading": 3.095694317757129, + "angularVelocity": -0.3013784186583571, + "velocityX": 3.299012046303043, + "velocityY": -0.1678569243295801, "moduleForcesX": [ - 102.6792974850671, - 102.66038096177155, - 102.96356872642492, - 102.939426086725 + 88.62959336610633, + 100.61041066833194, + 84.27835410029421, + 98.25990766190384 ], "moduleForcesY": [ - -8.525317491369549, - -8.235583388371387, - -3.8597400587840296, - -3.350865018387175 + 52.17924438635207, + 23.78466302835548, + -58.93296137680517, + -32.13890015705108 ], - "timestamp": 7.550073651218983 + "timestamp": 7.298948631704967 }, { "x": 4.994473934173584, "y": 1.0522435903549194, "heading": 3.069615115322268, - "angularVelocity": 1.4685990018368698, - "velocityX": 3.5271013853919833, - "velocityY": -0.19565408794644082, + "angularVelocity": -0.6092027640632386, + "velocityX": 3.5123881322272132, + "velocityY": -0.17722160001784806, "moduleForcesX": [ - 58.87926049401101, - 97.90553952546307, - 46.3522757191946, - 92.55927869131658 + 87.74948530062613, + 100.31459177779811, + 83.75899516652834, + 97.46139462629402 ], "moduleForcesY": [ - 80.63347164631476, - 29.303293505963616, - -88.46040550921222, - -43.328565242288015 + 51.62768559826387, + 22.65362039540959, + -57.70317606341726, + -32.78533166041236 ], - "timestamp": 7.597234414376422 + "timestamp": 7.341757371213827 }, { - "x": 5.21993980254767, - "y": 1.039630843584023, - "heading": 3.08612579482946, - "angularVelocity": 0.2463107723682536, - "velocityX": 3.363560667367391, - "velocityY": -0.18816035993378763, + "x": 5.220411209087956, + "y": 1.0394568906064166, + "heading": 3.0642021576954424, + "angularVelocity": -0.08079045747009987, + "velocityX": 3.3722000167562336, + "velocityY": -0.19084637150951397, "moduleForcesX": [ - -89.89760858727718, - 7.385392617841561, - -94.21103479178815, - -4.032488365945729 + -18.25974924770877, + -61.72570066835306, + -14.523924319494144, + -60.50942691174134 ], "moduleForcesY": [ - 50.674369616275214, - 102.01528692601666, - -42.13219571240748, - -102.27490978017325 + -41.395105821064156, + -26.076397284088287, + 28.930609473614382, + 23.47473958953477 ], - "timestamp": 7.664266316182598 + "timestamp": 7.408757333787733 }, { - "x": 5.420922348442108, - "y": 1.028282211672202, - "heading": 3.087184300804519, - "angularVelocity": 0.015791077778456095, - "velocityX": 2.998311855683048, - "velocityY": -0.16930195333911574, + "x": 5.421335815965932, + "y": 1.028068537679225, + "heading": 3.059593893702212, + "angularVelocity": -0.0687800980209144, + "velocityX": 2.9988764046893643, + "velocityY": -0.16997551177182332, "moduleForcesX": [ - -101.02914288206168, - -98.56977605934014, - -102.85614132118369, - -101.24146081662191 + -103.2664938988573, + -103.2751808850352, + -103.13301405288641, + -103.14332065108621 ], "moduleForcesY": [ - 22.827115278426835, - 31.24234686128395, - -12.191641059850506, - -21.03429499073052 + 4.541224118384727, + 4.630867167407542, + 6.93556034116202, + 6.971163895891921 ], - "timestamp": 7.7312982179887735 + "timestamp": 7.475757296361639 }, { - "x": 5.596884738261333, - "y": 1.0182966263987785, - "heading": 3.082148178112647, - "angularVelocity": -0.07513023733735659, - "velocityX": 2.625054415553102, - "velocityY": -0.1489676557633177, + "x": 5.597181183736462, + "y": 1.0180948163903252, + "heading": 3.055642266473313, + "angularVelocity": -0.058979543824966826, + "velocityX": 2.624559193993438, + "velocityY": -0.14886159492834625, "moduleForcesX": [ - -102.77315332713786, - -102.52922721443944, - -103.66971501009118, - -103.57607771279062 + -103.53305852533342, + -103.53469591125267, + -103.42317893872716, + -103.42578885136426 ], "moduleForcesY": [ - 13.830590440359913, - 15.251419200238098, - -2.496116046862724, - -4.111117694851949 + 4.8306687322724216, + 4.906393859163195, + 6.785485794504554, + 6.825037574562329 ], - "timestamp": 7.798330119794949 + "timestamp": 7.542757258935545 }, { - "x": 5.747733551223532, - "y": 1.0097082363442045, - "heading": 3.0745190793089487, - "angularVelocity": -0.11381295469965687, - "velocityX": 2.250403298990136, - "velocityY": -0.12812392044921225, + "x": 5.747925019771543, + "y": 1.0095411919696742, + "heading": 3.05229779161728, + "angularVelocity": -0.04991756304854153, + "velocityX": 2.2499092573185537, + "velocityY": -0.1276661074432343, "moduleForcesX": [ - -103.32486902872125, - -103.2942237860439, - -103.73764505407789, - -103.73181638939806 + -103.62208629776751, + -103.62173078672369, + -103.5202241170174, + -103.52060652438273 ], "moduleForcesY": [ - 9.484303024561918, - 9.676485182114542, - 2.1233990772684646, - 1.75365202837636 + 4.926128305543275, + 5.0005635670766955, + 6.733817674210244, + 6.777276521096291 ], - "timestamp": 7.865362021601125 + "timestamp": 7.609757221509451 }, { - "x": 5.873444227245606, - "y": 1.0025341434487187, - "heading": 3.0661617511748713, - "angularVelocity": -0.12467687636616408, - "velocityX": 1.875385788479751, - "velocityY": -0.10702505377559426, + "x": 5.873556159188288, + "y": 1.0024104036653874, + "heading": 3.049535712132861, + "angularVelocity": -0.04122508995990319, + "velocityX": 1.8750926805101673, + "velocityY": -0.10642973563491336, "moduleForcesX": [ - -103.56363844845902, - -103.56214591948665, - -103.68378743626758, - -103.6839446529072 + -103.66665324519711, + -103.6653199660069, + -103.56883625472425, + -103.56810747302617 ], "moduleForcesY": [ - 6.914243737313298, - 6.895026666759426, - 4.787160207313561, - 4.7233963185770085 + 4.973185116802823, + 5.048577308550577, + 6.707181320768238, + 6.75405185150205 ], - "timestamp": 7.9323939234073 + "timestamp": 7.676757184083357 }, { - "x": 5.974010415319068, - "y": 0.9967845639996021, - "heading": 3.0582409293271344, - "angularVelocity": -0.1181649577933858, - "velocityX": 1.5002735319109908, - "velocityY": -0.0857737777713852, + "x": 5.974067897354128, + "y": 0.996704097035998, + "heading": 3.047341170398741, + "angularVelocity": -0.032754372537126, + "velocityX": 1.5001760345007609, + "velocityY": -0.0851688032376159, "moduleForcesX": [ - -103.68647322434256, - -103.68567632686822, - -103.61320240133482, - -103.61288395314875 + -103.69341461870235, + -103.69148910140211, + -103.59803876166781, + -103.59663011099236 ], "moduleForcesY": [ - 5.206542405717511, - 5.249110661977166, - 6.503035230338926, - 6.529591244426612 + 5.001095808939345, + 5.0777995568546475, + 6.690824992522238, + 6.740434125392908 ], - "timestamp": 7.999425825213476 + "timestamp": 7.743757146657263 }, { - "x": 6.049431766890569, - "y": 0.9924662724676168, - "heading": 3.051554976537805, - "angularVelocity": -0.0997428479451764, - "velocityX": 1.1251560755292975, - "velocityY": -0.06442143838424273, + "x": 6.049455762238878, + "y": 0.9924233699091543, + "heading": 3.045704259638799, + "angularVelocity": -0.024431517527148842, + "velocityX": 1.1251926417363327, + "velocityY": -0.06389148534402293, "moduleForcesX": [ - -103.75677421099608, - -103.75270834682686, - -103.54776492224136, - -103.54673559392808 + -103.7112611091154, + -103.70894383397855, + -103.61751768625881, + -103.61565794570146 ], "moduleForcesY": [ - 3.985464683416833, - 4.1705499021545, - 7.693449422935552, - 7.750517296679296 + 5.019624761642934, + 5.097395248534811, + 6.679822686498952, + 6.7314307265973286 ], - "timestamp": 8.066457727019651 + "timestamp": 7.810757109231169 }, { - "x": 6.099710081045857, - "y": 0.9895840842861203, - "heading": 3.046685843199759, - "angularVelocity": -0.07263904509416273, - "velocityX": 0.7500654583942555, - "velocityY": -0.04299726106281018, + "x": 6.099716558467515, + "y": 0.989569006809897, + "heading": 3.0446179022503497, + "angularVelocity": -0.016214298437120946, + "velocityX": 0.7501615567798412, + "velocityY": -0.042602458115063656, "moduleForcesX": [ - -103.79993007073521, - -103.79334375915312, - -103.49115420635184, - -103.48989057299576 + -103.72400441579775, + -103.72142253974555, + -103.63142694229215, + -103.6292642891978 ], "moduleForcesY": [ - 3.0696514163509354, - 3.4109877407679896, - 8.567062634653622, - 8.631679427189365 + 5.032957243639672, + 5.11130283220324, + 6.672061132278851, + 6.724900296554289 ], - "timestamp": 8.133489628825828 + "timestamp": 7.877757071805075 }, { - "x": 6.124847888946533, - "y": 0.9881415963172908, + "x": 6.12484788894652, + "y": 0.9881415963172888, "heading": 3.0440767888466445, - "angularVelocity": -0.038922576904629844, - "velocityX": 0.37501260181103735, - "velocityY": -0.02151942478075615, + "angularVelocity": -0.008076323969709828, + "velocityX": 0.3750946942888271, + "velocityY": -0.021304646118706513, "moduleForcesX": [ - -103.82773310541879, - -103.82008730330988, - -103.44258569856589, - -103.44217710700607 + -103.73355085660772, + -103.73079678145365, + -103.64184438103867, + -103.63948865503173 ], "moduleForcesY": [ - 2.361430338717795, - 2.8438625635459225, - 9.239306415728796, - 9.294089241704407 + 5.0431852138632, + 5.121495388875575, + 6.666482603336728, + 6.7197724181306056 ], - "timestamp": 8.200521530632004 + "timestamp": 7.944757034378981 }, { "x": 6.124847888946533, "y": 0.988141596317291, "heading": 3.044076788846644, - "angularVelocity": 2.7103270983123612e-17, - "velocityX": -3.611620349514071e-17, - "velocityY": 3.713622586240161e-17, + "angularVelocity": 2.7161141224253378e-17, + "velocityX": -3.613596854420864e-17, + "velocityY": 3.7089850096461916e-17, "moduleForcesX": [ - -103.84628461386265, - -103.83885635426098, - -103.40030298005537, - -103.40264709813552 + -103.74095967535139, + -103.73810721466131, + -103.64992473488311, + -103.64746520965623 ], "moduleForcesY": [ - 1.803887986928977, - 2.3974582054604787, - 9.779530745408758, - 9.803777910373523 + 5.051470425075263, + 5.129071086156181, + 6.66249852967614, + 6.715452696467063 ], - "timestamp": 8.26755343243818 + "timestamp": 8.011756996952887 }, { - "x": 6.110634732554925, - "y": 0.997041194777477, - "heading": 3.0373126401476984, - "angularVelocity": -0.12304364450519946, - "velocityX": -0.2585452566507664, - "velocityY": 0.16188866896334042, + "x": 6.110634732561328, + "y": 0.9970411947826974, + "heading": 3.0373126401475794, + "angularVelocity": -0.12304364450736582, + "velocityX": -0.25854525665067285, + "velocityY": 0.1618886689632799, "moduleForcesX": [ - -84.8300601446508, - -75.0898929116376, - -96.37385776089208, - -92.14807124538784 + -84.83006014459953, + -75.08989291136919, + -96.37385776100199, + -92.14807124547087 ], "moduleForcesY": [ - 59.91992900493605, - 71.72511840476682, - 38.69327827800803, - 47.83930877720592 + 59.91992900500898, + 71.72511840504777, + 38.69327827773459, + 47.83930877704511 ], - "timestamp": 8.322527004833136 + "timestamp": 8.06673056934784 }, { - "x": 6.0822053465126045, - "y": 1.0148436356563937, - "heading": 3.0238865872883207, - "angularVelocity": -0.24422740372262675, - "velocityX": -0.5171464180619889, - "velocityY": 0.32383634715024767, + "x": 6.0822053465067905, + "y": 1.014843635655015, + "heading": 3.0238865872879876, + "angularVelocity": -0.24422740372652788, + "velocityX": -0.5171464180618228, + "velocityY": 0.32383634715015114, "moduleForcesX": [ - -84.7393743715122, - -75.3569946012607, - -96.21568889720955, - -92.20516713331142 + -84.739374371467, + -75.3569946010479, + -96.21568889729645, + -92.20516713338158 ], "moduleForcesY": [ - 60.03874061035034, - 71.43471959638731, - 39.06991075682854, - 47.71379033230931 + 60.03874061041446, + 71.43471959661174, + 39.069910756614824, + 47.71379033217303 ], - "timestamp": 8.37750057722809 + "timestamp": 8.121704141742793 }, { - "x": 6.03955634123586, - "y": 1.0415525633719367, - "heading": 3.003914713769894, - "angularVelocity": -0.36329953918474894, - "velocityX": -0.7758092373651998, - "velocityY": 0.48585031954004987, + "x": 6.039556341245207, + "y": 1.0415525633745906, + "heading": 3.003914713769281, + "angularVelocity": -0.3632995391898515, + "velocityX": -0.7758092373649862, + "velocityY": 0.4858503195399354, "moduleForcesX": [ - -84.59718960487209, - -75.67793809361636, - -96.01610596363868, - -92.30908778706126 + -84.59718960483518, + -75.67793809347147, + -96.01610596369684, + -92.30908778711465 ], "moduleForcesY": [ - 60.22794100568322, - 71.0830835385318, - 39.5407448611124, - 47.494736700529494 + 60.22794100573528, + 71.083083538686, + 39.54074486097146, + 47.494736700425264 ], - "timestamp": 8.432474149623046 + "timestamp": 8.176677714137746 }, { - "x": 5.982683900670879, - "y": 1.0771721914334311, - "heading": 2.977532671302065, - "angularVelocity": -0.4799040942489272, - "velocityX": -1.0345414730135558, - "velocityY": 0.647940938010814, + "x": 5.982683900674507, + "y": 1.0771721914258312, + "heading": 2.977532671301142, + "angularVelocity": -0.4799040942545924, + "velocityX": -1.0345414730133229, + "velocityY": 0.6479409380107021, "moduleForcesX": [ - -84.4117468485914, - -76.06724787133838, - -95.76969169073075, - -92.44518756493191 + -84.41174684856678, + -76.06724787127322, + -95.76969169075473, + -92.44518756496295 ], "moduleForcesY": [ - 60.47454381128638, - 70.65247665552374, - 40.11412819890906, - 47.20865349379163 + 60.47454381132092, + 70.65247665559389, + 40.11412819885202, + 47.208653493730665 ], - "timestamp": 8.487447722018 + "timestamp": 8.2316512865327 }, { - "x": 5.911583629045666, - "y": 1.1217075042934919, - "heading": 2.9449036806941926, - "angularVelocity": -0.5935395715863435, - "velocityX": -1.293353670479682, - "velocityY": 0.8101222265188435, + "x": 5.911583629035834, + "y": 1.121707504296573, + "heading": 2.944903680692972, + "angularVelocity": -0.5935395715917635, + "velocityX": -1.2933536704794637, + "velocityY": 0.8101222265187449, "moduleForcesX": [ - -84.19443291189384, - -76.54335998257876, - -95.46907770001037, - -92.5947680588966 + -84.19443291188921, + -76.54335998261115, + -95.46907769999206, + -92.59476805889527 ], "moduleForcesY": [ - 60.76103074765669, - 70.11956535871832, - 40.80122275955335, - 46.89017945698064 + 60.76103074766313, + 70.11956535868302, + 40.80122275959633, + 46.89017945698358 ], - "timestamp": 8.542421294412955 + "timestamp": 8.286624858927652 }, { - "x": 5.826250337220098, - "y": 1.1751644927011906, - "heading": 2.906229937044414, - "angularVelocity": -0.7034970071060459, - "velocityX": -1.5522602604983846, - "velocityY": 0.9724124896891126, + "x": 5.82625033723076, + "y": 1.1751644926956395, + "heading": 2.906229937042946, + "angularVelocity": -0.7034970071105705, + "velocityX": -1.5522602604982072, + "velocityY": 0.972412489689044, "moduleForcesX": [ - -83.96151353952493, - -77.12910808241261, - -95.10429131943967, - -92.73393871562132 + -83.96151353954032, + -77.12910808252042, + -95.10429131938795, + -92.73393871559084 ], "moduleForcesY": [ - 61.06320215655703, - 69.45398505600635, - 41.616710994168166, - 46.584965453798844 + 61.06320215653575, + 69.45398505588678, + 41.616710994286336, + 46.584965453860235 ], - "timestamp": 8.59739486680791 + "timestamp": 8.341598431322605 }, { - "x": 5.726677755243657, - "y": 1.2375504217085824, - "heading": 2.8617691881921195, - "angularVelocity": -0.8087658654028878, - "velocityX": -1.8112809054763035, - "velocityY": 1.1348349086300618, + "x": 5.726677755235851, + "y": 1.2375504217136353, + "heading": 2.861769188190487, + "angularVelocity": -0.8087658654059063, + "velocityX": -1.8112809054761907, + "velocityY": 1.1348349086300362, "moduleForcesX": [ - -83.73699636273983, - -77.85252008420294, - -94.66151602716938, - -92.83153124538079 + -83.73699636277946, + -77.85252008437688, + -94.6615160270873, + -92.83153124531917 ], "moduleForcesY": [ - 61.346478924432986, - 68.61600099000299, - 42.58035050989597, - 46.3541397930862 + 61.34647892437862, + 68.61600098980595, + 42.58035051007835, + 46.354139793210784 ], - "timestamp": 8.652368439202865 + "timestamp": 8.396572003717559 }, { - "x": 5.612858173253882, - "y": 1.3088741316664878, - "heading": 2.8118595087300506, - "angularVelocity": -0.9078849579484318, - "velocityX": -2.070441796602551, - "velocityY": 1.2974181385025019, + "x": 5.612858173258879, + "y": 1.3088741316636203, + "heading": 2.8118595087283933, + "angularVelocity": -0.9078849579489091, + "velocityX": -2.070441796602538, + "velocityY": 1.297418138502555, "moduleForcesX": [ - -83.55765429342505, - -78.74827893210937, - -94.12060181498998, - -92.8450386515704 + -83.55765429351254, + -78.7482789323879, + -94.1206018148576, + -92.84503865145162 ], "moduleForcesY": [ - 61.55910024103777, - 67.5524203141948, - 43.72035562235554, - 46.28181920567754 + 61.55910024091844, + 67.55242031387074, + 43.72035562264012, + 46.28181920591784 ], - "timestamp": 8.70734201159782 + "timestamp": 8.451545576112512 }, { - "x": 5.484782065278633, - "y": 1.3891463740366075, - "heading": 2.756958052279485, - "angularVelocity": -0.9986881706746032, - "velocityX": -2.329775970266254, - "velocityY": 1.4601969431488055, + "x": 5.484782065280293, + "y": 1.3891463740331047, + "heading": 2.756958052277954, + "angularVelocity": -0.9986881706723401, + "velocityX": -2.3297759702663448, + "velocityY": 1.460196943148917, "moduleForcesX": [ - -83.48255301270302, - -79.86072105764286, - -93.44967846698673, - -92.71215432517978 + -83.48255301281375, + -79.86072105792785, + -93.4496784668459, + -92.71215432504205 ], "moduleForcesY": [ - 61.61850058221323, - 66.18879981759747, - 45.08095523044974, - 46.48901620832081 + 61.6185005820626, + 66.18879981725462, + 45.080955230741196, + 46.48901620859793 ], - "timestamp": 8.762315583992775 + "timestamp": 8.506519148507465 }, { - "x": 5.342437911268035, - "y": 1.478380169844774, - "heading": 2.697706318550857, - "angularVelocity": -1.0778221452107346, - "velocityX": -2.589319700821736, - "velocityY": 1.6232126078772828, + "x": 5.342437911265935, + "y": 1.4783801698446344, + "heading": 2.697706318549636, + "angularVelocity": -1.0778221452051246, + "velocityX": -2.5893197008219415, + "velocityY": 1.623212607877452, "moduleForcesX": [ - -83.61299273219753, - -81.25057420713186, - -92.59228682646656, - -92.33167327612763 + -83.61299273235741, + -81.25057420745438, + -92.59228682629652, + -92.33167327594502 ], "moduleForcesY": [ - 61.38091527490915, - 64.41300325780229, - 46.74043198889193, - 47.162138052518856 + 61.380915274690516, + 64.41300325739722, + 46.74043198922804, + 47.16213805287967 ], - "timestamp": 8.81728915638773 + "timestamp": 8.561492720902418 }, { - "x": 5.185813016304511, - "y": 1.576591030565837, - "heading": 2.6350531319582737, - "angularVelocity": -1.1396964734701096, - "velocityX": -2.8490943580623322, - "velocityY": 1.7865104347236582, + "x": 5.1858130163033636, + "y": 1.5765910305618624, + "heading": 2.6350531319574313, + "angularVelocity": -1.1396964734632677, + "velocityX": -2.8490943580625947, + "velocityY": 1.7865104347238558, "moduleForcesX": [ - -84.13983054182101, - -83.01127626883185, - -91.43209699219983, - -91.51554352530742 + -84.13983054188876, + -83.01127626894349, + -91.4320969921366, + -91.51554352523937 ], "moduleForcesY": [ - 60.563239377036204, - 62.0362062074758, - 48.85926164168741, - 48.61805171407033 + 60.56323937694242, + 62.03620620732814, + 48.8592616418063, + 48.61805171420087 ], - "timestamp": 8.872262728782685 + "timestamp": 8.616466293297371 }, { - "x": 5.014898738142066, - "y": 1.6837958208609907, - "heading": 2.5705279236119396, - "angularVelocity": -1.1737495952192538, - "velocityX": -3.1090262232595176, - "velocityY": 1.9501150394720257, + "x": 5.014898738147155, + "y": 1.683795820864356, + "heading": 2.570527923611425, + "angularVelocity": -1.173749595213334, + "velocityX": -3.1090262232598085, + "velocityY": 1.9501150394722202, "moduleForcesX": [ - -85.47585344352798, - -85.3118067874862, - -89.674151663359, - -89.84880486421068 + -85.47585344347402, + -85.31180678742584, + -89.67415166341442, + -89.84880486427723 ], "moduleForcesY": [ - 58.49786820145132, - 58.686187699495015, - 51.83355824921669, - 51.47258989031521 + 58.49786820153291, + 58.68618769958436, + 51.83355824912394, + 51.4725898902009 ], - "timestamp": 8.92723630117764 + "timestamp": 8.671439865692324 }, { - "x": 4.829720072763227, - "y": 1.8000004850318336, - "heading": 2.5070278105659387, - "angularVelocity": -1.1551025389034095, - "velocityX": -3.3685033974467444, - "velocityY": 2.1138277739921136, + "x": 4.829720072773047, + "y": 1.8000004850362632, + "heading": 2.5070278105656283, + "angularVelocity": -1.155102538899726, + "velocityX": -3.3685033974470753, + "velocityY": 2.1138277739922944, "moduleForcesX": [ - -88.71709286679649, - -88.52155136043952, - -86.28201790264033, - -86.17716678134498 + -88.71709286665494, + -88.52155136032547, + -86.28201790279765, + -86.17716678150764 ], "moduleForcesY": [ - 53.08178703657719, - 53.4513782470058, - 56.95128514679214, - 57.15148028733032 + 53.08178703682181, + 53.45137824719711, + 56.95128514656165, + 57.15148028708766 ], - "timestamp": 8.982209873572595 + "timestamp": 8.726413438087278 }, { - "x": 4.630631373212693, - "y": 1.9250518086015365, - "heading": 2.452690751238951, - "angularVelocity": -0.9884214716229549, - "velocityX": -3.6215346918107696, - "velocityY": 2.274753452012011, + "x": 4.630631373197701, + "y": 1.9250518085990234, + "heading": 2.4526907512388036, + "angularVelocity": -0.9884214716200167, + "velocityX": -3.621534691811259, + "velocityY": 2.2747534520121397, "moduleForcesX": [ - -97.46251239739685, - -93.61667564220168, - -73.96265211772815, - -75.96886555450617 + -97.4625123973849, + -93.61667564220114, + -73.96265211784451, + -75.9688655545753 ], "moduleForcesY": [ - 32.669165400789424, - 43.24143764085197, - 71.27489026029656, - 69.69431663085776 + 32.66916540086088, + 43.24143764087089, + 71.27489026019346, + 69.69431663079334 ], - "timestamp": 9.03718344596755 + "timestamp": 8.78138701048223 }, { - "x": 4.422647731603957, - "y": 2.0565226976459505, - "heading": 2.440254457435589, - "angularVelocity": -0.22622313343613798, - "velocityX": -3.7833386576608445, - "velocityY": 2.3915289350428397, + "x": 4.422647731607199, + "y": 2.0565226976433393, + "heading": 2.440254457435579, + "angularVelocity": -0.22622313343364486, + "velocityX": -3.7833386576614494, + "velocityY": 2.3915289350430577, "moduleForcesX": [ - -86.57780281800447, - -99.29523053350272, - 21.236859668111055, - -53.42730625172477 + -86.57780281805616, + -99.2952305335068, + 21.2368596680207, + -53.427306251741676 ], "moduleForcesY": [ - -50.874712392323595, - 24.44800200918981, - 96.72683386602516, - 87.07839358262116 + -50.87471239226852, + 24.448002009206352, + 96.72683386607464, + 87.07839358262063 ], - "timestamp": 9.092157018362505 + "timestamp": 8.836360582877184 }, { - "x": 4.211642888888173, - "y": 2.188920329555242, - "heading": 2.439987241979953, - "angularVelocity": -0.004860798452689113, - "velocityX": -3.838295994465358, - "velocityY": 2.4083869055219655, + "x": 4.2116428888881625, + "y": 2.1889203295552395, + "heading": 2.439987241979948, + "angularVelocity": -0.004860798452597401, + "velocityX": -3.838295994465267, + "velocityY": 2.4083869055221276, "moduleForcesX": [ - -17.895066941329745, - -36.38334507069944, - 0.42343583903259896, - -20.211120097252607 + -17.895066941079264, + -36.38334507030241, + 0.4234358390630315, + -20.21112009699484 ], "moduleForcesY": [ - -13.978656655930484, - 3.9758187707995822, - 8.014896542371337, - 24.707456825662696 + -13.978656655713657, + 3.9758187708014625, + 8.014896542310398, + 24.707456825429773 ], - "timestamp": 9.14713059075746 + "timestamp": 8.891334155272137 }, { "x": 4.0005412101745605, "y": 2.321166753768921, "heading": 2.439727894004586, - "angularVelocity": -0.004717684590404729, - "velocityX": -3.84005749520817, - "velocityY": 2.405636353110956, + "angularVelocity": -0.004717684590317965, + "velocityX": -3.8400574952080944, + "velocityY": 2.40563635311109, "moduleForcesX": [ - -0.5924713914104806, - -0.6056971386509346, - -0.5812916448891551, - -0.594517371689846 + -0.5924713914159432, + -0.6056971386559915, + -0.5812916448950497, + -0.5945173716952727 ], "moduleForcesY": [ - -0.9389327981490366, - -0.927751437643592, - -0.9257106944955843, - -0.914529231532693 + -0.9389327981580513, + -0.9277514376530072, + -0.925710694505112, + -0.9145292315425559 ], - "timestamp": 9.202104163152415 + "timestamp": 8.94630772766709 } ], "trajectoryWaypoints": [ @@ -90913,7 +90892,7 @@ "controlIntervalCount": 24 }, { - "timestamp": 1.9614511692879133, + "timestamp": 1.961451169287916, "isStopPoint": true, "x": 8.141865730285645, "y": 0.7591670751571655, @@ -90924,7 +90903,7 @@ "controlIntervalCount": 13 }, { - "timestamp": 2.7911277772687106, + "timestamp": 2.7911277772687133, "isStopPoint": false, "x": 7.293661117553711, "y": 1.7425522804260254, @@ -90935,7 +90914,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 3.539361127567343, + "timestamp": 3.5393611275673456, "isStopPoint": true, "x": 8.053288459777832, "y": 2.294506311416626, @@ -90946,18 +90925,18 @@ "controlIntervalCount": 20 }, { - "timestamp": 4.5183055801677705, + "timestamp": 4.488660865359985, "isStopPoint": false, - "x": 5.720109462738037, - "y": 1.5596987009048462, + "x": 5.6509270668029785, + "y": 1.8346644639968872, "heading": 2.339802238554342, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 12 + "controlIntervalCount": 11 }, { - "timestamp": 5.368921240245233, + "timestamp": 5.276343965874389, "isStopPoint": true, "x": 4.202682018280029, "y": 2.3448798656463623, @@ -90968,7 +90947,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 5.723704233347581, + "timestamp": 5.631126958976737, "isStopPoint": false, "x": 4.111026763916016, "y": 2.221068859100342, @@ -90979,7 +90958,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 6.529753752619513, + "timestamp": 6.437176478248669, "isStopPoint": true, "x": 3.73, "y": 1.12, @@ -90990,8 +90969,8 @@ "controlIntervalCount": 5 }, { - "timestamp": 6.936983730172272, - "isStopPoint": true, + "timestamp": 6.7424350180897825, + "isStopPoint": false, "x": 3.73, "y": 1.12, "heading": 2.2417413543090356, @@ -91001,7 +90980,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 7.597234414376422, + "timestamp": 7.341757371213827, "isStopPoint": false, "x": 4.994473934173584, "y": 1.0522435903549194, @@ -91012,7 +90991,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 8.26755343243818, + "timestamp": 8.011756996952887, "isStopPoint": true, "x": 6.124847888946533, "y": 0.9881415963172913, @@ -91023,7 +91002,7 @@ "controlIntervalCount": 17 }, { - "timestamp": 9.202104163152415, + "timestamp": 8.94630772766709, "isStopPoint": false, "x": 4.0005412101745605, "y": 2.321166753768921, @@ -91059,12 +91038,6 @@ ], "type": "StopPoint" }, - { - "scope": [ - 8 - ], - "type": "StopPoint" - }, { "scope": [ 10 @@ -91081,7 +91054,7 @@ "name": "Seek SB", "target": 7, "trajTargetIndex": 7, - "targetTimestamp": 6.529753752619513, + "targetTimestamp": 6.437176478248669, "offset": -0.65, "command": { "type": "named", @@ -91094,7 +91067,7 @@ "name": "Seek 4", "target": 3, "trajTargetIndex": 3, - "targetTimestamp": 3.539361127567343, + "targetTimestamp": 3.5393611275673456, "offset": -0.8, "command": { "type": "named", @@ -91120,7 +91093,7 @@ "name": "Seek 5D", "target": 10, "trajTargetIndex": 10, - "targetTimestamp": 8.26755343243818, + "targetTimestamp": 8.011756996952887, "offset": -0.8, "command": { "type": "named", diff --git a/src/main/deploy/choreo/SourceSpit54Source.1.traj b/src/main/deploy/choreo/SourceSpit54Source.1.traj index 634893e..f1d29f9 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.1.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.1.traj @@ -4,9 +4,9 @@ "x": 1.3093055486679075, "y": 1.4855375289916992, "heading": 3.1415, - "angularVelocity": -0.00020611047214952728, - "velocityX": 4.247624054998792, - "velocityY": -0.45156582763286957, + "angularVelocity": -0.00020611047215007977, + "velocityX": 4.247624054998791, + "velocityY": -0.45156582763287095, "moduleForcesX": [ 0, 0, @@ -23,507 +23,507 @@ }, { "x": 1.6776912225328318, - "y": 1.4463743687041792, + "y": 1.446374368704179, "heading": 3.141472282141126, - "angularVelocity": -0.0003391512485237624, + "angularVelocity": -0.0003391512485240895, "velocityX": 4.5075076612628155, - "velocityY": -0.4791941097578826, + "velocityY": -0.479194109757884, "moduleForcesX": [ - 58.894651333366134, - 58.902040993577, - 58.89391091497932, - 58.901300701642334 + 58.89465133336612, + 58.902040993576975, + 58.8939109149793, + 58.90130070164229 ], "moduleForcesY": [ - -6.254691452649277, - -6.253954535213562, - -6.26895930675167, - -6.268220727628237 + -6.2546914526492765, + -6.253954535213559, + -6.2689593067516585, + -6.268220727628227 ], - "timestamp": 0.08172713205366311 + "timestamp": 0.08172713205366312 }, { - "x": 2.0460782805856987, - "y": 1.4072110612618156, - "heading": 3.141444998150414, - "angularVelocity": -0.0003338425076975475, + "x": 2.04607828058528, + "y": 1.4072110612618527, + "heading": 3.1414449981504142, + "angularVelocity": -0.0003338425076962522, "velocityX": 4.507524597961855, - "velocityY": -0.4791959103204973, + "velocityY": -0.4791959103204976, "moduleForcesX": [ - 0.004054411185247945, - 0.0036223253849391474, - 0.004054475069004705, - 0.0036223892690657507 + 0.0040544111854116495, + 0.003622325384970821, + 0.004054475069168368, + 0.003622389269097384 ], "moduleForcesY": [ - -0.0006241401719434498, - -0.0006240762768495998, - -0.00019205441259517473, - -0.00019199052157958934 + -0.0006241401717500891, + -0.0006240762766562905, + -0.00019205441226977354, + -0.00019199052125422377 ], - "timestamp": 0.16345426410732622 + "timestamp": 0.16345426410732625 }, { - "x": 2.4144653386990167, - "y": 1.3680477538129143, - "heading": 3.1414177142020585, - "angularVelocity": -0.0003338419894377083, - "velocityX": 4.507524598705652, - "velocityY": -0.4791959104011729, + "x": 2.414465338699188, + "y": 1.3680477538128972, + "heading": 3.141417714202059, + "angularVelocity": -0.00033384198943655095, + "velocityX": 4.507524598705653, + "velocityY": -0.4791959104011735, "moduleForcesX": [ - 1.8965212607030153e-7, - 1.4747024014620896e-7, - 1.8966659941626728e-7, - 1.4748471350632016e-7 + 1.8965220181163422e-7, + 1.474703271181504e-7, + 1.8966667527279182e-7, + 1.4748480059345372e-7 ], "moduleForcesY": [ - -3.9381860338036625e-8, - -3.936738687005518e-8, - 2.800025123487072e-9, - 2.8144985669772043e-9 + -3.938192729235327e-8, + -3.936745370918043e-8, + 2.7999469385635256e-9, + 2.814420497246649e-9 ], - "timestamp": 0.24518139616098933 + "timestamp": 0.24518139616098938 }, { - "x": 2.782852396812763, - "y": 1.328884446363913, - "heading": 3.1413904302531392, - "angularVelocity": -0.00033384199633377203, + "x": 2.782852396813364, + "y": 1.3288844463639362, + "heading": 3.1413904302531397, + "angularVelocity": -0.00033384199633044927, "velocityX": 4.50752459870562, - "velocityY": -0.47919591040144593, + "velocityY": -0.4791959104014461, "moduleForcesX": [ - -2.8808071498004513e-10, - 2.7319951370204496e-10, - -2.8794927631594204e-10, - 2.733309522445748e-10 + -2.8803563446343644e-10, + 2.7306834504483674e-10, + -2.8790426266076945e-10, + 2.7319971672592943e-10 ], "moduleForcesY": [ - 2.1869323715156544e-10, - 2.1882467936106666e-10, - -3.4258700998575654e-10, - -3.4245556750246296e-10 + 2.1870178685671868e-10, + 2.1883316220478742e-10, + -3.424022111068235e-10, + -3.4227083548495593e-10 ], - "timestamp": 0.32690852821465244 + "timestamp": 0.3269085282146525 }, { - "x": 3.1512394549262512, - "y": 1.289721138915009, - "heading": 3.1413631463036533, - "angularVelocity": -0.000333842003262993, + "x": 3.1512394549258516, + "y": 1.2897211389149879, + "heading": 3.1413631463036538, + "angularVelocity": -0.00033384200326365063, "velocityX": 4.507524598705565, - "velocityY": -0.47919591040160886, + "velocityY": -0.4791959104016092, "moduleForcesX": [ - -2.9425289616999354e-10, - 2.6972600228707847e-10, - -2.943766041628635e-10, - 2.6960229431046965e-10 + -2.945523994192452e-10, + 2.697504660509287e-10, + -2.946761066760521e-10, + 2.6962675881038304e-10 ], "moduleForcesY": [ - 2.4512765070974995e-10, - 2.4500394281245953e-10, - -3.188512480187098e-10, - -3.189749559340506e-10 + 2.4525625397135997e-10, + 2.4513254681013373e-10, + -3.1904661177020595e-10, + -3.191703189494828e-10 ], - "timestamp": 0.40863566026831555 + "timestamp": 0.4086356602683156 }, { - "x": 3.51962651304027, - "y": 1.250557831466011, - "heading": 3.1413358623536007, - "angularVelocity": -0.000333842010196935, + "x": 3.5196265130398467, + "y": 1.2505578314660648, + "heading": 3.1413358623536016, + "angularVelocity": -0.0003338420101929837, "velocityX": 4.507524598705517, - "velocityY": -0.4791959104017224, + "velocityY": -0.47919591040172266, "moduleForcesX": [ - -2.9319524605502616e-10, - 2.7116789785781755e-10, - -2.9334050125477524e-10, - 2.7102264266190907e-10 + -2.9283289574986723e-10, + 2.7115512516572705e-10, + -2.929781114118843e-10, + 2.7100990950755063e-10 ], "moduleForcesY": [ - 2.565256487745166e-10, - 2.5638039353513226e-10, - -3.0783749498208265e-10, - -3.0798275019898476e-10 + 2.5635051689420785e-10, + 2.5620530119255553e-10, + -3.0763750386514194e-10, + -3.0778271954431195e-10 ], - "timestamp": 0.49036279232197866 + "timestamp": 0.4903627923219787 }, { - "x": 3.8880135711533463, - "y": 1.2113945240170787, - "heading": 3.141308578402982, - "angularVelocity": -0.0003338420171260208, + "x": 3.8880135711535515, + "y": 1.2113945240170145, + "heading": 3.1413085784029833, + "angularVelocity": -0.00033384201712058706, "velocityX": 4.507524598705524, - "velocityY": -0.4791959104013023, + "velocityY": -0.47919591040130255, "moduleForcesX": [ - -2.8017365622927923e-10, - 2.8379423080040176e-10, - -2.803342617801993e-10, - 2.8363362524959436e-10 + -2.80192725101816e-10, + 2.836545029382628e-10, + -2.803532608136775e-10, + 2.83493967226514e-10 ], "moduleForcesY": [ - 3.7727704785442104e-10, - 3.771164423033856e-10, - -1.8669083917433548e-10, - -1.8685144472525347e-10 + 3.772119807760254e-10, + 3.770514450640486e-10, + -1.8663524726312927e-10, + -1.867957829749886e-10 ], - "timestamp": 0.5720899243756418 + "timestamp": 0.5720899243756419 }, { - "x": 4.256400629267179, - "y": 1.1722312165687208, - "heading": 3.1412812944517974, - "angularVelocity": -0.00033384202405161144, + "x": 4.256400629267131, + "y": 1.1722312165687518, + "heading": 3.1412812944517987, + "angularVelocity": -0.00033384202405156797, "velocityX": 4.507524598706256, - "velocityY": -0.4791959103940783, + "velocityY": -0.47919591039407844, "moduleForcesX": [ - -1.1601533840227877e-10, - 4.476680699088195e-10, - -1.1619133319256263e-10, - 4.474920751185415e-10 + -1.1635902338158833e-10, + 4.477631051174233e-10, + -1.165351535479574e-10, + 4.475869749510601e-10 ], "moduleForcesY": [ - 1.9191264638326385e-9, - 1.918950469047209e-9, - 1.3554430555132117e-9, - 1.3552670607222244e-9 + 1.9193651862238043e-9, + 1.9191890560622896e-9, + 1.3552430577164645e-9, + 1.3550669275493915e-9 ], - "timestamp": 0.6538170564293049 + "timestamp": 0.653817056429305 }, { - "x": 4.624787687381106, - "y": 1.1330679091280322, - "heading": 3.1412540105000466, - "angularVelocity": -0.00033384203097612254, + "x": 4.6247876873816365, + "y": 1.1330679091279792, + "heading": 3.141254010500048, + "angularVelocity": -0.00033384203097711876, "velocityX": 4.507524598716221, - "velocityY": -0.4791959103000003, + "velocityY": -0.4791959103000007, "moduleForcesX": [ - 1.9765770134900176e-9, - 2.5401725437966218e-9, - 1.976385590478481e-9, - 2.5399811207741598e-9 + 1.9765153355534307e-9, + 2.5401954963740974e-9, + 1.976323873007331e-9, + 2.5400040338170728e-9 ], "moduleForcesY": [ - 2.1602981176742383e-8, - 2.1602789753868992e-8, - 2.1039385646053967e-8, - 2.1039194223054364e-8 + 2.160298396904306e-8, + 2.16027925066351e-8, + 2.103930380784058e-8, + 2.103911234530641e-8 ], - "timestamp": 0.735544188482968 + "timestamp": 0.7355441884829681 }, { - "x": 4.993174745507101, - "y": 1.093904601785636, - "heading": 3.14122672654773, - "angularVelocity": -0.00033384203790308084, + "x": 4.993174745506862, + "y": 1.0939046017857066, + "heading": 3.1412267265477314, + "angularVelocity": -0.00033384203789967075, "velocityX": 4.507524598844053, - "velocityY": -0.4791959090972083, + "velocityY": -0.47919590909720844, "moduleForcesX": [ - 2.868929446678408e-8, - 2.9253089173942963e-8, - 2.868908394171876e-8, - 2.9252878648747433e-8 + 2.8689184983444446e-8, + 2.9252621055977716e-8, + 2.8688974602268402e-8, + 2.925241067467146e-8 ], "moduleForcesY": [ - 2.728733268257027e-7, - 2.7287311630124865e-7, - 2.723095321160976e-7, - 2.723093215911679e-7 + 2.7287318449784567e-7, + 2.72872974117281e-7, + 2.723097484228662e-7, + 2.723095380418258e-7 ], - "timestamp": 0.8172713205366311 + "timestamp": 0.8172713205366312 }, { - "x": 5.361561803764487, - "y": 1.0547412956983473, - "heading": 3.1411994425948473, - "angularVelocity": -0.0003338420448259796, + "x": 5.361561803764377, + "y": 1.0547412956983293, + "heading": 3.1411994425948486, + "angularVelocity": -0.0003338420448248998, "velocityX": 4.507524600476514, - "velocityY": -0.47919589374122556, + "velocityY": -0.4791958937412259, "moduleForcesX": [ - 3.696865577304178e-7, - 3.702500219545937e-7, - 3.6968613763840057e-7, - 3.702496018625516e-7 + 3.696867015506992e-7, + 3.7025035543909504e-7, + 3.696862813689362e-7, + 3.702499352573073e-7 ], "moduleForcesY": [ - 0.0000034804410489130244, - 0.0000034804406288175047, - 0.000003479877584702018, - 0.0000034798771646076077 + 0.0000034804411290891762, + 0.00000348044070890391, + 0.0000034798774752139487, + 0.0000034798770550297925 ], - "timestamp": 0.8989984525902942 + "timestamp": 0.8989984525902943 }, { - "x": 5.729948863726285, - "y": 1.015578005631815, - "heading": 3.1411721586413393, - "angularVelocity": -0.00033384205247850694, - "velocityX": 4.507524621316063, - "velocityY": -0.47919569771268744, + "x": 5.729948863726064, + "y": 1.0155780056318247, + "heading": 3.141172158641341, + "angularVelocity": -0.0003338420524782025, + "velocityX": 4.507524621316062, + "velocityY": -0.4791956977126878, "moduleForcesX": [ - 0.000004722605910888902, - 0.000004723228755826117, - 0.000004722593901597685, - 0.000004723216746540372 + 0.000004722605717249217, + 0.000004723228625294551, + 0.000004722593707959265, + 0.00000472321661601007 ], "moduleForcesY": [ - 0.00004442668313336451, - 0.00004442667112405076, - 0.00004442606028868228, - 0.00004442604827933517 + 0.000044426683151454254, + 0.00004442667114214177, + 0.00004442606024366391, + 0.000044426048234318074 ], - "timestamp": 0.9807255846439573 + "timestamp": 0.9807255846439574 }, { - "x": 6.098335944993547, - "y": 0.9764149201272616, - "heading": 3.141144873733055, - "angularVelocity": -0.0003338537349670905, - "velocityX": 4.507524882009698, - "velocityY": -0.4791931947257305, + "x": 6.098335944993564, + "y": 0.9764149201272568, + "heading": 3.1411448737330567, + "angularVelocity": -0.00033385373496601367, + "velocityX": 4.507524882009697, + "velocityY": -0.47919319472573085, "moduleForcesX": [ - 0.000058606608936925306, - 0.00005955746287124728, - 0.00005860564622522572, - 0.00005955650005937791 + 0.000058606609209525885, + 0.00005955746308098625, + 0.000058605646496038295, + 0.000059556500267328035 ], "moduleForcesY": [ - 0.0005677331808062003, - 0.0005677322177464595, - 0.0005667823272709411, - 0.0005667813645585504 + 0.0005677331807728031, + 0.0005677322177112738, + 0.000566782327300406, + 0.0005667813645862271 ], - "timestamp": 1.0624527166976203 + "timestamp": 1.0624527166976205 }, { - "x": 6.466713606551941, - "y": 0.9372554763119637, - "heading": 3.1411027380347774, - "angularVelocity": -0.0005155656049507016, + "x": 6.46671360655173, + "y": 0.9372554763119341, + "heading": 3.1411027380347787, + "angularVelocity": -0.0005155656049492363, "velocityX": 4.50740962396997, - "velocityY": -0.4791486356035406, + "velocityY": -0.47914863560354054, "moduleForcesX": [ - -0.033512437082181865, - -0.018722651292121043, - -0.03351970042077828, - -0.01872991270097043 + -0.03351243708215853, + -0.018722651292127624, + -0.03351970042075507, + -0.01872991270097627 ], "moduleForcesY": [ - 0.017497044920547423, - 0.01748978512288604, - 0.0027072770317358424, - 0.002700008527818997 + 0.017497044920615233, + 0.017489785122957475, + 0.002707277031841645, + 0.0027000085279199264 ], - "timestamp": 1.1441798487512833 + "timestamp": 1.1441798487512838 }, { - "x": 6.801579450679335, - "y": 0.9016550002248332, - "heading": 3.1232438571056225, - "angularVelocity": -0.21851838527048875, + "x": 6.801579450679561, + "y": 0.9016550002248982, + "heading": 3.12324385710561, + "angularVelocity": -0.21851838527065992, "velocityX": 4.097364433494548, - "velocityY": -0.4356016807700555, + "velocityY": -0.43560168077005584, "moduleForcesX": [ - -93.69834450297687, - -89.01513972710934, - -96.03922536165108, - -92.96495477245452 + -93.69834450297753, + -89.01513972710512, + -96.03922536165277, + -92.96495477245534 ], "moduleForcesY": [ - 22.28341658989289, - 29.051835313736024, - -4.744060783787519, - -7.114634103996269 + 22.28341658989852, + 29.051835313755163, + -4.744060783792586, + -7.114634104016339 ], - "timestamp": 1.2259069808049463 + "timestamp": 1.225906980804947 }, { - "x": 7.099346531012958, - "y": 0.8699987853286542, - "heading": 3.106691367168923, - "angularVelocity": -0.20253359589115869, - "velocityX": 3.6434299461030673, - "velocityY": -0.3873403373002619, + "x": 7.099346531013058, + "y": 0.869998785328631, + "heading": 3.1066913671689087, + "angularVelocity": -0.20253359589117298, + "velocityX": 3.6434299461030677, + "velocityY": -0.38734033730026224, "moduleForcesX": [ - -102.99949769077502, - -103.02513937963398, - -102.72151509322181, - -102.75841208178751 + -102.99949769077611, + -103.02513937963529, + -102.72151509322009, + -102.75841208178622 ], "moduleForcesY": [ - 9.727922777809646, - 9.578030116265486, - 12.328637537836405, - 12.115694391256039 + 9.727922777797522, + 9.578030116252217, + 12.328637537850282, + 12.115694391267553 ], - "timestamp": 1.3076341128586093 + "timestamp": 1.3076341128586102 }, { - "x": 7.359936597959423, - "y": 0.8422950114060971, - "heading": 3.0919308976796085, - "angularVelocity": -0.18060672286435264, + "x": 7.359936597959464, + "y": 0.8422950114061555, + "heading": 3.0919308976795943, + "angularVelocity": -0.18060672286435828, "velocityX": 3.1885380093254865, - "velocityY": -0.33897890732615193, + "velocityY": -0.3389789073261522, "moduleForcesX": [ - -103.27059619944963, - -103.29104696246749, - -102.8854236951988, - -102.92545257425414 + -103.2705961994497, + -103.29104696246755, + -102.88542369519871, + -102.92545257425405 ], "moduleForcesY": [ - 9.261942170050276, - 9.123903472256336, - 12.8564729825216, - 12.59869747011876 + 9.261942170049517, + 9.123903472255591, + 12.856472982522407, + 12.59869747011948 ], - "timestamp": 1.3893612449122723 + "timestamp": 1.3893612449122734 }, { - "x": 7.58332287276895, - "y": 0.8185464774785829, - "heading": 3.0791309749028772, - "angularVelocity": -0.1566177896506479, - "velocityX": 2.733318412085363, - "velocityY": -0.29058322898184225, + "x": 7.58332287276877, + "y": 0.818546477478533, + "heading": 3.079130974902868, + "angularVelocity": -0.15661778965058812, + "velocityX": 2.7333184120853633, + "velocityY": -0.2905832289818426, "moduleForcesX": [ - -103.36594951172025, - -103.38028751192688, - -102.94365368980282, - -102.97966227585505 + -103.3659495117207, + -103.38028751192735, + -102.94365368980209, + -102.97966227585444 ], "moduleForcesY": [ - 9.079616014969533, - 8.984237326802269, - 13.023827383874401, - 12.784382494043633 + 9.079616014964232, + 8.984237326796942, + 13.023827383880123, + 12.78438249404854 ], - "timestamp": 1.4710883769659353 + "timestamp": 1.4710883769659366 }, { - "x": 7.769491837116803, - "y": 0.7987545966176683, - "heading": 3.0683771471345906, - "angularVelocity": -0.1315821012931888, - "velocityX": 2.277933406815666, - "velocityY": -0.24217026051927823, + "x": 7.7694918371165045, + "y": 0.7987545966176534, + "heading": 3.0683771471345858, + "angularVelocity": -0.1315821012931304, + "velocityX": 2.277933406815667, + "velocityY": -0.2421702605192785, "moduleForcesX": [ -103.41515460878193, - -103.42443760342492, - -102.97433378125582, - -103.005574093989 + -103.4244376034249, + -102.97433378125584, + -103.00557409398901 ], "moduleForcesY": [ - 8.976218196001655, - 8.923469974360179, - 13.099124861119694, - 12.88892417371863 + 8.976218196001748, + 8.923469974360286, + 13.099124861119599, + 12.888924173718566 ], - "timestamp": 1.5528155090195983 + "timestamp": 1.5528155090195999 }, { - "x": 7.918435339366071, - "y": 0.7829202209960606, - "heading": 3.0597211380125815, - "angularVelocity": -0.10591353084953188, - "velocityX": 1.8224486594111562, - "velocityY": -0.19374686500967267, + "x": 7.918435339365923, + "y": 0.7829202209960395, + "heading": 3.0597211380125793, + "angularVelocity": -0.10591353084949826, + "velocityX": 1.8224486594111566, + "velocityY": -0.19374686500967284, "moduleForcesX": [ - -103.44532754676128, - -103.45059106507556, - -102.99353139152261, - -103.02046917509142 + -103.44532754676109, + -103.45059106507539, + -102.9935313915229, + -103.02046917509165 ], "moduleForcesY": [ - 8.908204125136255, - 8.89210265995939, - 13.139438738048499, - 12.957444097698344 + 8.908204125138308, + 8.892102659961388, + 13.139438738046369, + 12.957444097696476 ], - "timestamp": 1.6345426410732613 + "timestamp": 1.634542641073263 }, { - "x": 8.030147928353161, - "y": 0.7710439205191237, + "x": 8.030147928353294, + "y": 0.7710439205191398, "heading": 3.053197581935371, - "angularVelocity": -0.07982117949430736, - "velocityX": 1.3668972124774883, - "velocityY": -0.14531649622907394, + "angularVelocity": -0.07982117949428515, + "velocityX": 1.3668972124774887, + "velocityY": -0.14531649622907405, "moduleForcesX": [ - -103.46568344315243, - -103.46789643910462, - -103.00664909946575, - -103.03015522294537 + -103.46568344315234, + -103.46789643910454, + -103.00664909946587, + -103.03015522294548 ], "moduleForcesY": [ - 8.86063249043144, - 8.873193949089648, - 13.164397740662087, - 13.00528690977233 + 8.860632490432424, + 8.873193949090584, + 13.164397740661096, + 13.005286909771451 ], - "timestamp": 1.7162697731269243 + "timestamp": 1.7162697731269263 }, { - "x": 8.104625702260256, - "y": 0.7631261031139874, + "x": 8.10462570226017, + "y": 0.7631261031139884, "heading": 3.0488312843564214, - "angularVelocity": -0.053425312613233654, - "velocityX": 0.9112980234968839, - "velocityY": -0.09688113611971519, + "angularVelocity": -0.05342531261322825, + "velocityX": 0.911298023496884, + "velocityY": -0.09688113611971526, "moduleForcesX": [ - -103.48021692002517, - -103.48030657193449, - -103.01600852054571, - -103.03713171986256 + -103.48021692002504, + -103.48030657193438, + -103.01600852054591, + -103.03713171986273 ], "moduleForcesY": [ - 8.826978887492562, - 8.859337121264703, - 13.18260602174957, - 13.039113841379665 + 8.826978887494013, + 8.859337121266073, + 13.182606021748102, + 13.039113841378352 ], - "timestamp": 1.7979969051805873 + "timestamp": 1.7979969051805895 }, { - "x": 8.14186573028563, - "y": 0.7591670751571251, + "x": 8.14186573028574, + "y": 0.7591670751571266, "heading": 3.0466408807888117, - "angularVelocity": -0.02680142460120989, - "velocityX": 0.4556629737236343, - "velocityY": -0.04844202723516076, + "angularVelocity": -0.026801424601212133, + "velocityX": 0.4556629737236342, + "velocityY": -0.04844202723516079, "moduleForcesX": [ - -103.490940054563, - -103.4898092444739, - -103.0227710663496, - -103.04265219867469 + -103.49094005456293, + -103.48980924447385, + -103.02277106634969, + -103.04265219867477 ], "moduleForcesY": [ - 8.803943328885603, - 8.846770557986561, - 13.198440061449329, - 13.062280295237983 + 8.803943328886316, + 8.846770557987233, + 13.198440061448613, + 13.062280295237343 ], - "timestamp": 1.8797240372342503 + "timestamp": 1.8797240372342527 }, { "x": 8.141865730285645, "y": 0.7591670751571655, "heading": 3.0466408807888117, - "angularVelocity": -2.2162561306828634e-18, - "velocityX": 6.0719591465516605e-18, - "velocityY": 3.7191933332762756e-19, + "angularVelocity": -2.216413397491607e-18, + "velocityX": 6.071801473157301e-18, + "velocityY": 3.719160099439509e-19, "moduleForcesX": [ -103.49897514652822, - -103.497512630357, - -103.02758277721088, - -103.04741586769943 + -103.49751263035701, + -103.02758277721087, + -103.04741586769941 ], "moduleForcesY": [ - 8.789691125263571, - 8.833386151441184, - 13.214354544577951, - 13.076647990366267 + 8.789691125263493, + 8.833386151441111, + 13.214354544578041, + 13.076647990366352 ], - "timestamp": 1.9614511692879133 + "timestamp": 1.961451169287916 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/SourceSpit54Source.2.traj b/src/main/deploy/choreo/SourceSpit54Source.2.traj index 8f29509..9747e1b 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.2.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.2.traj @@ -4,41 +4,41 @@ "x": 8.141865730285645, "y": 0.7591670751571655, "heading": 3.0466408807888117, - "angularVelocity": -2.2162561306828634e-18, - "velocityX": 6.0719591465516605e-18, - "velocityY": 3.7191933332762756e-19, + "angularVelocity": -2.216413397491607e-18, + "velocityX": 6.071801473157301e-18, + "velocityY": 3.719160099439509e-19, "moduleForcesX": [ -103.49897514652822, - -103.497512630357, - -103.02758277721088, - -103.04741586769943 + -103.49751263035701, + -103.02758277721087, + -103.04741586769941 ], "moduleForcesY": [ - 8.789691125263571, - 8.833386151441184, - 13.214354544577951, - 13.076647990366267 + 8.789691125263493, + 8.833386151441111, + 13.214354544578041, + 13.076647990366352 ], "timestamp": 0 }, { "x": 8.12139177192427, - "y": 0.7686524008245413, - "heading": 3.056527253089306, - "angularVelocity": 0.15490715137698402, - "velocityX": -0.3208014497909542, - "velocityY": 0.14862324969723603, + "y": 0.7686524008245414, + "heading": 3.0565272530893055, + "angularVelocity": 0.15490715137698394, + "velocityX": -0.32080144979095415, + "velocityY": 0.14862324969723617, "moduleForcesX": [ - -98.54262377114843, - -100.4770509117282, - -82.79137566578632, - -90.59657531971158 + -98.54262377114841, + -100.47705091172818, + -82.7913756657863, + -90.59657531971156 ], "moduleForcesY": [ - 32.73797497154649, - 26.30090387431019, - 62.69281274939932, - 50.800045948114445 + 32.737974971546535, + 26.300903874310222, + 62.69281274939936, + 50.80004594811448 ], "timestamp": 0.06382127753698441 }, @@ -46,198 +46,198 @@ "x": 8.080660351142782, "y": 0.7880598204655119, "heading": 3.076375749087686, - "angularVelocity": 0.31100123288629355, - "velocityX": -0.638210677589206, - "velocityY": 0.30409011523976287, + "angularVelocity": 0.31100123288629333, + "velocityX": -0.6382106775892058, + "velocityY": 0.304090115239763, "moduleForcesX": [ -97.51013510987994, - -100.05875562562483, - -81.09999788338129, + -100.05875562562481, + -81.09999788338128, -89.80082050059022 ], "moduleForcesY": [ - 35.64906123251604, - 27.807073480632145, + 35.64906123251607, + 27.807073480632162, 64.84604210021749, - 52.17408445205142 + 52.174084452051424 ], "timestamp": 0.12764255507396882 }, { - "x": 8.019993961475123, + "x": 8.019993961475121, "y": 0.8180013901296872, "heading": 3.1062742720333283, - "angularVelocity": 0.46847264892677243, - "velocityX": -0.9505668330206076, - "velocityY": 0.46914713743898434, + "angularVelocity": 0.46847264892677226, + "velocityX": -0.9505668330206073, + "velocityY": 0.4691471374389845, "moduleForcesX": [ - -95.83367751055793, + -95.83367751055792, -99.42042191041061, - -78.67293358001308, + -78.67293358001307, -88.676734166875 ], "moduleForcesY": [ - 39.87717934463128, - 29.95217527604755, - 67.74395166278366, - 54.03584566132871 + 39.8771793446313, + 29.952175276047576, + 67.74395166278367, + 54.03584566132872 ], "timestamp": 0.19146383261095323 }, { - "x": 7.9399197688128345, + "x": 7.939919768812834, "y": 0.8593922232548926, "heading": 3.1463376298650596, - "angularVelocity": 0.627742962502038, - "velocityX": -1.2546629549351198, - "velocityY": 0.6485428484445409, + "angularVelocity": 0.6277429625020375, + "velocityX": -1.2546629549351196, + "velocityY": 0.6485428484445411, "moduleForcesX": [ - -92.88000464654638, + -92.88000464654637, -98.30849263529356, -74.94629470181758, -86.88017977205095 ], "moduleForcesY": [ - 46.26239074940662, - 33.34169675064432, + 46.262390749406656, + 33.34169675064433, 71.8090336983567, - 56.841332870312876 + 56.84133287031288 ], "timestamp": 0.25528511014793764 }, { - "x": 7.84143071939511, + "x": 7.841430719395109, "y": 0.9137307885891377, - "heading": 3.1967482621269068, - "angularVelocity": 0.7898718767049805, - "velocityX": -1.5432008449008328, - "velocityY": 0.8514177000414278, + "heading": 3.196748262126907, + "angularVelocity": 0.78987187670498, + "velocityX": -1.5432008449008323, + "velocityY": 0.8514177000414281, "moduleForcesX": [ - -86.89087334993594, - -95.98833796115419, + -86.89087334993593, + -95.98833796115417, -68.54914547471209, - -83.52558618270564 + -83.52558618270562 ], "moduleForcesY": [ - 56.60723624372076, - 39.41093811953867, + 56.6072362437208, + 39.4109381195387, 77.88580562900931, - 61.606619602131445 + 61.60661960213146 ], "timestamp": 0.31910638768492205 }, { - "x": 7.726890294226319, + "x": 7.726890294226318, "y": 0.9837916600371955, - "heading": 3.2578934429620614, - "angularVelocity": 0.9580688948089633, - "velocityX": -1.794705928636651, - "velocityY": 1.097766672054747, + "heading": 3.257893442962062, + "angularVelocity": 0.9580688948089631, + "velocityX": -1.7947059286366505, + "velocityY": 1.0977666720547472, "moduleForcesX": [ - -71.52639870627524, - -89.45838724827226, - -55.36209082390232, - -75.61692556289127 + -71.5263987062752, + -89.45838724827225, + -55.36209082390229, + -75.61692556289125 ], "moduleForcesY": [ - 74.9291777122655, - 52.39133519711495, - 87.66530845618459, - 70.99242409781272 + 74.92917771226554, + 52.39133519711497, + 87.6653084561846, + 70.99242409781274 ], "timestamp": 0.38292766522190647 }, { - "x": 7.604447006986396, - "y": 1.0748288274783149, + "x": 7.604447006986394, + "y": 1.0748288274783147, "heading": 3.330112940587566, - "angularVelocity": 1.1315896580674487, - "velocityX": -1.9185339429936596, - "velocityY": 1.4264391274267907, + "angularVelocity": 1.1315896580674483, + "velocityX": -1.9185339429936592, + "velocityY": 1.426439127426791, "moduleForcesX": [ - -19.766010110953378, + -19.766010110953335, -56.93061698323477, - -19.68184871481916, + -19.68184871481914, -47.36930602917605 ], "moduleForcesY": [ 101.47075361978412, - 86.34001229995955, - 101.64986956083462, + 86.34001229995954, + 101.6498695608346, 92.08417613875184 ], "timestamp": 0.4467489427588909 }, { - "x": 7.496600987086121, - "y": 1.1832751788415659, + "x": 7.49660098708612, + "y": 1.1832751788415656, "heading": 3.4049089717941157, - "angularVelocity": 1.171960733051846, - "velocityX": -1.689812928576642, - "velocityY": 1.6992193755508294, + "angularVelocity": 1.1719607330518458, + "velocityX": -1.6898129285766412, + "velocityY": 1.6992193755508296, "moduleForcesX": [ - 70.7545238307989, + 70.75452383079893, 67.2502135728131, - 65.69679627017268, - 61.81300803108725 + 65.69679627017267, + 61.81300803108722 ], "moduleForcesY": [ - 75.40519753122972, + 75.4051975312297, 78.49699682759936, 79.87907669757777, - 82.88015487947983 + 82.88015487947986 ], "timestamp": 0.5105702202958753 }, { "x": 7.410809145133341, - "y": 1.2972469395306558, + "y": 1.2972469395306556, "heading": 3.4754003948557055, - "angularVelocity": 1.1045128800616704, - "velocityX": -1.3442514042916571, - "velocityY": 1.7857956638840902, + "angularVelocity": 1.1045128800616708, + "velocityX": -1.3442514042916565, + "velocityY": 1.7857956638840904, "moduleForcesX": [ 98.62488839987037, 98.5728623639948, 102.14680103093937, - 101.80621253364352 + 101.8062125336435 ], "moduleForcesY": [ - 31.723120096729687, - 32.017438994516304, - 17.325158702635157, - 19.43778678310921 + 31.723120096729684, + 32.0174389945163, + 17.32515870263519, + 19.437786783109235 ], "timestamp": 0.5743914978328597 }, { - "x": 7.347703161601463, - "y": 1.4119343387372154, + "x": 7.347703161601462, + "y": 1.4119343387372152, "heading": 3.5395016960037164, - "angularVelocity": 1.0043876215242498, - "velocityX": -0.9887922330496858, - "velocityY": 1.797008828914432, + "angularVelocity": 1.00438762152425, + "velocityX": -0.9887922330496852, + "velocityY": 1.7970088289144321, "moduleForcesX": [ 103.21492466040641, 102.5340444041503, 103.15479218615785, - 103.73684891651338 + 103.7368489165134 ], "moduleForcesY": [ - 10.084977865190455, - 15.81269263577463, - -10.857317716288517, - -2.0233662096521496 + 10.084977865190448, + 15.812692635774624, + -10.857317716288497, + -2.02336620965214 ], "timestamp": 0.6382127753698441 }, { - "x": 7.307225519445186, - "y": 1.5251286705269973, - "heading": 3.5964095924585773, - "angularVelocity": 0.8916759214336103, - "velocityX": -0.6342342823335027, - "velocityY": 1.7736143204620987, + "x": 7.307225519445185, + "y": 1.525128670526997, + "heading": 3.5964095924585777, + "angularVelocity": 0.8916759214336106, + "velocityX": -0.6342342823335022, + "velocityY": 1.7736143204620993, "moduleForcesX": [ 103.74866093971778, 103.44945570252287, @@ -245,30 +245,30 @@ 103.26271541637972 ], "moduleForcesY": [ - -1.704103468345933, - 8.460590728388368, - -23.303196470017358, - -10.611189708777841 + -1.7041034683459535, + 8.46059072838836, + -23.303196470017355, + -10.611189708777834 ], "timestamp": 0.7020340529068285 }, { "x": 7.289250021057145, - "y": 1.6355954194055542, + "y": 1.635595419405554, "heading": 3.6457195990819606, - "angularVelocity": 0.7726264425654572, - "velocityX": -0.28165369108482585, - "velocityY": 1.730876490439123, + "angularVelocity": 0.7726264425654574, + "velocityX": -0.2816536910848256, + "velocityY": 1.7308764904391236, "moduleForcesX": [ 103.3950377520685, 103.7321422456981, - 99.41424789462361, + 99.4142478946236, 102.75753546713821 ], "moduleForcesY": [ - -9.12218556394263, - 4.334969983631569, - -29.912958244672346, + -9.122185563942644, + 4.334969983631551, + -29.912958244672343, -14.912737262065388 ], "timestamp": 0.7658553304438129 @@ -277,9 +277,9 @@ "x": 7.293661117553711, "y": 1.7425522804260254, "heading": 3.687185307179586, - "angularVelocity": 0.649716046088176, - "velocityX": 0.06911639294606202, - "velocityY": 1.675880915396745, + "angularVelocity": 0.6497160460881763, + "velocityX": 0.06911639294606219, + "velocityY": 1.6758809153967456, "moduleForcesX": [ 102.83835381995104, 103.82690448841359, @@ -287,157 +287,157 @@ 102.38468452490544 ], "moduleForcesY": [ - -14.237709698132518, - 1.6908860682116789, + -14.237709698132527, + 1.6908860682116629, -33.90397753188714, - -17.391714316675273 + -17.39171431667528 ], "timestamp": 0.8296766079807973 }, { - "x": 7.337238709014604, - "y": 1.87500903823816, - "heading": 3.7276018871038197, - "angularVelocity": 0.4861440875001379, - "velocityX": 0.5241657873061937, - "velocityY": 1.5932340089270574, + "x": 7.337238709014603, + "y": 1.8750090382381601, + "heading": 3.7276018871038192, + "angularVelocity": 0.4861440875001382, + "velocityX": 0.5241657873061938, + "velocityY": 1.593234008927058, "moduleForcesX": [ - 102.26407313635566, - 103.87008588403226, + 102.26407313635565, + 103.87008588403228, 97.23651288613812, 102.14881136766725 ], "moduleForcesY": [ - -18.1167751960945, - -0.13662685931345306, - -36.523872030709605, - -18.873918995735348 + -18.116775196094515, + -0.13662685931346932, + -36.52387203070962, + -18.873918995735366 ], "timestamp": 0.9128136469028676 }, { - "x": 7.418144617115574, - "y": 1.9984157113823813, + "x": 7.418144617115573, + "y": 1.9984157113823817, "heading": 3.7537024581651615, - "angularVelocity": 0.3139463637357569, - "velocityX": 0.973163215216371, - "velocityY": 1.4843765756427652, + "angularVelocity": 0.31394636373575724, + "velocityX": 0.9731632152163713, + "velocityY": 1.4843765756427656, "moduleForcesX": [ - 100.52939508517865, - 103.73438246873789, - 94.67434050174212, + 100.52939508517862, + 103.7343824687379, + 94.67434050174211, 101.1881258515662 ], "moduleForcesY": [ - -25.98258070015821, - -4.920905115133015, - -42.6869167197914, - -23.418429128288864 + -25.98258070015823, + -4.920905115133046, + -42.68691671979141, + -23.41842912828889 ], "timestamp": 0.9959506858249378 }, { "x": 7.535048231941541, - "y": 2.108654455088382, + "y": 2.1086544550883826, "heading": 3.764158105558933, - "angularVelocity": 0.12576400999285073, - "velocityX": 1.4061556237954207, - "velocityY": 1.32598833366359, + "angularVelocity": 0.12576400999285112, + "velocityX": 1.406155623795421, + "velocityY": 1.3259883336635903, "moduleForcesX": [ - 95.63931861838329, - 102.78237917887598, + 95.63931861838326, + 102.78237917887597, 88.81788214328411, 98.62371306642002 ], "moduleForcesY": [ - -40.31051152213473, - -14.596292935414386, - -53.76177775288337, - -32.47987077107174 + -40.31051152213476, + -14.596292935414418, + -53.761777752883376, + -32.47987077107177 ], "timestamp": 1.079087724747008 }, { "x": 7.682469399516894, "y": 2.196017238119042, - "heading": 3.7560195778482997, - "angularVelocity": -0.09789292253073484, - "velocityX": 1.7732309147255072, - "velocityY": 1.0508286578807635, + "heading": 3.7560195778483, + "angularVelocity": -0.09789292253073449, + "velocityX": 1.7732309147255074, + "velocityY": 1.0508286578807637, "moduleForcesX": [ - 73.74963298837837, + 73.74963298837834, 95.21787023816454, - 69.85213902700369, - 88.30129043115058 + 69.85213902700366, + 88.30129043115056 ], "moduleForcesY": [ - -72.87651101750657, - -41.11318054758713, - -76.71810896892563, - -54.50208420442406 + -72.87651101750659, + -41.11318054758717, + -76.71810896892566, + -54.502084204424094 ], "timestamp": 1.1622247636690783 }, { "x": 7.827046544355028, "y": 2.245170461645328, - "heading": 3.7335207343789736, - "angularVelocity": -0.2706235843979915, + "heading": 3.733520734378974, + "angularVelocity": -0.2706235843979911, "velocityX": 1.7390220617991428, - "velocityY": 0.5912313472261188, + "velocityY": 0.591231347226119, "moduleForcesX": [ - -27.243123321085665, - -4.814624290303508, - -9.68112654908082, - 11.253488323161408 + -27.24312332108567, + -4.8146242903035255, + -9.681126549080819, + 11.253488323161399 ], "moduleForcesY": [ -99.95478411862625, -103.41484563118533, -103.20086487986812, - -103.00188639272085 + -103.00188639272083 ], "timestamp": 1.2453618025911486 }, { "x": 7.939432858680839, "y": 2.2728190012561487, - "heading": 3.711795290511636, - "angularVelocity": -0.2613208763389104, - "velocityX": 1.351820028509299, - "velocityY": 0.3325658451311618, + "heading": 3.7117952905116365, + "angularVelocity": -0.2613208763389101, + "velocityX": 1.3518200285092992, + "velocityY": 0.3325658451311619, "moduleForcesX": [ -85.83973955060614, - -85.86349337551788, - -86.67105675311807, - -86.682687450033 + -85.86349337551786, + -86.67105675311805, + -86.68268745003297 ], "moduleForcesY": [ - -58.26066678399723, - -58.230272160397995, - -57.01652209858838, - -57.003560508651326 + -58.260666783997245, + -58.230272160398, + -57.0165220985884, + -57.003560508651354 ], "timestamp": 1.3284988415132188 }, { "x": 8.015204219703966, - "y": 2.2879711195258747, + "y": 2.287971119525875, "heading": 3.695746234916774, - "angularVelocity": -0.1930433871948052, - "velocityX": 0.9114031724674717, - "velocityY": 0.1822547262469813, + "angularVelocity": -0.19304338719480513, + "velocityX": 0.9114031724674719, + "velocityY": 0.18225472624698136, "moduleForcesX": [ -96.75469117814397, -96.05837459678298, -100.23022297352226, - -99.43633676223166 + -99.43633676223165 ], "moduleForcesY": [ -37.62667070086972, - -39.39983844031861, - -27.05066205494617, - -29.87331421433262 + -39.39983844031862, + -27.050662054946198, + -29.873314214332638 ], "timestamp": 1.411635880435289 }, @@ -445,20 +445,20 @@ "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -0.10222248797976585, - "velocityX": 0.458089926796231, - "velocityY": 0.07860746516215023, + "angularVelocity": -0.10222248797976584, + "velocityX": 0.4580899267962311, + "velocityY": 0.07860746516215021, "moduleForcesX": [ -99.99595652451094, -98.93838085703482, - -102.93566476550784, + -102.93566476550782, -102.1023037702812 ], "moduleForcesY": [ - -28.01425430205255, + -28.014254302052557, -31.58059735167417, - -13.749709895364493, - -19.02119979206612 + -13.749709895364512, + -19.021199792066128 ], "timestamp": 1.4947729193573593 }, @@ -466,20 +466,20 @@ "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -2.2487070096555965e-24, - "velocityX": -6.586009418122838e-24, - "velocityY": -6.745594827234793e-23, + "angularVelocity": 4.746550318316871e-18, + "velocityX": 3.830709578831724e-18, + "velocityY": -3.790242714904371e-17, "moduleForcesX": [ - -101.38094391616681, + -101.3809439161668, -100.18837572868954, -103.65752574347157, - -103.00222316967671 + -103.0022231696767 ], "moduleForcesY": [ -22.57602378649472, -27.420895846258933, - -6.612215074301221, - -13.442290586836583 + -6.612215074301234, + -13.442290586836586 ], "timestamp": 1.5779099582794296 } diff --git a/src/main/deploy/choreo/SourceSpit54Source.3.traj b/src/main/deploy/choreo/SourceSpit54Source.3.traj index cc323af..3aff2bd 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.3.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.3.traj @@ -4,694 +4,673 @@ "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -2.2487070096555965e-24, - "velocityX": -6.586009418122838e-24, - "velocityY": -6.745594827234793e-23, + "angularVelocity": 4.746550318316871e-18, + "velocityX": 3.830709578831724e-18, + "velocityY": -3.790242714904371e-17, "moduleForcesX": [ - -101.38094391616681, + -101.3809439161668, -100.18837572868954, -103.65752574347157, - -103.00222316967671 + -103.0022231696767 ], "moduleForcesY": [ -22.57602378649472, -27.420895846258933, - -6.612215074301221, - -13.442290586836583 + -6.612215074301234, + -13.442290586836586 ], "timestamp": 0 }, { - "x": 8.042267379204025, - "y": 2.286920400255937, - "heading": 3.6839492904550912, - "angularVelocity": -0.06738828727279574, - "velocityX": -0.22516253183784973, - "velocityY": -0.15498144231857655, + "x": 8.04155600019783, + "y": 2.2900230804484996, + "heading": 3.6835314194357935, + "angularVelocity": -0.07829646151040115, + "velocityX": -0.24718135110639422, + "velocityY": -0.09445343317829462, "moduleForcesX": [ - -90.23310642233936, - -90.46015989642483, - -80.90721847317343, - -79.21224337558162 + -99.51138063972249, + -101.00703312365503, + -92.29762670645609, + -93.00870017418045 ], "moduleForcesY": [ - -51.39622974657535, - -50.96352690092429, - -65.09806908584876, - -67.12671078256284 + -29.683224012710998, + -24.030989118219587, + -47.584016472907386, + -46.13389339344374 ], - "timestamp": 0.0489472226300216 + "timestamp": 0.047464986889631966 }, { - "x": 8.020118260548989, - "y": 2.27191020601647, - "heading": 3.67731157995458, - "angularVelocity": -0.1356095431743696, - "velocityX": -0.452510223561754, - "velocityY": -0.30666079570897453, + "x": 8.018057195518905, + "y": 2.2811494373882057, + "heading": 3.6760894228573657, + "angularVelocity": -0.15678918432512154, + "velocityX": -0.49507660715139173, + "velocityY": -0.18695134325515003, "moduleForcesX": [ - -90.97734104538547, - -91.27768795879761, - -81.73935810599804, - -80.12586427698638 + -99.74002296606275, + -101.19538000468857, + -92.65070099257755, + -93.35296907893509 ], "moduleForcesY": [ - -50.05478323953953, - -49.46918914887244, - -64.04043461006067, - -66.02198916487437 + -28.886290968520573, + -23.19555788366235, + -46.88051907476131, + -45.41738404777075 ], - "timestamp": 0.0978944452600432 + "timestamp": 0.09492997377926393 }, { - "x": 7.986720121618324, - "y": 2.2496648858012405, - "heading": 3.667288353892784, - "angularVelocity": -0.20477619614005485, - "velocityX": -0.6823296018879611, - "velocityY": -0.4544756376347613, + "x": 7.982754275427238, + "y": 2.2679916233265414, + "heading": 3.664910946533458, + "angularVelocity": -0.23550994230548836, + "velocityX": -0.7437676148626708, + "velocityY": -0.2772109491597683, "moduleForcesX": [ - -91.82209642527894, - -92.18311514570865, - -82.69994324479192, - -81.15631518014195 + -100.00155441797193, + -101.39729726358, + -93.0583355862382, + -93.72397252125086 ], "moduleForcesY": [ - -48.47312480864625, - -47.74251349400657, - -62.783720018414115, - -64.73759795306572 + -27.944614997839846, + -22.261085973038842, + -46.051832228917284, + -44.62845550001454 ], - "timestamp": 0.1468416678900648 + "timestamp": 0.1423949606688959 }, { - "x": 7.941935287270955, - "y": 2.2204085553192443, - "heading": 3.653826669659306, - "angularVelocity": -0.27502447555055315, - "velocityX": -0.9149617065279765, - "velocityY": -0.5977117578894477, + "x": 7.93560492757735, + "y": 2.250672393954877, + "heading": 3.6499835048582434, + "angularVelocity": -0.31449374904337585, + "velocityX": -0.9933500661146728, + "velocityY": -0.36488431800970306, "moduleForcesX": [ - -92.78130460539496, - -93.19410470384004, - -83.81128188925368, - -82.33220529185469 + -100.29788416314965, + -101.61561762433931, + -93.52735002862231, + -94.13175992251685 ], "moduleForcesY": [ - -46.59314409733099, - -45.71536994844289, - -61.27877787721252, - -63.21917457778012 + -26.834219228647218, + -21.19949127166946, + -45.07503931940974, + -43.74038805618346 ], - "timestamp": 0.1957888905200864 + "timestamp": 0.18985994755852786 }, { - "x": 7.885606145012031, - "y": 2.184410544194298, - "heading": 3.6368654595761822, - "angularVelocity": -0.34652037790435614, - "velocityX": -1.1508138609763638, - "velocityY": -0.7354454285801943, + "x": 7.876561507986373, + "y": 2.2293351295184527, + "heading": 3.6312927818612053, + "angularVelocity": -0.39377916695729515, + "velocityX": -1.2439362877748312, + "velocityY": -0.44953692889872054, "moduleForcesX": [ - -93.87058194700928, - -94.3305748926031, - -85.10140955008177, - -83.69029359301578 + -100.63091275931306, + -101.85325235990693, + -94.0662420635145, + -94.58898722643158 ], "moduleForcesY": [ - -44.33581141832799, - -43.29398533047087, - -59.45771041589864, - -61.39028745543386 + -25.523497466552957, + -19.97371276998484, + -43.91957692503486, + -42.71725731589675 ], - "timestamp": 0.24473611315010801 + "timestamp": 0.23732493444815983 }, { - "x": 7.817551278486936, - "y": 2.141999892045337, - "heading": 3.616333715880149, - "angularVelocity": -0.4194669808178373, - "velocityX": -1.3903723820961815, - "velocityY": -0.8664567644528267, + "x": 7.8055701014577625, + "y": 2.204149410872242, + "heading": 3.6088224461535567, + "angularVelocity": -0.4734086572044736, + "velocityX": -1.4956584035616685, + "velocityY": -0.5306167830756522, "moduleForcesX": [ - -95.10628659732889, - -95.61338727553908, - -86.60546294692051, - -85.27779037334444 + -101.00228721734821, + -102.1128986440163, + -94.68559764988736, + -95.11162514377558 ], "moduleForcesY": [ - -41.59126226883808, - -40.34628817483284, - -57.22442878703077, - -59.140688780590104 + -23.969873712700704, + -18.533565956987044, + -42.54396152487971, + -41.509936441328755 ], - "timestamp": 0.2936833357801296 + "timestamp": 0.2847899213377918 }, { - "x": 7.737561088001236, - "y": 2.0935863858643846, - "heading": 3.592148279739013, - "angularVelocity": -0.4941125326751832, - "velocityX": -1.6342130602654035, - "velocityY": -0.9890960830790406, + "x": 7.722569430006346, + "y": 2.1753187660940543, + "heading": 3.5825539547204364, + "angularVelocity": -0.553428814679775, + "velocityX": -1.7486715343285755, + "velocityY": -0.6074086745922084, "moduleForcesX": [ - -96.50269363466799, - -97.06027029285035, - -88.36685045612268, - -87.1547135204852 + -101.412834147822, + -102.3963066503469, + -95.39857355561514, + -95.71983629162236 ], "moduleForcesY": [ - -38.20314229261208, - -36.681729663577826, - -54.43913458067309, - -56.30652630732109 + -22.1146138290831, + -16.80930630512557, + -40.89061643024383, + -40.04973108891953 ], - "timestamp": 0.3426305584101512 + "timestamp": 0.33225490822742376 }, { - "x": 7.645393467684546, - "y": 2.03969197754913, - "heading": 3.5642113237831787, - "angularVelocity": -0.5707567141654175, - "velocityX": -1.883000002132083, - "velocityY": -1.1010718365499048, + "x": 7.627489656477081, + "y": 2.1430917308500237, + "heading": 3.552466371319351, + "angularVelocity": -0.63389006028899, + "velocityX": -2.0031560052914554, + "velocityY": -0.6789643768513749, "moduleForcesX": [ - -98.0646712363435, - -98.67496193551976, - -90.43697519136059, - -89.39473189465788 + -101.86129240177104, + -102.70256768115746, + -96.22136667221518, + -96.43893505032159 ], "moduleForcesY": [ - -33.94342733722026, - -32.01865968778751, - -50.89195526213231, - -52.63580008371086 + -19.87450898790123, + -14.701329976881233, + -38.877400569033554, + -38.237873659673255 ], - "timestamp": 0.3915777810401728 + "timestamp": 0.37971989511705573 }, { - "x": 7.540771392641462, - "y": 1.9809991176716732, - "heading": 3.5324080450033617, - "angularVelocity": -0.6497463404657143, - "velocityX": -2.1374466092569384, - "velocityY": -1.1991050099226261, + "x": 7.520251265886663, + "y": 2.1077781488351413, + "heading": 3.5185362794379946, + "angularVelocity": -0.714844648756607, + "velocityX": -2.259315710866347, + "velocityY": -0.7439922419123983, "moduleForcesX": [ - -99.76955042301674, - -100.41971785352567, - -92.86965725890394, - -92.0790529699704 + -102.34147627267791, + -103.02417396799694, + -97.17334997690496, + -97.30003102204127 ], "moduleForcesY": [ - -28.4715548192435, - -25.931723671972655, - -46.25668565248566, - -47.72597287417353 + -17.128069363556765, + -12.063145744424151, + -36.38316192720738, + -35.92745172132362 ], - "timestamp": 0.4405250036701944 + "timestamp": 0.4271848820066877 }, { - "x": 7.423387798901581, - "y": 1.9184271511492825, - "heading": 3.496606398639386, - "angularVelocity": -0.7314336634499311, - "velocityX": -2.3981665850001437, - "velocityY": -1.27835581183747, + "x": 7.400764572383453, + "y": 2.0697740988296585, + "heading": 3.4807380145196527, + "angularVelocity": -0.796339942244816, + "velocityX": -2.51736493201164, + "velocityY": -0.8006754556693165, "moduleForcesX": [ - -101.52272463385668, - -102.1469107017657, - -95.69853790300179, - -95.26536323626863 + -102.83577382732888, + -103.33781837709795, + -98.27583595511979, + -98.33894311574731 ], "moduleForcesY": [ - -21.269168958218934, - -17.770998122924084, - -40.007572924195685, - -40.90863901385157 + -13.691698596586228, + -8.672231017023337, + -33.221926437578354, + -32.89082776312146 ], - "timestamp": 0.48947222630021603 + "timestamp": 0.47464986889631966 }, { - "x": 7.292932816380647, - "y": 1.8532547705946691, - "heading": 3.4566645498803235, - "angularVelocity": -0.8160186955033512, - "velocityX": -2.6652172587402316, - "velocityY": -1.3314827083700613, + "x": 7.2689314106331135, + "y": 2.0296016810214934, + "heading": 3.439044836951077, + "angularVelocity": -0.8783985902181007, + "velocityX": -2.777482317048192, + "velocityY": -0.8463589783696349, "moduleForcesX": [ - -103.04921333228688, - -103.43213563525939, - -98.86159408086765, - -98.87292685429789 + -103.29961496935752, + -103.58217004765575, + -99.54614904632459, + -99.58862895612812 ], "moduleForcesY": [ - -11.544949271307244, - -6.560069407755689, - -31.269777895580606, - -31.039659589782794 + -9.276827219626885, + -4.178448909532042, + -29.094262330489535, + -28.757755632981716 ], - "timestamp": 0.5384194489302372 + "timestamp": 0.5221148557859516 }, { - "x": 7.14918408141944, - "y": 1.7873106738525886, - "heading": 3.4124618351481057, - "angularVelocity": -0.903068904773904, - "velocityX": -2.9368108594794906, - "velocityY": -1.347249000020567, + "x": 7.124653502119942, + "y": 1.9879756803908264, + "heading": 3.393432804978208, + "angularVelocity": -0.9609616469277636, + "velocityX": -3.0396702486996596, + "velocityY": -0.8769832955485592, "moduleForcesX": [ - -103.63562609216031, - -103.19508156086872, - -101.9636791247673, - -102.297793014557 + -103.62216827811297, + -103.60152394447236, + -100.97600742467284, + -101.04877430364988 ], "moduleForcesY": [ - 1.8578199404637532, - 9.026980369120835, - -18.574046448195194, - -16.175083448707877 + -3.4095505625262734, + 1.9894522183883672, + -23.490052769531545, + -22.89126748071193 ], - "timestamp": 0.5873666715602583 + "timestamp": 0.5695798426755836 }, { - "x": 6.992257977502523, - "y": 1.7232224565630139, - "heading": 3.3639866140947756, - "angularVelocity": -0.9903569283131962, - "velocityX": -3.2060267260326114, - "velocityY": -1.3093330703153447, + "x": 6.967861097841668, + "y": 1.9459210882345401, + "heading": 3.3438925458224324, + "angularVelocity": -1.0437221708490971, + "velocityX": -3.3033276643529277, + "velocityY": -0.8860129310508679, "moduleForcesX": [ - -101.58700144053036, - -99.04092706549442, - -103.57948992890111, - -103.28575192979112 + -103.51947999165917, + -102.99468331816422, + -102.45505555668103, + -102.57296891571525 ], "moduleForcesY": [ - 20.333355715385643, - 30.164112642791856, - 0.3712746034261658, - 6.521939841477385 + 4.724347773856147, + 10.791054603518292, + -15.482230188456697, + -14.127507219444064 ], - "timestamp": 0.6363138941902795 + "timestamp": 0.6170448295652156 }, { - "x": 6.823161968060095, - "y": 1.6645227955369413, - "heading": 3.3115006930198336, - "angularVelocity": -1.0722962050711007, - "velocityX": -3.4546599450714037, - "velocityY": -1.1992439585340129, + "x": 6.798605926608696, + "y": 1.904988087661922, + "heading": 3.290464815782709, + "angularVelocity": -1.125624034489893, + "velocityX": -3.5658952488008056, + "velocityY": -0.8623830588172553, "moduleForcesX": [ - -93.54862615603459, - -87.12505304198946, - -99.68478228184767, - -95.98019931786078 + -102.22032427708363, + -100.69148391011608, + -103.48690787316097, + -103.44235697238129 ], "moduleForcesY": [ - 44.39868763909986, - 55.84311796842087, - 27.881573322185066, - 38.51078627303082 + 16.569411418577502, + 23.827896852783, + -3.273936939739203, + -0.23956401697252558 ], - "timestamp": 0.6852611168203007 + "timestamp": 0.6645098164548475 }, { - "x": 6.64442651702477, - "y": 1.6150301081248706, - "heading": 3.2556875029374615, - "angularVelocity": -1.1402728711340493, - "velocityX": -3.6515953598907216, - "velocityY": -1.011143937341902, + "x": 6.617365994453179, + "y": 1.867626940195305, + "heading": 3.233345431363907, + "angularVelocity": -1.2034004044204083, + "velocityX": -3.818392124836544, + "velocityY": -0.7871306813093759, "moduleForcesX": [ - -75.58670515218044, - -65.41341394673287, - -83.26129301433434, - -73.82590929646548 + -97.4964351201358, + -93.81211585906499, + -102.06328549780508, + -100.74989347493035 ], "moduleForcesY": [ - 70.7269627500392, - 80.17399602370682, - 61.418213629826944, - 72.39463351959833 + 34.58607042006599, + 43.38012581746179, + 16.68289517028768, + 22.81215275508421 ], - "timestamp": 0.7342083394503218 + "timestamp": 0.7119748033444795 }, { - "x": 6.459747955634086, - "y": 1.5775049558527945, - "heading": 3.1976078744797825, - "angularVelocity": -1.1865765887614697, - "velocityX": -3.773014105143794, - "velocityY": -0.7666451793540634, + "x": 6.425959539225168, + "y": 1.8375524189497474, + "heading": 3.173140969039124, + "angularVelocity": -1.2683973233735604, + "velocityX": -4.0325820737484745, + "velocityY": -0.6336148647008714, "moduleForcesX": [ - -48.754658545853765, - -38.78516132328316, - -53.451745855433785, - -42.79147083400311 + -83.0793580408409, + -75.74454164980041, + -90.56807884095008, + -84.9365665532044 ], "moduleForcesY": [ - 91.32367097930855, - 95.96411440332321, - 88.60385895496529, - 94.18897282038556 + 61.40607447858171, + 70.1333997647084, + 49.57748404754354, + 58.505488397082836 ], - "timestamp": 0.783155562080343 + "timestamp": 0.7594397902341115 }, { - "x": 6.272669917195343, - "y": 1.5531505703892592, - "heading": 3.1383417150669244, - "angularVelocity": -1.2108176159622883, - "velocityX": -3.8220358252563957, - "velocityY": -0.49756419577926697, + "x": 6.228897688944246, + "y": 1.8186603576908584, + "heading": 3.1111720980598196, + "angularVelocity": -1.3055701695100008, + "velocityX": -4.151730848027373, + "velocityY": -0.39802099372859684, "moduleForcesX": [ - -21.047088345037217, - -14.88450612601458, - -22.399140974726627, - -15.870003170324972 + -48.29802014497603, + -40.33132670698785, + -52.811490595206955, + -44.53818050230527 ], "moduleForcesY": [ - 101.40262934316833, - 102.48466604056495, - 101.08906364862342, - 102.31264843078472 + 91.20355568795507, + 94.96047101888112, + 88.59300740140523, + 92.98083834186113 ], - "timestamp": 0.8321027847103641 + "timestamp": 0.8069047771237434 }, { - "x": 6.085876927840109, - "y": 1.5421947938918785, - "heading": 3.0787272867385784, - "angularVelocity": -1.2179328085467576, - "velocityX": -3.8162122244841195, - "velocityY": -0.2238283585606515, + "x": 6.031703753180514, + "y": 1.812324789891614, + "heading": 3.048787154019588, + "angularVelocity": -1.3143360638712303, + "velocityX": -4.1545136460626555, + "velocityY": -0.1334787645738432, "moduleForcesX": [ - 1.28984663500939, - 3.1977958082791926, - 1.1917630490161586, - 3.1353704420291226 + -2.1599097042320587, + 0.23951217753484877, + -2.4393520274010894, + 0.0160871967695788 ], "moduleForcesY": [ - 103.60661623587562, - 103.56505077845577, - 103.60195655485191, - 103.56110929339067 + 103.22994984050744, + 103.25066468571664, + 103.20778601077548, + 103.23489038346442 ], - "timestamp": 0.8810500073403853 + "timestamp": 0.8543697640133754 }, { - "x": 5.9012506330843415, - "y": 1.544471272265801, - "heading": 3.019361976734124, - "angularVelocity": -1.2128432792434443, - "velocityX": -3.7719462889918423, - "velocityY": 0.04650883648965221, + "x": 5.838288005789171, + "y": 1.8179815794617071, + "heading": 2.987084814881381, + "angularVelocity": -1.2999548336898101, + "velocityX": -4.074914164711231, + "velocityY": 0.1191781553091145, "moduleForcesX": [ - 17.462293324811608, - 16.0927923319585, - 17.39937814131849, - 16.04777728025772 + 33.269109007803046, + 29.421028827707513, + 32.63531064252144, + 28.92117898933171 ], "moduleForcesY": [ - 102.17914754620458, - 102.40362384187102, - 102.19343457298935, - 102.41424068304686 + 97.88150666677997, + 99.10269370028429, + 98.11607395134999, + 99.27126766658209 ], - "timestamp": 0.9299972299704065 + "timestamp": 0.9018347509030074 }, { - "x": 5.720109462738037, - "y": 1.5596987009048462, - "heading": 2.960670957642772, - "angularVelocity": -1.1990674023525598, - "velocityX": -3.7007446104858777, - "velocityY": 0.3110989310700059, + "x": 5.6509270668029785, + "y": 1.8346644639968877, + "heading": 2.9268466161891644, + "angularVelocity": -1.2691080866046227, + "velocityX": -3.9473504841914, + "velocityY": 0.3514777023129056, "moduleForcesX": [ - 28.918155728680293, - 25.26090248672073, - 28.563093727712385, - 25.03083365823741 + 54.557219185525284, + 47.10662649560467, + 52.23481946428302, + 45.215158498074324 ], "moduleForcesY": [ - 99.58409972188349, - 100.5733296943564, - 99.69486169755311, - 100.63917273673817 + 87.9480109752448, + 92.14125457174697, + 89.38412725469736, + 93.12237776631163 ], - "timestamp": 0.9789444526004276 + "timestamp": 0.9492997377926393 }, { - "x": 5.467086369754889, - "y": 1.608315943409953, - "heading": 2.8777398443490734, - "angularVelocity": -1.1699447896759345, - "velocityX": -3.569505310449224, - "velocityY": 0.6858642950544216, + "x": 5.38507100164977, + "y": 1.8830556799414413, + "heading": 2.8404188381427997, + "angularVelocity": -1.206964524044126, + "velocityX": -3.7126818066149396, + "velocityY": 0.6757836684655287, "moduleForcesX": [ - 37.110633318213495, - 31.845579277279175, - 36.60935471340153, - 31.604551220999983 + 66.72846331028158, + 57.59774579035315, + 63.503281618778075, + 54.96790246952051 ], "moduleForcesY": [ - 96.92740942126741, - 98.78190883714102, - 97.1253146659255, - 98.8667048935603 + 79.37288585131948, + 86.21672384257603, + 82.00415549354298, + 87.94587304069235 ], - "timestamp": 1.0498290909402161 + "timestamp": 1.020907292384858 }, { - "x": 5.228866992709924, - "y": 1.6808350936944374, - "heading": 2.7987184964204332, - "angularVelocity": -1.1147880525234262, - "velocityX": -3.360662939451719, - "velocityY": 1.0230587611502073, + "x": 5.143346384858564, + "y": 1.9467965849215205, + "heading": 2.761004546429683, + "angularVelocity": -1.1090211384168227, + "velocityX": -3.375685961785028, + "velocityY": 0.8901421834091305, "moduleForcesX": [ - 59.93331425285257, - 51.01709215758398, - 57.78209023791096, - 49.547643338616176 + 93.74953605342704, + 86.18692065004286, + 88.50666550737564, + 80.22596087781076 ], "moduleForcesY": [ - 84.70174546991043, - 90.34848029716736, - 86.20162312446539, - 91.18072937628781 + 44.334189316001165, + 57.62394594710871, + 54.09828635812438, + 65.72728284950935 ], - "timestamp": 1.1207137292800047 + "timestamp": 1.0925148469770765 }, { - "x": 5.011723742658711, - "y": 1.7718777634914877, - "heading": 2.7257838036773063, - "angularVelocity": -1.0289209968669253, - "velocityX": -3.0633329750562632, - "velocityY": 1.284377996832451, + "x": 4.929333767387997, + "y": 2.0174366654365876, + "heading": 2.690018539768091, + "angularVelocity": -0.9913200788076207, + "velocityX": -2.9886876975747554, + "velocityY": 0.9864892176106754, "moduleForcesX": [ - 84.76572357068362, - 74.96765408925388, - 80.2383461943941, - 70.79484109399709 + 103.24738699653997, + 101.0121859942123, + 100.38393572494448, + 95.76003337310947 ], "moduleForcesY": [ - 59.80528809358341, - 71.6849991388353, - 65.79112728880133, - 75.84706545896569 + 10.088544648544431, + 23.460609845249287, + 26.250656903011137, + 39.88459892674545 ], - "timestamp": 1.1915983676197932 + "timestamp": 1.164122401569295 }, { - "x": 4.820647432846547, - "y": 1.873141713864737, - "heading": 2.6607448349840026, - "angularVelocity": -0.9175326307166438, - "velocityX": -2.6955954673314677, - "velocityY": 1.428573986479781, + "x": 4.7438644840225095, + "y": 2.0884223679161025, + "heading": 2.6280208337517874, + "angularVelocity": -0.8657983975202782, + "velocityX": -2.5900798378039753, + "velocityY": 0.9913158310575519, "moduleForcesX": [ - 101.00986249777799, - 96.10854339543843, - 96.9286920524181, - 90.30878865548299 + 102.83526119368163, + 103.67090860218237, + 103.67025296676273, + 102.23886101741424 ], "moduleForcesY": [ - 23.644613389650427, - 38.97112673980988, - 37.036581210585425, - 51.060010910549146 + -13.933835689919919, + -3.7386929134956266, + 4.950653494760573, + 17.715678179992125 ], - "timestamp": 1.2624830059595817 + "timestamp": 1.2357299561615136 }, { - "x": 4.657509621107699, - "y": 1.9756961760175065, - "heading": 2.604521572828749, - "angularVelocity": -0.7931656769657904, - "velocityX": -2.3014550904081728, - "velocityY": 1.44677978973625, + "x": 4.5866372251458625, + "y": 2.1552385034426114, + "heading": 2.575144646059974, + "angularVelocity": -0.7384163304125048, + "velocityX": -2.19567976805722, + "velocityY": 0.9330877990775547, "moduleForcesX": [ - 103.19738359227847, - 103.72054443575398, - 103.49434008790791, - 101.5396563829404 + 99.54412665319884, + 101.40753250877371, + 103.32899619969018, + 103.78108426641127 ], "moduleForcesY": [ - -10.817553101285721, - 0.8550148862546341, - 7.678543308436053, - 21.312534299325236 + -29.427597778899138, + -22.02325540050219, + -9.999738927376326, + 1.2055925555842326 ], - "timestamp": 1.3333676442993703 + "timestamp": 1.3073375107537322 }, { - "x": 4.52173266583132, - "y": 2.07244812277131, - "heading": 2.557278720564778, - "angularVelocity": -0.6664751823591233, - "velocityX": -1.915463751476393, - "velocityY": 1.3649212159342432, + "x": 4.45702944180966, + "y": 2.2148008989688965, + "heading": 2.531346475674566, + "angularVelocity": -0.6116417553261012, + "velocityX": -1.8099735999287732, + "velocityY": 0.8317892696043293, "moduleForcesX": [ - 97.61435766859866, - 99.6011131749049, - 102.58825345734893, - 103.63090006850514 + 95.96812342989033, + 98.04572669881219, + 101.79189444348697, + 103.26094436840614 ], "moduleForcesY": [ - -35.268770461587025, - -29.065839121035793, - -15.80955389013574, - -5.413670712377771 + -39.61546892739203, + -34.07129292769581, + -20.46914580913734, + -10.651513351600967 ], - "timestamp": 1.4042522826391588 + "timestamp": 1.3789450653459507 }, { - "x": 4.411830591378865, - "y": 2.1585354918951616, - "heading": 2.51876748636365, - "angularVelocity": -0.5432945007989202, - "velocityX": -1.5504357083072682, - "velocityY": 1.2144714445912563, + "x": 4.354388254594759, + "y": 2.2649421325832035, + "heading": 2.496522874025983, + "angularVelocity": -0.48631184023641394, + "velocityX": -1.4333848962381666, + "velocityY": 0.7002226776455226, "moduleForcesX": [ - 90.47854282502254, - 91.83285534237497, - 98.58812625350899, - 100.62445455688419 + 92.7907537763575, + 94.8155739460098, + 100.00318758141623, + 102.02388828803367 ], "moduleForcesY": [ - -50.901475267722624, - -48.35511926084885, - -32.53677718349569, - -25.45535608630757 + -46.60791622206078, + -42.282733802481594, + -27.97777559095913, + -19.25551682225231 ], - "timestamp": 1.4751369209789473 + "timestamp": 1.4505526199381693 }, { - "x": 4.3262415482856165, - "y": 2.230721782989921, - "heading": 2.488611108566075, - "angularVelocity": -0.42542895758343663, - "velocityX": -1.2074413455137303, - "velocityY": 1.0183629737762252, + "x": 4.278118050279357, + "y": 2.3040837289983593, + "heading": 2.4705582318655237, + "angularVelocity": -0.36259640911227725, + "velocityX": -1.0651139355949073, + "velocityY": 0.5466126669277778, "moduleForcesX": [ - 84.07525354896863, - 84.42849078503647, - 93.9888010492201, - 96.0020319753479 + 90.1187469058319, + 91.995376602234, + 98.29771671442934, + 100.61570105327873 ], "moduleForcesY": [ - -60.92976824507471, - -60.40104086303051, - -44.13196396617181, - -39.50801066886383 + -51.60847738463325, + -48.14285693742628, + -33.513140486900426, + -25.666450933577256 ], - "timestamp": 1.5460215593187359 + "timestamp": 1.5221601745303879 }, { - "x": 4.263589020412451, - "y": 2.2868059201143556, - "heading": 2.466437553417309, - "angularVelocity": -0.3128118541351126, - "velocityX": -0.8838660863703308, - "velocityY": 0.7912029804764343, + "x": 4.227698728083314, + "y": 2.3310369086387626, + "heading": 2.4533426833893883, + "angularVelocity": -0.2404152547055344, + "velocityX": -0.7041061865523344, + "velocityY": 0.37640134201140235, "moduleForcesX": [ - 78.82081144473382, - 78.2947277286741, - 89.72768925430235, - 91.35467904089971 + 87.90888243626851, + 89.58265687469483, + 96.7811494551446, + 99.2400496777036 ], "moduleForcesY": [ - -67.61078851767357, - -68.19198593943935, - -52.27861117061747, - -49.344165998038456 + -55.30576952737938, + -52.51878339626849, + -37.692133911621376, + -30.590607959006878 ], - "timestamp": 1.6169061976585244 + "timestamp": 1.5937677291226064 }, { - "x": 4.222720463089765, - "y": 2.325236543036976, - "heading": 2.451919310286384, - "angularVelocity": -0.20481508364804626, - "velocityX": -0.576550269280934, - "velocityY": 0.5421572829136999, + "x": 4.2026820182780895, + "y": 2.3448798656255554, + "heading": 2.444777874392378, + "angularVelocity": -0.11960761746132077, + "velocityX": -0.34935852732262185, + "velocityY": 0.19331699150554127, "moduleForcesX": [ - 74.60403531213795, - 73.36398730793962, - 86.04738983964184, - 87.18827457983765 + 86.09072271913463, + 87.50803229096606, + 95.47488145367366, + 97.96216818816397 ], "moduleForcesY": [ - -72.2521437562441, - -73.49008857932517, - -58.15497382694532, - -56.40308380016812 + -58.108421977440734, + -55.92431623005057, + -40.90491902309583, + -34.48857338358015 ], - "timestamp": 1.687790835998313 + "timestamp": 1.665375283714825 }, { "x": 4.202682018280029, - "y": 2.3448798656463623, + "y": 2.344879865646362, "heading": 2.4447778743923783, - "angularVelocity": -0.10074729957389103, - "velocityX": -0.2826909366974499, - "velocityY": 0.27711677832402926, + "angularVelocity": 5.168003878366018e-17, + "velocityX": 4.1453752254911594e-17, + "velocityY": 8.192712538061972e-17, "moduleForcesX": [ - 71.22468650853797, - 69.3870865231279, - 82.9455645855158, - 83.58175463898205 + 84.5994600681018, + 85.69781853498485, + 94.37037678492582, + 96.79234259000295 ], "moduleForcesY": [ - -75.5969633085211, - -77.27040216937355, - -62.51253196312979, - -61.63801883584066 + -60.26906063131338, + -58.67389816054446, + -43.40532121869834, + -37.66504124484338 ], - "timestamp": 1.7586754743381015 - }, - { - "x": 4.202682018280029, - "y": 2.3448798656463623, - "heading": 2.4447778743923783, - "angularVelocity": -5.80382960829085e-23, - "velocityX": 1.3673447485380094e-21, - "velocityY": -7.76305297216273e-23, - "moduleForcesX": [ - 68.50416083765214, - 66.13446697456098, - 80.349821554819, - 80.4775374470252 - ], - "moduleForcesY": [ - -78.07954947028286, - -80.08289970808126, - -65.825574909368, - -65.65190327177945 - ], - "timestamp": 1.82956011267789 + "timestamp": 1.7369828383070436 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/SourceSpit54Source.4.traj b/src/main/deploy/choreo/SourceSpit54Source.4.traj index cb7a64e..5bce370 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.4.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.4.traj @@ -2,188 +2,188 @@ "samples": [ { "x": 4.202682018280029, - "y": 2.3448798656463623, + "y": 2.344879865646362, "heading": 2.4447778743923783, - "angularVelocity": -5.80382960829085e-23, - "velocityX": 1.3673447485380094e-21, - "velocityY": -7.76305297216273e-23, + "angularVelocity": 5.168003878366018e-17, + "velocityX": 4.1453752254911594e-17, + "velocityY": 8.192712538061972e-17, "moduleForcesX": [ - 68.50416083765214, - 66.13446697456098, - 80.349821554819, - 80.4775374470252 + 84.5994600681018, + 85.69781853498485, + 94.37037678492582, + 96.79234259000295 ], "moduleForcesY": [ - -78.07954947028286, - -80.08289970808126, - -65.825574909368, - -65.65190327177945 + -60.26906063131338, + -58.67389816054446, + -43.40532121869834, + -37.66504124484338 ], "timestamp": 0 }, { - "x": 4.201703407238958, + "x": 4.201703407238959, "y": 2.344928891411713, "heading": 2.4109202649275003, - "angularVelocity": -0.8588869565571112, - "velocityX": -0.02482503259982727, - "velocityY": 0.0012436669647010426, + "angularVelocity": -0.8588869565571109, + "velocityX": -0.024825032599826515, + "velocityY": 0.00124366696470136, "moduleForcesX": [ - -28.227322752614786, - 103.42278400099644, - -103.75844967549132, - -18.094061998184152 + -28.22732275261409, + 103.42278400099643, + -103.75844967549133, + -18.094061998183502 ], "moduleForcesY": [ - 99.90321784851972, - 8.536606790573616, - -3.8816893662670853, - -102.22074328548473 + 99.90321784851992, + 8.53660679057382, + -3.8816893662669205, + -102.22074328548484 ], "timestamp": 0.03942033256692756 }, { "x": 4.19960599570747, "y": 2.344567972526076, - "heading": 2.3434151950983257, + "heading": 2.343415195098326, "angularVelocity": -1.7124429306770592, - "velocityX": -0.05320633781888569, - "velocityY": -0.009155652987557033, + "velocityX": -0.05320633781888414, + "velocityY": -0.009155652987556358, "moduleForcesX": [ - -27.118032037334096, - 102.87897965174633, + -27.118032037333307, + 102.87897965174639, -103.65492919654237, - -25.446854262350335 + -25.446854262349746 ], "moduleForcesY": [ - 100.17273398636637, - -13.32089023629324, - -5.763677170586516, - -100.6330188752554 + 100.17273398636658, + -13.320890236292788, + -5.763677170586371, + -100.63301887525554 ], "timestamp": 0.07884066513385513 }, { "x": 4.1960512028500485, - "y": 2.3431299343053045, - "heading": 2.243041963319051, - "angularVelocity": -2.546229959091813, - "velocityX": -0.09017663286798999, - "velocityY": -0.03647960651602133, + "y": 2.343129934305304, + "heading": 2.2430419633190515, + "angularVelocity": -2.546229959091814, + "velocityX": -0.09017663286798745, + "velocityY": -0.03647960651602015, "moduleForcesX": [ - -25.33343532040246, - 93.27197212593993, + -25.333435320401506, + 93.27197212594027, -103.44021230394544, - -33.98161373425351 + -33.98161373425298 ], "moduleForcesY": [ - 100.56440767021368, - -45.312631622641916, - -8.536330867305994, - -98.06905659928213 + 100.56440767021392, + -45.312631622641206, + -8.536330867305882, + -98.0690565992823 ], "timestamp": 0.11826099770078269 }, { "x": 4.190293529660696, - "y": 2.3398051514706095, - "heading": 2.111921828848045, - "angularVelocity": -3.326205689624509, - "velocityX": -0.1460584630933037, - "velocityY": -0.08434182611347482, + "y": 2.339805151470608, + "heading": 2.1119218288480455, + "angularVelocity": -3.3262056896245125, + "velocityX": -0.14605846309329973, + "velocityY": -0.08434182611347314, "moduleForcesX": [ - -27.49060665939882, - 66.97560497296121, - -102.56378310330503, - -41.947517197804814 + -27.490606659397372, + 66.97560497296193, + -102.56378310330504, + -41.94751719780439 ], "moduleForcesY": [ - 99.77621827507902, - -79.12850743515231, - -15.681873461362015, - -94.91979752927205 + 99.77621827507942, + -79.12850743515172, + -15.681873461361965, + -94.91979752927223 ], "timestamp": 0.15768133026771025 }, { "x": 4.180004921895993, "y": 2.331957993445509, - "heading": 1.9628540404616008, - "angularVelocity": -3.7814949463796665, - "velocityX": -0.260997487711088, - "velocityY": -0.19906371951014543, + "heading": 1.9628540404616013, + "angularVelocity": -3.781494946379674, + "velocityX": -0.2609974877110832, + "velocityY": -0.1990637195101428, "moduleForcesX": [ - -101.10990652767909, - 29.517572053746953, - -97.66177710983962, - -46.76638489941762 + -101.10990652767879, + 29.517572053747624, + -97.66177710983959, + -46.7663848994173 ], "moduleForcesY": [ - 11.251940941172409, - -99.37458530974946, - -34.87193793205709, - -92.61783003234635 + 11.251940941173997, + -99.37458530974925, + -34.87193793205716, + -92.61783003234652 ], "timestamp": 0.19710166283463781 }, { - "x": 4.166361351302606, - "y": 2.3164379306505576, - "heading": 1.8072932986079373, - "angularVelocity": -3.9462057198414553, - "velocityX": -0.3461049084307693, - "velocityY": -0.3937070487318249, + "x": 4.166361351302605, + "y": 2.3164379306505567, + "heading": 1.8072932986079375, + "angularVelocity": -3.946205719841463, + "velocityX": -0.3461049084307636, + "velocityY": -0.3937070487318224, "moduleForcesX": [ - -33.36951073216951, - -5.706270650379014, - -75.36467871982056, - -45.51345754575896 + -33.369510732168834, + -5.706270650378617, + -75.36467871982032, + -45.51345754575867 ], "moduleForcesY": [ - -97.93226744361932, - -103.51923261668531, - -71.1617240805949, - -93.20638112745955 + -97.93226744361955, + -103.51923261668534, + -71.16172408059515, + -93.2063811274597 ], "timestamp": 0.23652199540156538 }, { "x": 4.149916591020042, - "y": 2.2926823181951774, - "heading": 1.65181054109108, - "angularVelocity": -3.944227442852698, - "velocityX": -0.41716442281767707, - "velocityY": -0.602623339492322, + "y": 2.292682318195177, + "heading": 1.6518105410910802, + "angularVelocity": -3.9442274428527058, + "velocityX": -0.41716442281767085, + "velocityY": -0.6026233394923195, "moduleForcesX": [ - -33.55166682694357, - -33.80304782175004, - -32.97397566453504, - -33.22309184918086 + -33.551666826943425, + -33.80304782174995, + -32.97397566453473, + -33.22309184918061 ], "moduleForcesY": [ - -98.10698033320081, - -98.01915041897836, - -98.30200452433485, - -98.21658224726805 + -98.10698033320087, + -98.01915041897838, + -98.30200452433495, + -98.21658224726814 ], "timestamp": 0.27594232796849294 }, { - "x": 4.131295062523411, - "y": 2.2607333178953537, - "heading": 1.5019050907593101, - "angularVelocity": -3.80274443593949, - "velocityX": -0.472383850770812, - "velocityY": -0.8104700853444186, + "x": 4.13129506252341, + "y": 2.2607333178953555, + "heading": 1.5019050907593103, + "angularVelocity": -3.802744435939497, + "velocityX": -0.47238385077080564, + "velocityY": -0.8104700853444158, "moduleForcesX": [ - -40.2168329104546, - -55.21625645355153, - -4.835470491948852, - -3.5127997094387298 + -40.21683291045461, + -55.21625645355164, + -4.835470491948728, + -3.5127997094385286 ], "moduleForcesY": [ - -95.64897949611914, - -87.757099641864, + -95.64897949611913, + -87.75709964186395, -103.63779020013178, -103.59070739238904 ], @@ -193,207 +193,207 @@ "x": 4.111026763916016, "y": 2.221068859100342, "heading": 1.3630312678774887, - "angularVelocity": -3.5228983075178477, - "velocityX": -0.5141584884648978, - "velocityY": -1.0061929012818376, + "angularVelocity": -3.522898307517854, + "velocityX": -0.5141584884648915, + "velocityY": -1.0061929012818345, "moduleForcesX": [ - -47.929085434488584, - -71.96458253113931, - 6.298074117284643, - 35.08285193940007 + -47.92908543448869, + -71.96458253113951, + 6.29807411728461, + 35.082851939400115 ], "moduleForcesY": [ - -92.06794236589327, - -74.62301016758721, - -103.60506557630978, - -97.55241293864256 + -92.06794236589322, + -74.62301016758703, + -103.60506557630977, + -97.55241293864255 ], "timestamp": 0.35478299310234807 }, { - "x": 4.062724486802488, - "y": 2.110555894865889, - "heading": 1.1420372292372407, - "angularVelocity": -2.7416930766221763, - "velocityX": -0.5992470184357392, - "velocityY": -1.3710443538788295, + "x": 4.062724486802489, + "y": 2.1105558948658896, + "heading": 1.1420372292372403, + "angularVelocity": -2.7416930766221816, + "velocityX": -0.5992470184357338, + "velocityY": -1.3710443538788264, "moduleForcesX": [ - -58.73772933370447, - -84.11029030603055, - 5.233285508187558, - 59.405679960771735 + -58.737729333704614, + -84.11029030603079, + 5.2332855081874134, + 59.40567996077163 ], "moduleForcesY": [ - -85.66951767872665, - -60.775439425919956, - -103.74545811129138, - -85.16250520967935 + -85.66951767872655, + -60.77543942591964, + -103.7454581112914, + -85.16250520967942 ], "timestamp": 0.43538794502954126 }, { "x": 4.007017393904712, "y": 1.9705835820032092, - "heading": 0.9812050036884946, - "angularVelocity": -1.9953144528145002, - "velocityX": -0.6911125379504645, - "velocityY": -1.7365225028495959, + "heading": 0.9812050036884937, + "angularVelocity": -1.9953144528145033, + "velocityX": -0.69111253795046, + "velocityY": -1.7365225028495925, "moduleForcesX": [ - -64.22141665906422, - -80.12397623088805, - -0.09600908354098996, - 60.003283291507636 + -64.22141665906439, + -80.12397623088835, + -0.09600908354117038, + 60.0032832915075 ], "moduleForcesY": [ - -81.61082059327089, - -65.73350813646502, + -81.61082059327076, + -65.73350813646466, -103.8621786778673, - -84.72244048801421 + -84.72244048801433 ], "timestamp": 0.5159928969567344 }, { "x": 3.943851323495702, - "y": 1.8018787684532644, - "heading": 0.8821659959765331, - "angularVelocity": -1.2286963188244244, - "velocityX": -0.7836499979066395, - "velocityY": -2.092983241306668, + "y": 1.8018787684532651, + "heading": 0.882165995976532, + "angularVelocity": -1.2286963188244255, + "velocityX": -0.7836499979066361, + "velocityY": -2.0929832413066642, "moduleForcesX": [ - -68.62017364940806, - -80.1006769069396, - -1.411311275947935, - 65.07642963174425 + -68.62017364940823, + -80.10067690694001, + -1.4113112759481592, + 65.07642963174403 ], "moduleForcesY": [ - -77.88958304459304, - -65.089910548468, - -103.82208570578915, - -80.83902294562851 + -77.8895830445929, + -65.0899105484675, + -103.82208570578916, + -80.83902294562868 ], "timestamp": 0.5965978488839276 }, { - "x": 3.8781108764118923, - "y": 1.62015655248617, - "heading": 0.9059483264084738, - "angularVelocity": 0.2950480071425667, - "velocityX": -0.8155881929337341, - "velocityY": -2.2544795527108175, + "x": 3.8781108764118932, + "y": 1.6201565524861705, + "heading": 0.9059483264084722, + "angularVelocity": 0.29504800714256113, + "velocityX": -0.815588192933734, + "velocityY": -2.2544795527108152, "moduleForcesX": [ - -72.70004868646518, - -50.250066546788176, - 8.938812986150849, - 84.6553358689454 + -72.70004868646532, + -50.25006654679044, + 8.938812986150491, + 84.65533586894512 ], "moduleForcesY": [ - -73.92227873323378, - 88.67129288393822, - -103.36018720677365, - -59.82803222008088 + -73.92227873323364, + 88.67129288393693, + -103.36018720677367, + -59.828032220081276 ], "timestamp": 0.6772028008111208 }, { "x": 3.82485357780854, - "y": 1.4531042418213815, - "heading": 1.0372615296620737, - "angularVelocity": 1.6290959812519923, - "velocityX": -0.660719935066242, - "velocityY": -2.0724819836835775, + "y": 1.4531042418213824, + "heading": 1.0372615296620726, + "angularVelocity": 1.6290959812519983, + "velocityX": -0.6607199350662438, + "velocityY": -2.072481983683578, "moduleForcesX": [ - -73.9628963267555, - 29.478911488108032, - 92.80376149106614, - 94.02725852427287 + -73.96289632675686, + 29.47891148810785, + 92.80376149106574, + 94.02725852427297 ], "moduleForcesY": [ - 69.9865243622358, - 99.10987378380912, - -45.02524501367293, - 43.211766667495525 + 69.98652436223436, + 99.10987378380918, + -45.02524501367373, + 43.211766667495276 ], "timestamp": 0.757807752738314 }, { "x": 3.7854736830756957, - "y": 1.3195187350370476, - "heading": 1.1596419881635687, - "angularVelocity": 1.5182746912625922, - "velocityX": -0.4885542859502548, - "velocityY": -1.6572866007661222, + "y": 1.3195187350370479, + "heading": 1.1596419881635682, + "angularVelocity": 1.5182746912625973, + "velocityX": -0.48855428595025646, + "velocityY": -1.6572866007661224, "moduleForcesX": [ - 47.382251388920984, - 48.46951456581909, - 32.104806016987034, - 30.2893465166195 + 47.38225138892106, + 48.46951456581919, + 32.104806016986984, + 30.2893465166194 ], "moduleForcesY": [ - 92.24628285703518, - 91.63195838513802, - 98.60962299241723, - 99.13863942195309 + 92.24628285703513, + 91.63195838513796, + 98.60962299241726, + 99.13863942195313 ], "timestamp": 0.8384127046655072 }, { - "x": 3.7572242233614133, + "x": 3.7572242233614137, "y": 1.2196002881884476, - "heading": 1.2584600862248756, - "angularVelocity": 1.22595567268082, - "velocityX": -0.3504680424572255, + "heading": 1.2584600862248754, + "angularVelocity": 1.2259556726808236, + "velocityX": -0.35046804245722674, "velocityY": -1.2396068040441512, "moduleForcesX": [ - 49.28365457148797, - 57.86750411793015, - 14.612587070047223, - 5.158114346545566 + 49.283654571488064, + 57.86750411793033, + 14.612587070047217, + 5.158114346545502 ], "moduleForcesY": [ - 91.37280556707458, - 86.12414163106692, - 102.782755901925, + 91.37280556707454, + 86.1241416310668, + 102.78275590192501, 103.63034751499849 ], "timestamp": 0.9190176565927004 }, { "x": 3.738947473265417, - "y": 1.153151514149799, - "heading": 1.3274153889759315, - "angularVelocity": 0.8554722892625776, - "velocityX": -0.22674475524164925, + "y": 1.1531515141497997, + "heading": 1.3274153889759313, + "angularVelocity": 0.8554722892625797, + "velocityX": -0.2267447552416501, "velocityY": -0.8243758286546562, "moduleForcesX": [ - 48.61931337934166, - 62.846738605842184, - 7.378601440653287, - -5.124493078192649 + 48.61931337934176, + 62.84673860584237, + 7.3786014406533145, + -5.124493078192651 ], "moduleForcesY": [ - 91.7705326878624, - 82.62185421955228, + 91.77053268786236, + 82.62185421955213, 103.59052194670481, - 103.67630959459125 + 103.67630959459123 ], "timestamp": 0.9996226085198936 }, { "x": 3.73, - "y": 1.12, + "y": 1.1199999999999999, "heading": 1.3630312678774887, - "angularVelocity": 0.44185720666055006, - "velocityX": -0.11100401466027994, - "velocityY": -0.41128383997727014, + "angularVelocity": 0.4418572066605511, + "velocityX": -0.11100401466028038, + "velocityY": -0.4112838399772702, "moduleForcesX": [ - 48.05959947460402, - 65.55089466299441, - 3.545184653333839, - -10.772669788473484 + 48.05959947460411, + 65.55089466299457, + 3.54518465333388, + -10.772669788473445 ], "moduleForcesY": [ - 92.08571544205489, - 80.52833862168941, + 92.08571544205485, + 80.52833862168929, 103.81078891723752, 103.268327544522 ], @@ -403,18 +403,18 @@ "x": 3.73, "y": 1.12, "heading": 1.3630312678774887, - "angularVelocity": 3.806016005451674e-22, - "velocityX": 1.1811367619243883e-22, - "velocityY": 1.878055725323778e-21, + "angularVelocity": -3.589610570804574e-21, + "velocityX": 5.339550258707543e-21, + "velocityY": -2.502223964641149e-20, "moduleForcesX": [ - 48.217410638261995, - 66.96008834120764, - 1.7871900274204235, - -14.935437840905193 + 48.2174106382621, + 66.96008834120781, + 1.7871900274204708, + -14.935437840905156 ], "moduleForcesY": [ - 92.01539367318387, - 79.38179672545625, + 92.01539367318382, + 79.38179672545613, 103.86711250635297, 102.76690919104156 ], diff --git a/src/main/deploy/choreo/SourceSpit54Source.5.traj b/src/main/deploy/choreo/SourceSpit54Source.5.traj index c9795d3..97b4da4 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.5.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.5.traj @@ -4,128 +4,642 @@ "x": 3.73, "y": 1.12, "heading": 1.3630312678774887, - "angularVelocity": 3.806016005451674e-22, - "velocityX": 1.1811367619243883e-22, - "velocityY": 1.878055725323778e-21, + "angularVelocity": -3.589610570804574e-21, + "velocityX": 5.339550258707543e-21, + "velocityY": -2.502223964641149e-20, "moduleForcesX": [ - 48.217410638261995, - 66.96008834120764, - 1.7871900274204235, - -14.935437840905193 + 48.2174106382621, + 66.96008834120781, + 1.7871900274204708, + -14.935437840905156 ], "moduleForcesY": [ - 92.01539367318387, - 79.38179672545625, + 92.01539367318382, + 79.38179672545613, 103.86711250635297, 102.76690919104156 ], "timestamp": 0 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.5095116837609095, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.709497073488135e-16, - "velocityY": -1.4947758853647621e-16, + "x": 3.72087766585563, + "y": 1.1208176986079128, + "heading": 1.431626602021572, + "angularVelocity": 1.1235612635077608, + "velocityX": -0.14941980245858624, + "velocityY": 0.013393541886655683, "moduleForcesX": [ - -77.80402381445582, - -68.80771039095391, - 68.8077103909537, - 77.80402381445577 + -96.6383007361533, + -88.19573664846793, + -12.8532068373394, + 16.362081392441013 ], "moduleForcesY": [ - -68.80771039095379, - 77.8040238144557, - -77.80402381445587, - 68.80771039095383 + -38.07025222846023, + 54.85615378968718, + -103.0065453160445, + 102.47408622697547 ], - "timestamp": 0.08144599551055176 + "timestamp": 0.06105170796822268 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.802386311093262, - "angularVelocity": 3.595936491370013, - "velocityX": -5.571400134063502e-16, - "velocityY": -3.009483254088862e-16, + "x": 3.7060685799077318, + "y": 1.1216188501069515, + "heading": 1.5768366563753402, + "angularVelocity": 2.3784765272963293, + "velocityX": -0.24256628423237084, + "velocityY": 0.013122507554436695, "moduleForcesX": [ - -54.593644788232, - -88.28820574759457, - 88.28820574759443, - 54.593644788231884 + -88.8285234526177, + -89.30381940223486, + 33.24862083207597, + 31.84782787273839 ], "moduleForcesY": [ - -88.28820574759447, - 54.593644788231835, - -54.593644788232055, - 88.28820574759455 + -53.74418536835451, + 52.95104455482856, + -98.25981269878262, + 98.72404567269594 ], - "timestamp": 0.16289199102110352 + "timestamp": 0.12210341593644536 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.0952609384256147, - "angularVelocity": 3.5959364913700127, - "velocityX": -5.444414637967877e-16, - "velocityY": -2.972769677792861e-16, + "x": 3.6934340527017753, + "y": 1.1220954757151458, + "heading": 1.8032677618817912, + "angularVelocity": 3.708841456561832, + "velocityX": -0.20694797289753816, + "velocityY": 0.00780691685910522, "moduleForcesX": [ - 8.817109797269002e-15, - 2.5092224152930147e-14, - -1.931655743496392e-14, - -3.041443079302774e-15 + -35.05819106953644, + -82.5405267662809, + 91.56935681606274, + 69.25319076809818 ], "moduleForcesY": [ - 2.303931047982611e-14, - -5.0943567524068115e-15, - 6.764196124164912e-15, - -2.1369471108068058e-14 + -97.51255338667491, + 62.56571622690056, + -48.643052215626845, + 77.13926949432349 ], - "timestamp": 0.24433798653165528 + "timestamp": 0.18315512390466804 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.2417413543090356, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.6928205770985715e-16, - "velocityY": -1.3976239164731637e-16, + "x": 3.7016410085682656, + "y": 1.1214615431425257, + "heading": 2.0300291224213423, + "angularVelocity": 3.714250888076378, + "velocityX": 0.1344263107389409, + "velocityY": -0.010383535428491778, "moduleForcesX": [ - 11.854773337595287, - 103.12486448237142, - -103.1248644823714, - -11.85477333759506 + 103.52224314206727, + 103.57865086400795, + 103.55804416719118, + 103.60842497193357 ], "moduleForcesY": [ - 103.1248644823714, - -11.85477333759509, - 11.854773337595256, - -103.12486448237142 + -6.3201721524407395, + -5.293000752987987, + -5.7410129870185775, + -4.720443231127713 ], - "timestamp": 0.32578398204220704 + "timestamp": 0.24420683187289072 }, { "x": 3.73, "y": 1.12, "heading": 2.2417413543090356, - "angularVelocity": -1.621613980672119e-23, - "velocityX": -2.040896989344763e-21, - "velocityY": 2.209371111140419e-21, + "angularVelocity": 3.467752810419143, + "velocityX": 0.46450774884957136, + "velocityY": -0.02393943087174043, + "moduleForcesX": [ + 98.57622997589631, + 103.63716028828135, + 103.73909202920692, + 94.61069291895654 + ], + "moduleForcesY": [ + 32.58548347862939, + -6.552674898718845, + 0.25821976705337374, + -42.74149145896195 + ], + "timestamp": 0.3052585398411134 + }, + { + "x": 3.7595235837147456, + "y": 1.1185280268961153, + "heading": 2.3805165275370834, + "angularVelocity": 3.241748643389131, + "velocityX": 0.6896625327778686, + "velocityY": -0.03438487376134009, + "moduleForcesX": [ + 92.63480916068393, + 103.83855124027123, + 103.02064063619865, + 90.17555347900034 + ], + "moduleForcesY": [ + 46.88788427101869, + -1.7717146795353886, + -11.72405596945411, + -51.469771162765475 + ], + "timestamp": 0.3480672793499737 + }, + { + "x": 3.7986214441040707, + "y": 1.1164937101985923, + "heading": 2.509065602848367, + "angularVelocity": 3.0028698996072096, + "velocityX": 0.9133149174197912, + "velocityY": -0.047521060438719384, + "moduleForcesX": [ + 91.30030171363514, + 103.80690678446062, + 100.27353405465394, + 91.68864842073944 + ], + "moduleForcesY": [ + 49.406044695641285, + 2.918795853575125, + -26.34108710491625, + -48.71821158597372 + ], + "timestamp": 0.39087601885883405 + }, + { + "x": 3.847205006575031, + "y": 1.1138399376381436, + "heading": 2.6265825725100256, + "angularVelocity": 2.745163044039986, + "velocityX": 1.1348982247159145, + "velocityY": -0.06199137351157865, + "moduleForcesX": [ + 90.2042873084176, + 103.58978446340055, + 96.57875922239813, + 93.11566139239736 + ], + "moduleForcesY": [ + 51.344934793162416, + 7.2187104736979055, + -37.68389178110523, + -45.92314963498386 + ], + "timestamp": 0.4336847583676944 + }, + { + "x": 3.9051896953007397, + "y": 1.110564122158419, + "heading": 2.732274631293762, + "angularVelocity": 2.4689364834453884, + "velocityX": 1.35450586471335, + "velocityY": -0.07652211948572567, + "moduleForcesX": [ + 89.3927835844053, + 103.23979633546678, + 93.02671273614925, + 94.40996349354707 + ], + "moduleForcesY": [ + 52.70412794820037, + 11.079320727564896, + -45.74514083121305, + -43.186293651224865 + ], + "timestamp": 0.4764934978765547 + }, + { + "x": 3.9725090760296573, + "y": 1.1066998807874662, + "heading": 2.8255063011841965, + "angularVelocity": 2.1778653368463976, + "velocityX": 1.5725616194552194, + "velocityY": -0.09026758122959308, "moduleForcesX": [ - 11.861754037319995, - 103.18558970187604, - -103.18558970187601, - -11.861754037319772 + 88.88037952242793, + 102.81005176007353, + 90.15112154865182, + 95.54189569023103 ], "moduleForcesY": [ - 103.185589701876, - -11.8617540373198, - 11.861754037319967, - -103.18558970187604 + 53.51505450468626, + 14.462722838276617, + -51.165484322274246, + -40.60120774371482 ], - "timestamp": 0.4072299775527588 + "timestamp": 0.519302237385415 + }, + { + "x": 4.04911754604587, + "y": 1.1022980104803026, + "heading": 2.905836418420014, + "angularVelocity": 1.8764887300452011, + "velocityX": 1.7895521077032517, + "velocityY": -0.1028264405272802, + "moduleForcesX": [ + 88.6435849529272, + 102.35009226005988, + 88.04981715271404, + 96.49632501819781 + ], + "moduleForcesY": [ + 53.8478227107517, + 17.346843483393773, + -54.67995276264344, + -38.25000602612566 + ], + "timestamp": 0.5621109768942754 + }, + { + "x": 4.134987194671327, + "y": 1.0974123372446702, + "heading": 2.972996577285001, + "angularVelocity": 1.568842241923198, + "velocityX": 2.005890610438106, + "velocityY": -0.11412793956759826, + "moduleForcesX": [ + 88.62476323392177, + 101.90241204467951, + 86.61463584529837, + 97.26963381448 + ], + "moduleForcesY": [ + 53.80724235029578, + 19.724948998303372, + -56.891541867481344, + -36.19986123567652 + ], + "timestamp": 0.6049197164031357 + }, + { + "x": 4.230102691196206, + "y": 1.0920909550243076, + "heading": 3.0268475265496417, + "angularVelocity": 1.2579428846180885, + "velocityX": 2.2218709921405915, + "velocityY": -0.12430597773782255, + "moduleForcesX": [ + 88.74379947495026, + 101.50047511959417, + 85.68172812373263, + 97.86565142236238 + ], + "moduleForcesY": [ + 53.52138370855977, + 21.601735994041906, + -58.23596611496595, + -34.502020704573155 + ], + "timestamp": 0.647728455911996 + }, + { + "x": 4.334456113781515, + "y": 1.086371616052347, + "heading": 3.0673336474081494, + "angularVelocity": 0.9457442878019748, + "velocityX": 2.437666321936928, + "velocityY": -0.1336021344607505, + "moduleForcesX": [ + 88.91294242841904, + 101.16809361041918, + 85.0990600378489, + 98.29129352160717 + ], + "moduleForcesY": [ + 53.12500412966054, + 22.988179743010008, + -59.00882911377455, + -33.19297248992892 + ], + "timestamp": 0.6905371954208563 + }, + { + "x": 4.448042469034826, + "y": 1.0802797732534677, + "heading": 3.0944451868788407, + "angularVelocity": 0.6333178641029511, + "velocityX": 2.653345007502878, + "velocityY": -0.14230371809045952, + "moduleForcesX": [ + 89.05028068668823, + 100.91938488804666, + 84.74746616957619, + 98.55238470477299 + ], + "moduleForcesY": [ + 52.73979656003988, + 23.896465943972522, + -59.39938458297941, + -32.29648339516581 + ], + "timestamp": 0.7333459349297167 + }, + { + "x": 4.570855977052453, + "y": 1.0738280106171412, + "heading": 3.1081926381636182, + "angularVelocity": 0.32113655862097673, + "velocityX": 2.868888676158945, + "velocityY": -0.1507113432992367, + "moduleForcesX": [ + 89.08809122726427, + 100.7579318929463, + 84.54064179908963, + 98.64918125989954 + ], + "moduleForcesY": [ + 52.453084161766014, + 24.33536809116126, + -59.51415041556405, + -31.82516108397966 + ], + "timestamp": 0.776154674438577 + }, + { + "x": 4.702886478240266, + "y": 1.0670159670138122, + "heading": 3.108595947975067, + "angularVelocity": 0.009421202681421935, + "velocityX": 3.0841950195825003, + "velocityY": -0.15912740439179773, + "moduleForcesX": [ + 88.97153279637656, + 100.67185170490919, + 84.41297414011797, + 98.56875490305062 + ], + "moduleForcesY": [ + 52.29316044520558, + 24.305030951948087, + -59.383999366054645, + -31.779651043346263 + ], + "timestamp": 0.8189634139474373 + }, + { + "x": 4.844113025567038, + "y": 1.0598302236654258, + "heading": 3.095694317757129, + "angularVelocity": -0.3013784186583571, + "velocityX": 3.299012046303043, + "velocityY": -0.1678569243295801, + "moduleForcesX": [ + 88.62959336610633, + 100.61041066833194, + 84.27835410029421, + 98.25990766190384 + ], + "moduleForcesY": [ + 52.17924438635207, + 23.78466302835548, + -58.93296137680517, + -32.13890015705108 + ], + "timestamp": 0.8617721534562977 + }, + { + "x": 4.994473934173584, + "y": 1.0522435903549194, + "heading": 3.069615115322268, + "angularVelocity": -0.6092027640632386, + "velocityX": 3.5123881322272132, + "velocityY": -0.17722160001784806, + "moduleForcesX": [ + 87.74948530062613, + 100.31459177779811, + 83.75899516652834, + 97.46139462629402 + ], + "moduleForcesY": [ + 51.62768559826387, + 22.65362039540959, + -57.70317606341726, + -32.78533166041236 + ], + "timestamp": 0.904580892965158 + }, + { + "x": 5.220411209087956, + "y": 1.0394568906064166, + "heading": 3.0642021576954424, + "angularVelocity": -0.08079045747009987, + "velocityX": 3.3722000167562336, + "velocityY": -0.19084637150951397, + "moduleForcesX": [ + -18.25974924770877, + -61.72570066835306, + -14.523924319494144, + -60.50942691174134 + ], + "moduleForcesY": [ + -41.395105821064156, + -26.076397284088287, + 28.930609473614382, + 23.47473958953477 + ], + "timestamp": 0.9715808555390639 + }, + { + "x": 5.421335815965932, + "y": 1.028068537679225, + "heading": 3.059593893702212, + "angularVelocity": -0.0687800980209144, + "velocityX": 2.9988764046893643, + "velocityY": -0.16997551177182332, + "moduleForcesX": [ + -103.2664938988573, + -103.2751808850352, + -103.13301405288641, + -103.14332065108621 + ], + "moduleForcesY": [ + 4.541224118384727, + 4.630867167407542, + 6.93556034116202, + 6.971163895891921 + ], + "timestamp": 1.0385808181129699 + }, + { + "x": 5.597181183736462, + "y": 1.0180948163903252, + "heading": 3.055642266473313, + "angularVelocity": -0.058979543824966826, + "velocityX": 2.624559193993438, + "velocityY": -0.14886159492834625, + "moduleForcesX": [ + -103.53305852533342, + -103.53469591125267, + -103.42317893872716, + -103.42578885136426 + ], + "moduleForcesY": [ + 4.8306687322724216, + 4.906393859163195, + 6.785485794504554, + 6.825037574562329 + ], + "timestamp": 1.1055807806868758 + }, + { + "x": 5.747925019771543, + "y": 1.0095411919696742, + "heading": 3.05229779161728, + "angularVelocity": -0.04991756304854153, + "velocityX": 2.2499092573185537, + "velocityY": -0.1276661074432343, + "moduleForcesX": [ + -103.62208629776751, + -103.62173078672369, + -103.5202241170174, + -103.52060652438273 + ], + "moduleForcesY": [ + 4.926128305543275, + 5.0005635670766955, + 6.733817674210244, + 6.777276521096291 + ], + "timestamp": 1.1725807432607818 + }, + { + "x": 5.873556159188288, + "y": 1.0024104036653874, + "heading": 3.049535712132861, + "angularVelocity": -0.04122508995990319, + "velocityX": 1.8750926805101673, + "velocityY": -0.10642973563491336, + "moduleForcesX": [ + -103.66665324519711, + -103.6653199660069, + -103.56883625472425, + -103.56810747302617 + ], + "moduleForcesY": [ + 4.973185116802823, + 5.048577308550577, + 6.707181320768238, + 6.75405185150205 + ], + "timestamp": 1.2395807058346877 + }, + { + "x": 5.974067897354128, + "y": 0.996704097035998, + "heading": 3.047341170398741, + "angularVelocity": -0.032754372537126, + "velocityX": 1.5001760345007609, + "velocityY": -0.0851688032376159, + "moduleForcesX": [ + -103.69341461870235, + -103.69148910140211, + -103.59803876166781, + -103.59663011099236 + ], + "moduleForcesY": [ + 5.001095808939345, + 5.0777995568546475, + 6.690824992522238, + 6.740434125392908 + ], + "timestamp": 1.3065806684085937 + }, + { + "x": 6.049455762238878, + "y": 0.9924233699091543, + "heading": 3.045704259638799, + "angularVelocity": -0.024431517527148842, + "velocityX": 1.1251926417363327, + "velocityY": -0.06389148534402293, + "moduleForcesX": [ + -103.7112611091154, + -103.70894383397855, + -103.61751768625881, + -103.61565794570146 + ], + "moduleForcesY": [ + 5.019624761642934, + 5.097395248534811, + 6.679822686498952, + 6.7314307265973286 + ], + "timestamp": 1.3735806309824996 + }, + { + "x": 6.099716558467515, + "y": 0.989569006809897, + "heading": 3.0446179022503497, + "angularVelocity": -0.016214298437120946, + "velocityX": 0.7501615567798412, + "velocityY": -0.042602458115063656, + "moduleForcesX": [ + -103.72400441579775, + -103.72142253974555, + -103.63142694229215, + -103.6292642891978 + ], + "moduleForcesY": [ + 5.032957243639672, + 5.11130283220324, + 6.672061132278851, + 6.724900296554289 + ], + "timestamp": 1.4405805935564056 + }, + { + "x": 6.12484788894652, + "y": 0.9881415963172888, + "heading": 3.0440767888466445, + "angularVelocity": -0.008076323969709828, + "velocityX": 0.3750946942888271, + "velocityY": -0.021304646118706513, + "moduleForcesX": [ + -103.73355085660772, + -103.73079678145365, + -103.64184438103867, + -103.63948865503173 + ], + "moduleForcesY": [ + 5.0431852138632, + 5.121495388875575, + 6.666482603336728, + 6.7197724181306056 + ], + "timestamp": 1.5075805561303115 + }, + { + "x": 6.124847888946533, + "y": 0.988141596317291, + "heading": 3.044076788846644, + "angularVelocity": 2.7161141224253378e-17, + "velocityX": -3.613596854420864e-17, + "velocityY": 3.7089850096461916e-17, + "moduleForcesX": [ + -103.74095967535139, + -103.73810721466131, + -103.64992473488311, + -103.64746520965623 + ], + "moduleForcesY": [ + 5.051470425075263, + 5.129071086156181, + 6.66249852967614, + 6.715452696467063 + ], + "timestamp": 1.5745805187042174 } ], - "eventMarkers": [] + "eventMarkers": [ + { + "timestamp": 0.7745805187042176, + "command": { + "type": "named", + "data": { + "name": "seek5D" + } + } + } + ] } \ No newline at end of file diff --git a/src/main/deploy/choreo/SourceSpit54Source.6.traj b/src/main/deploy/choreo/SourceSpit54Source.6.traj index 04c567d..0ba208c 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.6.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.6.traj @@ -1,540 +1,383 @@ { "samples": [ { - "x": 3.73, - "y": 1.12, - "heading": 2.2417413543090356, - "angularVelocity": -1.621613980672119e-23, - "velocityX": -2.040896989344763e-21, - "velocityY": 2.209371111140419e-21, + "x": 6.124847888946533, + "y": 0.988141596317291, + "heading": 3.044076788846644, + "angularVelocity": 2.7161141224253378e-17, + "velocityX": -3.613596854420864e-17, + "velocityY": 3.7089850096461916e-17, "moduleForcesX": [ - 11.861754037319995, - 103.18558970187604, - -103.18558970187601, - -11.861754037319772 + -103.74095967535139, + -103.73810721466131, + -103.64992473488311, + -103.64746520965623 ], "moduleForcesY": [ - 103.185589701876, - -11.8617540373198, - 11.861754037319967, - -103.18558970187604 + 5.051470425075263, + 5.129071086156181, + 6.66249852967614, + 6.715452696467063 ], "timestamp": 0 }, { - "x": 3.7420257087402713, - "y": 1.119395565443157, - "heading": 2.250679174338871, - "angularVelocity": 0.18951813820310662, - "velocityX": 0.25499393850188956, - "velocityY": -0.01281647107416695, - "moduleForcesX": [ - 94.39176645951244, - 103.75042896292366, - 103.62407770654451, - 98.82065097544032 - ], - "moduleForcesY": [ - -43.26174671623899, - -1.821110039816679, - -6.93478963585717, - 31.88340023830956 - ], - "timestamp": 0.047160763157439334 - }, - { - "x": 3.7660834861885943, - "y": 1.1181790558565958, - "heading": 2.2684739284287843, - "angularVelocity": 0.37732116485282313, - "velocityX": 0.510122734189237, - "velocityY": -0.025794951250046723, - "moduleForcesX": [ - 94.60878216272674, - 103.70988945367432, - 103.65165670870203, - 98.82845189414677 - ], - "moduleForcesY": [ - -42.76818746342199, - -3.0383973887514557, - -6.41564735852772, - 31.833475192591276 - ], - "timestamp": 0.09432152631487867 - }, - { - "x": 3.8021804586038193, - "y": 1.116340174110553, - "heading": 2.2950337283480158, - "angularVelocity": 0.5631757872654675, - "velocityX": 0.7654026355493844, - "velocityY": -0.038991772459324274, + "x": 6.110634732561328, + "y": 0.9970411947826974, + "heading": 3.0373126401475794, + "angularVelocity": -0.12304364450736582, + "velocityX": -0.25854525665067285, + "velocityY": 0.1618886689632799, "moduleForcesX": [ - 94.8944561275941, - 103.62991439772085, - 103.68917333070299, - 98.822618306651 + -84.83006014459953, + -75.08989291136919, + -96.37385776100199, + -92.14807124547087 ], "moduleForcesY": [ - -42.11106179846348, - -4.788890326585848, - -5.652040565410073, - 31.820229232712332 + 59.91992900500898, + 71.72511840504777, + 38.69327827773459, + 47.83930877704511 ], - "timestamp": 0.141482289472318 + "timestamp": 0.05497357239495315 }, { - "x": 3.8503241618605326, - "y": 1.1138665667296608, - "heading": 2.3302610133197463, - "angularVelocity": 0.7469617243921487, - "velocityX": 1.0208423281021242, - "velocityY": -0.05245053759274676, + "x": 6.0822053465067905, + "y": 1.014843635655015, + "heading": 3.0238865872879876, + "angularVelocity": -0.24422740372652788, + "velocityX": -0.5171464180618228, + "velocityY": 0.32383634715015114, "moduleForcesX": [ - 95.25359220944863, - 103.48669966827966, - 103.73034024206368, - 98.81655664655072 + -84.739374371467, + -75.3569946010479, + -96.21568889729645, + -92.20516713338158 ], "moduleForcesY": [ - -41.26925009772418, - -7.018269244384779, - -4.656152780003914, - 31.800403545940096 + 60.03874061041446, + 71.43471959661174, + 39.069910756614824, + 47.71379033217303 ], - "timestamp": 0.18864305262975734 + "timestamp": 0.1099471447899063 }, { - "x": 3.9105222915906985, - "y": 1.1107447960198984, - "heading": 2.374057057087477, - "angularVelocity": 0.9286542633231647, - "velocityX": 1.276445199353584, - "velocityY": -0.06619423649572619, + "x": 6.039556341245207, + "y": 1.0415525633745906, + "heading": 3.003914713769281, + "angularVelocity": -0.3632995391898515, + "velocityX": -0.7758092373649862, + "velocityY": 0.4858503195399354, "moduleForcesX": [ - 95.6913636594475, - 103.25613890552566, - 103.76742989536034, - 98.82860456818229 + -84.59718960483518, + -75.67793809347147, + -96.01610596369684, + -92.30908778711465 ], "moduleForcesY": [ - -40.215687472750055, - -9.644987734666467, - -3.44472063684618, - 31.714505873672152 + 60.22794100573528, + 71.083083538686, + 39.54074486097146, + 47.494736700425264 ], - "timestamp": 0.23580381578719667 + "timestamp": 0.16492071718485946 }, { - "x": 3.9827828266678518, - "y": 1.106961759031523, - "heading": 2.4263221397090615, - "angularVelocity": 1.108232333881124, - "velocityX": 1.5322172551772217, - "velocityY": -0.08021577122801049, + "x": 5.982683900674507, + "y": 1.0771721914258312, + "heading": 2.977532671301142, + "angularVelocity": -0.4799040942545924, + "velocityX": -1.0345414730133229, + "velocityY": 0.6479409380107021, "moduleForcesX": [ - 96.21274681913333, - 102.92117372125647, - 103.79170757840996, - 98.88369219763595 + -84.41174684856678, + -76.06724787127322, + -95.76969169075473, + -92.44518756496295 ], "moduleForcesY": [ - -38.9163675493585, - -12.5495178250086, - -2.0417028183548362, - 31.480227453762826 + 60.47454381132092, + 70.65247665559389, + 40.11412819885202, + 47.208653493730665 ], - "timestamp": 0.282964578944636 + "timestamp": 0.2198942895798126 }, { - "x": 4.067114900352871, - "y": 1.1025064837995016, - "heading": 2.4869458369938227, - "angularVelocity": 1.2854689624588427, - "velocityX": 1.7881829732798544, - "velocityY": -0.09446995624621968, + "x": 5.911583629035834, + "y": 1.121707504296573, + "heading": 2.944903680692972, + "angularVelocity": -0.5935395715917635, + "velocityX": -1.2933536704794637, + "velocityY": 0.8101222265187449, "moduleForcesX": [ - 96.82210060607143, - 102.48186327897088, - 103.79411466441147, - 99.01547871125396 + -84.19443291188921, + -76.54335998261115, + -95.46907769999206, + -92.59476805889527 ], "moduleForcesY": [ - -37.327787018091406, - -15.562895960409582, - -0.48329422551997087, - 30.98113066968098 + 60.76103074766313, + 70.11956535868302, + 40.80122275959633, + 46.89017945698358 ], - "timestamp": 0.33012534210207534 + "timestamp": 0.27486786197476576 }, { - "x": 4.163530889459729, - "y": 1.0973719786562688, - "heading": 2.5557791619374997, - "angularVelocity": 1.4595464605584618, - "velocityX": 2.044411130180125, - "velocityY": -0.1088723930546053, + "x": 5.82625033723076, + "y": 1.1751644926956395, + "heading": 2.906229937042946, + "angularVelocity": -0.7034970071105705, + "velocityX": -1.5522602604982072, + "velocityY": 0.972412489689044, "moduleForcesX": [ - 97.52307759296336, - 101.96757166187002, - 103.76643805404562, - 99.2687524999127 + -83.96151353954032, + -77.12910808252042, + -95.10429131938795, + -92.73393871559084 ], "moduleForcesY": [ - -35.391087956730566, - -18.45337114743011, - 1.1721764204605787, - 30.046537559814595 + 61.06320215653575, + 69.45398505588678, + 41.616710994286336, + 46.584965453860235 ], - "timestamp": 0.37728610525951467 + "timestamp": 0.3298414343697189 }, { - "x": 4.27205024518103, - "y": 1.0915564372377649, - "heading": 2.6325761862157253, - "angularVelocity": 1.628409277895895, - "velocityX": 2.3010517314791077, - "velocityY": -0.1233131321282886, + "x": 5.726677755235851, + "y": 1.2375504217136353, + "heading": 2.861769188190487, + "angularVelocity": -0.8087658654059063, + "velocityX": -1.8112809054761907, + "velocityY": 1.1348349086300362, "moduleForcesX": [ - 98.3192725604474, - 101.45005517054383, - 103.70343609036856, - 99.70101230315205 + -83.73699636277946, + -77.85252008437688, + -94.6615160270873, + -92.83153124531917 ], "moduleForcesY": [ - -33.018357864516105, - -20.904618562351715, - 2.823282264089796, - 28.413777464885822 + 61.34647892437862, + 68.61600098980595, + 42.58035051007835, + 46.354139793210784 ], - "timestamp": 0.424446868416954 + "timestamp": 0.38481500676467206 }, { - "x": 4.392705551657881, - "y": 1.0850626109406343, - "heading": 2.7168841340917256, - "angularVelocity": 1.7876714079997014, - "velocityX": 2.5583832491017766, - "velocityY": -0.13769553040208768, + "x": 5.612858173258879, + "y": 1.3088741316636203, + "heading": 2.8118595087283933, + "angularVelocity": -0.9078849579489091, + "velocityX": -2.070441796602538, + "velocityY": 1.297418138502555, "moduleForcesX": [ - 99.21668025263472, - 101.05663190107522, - 103.60675985804505, - 100.37911048180725 + -83.55765429351254, + -78.7482789323879, + -94.1206018148576, + -92.84503865145162 ], "moduleForcesY": [ - -30.057161726527582, - -22.46386652016153, - 4.275852534155649, - 25.65091045432924 + 61.55910024091844, + 67.55242031387074, + 43.72035562264012, + 46.28181920591784 ], - "timestamp": 0.47160763157439334 + "timestamp": 0.4397885791596252 }, { - "x": 4.525550892595546, - "y": 1.0778935325462906, - "heading": 2.80783510466324, - "angularVelocity": 1.9285305088869589, - "velocityX": 2.8168615612554824, - "velocityY": -0.1520136213744107, + "x": 5.484782065280293, + "y": 1.3891463740331047, + "heading": 2.756958052277954, + "angularVelocity": -0.9986881706723401, + "velocityX": -2.3297759702663448, + "velocityY": 1.460196943148917, "moduleForcesX": [ - 100.23079205968564, - 100.98392888115625, - 103.49130741231629, - 101.35472988164179 + -83.48255301281375, + -79.86072105792785, + -93.4496784668459, + -92.71215432504205 ], "moduleForcesY": [ - -26.181867508904073, - -22.390549955983754, - 5.102781651117579, - 20.97639516911996 + 61.6185005820626, + 66.18879981725462, + 45.080955230741196, + 46.48901620859793 ], - "timestamp": 0.5187683947318327 + "timestamp": 0.49476215155457837 }, { - "x": 4.6706692184978085, - "y": 1.0700419744774925, - "heading": 2.9036900081376484, - "angularVelocity": 2.032513832619933, - "velocityX": 3.077098761481141, - "velocityY": -0.16648496638163585, + "x": 5.342437911265935, + "y": 1.4783801698446344, + "heading": 2.697706318549636, + "angularVelocity": -1.0778221452051246, + "velocityX": -2.5893197008219415, + "velocityY": 1.623212607877452, "moduleForcesX": [ - 101.4022901583631, - 101.49973712392797, - 103.38179356673183, - 102.54009154829254 + -83.61299273235741, + -81.25057420745438, + -92.59228682629652, + -92.33167327594502 ], "moduleForcesY": [ - -20.460130196971843, - -19.145861980841424, - 4.12011250952299, - 12.751882075421097 + 61.380915274690516, + 64.41300325739722, + 46.74043198922804, + 47.16213805287967 ], - "timestamp": 0.565929157889272 + "timestamp": 0.5497357239495315 }, { - "x": 4.828133141104835, - "y": 1.061470786457346, - "heading": 3.0003548656233874, - "angularVelocity": 2.0496881520563304, - "velocityX": 3.3388756259383423, - "velocityY": -0.18174404836350594, + "x": 5.1858130163033636, + "y": 1.5765910305618624, + "heading": 2.6350531319574313, + "angularVelocity": -1.1396964734632677, + "velocityX": -2.8490943580625947, + "velocityY": 1.7865104347238558, "moduleForcesX": [ - 102.6792974850671, - 102.66038096177155, - 102.96356872642492, - 102.939426086725 + -84.13983054188876, + -83.01127626894349, + -91.4320969921366, + -91.51554352523937 ], "moduleForcesY": [ - -8.525317491369549, - -8.235583388371387, - -3.8597400587840296, - -3.350865018387175 + 60.56323937694242, + 62.03620620732814, + 48.8592616418063, + 48.61805171420087 ], - "timestamp": 0.6130899210467113 + "timestamp": 0.6047092963444847 }, { - "x": 4.994473934173584, - "y": 1.0522435903549194, - "heading": 3.069615115322268, - "angularVelocity": 1.4685990018368698, - "velocityX": 3.5271013853919833, - "velocityY": -0.19565408794644082, + "x": 5.014898738147155, + "y": 1.683795820864356, + "heading": 2.570527923611425, + "angularVelocity": -1.173749595213334, + "velocityX": -3.1090262232598085, + "velocityY": 1.9501150394722202, "moduleForcesX": [ - 58.87926049401101, - 97.90553952546307, - 46.3522757191946, - 92.55927869131658 + -85.47585344347402, + -85.31180678742584, + -89.67415166341442, + -89.84880486427723 ], "moduleForcesY": [ - 80.63347164631476, - 29.303293505963616, - -88.46040550921222, - -43.328565242288015 + 58.49786820153291, + 58.68618769958436, + 51.83355824912394, + 51.4725898902009 ], - "timestamp": 0.6602506842041507 + "timestamp": 0.6596828687394378 }, { - "x": 5.21993980254767, - "y": 1.039630843584023, - "heading": 3.08612579482946, - "angularVelocity": 0.2463107723682536, - "velocityX": 3.363560667367391, - "velocityY": -0.18816035993378763, + "x": 4.829720072773047, + "y": 1.8000004850362632, + "heading": 2.5070278105656283, + "angularVelocity": -1.155102538899726, + "velocityX": -3.3685033974470753, + "velocityY": 2.1138277739922944, "moduleForcesX": [ - -89.89760858727718, - 7.385392617841561, - -94.21103479178815, - -4.032488365945729 + -88.71709286665494, + -88.52155136032547, + -86.28201790279765, + -86.17716678150764 ], "moduleForcesY": [ - 50.674369616275214, - 102.01528692601666, - -42.13219571240748, - -102.27490978017325 + 53.08178703682181, + 53.45137824719711, + 56.95128514656165, + 57.15148028708766 ], - "timestamp": 0.7272825860103262 + "timestamp": 0.714656441134391 }, { - "x": 5.420922348442108, - "y": 1.028282211672202, - "heading": 3.087184300804519, - "angularVelocity": 0.015791077778456095, - "velocityX": 2.998311855683048, - "velocityY": -0.16930195333911574, + "x": 4.630631373197701, + "y": 1.9250518085990234, + "heading": 2.4526907512388036, + "angularVelocity": -0.9884214716200167, + "velocityX": -3.621534691811259, + "velocityY": 2.2747534520121397, "moduleForcesX": [ - -101.02914288206168, - -98.56977605934014, - -102.85614132118369, - -101.24146081662191 + -97.4625123973849, + -93.61667564220114, + -73.96265211784451, + -75.9688655545753 ], "moduleForcesY": [ - 22.827115278426835, - 31.24234686128395, - -12.191641059850506, - -21.03429499073052 + 32.66916540086088, + 43.24143764087089, + 71.27489026019346, + 69.69431663079334 ], - "timestamp": 0.7943144878165018 + "timestamp": 0.7696300135293441 }, { - "x": 5.596884738261333, - "y": 1.0182966263987785, - "heading": 3.082148178112647, - "angularVelocity": -0.07513023733735659, - "velocityX": 2.625054415553102, - "velocityY": -0.1489676557633177, + "x": 4.422647731607199, + "y": 2.0565226976433393, + "heading": 2.440254457435579, + "angularVelocity": -0.22622313343364486, + "velocityX": -3.7833386576614494, + "velocityY": 2.3915289350430577, "moduleForcesX": [ - -102.77315332713786, - -102.52922721443944, - -103.66971501009118, - -103.57607771279062 + -86.57780281805616, + -99.2952305335068, + 21.2368596680207, + -53.427306251741676 ], "moduleForcesY": [ - 13.830590440359913, - 15.251419200238098, - -2.496116046862724, - -4.111117694851949 + -50.87471239226852, + 24.448002009206352, + 96.72683386607464, + 87.07839358262063 ], - "timestamp": 0.8613463896226774 + "timestamp": 0.8246035859242973 }, { - "x": 5.747733551223532, - "y": 1.0097082363442045, - "heading": 3.0745190793089487, - "angularVelocity": -0.11381295469965687, - "velocityX": 2.250403298990136, - "velocityY": -0.12812392044921225, + "x": 4.2116428888881625, + "y": 2.1889203295552395, + "heading": 2.439987241979948, + "angularVelocity": -0.004860798452597401, + "velocityX": -3.838295994465267, + "velocityY": 2.4083869055221276, "moduleForcesX": [ - -103.32486902872125, - -103.2942237860439, - -103.73764505407789, - -103.73181638939806 + -17.895066941079264, + -36.38334507030241, + 0.4234358390630315, + -20.21112009699484 ], "moduleForcesY": [ - 9.484303024561918, - 9.676485182114542, - 2.1233990772684646, - 1.75365202837636 + -13.978656655713657, + 3.9758187708014625, + 8.014896542310398, + 24.707456825429773 ], - "timestamp": 0.928378291428853 + "timestamp": 0.8795771583192504 }, { - "x": 5.873444227245606, - "y": 1.0025341434487187, - "heading": 3.0661617511748713, - "angularVelocity": -0.12467687636616408, - "velocityX": 1.875385788479751, - "velocityY": -0.10702505377559426, + "x": 4.0005412101745605, + "y": 2.321166753768921, + "heading": 2.439727894004586, + "angularVelocity": -0.004717684590317965, + "velocityX": -3.8400574952080944, + "velocityY": 2.40563635311109, "moduleForcesX": [ - -103.56363844845902, - -103.56214591948665, - -103.68378743626758, - -103.6839446529072 + -0.5924713914159432, + -0.6056971386559915, + -0.5812916448950497, + -0.5945173716952727 ], "moduleForcesY": [ - 6.914243737313298, - 6.895026666759426, - 4.787160207313561, - 4.7233963185770085 + -0.9389327981580513, + -0.9277514376530072, + -0.925710694505112, + -0.9145292315425559 ], - "timestamp": 0.9954101932350286 - }, - { - "x": 5.974010415319068, - "y": 0.9967845639996021, - "heading": 3.0582409293271344, - "angularVelocity": -0.1181649577933858, - "velocityX": 1.5002735319109908, - "velocityY": -0.0857737777713852, - "moduleForcesX": [ - -103.68647322434256, - -103.68567632686822, - -103.61320240133482, - -103.61288395314875 - ], - "moduleForcesY": [ - 5.206542405717511, - 5.249110661977166, - 6.503035230338926, - 6.529591244426612 - ], - "timestamp": 1.0624420950412041 - }, - { - "x": 6.049431766890569, - "y": 0.9924662724676168, - "heading": 3.051554976537805, - "angularVelocity": -0.0997428479451764, - "velocityX": 1.1251560755292975, - "velocityY": -0.06442143838424273, - "moduleForcesX": [ - -103.75677421099608, - -103.75270834682686, - -103.54776492224136, - -103.54673559392808 - ], - "moduleForcesY": [ - 3.985464683416833, - 4.1705499021545, - 7.693449422935552, - 7.750517296679296 - ], - "timestamp": 1.1294739968473797 - }, - { - "x": 6.099710081045857, - "y": 0.9895840842861203, - "heading": 3.046685843199759, - "angularVelocity": -0.07263904509416273, - "velocityX": 0.7500654583942555, - "velocityY": -0.04299726106281018, - "moduleForcesX": [ - -103.79993007073521, - -103.79334375915312, - -103.49115420635184, - -103.48989057299576 - ], - "moduleForcesY": [ - 3.0696514163509354, - 3.4109877407679896, - 8.567062634653622, - 8.631679427189365 - ], - "timestamp": 1.1965058986535562 - }, - { - "x": 6.124847888946533, - "y": 0.9881415963172908, - "heading": 3.0440767888466445, - "angularVelocity": -0.038922576904629844, - "velocityX": 0.37501260181103735, - "velocityY": -0.02151942478075615, - "moduleForcesX": [ - -103.82773310541879, - -103.82008730330988, - -103.44258569856589, - -103.44217710700607 - ], - "moduleForcesY": [ - 2.361430338717795, - 2.8438625635459225, - 9.239306415728796, - 9.294089241704407 - ], - "timestamp": 1.2635378004597326 - }, - { - "x": 6.124847888946533, - "y": 0.988141596317291, - "heading": 3.044076788846644, - "angularVelocity": 2.7103270983123612e-17, - "velocityX": -3.611620349514071e-17, - "velocityY": 3.713622586240161e-17, - "moduleForcesX": [ - -103.84628461386265, - -103.83885635426098, - -103.40030298005537, - -103.40264709813552 - ], - "moduleForcesY": [ - 1.803887986928977, - 2.3974582054604787, - 9.779530745408758, - 9.803777910373523 - ], - "timestamp": 1.330569702265909 + "timestamp": 0.9345507307142036 } ], - "eventMarkers": [ - { - "timestamp": 0.5305697022659093, - "command": { - "type": "named", - "data": { - "name": "seek5D" - } - } - } - ] + "eventMarkers": [] } \ No newline at end of file diff --git a/src/main/deploy/choreo/SourceSpit54Source.traj b/src/main/deploy/choreo/SourceSpit54Source.traj index 5185902..05a343d 100644 --- a/src/main/deploy/choreo/SourceSpit54Source.traj +++ b/src/main/deploy/choreo/SourceSpit54Source.traj @@ -4,9 +4,9 @@ "x": 1.3093055486679075, "y": 1.4855375289916992, "heading": 3.1415, - "angularVelocity": -0.00020611047214952728, - "velocityX": 4.247624054998792, - "velocityY": -0.45156582763286957, + "angularVelocity": -0.00020611047215007977, + "velocityX": 4.247624054998791, + "velocityY": -0.45156582763287095, "moduleForcesX": [ 0, 0, @@ -23,725 +23,725 @@ }, { "x": 1.6776912225328318, - "y": 1.4463743687041792, + "y": 1.446374368704179, "heading": 3.141472282141126, - "angularVelocity": -0.0003391512485237624, + "angularVelocity": -0.0003391512485240895, "velocityX": 4.5075076612628155, - "velocityY": -0.4791941097578826, + "velocityY": -0.479194109757884, "moduleForcesX": [ - 58.894651333366134, - 58.902040993577, - 58.89391091497932, - 58.901300701642334 + 58.89465133336612, + 58.902040993576975, + 58.8939109149793, + 58.90130070164229 ], "moduleForcesY": [ - -6.254691452649277, - -6.253954535213562, - -6.26895930675167, - -6.268220727628237 + -6.2546914526492765, + -6.253954535213559, + -6.2689593067516585, + -6.268220727628227 ], - "timestamp": 0.08172713205366311 + "timestamp": 0.08172713205366312 }, { - "x": 2.0460782805856987, - "y": 1.4072110612618156, - "heading": 3.141444998150414, - "angularVelocity": -0.0003338425076975475, + "x": 2.04607828058528, + "y": 1.4072110612618527, + "heading": 3.1414449981504142, + "angularVelocity": -0.0003338425076962522, "velocityX": 4.507524597961855, - "velocityY": -0.4791959103204973, + "velocityY": -0.4791959103204976, "moduleForcesX": [ - 0.004054411185247945, - 0.0036223253849391474, - 0.004054475069004705, - 0.0036223892690657507 + 0.0040544111854116495, + 0.003622325384970821, + 0.004054475069168368, + 0.003622389269097384 ], "moduleForcesY": [ - -0.0006241401719434498, - -0.0006240762768495998, - -0.00019205441259517473, - -0.00019199052157958934 + -0.0006241401717500891, + -0.0006240762766562905, + -0.00019205441226977354, + -0.00019199052125422377 ], - "timestamp": 0.16345426410732622 + "timestamp": 0.16345426410732625 }, { - "x": 2.4144653386990167, - "y": 1.3680477538129143, - "heading": 3.1414177142020585, - "angularVelocity": -0.0003338419894377083, - "velocityX": 4.507524598705652, - "velocityY": -0.4791959104011729, + "x": 2.414465338699188, + "y": 1.3680477538128972, + "heading": 3.141417714202059, + "angularVelocity": -0.00033384198943655095, + "velocityX": 4.507524598705653, + "velocityY": -0.4791959104011735, "moduleForcesX": [ - 1.8965212607030153e-7, - 1.4747024014620896e-7, - 1.8966659941626728e-7, - 1.4748471350632016e-7 + 1.8965220181163422e-7, + 1.474703271181504e-7, + 1.8966667527279182e-7, + 1.4748480059345372e-7 ], "moduleForcesY": [ - -3.9381860338036625e-8, - -3.936738687005518e-8, - 2.800025123487072e-9, - 2.8144985669772043e-9 + -3.938192729235327e-8, + -3.936745370918043e-8, + 2.7999469385635256e-9, + 2.814420497246649e-9 ], - "timestamp": 0.24518139616098933 + "timestamp": 0.24518139616098938 }, { - "x": 2.782852396812763, - "y": 1.328884446363913, - "heading": 3.1413904302531392, - "angularVelocity": -0.00033384199633377203, + "x": 2.782852396813364, + "y": 1.3288844463639362, + "heading": 3.1413904302531397, + "angularVelocity": -0.00033384199633044927, "velocityX": 4.50752459870562, - "velocityY": -0.47919591040144593, + "velocityY": -0.4791959104014461, "moduleForcesX": [ - -2.8808071498004513e-10, - 2.7319951370204496e-10, - -2.8794927631594204e-10, - 2.733309522445748e-10 + -2.8803563446343644e-10, + 2.7306834504483674e-10, + -2.8790426266076945e-10, + 2.7319971672592943e-10 ], "moduleForcesY": [ - 2.1869323715156544e-10, - 2.1882467936106666e-10, - -3.4258700998575654e-10, - -3.4245556750246296e-10 + 2.1870178685671868e-10, + 2.1883316220478742e-10, + -3.424022111068235e-10, + -3.4227083548495593e-10 ], - "timestamp": 0.32690852821465244 + "timestamp": 0.3269085282146525 }, { - "x": 3.1512394549262512, - "y": 1.289721138915009, - "heading": 3.1413631463036533, - "angularVelocity": -0.000333842003262993, + "x": 3.1512394549258516, + "y": 1.2897211389149879, + "heading": 3.1413631463036538, + "angularVelocity": -0.00033384200326365063, "velocityX": 4.507524598705565, - "velocityY": -0.47919591040160886, + "velocityY": -0.4791959104016092, "moduleForcesX": [ - -2.9425289616999354e-10, - 2.6972600228707847e-10, - -2.943766041628635e-10, - 2.6960229431046965e-10 + -2.945523994192452e-10, + 2.697504660509287e-10, + -2.946761066760521e-10, + 2.6962675881038304e-10 ], "moduleForcesY": [ - 2.4512765070974995e-10, - 2.4500394281245953e-10, - -3.188512480187098e-10, - -3.189749559340506e-10 + 2.4525625397135997e-10, + 2.4513254681013373e-10, + -3.1904661177020595e-10, + -3.191703189494828e-10 ], - "timestamp": 0.40863566026831555 + "timestamp": 0.4086356602683156 }, { - "x": 3.51962651304027, - "y": 1.250557831466011, - "heading": 3.1413358623536007, - "angularVelocity": -0.000333842010196935, + "x": 3.5196265130398467, + "y": 1.2505578314660648, + "heading": 3.1413358623536016, + "angularVelocity": -0.0003338420101929837, "velocityX": 4.507524598705517, - "velocityY": -0.4791959104017224, + "velocityY": -0.47919591040172266, "moduleForcesX": [ - -2.9319524605502616e-10, - 2.7116789785781755e-10, - -2.9334050125477524e-10, - 2.7102264266190907e-10 + -2.9283289574986723e-10, + 2.7115512516572705e-10, + -2.929781114118843e-10, + 2.7100990950755063e-10 ], "moduleForcesY": [ - 2.565256487745166e-10, - 2.5638039353513226e-10, - -3.0783749498208265e-10, - -3.0798275019898476e-10 + 2.5635051689420785e-10, + 2.5620530119255553e-10, + -3.0763750386514194e-10, + -3.0778271954431195e-10 ], - "timestamp": 0.49036279232197866 + "timestamp": 0.4903627923219787 }, { - "x": 3.8880135711533463, - "y": 1.2113945240170787, - "heading": 3.141308578402982, - "angularVelocity": -0.0003338420171260208, + "x": 3.8880135711535515, + "y": 1.2113945240170145, + "heading": 3.1413085784029833, + "angularVelocity": -0.00033384201712058706, "velocityX": 4.507524598705524, - "velocityY": -0.4791959104013023, + "velocityY": -0.47919591040130255, "moduleForcesX": [ - -2.8017365622927923e-10, - 2.8379423080040176e-10, - -2.803342617801993e-10, - 2.8363362524959436e-10 + -2.80192725101816e-10, + 2.836545029382628e-10, + -2.803532608136775e-10, + 2.83493967226514e-10 ], "moduleForcesY": [ - 3.7727704785442104e-10, - 3.771164423033856e-10, - -1.8669083917433548e-10, - -1.8685144472525347e-10 + 3.772119807760254e-10, + 3.770514450640486e-10, + -1.8663524726312927e-10, + -1.867957829749886e-10 ], - "timestamp": 0.5720899243756418 + "timestamp": 0.5720899243756419 }, { - "x": 4.256400629267179, - "y": 1.1722312165687208, - "heading": 3.1412812944517974, - "angularVelocity": -0.00033384202405161144, + "x": 4.256400629267131, + "y": 1.1722312165687518, + "heading": 3.1412812944517987, + "angularVelocity": -0.00033384202405156797, "velocityX": 4.507524598706256, - "velocityY": -0.4791959103940783, + "velocityY": -0.47919591039407844, "moduleForcesX": [ - -1.1601533840227877e-10, - 4.476680699088195e-10, - -1.1619133319256263e-10, - 4.474920751185415e-10 + -1.1635902338158833e-10, + 4.477631051174233e-10, + -1.165351535479574e-10, + 4.475869749510601e-10 ], "moduleForcesY": [ - 1.9191264638326385e-9, - 1.918950469047209e-9, - 1.3554430555132117e-9, - 1.3552670607222244e-9 + 1.9193651862238043e-9, + 1.9191890560622896e-9, + 1.3552430577164645e-9, + 1.3550669275493915e-9 ], - "timestamp": 0.6538170564293049 + "timestamp": 0.653817056429305 }, { - "x": 4.624787687381106, - "y": 1.1330679091280322, - "heading": 3.1412540105000466, - "angularVelocity": -0.00033384203097612254, + "x": 4.6247876873816365, + "y": 1.1330679091279792, + "heading": 3.141254010500048, + "angularVelocity": -0.00033384203097711876, "velocityX": 4.507524598716221, - "velocityY": -0.4791959103000003, + "velocityY": -0.4791959103000007, "moduleForcesX": [ - 1.9765770134900176e-9, - 2.5401725437966218e-9, - 1.976385590478481e-9, - 2.5399811207741598e-9 + 1.9765153355534307e-9, + 2.5401954963740974e-9, + 1.976323873007331e-9, + 2.5400040338170728e-9 ], "moduleForcesY": [ - 2.1602981176742383e-8, - 2.1602789753868992e-8, - 2.1039385646053967e-8, - 2.1039194223054364e-8 + 2.160298396904306e-8, + 2.16027925066351e-8, + 2.103930380784058e-8, + 2.103911234530641e-8 ], - "timestamp": 0.735544188482968 + "timestamp": 0.7355441884829681 }, { - "x": 4.993174745507101, - "y": 1.093904601785636, - "heading": 3.14122672654773, - "angularVelocity": -0.00033384203790308084, + "x": 4.993174745506862, + "y": 1.0939046017857066, + "heading": 3.1412267265477314, + "angularVelocity": -0.00033384203789967075, "velocityX": 4.507524598844053, - "velocityY": -0.4791959090972083, + "velocityY": -0.47919590909720844, "moduleForcesX": [ - 2.868929446678408e-8, - 2.9253089173942963e-8, - 2.868908394171876e-8, - 2.9252878648747433e-8 + 2.8689184983444446e-8, + 2.9252621055977716e-8, + 2.8688974602268402e-8, + 2.925241067467146e-8 ], "moduleForcesY": [ - 2.728733268257027e-7, - 2.7287311630124865e-7, - 2.723095321160976e-7, - 2.723093215911679e-7 + 2.7287318449784567e-7, + 2.72872974117281e-7, + 2.723097484228662e-7, + 2.723095380418258e-7 ], - "timestamp": 0.8172713205366311 + "timestamp": 0.8172713205366312 }, { - "x": 5.361561803764487, - "y": 1.0547412956983473, - "heading": 3.1411994425948473, - "angularVelocity": -0.0003338420448259796, + "x": 5.361561803764377, + "y": 1.0547412956983293, + "heading": 3.1411994425948486, + "angularVelocity": -0.0003338420448248998, "velocityX": 4.507524600476514, - "velocityY": -0.47919589374122556, + "velocityY": -0.4791958937412259, "moduleForcesX": [ - 3.696865577304178e-7, - 3.702500219545937e-7, - 3.6968613763840057e-7, - 3.702496018625516e-7 + 3.696867015506992e-7, + 3.7025035543909504e-7, + 3.696862813689362e-7, + 3.702499352573073e-7 ], "moduleForcesY": [ - 0.0000034804410489130244, - 0.0000034804406288175047, - 0.000003479877584702018, - 0.0000034798771646076077 + 0.0000034804411290891762, + 0.00000348044070890391, + 0.0000034798774752139487, + 0.0000034798770550297925 ], - "timestamp": 0.8989984525902942 + "timestamp": 0.8989984525902943 }, { - "x": 5.729948863726285, - "y": 1.015578005631815, - "heading": 3.1411721586413393, - "angularVelocity": -0.00033384205247850694, - "velocityX": 4.507524621316063, - "velocityY": -0.47919569771268744, + "x": 5.729948863726064, + "y": 1.0155780056318247, + "heading": 3.141172158641341, + "angularVelocity": -0.0003338420524782025, + "velocityX": 4.507524621316062, + "velocityY": -0.4791956977126878, "moduleForcesX": [ - 0.000004722605910888902, - 0.000004723228755826117, - 0.000004722593901597685, - 0.000004723216746540372 + 0.000004722605717249217, + 0.000004723228625294551, + 0.000004722593707959265, + 0.00000472321661601007 ], "moduleForcesY": [ - 0.00004442668313336451, - 0.00004442667112405076, - 0.00004442606028868228, - 0.00004442604827933517 + 0.000044426683151454254, + 0.00004442667114214177, + 0.00004442606024366391, + 0.000044426048234318074 ], - "timestamp": 0.9807255846439573 + "timestamp": 0.9807255846439574 }, { - "x": 6.098335944993547, - "y": 0.9764149201272616, - "heading": 3.141144873733055, - "angularVelocity": -0.0003338537349670905, - "velocityX": 4.507524882009698, - "velocityY": -0.4791931947257305, + "x": 6.098335944993564, + "y": 0.9764149201272568, + "heading": 3.1411448737330567, + "angularVelocity": -0.00033385373496601367, + "velocityX": 4.507524882009697, + "velocityY": -0.47919319472573085, "moduleForcesX": [ - 0.000058606608936925306, - 0.00005955746287124728, - 0.00005860564622522572, - 0.00005955650005937791 + 0.000058606609209525885, + 0.00005955746308098625, + 0.000058605646496038295, + 0.000059556500267328035 ], "moduleForcesY": [ - 0.0005677331808062003, - 0.0005677322177464595, - 0.0005667823272709411, - 0.0005667813645585504 + 0.0005677331807728031, + 0.0005677322177112738, + 0.000566782327300406, + 0.0005667813645862271 ], - "timestamp": 1.0624527166976203 + "timestamp": 1.0624527166976205 }, { - "x": 6.466713606551941, - "y": 0.9372554763119637, - "heading": 3.1411027380347774, - "angularVelocity": -0.0005155656049507016, + "x": 6.46671360655173, + "y": 0.9372554763119341, + "heading": 3.1411027380347787, + "angularVelocity": -0.0005155656049492363, "velocityX": 4.50740962396997, - "velocityY": -0.4791486356035406, + "velocityY": -0.47914863560354054, "moduleForcesX": [ - -0.033512437082181865, - -0.018722651292121043, - -0.03351970042077828, - -0.01872991270097043 + -0.03351243708215853, + -0.018722651292127624, + -0.03351970042075507, + -0.01872991270097627 ], "moduleForcesY": [ - 0.017497044920547423, - 0.01748978512288604, - 0.0027072770317358424, - 0.002700008527818997 + 0.017497044920615233, + 0.017489785122957475, + 0.002707277031841645, + 0.0027000085279199264 ], - "timestamp": 1.1441798487512833 + "timestamp": 1.1441798487512838 }, { - "x": 6.801579450679335, - "y": 0.9016550002248332, - "heading": 3.1232438571056225, - "angularVelocity": -0.21851838527048875, + "x": 6.801579450679561, + "y": 0.9016550002248982, + "heading": 3.12324385710561, + "angularVelocity": -0.21851838527065992, "velocityX": 4.097364433494548, - "velocityY": -0.4356016807700555, + "velocityY": -0.43560168077005584, "moduleForcesX": [ - -93.69834450297687, - -89.01513972710934, - -96.03922536165108, - -92.96495477245452 + -93.69834450297753, + -89.01513972710512, + -96.03922536165277, + -92.96495477245534 ], "moduleForcesY": [ - 22.28341658989289, - 29.051835313736024, - -4.744060783787519, - -7.114634103996269 + 22.28341658989852, + 29.051835313755163, + -4.744060783792586, + -7.114634104016339 ], - "timestamp": 1.2259069808049463 + "timestamp": 1.225906980804947 }, { - "x": 7.099346531012958, - "y": 0.8699987853286542, - "heading": 3.106691367168923, - "angularVelocity": -0.20253359589115869, - "velocityX": 3.6434299461030673, - "velocityY": -0.3873403373002619, + "x": 7.099346531013058, + "y": 0.869998785328631, + "heading": 3.1066913671689087, + "angularVelocity": -0.20253359589117298, + "velocityX": 3.6434299461030677, + "velocityY": -0.38734033730026224, "moduleForcesX": [ - -102.99949769077502, - -103.02513937963398, - -102.72151509322181, - -102.75841208178751 + -102.99949769077611, + -103.02513937963529, + -102.72151509322009, + -102.75841208178622 ], "moduleForcesY": [ - 9.727922777809646, - 9.578030116265486, - 12.328637537836405, - 12.115694391256039 + 9.727922777797522, + 9.578030116252217, + 12.328637537850282, + 12.115694391267553 ], - "timestamp": 1.3076341128586093 + "timestamp": 1.3076341128586102 }, { - "x": 7.359936597959423, - "y": 0.8422950114060971, - "heading": 3.0919308976796085, - "angularVelocity": -0.18060672286435264, + "x": 7.359936597959464, + "y": 0.8422950114061555, + "heading": 3.0919308976795943, + "angularVelocity": -0.18060672286435828, "velocityX": 3.1885380093254865, - "velocityY": -0.33897890732615193, + "velocityY": -0.3389789073261522, "moduleForcesX": [ - -103.27059619944963, - -103.29104696246749, - -102.8854236951988, - -102.92545257425414 + -103.2705961994497, + -103.29104696246755, + -102.88542369519871, + -102.92545257425405 ], "moduleForcesY": [ - 9.261942170050276, - 9.123903472256336, - 12.8564729825216, - 12.59869747011876 + 9.261942170049517, + 9.123903472255591, + 12.856472982522407, + 12.59869747011948 ], - "timestamp": 1.3893612449122723 + "timestamp": 1.3893612449122734 }, { - "x": 7.58332287276895, - "y": 0.8185464774785829, - "heading": 3.0791309749028772, - "angularVelocity": -0.1566177896506479, - "velocityX": 2.733318412085363, - "velocityY": -0.29058322898184225, + "x": 7.58332287276877, + "y": 0.818546477478533, + "heading": 3.079130974902868, + "angularVelocity": -0.15661778965058812, + "velocityX": 2.7333184120853633, + "velocityY": -0.2905832289818426, "moduleForcesX": [ - -103.36594951172025, - -103.38028751192688, - -102.94365368980282, - -102.97966227585505 + -103.3659495117207, + -103.38028751192735, + -102.94365368980209, + -102.97966227585444 ], "moduleForcesY": [ - 9.079616014969533, - 8.984237326802269, - 13.023827383874401, - 12.784382494043633 + 9.079616014964232, + 8.984237326796942, + 13.023827383880123, + 12.78438249404854 ], - "timestamp": 1.4710883769659353 + "timestamp": 1.4710883769659366 }, { - "x": 7.769491837116803, - "y": 0.7987545966176683, - "heading": 3.0683771471345906, - "angularVelocity": -0.1315821012931888, - "velocityX": 2.277933406815666, - "velocityY": -0.24217026051927823, + "x": 7.7694918371165045, + "y": 0.7987545966176534, + "heading": 3.0683771471345858, + "angularVelocity": -0.1315821012931304, + "velocityX": 2.277933406815667, + "velocityY": -0.2421702605192785, "moduleForcesX": [ -103.41515460878193, - -103.42443760342492, - -102.97433378125582, - -103.005574093989 + -103.4244376034249, + -102.97433378125584, + -103.00557409398901 ], "moduleForcesY": [ - 8.976218196001655, - 8.923469974360179, - 13.099124861119694, - 12.88892417371863 + 8.976218196001748, + 8.923469974360286, + 13.099124861119599, + 12.888924173718566 ], - "timestamp": 1.5528155090195983 + "timestamp": 1.5528155090195999 }, { - "x": 7.918435339366071, - "y": 0.7829202209960606, - "heading": 3.0597211380125815, - "angularVelocity": -0.10591353084953188, - "velocityX": 1.8224486594111562, - "velocityY": -0.19374686500967267, + "x": 7.918435339365923, + "y": 0.7829202209960395, + "heading": 3.0597211380125793, + "angularVelocity": -0.10591353084949826, + "velocityX": 1.8224486594111566, + "velocityY": -0.19374686500967284, "moduleForcesX": [ - -103.44532754676128, - -103.45059106507556, - -102.99353139152261, - -103.02046917509142 + -103.44532754676109, + -103.45059106507539, + -102.9935313915229, + -103.02046917509165 ], "moduleForcesY": [ - 8.908204125136255, - 8.89210265995939, - 13.139438738048499, - 12.957444097698344 + 8.908204125138308, + 8.892102659961388, + 13.139438738046369, + 12.957444097696476 ], - "timestamp": 1.6345426410732613 + "timestamp": 1.634542641073263 }, { - "x": 8.030147928353161, - "y": 0.7710439205191237, + "x": 8.030147928353294, + "y": 0.7710439205191398, "heading": 3.053197581935371, - "angularVelocity": -0.07982117949430736, - "velocityX": 1.3668972124774883, - "velocityY": -0.14531649622907394, + "angularVelocity": -0.07982117949428515, + "velocityX": 1.3668972124774887, + "velocityY": -0.14531649622907405, "moduleForcesX": [ - -103.46568344315243, - -103.46789643910462, - -103.00664909946575, - -103.03015522294537 + -103.46568344315234, + -103.46789643910454, + -103.00664909946587, + -103.03015522294548 ], "moduleForcesY": [ - 8.86063249043144, - 8.873193949089648, - 13.164397740662087, - 13.00528690977233 + 8.860632490432424, + 8.873193949090584, + 13.164397740661096, + 13.005286909771451 ], - "timestamp": 1.7162697731269243 + "timestamp": 1.7162697731269263 }, { - "x": 8.104625702260256, - "y": 0.7631261031139874, + "x": 8.10462570226017, + "y": 0.7631261031139884, "heading": 3.0488312843564214, - "angularVelocity": -0.053425312613233654, - "velocityX": 0.9112980234968839, - "velocityY": -0.09688113611971519, + "angularVelocity": -0.05342531261322825, + "velocityX": 0.911298023496884, + "velocityY": -0.09688113611971526, "moduleForcesX": [ - -103.48021692002517, - -103.48030657193449, - -103.01600852054571, - -103.03713171986256 + -103.48021692002504, + -103.48030657193438, + -103.01600852054591, + -103.03713171986273 ], "moduleForcesY": [ - 8.826978887492562, - 8.859337121264703, - 13.18260602174957, - 13.039113841379665 + 8.826978887494013, + 8.859337121266073, + 13.182606021748102, + 13.039113841378352 ], - "timestamp": 1.7979969051805873 + "timestamp": 1.7979969051805895 }, { - "x": 8.14186573028563, - "y": 0.7591670751571251, + "x": 8.14186573028574, + "y": 0.7591670751571266, "heading": 3.0466408807888117, - "angularVelocity": -0.02680142460120989, - "velocityX": 0.4556629737236343, - "velocityY": -0.04844202723516076, + "angularVelocity": -0.026801424601212133, + "velocityX": 0.4556629737236342, + "velocityY": -0.04844202723516079, "moduleForcesX": [ - -103.490940054563, - -103.4898092444739, - -103.0227710663496, - -103.04265219867469 + -103.49094005456293, + -103.48980924447385, + -103.02277106634969, + -103.04265219867477 ], "moduleForcesY": [ - 8.803943328885603, - 8.846770557986561, - 13.198440061449329, - 13.062280295237983 + 8.803943328886316, + 8.846770557987233, + 13.198440061448613, + 13.062280295237343 ], - "timestamp": 1.8797240372342503 + "timestamp": 1.8797240372342527 }, { "x": 8.141865730285645, "y": 0.7591670751571655, "heading": 3.0466408807888117, - "angularVelocity": -2.2162561306828634e-18, - "velocityX": 6.0719591465516605e-18, - "velocityY": 3.7191933332762756e-19, + "angularVelocity": -2.216413397491607e-18, + "velocityX": 6.071801473157301e-18, + "velocityY": 3.719160099439509e-19, "moduleForcesX": [ -103.49897514652822, - -103.497512630357, - -103.02758277721088, - -103.04741586769943 + -103.49751263035701, + -103.02758277721087, + -103.04741586769941 ], "moduleForcesY": [ - 8.789691125263571, - 8.833386151441184, - 13.214354544577951, - 13.076647990366267 + 8.789691125263493, + 8.833386151441111, + 13.214354544578041, + 13.076647990366352 ], - "timestamp": 1.9614511692879133 + "timestamp": 1.961451169287916 }, { "x": 8.12139177192427, - "y": 0.7686524008245413, - "heading": 3.056527253089306, - "angularVelocity": 0.15490715137698402, - "velocityX": -0.3208014497909542, - "velocityY": 0.14862324969723603, + "y": 0.7686524008245414, + "heading": 3.0565272530893055, + "angularVelocity": 0.15490715137698394, + "velocityX": -0.32080144979095415, + "velocityY": 0.14862324969723617, "moduleForcesX": [ - -98.54262377114843, - -100.4770509117282, - -82.79137566578632, - -90.59657531971158 + -98.54262377114841, + -100.47705091172818, + -82.7913756657863, + -90.59657531971156 ], "moduleForcesY": [ - 32.73797497154649, - 26.30090387431019, - 62.69281274939932, - 50.800045948114445 + 32.737974971546535, + 26.300903874310222, + 62.69281274939936, + 50.80004594811448 ], - "timestamp": 2.0252724468248977 + "timestamp": 2.0252724468249004 }, { "x": 8.080660351142782, "y": 0.7880598204655119, "heading": 3.076375749087686, - "angularVelocity": 0.31100123288629355, - "velocityX": -0.638210677589206, - "velocityY": 0.30409011523976287, + "angularVelocity": 0.31100123288629333, + "velocityX": -0.6382106775892058, + "velocityY": 0.304090115239763, "moduleForcesX": [ -97.51013510987994, - -100.05875562562483, - -81.09999788338129, + -100.05875562562481, + -81.09999788338128, -89.80082050059022 ], "moduleForcesY": [ - 35.64906123251604, - 27.807073480632145, + 35.64906123251607, + 27.807073480632162, 64.84604210021749, - 52.17408445205142 + 52.174084452051424 ], - "timestamp": 2.089093724361882 + "timestamp": 2.089093724361885 }, { - "x": 8.019993961475123, + "x": 8.019993961475121, "y": 0.8180013901296872, "heading": 3.1062742720333283, - "angularVelocity": 0.46847264892677243, - "velocityX": -0.9505668330206076, - "velocityY": 0.46914713743898434, + "angularVelocity": 0.46847264892677226, + "velocityX": -0.9505668330206073, + "velocityY": 0.4691471374389845, "moduleForcesX": [ - -95.83367751055793, + -95.83367751055792, -99.42042191041061, - -78.67293358001308, + -78.67293358001307, -88.676734166875 ], "moduleForcesY": [ - 39.87717934463128, - 29.95217527604755, - 67.74395166278366, - 54.03584566132871 + 39.8771793446313, + 29.952175276047576, + 67.74395166278367, + 54.03584566132872 ], - "timestamp": 2.1529150018988665 + "timestamp": 2.152915001898869 }, { - "x": 7.9399197688128345, + "x": 7.939919768812834, "y": 0.8593922232548926, "heading": 3.1463376298650596, - "angularVelocity": 0.627742962502038, - "velocityX": -1.2546629549351198, - "velocityY": 0.6485428484445409, + "angularVelocity": 0.6277429625020375, + "velocityX": -1.2546629549351196, + "velocityY": 0.6485428484445411, "moduleForcesX": [ - -92.88000464654638, + -92.88000464654637, -98.30849263529356, -74.94629470181758, -86.88017977205095 ], "moduleForcesY": [ - 46.26239074940662, - 33.34169675064432, + 46.262390749406656, + 33.34169675064433, 71.8090336983567, - 56.841332870312876 + 56.84133287031288 ], - "timestamp": 2.216736279435851 + "timestamp": 2.2167362794358536 }, { - "x": 7.84143071939511, + "x": 7.841430719395109, "y": 0.9137307885891377, - "heading": 3.1967482621269068, - "angularVelocity": 0.7898718767049805, - "velocityX": -1.5432008449008328, - "velocityY": 0.8514177000414278, + "heading": 3.196748262126907, + "angularVelocity": 0.78987187670498, + "velocityX": -1.5432008449008323, + "velocityY": 0.8514177000414281, "moduleForcesX": [ - -86.89087334993594, - -95.98833796115419, + -86.89087334993593, + -95.98833796115417, -68.54914547471209, - -83.52558618270564 + -83.52558618270562 ], "moduleForcesY": [ - 56.60723624372076, - 39.41093811953867, + 56.6072362437208, + 39.4109381195387, 77.88580562900931, - 61.606619602131445 + 61.60661960213146 ], - "timestamp": 2.2805575569728354 + "timestamp": 2.280557556972838 }, { - "x": 7.726890294226319, + "x": 7.726890294226318, "y": 0.9837916600371955, - "heading": 3.2578934429620614, - "angularVelocity": 0.9580688948089633, - "velocityX": -1.794705928636651, - "velocityY": 1.097766672054747, + "heading": 3.257893442962062, + "angularVelocity": 0.9580688948089631, + "velocityX": -1.7947059286366505, + "velocityY": 1.0977666720547472, "moduleForcesX": [ - -71.52639870627524, - -89.45838724827226, - -55.36209082390232, - -75.61692556289127 + -71.5263987062752, + -89.45838724827225, + -55.36209082390229, + -75.61692556289125 ], "moduleForcesY": [ - 74.9291777122655, - 52.39133519711495, - 87.66530845618459, - 70.99242409781272 + 74.92917771226554, + 52.39133519711497, + 87.6653084561846, + 70.99242409781274 ], - "timestamp": 2.3443788345098198 + "timestamp": 2.3443788345098224 }, { - "x": 7.604447006986396, - "y": 1.0748288274783149, + "x": 7.604447006986394, + "y": 1.0748288274783147, "heading": 3.330112940587566, - "angularVelocity": 1.1315896580674487, - "velocityX": -1.9185339429936596, - "velocityY": 1.4264391274267907, + "angularVelocity": 1.1315896580674483, + "velocityX": -1.9185339429936592, + "velocityY": 1.426439127426791, "moduleForcesX": [ - -19.766010110953378, + -19.766010110953335, -56.93061698323477, - -19.68184871481916, + -19.68184871481914, -47.36930602917605 ], "moduleForcesY": [ 101.47075361978412, - 86.34001229995955, - 101.64986956083462, + 86.34001229995954, + 101.6498695608346, 92.08417613875184 ], - "timestamp": 2.408200112046804 + "timestamp": 2.408200112046807 }, { - "x": 7.496600987086121, - "y": 1.1832751788415659, + "x": 7.49660098708612, + "y": 1.1832751788415656, "heading": 3.4049089717941157, - "angularVelocity": 1.171960733051846, - "velocityX": -1.689812928576642, - "velocityY": 1.6992193755508294, + "angularVelocity": 1.1719607330518458, + "velocityX": -1.6898129285766412, + "velocityY": 1.6992193755508296, "moduleForcesX": [ - 70.7545238307989, + 70.75452383079893, 67.2502135728131, - 65.69679627017268, - 61.81300803108725 + 65.69679627017267, + 61.81300803108722 ], "moduleForcesY": [ - 75.40519753122972, + 75.4051975312297, 78.49699682759936, 79.87907669757777, - 82.88015487947983 + 82.88015487947986 ], - "timestamp": 2.4720213895837886 + "timestamp": 2.4720213895837913 }, { "x": 7.410809145133341, - "y": 1.2972469395306558, + "y": 1.2972469395306556, "heading": 3.4754003948557055, - "angularVelocity": 1.1045128800616704, - "velocityX": -1.3442514042916571, - "velocityY": 1.7857956638840902, + "angularVelocity": 1.1045128800616708, + "velocityX": -1.3442514042916565, + "velocityY": 1.7857956638840904, "moduleForcesX": [ 98.62488839987037, 98.5728623639948, 102.14680103093937, - 101.80621253364352 + 101.8062125336435 ], "moduleForcesY": [ - 31.723120096729687, - 32.017438994516304, - 17.325158702635157, - 19.43778678310921 + 31.723120096729684, + 32.0174389945163, + 17.32515870263519, + 19.437786783109235 ], - "timestamp": 2.535842667120773 + "timestamp": 2.5358426671207757 }, { - "x": 7.347703161601463, - "y": 1.4119343387372154, + "x": 7.347703161601462, + "y": 1.4119343387372152, "heading": 3.5395016960037164, - "angularVelocity": 1.0043876215242498, - "velocityX": -0.9887922330496858, - "velocityY": 1.797008828914432, + "angularVelocity": 1.00438762152425, + "velocityX": -0.9887922330496852, + "velocityY": 1.7970088289144321, "moduleForcesX": [ 103.21492466040641, 102.5340444041503, 103.15479218615785, - 103.73684891651338 + 103.7368489165134 ], "moduleForcesY": [ - 10.084977865190455, - 15.81269263577463, - -10.857317716288517, - -2.0233662096521496 + 10.084977865190448, + 15.812692635774624, + -10.857317716288497, + -2.02336620965214 ], - "timestamp": 2.5996639446577574 + "timestamp": 2.59966394465776 }, { - "x": 7.307225519445186, - "y": 1.5251286705269973, - "heading": 3.5964095924585773, - "angularVelocity": 0.8916759214336103, - "velocityX": -0.6342342823335027, - "velocityY": 1.7736143204620987, + "x": 7.307225519445185, + "y": 1.525128670526997, + "heading": 3.5964095924585777, + "angularVelocity": 0.8916759214336106, + "velocityX": -0.6342342823335022, + "velocityY": 1.7736143204620993, "moduleForcesX": [ 103.74866093971778, 103.44945570252287, @@ -749,41 +749,41 @@ 103.26271541637972 ], "moduleForcesY": [ - -1.704103468345933, - 8.460590728388368, - -23.303196470017358, - -10.611189708777841 + -1.7041034683459535, + 8.46059072838836, + -23.303196470017355, + -10.611189708777834 ], - "timestamp": 2.663485222194742 + "timestamp": 2.6634852221947445 }, { "x": 7.289250021057145, - "y": 1.6355954194055542, + "y": 1.635595419405554, "heading": 3.6457195990819606, - "angularVelocity": 0.7726264425654572, - "velocityX": -0.28165369108482585, - "velocityY": 1.730876490439123, + "angularVelocity": 0.7726264425654574, + "velocityX": -0.2816536910848256, + "velocityY": 1.7308764904391236, "moduleForcesX": [ 103.3950377520685, 103.7321422456981, - 99.41424789462361, + 99.4142478946236, 102.75753546713821 ], "moduleForcesY": [ - -9.12218556394263, - 4.334969983631569, - -29.912958244672346, + -9.122185563942644, + 4.334969983631551, + -29.912958244672343, -14.912737262065388 ], - "timestamp": 2.7273064997317262 + "timestamp": 2.727306499731729 }, { "x": 7.293661117553711, "y": 1.7425522804260254, "heading": 3.687185307179586, - "angularVelocity": 0.649716046088176, - "velocityX": 0.06911639294606202, - "velocityY": 1.675880915396745, + "angularVelocity": 0.6497160460881763, + "velocityX": 0.06911639294606219, + "velocityY": 1.6758809153967456, "moduleForcesX": [ 102.83835381995104, 103.82690448841359, @@ -791,2243 +791,2222 @@ 102.38468452490544 ], "moduleForcesY": [ - -14.237709698132518, - 1.6908860682116789, + -14.237709698132527, + 1.6908860682116629, -33.90397753188714, - -17.391714316675273 + -17.39171431667528 ], - "timestamp": 2.7911277772687106 + "timestamp": 2.7911277772687133 }, { - "x": 7.337238709014604, - "y": 1.87500903823816, - "heading": 3.7276018871038197, - "angularVelocity": 0.4861440875001379, - "velocityX": 0.5241657873061937, - "velocityY": 1.5932340089270574, + "x": 7.337238709014603, + "y": 1.8750090382381601, + "heading": 3.7276018871038192, + "angularVelocity": 0.4861440875001382, + "velocityX": 0.5241657873061938, + "velocityY": 1.593234008927058, "moduleForcesX": [ - 102.26407313635566, - 103.87008588403226, + 102.26407313635565, + 103.87008588403228, 97.23651288613812, 102.14881136766725 ], "moduleForcesY": [ - -18.1167751960945, - -0.13662685931345306, - -36.523872030709605, - -18.873918995735348 + -18.116775196094515, + -0.13662685931346932, + -36.52387203070962, + -18.873918995735366 ], - "timestamp": 2.874264816190781 + "timestamp": 2.8742648161907836 }, { - "x": 7.418144617115574, - "y": 1.9984157113823813, + "x": 7.418144617115573, + "y": 1.9984157113823817, "heading": 3.7537024581651615, - "angularVelocity": 0.3139463637357569, - "velocityX": 0.973163215216371, - "velocityY": 1.4843765756427652, + "angularVelocity": 0.31394636373575724, + "velocityX": 0.9731632152163713, + "velocityY": 1.4843765756427656, "moduleForcesX": [ - 100.52939508517865, - 103.73438246873789, - 94.67434050174212, + 100.52939508517862, + 103.7343824687379, + 94.67434050174211, 101.1881258515662 ], "moduleForcesY": [ - -25.98258070015821, - -4.920905115133015, - -42.6869167197914, - -23.418429128288864 + -25.98258070015823, + -4.920905115133046, + -42.68691671979141, + -23.41842912828889 ], - "timestamp": 2.957401855112851 + "timestamp": 2.957401855112854 }, { "x": 7.535048231941541, - "y": 2.108654455088382, + "y": 2.1086544550883826, "heading": 3.764158105558933, - "angularVelocity": 0.12576400999285073, - "velocityX": 1.4061556237954207, - "velocityY": 1.32598833366359, + "angularVelocity": 0.12576400999285112, + "velocityX": 1.406155623795421, + "velocityY": 1.3259883336635903, "moduleForcesX": [ - 95.63931861838329, - 102.78237917887598, + 95.63931861838326, + 102.78237917887597, 88.81788214328411, 98.62371306642002 ], "moduleForcesY": [ - -40.31051152213473, - -14.596292935414386, - -53.76177775288337, - -32.47987077107174 + -40.31051152213476, + -14.596292935414418, + -53.761777752883376, + -32.47987077107177 ], - "timestamp": 3.0405388940349214 + "timestamp": 3.040538894034924 }, { "x": 7.682469399516894, "y": 2.196017238119042, - "heading": 3.7560195778482997, - "angularVelocity": -0.09789292253073484, - "velocityX": 1.7732309147255072, - "velocityY": 1.0508286578807635, + "heading": 3.7560195778483, + "angularVelocity": -0.09789292253073449, + "velocityX": 1.7732309147255074, + "velocityY": 1.0508286578807637, "moduleForcesX": [ - 73.74963298837837, + 73.74963298837834, 95.21787023816454, - 69.85213902700369, - 88.30129043115058 + 69.85213902700366, + 88.30129043115056 ], "moduleForcesY": [ - -72.87651101750657, - -41.11318054758713, - -76.71810896892563, - -54.50208420442406 + -72.87651101750659, + -41.11318054758717, + -76.71810896892566, + -54.502084204424094 ], - "timestamp": 3.1236759329569916 + "timestamp": 3.1236759329569943 }, { "x": 7.827046544355028, "y": 2.245170461645328, - "heading": 3.7335207343789736, - "angularVelocity": -0.2706235843979915, + "heading": 3.733520734378974, + "angularVelocity": -0.2706235843979911, "velocityX": 1.7390220617991428, - "velocityY": 0.5912313472261188, + "velocityY": 0.591231347226119, "moduleForcesX": [ - -27.243123321085665, - -4.814624290303508, - -9.68112654908082, - 11.253488323161408 + -27.24312332108567, + -4.8146242903035255, + -9.681126549080819, + 11.253488323161399 ], "moduleForcesY": [ -99.95478411862625, -103.41484563118533, -103.20086487986812, - -103.00188639272085 + -103.00188639272083 ], - "timestamp": 3.206812971879062 + "timestamp": 3.2068129718790646 }, { "x": 7.939432858680839, "y": 2.2728190012561487, - "heading": 3.711795290511636, - "angularVelocity": -0.2613208763389104, - "velocityX": 1.351820028509299, - "velocityY": 0.3325658451311618, + "heading": 3.7117952905116365, + "angularVelocity": -0.2613208763389101, + "velocityX": 1.3518200285092992, + "velocityY": 0.3325658451311619, "moduleForcesX": [ -85.83973955060614, - -85.86349337551788, - -86.67105675311807, - -86.682687450033 + -85.86349337551786, + -86.67105675311805, + -86.68268745003297 ], "moduleForcesY": [ - -58.26066678399723, - -58.230272160397995, - -57.01652209858838, - -57.003560508651326 + -58.260666783997245, + -58.230272160398, + -57.0165220985884, + -57.003560508651354 ], - "timestamp": 3.289950010801132 + "timestamp": 3.289950010801135 }, { "x": 8.015204219703966, - "y": 2.2879711195258747, + "y": 2.287971119525875, "heading": 3.695746234916774, - "angularVelocity": -0.1930433871948052, - "velocityX": 0.9114031724674717, - "velocityY": 0.1822547262469813, + "angularVelocity": -0.19304338719480513, + "velocityX": 0.9114031724674719, + "velocityY": 0.18225472624698136, "moduleForcesX": [ -96.75469117814397, -96.05837459678298, -100.23022297352226, - -99.43633676223166 + -99.43633676223165 ], "moduleForcesY": [ -37.62667070086972, - -39.39983844031861, - -27.05066205494617, - -29.87331421433262 + -39.39983844031862, + -27.050662054946198, + -29.873314214332638 ], - "timestamp": 3.3730870497232024 + "timestamp": 3.373087049723205 }, { "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -0.10222248797976585, - "velocityX": 0.458089926796231, - "velocityY": 0.07860746516215023, + "angularVelocity": -0.10222248797976584, + "velocityX": 0.4580899267962311, + "velocityY": 0.07860746516215021, "moduleForcesX": [ -99.99595652451094, -98.93838085703482, - -102.93566476550784, + -102.93566476550782, -102.1023037702812 ], "moduleForcesY": [ - -28.01425430205255, + -28.014254302052557, -31.58059735167417, - -13.749709895364493, - -19.02119979206612 + -13.749709895364512, + -19.021199792066128 ], - "timestamp": 3.4562240886452726 + "timestamp": 3.4562240886452753 }, { "x": 8.053288459777832, "y": 2.294506311416626, "heading": 3.687247759954889, - "angularVelocity": -2.2487070096555965e-24, - "velocityX": -6.586009418122838e-24, - "velocityY": -6.745594827234793e-23, + "angularVelocity": 4.746550318316871e-18, + "velocityX": 3.830709578831724e-18, + "velocityY": -3.790242714904371e-17, "moduleForcesX": [ - -101.38094391616681, + -101.3809439161668, -100.18837572868954, -103.65752574347157, - -103.00222316967671 + -103.0022231696767 ], "moduleForcesY": [ -22.57602378649472, -27.420895846258933, - -6.612215074301221, - -13.442290586836583 + -6.612215074301234, + -13.442290586836586 ], - "timestamp": 3.539361127567343 + "timestamp": 3.5393611275673456 }, { - "x": 8.042267379204025, - "y": 2.286920400255937, - "heading": 3.6839492904550912, - "angularVelocity": -0.06738828727279574, - "velocityX": -0.22516253183784973, - "velocityY": -0.15498144231857655, + "x": 8.04155600019783, + "y": 2.2900230804484996, + "heading": 3.6835314194357935, + "angularVelocity": -0.07829646151040115, + "velocityX": -0.24718135110639422, + "velocityY": -0.09445343317829462, "moduleForcesX": [ - -90.23310642233936, - -90.46015989642483, - -80.90721847317343, - -79.21224337558162 + -99.51138063972249, + -101.00703312365503, + -92.29762670645609, + -93.00870017418045 ], "moduleForcesY": [ - -51.39622974657535, - -50.96352690092429, - -65.09806908584876, - -67.12671078256284 + -29.683224012710998, + -24.030989118219587, + -47.584016472907386, + -46.13389339344374 ], - "timestamp": 3.5883083501973645 + "timestamp": 3.5868261144569775 }, { - "x": 8.020118260548989, - "y": 2.27191020601647, - "heading": 3.67731157995458, - "angularVelocity": -0.1356095431743696, - "velocityX": -0.452510223561754, - "velocityY": -0.30666079570897453, + "x": 8.018057195518905, + "y": 2.2811494373882057, + "heading": 3.6760894228573657, + "angularVelocity": -0.15678918432512154, + "velocityX": -0.49507660715139173, + "velocityY": -0.18695134325515003, "moduleForcesX": [ - -90.97734104538547, - -91.27768795879761, - -81.73935810599804, - -80.12586427698638 + -99.74002296606275, + -101.19538000468857, + -92.65070099257755, + -93.35296907893509 ], "moduleForcesY": [ - -50.05478323953953, - -49.46918914887244, - -64.04043461006067, - -66.02198916487437 + -28.886290968520573, + -23.19555788366235, + -46.88051907476131, + -45.41738404777075 ], - "timestamp": 3.637255572827386 + "timestamp": 3.6342911013466095 }, { - "x": 7.986720121618324, - "y": 2.2496648858012405, - "heading": 3.667288353892784, - "angularVelocity": -0.20477619614005485, - "velocityX": -0.6823296018879611, - "velocityY": -0.4544756376347613, + "x": 7.982754275427238, + "y": 2.2679916233265414, + "heading": 3.664910946533458, + "angularVelocity": -0.23550994230548836, + "velocityX": -0.7437676148626708, + "velocityY": -0.2772109491597683, "moduleForcesX": [ - -91.82209642527894, - -92.18311514570865, - -82.69994324479192, - -81.15631518014195 + -100.00155441797193, + -101.39729726358, + -93.0583355862382, + -93.72397252125086 ], "moduleForcesY": [ - -48.47312480864625, - -47.74251349400657, - -62.783720018414115, - -64.73759795306572 + -27.944614997839846, + -22.261085973038842, + -46.051832228917284, + -44.62845550001454 ], - "timestamp": 3.6862027954574077 + "timestamp": 3.6817560882362415 }, { - "x": 7.941935287270955, - "y": 2.2204085553192443, - "heading": 3.653826669659306, - "angularVelocity": -0.27502447555055315, - "velocityX": -0.9149617065279765, - "velocityY": -0.5977117578894477, + "x": 7.93560492757735, + "y": 2.250672393954877, + "heading": 3.6499835048582434, + "angularVelocity": -0.31449374904337585, + "velocityX": -0.9933500661146728, + "velocityY": -0.36488431800970306, "moduleForcesX": [ - -92.78130460539496, - -93.19410470384004, - -83.81128188925368, - -82.33220529185469 + -100.29788416314965, + -101.61561762433931, + -93.52735002862231, + -94.13175992251685 ], "moduleForcesY": [ - -46.59314409733099, - -45.71536994844289, - -61.27877787721252, - -63.21917457778012 + -26.834219228647218, + -21.19949127166946, + -45.07503931940974, + -43.74038805618346 ], - "timestamp": 3.7351500180874293 + "timestamp": 3.7292210751258734 }, { - "x": 7.885606145012031, - "y": 2.184410544194298, - "heading": 3.6368654595761822, - "angularVelocity": -0.34652037790435614, - "velocityX": -1.1508138609763638, - "velocityY": -0.7354454285801943, + "x": 7.876561507986373, + "y": 2.2293351295184527, + "heading": 3.6312927818612053, + "angularVelocity": -0.39377916695729515, + "velocityX": -1.2439362877748312, + "velocityY": -0.44953692889872054, "moduleForcesX": [ - -93.87058194700928, - -94.3305748926031, - -85.10140955008177, - -83.69029359301578 + -100.63091275931306, + -101.85325235990693, + -94.0662420635145, + -94.58898722643158 ], "moduleForcesY": [ - -44.33581141832799, - -43.29398533047087, - -59.45771041589864, - -61.39028745543386 + -25.523497466552957, + -19.97371276998484, + -43.91957692503486, + -42.71725731589675 ], - "timestamp": 3.784097240717451 + "timestamp": 3.7766860620155054 }, { - "x": 7.817551278486936, - "y": 2.141999892045337, - "heading": 3.616333715880149, - "angularVelocity": -0.4194669808178373, - "velocityX": -1.3903723820961815, - "velocityY": -0.8664567644528267, + "x": 7.8055701014577625, + "y": 2.204149410872242, + "heading": 3.6088224461535567, + "angularVelocity": -0.4734086572044736, + "velocityX": -1.4956584035616685, + "velocityY": -0.5306167830756522, "moduleForcesX": [ - -95.10628659732889, - -95.61338727553908, - -86.60546294692051, - -85.27779037334444 + -101.00228721734821, + -102.1128986440163, + -94.68559764988736, + -95.11162514377558 ], "moduleForcesY": [ - -41.59126226883808, - -40.34628817483284, - -57.22442878703077, - -59.140688780590104 + -23.969873712700704, + -18.533565956987044, + -42.54396152487971, + -41.509936441328755 ], - "timestamp": 3.8330444633474725 + "timestamp": 3.8241510489051374 }, { - "x": 7.737561088001236, - "y": 2.0935863858643846, - "heading": 3.592148279739013, - "angularVelocity": -0.4941125326751832, - "velocityX": -1.6342130602654035, - "velocityY": -0.9890960830790406, + "x": 7.722569430006346, + "y": 2.1753187660940543, + "heading": 3.5825539547204364, + "angularVelocity": -0.553428814679775, + "velocityX": -1.7486715343285755, + "velocityY": -0.6074086745922084, "moduleForcesX": [ - -96.50269363466799, - -97.06027029285035, - -88.36685045612268, - -87.1547135204852 + -101.412834147822, + -102.3963066503469, + -95.39857355561514, + -95.71983629162236 ], "moduleForcesY": [ - -38.20314229261208, - -36.681729663577826, - -54.43913458067309, - -56.30652630732109 + -22.1146138290831, + -16.80930630512557, + -40.89061643024383, + -40.04973108891953 ], - "timestamp": 3.881991685977494 + "timestamp": 3.8716160357947693 }, { - "x": 7.645393467684546, - "y": 2.03969197754913, - "heading": 3.5642113237831787, - "angularVelocity": -0.5707567141654175, - "velocityX": -1.883000002132083, - "velocityY": -1.1010718365499048, + "x": 7.627489656477081, + "y": 2.1430917308500237, + "heading": 3.552466371319351, + "angularVelocity": -0.63389006028899, + "velocityX": -2.0031560052914554, + "velocityY": -0.6789643768513749, "moduleForcesX": [ - -98.0646712363435, - -98.67496193551976, - -90.43697519136059, - -89.39473189465788 + -101.86129240177104, + -102.70256768115746, + -96.22136667221518, + -96.43893505032159 ], "moduleForcesY": [ - -33.94342733722026, - -32.01865968778751, - -50.89195526213231, - -52.63580008371086 + -19.87450898790123, + -14.701329976881233, + -38.877400569033554, + -38.237873659673255 ], - "timestamp": 3.9309389086075157 + "timestamp": 3.9190810226844013 }, { - "x": 7.540771392641462, - "y": 1.9809991176716732, - "heading": 3.5324080450033617, - "angularVelocity": -0.6497463404657143, - "velocityX": -2.1374466092569384, - "velocityY": -1.1991050099226261, + "x": 7.520251265886663, + "y": 2.1077781488351413, + "heading": 3.5185362794379946, + "angularVelocity": -0.714844648756607, + "velocityX": -2.259315710866347, + "velocityY": -0.7439922419123983, "moduleForcesX": [ - -99.76955042301674, - -100.41971785352567, - -92.86965725890394, - -92.0790529699704 + -102.34147627267791, + -103.02417396799694, + -97.17334997690496, + -97.30003102204127 ], "moduleForcesY": [ - -28.4715548192435, - -25.931723671972655, - -46.25668565248566, - -47.72597287417353 + -17.128069363556765, + -12.063145744424151, + -36.38316192720738, + -35.92745172132362 ], - "timestamp": 3.9798861312375373 + "timestamp": 3.9665460095740332 }, { - "x": 7.423387798901581, - "y": 1.9184271511492825, - "heading": 3.496606398639386, - "angularVelocity": -0.7314336634499311, - "velocityX": -2.3981665850001437, - "velocityY": -1.27835581183747, + "x": 7.400764572383453, + "y": 2.0697740988296585, + "heading": 3.4807380145196527, + "angularVelocity": -0.796339942244816, + "velocityX": -2.51736493201164, + "velocityY": -0.8006754556693165, "moduleForcesX": [ - -101.52272463385668, - -102.1469107017657, - -95.69853790300179, - -95.26536323626863 + -102.83577382732888, + -103.33781837709795, + -98.27583595511979, + -98.33894311574731 ], "moduleForcesY": [ - -21.269168958218934, - -17.770998122924084, - -40.007572924195685, - -40.90863901385157 + -13.691698596586228, + -8.672231017023337, + -33.221926437578354, + -32.89082776312146 ], - "timestamp": 4.028833353867559 + "timestamp": 4.014010996463665 }, { - "x": 7.292932816380647, - "y": 1.8532547705946691, - "heading": 3.4566645498803235, - "angularVelocity": -0.8160186955033512, - "velocityX": -2.6652172587402316, - "velocityY": -1.3314827083700613, + "x": 7.2689314106331135, + "y": 2.0296016810214934, + "heading": 3.439044836951077, + "angularVelocity": -0.8783985902181007, + "velocityX": -2.777482317048192, + "velocityY": -0.8463589783696349, "moduleForcesX": [ - -103.04921333228688, - -103.43213563525939, - -98.86159408086765, - -98.87292685429789 + -103.29961496935752, + -103.58217004765575, + -99.54614904632459, + -99.58862895612812 ], "moduleForcesY": [ - -11.544949271307244, - -6.560069407755689, - -31.269777895580606, - -31.039659589782794 + -9.276827219626885, + -4.178448909532042, + -29.094262330489535, + -28.757755632981716 ], - "timestamp": 4.07778057649758 + "timestamp": 4.061475983353297 }, { - "x": 7.14918408141944, - "y": 1.7873106738525886, - "heading": 3.4124618351481057, - "angularVelocity": -0.903068904773904, - "velocityX": -2.9368108594794906, - "velocityY": -1.347249000020567, + "x": 7.124653502119942, + "y": 1.9879756803908264, + "heading": 3.393432804978208, + "angularVelocity": -0.9609616469277636, + "velocityX": -3.0396702486996596, + "velocityY": -0.8769832955485592, "moduleForcesX": [ - -103.63562609216031, - -103.19508156086872, - -101.9636791247673, - -102.297793014557 + -103.62216827811297, + -103.60152394447236, + -100.97600742467284, + -101.04877430364988 ], "moduleForcesY": [ - 1.8578199404637532, - 9.026980369120835, - -18.574046448195194, - -16.175083448707877 + -3.4095505625262734, + 1.9894522183883672, + -23.490052769531545, + -22.89126748071193 ], - "timestamp": 4.126727799127601 + "timestamp": 4.108940970242929 }, { - "x": 6.992257977502523, - "y": 1.7232224565630139, - "heading": 3.3639866140947756, - "angularVelocity": -0.9903569283131962, - "velocityX": -3.2060267260326114, - "velocityY": -1.3093330703153447, + "x": 6.967861097841668, + "y": 1.9459210882345401, + "heading": 3.3438925458224324, + "angularVelocity": -1.0437221708490971, + "velocityX": -3.3033276643529277, + "velocityY": -0.8860129310508679, "moduleForcesX": [ - -101.58700144053036, - -99.04092706549442, - -103.57948992890111, - -103.28575192979112 + -103.51947999165917, + -102.99468331816422, + -102.45505555668103, + -102.57296891571525 ], "moduleForcesY": [ - 20.333355715385643, - 30.164112642791856, - 0.3712746034261658, - 6.521939841477385 + 4.724347773856147, + 10.791054603518292, + -15.482230188456697, + -14.127507219444064 ], - "timestamp": 4.175675021757622 + "timestamp": 4.156405957132561 }, { - "x": 6.823161968060095, - "y": 1.6645227955369413, - "heading": 3.3115006930198336, - "angularVelocity": -1.0722962050711007, - "velocityX": -3.4546599450714037, - "velocityY": -1.1992439585340129, + "x": 6.798605926608696, + "y": 1.904988087661922, + "heading": 3.290464815782709, + "angularVelocity": -1.125624034489893, + "velocityX": -3.5658952488008056, + "velocityY": -0.8623830588172553, "moduleForcesX": [ - -93.54862615603459, - -87.12505304198946, - -99.68478228184767, - -95.98019931786078 + -102.22032427708363, + -100.69148391011608, + -103.48690787316097, + -103.44235697238129 ], "moduleForcesY": [ - 44.39868763909986, - 55.84311796842087, - 27.881573322185066, - 38.51078627303082 + 16.569411418577502, + 23.827896852783, + -3.273936939739203, + -0.23956401697252558 ], - "timestamp": 4.2246222443876436 + "timestamp": 4.203870944022193 }, { - "x": 6.64442651702477, - "y": 1.6150301081248706, - "heading": 3.2556875029374615, - "angularVelocity": -1.1402728711340493, - "velocityX": -3.6515953598907216, - "velocityY": -1.011143937341902, + "x": 6.617365994453179, + "y": 1.867626940195305, + "heading": 3.233345431363907, + "angularVelocity": -1.2034004044204083, + "velocityX": -3.818392124836544, + "velocityY": -0.7871306813093759, "moduleForcesX": [ - -75.58670515218044, - -65.41341394673287, - -83.26129301433434, - -73.82590929646548 + -97.4964351201358, + -93.81211585906499, + -102.06328549780508, + -100.74989347493035 ], "moduleForcesY": [ - 70.7269627500392, - 80.17399602370682, - 61.418213629826944, - 72.39463351959833 + 34.58607042006599, + 43.38012581746179, + 16.68289517028768, + 22.81215275508421 ], - "timestamp": 4.273569467017665 + "timestamp": 4.251335930911825 }, { - "x": 6.459747955634086, - "y": 1.5775049558527945, - "heading": 3.1976078744797825, - "angularVelocity": -1.1865765887614697, - "velocityX": -3.773014105143794, - "velocityY": -0.7666451793540634, + "x": 6.425959539225168, + "y": 1.8375524189497474, + "heading": 3.173140969039124, + "angularVelocity": -1.2683973233735604, + "velocityX": -4.0325820737484745, + "velocityY": -0.6336148647008714, "moduleForcesX": [ - -48.754658545853765, - -38.78516132328316, - -53.451745855433785, - -42.79147083400311 + -83.0793580408409, + -75.74454164980041, + -90.56807884095008, + -84.9365665532044 ], "moduleForcesY": [ - 91.32367097930855, - 95.96411440332321, - 88.60385895496529, - 94.18897282038556 + 61.40607447858171, + 70.1333997647084, + 49.57748404754354, + 58.505488397082836 ], - "timestamp": 4.322516689647686 + "timestamp": 4.298800917801457 }, { - "x": 6.272669917195343, - "y": 1.5531505703892592, - "heading": 3.1383417150669244, - "angularVelocity": -1.2108176159622883, - "velocityX": -3.8220358252563957, - "velocityY": -0.49756419577926697, + "x": 6.228897688944246, + "y": 1.8186603576908584, + "heading": 3.1111720980598196, + "angularVelocity": -1.3055701695100008, + "velocityX": -4.151730848027373, + "velocityY": -0.39802099372859684, "moduleForcesX": [ - -21.047088345037217, - -14.88450612601458, - -22.399140974726627, - -15.870003170324972 + -48.29802014497603, + -40.33132670698785, + -52.811490595206955, + -44.53818050230527 ], "moduleForcesY": [ - 101.40262934316833, - 102.48466604056495, - 101.08906364862342, - 102.31264843078472 + 91.20355568795507, + 94.96047101888112, + 88.59300740140523, + 92.98083834186113 ], - "timestamp": 4.371463912277707 + "timestamp": 4.346265904691089 }, { - "x": 6.085876927840109, - "y": 1.5421947938918785, - "heading": 3.0787272867385784, - "angularVelocity": -1.2179328085467576, - "velocityX": -3.8162122244841195, - "velocityY": -0.2238283585606515, + "x": 6.031703753180514, + "y": 1.812324789891614, + "heading": 3.048787154019588, + "angularVelocity": -1.3143360638712303, + "velocityX": -4.1545136460626555, + "velocityY": -0.1334787645738432, "moduleForcesX": [ - 1.28984663500939, - 3.1977958082791926, - 1.1917630490161586, - 3.1353704420291226 + -2.1599097042320587, + 0.23951217753484877, + -2.4393520274010894, + 0.0160871967695788 ], "moduleForcesY": [ - 103.60661623587562, - 103.56505077845577, - 103.60195655485191, - 103.56110929339067 + 103.22994984050744, + 103.25066468571664, + 103.20778601077548, + 103.23489038346442 ], - "timestamp": 4.420411134907728 + "timestamp": 4.393730891580721 }, { - "x": 5.9012506330843415, - "y": 1.544471272265801, - "heading": 3.019361976734124, - "angularVelocity": -1.2128432792434443, - "velocityX": -3.7719462889918423, - "velocityY": 0.04650883648965221, + "x": 5.838288005789171, + "y": 1.8179815794617071, + "heading": 2.987084814881381, + "angularVelocity": -1.2999548336898101, + "velocityX": -4.074914164711231, + "velocityY": 0.1191781553091145, "moduleForcesX": [ - 17.462293324811608, - 16.0927923319585, - 17.39937814131849, - 16.04777728025772 + 33.269109007803046, + 29.421028827707513, + 32.63531064252144, + 28.92117898933171 ], "moduleForcesY": [ - 102.17914754620458, - 102.40362384187102, - 102.19343457298935, - 102.41424068304686 + 97.88150666677997, + 99.10269370028429, + 98.11607395134999, + 99.27126766658209 ], - "timestamp": 4.469358357537749 + "timestamp": 4.441195878470353 }, { - "x": 5.720109462738037, - "y": 1.5596987009048462, - "heading": 2.960670957642772, - "angularVelocity": -1.1990674023525598, - "velocityX": -3.7007446104858777, - "velocityY": 0.3110989310700059, + "x": 5.6509270668029785, + "y": 1.8346644639968877, + "heading": 2.9268466161891644, + "angularVelocity": -1.2691080866046227, + "velocityX": -3.9473504841914, + "velocityY": 0.3514777023129056, "moduleForcesX": [ - 28.918155728680293, - 25.26090248672073, - 28.563093727712385, - 25.03083365823741 + 54.557219185525284, + 47.10662649560467, + 52.23481946428302, + 45.215158498074324 ], "moduleForcesY": [ - 99.58409972188349, - 100.5733296943564, - 99.69486169755311, - 100.63917273673817 + 87.9480109752448, + 92.14125457174697, + 89.38412725469736, + 93.12237776631163 ], - "timestamp": 4.5183055801677705 + "timestamp": 4.488660865359985 }, { - "x": 5.467086369754889, - "y": 1.608315943409953, - "heading": 2.8777398443490734, - "angularVelocity": -1.1699447896759345, - "velocityX": -3.569505310449224, - "velocityY": 0.6858642950544216, + "x": 5.38507100164977, + "y": 1.8830556799414413, + "heading": 2.8404188381427997, + "angularVelocity": -1.206964524044126, + "velocityX": -3.7126818066149396, + "velocityY": 0.6757836684655287, "moduleForcesX": [ - 37.110633318213495, - 31.845579277279175, - 36.60935471340153, - 31.604551220999983 + 66.72846331028158, + 57.59774579035315, + 63.503281618778075, + 54.96790246952051 ], "moduleForcesY": [ - 96.92740942126741, - 98.78190883714102, - 97.1253146659255, - 98.8667048935603 + 79.37288585131948, + 86.21672384257603, + 82.00415549354298, + 87.94587304069235 ], - "timestamp": 4.589190218507559 + "timestamp": 4.5602684199522034 }, { - "x": 5.228866992709924, - "y": 1.6808350936944374, - "heading": 2.7987184964204332, - "angularVelocity": -1.1147880525234262, - "velocityX": -3.360662939451719, - "velocityY": 1.0230587611502073, + "x": 5.143346384858564, + "y": 1.9467965849215205, + "heading": 2.761004546429683, + "angularVelocity": -1.1090211384168227, + "velocityX": -3.375685961785028, + "velocityY": 0.8901421834091305, "moduleForcesX": [ - 59.93331425285257, - 51.01709215758398, - 57.78209023791096, - 49.547643338616176 + 93.74953605342704, + 86.18692065004286, + 88.50666550737564, + 80.22596087781076 ], "moduleForcesY": [ - 84.70174546991043, - 90.34848029716736, - 86.20162312446539, - 91.18072937628781 + 44.334189316001165, + 57.62394594710871, + 54.09828635812438, + 65.72728284950935 ], - "timestamp": 4.660074856847348 + "timestamp": 4.631875974544422 }, { - "x": 5.011723742658711, - "y": 1.7718777634914877, - "heading": 2.7257838036773063, - "angularVelocity": -1.0289209968669253, - "velocityX": -3.0633329750562632, - "velocityY": 1.284377996832451, + "x": 4.929333767387997, + "y": 2.0174366654365876, + "heading": 2.690018539768091, + "angularVelocity": -0.9913200788076207, + "velocityX": -2.9886876975747554, + "velocityY": 0.9864892176106754, "moduleForcesX": [ - 84.76572357068362, - 74.96765408925388, - 80.2383461943941, - 70.79484109399709 + 103.24738699653997, + 101.0121859942123, + 100.38393572494448, + 95.76003337310947 ], "moduleForcesY": [ - 59.80528809358341, - 71.6849991388353, - 65.79112728880133, - 75.84706545896569 + 10.088544648544431, + 23.460609845249287, + 26.250656903011137, + 39.88459892674545 ], - "timestamp": 4.730959495187136 + "timestamp": 4.703483529136641 }, { - "x": 4.820647432846547, - "y": 1.873141713864737, - "heading": 2.6607448349840026, - "angularVelocity": -0.9175326307166438, - "velocityX": -2.6955954673314677, - "velocityY": 1.428573986479781, + "x": 4.7438644840225095, + "y": 2.0884223679161025, + "heading": 2.6280208337517874, + "angularVelocity": -0.8657983975202782, + "velocityX": -2.5900798378039753, + "velocityY": 0.9913158310575519, "moduleForcesX": [ - 101.00986249777799, - 96.10854339543843, - 96.9286920524181, - 90.30878865548299 + 102.83526119368163, + 103.67090860218237, + 103.67025296676273, + 102.23886101741424 ], "moduleForcesY": [ - 23.644613389650427, - 38.97112673980988, - 37.036581210585425, - 51.060010910549146 + -13.933835689919919, + -3.7386929134956266, + 4.950653494760573, + 17.715678179992125 ], - "timestamp": 4.801844133526925 + "timestamp": 4.775091083728859 }, { - "x": 4.657509621107699, - "y": 1.9756961760175065, - "heading": 2.604521572828749, - "angularVelocity": -0.7931656769657904, - "velocityX": -2.3014550904081728, - "velocityY": 1.44677978973625, + "x": 4.5866372251458625, + "y": 2.1552385034426114, + "heading": 2.575144646059974, + "angularVelocity": -0.7384163304125048, + "velocityX": -2.19567976805722, + "velocityY": 0.9330877990775547, "moduleForcesX": [ - 103.19738359227847, - 103.72054443575398, - 103.49434008790791, - 101.5396563829404 + 99.54412665319884, + 101.40753250877371, + 103.32899619969018, + 103.78108426641127 ], "moduleForcesY": [ - -10.817553101285721, - 0.8550148862546341, - 7.678543308436053, - 21.312534299325236 + -29.427597778899138, + -22.02325540050219, + -9.999738927376326, + 1.2055925555842326 ], - "timestamp": 4.872728771866713 + "timestamp": 4.846698638321078 }, { - "x": 4.52173266583132, - "y": 2.07244812277131, - "heading": 2.557278720564778, - "angularVelocity": -0.6664751823591233, - "velocityX": -1.915463751476393, - "velocityY": 1.3649212159342432, + "x": 4.45702944180966, + "y": 2.2148008989688965, + "heading": 2.531346475674566, + "angularVelocity": -0.6116417553261012, + "velocityX": -1.8099735999287732, + "velocityY": 0.8317892696043293, "moduleForcesX": [ - 97.61435766859866, - 99.6011131749049, - 102.58825345734893, - 103.63090006850514 + 95.96812342989033, + 98.04572669881219, + 101.79189444348697, + 103.26094436840614 ], "moduleForcesY": [ - -35.268770461587025, - -29.065839121035793, - -15.80955389013574, - -5.413670712377771 + -39.61546892739203, + -34.07129292769581, + -20.46914580913734, + -10.651513351600967 ], - "timestamp": 4.943613410206502 + "timestamp": 4.918306192913296 }, { - "x": 4.411830591378865, - "y": 2.1585354918951616, - "heading": 2.51876748636365, - "angularVelocity": -0.5432945007989202, - "velocityX": -1.5504357083072682, - "velocityY": 1.2144714445912563, + "x": 4.354388254594759, + "y": 2.2649421325832035, + "heading": 2.496522874025983, + "angularVelocity": -0.48631184023641394, + "velocityX": -1.4333848962381666, + "velocityY": 0.7002226776455226, "moduleForcesX": [ - 90.47854282502254, - 91.83285534237497, - 98.58812625350899, - 100.62445455688419 + 92.7907537763575, + 94.8155739460098, + 100.00318758141623, + 102.02388828803367 ], "moduleForcesY": [ - -50.901475267722624, - -48.35511926084885, - -32.53677718349569, - -25.45535608630757 + -46.60791622206078, + -42.282733802481594, + -27.97777559095913, + -19.25551682225231 ], - "timestamp": 5.01449804854629 + "timestamp": 4.989913747505515 }, { - "x": 4.3262415482856165, - "y": 2.230721782989921, - "heading": 2.488611108566075, - "angularVelocity": -0.42542895758343663, - "velocityX": -1.2074413455137303, - "velocityY": 1.0183629737762252, + "x": 4.278118050279357, + "y": 2.3040837289983593, + "heading": 2.4705582318655237, + "angularVelocity": -0.36259640911227725, + "velocityX": -1.0651139355949073, + "velocityY": 0.5466126669277778, "moduleForcesX": [ - 84.07525354896863, - 84.42849078503647, - 93.9888010492201, - 96.0020319753479 + 90.1187469058319, + 91.995376602234, + 98.29771671442934, + 100.61570105327873 ], "moduleForcesY": [ - -60.92976824507471, - -60.40104086303051, - -44.13196396617181, - -39.50801066886383 + -51.60847738463325, + -48.14285693742628, + -33.513140486900426, + -25.666450933577256 ], - "timestamp": 5.085382686886079 + "timestamp": 5.061521302097733 }, { - "x": 4.263589020412451, - "y": 2.2868059201143556, - "heading": 2.466437553417309, - "angularVelocity": -0.3128118541351126, - "velocityX": -0.8838660863703308, - "velocityY": 0.7912029804764343, + "x": 4.227698728083314, + "y": 2.3310369086387626, + "heading": 2.4533426833893883, + "angularVelocity": -0.2404152547055344, + "velocityX": -0.7041061865523344, + "velocityY": 0.37640134201140235, "moduleForcesX": [ - 78.82081144473382, - 78.2947277286741, - 89.72768925430235, - 91.35467904089971 + 87.90888243626851, + 89.58265687469483, + 96.7811494551446, + 99.2400496777036 ], "moduleForcesY": [ - -67.61078851767357, - -68.19198593943935, - -52.27861117061747, - -49.344165998038456 + -55.30576952737938, + -52.51878339626849, + -37.692133911621376, + -30.590607959006878 ], - "timestamp": 5.156267325225867 + "timestamp": 5.133128856689952 }, { - "x": 4.222720463089765, - "y": 2.325236543036976, - "heading": 2.451919310286384, - "angularVelocity": -0.20481508364804626, - "velocityX": -0.576550269280934, - "velocityY": 0.5421572829136999, + "x": 4.2026820182780895, + "y": 2.3448798656255554, + "heading": 2.444777874392378, + "angularVelocity": -0.11960761746132077, + "velocityX": -0.34935852732262185, + "velocityY": 0.19331699150554127, "moduleForcesX": [ - 74.60403531213795, - 73.36398730793962, - 86.04738983964184, - 87.18827457983765 + 86.09072271913463, + 87.50803229096606, + 95.47488145367366, + 97.96216818816397 ], "moduleForcesY": [ - -72.2521437562441, - -73.49008857932517, - -58.15497382694532, - -56.40308380016812 + -58.108421977440734, + -55.92431623005057, + -40.90491902309583, + -34.48857338358015 ], - "timestamp": 5.227151963565656 + "timestamp": 5.204736411282171 }, { "x": 4.202682018280029, - "y": 2.3448798656463623, + "y": 2.344879865646362, "heading": 2.4447778743923783, - "angularVelocity": -0.10074729957389103, - "velocityX": -0.2826909366974499, - "velocityY": 0.27711677832402926, + "angularVelocity": 5.168003878366018e-17, + "velocityX": 4.1453752254911594e-17, + "velocityY": 8.192712538061972e-17, "moduleForcesX": [ - 71.22468650853797, - 69.3870865231279, - 82.9455645855158, - 83.58175463898205 + 84.5994600681018, + 85.69781853498485, + 94.37037678492582, + 96.79234259000295 ], "moduleForcesY": [ - -75.5969633085211, - -77.27040216937355, - -62.51253196312979, - -61.63801883584066 + -60.26906063131338, + -58.67389816054446, + -43.40532121869834, + -37.66504124484338 ], - "timestamp": 5.298036601905444 + "timestamp": 5.276343965874389 }, { - "x": 4.202682018280029, - "y": 2.3448798656463623, - "heading": 2.4447778743923783, - "angularVelocity": -5.80382960829085e-23, - "velocityX": 1.3673447485380094e-21, - "velocityY": -7.76305297216273e-23, - "moduleForcesX": [ - 68.50416083765214, - 66.13446697456098, - 80.349821554819, - 80.4775374470252 - ], - "moduleForcesY": [ - -78.07954947028286, - -80.08289970808126, - -65.825574909368, - -65.65190327177945 - ], - "timestamp": 5.368921240245233 - }, - { - "x": 4.201703407238958, + "x": 4.201703407238959, "y": 2.344928891411713, "heading": 2.4109202649275003, - "angularVelocity": -0.8588869565571112, - "velocityX": -0.02482503259982727, - "velocityY": 0.0012436669647010426, + "angularVelocity": -0.8588869565571109, + "velocityX": -0.024825032599826515, + "velocityY": 0.00124366696470136, "moduleForcesX": [ - -28.227322752614786, - 103.42278400099644, - -103.75844967549132, - -18.094061998184152 + -28.22732275261409, + 103.42278400099643, + -103.75844967549133, + -18.094061998183502 ], "moduleForcesY": [ - 99.90321784851972, - 8.536606790573616, - -3.8816893662670853, - -102.22074328548473 + 99.90321784851992, + 8.53660679057382, + -3.8816893662669205, + -102.22074328548484 ], - "timestamp": 5.40834157281216 + "timestamp": 5.315764298441317 }, { "x": 4.19960599570747, "y": 2.344567972526076, - "heading": 2.3434151950983257, + "heading": 2.343415195098326, "angularVelocity": -1.7124429306770592, - "velocityX": -0.05320633781888569, - "velocityY": -0.009155652987557033, + "velocityX": -0.05320633781888414, + "velocityY": -0.009155652987556358, "moduleForcesX": [ - -27.118032037334096, - 102.87897965174633, + -27.118032037333307, + 102.87897965174639, -103.65492919654237, - -25.446854262350335 + -25.446854262349746 ], "moduleForcesY": [ - 100.17273398636637, - -13.32089023629324, - -5.763677170586516, - -100.6330188752554 + 100.17273398636658, + -13.320890236292788, + -5.763677170586371, + -100.63301887525554 ], - "timestamp": 5.447761905379088 + "timestamp": 5.355184631008244 }, { "x": 4.1960512028500485, - "y": 2.3431299343053045, - "heading": 2.243041963319051, - "angularVelocity": -2.546229959091813, - "velocityX": -0.09017663286798999, - "velocityY": -0.03647960651602133, - "moduleForcesX": [ - -25.33343532040246, - 93.27197212593993, + "y": 2.343129934305304, + "heading": 2.2430419633190515, + "angularVelocity": -2.546229959091814, + "velocityX": -0.09017663286798745, + "velocityY": -0.03647960651602015, + "moduleForcesX": [ + -25.333435320401506, + 93.27197212594027, -103.44021230394544, - -33.98161373425351 + -33.98161373425298 ], "moduleForcesY": [ - 100.56440767021368, - -45.312631622641916, - -8.536330867305994, - -98.06905659928213 + 100.56440767021392, + -45.312631622641206, + -8.536330867305882, + -98.0690565992823 ], - "timestamp": 5.487182237946016 + "timestamp": 5.394604963575172 }, { "x": 4.190293529660696, - "y": 2.3398051514706095, - "heading": 2.111921828848045, - "angularVelocity": -3.326205689624509, - "velocityX": -0.1460584630933037, - "velocityY": -0.08434182611347482, + "y": 2.339805151470608, + "heading": 2.1119218288480455, + "angularVelocity": -3.3262056896245125, + "velocityX": -0.14605846309329973, + "velocityY": -0.08434182611347314, "moduleForcesX": [ - -27.49060665939882, - 66.97560497296121, - -102.56378310330503, - -41.947517197804814 + -27.490606659397372, + 66.97560497296193, + -102.56378310330504, + -41.94751719780439 ], "moduleForcesY": [ - 99.77621827507902, - -79.12850743515231, - -15.681873461362015, - -94.91979752927205 + 99.77621827507942, + -79.12850743515172, + -15.681873461361965, + -94.91979752927223 ], - "timestamp": 5.526602570512943 + "timestamp": 5.434025296142099 }, { "x": 4.180004921895993, "y": 2.331957993445509, - "heading": 1.9628540404616008, - "angularVelocity": -3.7814949463796665, - "velocityX": -0.260997487711088, - "velocityY": -0.19906371951014543, + "heading": 1.9628540404616013, + "angularVelocity": -3.781494946379674, + "velocityX": -0.2609974877110832, + "velocityY": -0.1990637195101428, "moduleForcesX": [ - -101.10990652767909, - 29.517572053746953, - -97.66177710983962, - -46.76638489941762 + -101.10990652767879, + 29.517572053747624, + -97.66177710983959, + -46.7663848994173 ], "moduleForcesY": [ - 11.251940941172409, - -99.37458530974946, - -34.87193793205709, - -92.61783003234635 + 11.251940941173997, + -99.37458530974925, + -34.87193793205716, + -92.61783003234652 ], - "timestamp": 5.566022903079871 + "timestamp": 5.473445628709027 }, { - "x": 4.166361351302606, - "y": 2.3164379306505576, - "heading": 1.8072932986079373, - "angularVelocity": -3.9462057198414553, - "velocityX": -0.3461049084307693, - "velocityY": -0.3937070487318249, + "x": 4.166361351302605, + "y": 2.3164379306505567, + "heading": 1.8072932986079375, + "angularVelocity": -3.946205719841463, + "velocityX": -0.3461049084307636, + "velocityY": -0.3937070487318224, "moduleForcesX": [ - -33.36951073216951, - -5.706270650379014, - -75.36467871982056, - -45.51345754575896 + -33.369510732168834, + -5.706270650378617, + -75.36467871982032, + -45.51345754575867 ], "moduleForcesY": [ - -97.93226744361932, - -103.51923261668531, - -71.1617240805949, - -93.20638112745955 + -97.93226744361955, + -103.51923261668534, + -71.16172408059515, + -93.2063811274597 ], - "timestamp": 5.605443235646798 + "timestamp": 5.5128659612759545 }, { "x": 4.149916591020042, - "y": 2.2926823181951774, - "heading": 1.65181054109108, - "angularVelocity": -3.944227442852698, - "velocityX": -0.41716442281767707, - "velocityY": -0.602623339492322, + "y": 2.292682318195177, + "heading": 1.6518105410910802, + "angularVelocity": -3.9442274428527058, + "velocityX": -0.41716442281767085, + "velocityY": -0.6026233394923195, "moduleForcesX": [ - -33.55166682694357, - -33.80304782175004, - -32.97397566453504, - -33.22309184918086 + -33.551666826943425, + -33.80304782174995, + -32.97397566453473, + -33.22309184918061 ], "moduleForcesY": [ - -98.10698033320081, - -98.01915041897836, - -98.30200452433485, - -98.21658224726805 + -98.10698033320087, + -98.01915041897838, + -98.30200452433495, + -98.21658224726814 ], - "timestamp": 5.644863568213726 + "timestamp": 5.552286293842882 }, { - "x": 4.131295062523411, - "y": 2.2607333178953537, - "heading": 1.5019050907593101, - "angularVelocity": -3.80274443593949, - "velocityX": -0.472383850770812, - "velocityY": -0.8104700853444186, + "x": 4.13129506252341, + "y": 2.2607333178953555, + "heading": 1.5019050907593103, + "angularVelocity": -3.802744435939497, + "velocityX": -0.47238385077080564, + "velocityY": -0.8104700853444158, "moduleForcesX": [ - -40.2168329104546, - -55.21625645355153, - -4.835470491948852, - -3.5127997094387298 + -40.21683291045461, + -55.21625645355164, + -4.835470491948728, + -3.5127997094385286 ], "moduleForcesY": [ - -95.64897949611914, - -87.757099641864, + -95.64897949611913, + -87.75709964186395, -103.63779020013178, -103.59070739238904 ], - "timestamp": 5.684283900780653 + "timestamp": 5.59170662640981 }, { "x": 4.111026763916016, "y": 2.221068859100342, "heading": 1.3630312678774887, - "angularVelocity": -3.5228983075178477, - "velocityX": -0.5141584884648978, - "velocityY": -1.0061929012818376, + "angularVelocity": -3.522898307517854, + "velocityX": -0.5141584884648915, + "velocityY": -1.0061929012818345, "moduleForcesX": [ - -47.929085434488584, - -71.96458253113931, - 6.298074117284643, - 35.08285193940007 + -47.92908543448869, + -71.96458253113951, + 6.29807411728461, + 35.082851939400115 ], "moduleForcesY": [ - -92.06794236589327, - -74.62301016758721, - -103.60506557630978, - -97.55241293864256 + -92.06794236589322, + -74.62301016758703, + -103.60506557630977, + -97.55241293864255 ], - "timestamp": 5.723704233347581 + "timestamp": 5.631126958976737 }, { - "x": 4.062724486802488, - "y": 2.110555894865889, - "heading": 1.1420372292372407, - "angularVelocity": -2.7416930766221763, - "velocityX": -0.5992470184357392, - "velocityY": -1.3710443538788295, + "x": 4.062724486802489, + "y": 2.1105558948658896, + "heading": 1.1420372292372403, + "angularVelocity": -2.7416930766221816, + "velocityX": -0.5992470184357338, + "velocityY": -1.3710443538788264, "moduleForcesX": [ - -58.73772933370447, - -84.11029030603055, - 5.233285508187558, - 59.405679960771735 + -58.737729333704614, + -84.11029030603079, + 5.2332855081874134, + 59.40567996077163 ], "moduleForcesY": [ - -85.66951767872665, - -60.775439425919956, - -103.74545811129138, - -85.16250520967935 + -85.66951767872655, + -60.77543942591964, + -103.7454581112914, + -85.16250520967942 ], - "timestamp": 5.804309185274774 + "timestamp": 5.71173191090393 }, { "x": 4.007017393904712, "y": 1.9705835820032092, - "heading": 0.9812050036884946, - "angularVelocity": -1.9953144528145002, - "velocityX": -0.6911125379504645, - "velocityY": -1.7365225028495959, + "heading": 0.9812050036884937, + "angularVelocity": -1.9953144528145033, + "velocityX": -0.69111253795046, + "velocityY": -1.7365225028495925, "moduleForcesX": [ - -64.22141665906422, - -80.12397623088805, - -0.09600908354098996, - 60.003283291507636 + -64.22141665906439, + -80.12397623088835, + -0.09600908354117038, + 60.0032832915075 ], "moduleForcesY": [ - -81.61082059327089, - -65.73350813646502, + -81.61082059327076, + -65.73350813646466, -103.8621786778673, - -84.72244048801421 + -84.72244048801433 ], - "timestamp": 5.884914137201967 + "timestamp": 5.792336862831124 }, { "x": 3.943851323495702, - "y": 1.8018787684532644, - "heading": 0.8821659959765331, - "angularVelocity": -1.2286963188244244, - "velocityX": -0.7836499979066395, - "velocityY": -2.092983241306668, + "y": 1.8018787684532651, + "heading": 0.882165995976532, + "angularVelocity": -1.2286963188244255, + "velocityX": -0.7836499979066361, + "velocityY": -2.0929832413066642, "moduleForcesX": [ - -68.62017364940806, - -80.1006769069396, - -1.411311275947935, - 65.07642963174425 + -68.62017364940823, + -80.10067690694001, + -1.4113112759481592, + 65.07642963174403 ], "moduleForcesY": [ - -77.88958304459304, - -65.089910548468, - -103.82208570578915, - -80.83902294562851 + -77.8895830445929, + -65.0899105484675, + -103.82208570578916, + -80.83902294562868 ], - "timestamp": 5.9655190891291605 + "timestamp": 5.872941814758317 }, { - "x": 3.8781108764118923, - "y": 1.62015655248617, - "heading": 0.9059483264084738, - "angularVelocity": 0.2950480071425667, - "velocityX": -0.8155881929337341, - "velocityY": -2.2544795527108175, + "x": 3.8781108764118932, + "y": 1.6201565524861705, + "heading": 0.9059483264084722, + "angularVelocity": 0.29504800714256113, + "velocityX": -0.815588192933734, + "velocityY": -2.2544795527108152, "moduleForcesX": [ - -72.70004868646518, - -50.250066546788176, - 8.938812986150849, - 84.6553358689454 + -72.70004868646532, + -50.25006654679044, + 8.938812986150491, + 84.65533586894512 ], "moduleForcesY": [ - -73.92227873323378, - 88.67129288393822, - -103.36018720677365, - -59.82803222008088 + -73.92227873323364, + 88.67129288393693, + -103.36018720677367, + -59.828032220081276 ], - "timestamp": 6.046124041056354 + "timestamp": 5.95354676668551 }, { "x": 3.82485357780854, - "y": 1.4531042418213815, - "heading": 1.0372615296620737, - "angularVelocity": 1.6290959812519923, - "velocityX": -0.660719935066242, - "velocityY": -2.0724819836835775, + "y": 1.4531042418213824, + "heading": 1.0372615296620726, + "angularVelocity": 1.6290959812519983, + "velocityX": -0.6607199350662438, + "velocityY": -2.072481983683578, "moduleForcesX": [ - -73.9628963267555, - 29.478911488108032, - 92.80376149106614, - 94.02725852427287 + -73.96289632675686, + 29.47891148810785, + 92.80376149106574, + 94.02725852427297 ], "moduleForcesY": [ - 69.9865243622358, - 99.10987378380912, - -45.02524501367293, - 43.211766667495525 + 69.98652436223436, + 99.10987378380918, + -45.02524501367373, + 43.211766667495276 ], - "timestamp": 6.126728992983547 + "timestamp": 6.034151718612703 }, { "x": 3.7854736830756957, - "y": 1.3195187350370476, - "heading": 1.1596419881635687, - "angularVelocity": 1.5182746912625922, - "velocityX": -0.4885542859502548, - "velocityY": -1.6572866007661222, + "y": 1.3195187350370479, + "heading": 1.1596419881635682, + "angularVelocity": 1.5182746912625973, + "velocityX": -0.48855428595025646, + "velocityY": -1.6572866007661224, "moduleForcesX": [ - 47.382251388920984, - 48.46951456581909, - 32.104806016987034, - 30.2893465166195 + 47.38225138892106, + 48.46951456581919, + 32.104806016986984, + 30.2893465166194 ], "moduleForcesY": [ - 92.24628285703518, - 91.63195838513802, - 98.60962299241723, - 99.13863942195309 + 92.24628285703513, + 91.63195838513796, + 98.60962299241726, + 99.13863942195313 ], - "timestamp": 6.20733394491074 + "timestamp": 6.114756670539896 }, { - "x": 3.7572242233614133, + "x": 3.7572242233614137, "y": 1.2196002881884476, - "heading": 1.2584600862248756, - "angularVelocity": 1.22595567268082, - "velocityX": -0.3504680424572255, + "heading": 1.2584600862248754, + "angularVelocity": 1.2259556726808236, + "velocityX": -0.35046804245722674, "velocityY": -1.2396068040441512, "moduleForcesX": [ - 49.28365457148797, - 57.86750411793015, - 14.612587070047223, - 5.158114346545566 + 49.283654571488064, + 57.86750411793033, + 14.612587070047217, + 5.158114346545502 ], "moduleForcesY": [ - 91.37280556707458, - 86.12414163106692, - 102.782755901925, + 91.37280556707454, + 86.1241416310668, + 102.78275590192501, 103.63034751499849 ], - "timestamp": 6.287938896837933 + "timestamp": 6.1953616224670895 }, { "x": 3.738947473265417, - "y": 1.153151514149799, - "heading": 1.3274153889759315, - "angularVelocity": 0.8554722892625776, - "velocityX": -0.22674475524164925, + "y": 1.1531515141497997, + "heading": 1.3274153889759313, + "angularVelocity": 0.8554722892625797, + "velocityX": -0.2267447552416501, "velocityY": -0.8243758286546562, "moduleForcesX": [ - 48.61931337934166, - 62.846738605842184, - 7.378601440653287, - -5.124493078192649 + 48.61931337934176, + 62.84673860584237, + 7.3786014406533145, + -5.124493078192651 ], "moduleForcesY": [ - 91.7705326878624, - 82.62185421955228, + 91.77053268786236, + 82.62185421955213, 103.59052194670481, - 103.67630959459125 + 103.67630959459123 ], - "timestamp": 6.3685438487651265 + "timestamp": 6.275966574394283 }, { "x": 3.73, - "y": 1.12, + "y": 1.1199999999999999, "heading": 1.3630312678774887, - "angularVelocity": 0.44185720666055006, - "velocityX": -0.11100401466027994, - "velocityY": -0.41128383997727014, + "angularVelocity": 0.4418572066605511, + "velocityX": -0.11100401466028038, + "velocityY": -0.4112838399772702, "moduleForcesX": [ - 48.05959947460402, - 65.55089466299441, - 3.545184653333839, - -10.772669788473484 + 48.05959947460411, + 65.55089466299457, + 3.54518465333388, + -10.772669788473445 ], "moduleForcesY": [ - 92.08571544205489, - 80.52833862168941, + 92.08571544205485, + 80.52833862168929, 103.81078891723752, 103.268327544522 ], - "timestamp": 6.44914880069232 + "timestamp": 6.356571526321476 }, { "x": 3.73, "y": 1.12, "heading": 1.3630312678774887, - "angularVelocity": 3.806016005451674e-22, - "velocityX": 1.1811367619243883e-22, - "velocityY": 1.878055725323778e-21, + "angularVelocity": -3.589610570804574e-21, + "velocityX": 5.339550258707543e-21, + "velocityY": -2.502223964641149e-20, "moduleForcesX": [ - 48.217410638261995, - 66.96008834120764, - 1.7871900274204235, - -14.935437840905193 + 48.2174106382621, + 66.96008834120781, + 1.7871900274204708, + -14.935437840905156 ], "moduleForcesY": [ - 92.01539367318387, - 79.38179672545625, + 92.01539367318382, + 79.38179672545613, 103.86711250635297, 102.76690919104156 ], - "timestamp": 6.529753752619513 + "timestamp": 6.437176478248669 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.5095116837609095, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.709497073488135e-16, - "velocityY": -1.4947758853647621e-16, + "x": 3.72087766585563, + "y": 1.1208176986079128, + "heading": 1.431626602021572, + "angularVelocity": 1.1235612635077608, + "velocityX": -0.14941980245858624, + "velocityY": 0.013393541886655683, "moduleForcesX": [ - -77.80402381445582, - -68.80771039095391, - 68.8077103909537, - 77.80402381445577 + -96.6383007361533, + -88.19573664846793, + -12.8532068373394, + 16.362081392441013 ], "moduleForcesY": [ - -68.80771039095379, - 77.8040238144557, - -77.80402381445587, - 68.80771039095383 + -38.07025222846023, + 54.85615378968718, + -103.0065453160445, + 102.47408622697547 ], - "timestamp": 6.611199748130065 + "timestamp": 6.498228186216892 }, { - "x": 3.73, - "y": 1.12, - "heading": 1.802386311093262, - "angularVelocity": 3.595936491370013, - "velocityX": -5.571400134063502e-16, - "velocityY": -3.009483254088862e-16, + "x": 3.7060685799077318, + "y": 1.1216188501069515, + "heading": 1.5768366563753402, + "angularVelocity": 2.3784765272963293, + "velocityX": -0.24256628423237084, + "velocityY": 0.013122507554436695, "moduleForcesX": [ - -54.593644788232, - -88.28820574759457, - 88.28820574759443, - 54.593644788231884 + -88.8285234526177, + -89.30381940223486, + 33.24862083207597, + 31.84782787273839 ], "moduleForcesY": [ - -88.28820574759447, - 54.593644788231835, - -54.593644788232055, - 88.28820574759455 + -53.74418536835451, + 52.95104455482856, + -98.25981269878262, + 98.72404567269594 ], - "timestamp": 6.692645743640616 + "timestamp": 6.5592798941851145 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.0952609384256147, - "angularVelocity": 3.5959364913700127, - "velocityX": -5.444414637967877e-16, - "velocityY": -2.972769677792861e-16, + "x": 3.6934340527017753, + "y": 1.1220954757151458, + "heading": 1.8032677618817912, + "angularVelocity": 3.708841456561832, + "velocityX": -0.20694797289753816, + "velocityY": 0.00780691685910522, "moduleForcesX": [ - 8.817109797269002e-15, - 2.5092224152930147e-14, - -1.931655743496392e-14, - -3.041443079302774e-15 + -35.05819106953644, + -82.5405267662809, + 91.56935681606274, + 69.25319076809818 ], "moduleForcesY": [ - 2.303931047982611e-14, - -5.0943567524068115e-15, - 6.764196124164912e-15, - -2.1369471108068058e-14 + -97.51255338667491, + 62.56571622690056, + -48.643052215626845, + 77.13926949432349 ], - "timestamp": 6.774091739151168 + "timestamp": 6.620331602153337 }, { - "x": 3.73, - "y": 1.12, - "heading": 2.2417413543090356, - "angularVelocity": 1.7984974579191284, - "velocityX": -2.6928205770985715e-16, - "velocityY": -1.3976239164731637e-16, + "x": 3.7016410085682656, + "y": 1.1214615431425257, + "heading": 2.0300291224213423, + "angularVelocity": 3.714250888076378, + "velocityX": 0.1344263107389409, + "velocityY": -0.010383535428491778, "moduleForcesX": [ - 11.854773337595287, - 103.12486448237142, - -103.1248644823714, - -11.85477333759506 + 103.52224314206727, + 103.57865086400795, + 103.55804416719118, + 103.60842497193357 ], "moduleForcesY": [ - 103.1248644823714, - -11.85477333759509, - 11.854773337595256, - -103.12486448237142 + -6.3201721524407395, + -5.293000752987987, + -5.7410129870185775, + -4.720443231127713 ], - "timestamp": 6.85553773466172 + "timestamp": 6.68138331012156 }, { "x": 3.73, "y": 1.12, "heading": 2.2417413543090356, - "angularVelocity": -1.621613980672119e-23, - "velocityX": -2.040896989344763e-21, - "velocityY": 2.209371111140419e-21, + "angularVelocity": 3.467752810419143, + "velocityX": 0.46450774884957136, + "velocityY": -0.02393943087174043, "moduleForcesX": [ - 11.861754037319995, - 103.18558970187604, - -103.18558970187601, - -11.861754037319772 + 98.57622997589631, + 103.63716028828135, + 103.73909202920692, + 94.61069291895654 ], "moduleForcesY": [ - 103.185589701876, - -11.8617540373198, - 11.861754037319967, - -103.18558970187604 + 32.58548347862939, + -6.552674898718845, + 0.25821976705337374, + -42.74149145896195 ], - "timestamp": 6.936983730172272 + "timestamp": 6.7424350180897825 }, { - "x": 3.7420257087402713, - "y": 1.119395565443157, - "heading": 2.250679174338871, - "angularVelocity": 0.18951813820310662, - "velocityX": 0.25499393850188956, - "velocityY": -0.01281647107416695, + "x": 3.7595235837147456, + "y": 1.1185280268961153, + "heading": 2.3805165275370834, + "angularVelocity": 3.241748643389131, + "velocityX": 0.6896625327778686, + "velocityY": -0.03438487376134009, "moduleForcesX": [ - 94.39176645951244, - 103.75042896292366, - 103.62407770654451, - 98.82065097544032 + 92.63480916068393, + 103.83855124027123, + 103.02064063619865, + 90.17555347900034 ], "moduleForcesY": [ - -43.26174671623899, - -1.821110039816679, - -6.93478963585717, - 31.88340023830956 + 46.88788427101869, + -1.7717146795353886, + -11.72405596945411, + -51.469771162765475 ], - "timestamp": 6.984144493329711 + "timestamp": 6.785243757598643 }, { - "x": 3.7660834861885943, - "y": 1.1181790558565958, - "heading": 2.2684739284287843, - "angularVelocity": 0.37732116485282313, - "velocityX": 0.510122734189237, - "velocityY": -0.025794951250046723, + "x": 3.7986214441040707, + "y": 1.1164937101985923, + "heading": 2.509065602848367, + "angularVelocity": 3.0028698996072096, + "velocityX": 0.9133149174197912, + "velocityY": -0.047521060438719384, "moduleForcesX": [ - 94.60878216272674, - 103.70988945367432, - 103.65165670870203, - 98.82845189414677 + 91.30030171363514, + 103.80690678446062, + 100.27353405465394, + 91.68864842073944 ], "moduleForcesY": [ - -42.76818746342199, - -3.0383973887514557, - -6.41564735852772, - 31.833475192591276 + 49.406044695641285, + 2.918795853575125, + -26.34108710491625, + -48.71821158597372 ], - "timestamp": 7.03130525648715 + "timestamp": 6.828052497107503 }, { - "x": 3.8021804586038193, - "y": 1.116340174110553, - "heading": 2.2950337283480158, - "angularVelocity": 0.5631757872654675, - "velocityX": 0.7654026355493844, - "velocityY": -0.038991772459324274, + "x": 3.847205006575031, + "y": 1.1138399376381436, + "heading": 2.6265825725100256, + "angularVelocity": 2.745163044039986, + "velocityX": 1.1348982247159145, + "velocityY": -0.06199137351157865, "moduleForcesX": [ - 94.8944561275941, - 103.62991439772085, - 103.68917333070299, - 98.822618306651 + 90.2042873084176, + 103.58978446340055, + 96.57875922239813, + 93.11566139239736 ], "moduleForcesY": [ - -42.11106179846348, - -4.788890326585848, - -5.652040565410073, - 31.820229232712332 + 51.344934793162416, + 7.2187104736979055, + -37.68389178110523, + -45.92314963498386 ], - "timestamp": 7.07846601964459 + "timestamp": 6.8708612366163635 }, { - "x": 3.8503241618605326, - "y": 1.1138665667296608, - "heading": 2.3302610133197463, - "angularVelocity": 0.7469617243921487, - "velocityX": 1.0208423281021242, - "velocityY": -0.05245053759274676, + "x": 3.9051896953007397, + "y": 1.110564122158419, + "heading": 2.732274631293762, + "angularVelocity": 2.4689364834453884, + "velocityX": 1.35450586471335, + "velocityY": -0.07652211948572567, "moduleForcesX": [ - 95.25359220944863, - 103.48669966827966, - 103.73034024206368, - 98.81655664655072 + 89.3927835844053, + 103.23979633546678, + 93.02671273614925, + 94.40996349354707 ], "moduleForcesY": [ - -41.26925009772418, - -7.018269244384779, - -4.656152780003914, - 31.800403545940096 + 52.70412794820037, + 11.079320727564896, + -45.74514083121305, + -43.186293651224865 ], - "timestamp": 7.125626782802029 + "timestamp": 6.913669976125224 }, { - "x": 3.9105222915906985, - "y": 1.1107447960198984, - "heading": 2.374057057087477, - "angularVelocity": 0.9286542633231647, - "velocityX": 1.276445199353584, - "velocityY": -0.06619423649572619, + "x": 3.9725090760296573, + "y": 1.1066998807874662, + "heading": 2.8255063011841965, + "angularVelocity": 2.1778653368463976, + "velocityX": 1.5725616194552194, + "velocityY": -0.09026758122959308, "moduleForcesX": [ - 95.6913636594475, - 103.25613890552566, - 103.76742989536034, - 98.82860456818229 + 88.88037952242793, + 102.81005176007353, + 90.15112154865182, + 95.54189569023103 ], "moduleForcesY": [ - -40.215687472750055, - -9.644987734666467, - -3.44472063684618, - 31.714505873672152 + 53.51505450468626, + 14.462722838276617, + -51.165484322274246, + -40.60120774371482 ], - "timestamp": 7.172787545959468 + "timestamp": 6.956478715634084 }, { - "x": 3.9827828266678518, - "y": 1.106961759031523, - "heading": 2.4263221397090615, - "angularVelocity": 1.108232333881124, - "velocityX": 1.5322172551772217, - "velocityY": -0.08021577122801049, + "x": 4.04911754604587, + "y": 1.1022980104803026, + "heading": 2.905836418420014, + "angularVelocity": 1.8764887300452011, + "velocityX": 1.7895521077032517, + "velocityY": -0.1028264405272802, "moduleForcesX": [ - 96.21274681913333, - 102.92117372125647, - 103.79170757840996, - 98.88369219763595 + 88.6435849529272, + 102.35009226005988, + 88.04981715271404, + 96.49632501819781 ], "moduleForcesY": [ - -38.9163675493585, - -12.5495178250086, - -2.0417028183548362, - 31.480227453762826 + 53.8478227107517, + 17.346843483393773, + -54.67995276264344, + -38.25000602612566 ], - "timestamp": 7.219948309116908 + "timestamp": 6.9992874551429445 }, { - "x": 4.067114900352871, - "y": 1.1025064837995016, - "heading": 2.4869458369938227, - "angularVelocity": 1.2854689624588427, - "velocityX": 1.7881829732798544, - "velocityY": -0.09446995624621968, + "x": 4.134987194671327, + "y": 1.0974123372446702, + "heading": 2.972996577285001, + "angularVelocity": 1.568842241923198, + "velocityX": 2.005890610438106, + "velocityY": -0.11412793956759826, "moduleForcesX": [ - 96.82210060607143, - 102.48186327897088, - 103.79411466441147, - 99.01547871125396 + 88.62476323392177, + 101.90241204467951, + 86.61463584529837, + 97.26963381448 ], "moduleForcesY": [ - -37.327787018091406, - -15.562895960409582, - -0.48329422551997087, - 30.98113066968098 + 53.80724235029578, + 19.724948998303372, + -56.891541867481344, + -36.19986123567652 ], - "timestamp": 7.267109072274347 + "timestamp": 7.042096194651805 }, { - "x": 4.163530889459729, - "y": 1.0973719786562688, - "heading": 2.5557791619374997, - "angularVelocity": 1.4595464605584618, - "velocityX": 2.044411130180125, - "velocityY": -0.1088723930546053, + "x": 4.230102691196206, + "y": 1.0920909550243076, + "heading": 3.0268475265496417, + "angularVelocity": 1.2579428846180885, + "velocityX": 2.2218709921405915, + "velocityY": -0.12430597773782255, "moduleForcesX": [ - 97.52307759296336, - 101.96757166187002, - 103.76643805404562, - 99.2687524999127 + 88.74379947495026, + 101.50047511959417, + 85.68172812373263, + 97.86565142236238 ], "moduleForcesY": [ - -35.391087956730566, - -18.45337114743011, - 1.1721764204605787, - 30.046537559814595 + 53.52138370855977, + 21.601735994041906, + -58.23596611496595, + -34.502020704573155 ], - "timestamp": 7.314269835431786 + "timestamp": 7.084904934160665 }, { - "x": 4.27205024518103, - "y": 1.0915564372377649, - "heading": 2.6325761862157253, - "angularVelocity": 1.628409277895895, - "velocityX": 2.3010517314791077, - "velocityY": -0.1233131321282886, + "x": 4.334456113781515, + "y": 1.086371616052347, + "heading": 3.0673336474081494, + "angularVelocity": 0.9457442878019748, + "velocityX": 2.437666321936928, + "velocityY": -0.1336021344607505, "moduleForcesX": [ - 98.3192725604474, - 101.45005517054383, - 103.70343609036856, - 99.70101230315205 + 88.91294242841904, + 101.16809361041918, + 85.0990600378489, + 98.29129352160717 ], "moduleForcesY": [ - -33.018357864516105, - -20.904618562351715, - 2.823282264089796, - 28.413777464885822 + 53.12500412966054, + 22.988179743010008, + -59.00882911377455, + -33.19297248992892 ], - "timestamp": 7.361430598589226 + "timestamp": 7.1277136736695255 }, { - "x": 4.392705551657881, - "y": 1.0850626109406343, - "heading": 2.7168841340917256, - "angularVelocity": 1.7876714079997014, - "velocityX": 2.5583832491017766, - "velocityY": -0.13769553040208768, + "x": 4.448042469034826, + "y": 1.0802797732534677, + "heading": 3.0944451868788407, + "angularVelocity": 0.6333178641029511, + "velocityX": 2.653345007502878, + "velocityY": -0.14230371809045952, "moduleForcesX": [ - 99.21668025263472, - 101.05663190107522, - 103.60675985804505, - 100.37911048180725 + 89.05028068668823, + 100.91938488804666, + 84.74746616957619, + 98.55238470477299 ], "moduleForcesY": [ - -30.057161726527582, - -22.46386652016153, - 4.275852534155649, - 25.65091045432924 + 52.73979656003988, + 23.896465943972522, + -59.39938458297941, + -32.29648339516581 ], - "timestamp": 7.408591361746665 + "timestamp": 7.170522413178386 }, { - "x": 4.525550892595546, - "y": 1.0778935325462906, - "heading": 2.80783510466324, - "angularVelocity": 1.9285305088869589, - "velocityX": 2.8168615612554824, - "velocityY": -0.1520136213744107, + "x": 4.570855977052453, + "y": 1.0738280106171412, + "heading": 3.1081926381636182, + "angularVelocity": 0.32113655862097673, + "velocityX": 2.868888676158945, + "velocityY": -0.1507113432992367, "moduleForcesX": [ - 100.23079205968564, - 100.98392888115625, - 103.49130741231629, - 101.35472988164179 + 89.08809122726427, + 100.7579318929463, + 84.54064179908963, + 98.64918125989954 ], "moduleForcesY": [ - -26.181867508904073, - -22.390549955983754, - 5.102781651117579, - 20.97639516911996 + 52.453084161766014, + 24.33536809116126, + -59.51415041556405, + -31.82516108397966 ], - "timestamp": 7.455752124904104 + "timestamp": 7.213331152687246 }, { - "x": 4.6706692184978085, - "y": 1.0700419744774925, - "heading": 2.9036900081376484, - "angularVelocity": 2.032513832619933, - "velocityX": 3.077098761481141, - "velocityY": -0.16648496638163585, + "x": 4.702886478240266, + "y": 1.0670159670138122, + "heading": 3.108595947975067, + "angularVelocity": 0.009421202681421935, + "velocityX": 3.0841950195825003, + "velocityY": -0.15912740439179773, "moduleForcesX": [ - 101.4022901583631, - 101.49973712392797, - 103.38179356673183, - 102.54009154829254 + 88.97153279637656, + 100.67185170490919, + 84.41297414011797, + 98.56875490305062 ], "moduleForcesY": [ - -20.460130196971843, - -19.145861980841424, - 4.12011250952299, - 12.751882075421097 + 52.29316044520558, + 24.305030951948087, + -59.383999366054645, + -31.779651043346263 ], - "timestamp": 7.502912888061544 + "timestamp": 7.2561398921961064 }, { - "x": 4.828133141104835, - "y": 1.061470786457346, - "heading": 3.0003548656233874, - "angularVelocity": 2.0496881520563304, - "velocityX": 3.3388756259383423, - "velocityY": -0.18174404836350594, + "x": 4.844113025567038, + "y": 1.0598302236654258, + "heading": 3.095694317757129, + "angularVelocity": -0.3013784186583571, + "velocityX": 3.299012046303043, + "velocityY": -0.1678569243295801, "moduleForcesX": [ - 102.6792974850671, - 102.66038096177155, - 102.96356872642492, - 102.939426086725 + 88.62959336610633, + 100.61041066833194, + 84.27835410029421, + 98.25990766190384 ], "moduleForcesY": [ - -8.525317491369549, - -8.235583388371387, - -3.8597400587840296, - -3.350865018387175 + 52.17924438635207, + 23.78466302835548, + -58.93296137680517, + -32.13890015705108 ], - "timestamp": 7.550073651218983 + "timestamp": 7.298948631704967 }, { "x": 4.994473934173584, "y": 1.0522435903549194, "heading": 3.069615115322268, - "angularVelocity": 1.4685990018368698, - "velocityX": 3.5271013853919833, - "velocityY": -0.19565408794644082, + "angularVelocity": -0.6092027640632386, + "velocityX": 3.5123881322272132, + "velocityY": -0.17722160001784806, "moduleForcesX": [ - 58.87926049401101, - 97.90553952546307, - 46.3522757191946, - 92.55927869131658 + 87.74948530062613, + 100.31459177779811, + 83.75899516652834, + 97.46139462629402 ], "moduleForcesY": [ - 80.63347164631476, - 29.303293505963616, - -88.46040550921222, - -43.328565242288015 + 51.62768559826387, + 22.65362039540959, + -57.70317606341726, + -32.78533166041236 ], - "timestamp": 7.597234414376422 + "timestamp": 7.341757371213827 }, { - "x": 5.21993980254767, - "y": 1.039630843584023, - "heading": 3.08612579482946, - "angularVelocity": 0.2463107723682536, - "velocityX": 3.363560667367391, - "velocityY": -0.18816035993378763, + "x": 5.220411209087956, + "y": 1.0394568906064166, + "heading": 3.0642021576954424, + "angularVelocity": -0.08079045747009987, + "velocityX": 3.3722000167562336, + "velocityY": -0.19084637150951397, "moduleForcesX": [ - -89.89760858727718, - 7.385392617841561, - -94.21103479178815, - -4.032488365945729 + -18.25974924770877, + -61.72570066835306, + -14.523924319494144, + -60.50942691174134 ], "moduleForcesY": [ - 50.674369616275214, - 102.01528692601666, - -42.13219571240748, - -102.27490978017325 + -41.395105821064156, + -26.076397284088287, + 28.930609473614382, + 23.47473958953477 ], - "timestamp": 7.664266316182598 + "timestamp": 7.408757333787733 }, { - "x": 5.420922348442108, - "y": 1.028282211672202, - "heading": 3.087184300804519, - "angularVelocity": 0.015791077778456095, - "velocityX": 2.998311855683048, - "velocityY": -0.16930195333911574, + "x": 5.421335815965932, + "y": 1.028068537679225, + "heading": 3.059593893702212, + "angularVelocity": -0.0687800980209144, + "velocityX": 2.9988764046893643, + "velocityY": -0.16997551177182332, "moduleForcesX": [ - -101.02914288206168, - -98.56977605934014, - -102.85614132118369, - -101.24146081662191 + -103.2664938988573, + -103.2751808850352, + -103.13301405288641, + -103.14332065108621 ], "moduleForcesY": [ - 22.827115278426835, - 31.24234686128395, - -12.191641059850506, - -21.03429499073052 + 4.541224118384727, + 4.630867167407542, + 6.93556034116202, + 6.971163895891921 ], - "timestamp": 7.7312982179887735 + "timestamp": 7.475757296361639 }, { - "x": 5.596884738261333, - "y": 1.0182966263987785, - "heading": 3.082148178112647, - "angularVelocity": -0.07513023733735659, - "velocityX": 2.625054415553102, - "velocityY": -0.1489676557633177, + "x": 5.597181183736462, + "y": 1.0180948163903252, + "heading": 3.055642266473313, + "angularVelocity": -0.058979543824966826, + "velocityX": 2.624559193993438, + "velocityY": -0.14886159492834625, "moduleForcesX": [ - -102.77315332713786, - -102.52922721443944, - -103.66971501009118, - -103.57607771279062 + -103.53305852533342, + -103.53469591125267, + -103.42317893872716, + -103.42578885136426 ], "moduleForcesY": [ - 13.830590440359913, - 15.251419200238098, - -2.496116046862724, - -4.111117694851949 + 4.8306687322724216, + 4.906393859163195, + 6.785485794504554, + 6.825037574562329 ], - "timestamp": 7.798330119794949 + "timestamp": 7.542757258935545 }, { - "x": 5.747733551223532, - "y": 1.0097082363442045, - "heading": 3.0745190793089487, - "angularVelocity": -0.11381295469965687, - "velocityX": 2.250403298990136, - "velocityY": -0.12812392044921225, + "x": 5.747925019771543, + "y": 1.0095411919696742, + "heading": 3.05229779161728, + "angularVelocity": -0.04991756304854153, + "velocityX": 2.2499092573185537, + "velocityY": -0.1276661074432343, "moduleForcesX": [ - -103.32486902872125, - -103.2942237860439, - -103.73764505407789, - -103.73181638939806 + -103.62208629776751, + -103.62173078672369, + -103.5202241170174, + -103.52060652438273 ], "moduleForcesY": [ - 9.484303024561918, - 9.676485182114542, - 2.1233990772684646, - 1.75365202837636 + 4.926128305543275, + 5.0005635670766955, + 6.733817674210244, + 6.777276521096291 ], - "timestamp": 7.865362021601125 + "timestamp": 7.609757221509451 }, { - "x": 5.873444227245606, - "y": 1.0025341434487187, - "heading": 3.0661617511748713, - "angularVelocity": -0.12467687636616408, - "velocityX": 1.875385788479751, - "velocityY": -0.10702505377559426, + "x": 5.873556159188288, + "y": 1.0024104036653874, + "heading": 3.049535712132861, + "angularVelocity": -0.04122508995990319, + "velocityX": 1.8750926805101673, + "velocityY": -0.10642973563491336, "moduleForcesX": [ - -103.56363844845902, - -103.56214591948665, - -103.68378743626758, - -103.6839446529072 + -103.66665324519711, + -103.6653199660069, + -103.56883625472425, + -103.56810747302617 ], "moduleForcesY": [ - 6.914243737313298, - 6.895026666759426, - 4.787160207313561, - 4.7233963185770085 + 4.973185116802823, + 5.048577308550577, + 6.707181320768238, + 6.75405185150205 ], - "timestamp": 7.9323939234073 + "timestamp": 7.676757184083357 }, { - "x": 5.974010415319068, - "y": 0.9967845639996021, - "heading": 3.0582409293271344, - "angularVelocity": -0.1181649577933858, - "velocityX": 1.5002735319109908, - "velocityY": -0.0857737777713852, + "x": 5.974067897354128, + "y": 0.996704097035998, + "heading": 3.047341170398741, + "angularVelocity": -0.032754372537126, + "velocityX": 1.5001760345007609, + "velocityY": -0.0851688032376159, "moduleForcesX": [ - -103.68647322434256, - -103.68567632686822, - -103.61320240133482, - -103.61288395314875 + -103.69341461870235, + -103.69148910140211, + -103.59803876166781, + -103.59663011099236 ], "moduleForcesY": [ - 5.206542405717511, - 5.249110661977166, - 6.503035230338926, - 6.529591244426612 + 5.001095808939345, + 5.0777995568546475, + 6.690824992522238, + 6.740434125392908 ], - "timestamp": 7.999425825213476 + "timestamp": 7.743757146657263 }, { - "x": 6.049431766890569, - "y": 0.9924662724676168, - "heading": 3.051554976537805, - "angularVelocity": -0.0997428479451764, - "velocityX": 1.1251560755292975, - "velocityY": -0.06442143838424273, + "x": 6.049455762238878, + "y": 0.9924233699091543, + "heading": 3.045704259638799, + "angularVelocity": -0.024431517527148842, + "velocityX": 1.1251926417363327, + "velocityY": -0.06389148534402293, "moduleForcesX": [ - -103.75677421099608, - -103.75270834682686, - -103.54776492224136, - -103.54673559392808 + -103.7112611091154, + -103.70894383397855, + -103.61751768625881, + -103.61565794570146 ], "moduleForcesY": [ - 3.985464683416833, - 4.1705499021545, - 7.693449422935552, - 7.750517296679296 + 5.019624761642934, + 5.097395248534811, + 6.679822686498952, + 6.7314307265973286 ], - "timestamp": 8.066457727019651 + "timestamp": 7.810757109231169 }, { - "x": 6.099710081045857, - "y": 0.9895840842861203, - "heading": 3.046685843199759, - "angularVelocity": -0.07263904509416273, - "velocityX": 0.7500654583942555, - "velocityY": -0.04299726106281018, + "x": 6.099716558467515, + "y": 0.989569006809897, + "heading": 3.0446179022503497, + "angularVelocity": -0.016214298437120946, + "velocityX": 0.7501615567798412, + "velocityY": -0.042602458115063656, "moduleForcesX": [ - -103.79993007073521, - -103.79334375915312, - -103.49115420635184, - -103.48989057299576 + -103.72400441579775, + -103.72142253974555, + -103.63142694229215, + -103.6292642891978 ], "moduleForcesY": [ - 3.0696514163509354, - 3.4109877407679896, - 8.567062634653622, - 8.631679427189365 + 5.032957243639672, + 5.11130283220324, + 6.672061132278851, + 6.724900296554289 ], - "timestamp": 8.133489628825828 + "timestamp": 7.877757071805075 }, { - "x": 6.124847888946533, - "y": 0.9881415963172908, + "x": 6.12484788894652, + "y": 0.9881415963172888, "heading": 3.0440767888466445, - "angularVelocity": -0.038922576904629844, - "velocityX": 0.37501260181103735, - "velocityY": -0.02151942478075615, + "angularVelocity": -0.008076323969709828, + "velocityX": 0.3750946942888271, + "velocityY": -0.021304646118706513, "moduleForcesX": [ - -103.82773310541879, - -103.82008730330988, - -103.44258569856589, - -103.44217710700607 + -103.73355085660772, + -103.73079678145365, + -103.64184438103867, + -103.63948865503173 ], "moduleForcesY": [ - 2.361430338717795, - 2.8438625635459225, - 9.239306415728796, - 9.294089241704407 + 5.0431852138632, + 5.121495388875575, + 6.666482603336728, + 6.7197724181306056 ], - "timestamp": 8.200521530632004 + "timestamp": 7.944757034378981 }, { "x": 6.124847888946533, "y": 0.988141596317291, "heading": 3.044076788846644, - "angularVelocity": 2.7103270983123612e-17, - "velocityX": -3.611620349514071e-17, - "velocityY": 3.713622586240161e-17, + "angularVelocity": 2.7161141224253378e-17, + "velocityX": -3.613596854420864e-17, + "velocityY": 3.7089850096461916e-17, "moduleForcesX": [ - -103.84628461386265, - -103.83885635426098, - -103.40030298005537, - -103.40264709813552 + -103.74095967535139, + -103.73810721466131, + -103.64992473488311, + -103.64746520965623 ], "moduleForcesY": [ - 1.803887986928977, - 2.3974582054604787, - 9.779530745408758, - 9.803777910373523 + 5.051470425075263, + 5.129071086156181, + 6.66249852967614, + 6.715452696467063 ], - "timestamp": 8.26755343243818 + "timestamp": 8.011756996952887 }, { - "x": 6.110634732554925, - "y": 0.997041194777477, - "heading": 3.0373126401476984, - "angularVelocity": -0.12304364450519946, - "velocityX": -0.2585452566507664, - "velocityY": 0.16188866896334042, + "x": 6.110634732561328, + "y": 0.9970411947826974, + "heading": 3.0373126401475794, + "angularVelocity": -0.12304364450736582, + "velocityX": -0.25854525665067285, + "velocityY": 0.1618886689632799, "moduleForcesX": [ - -84.8300601446508, - -75.0898929116376, - -96.37385776089208, - -92.14807124538784 + -84.83006014459953, + -75.08989291136919, + -96.37385776100199, + -92.14807124547087 ], "moduleForcesY": [ - 59.91992900493605, - 71.72511840476682, - 38.69327827800803, - 47.83930877720592 + 59.91992900500898, + 71.72511840504777, + 38.69327827773459, + 47.83930877704511 ], - "timestamp": 8.322527004833136 + "timestamp": 8.06673056934784 }, { - "x": 6.0822053465126045, - "y": 1.0148436356563937, - "heading": 3.0238865872883207, - "angularVelocity": -0.24422740372262675, - "velocityX": -0.5171464180619889, - "velocityY": 0.32383634715024767, + "x": 6.0822053465067905, + "y": 1.014843635655015, + "heading": 3.0238865872879876, + "angularVelocity": -0.24422740372652788, + "velocityX": -0.5171464180618228, + "velocityY": 0.32383634715015114, "moduleForcesX": [ - -84.7393743715122, - -75.3569946012607, - -96.21568889720955, - -92.20516713331142 + -84.739374371467, + -75.3569946010479, + -96.21568889729645, + -92.20516713338158 ], "moduleForcesY": [ - 60.03874061035034, - 71.43471959638731, - 39.06991075682854, - 47.71379033230931 + 60.03874061041446, + 71.43471959661174, + 39.069910756614824, + 47.71379033217303 ], - "timestamp": 8.37750057722809 + "timestamp": 8.121704141742793 }, { - "x": 6.03955634123586, - "y": 1.0415525633719367, - "heading": 3.003914713769894, - "angularVelocity": -0.36329953918474894, - "velocityX": -0.7758092373651998, - "velocityY": 0.48585031954004987, + "x": 6.039556341245207, + "y": 1.0415525633745906, + "heading": 3.003914713769281, + "angularVelocity": -0.3632995391898515, + "velocityX": -0.7758092373649862, + "velocityY": 0.4858503195399354, "moduleForcesX": [ - -84.59718960487209, - -75.67793809361636, - -96.01610596363868, - -92.30908778706126 + -84.59718960483518, + -75.67793809347147, + -96.01610596369684, + -92.30908778711465 ], "moduleForcesY": [ - 60.22794100568322, - 71.0830835385318, - 39.5407448611124, - 47.494736700529494 + 60.22794100573528, + 71.083083538686, + 39.54074486097146, + 47.494736700425264 ], - "timestamp": 8.432474149623046 + "timestamp": 8.176677714137746 }, { - "x": 5.982683900670879, - "y": 1.0771721914334311, - "heading": 2.977532671302065, - "angularVelocity": -0.4799040942489272, - "velocityX": -1.0345414730135558, - "velocityY": 0.647940938010814, + "x": 5.982683900674507, + "y": 1.0771721914258312, + "heading": 2.977532671301142, + "angularVelocity": -0.4799040942545924, + "velocityX": -1.0345414730133229, + "velocityY": 0.6479409380107021, "moduleForcesX": [ - -84.4117468485914, - -76.06724787133838, - -95.76969169073075, - -92.44518756493191 + -84.41174684856678, + -76.06724787127322, + -95.76969169075473, + -92.44518756496295 ], "moduleForcesY": [ - 60.47454381128638, - 70.65247665552374, - 40.11412819890906, - 47.20865349379163 + 60.47454381132092, + 70.65247665559389, + 40.11412819885202, + 47.208653493730665 ], - "timestamp": 8.487447722018 + "timestamp": 8.2316512865327 }, { - "x": 5.911583629045666, - "y": 1.1217075042934919, - "heading": 2.9449036806941926, - "angularVelocity": -0.5935395715863435, - "velocityX": -1.293353670479682, - "velocityY": 0.8101222265188435, + "x": 5.911583629035834, + "y": 1.121707504296573, + "heading": 2.944903680692972, + "angularVelocity": -0.5935395715917635, + "velocityX": -1.2933536704794637, + "velocityY": 0.8101222265187449, "moduleForcesX": [ - -84.19443291189384, - -76.54335998257876, - -95.46907770001037, - -92.5947680588966 + -84.19443291188921, + -76.54335998261115, + -95.46907769999206, + -92.59476805889527 ], "moduleForcesY": [ - 60.76103074765669, - 70.11956535871832, - 40.80122275955335, - 46.89017945698064 + 60.76103074766313, + 70.11956535868302, + 40.80122275959633, + 46.89017945698358 ], - "timestamp": 8.542421294412955 + "timestamp": 8.286624858927652 }, { - "x": 5.826250337220098, - "y": 1.1751644927011906, - "heading": 2.906229937044414, - "angularVelocity": -0.7034970071060459, - "velocityX": -1.5522602604983846, - "velocityY": 0.9724124896891126, + "x": 5.82625033723076, + "y": 1.1751644926956395, + "heading": 2.906229937042946, + "angularVelocity": -0.7034970071105705, + "velocityX": -1.5522602604982072, + "velocityY": 0.972412489689044, "moduleForcesX": [ - -83.96151353952493, - -77.12910808241261, - -95.10429131943967, - -92.73393871562132 + -83.96151353954032, + -77.12910808252042, + -95.10429131938795, + -92.73393871559084 ], "moduleForcesY": [ - 61.06320215655703, - 69.45398505600635, - 41.616710994168166, - 46.584965453798844 + 61.06320215653575, + 69.45398505588678, + 41.616710994286336, + 46.584965453860235 ], - "timestamp": 8.59739486680791 + "timestamp": 8.341598431322605 }, { - "x": 5.726677755243657, - "y": 1.2375504217085824, - "heading": 2.8617691881921195, - "angularVelocity": -0.8087658654028878, - "velocityX": -1.8112809054763035, - "velocityY": 1.1348349086300618, + "x": 5.726677755235851, + "y": 1.2375504217136353, + "heading": 2.861769188190487, + "angularVelocity": -0.8087658654059063, + "velocityX": -1.8112809054761907, + "velocityY": 1.1348349086300362, "moduleForcesX": [ - -83.73699636273983, - -77.85252008420294, - -94.66151602716938, - -92.83153124538079 + -83.73699636277946, + -77.85252008437688, + -94.6615160270873, + -92.83153124531917 ], "moduleForcesY": [ - 61.346478924432986, - 68.61600099000299, - 42.58035050989597, - 46.3541397930862 + 61.34647892437862, + 68.61600098980595, + 42.58035051007835, + 46.354139793210784 ], - "timestamp": 8.652368439202865 + "timestamp": 8.396572003717559 }, { - "x": 5.612858173253882, - "y": 1.3088741316664878, - "heading": 2.8118595087300506, - "angularVelocity": -0.9078849579484318, - "velocityX": -2.070441796602551, - "velocityY": 1.2974181385025019, + "x": 5.612858173258879, + "y": 1.3088741316636203, + "heading": 2.8118595087283933, + "angularVelocity": -0.9078849579489091, + "velocityX": -2.070441796602538, + "velocityY": 1.297418138502555, "moduleForcesX": [ - -83.55765429342505, - -78.74827893210937, - -94.12060181498998, - -92.8450386515704 + -83.55765429351254, + -78.7482789323879, + -94.1206018148576, + -92.84503865145162 ], "moduleForcesY": [ - 61.55910024103777, - 67.5524203141948, - 43.72035562235554, - 46.28181920567754 + 61.55910024091844, + 67.55242031387074, + 43.72035562264012, + 46.28181920591784 ], - "timestamp": 8.70734201159782 + "timestamp": 8.451545576112512 }, { - "x": 5.484782065278633, - "y": 1.3891463740366075, - "heading": 2.756958052279485, - "angularVelocity": -0.9986881706746032, - "velocityX": -2.329775970266254, - "velocityY": 1.4601969431488055, + "x": 5.484782065280293, + "y": 1.3891463740331047, + "heading": 2.756958052277954, + "angularVelocity": -0.9986881706723401, + "velocityX": -2.3297759702663448, + "velocityY": 1.460196943148917, "moduleForcesX": [ - -83.48255301270302, - -79.86072105764286, - -93.44967846698673, - -92.71215432517978 + -83.48255301281375, + -79.86072105792785, + -93.4496784668459, + -92.71215432504205 ], "moduleForcesY": [ - 61.61850058221323, - 66.18879981759747, - 45.08095523044974, - 46.48901620832081 + 61.6185005820626, + 66.18879981725462, + 45.080955230741196, + 46.48901620859793 ], - "timestamp": 8.762315583992775 + "timestamp": 8.506519148507465 }, { - "x": 5.342437911268035, - "y": 1.478380169844774, - "heading": 2.697706318550857, - "angularVelocity": -1.0778221452107346, - "velocityX": -2.589319700821736, - "velocityY": 1.6232126078772828, + "x": 5.342437911265935, + "y": 1.4783801698446344, + "heading": 2.697706318549636, + "angularVelocity": -1.0778221452051246, + "velocityX": -2.5893197008219415, + "velocityY": 1.623212607877452, "moduleForcesX": [ - -83.61299273219753, - -81.25057420713186, - -92.59228682646656, - -92.33167327612763 + -83.61299273235741, + -81.25057420745438, + -92.59228682629652, + -92.33167327594502 ], "moduleForcesY": [ - 61.38091527490915, - 64.41300325780229, - 46.74043198889193, - 47.162138052518856 + 61.380915274690516, + 64.41300325739722, + 46.74043198922804, + 47.16213805287967 ], - "timestamp": 8.81728915638773 + "timestamp": 8.561492720902418 }, { - "x": 5.185813016304511, - "y": 1.576591030565837, - "heading": 2.6350531319582737, - "angularVelocity": -1.1396964734701096, - "velocityX": -2.8490943580623322, - "velocityY": 1.7865104347236582, + "x": 5.1858130163033636, + "y": 1.5765910305618624, + "heading": 2.6350531319574313, + "angularVelocity": -1.1396964734632677, + "velocityX": -2.8490943580625947, + "velocityY": 1.7865104347238558, "moduleForcesX": [ - -84.13983054182101, - -83.01127626883185, - -91.43209699219983, - -91.51554352530742 + -84.13983054188876, + -83.01127626894349, + -91.4320969921366, + -91.51554352523937 ], "moduleForcesY": [ - 60.563239377036204, - 62.0362062074758, - 48.85926164168741, - 48.61805171407033 + 60.56323937694242, + 62.03620620732814, + 48.8592616418063, + 48.61805171420087 ], - "timestamp": 8.872262728782685 + "timestamp": 8.616466293297371 }, { - "x": 5.014898738142066, - "y": 1.6837958208609907, - "heading": 2.5705279236119396, - "angularVelocity": -1.1737495952192538, - "velocityX": -3.1090262232595176, - "velocityY": 1.9501150394720257, + "x": 5.014898738147155, + "y": 1.683795820864356, + "heading": 2.570527923611425, + "angularVelocity": -1.173749595213334, + "velocityX": -3.1090262232598085, + "velocityY": 1.9501150394722202, "moduleForcesX": [ - -85.47585344352798, - -85.3118067874862, - -89.674151663359, - -89.84880486421068 + -85.47585344347402, + -85.31180678742584, + -89.67415166341442, + -89.84880486427723 ], "moduleForcesY": [ - 58.49786820145132, - 58.686187699495015, - 51.83355824921669, - 51.47258989031521 + 58.49786820153291, + 58.68618769958436, + 51.83355824912394, + 51.4725898902009 ], - "timestamp": 8.92723630117764 + "timestamp": 8.671439865692324 }, { - "x": 4.829720072763227, - "y": 1.8000004850318336, - "heading": 2.5070278105659387, - "angularVelocity": -1.1551025389034095, - "velocityX": -3.3685033974467444, - "velocityY": 2.1138277739921136, + "x": 4.829720072773047, + "y": 1.8000004850362632, + "heading": 2.5070278105656283, + "angularVelocity": -1.155102538899726, + "velocityX": -3.3685033974470753, + "velocityY": 2.1138277739922944, "moduleForcesX": [ - -88.71709286679649, - -88.52155136043952, - -86.28201790264033, - -86.17716678134498 + -88.71709286665494, + -88.52155136032547, + -86.28201790279765, + -86.17716678150764 ], "moduleForcesY": [ - 53.08178703657719, - 53.4513782470058, - 56.95128514679214, - 57.15148028733032 + 53.08178703682181, + 53.45137824719711, + 56.95128514656165, + 57.15148028708766 ], - "timestamp": 8.982209873572595 + "timestamp": 8.726413438087278 }, { - "x": 4.630631373212693, - "y": 1.9250518086015365, - "heading": 2.452690751238951, - "angularVelocity": -0.9884214716229549, - "velocityX": -3.6215346918107696, - "velocityY": 2.274753452012011, + "x": 4.630631373197701, + "y": 1.9250518085990234, + "heading": 2.4526907512388036, + "angularVelocity": -0.9884214716200167, + "velocityX": -3.621534691811259, + "velocityY": 2.2747534520121397, "moduleForcesX": [ - -97.46251239739685, - -93.61667564220168, - -73.96265211772815, - -75.96886555450617 + -97.4625123973849, + -93.61667564220114, + -73.96265211784451, + -75.9688655545753 ], "moduleForcesY": [ - 32.669165400789424, - 43.24143764085197, - 71.27489026029656, - 69.69431663085776 + 32.66916540086088, + 43.24143764087089, + 71.27489026019346, + 69.69431663079334 ], - "timestamp": 9.03718344596755 + "timestamp": 8.78138701048223 }, { - "x": 4.422647731603957, - "y": 2.0565226976459505, - "heading": 2.440254457435589, - "angularVelocity": -0.22622313343613798, - "velocityX": -3.7833386576608445, - "velocityY": 2.3915289350428397, + "x": 4.422647731607199, + "y": 2.0565226976433393, + "heading": 2.440254457435579, + "angularVelocity": -0.22622313343364486, + "velocityX": -3.7833386576614494, + "velocityY": 2.3915289350430577, "moduleForcesX": [ - -86.57780281800447, - -99.29523053350272, - 21.236859668111055, - -53.42730625172477 + -86.57780281805616, + -99.2952305335068, + 21.2368596680207, + -53.427306251741676 ], "moduleForcesY": [ - -50.874712392323595, - 24.44800200918981, - 96.72683386602516, - 87.07839358262116 + -50.87471239226852, + 24.448002009206352, + 96.72683386607464, + 87.07839358262063 ], - "timestamp": 9.092157018362505 + "timestamp": 8.836360582877184 }, { - "x": 4.211642888888173, - "y": 2.188920329555242, - "heading": 2.439987241979953, - "angularVelocity": -0.004860798452689113, - "velocityX": -3.838295994465358, - "velocityY": 2.4083869055219655, + "x": 4.2116428888881625, + "y": 2.1889203295552395, + "heading": 2.439987241979948, + "angularVelocity": -0.004860798452597401, + "velocityX": -3.838295994465267, + "velocityY": 2.4083869055221276, "moduleForcesX": [ - -17.895066941329745, - -36.38334507069944, - 0.42343583903259896, - -20.211120097252607 + -17.895066941079264, + -36.38334507030241, + 0.4234358390630315, + -20.21112009699484 ], "moduleForcesY": [ - -13.978656655930484, - 3.9758187707995822, - 8.014896542371337, - 24.707456825662696 + -13.978656655713657, + 3.9758187708014625, + 8.014896542310398, + 24.707456825429773 ], - "timestamp": 9.14713059075746 + "timestamp": 8.891334155272137 }, { "x": 4.0005412101745605, "y": 2.321166753768921, "heading": 2.439727894004586, - "angularVelocity": -0.004717684590404729, - "velocityX": -3.84005749520817, - "velocityY": 2.405636353110956, + "angularVelocity": -0.004717684590317965, + "velocityX": -3.8400574952080944, + "velocityY": 2.40563635311109, "moduleForcesX": [ - -0.5924713914104806, - -0.6056971386509346, - -0.5812916448891551, - -0.594517371689846 + -0.5924713914159432, + -0.6056971386559915, + -0.5812916448950497, + -0.5945173716952727 ], "moduleForcesY": [ - -0.9389327981490366, - -0.927751437643592, - -0.9257106944955843, - -0.914529231532693 + -0.9389327981580513, + -0.9277514376530072, + -0.925710694505112, + -0.9145292315425559 ], - "timestamp": 9.202104163152415 + "timestamp": 8.94630772766709 } ], "eventMarkers": [ { - "timestamp": 5.8797537526195125, + "timestamp": 5.787176478248669, "command": { "type": "named", "data": { @@ -3036,7 +3015,7 @@ } }, { - "timestamp": 2.739361127567343, + "timestamp": 2.7393611275673457, "command": { "type": "named", "data": { @@ -3054,7 +3033,7 @@ } }, { - "timestamp": 7.467553432438181, + "timestamp": 7.211756996952887, "command": { "type": "named", "data": {