From 9b1c58d661529855ebf7892b42f4d8ab463c3e4f Mon Sep 17 00:00:00 2001 From: fcuellar13 <105395555+fcuellar13@users.noreply.github.com> Date: Fri, 8 Nov 2024 14:57:29 -0800 Subject: [PATCH] lower max speed for autos from 4000 to 3800 rpm --- choreo_traj.chor | 27914 ++++++++-------- src/main/deploy/choreo/Blue 4 to 5.1.traj | 480 +- src/main/deploy/choreo/Blue 4 to 5.traj | 480 +- src/main/deploy/choreo/Blue 5 to Amp.1.traj | 1062 +- src/main/deploy/choreo/Blue 5 to Amp.traj | 1062 +- .../deploy/choreo/Blue Amp 5 Piece.1.traj | 672 +- .../deploy/choreo/Blue Amp 5 Piece.2.traj | 481 +- .../deploy/choreo/Blue Amp 5 Piece.3.traj | 455 +- .../deploy/choreo/Blue Amp 5 Piece.4.traj | 868 +- .../deploy/choreo/Blue Amp 5 Piece.5.traj | 670 +- .../deploy/choreo/Blue Amp 5 Piece.6.traj | 374 +- .../deploy/choreo/Blue Amp 5 Piece.7.traj | 400 +- .../deploy/choreo/Blue Amp 5 Piece.8.traj | 280 +- .../deploy/choreo/Blue Amp 5 Piece.9.traj | 280 +- src/main/deploy/choreo/Blue Amp 5 Piece.traj | 4312 +-- src/main/deploy/choreo/Blue OP.1.traj | 294 +- src/main/deploy/choreo/Blue OP.2.traj | 546 +- src/main/deploy/choreo/Blue OP.3.traj | 664 +- src/main/deploy/choreo/Blue OP.4.traj | 511 +- src/main/deploy/choreo/Blue OP.5.traj | 870 +- src/main/deploy/choreo/Blue OP.6.traj | 694 +- src/main/deploy/choreo/Blue OP.traj | 3475 +- .../deploy/choreo/Blue Source 4 Piece.1.traj | 727 +- .../deploy/choreo/Blue Source 4 Piece.2.traj | 631 +- .../deploy/choreo/Blue Source 4 Piece.3.traj | 814 +- .../deploy/choreo/Blue Source 4 Piece.4.traj | 814 +- .../deploy/choreo/Blue Source 4 Piece.5.traj | 884 +- .../deploy/choreo/Blue Source 4 Piece.6.traj | 702 +- .../deploy/choreo/Blue Source 4 Piece.traj | 4464 +-- src/main/deploy/choreo/Red 4 to 5.1.traj | 510 +- src/main/deploy/choreo/Red 4 to 5.traj | 510 +- src/main/deploy/choreo/Red 5 to Amp.1.traj | 1068 +- src/main/deploy/choreo/Red 5 to Amp.traj | 1068 +- src/main/deploy/choreo/Red Amp 5 Piece.1.traj | 678 +- src/main/deploy/choreo/Red Amp 5 Piece.2.traj | 487 +- src/main/deploy/choreo/Red Amp 5 Piece.3.traj | 487 +- src/main/deploy/choreo/Red Amp 5 Piece.4.traj | 870 +- src/main/deploy/choreo/Red Amp 5 Piece.5.traj | 674 +- src/main/deploy/choreo/Red Amp 5 Piece.6.traj | 402 +- src/main/deploy/choreo/Red Amp 5 Piece.7.traj | 402 +- src/main/deploy/choreo/Red Amp 5 Piece.8.traj | 284 +- src/main/deploy/choreo/Red Amp 5 Piece.9.traj | 282 +- src/main/deploy/choreo/Red Amp 5 Piece.traj | 4386 +-- src/main/deploy/choreo/Red OP.1.traj | 294 +- src/main/deploy/choreo/Red OP.2.traj | 546 +- src/main/deploy/choreo/Red OP.3.traj | 670 +- src/main/deploy/choreo/Red OP.4.traj | 513 +- src/main/deploy/choreo/Red OP.5.traj | 870 +- src/main/deploy/choreo/Red OP.6.traj | 696 +- src/main/deploy/choreo/Red OP.traj | 3483 +- .../deploy/choreo/Red Source 4 Piece.1.traj | 741 +- .../deploy/choreo/Red Source 4 Piece.2.traj | 633 +- .../deploy/choreo/Red Source 4 Piece.3.traj | 814 +- .../deploy/choreo/Red Source 4 Piece.4.traj | 816 +- .../deploy/choreo/Red Source 4 Piece.5.traj | 878 +- .../deploy/choreo/Red Source 4 Piece.6.traj | 702 +- .../deploy/choreo/Red Source 4 Piece.traj | 4476 +-- 57 files changed, 42375 insertions(+), 41745 deletions(-) diff --git a/choreo_traj.chor b/choreo_traj.chor index 4f53ebe..6e9baf7 100644 --- a/choreo_traj.chor +++ b/choreo_traj.chor @@ -4,7 +4,7 @@ "mass": 56.80078236903715, "rotationalInertia": 6, "motorMaxTorque": 1.0949416342412452, - "motorMaxVelocity": 4000, + "motorMaxVelocity": 3800, "gearing": 5.35714, "wheelbase": 0.777, "trackWidth": 0.579, @@ -49,7 +49,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { "x": 9.1, @@ -58,7 +58,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { "x": 12.638096809387207, @@ -155,10 +155,10 @@ { "x": 15.20169734954834, "y": 6.508597373962402, - "heading": -4.3528887118527857e-23, - "angularVelocity": -6.603140405428085e-24, - "velocityX": -1.2060893015993952e-21, - "velocityY": 7.138840853465489e-22, + "heading": -8.498320371979777e-23, + "angularVelocity": -1.303634376415855e-23, + "velocityX": -2.443695081429881e-20, + "velocityY": 2.3610421524139276e-20, "moduleForcesX": [ 0, 0, @@ -174,3112 +174,3154 @@ "timestamp": 0 }, { - "x": 15.179626306424254, - "y": 6.490858286972303, - "heading": -1.6477847497890382e-10, - "angularVelocity": -2.7912762094873322e-9, - "velocityX": -0.3738739395345731, - "velocityY": -0.3004924733030536, + "x": 15.179323748097806, + "y": 6.491593300242642, + "heading": -3.446686628016041e-10, + "angularVelocity": -5.8607425984795884e-9, + "velocityX": -0.38044050200785395, + "velocityY": -0.2891371045661442, "moduleForcesX": [ - -89.93357437032712, - -89.93357449974754, - -89.93357458600433, - -89.93357471542474 + -91.8611587363816, + -91.8611589873367, + -91.86115917858633, + -91.86115942954144 ], "moduleForcesY": [ - -72.28201666391972, - -72.28201650320274, - -72.28201639524063, - -72.28201623452364 + -69.81504228033312, + -69.81504195081375, + -69.8150416977938, + -69.81504136827444 ], - "timestamp": 0.05903338208477801 + "timestamp": 0.058809725390574434 }, { - "x": 15.134092099800656, - "y": 6.457273283717531, - "heading": -4.5125780037436346e-10, - "angularVelocity": -4.852836061196729e-9, - "velocityX": -0.7713297970664511, - "velocityY": -0.5689154520494917, + "x": 15.133401882134509, + "y": 6.459259290320045, + "heading": -9.442226120947298e-10, + "angularVelocity": -1.0194809537218462e-8, + "velocityX": -0.7808549633298901, + "velocityY": -0.5498071910361231, "moduleForcesX": [ - -95.60609117215738, - -95.60609124537726, - -95.60609131724519, - -95.60609139046507 + -96.68407083847598, + -96.68407098415932, + -96.68407113790389, + -96.68407128358724 ], "moduleForcesY": [ - -64.56785423072616, - -64.56785412261053, - -64.56785401562026, - -64.56785390750461 + -62.941396315731794, + -62.94139609260596, + -62.941395855206785, + -62.941395632080955 ], - "timestamp": 0.11806676416955603 + "timestamp": 0.11761945078114887 }, { - "x": 15.063455246346447, - "y": 6.4106030861332375, - "heading": -7.923518954984216e-10, - "angularVelocity": -5.777986675982209e-9, - "velocityX": -1.1965577942454486, - "velocityY": -0.7905729933831352, + "x": 15.062531609729039, + "y": 6.4140078818149915, + "heading": -1.6620460583836768e-9, + "angularVelocity": -1.2205862916746293e-8, + "velocityX": -1.2050774244361186, + "velocityY": -0.769454511214313, "moduleForcesX": [ - -102.28654560786366, - -102.28654562921926, - -102.28654566257885, - -102.28654568393446 + -102.43275032289199, + -102.43275036895025, + -102.43275044168742, + -102.4327504877457 ], "moduleForcesY": [ - -53.3186535242474, - -53.31865348347508, - -53.318653419144425, - -53.318653378372105 + -53.03603947289089, + -53.03603938436765, + -53.036039243151045, + -53.036039154627815 ], - "timestamp": 0.17710014625433404 + "timestamp": 0.1764291761717233 }, { - "x": 14.965964427690755, - "y": 6.354993169367382, - "heading": -1.0815114154157552e-9, - "angularVelocity": -4.898237399002934e-9, - "velocityX": -1.6514523683512154, - "velocityY": -0.942007975860076, + "x": 14.96515989030649, + "y": 6.359448552089575, + "heading": -2.28357279584149e-9, + "angularVelocity": -1.0568434614002256e-8, + "velocityX": -1.655707772411321, + "velocityY": -0.9277263133447721, "moduleForcesX": [ - -109.42269779178156, - -109.42269778273729, - -109.42269775576457, - -109.42269774672029 + -108.80919849872593, + -108.80919848005888, + -108.80919842819559, + -108.80919840952853 ], "moduleForcesY": [ - -36.426955237033994, - -36.426955263872905, - -36.42695534537222, - -36.42695537221113 + -38.216307330242316, + -38.216307382799684, + -38.21630753133454, + -38.21630758389191 ], - "timestamp": 0.23613352833911205 + "timestamp": 0.23523890156229774 }, { - "x": 14.84031024724876, - "y": 6.296639809307858, - "heading": -1.1586671377582547e-9, - "angularVelocity": -1.3069846181547316e-9, - "velocityX": -2.1285275551643497, - "velocityY": -0.9884807205476066, + "x": 14.839966986250749, + "y": 6.301073904680198, + "heading": -2.4785955133946477e-9, + "angularVelocity": -3.3161643972635273e-9, + "velocityX": -2.1287789260074454, + "velocityY": -0.9926019382286347, "moduleForcesX": [ - -114.75813729736898, - -114.7581372935656, - -114.75813725195086, - -114.75813724814746 + -114.22775518362515, + -114.22775516938998, + -114.22775505468461, + -114.22775504044945 ], "moduleForcesY": [ - -11.178794542775593, - -11.178794576619985, - -11.17879500970412, - -11.178795043548515 + -15.664867092783735, + -15.664867188866841, + -15.66486803443501, + -15.664868130518121 ], - "timestamp": 0.2951669104238901 + "timestamp": 0.29404862695287215 }, { - "x": 14.686942751138512, - "y": 6.243977280961659, - "heading": -8.363450931363897e-10, - "angularVelocity": 5.459996246852681e-9, - "velocityX": -2.5979791550820597, - "velocityY": -0.8920804888083312, + "x": 14.687002517259797, + "y": 6.246814000732414, + "heading": -1.8217268295736112e-9, + "angularVelocity": 1.1169388727096216e-8, + "velocityX": -2.6010063467405375, + "velocityY": -0.9226348803268004, "moduleForcesX": [ - -112.92432010689039, - -112.92432007869421, - -112.92432028404276, - -112.9243202558466 + -114.02402726270896, + -114.02402722958728, + -114.02402754037327, + -114.0240275072516 ], "moduleForcesY": [ - 23.188611580505953, - 23.18861171251525, - 23.188610716345337, - 23.188610848354628 + 16.89424580273815, + 16.894246009646327, + 16.894243925394832, + 16.894244132302983 ], - "timestamp": 0.35420029250866814 + "timestamp": 0.3528583523434466 }, { "x": 14.509410858154297, "y": 6.206027030944824, - "heading": 1.6870395426082385e-22, - "angularVelocity": 1.4167324716980014e-8, - "velocityX": -3.0073136031620438, - "velocityY": -0.6428608471446768, + "heading": 3.969467826839008e-22, + "angularVelocity": 3.0976625336632224e-8, + "velocityX": -3.0197668485281395, + "velocityY": -0.6935412385742346, "moduleForcesX": [ - -98.46342884163919, - -98.46342857989734, - -98.46342941505019, - -98.46342915330834 + -101.11390541508874, + -101.11390491533385, + -101.11390663127975, + -101.1139061315249 ], "moduleForcesY": [ - 59.948584128622876, - 59.948584555913705, - 59.94858318468237, - 59.94858361197319 + 55.316948669637505, + 55.316949575911146, + 55.316946441253606, + 55.316947347527226 ], - "timestamp": 0.4132336745934462 + "timestamp": 0.41166807773402103 }, { - "x": 14.39870668839677, - "y": 6.191150636092829, - "heading": 6.682629988227654e-10, - "angularVelocity": 1.925590029446468e-8, - "velocityX": -3.1899244141732552, - "velocityY": -0.428661135684424, + "x": 14.395876140440663, + "y": 6.189128805794054, + "heading": 1.522966758732963e-9, + "angularVelocity": 4.3040847489578005e-8, + "velocityX": -3.2086258231614164, + "velocityY": -0.4775638912593676, "moduleForcesX": [ - -74.7200621801483, - -74.72006152267782, - -74.72006292902194, - -74.72006227155148 + -75.79182122905944, + -75.79181974401823, + -75.79182296295163, + -75.79182147791046 ], "moduleForcesY": [ - 87.64549967297297, - 87.64550023101394, - 87.64549903065125, - 87.64549958869223 + 86.67481425219046, + 86.67481554424141, + 86.67481272599154, + 86.67481401804254 ], - "timestamp": 0.4479379983904785 + "timestamp": 0.4470522963905207 }, { - "x": 14.281833992771213, - "y": 6.183842078444728, - "heading": 1.46563128230524e-9, - "angularVelocity": 2.297605013558962e-8, - "velocityX": -3.36766958230001, - "velocityY": -0.2105950166568239, + "x": 14.276015624628796, + "y": 6.18016177358942, + "heading": 3.3017017289639248e-9, + "angularVelocity": 5.0269160596653465e-8, + "velocityX": -3.387400382510616, + "velocityY": -0.2534189688256986, "moduleForcesX": [ - -72.72915521902236, - -72.7291547139971, - -72.72915576861566, - -72.72915526359041 + -71.7448005057056, + -71.74479952082729, + -71.74480155376283, + -71.7448005688845 ], "moduleForcesY": [ - 89.22754297343529, - 89.2275433829778, - 89.22754252200183, - 89.22754293154432 + 89.95257946983574, + 89.95258025082046, + 89.95257862628402, + 89.95257940726874 ], - "timestamp": 0.4826423221875108 + "timestamp": 0.48243651504702034 }, { - "x": 14.159050528640018, - "y": 6.184294815459166, - "heading": 2.3229765945150137e-9, - "angularVelocity": 2.470427942131417e-8, - "velocityX": -3.5379875098357174, - "velocityY": 0.013045550666414774, + "x": 14.150428609865713, + "y": 6.179555476543678, + "heading": 5.078023376549813e-9, + "angularVelocity": 5.020095723547424e-8, + "velocityX": -3.5492380369409227, + "velocityY": -0.017134673839445464, "moduleForcesX": [ - -69.69010253451697, - -69.69010228267354, - -69.69010279033854, - -69.69010253849511 + -64.9477771261755, + -64.94777713696463, + -64.9477771163259, + -64.94777712711503 ], "moduleForcesY": [ - 91.50847649519069, - 91.50847668582223, - 91.50847629831208, - 91.5084764889436 + 94.82428414669329, + 94.82428413935362, + 94.82428415353773, + 94.82428414619807 ], - "timestamp": 0.5173466459845432 + "timestamp": 0.51782073370352 }, { - "x": 14.03079533153799, - "y": 6.192809216565774, - "heading": 3.1312188046741175e-9, - "angularVelocity": 2.3289380737857663e-8, - "velocityX": -3.6956546928309977, - "velocityY": 0.2453412190481945, + "x": 14.020285286516224, + "y": 6.187978683471175, + "heading": 6.434200940526406e-9, + "angularVelocity": 3.832718696268834e-8, + "velocityX": -3.6780047233170614, + "velocityY": 0.23804982128522642, "moduleForcesX": [ - -64.51371447905602, - -64.51371470905573, - -64.51371427113206, - -64.51371450113174 + -51.67592186533519, + -51.67592423146429, + -51.67592027633643, + -51.675922642465494 ], "moduleForcesY": [ - 95.0499409165131, - 95.04994076157361, - 95.04994105995034, - 95.04994090501086 + 102.40920632891186, + 102.4092051448318, + 102.40920715698425, + 102.40920597290425 ], - "timestamp": 0.5520509697815755 + "timestamp": 0.5532049523600197 }, { - "x": 13.897963803701671, - "y": 6.20989769926313, - "heading": 3.696973755747146e-9, - "angularVelocity": 1.630214593379525e-8, - "velocityX": -3.827520991712204, - "velocityY": 0.4924021224934038, + "x": 13.888371101336414, + "y": 6.206318425861406, + "heading": 6.680653519085837e-9, + "angularVelocity": 6.96504226789965e-9, + "velocityX": -3.7280513796388863, + "velocityY": 0.5183028787005002, "moduleForcesX": [ - -53.95659746008519, - -53.95659882762597, - -53.95659649016197, - -53.95659785770273 + -20.084439343980858, + -20.08444787570321, + -20.08443732182004, + -20.084445853541588 ], "moduleForcesY": [ - 101.09152899469004, - 101.0915282719287, - 101.09152953035384, - 101.09152880759252 + 112.46958106687981, + 112.46957956001785, + 112.46958155352253, + 112.46958004666087 ], - "timestamp": 0.5867552935786079 + "timestamp": 0.5885891710165193 }, { - "x": 13.763055492335095, - "y": 6.236418641581392, - "heading": 3.6171222083325864e-9, - "angularVelocity": -2.300910626632439e-9, - "velocityX": -3.8873632045270554, - "velocityY": 0.7641970629760271, + "x": 13.758040033310886, + "y": 6.234528802394688, + "heading": 6.645267838303864e-9, + "angularVelocity": -1.00004132140941e-9, + "velocityX": -3.6833106106071467, + "velocityY": 0.7972587103629364, "moduleForcesX": [ - -24.48602860516184, - -24.486033599316524, - -24.48602715105942, - -24.48603214521383 + 17.955115066486492, + 17.95511290507103, + 17.955114609991067, + 17.95511244857563 ], "moduleForcesY": [ - 111.21211725559331, - 111.21211617203417, - 111.21211767341897, - 111.21211658985995 + 111.94898498074906, + 111.94898532090953, + 111.9489851083639, + 111.94898544852435 ], - "timestamp": 0.6214596173756403 + "timestamp": 0.623973389673019 }, { "x": 13.630112648010254, "y": 6.272213459014893, - "heading": -1.0376160127202523e-19, - "angularVelocity": -1.0422684589940892e-7, - "velocityX": -3.830728560001787, - "velocityY": 1.0314224141881108, + "heading": -1.5585370169858288e-19, + "angularVelocity": -1.8780315323536185e-7, + "velocityX": -3.6153796850091533, + "velocityY": 1.0650131061543873, "moduleForcesX": [ - 23.17358566119532, - 23.173558952779945, - 23.17357832384853, - 23.17355161544207 + 27.261687418434768, + 27.261641389084208, + 27.261672495978797, + 27.261626473603524 ], "moduleForcesY": [ - 109.34234401324875, - 109.34234948074236, - 109.342346790233, - 109.34235225772296 + 107.45367915993488, + 107.45369033038008, + 107.45368563018035, + 107.45369679884966 ], - "timestamp": 0.6561639411726726 + "timestamp": 0.6593576083295186 }, { - "x": 13.379601321542795, - "y": 6.323151596088256, - "heading": -0.000044770172369445994, - "angularVelocity": -0.0006952279229347041, - "velocityX": -3.8901451558951234, - "velocityY": 0.7910091331219953, + "x": 13.390615610810706, + "y": 6.321687036535878, + "heading": -0.00007211348501602596, + "angularVelocity": -0.00111204705585835, + "velocityX": -3.6932340053371213, + "velocityY": 0.7629217505264949, "moduleForcesX": [ - -13.064389136262065, - -13.121852274728727, - -13.082219112887778, - -13.13989401364793 + -16.987922786840045, + -17.082996331763876, + -17.01360023100258, + -17.109096037679436 ], "moduleForcesY": [ - -53.03975477268047, - -53.028859886833715, - -52.99881173697238, - -52.9888901966368 + -66.19005542155882, + -66.17422233699283, + -66.12851592804181, + -66.11296782709219 ], - "timestamp": 0.720560336789899 + "timestamp": 0.7242051205243725 }, { - "x": 13.148958187009413, - "y": 6.368906756131173, - "heading": -0.05557421160697782, - "angularVelocity": -0.86230666953282, - "velocityX": -3.5816155907906864, - "velocityY": 0.7105236186647266, + "x": 13.157753730626089, + "y": 6.367449891304318, + "heading": -0.020349716479967844, + "angularVelocity": -0.312696698896045, + "velocityX": -3.590914628843632, + "velocityY": 0.7056994666338302, "moduleForcesX": [ - 77.93257191876994, - 44.11069948512947, - 88.44467603296238, - 61.65027573448044 + 29.89084865554921, + 13.030490785947396, + 32.10384734704793, + 14.597690630081734 ], "moduleForcesY": [ - -49.06442321549933, - -66.62250167596093, - 15.430666972718294, - 29.26408286408135 + -24.010835804939674, + -25.326666831059267, + -0.4836556990558821, + -0.30058703399048453 ], - "timestamp": 0.7849567324071254 + "timestamp": 0.7890526327192263 }, { - "x": 12.951234166317056, - "y": 6.408161403232974, - "heading": -0.10764799496471299, - "angularVelocity": -0.8086443792174783, - "velocityX": -3.0704206158933536, - "velocityY": 0.609578326947544, + "x": 12.957356286277964, + "y": 6.40709453148691, + "heading": -0.07061445763616857, + "angularVelocity": -0.7751221204163579, + "velocityX": -3.090287315047219, + "velocityY": 0.6113517518369715, "moduleForcesX": [ - 113.31038231556686, - 113.37930141281873, - 112.03346259287166, - 112.1759178108579 + 107.3795653758912, + 101.86125988189073, + 114.8648292984834, + 114.40034415500577 ], "moduleForcesY": [ - -19.252528450963577, - -18.974700403964082, - -25.67152082683337, - -25.13995335510332 + -40.97120389792557, + -52.80126855800278, + 3.191564836013126, + 7.940512733376601 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.8539001449140802 }, { - "x": 12.7864611895928, - "y": 6.440888378700205, - "heading": -0.15272288248178728, - "angularVelocity": -0.699959789442261, - "velocityX": -2.5587298038180677, - "velocityY": 0.5082112927835478, + "x": 12.790427998602441, + "y": 6.440171200929543, + "heading": -0.1227572585272402, + "angularVelocity": -0.8040832890303166, + "velocityX": -2.5741664101768, + "velocityY": 0.5100684409178722, "moduleForcesX": [ - 114.09477809264015, - 114.09797780307369, - 111.442266391589, - 111.70139457807396 + 112.71395426887749, + 112.66218369215821, + 113.36635432566672, + 113.33454508007034 ], "moduleForcesY": [ - -15.913469790929499, - -16.046789303580823, - -29.18564939151568, - -28.264792093676622 + -23.760754374513482, + -23.975233317910366, + -20.419260667878685, + -20.560125698223537 ], - "timestamp": 0.9137495236415782 + "timestamp": 0.918747657108934 }, { - "x": 12.654642871116208, - "y": 6.467078064626328, - "heading": -0.18960174396775148, - "angularVelocity": -0.5726851810957397, - "velocityX": -2.0469828662480234, - "velocityY": 0.4066949038855515, + "x": 12.65696171804704, + "y": 6.466645530685566, + "heading": -0.16925593959498417, + "angularVelocity": -0.7170464909744682, + "velocityX": -2.0581557570683704, + "velocityY": 0.4082551336198239, "moduleForcesX": [ - 114.36206703200182, - 114.29110618647663, - 111.25270682753312, - 111.48004226113034 + 114.00144220452592, + 113.99095150053918, + 111.92404445290293, + 112.06402825139133 ], "moduleForcesY": [ - -14.58829144036612, - -15.26085484138321, - -30.238604229918433, - -29.45468827574684 + -17.14637544539112, + -17.295470407167763, + -27.630401033773403, + -27.107357918418792 ], - "timestamp": 0.9781459192588047 + "timestamp": 0.9835951693037879 }, { - "x": 12.555779549706159, - "y": 6.486724686682261, - "heading": -0.21768842940260533, - "angularVelocity": -0.43615306673065574, - "velocityX": -1.5352306672208027, - "velocityY": 0.3050888464738352, + "x": 12.556912258763324, + "y": 6.486507786121201, + "heading": -0.2065751634433522, + "angularVelocity": -0.5754919901357388, + "velocityX": -1.5428419055319835, + "velocityY": 0.3062917105586495, "moduleForcesX": [ - 114.49936666718258, - 114.37291094617846, - 111.17407977417163, - 111.34420578314155 + 114.52951979915348, + 114.41545555950175, + 111.1038117502864, + 111.32134170829701 ], "moduleForcesY": [ - -13.847592290942329, - -14.958857918151065, - -30.693310454837178, - -30.121770154712582 + -13.56849995910181, + -14.610037306397269, + -30.935423415458633, + -30.197132480137224 ], - "timestamp": 1.042542314876031 + "timestamp": 1.0484426814986416 }, { - "x": 12.489870969885784, - "y": 6.4998244090967265, - "heading": -0.23662843692451097, - "angularVelocity": -0.29411595696264536, - "velocityX": -1.0234824354477663, - "velocityY": 0.20342322406258137, + "x": 12.490240750486658, + "y": 6.499752126190816, + "heading": -0.23266460878981102, + "angularVelocity": -0.40231991117971083, + "velocityX": -1.028127464263096, + "velocityY": 0.2042382139474869, "moduleForcesX": [ - 114.58169370325793, - 114.41751735086616, - 111.13270734016913, - 111.25514546342465 + 114.80042068735366, + 114.61054935161582, + 110.59863478703036, + 110.83549271399136 ], "moduleForcesY": [ - -13.383209155395406, - -14.806913472109198, - -30.942388952575417, - -30.541558492400497 + -11.333508890235418, + -13.232312421101899, + -32.792340177493294, + -32.03182827040542 ], - "timestamp": 1.1069387104932575 + "timestamp": 1.1132901936934954 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": -0.14840255835934948, - "velocityX": -0.5117392128533444, - "velocityY": 0.10172039612632167, + "angularVelocity": -0.20849555419783833, + "velocityX": -0.5138815704216196, + "velocityY": 0.10212743022895641, "moduleForcesX": [ - 114.63396863953953, - 114.44886671702369, - 111.10080141802345, - 111.19900874167566 + 114.95598681748038, + 114.72482442231708, + 110.24775114592639, + 110.5061283467711 ], "moduleForcesY": [ - -13.08662495525689, - -14.690983770852931, - -31.12304727525516, - -30.806231170714476 + -9.848309354372528, + -12.36579682333574, + -34.015560796460676, + -33.21050131016418 ], - "timestamp": 1.171335106110484 + "timestamp": 1.178137705888349 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": 3.1053355931895455e-20, - "velocityX": 1.4124500530750476e-19, - "velocityY": 6.271253114440515e-19, + "angularVelocity": -4.8297071609365385e-20, + "velocityX": 6.470993194950448e-19, + "velocityY": 3.3178230289344078e-18, + "moduleForcesX": [ + 115.05021982561283, + 114.80814664741968, + 109.96652897988751, + 110.29067964070444 + ], + "moduleForcesY": [ + -8.850873959259241, + -11.686076549662568, + -34.957520485564494, + -33.96027818561143 + ], + "timestamp": 1.2429852180832028 + }, + { + "x": 12.397672522253476, + "y": 6.523112878711347, + "heading": -0.23760577600202967, + "angularVelocity": 0.09853884197084228, + "velocityX": -0.6804630807935004, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - 114.6667993998726, - 114.47707589122747, - 111.06552665667455, - 111.1697067800059 + -109.87343425060293, + -109.71928226568586, + -112.17142318363217, + -112.1683964785196 ], "moduleForcesY": [ - -12.910071305057201, - -14.561200011281274, - -31.296024837317898, - -30.955087024539008 + 35.32323951770473, + 35.78880107821523, + 27.1558429759438, + 27.154535423780597 ], - "timestamp": 1.2357315017277104 + "timestamp": 1.3300498781665546 }, { - "x": 12.391577669935138, - "y": 6.524834886416186, - "heading": -0.2376574883237867, - "angularVelocity": 0.09327225382491915, - "velocityX": -0.7146644720743752, - "velocityY": 0.20191178488512532, + "x": 12.279190101968272, + "y": 6.556586338886186, + "heading": -0.22055367602817383, + "angularVelocity": 0.19585558546407858, + "velocityX": -1.3608554857019426, + "velocityY": 0.3844666727325826, "moduleForcesX": [ - -109.9959827367489, - -109.86538217101113, - -112.07438057028467, - -112.0666311120356 + -109.89245539711597, + -109.70709462938446, + -112.15861944802997, + -112.12825792036844 ], "moduleForcesY": [ - 34.947790309423134, - 35.34716847772434, - 27.56387748227317, - 27.583683757251233 + 35.21826543338556, + 35.77869126173595, + 27.148840736400675, + 27.256949433752844 ], - "timestamp": 1.3271578167329043 + "timestamp": 1.4171145382499064 }, { - "x": 12.260906252411765, - "y": 6.561752331915095, - "heading": -0.2206877610023437, - "angularVelocity": 0.1856109733885584, - "velocityX": -1.4292539026203903, - "velocityY": 0.4037945256440807, + "x": 12.101479877603184, + "y": 6.606791013546223, + "heading": -0.1952091525882827, + "angularVelocity": 0.29110001021800874, + "velocityX": -2.041129250317603, + "velocityY": 0.5766366584556093, "moduleForcesX": [ - -110.00945422487304, - -109.8504153683674, - -112.06416998026945, - -112.03171567433652 + -109.92048751533741, + -109.69117162238653, + -112.1337688915827, + -112.06359871366234 ], "moduleForcesY": [ - 34.86118581179554, - 35.347956242495144, - 27.54904597391854, - 27.666287641216236 + 35.05402926782684, + 35.74845318822676, + 27.151367351771455, + 27.417403309854482 ], - "timestamp": 1.4185841317380983 + "timestamp": 1.5041791983332582 }, { - "x": 12.064914042906658, - "y": 6.617122892086999, - "heading": -0.19542124177576825, - "angularVelocity": 0.27635937448796954, - "velocityX": -2.143717697623187, - "velocityY": 0.6056304486160079, + "x": 11.864562910114323, + "y": 6.6737192302015265, + "heading": -0.16192803904792102, + "angularVelocity": 0.3822574338256172, + "velocityX": -2.7211611147628307, + "velocityY": 0.7687185201346822, "moduleForcesX": [ - -110.02889664350995, - -109.82922400996975, - -112.04411023069697, - -111.975470281016 + -109.95591771814263, + -109.67704537348149, + -112.0693733681274, + -111.94887517290029 ], "moduleForcesY": [ - 34.72586213068898, - 35.33767829400725, - 27.53646502457929, - 27.795383551483052 + 34.788017531200495, + 35.6335008373943, + 27.216188056391903, + 27.676054770743054 ], - "timestamp": 1.5100104467432922 + "timestamp": 1.59124385841661 }, { - "x": 11.80362432610035, - "y": 6.690938650379312, - "heading": -0.16214419063285807, - "angularVelocity": 0.3639767296868492, - "velocityX": -2.857926810147228, - "velocityY": 0.8073797821570227, + "x": 11.56850461802944, + "y": 6.7573499531090215, + "heading": -0.1217025196318901, + "angularVelocity": 0.46201891074427753, + "velocityX": -3.400441600546649, + "velocityY": 0.9605587712331278, "moduleForcesX": [ - -110.05001149729422, - -109.80240908300567, - -111.99097622261098, - -111.87607678799768 + -109.98511497469823, + -109.68108201991241, + -111.83317527235297, + -111.6616416691419 ], "moduleForcesY": [ - 34.51004456710356, - 35.26876905745422, - 27.56365281863087, - 27.999126804996614 + 34.22235845768231, + 35.142081931115705, + 27.57984056765442, + 28.211854056677726 ], - "timestamp": 1.6014367617484861 + "timestamp": 1.6783085184999618 }, { - "x": 11.477108634875863, - "y": 6.783177700282454, - "heading": -0.12164341187087872, - "angularVelocity": 0.4429882004943381, - "velocityX": -3.571353512453578, - "velocityY": 1.008889507336059, + "x": 11.252494100051829, + "y": 6.8466425061476945, + "heading": -0.12168267110063807, + "angularVelocity": 0.00022797460224432592, + "velocityX": -3.6296072100330767, + "velocityY": 1.0255889468033135, "moduleForcesX": [ - -110.04642262897133, - -109.76393441481716, - -111.79375874723362, - -111.62926676038809 + -31.02179127200356, + -47.98351788132492, + -26.680968019598573, + -43.820835109423456 ], "moduleForcesY": [ - 34.068957025324174, - 34.92992729055502, - 27.794484147904477, - 28.39936236528553 + -4.756334887484557, + -1.9309977832536225, + 24.46796105753946, + 24.644907375310982 ], - "timestamp": 1.69286307675368 + "timestamp": 1.7653731785833136 }, { - "x": 11.127792753189217, - "y": 6.881877306152213, - "heading": -0.12162478079751621, - "angularVelocity": 0.00020378239417665058, - "velocityX": -3.8207367503196448, - "velocityY": 1.0795535821842135, + "x": 10.936483790907323, + "y": 6.935936936057917, + "heading": -0.12166324602862022, + "angularVelocity": 0.00022311086954514994, + "velocityX": -3.6296048114352204, + "velocityY": 1.025610504017775, "moduleForcesX": [ - -33.09132616097768, - -48.347985418148845, - -29.02496895325345, - -44.47101375036062 + 0.0005154716607218464, + 0.0002417899336236675, + 0.0005410426549909981, + 0.00026653543094474054 ], "moduleForcesY": [ - -3.094463016167937, - -0.5892512773323937, - 23.759456581488084, - 23.82600237416276 + 0.0033758890088798066, + 0.0034350821142144186, + 0.0035869113525768474, + 0.0036659942562330076 ], - "timestamp": 1.784289391758874 + "timestamp": 1.8524378386666653 }, { - "x": 10.778476992179064, - "y": 6.980578519140531, - "heading": -0.12160654197932859, - "angularVelocity": 0.0001994919973158839, - "velocityX": -3.820735430387944, - "velocityY": 1.0795711604772797, + "x": 10.620473493797341, + "y": 7.025231408572309, + "heading": -0.12164382100669206, + "angularVelocity": 0.00022311029422917704, + "velocityX": -3.6296046732101006, + "velocityY": 1.0256109933571795, "moduleForcesX": [ - 0.0002512832040627029, - 0.00011234039315012063, - 0.00029742988117872183, - 0.00015898562376514823 + 0.00002434182804179363, + 0.00002440227199946701, + 0.000020678411625246635, + 0.00002075523564597107 ], "moduleForcesY": [ - 0.002591336436009617, - 0.0026141003619889144, - 0.002857948956202869, - 0.0028575487581504696 + 0.00008082287391198304, + 0.00007797287404045539, + 0.00008183770796018627, + 0.00007861043704994156 ], - "timestamp": 1.875715706764068 + "timestamp": 1.9395024987500171 }, { - "x": 10.42916122482486, - "y": 7.079279709676494, - "heading": -0.12158830320096466, - "angularVelocity": 0.000199491561733752, - "velocityX": -3.8207354997777165, - "velocityY": 1.079570914898582, + "x": 10.304463176887305, + "y": 7.114525811000592, + "heading": -0.12162439602548268, + "angularVelocity": 0.00022310982654477333, + "velocityX": -3.629604900627923, + "velocityY": 1.0256101883680144, "moduleForcesX": [ - -0.000010817185800089757, - -0.000010826840184563996, - -0.000010728186769667733, - -0.000010737841153636994 + -0.00003675082473489597, + -0.000037176248898554475, + -0.00003699545409221911, + -0.00003744433216461551 ], "moduleForcesY": [ - -0.00003818254602090013, - -0.00003811622625778976, - -0.00003816959017816588, - -0.00003810327041597527 + -0.00013113344539951354, + -0.0001311896105161841, + -0.00013157216497814358, + -0.0001312778439131569 ], - "timestamp": 1.967142021769262 + "timestamp": 2.0265671588333687 }, { - "x": 10.079845074724386, - "y": 7.17797836765492, - "heading": -0.12156967900738717, - "angularVelocity": 0.00020370714467073155, - "velocityX": -3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 9.988452352347721, + "y": 7.203817281479636, + "heading": -0.12160455496323849, + "angularVelocity": 0.00022788881533772785, + "velocityX": -3.629610731116951, + "velocityY": 1.0255765128303516, "moduleForcesX": [ - -0.000724611981877418, - -0.0005826729788445193, - -0.0007171397023142401, - -0.0005764705403427619 + -0.0010130445731977192, + -0.000753992270294424, + -0.0011491207143127223, + -0.0008876399654099 ], "moduleForcesY": [ - -0.004183092119230615, - -0.004164770678407313, - -0.004451422852479581, - -0.004410331431156549 + -0.0053203589783196985, + -0.005461740514528871, + -0.00551336991331991, + -0.005674373284473044 ], - "timestamp": 2.0585683367744556 + "timestamp": 2.1136318189167205 }, { - "x": 9.753318963003084, - "y": 7.270191836288494, - "heading": -0.08193010734885013, - "angularVelocity": 0.43356851532608676, - "velocityX": -3.5714674894503937, - "velocityY": 1.0086097052947562, + "x": 9.692382682952024, + "y": 7.2874193702981085, + "heading": -0.0822191306558338, + "angularVelocity": 0.45236981652140956, + "velocityX": -3.4005722771128415, + "velocityY": 0.9602298882053446, "moduleForcesX": [ - 32.71681627397986, - 47.82428831491742, - 29.57806286942199, - 44.74713985839775 + 30.62118617981392, + 47.41130841236055, + 27.280967447136295, + 44.1106943011997 ], "moduleForcesY": [ - 2.410633101239201, - 0.7117166259846383, - -23.90450526901233, - -23.286981568782405 + 4.023869535756976, + 2.0544391312139076, + -24.6327470438544, + -24.07754801487098 ], - "timestamp": 2.1499946517796493 + "timestamp": 2.2006964790000723 }, { - "x": 9.492019530398496, - "y": 7.343983789856553, - "heading": -0.04944702950219561, - "angularVelocity": 0.35529243243380376, - "velocityX": -2.858033079313581, - "velocityY": 0.8071194115596501, + "x": 9.455455171491224, + "y": 7.354320907313611, + "heading": -0.04970482150665087, + "angularVelocity": 0.3734501360030033, + "velocityX": -2.721282219834982, + "velocityY": 0.768412085356498, "moduleForcesX": [ - 110.11042093282536, - 109.72343096717103, - 111.82904603560874, - 111.57527328961984 + 110.05417979801821, + 109.63993232178616, + 111.86911447326588, + 111.60403176355511 ], "moduleForcesY": [ - -33.86318732230892, - -35.059198202419715, - -27.649683347659746, - -28.608589707922565 + -34.00135979147741, + -35.27274549289079, + -27.43088810329592, + -28.43649643947654 ], - "timestamp": 2.241420966784843 + "timestamp": 2.287761139083424 }, { - "x": 9.2960192355485, - "y": 7.399334406788997, - "heading": -0.02482773338497671, - "angularVelocity": 0.2692801970178966, - "velocityX": -2.1438061332654796, - "velocityY": 0.6054123140509308, + "x": 9.277736160829281, + "y": 7.404503175997865, + "heading": -0.0249851504638235, + "angularVelocity": 0.2839231327517031, + "velocityX": -2.0412301672320625, + "velocityY": 0.5763793097705944, "moduleForcesX": [ - 110.18532231271769, - 109.7167628980199, - 112.06441279220556, - 111.76405509082988 + 110.1040648842651, + 109.58272113098381, + 112.14908861391895, + 111.82850771075378 ], "moduleForcesY": [ - -34.07720649246468, - -35.53661461014457, - -27.26087793372916, - -28.44065406776567 + -34.31811935636646, + -35.92513988883449, + -26.882739105964255, + -28.155739191192566 ], - "timestamp": 2.3328472817900368 + "timestamp": 2.374825799166776 }, { - "x": 9.16534208313775, - "y": 7.436237482881837, - "heading": -0.008305113039109078, - "angularVelocity": 0.18072062015109094, - "velocityX": -1.4293166294991293, - "velocityY": 0.4036373563863185, + "x": 9.159247496299429, + "y": 7.437960457197711, + "heading": -0.008364737523416488, + "angularVelocity": 0.19089735059547008, + "velocityX": -1.3609272053255366, + "velocityY": 0.38428084561307907, "moduleForcesX": [ - 110.21880379377984, - 109.70681368656747, - 112.14833562771497, - 111.81972024066971 + 110.13043304849137, + 109.55438775829175, + 112.24817460065178, + 111.89507958039741 ], "moduleForcesY": [ - -34.1198596453768, - -35.718037584285995, - -27.106350443858066, - -28.413265173608863 + -34.39052165205634, + -36.16792173997415, + -26.671524840114127, + -28.094624382026243 ], - "timestamp": 2.4242735967952305 + "timestamp": 2.4618904592501276 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 3.668994025305924e-20, - "angularVelocity": 0.09083941574848846, - "velocityX": -0.7146966727690923, - "velocityY": 0.2018291634125037, + "heading": 7.242510620075491e-20, + "angularVelocity": 0.096075003513578, + "velocityX": -0.680499943865953, + "velocityY": 0.19215055040122928, "moduleForcesX": [ - 110.23546235943999, - 109.70058243131005, - 112.19103002395251, - 111.8476455542373 + 110.14366836151463, + 109.53867302844944, + 112.29847947682536, + 111.92834686125501 ], "moduleForcesY": [ - -34.1411922801755, - -35.81216376796426, - -27.025531588293937, - -28.399273440528706 + -34.426167314961276, + -36.29325100794249, + -26.561761552149026, + -28.064179245161927 ], - "timestamp": 2.515699911800424 + "timestamp": 2.5489551193334794 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 1.8140975017922662e-20, - "angularVelocity": -5.347539139373239e-21, - "velocityX": 1.1027338008988471e-21, - "velocityY": 1.1228733232906781e-21, + "heading": 3.585471297015955e-20, + "angularVelocity": -1.007056327923224e-20, + "velocityX": 3.7291337159094484e-21, + "velocityY": 1.6506889205384567e-21, + "moduleForcesX": [ + 110.14478533871653, + 109.53077444413167, + 112.32693857060057, + 111.95408720798878 + ], + "moduleForcesY": [ + -34.46921393384191, + -36.36354115442993, + -26.50294273092508, + -28.022875739605002 + ], + "timestamp": 2.636019779416831 + }, + { + "x": 9.165462800190092, + "y": 7.420246784454786, + "heading": 1.0000252535719594e-17, + "angularVelocity": 1.0444752855082387e-16, + "velocityX": 0.6861857407128128, + "velocityY": -0.3610360276753583, "moduleForcesX": [ - 110.23935489778837, - 109.69825354519148, - 112.21511593235195, - 111.8696576656152 + 102.13700666833603, + 102.13700666833603, + 102.13700666833601, + 102.13700666833603 ], "moduleForcesY": [ - -34.173575075339315, - -35.86413648487152, - -26.9832725291903, - -28.370205373579942 + -53.73929677973422, + -53.739296779734225, + -53.73929677973423, + -53.73929677973423 ], - "timestamp": 2.607126226805618 + "timestamp": 2.7314207711688447 }, { - "x": 9.171685854048507, - "y": 7.416972530106804, - "heading": 4.73116158338858e-18, - "angularVelocity": 4.720976000658869e-17, - "velocityX": 0.7180685701633659, - "velocityY": -0.37781115052171915, + "x": 9.296377871427524, + "y": 7.351365934157169, + "heading": 3.1188473540722436e-17, + "angularVelocity": 2.2209644368399916e-16, + "velocityX": 1.3722611142002972, + "velocityY": -0.7220139857315829, "moduleForcesX": [ - 102.13925806744795, - 102.13925806744795, - 102.13925806744794, - 102.13925806744795 + 102.12057878684489, + 102.12057878684489, + 102.12057878684487, + 102.12057878684489 ], "moduleForcesY": [ - -53.74048135140899, - -53.74048135140898, - -53.74048135140899, - -53.74048135140898 + -53.7306532642474, + -53.7306532642474, + -53.730653264247415, + -53.730653264247415 ], - "timestamp": 2.7069577150884125 + "timestamp": 2.8268217629208583 }, { - "x": 9.315046569258698, - "y": 7.341543415111761, - "heading": 2.876637893287952e-17, - "angularVelocity": 2.4075787867618104e-16, - "velocityX": 1.4360270259027919, - "velocityY": -0.755564364435534, + "x": 9.492724224087116, + "y": 7.2480584723333115, + "heading": 4.513674716574335e-17, + "angularVelocity": 1.4620679885932853e-16, + "velocityX": 2.0581164729395796, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 102.12359521012328, - 102.1235952101233, - 102.12359521012328, - 102.12359521012328 + 102.08783014974716, + 102.08783014974716, + 102.08783014974716, + 102.08783014974716 ], "moduleForcesY": [ - -53.73224035271865, - -53.73224035271864, - -53.732240352718655, - -53.732240352718655 + -53.71342259746431, + -53.71342259746431, + -53.7134225974643, + -53.7134225974643 ], - "timestamp": 2.806789203371207 + "timestamp": 2.922222754672872 }, { - "x": 9.530060249336586, - "y": 7.228414155284034, - "heading": 4.9619729837040083e-17, - "angularVelocity": 2.0888550553958917e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246714, + "x": 9.754439455027212, + "y": 7.11035723234165, + "heading": 4.2267360158652724e-17, + "angularVelocity": -3.007711940252278e-17, + "velocityX": 2.743317717497125, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 102.09239698765673, - 102.09239698765673, - 102.09239698765673, - 102.09239698765673 + 101.99046691326761, + 101.99046691326761, + 101.99046691326761, + 101.99046691326761 ], "moduleForcesY": [ - -53.71582543523849, - -53.71582543523849, - -53.71582543523849, - -53.71582543523849 + -53.662195015696604, + -53.662195015696604, + -53.66219501569659, + -53.6621950156966 ], - "timestamp": 2.906620691654002 + "timestamp": 3.0176237464248854 }, { - "x": 9.81666193347748, - "y": 7.077618929694229, - "heading": 5.975283971937042e-17, - "angularVelocity": 1.0150214177102703e-16, - "velocityX": 2.870854567739517, - "velocityY": -1.510497621378186, + "x": 10.072897912662654, + "y": 6.942800593223961, + "heading": 1.7008792193577606e-17, + "angularVelocity": -2.647621111076902e-16, + "velocityX": 3.3381042669163024, + "velocityY": -1.7563406421731869, "moduleForcesX": [ - 101.99983969748537, - 101.99983969748537, - 101.99983969748537, - 101.99983969748537 + 88.53246892183445, + 88.53246892183445, + 88.53246892183445, + 88.53246892183445 ], "moduleForcesY": [ - -53.667126497919924, - -53.66712649791993, - -53.66712649791992, - -53.667126497919924 + -46.58128113625249, + -46.58128113625251, + -46.58128113625249, + -46.581281136252485 ], - "timestamp": 3.0064521799367965 + "timestamp": 3.113024738176899 }, { - "x": 10.167455917956454, - "y": 6.893048981392569, - "heading": 5.19391181641435e-17, - "angularVelocity": -7.826910822496646e-17, - "velocityX": 3.5138611124906114, - "velocityY": -1.8488149528415818, + "x": 10.391358109467166, + "y": 6.775243039043985, + "heading": 1.964059559448171e-17, + "angularVelocity": 2.7586750815932474e-17, + "velocityX": 3.3381224970105308, + "velocityY": -1.75635023392133, "moduleForcesX": [ - 91.46231173778877, - 91.46231173778874, - 91.46231173778877, - 91.46231173778875 + 0.0027135032766586317, + 0.002713503276605032, + 0.002713503276550828, + 0.0027135032764971424 ], "moduleForcesY": [ - -48.12281537286678, - -48.12281537286678, - -48.12281537286676, - -48.12281537286676 + -0.0014277073770695113, + -0.0014277073770064686, + -0.0014277073771330811, + -0.0014277073770701714 ], - "timestamp": 3.106283668219591 + "timestamp": 3.2084257299289125 }, { - "x": 10.518252161317257, - "y": 6.70847784458221, - "heading": 3.766456124956393e-17, - "angularVelocity": -1.4298651827732539e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901475, + "x": 10.709818306284792, + "y": 6.607685484857109, + "heading": -3.8538311178504195e-18, + "angularVelocity": -2.462702566883343e-16, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936556, "moduleForcesX": [ - 0.003218494319225325, - 0.003218494319216094, - 0.003218494319193459, - 0.003218494319184196 + 2.0460973813009118e-8, + 2.0460961354645526e-8, + 2.0460963129610995e-8, + 2.0460950665772818e-8 ], "moduleForcesY": [ - -0.0016934079727223925, - -0.0016934079727399663, - -0.0016934079727242658, - -0.0016934079727418635 + -1.0765500981855737e-8, + -1.0765504080928475e-8, + -1.0765488096575326e-8, + -1.0765491204163331e-8 ], - "timestamp": 3.2061151565023858 + "timestamp": 3.303826721680926 }, { - "x": 10.869048404693604, - "y": 6.523906707763672, - "heading": 2.2701290589411372e-17, - "angularVelocity": -1.4988528093015713e-16, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 11.028278503102417, + "y": 6.440127930670234, + "heading": -1.300020909937592e-17, + "angularVelocity": -9.58729864932316e-17, + "velocityX": 3.3381224971479946, + "velocityY": -1.756350233993656, "moduleForcesX": [ - 2.214842103369335e-8, - 2.214841971652397e-8, - 2.2148399662466356e-8, - 2.2148398355512985e-8 + 1.4474838704178555e-13, + 1.5068927215576243e-13, + 1.408186230548463e-13, + 1.4675794469346446e-13 ], "moduleForcesY": [ - -1.1653376600724734e-8, - -1.1653388805406456e-8, - -1.165337704047802e-8, - -1.165338925383615e-8 + -8.907551463496866e-14, + -9.211214882671091e-14, + -9.682450585984768e-14, + -9.985744234971747e-14 ], - "timestamp": 3.3059466447851804 + "timestamp": 3.3992277134329396 }, { - "x": 11.219844648069952, - "y": 6.339335570945134, - "heading": 3.061231332790382e-17, - "angularVelocity": 7.924376236807535e-17, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 11.346738699920042, + "y": 6.272570376483358, + "heading": -1.6034884829107134e-17, + "angularVelocity": -3.180968750998064e-17, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936554, "moduleForcesX": [ - 8.153502180996974e-15, - 1.7251673005843974e-14, - -1.58855310989108e-15, - 7.507130962539776e-15 + -1.6409175526761825e-13, + -1.6159239329690174e-13, + -1.6616883137339107e-13, + -1.6366371958278699e-13 ], "moduleForcesY": [ - -2.8417399270339567e-16, - -8.464949440223293e-15, - -1.1231547709612304e-14, - -1.9406448996208048e-14 + 9.856885441627709e-14, + 9.702579680058777e-14, + 9.524682094901744e-14, + 9.370612817889214e-14 ], - "timestamp": 3.405778133067975 + "timestamp": 3.494628705184953 }, { - "x": 11.570640891430754, - "y": 6.1547644341347745, - "heading": 1.903661500367957e-17, - "angularVelocity": -1.1595237656501265e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901472, + "x": 11.665198896724554, + "y": 6.105012822303383, + "heading": -3.327196466558203e-18, + "angularVelocity": 1.33202895790123e-16, + "velocityX": 3.3381224970105308, + "velocityY": -1.7563502339213297, "moduleForcesX": [ - -2.2148468458536655e-8, - -2.2148476648513925e-8, - -2.2148474908807252e-8, - -2.2148483100357075e-8 + -2.046097600304392e-8, + -2.046096833033551e-8, + -2.0460974922422488e-8, + -2.0460967227223523e-8 ], "moduleForcesY": [ - 1.1653415936522858e-8, - 1.1653413493871686e-8, - 1.165342493176425e-8, - 1.1653422488553742e-8 + 1.0765497780128575e-8, + 1.0765495712162903e-8, + 1.0765490146356085e-8, + 1.0765488084589651e-8 ], - "timestamp": 3.5056096213507697 + "timestamp": 3.5900296969369667 }, { - "x": 11.921434875909728, - "y": 5.970194485833114, - "heading": 2.2015567565585324e-17, - "angularVelocity": 2.9839809238463793e-17, - "velocityX": 3.513861112490612, - "velocityY": -1.8488149528415816, + "x": 11.983657354359996, + "y": 5.937456183185693, + "heading": -1.2837192767441167e-17, + "angularVelocity": -9.968445945953903e-17, + "velocityX": 3.338104266916303, + "velocityY": -1.7563406421731866, "moduleForcesX": [ - -0.0032184943191482383, - -0.003218494319154078, - -0.003218494319166007, - -0.0032184943191717096 + -0.002713503276636462, + -0.0027135032765821195, + -0.002713503276540376, + -0.0027135032764861538 ], "moduleForcesY": [ - 0.0016934079727123717, - 0.0016934079727241181, - 0.0016934079726967873, - 0.001693407972708547 + 0.0014277073770852346, + 0.0014277073770136435, + 0.0014277073771445043, + 0.0014277073770729747 ], - "timestamp": 3.6054411096335643 + "timestamp": 3.6854306886889803 }, { - "x": 12.208036560050623, - "y": 5.819399260243309, - "heading": 1.715956257076988e-17, - "angularVelocity": -4.864201740947202e-17, - "velocityX": 2.8708545677395176, - "velocityY": -1.510497621378186, + "x": 12.245372585300093, + "y": 5.799754943194032, + "heading": 8.061487264185827e-18, + "angularVelocity": 2.1906145481338784e-16, + "velocityX": 2.7433177174971255, + "velocityY": -1.4433942191041782, "moduleForcesX": [ - -91.4623117377888, - -91.4623117377888, - -91.46231173778881, - -91.46231173778878 + -88.53246892183448, + -88.53246892183445, + -88.53246892183448, + -88.53246892183448 ], "moduleForcesY": [ - 48.122815372866775, - 48.12281537286678, - 48.12281537286677, - 48.122815372866796 + 46.581281136252514, + 46.58128113625253, + 46.5812811362525, + 46.58128113625251 ], - "timestamp": 3.705272597916359 + "timestamp": 3.780831680440994 }, { - "x": 12.42305024012851, - "y": 5.706270000415583, - "heading": 4.0500799094748495e-18, - "angularVelocity": -1.3131610960667952e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246712, + "x": 12.441718937959685, + "y": 5.696447481370175, + "heading": -6.661113737991722e-19, + "angularVelocity": -9.14833112894713e-17, + "velocityX": 2.05811647293958, + "velocityY": -1.0828761832203577, "moduleForcesX": [ - -101.99983969748537, - -101.99983969748537, - -101.99983969748537, - -101.99983969748537 + -101.99046691326761, + -101.99046691326762, + -101.99046691326761, + -101.99046691326761 ], "moduleForcesY": [ - 53.667126497919924, - 53.667126497919924, - 53.66712649791993, - 53.66712649791993 + 53.66219501569659, + 53.66219501569659, + 53.66219501569661, + 53.662195015696604 ], - "timestamp": 3.8051040861991536 + "timestamp": 3.8762326721930074 }, { - "x": 12.566410955338702, - "y": 5.63084088542054, - "heading": -3.708075207453893e-18, - "angularVelocity": -7.771250580976826e-17, - "velocityX": 1.4360270259027916, - "velocityY": -0.7555643644355339, + "x": 12.572634009197117, + "y": 5.627566631072558, + "heading": -3.887549896896706e-19, + "angularVelocity": 2.907269528625613e-18, + "velocityX": 1.3722611142002974, + "velocityY": -0.7220139857315828, "moduleForcesX": [ - -102.09239698765673, - -102.09239698765673, - -102.09239698765673, - -102.09239698765673 + -102.08783014974718, + -102.08783014974716, + -102.08783014974716, + -102.08783014974716 ], "moduleForcesY": [ - 53.715825435238486, - 53.715825435238486, - 53.715825435238486, - 53.71582543523849 + 53.7134225974643, + 53.7134225974643, + 53.7134225974643, + 53.71342259746431 ], - "timestamp": 3.9049355744819483 + "timestamp": 3.971633663945021 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.613826982610023e-18, - "angularVelocity": 9.440731598697995e-19, - "velocityX": 0.718068570163366, - "velocityY": -0.3778111505217191, + "heading": 4.421333072969964e-19, + "angularVelocity": 8.70943051994905e-18, + "velocityX": 0.6861857407128128, + "velocityY": -0.36103602767535825, "moduleForcesX": [ - -102.1235952101233, - -102.12359521012328, - -102.1235952101233, - -102.1235952101233 + -102.12057878684487, + -102.12057878684489, + -102.12057878684489, + -102.12057878684489 ], "moduleForcesY": [ - 53.73224035271864, - 53.73224035271865, - 53.73224035271864, - 53.73224035271865 + 53.73065326424741, + 53.73065326424741, + 53.7306532642474, + 53.73065326424741 ], - "timestamp": 4.004767062764743 + "timestamp": 4.067034655697034 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.5546712678246825e-18, - "angularVelocity": 5.925557111968679e-19, - "velocityX": 4.845232015144286e-18, - "velocityY": -3.784642229218748e-18, + "heading": 4.2336552415027816e-19, + "angularVelocity": -1.9672511354829974e-19, + "velocityX": 4.977758444457901e-18, + "velocityY": 1.6190413361646781e-18, "moduleForcesX": [ - -102.13925806744795, - -102.13925806744795, - -102.13925806744795, - -102.13925806744794 + -102.13700666833603, + -102.13700666833603, + -102.13700666833603, + -102.13700666833603 ], "moduleForcesY": [ - 53.74048135140898, - 53.74048135140899, - 53.740481351408974, - 53.74048135140899 + 53.73929677973424, + 53.73929677973423, + 53.739296779734225, + 53.739296779734225 ], - "timestamp": 4.104598551047538 + "timestamp": 4.162435647449048 }, { - "x": 12.635601743595934, - "y": 5.59148869514806, - "heading": -0.040469209324330645, - "angularVelocity": -1.1653411306828494, - "velocityX": -0.07184728436451648, - "velocityY": -0.047073583952371864, + "x": 12.635716300422908, + "y": 5.591477621529516, + "heading": -0.04053440079408721, + "angularVelocity": -1.1690740956944317, + "velocityX": -0.06865751831067732, + "velocityY": -0.047467805020289744, "moduleForcesX": [ - 6.715898232782912, - -74.23634164667784, - 61.50244174016689, - -111.49692422807281 + 8.096498399631756, + -73.90381849216459, + 64.47066032298743, + -111.13955678681945 ], "moduleForcesY": [ - -115.15629744618346, - -88.32054795571801, - 97.03134384991834, - 29.45095987898999 + -115.06817413543638, + -88.5992032674739, + 95.13273018745403, + 30.771872674752988 ], - "timestamp": 4.139325901055871 + "timestamp": 4.197107873053371 }, { - "x": 12.630989153588672, - "y": 5.587957161161052, - "heading": -0.12142442884644973, - "angularVelocity": -2.3311660550745135, - "velocityX": -0.13282297688005926, - "velocityY": -0.10169316075544019, + "x": 12.63128685127921, + "y": 5.587940767261187, + "heading": -0.12156201076160397, + "angularVelocity": -2.33696016206742, + "velocityX": -0.12775208589855394, + "velocityY": -0.102008284922097, "moduleForcesX": [ - 0.99135751533034, - -78.3059668743301, - 87.10790717980457, - -109.52641997223697 + 2.2065963342952273, + -78.0409085702254, + 88.10645679121941, + -109.08213048053173 ], "moduleForcesY": [ - -115.3287239283564, - -84.70847062161553, - 74.72643789735397, - 35.97383073297602 + -115.31231038297804, + -84.95264569095009, + 73.61772559553323, + 37.297848510277355 ], - "timestamp": 4.174053251064205 + "timestamp": 4.231780098657694 }, { - "x": 12.624509421807858, - "y": 5.58199542338269, - "heading": -0.24205524013552657, - "angularVelocity": -3.4736543750136, - "velocityX": -0.18658871982052855, - "velocityY": -0.17167269535197777, + "x": 12.625028987271739, + "y": 5.582022220388997, + "heading": -0.2423139565639912, + "angularVelocity": -3.48267074575483, + "velocityX": -0.18048636620236289, + "velocityY": -0.17069994120746917, "moduleForcesX": [ - -7.591385688898406, - -84.0456517158906, - 109.52068801281428, - -105.82402794572394 + -6.5867304178653185, + -83.86452574104914, + 109.29775219994504, + -105.23692315428146 ], "moduleForcesY": [ - -115.05554501752215, - -78.97617075986716, - 34.00596685578571, - 45.5657537319174 + -115.11732618046953, + -79.16769136400295, + 34.85061884596746, + 46.9022565810502 ], - "timestamp": 4.208780601072538 + "timestamp": 4.266452324262017 }, { - "x": 12.61601333895309, - "y": 5.573089966082191, - "heading": -0.40091737527763976, - "angularVelocity": -4.574553920871888, - "velocityX": -0.24465105609063115, - "velocityY": -0.2564392992371348, + "x": 12.61679879499125, + "y": 5.573228753463621, + "heading": -0.4014079147959288, + "angularVelocity": -4.588513008870753, + "velocityX": -0.23737132927115676, + "velocityY": -0.25361703127242496, "moduleForcesX": [ - -18.72557620909359, - -90.96637263149834, - 113.95654026368184, - -99.23256696756765 + -17.998694570457108, + -90.87202731423554, + 114.15847162607923, + -98.47791423254111 ], "moduleForcesY": [ - -113.7295099024964, - -70.81659924554228, - -12.395836704635942, - 58.295909852584266 + -113.84541579014022, + -70.93479429110369, + -10.61021875597528, + 59.55387651430768 ], - "timestamp": 4.243507951080872 + "timestamp": 4.301124549866341 }, { - "x": 12.605082130208535, - "y": 5.561092759135586, - "heading": -0.5968969422163409, - "angularVelocity": -5.643378112400488, - "velocityX": -0.31477232619048406, - "velocityY": -0.3454685411851268, + "x": 12.606171501564956, + "y": 5.561383158190227, + "heading": -0.597641326297266, + "angularVelocity": -5.659671627104043, + "velocityX": -0.3065073914657803, + "velocityY": -0.3416450795104292, "moduleForcesX": [ - -32.04770801640716, - -98.43585145612518, - 103.26614786567647, - -87.47440914613598 + -31.702182349069048, + -98.39402131426678, + 103.64312194332079, + -86.80709567336851 ], "moduleForcesY": [ - -110.62167229916327, - -59.81255295495651, - -49.50954102303336, - 74.32567001715357 + -110.71556436707718, + -59.87033716863823, + -48.704407218405564, + 75.08087531888812 ], - "timestamp": 4.278235301089206 + "timestamp": 4.335796775470664 }, { - "x": 12.591329218838723, - "y": 5.546283772243203, - "heading": -0.8296689344895842, - "angularVelocity": -6.702843499932593, - "velocityX": -0.39602536233005076, - "velocityY": -0.42643584635250353, + "x": 12.59265174321713, + "y": 5.546665747496571, + "heading": -0.8301729234385428, + "angularVelocity": -6.706566800611855, + "velocityX": -0.3899305023598048, + "velocityY": -0.4244726272149572, "moduleForcesX": [ - -47.31647496655648, - -105.61081086052921, - 85.39422216677532, - -65.36610720874525 + -47.633339347555925, + -105.47445484854185, + 83.83071395151596, + -67.38844623517069 ], "moduleForcesY": [ - -104.70081415220629, - -45.20977101766445, - -75.5707601247976, - 93.04952199931408 + -104.5242317395292, + -45.44976016477657, + -77.1734046395607, + 91.457534433043 ], - "timestamp": 4.312962651097539 + "timestamp": 4.370469001074987 }, { - "x": 12.572042639393677, - "y": 5.534219720600946, - "heading": -1.073814547044594, - "angularVelocity": -7.030355397011889, - "velocityX": -0.5553714706252239, - "velocityY": -0.3473933841586206, + "x": 12.572877030087271, + "y": 5.534422452953114, + "heading": -1.0590948047093973, + "angularVelocity": -6.602457075680554, + "velocityX": -0.5703329620523357, + "velocityY": -0.35311533453825095, "moduleForcesX": [ - -82.71377263272161, - -84.82446387482808, - -42.35353791946482, - -50.7380639123641 + -69.11423919609621, + -67.8872625428816, + -79.57383821530136, + -78.96383219960605 ], "moduleForcesY": [ - -3.3792218912464422, - 29.67111027754918, - 37.553509843725166, - 65.43811150826103 + 41.078313605626754, + 30.388799241217356, + 28.281282661879363, + 17.150649220262693 ], - "timestamp": 4.347690001105873 + "timestamp": 4.40514122667931 }, { - "x": 12.559986566266332, - "y": 5.526755385653593, - "heading": -1.330510420929693, - "angularVelocity": -7.391749552542837, - "velocityX": -0.34716363685831114, - "velocityY": -0.21494110392994975, + "x": 12.560233187149112, + "y": 5.526847142047006, + "heading": -1.3004735728523615, + "angularVelocity": -6.961732739558218, + "velocityX": -0.36466776267695544, + "velocityY": -0.21848354912537238, "moduleForcesX": [ - 105.72590475429266, - 37.456143843089066, - 110.13783644093012, - 87.22921676430109 + 105.17188805717923, + 36.64629093835158, + 109.3871868445873, + 85.71976737512696 ], "moduleForcesY": [ - 16.762047005929656, - 104.18797300994257, - 23.903310122839276, - 71.78839869306294 + 17.180702657687426, + 103.98341170708088, + 26.15382218906551, + 73.23873697676419 ], - "timestamp": 4.382417351114206 + "timestamp": 4.439813452283634 }, { - "x": 12.554805000117685, - "y": 5.5258948814498945, - "heading": -1.5817192983329285, - "angularVelocity": -7.233747387662799, - "velocityX": -0.14920707014510395, - "velocityY": -0.024778861718294874, + "x": 12.554266136797898, + "y": 5.525513029563462, + "heading": -1.5511519906743647, + "angularVelocity": -7.2299488553959, + "velocityX": -0.17209885570398845, + "velocityY": -0.03847784387333178, "moduleForcesX": [ - 85.10006434406202, - 98.91322895268817, - 60.59757319762427, - 79.17104780949104 + 79.29225853022504, + 41.96175012878335, + 107.32093626149006, + 86.89556166997258 ], "moduleForcesY": [ - 76.28924255238852, - 56.8610964875441, - 96.53986801348239, - 81.3431465448386 + 78.39773568550407, + 105.27165483766125, + 37.43702182189581, + 73.78278818931089 ], - "timestamp": 4.41714470112254 + "timestamp": 4.474485677887957 }, { - "x": 12.553693111577713, - "y": 5.531340138988141, - "heading": -1.8090738890833113, - "angularVelocity": -6.546845373914893, - "velocityX": -0.032017661575237936, - "velocityY": 0.15680026080135756, + "x": 12.553234089263041, + "y": 5.53083198575942, + "heading": -1.783366315606556, + "angularVelocity": -6.69741618499501, + "velocityX": -0.029765828898134138, + "velocityY": 0.15340682933530048, "moduleForcesX": [ - 93.64139046456043, - 114.77127776967987, - 11.773017615907161, - -28.508230169372723 + 91.37221926721882, + 113.32252584700692, + 19.278349706082533, + 9.199917255318628 ], "moduleForcesY": [ - 66.90444420135348, - 5.619126084548563, - 114.36468781389611, - 110.10636482779223 + 69.7968364317707, + 18.15978259725049, + 113.19848312438963, + 113.19447803386177 ], - "timestamp": 4.451872051130874 + "timestamp": 4.50915790349228 }, { - "x": 12.556050432946392, - "y": 5.5420473258338605, - "heading": -2.005506504495854, - "angularVelocity": -5.656423981829998, - "velocityX": 0.06788083076058496, - "velocityY": 0.30832144817123774, + "x": 12.555779264328171, + "y": 5.54162936928793, + "heading": -1.9860033843796512, + "angularVelocity": -5.8443628939651955, + "velocityX": 0.07340674043181038, + "velocityY": 0.31141305008017556, "moduleForcesX": [ - 100.73960236681776, - 113.64668162060796, - 12.572866576727497, - -63.56308029676134 + 99.46991245107658, + 114.32669032012043, + 12.885145778988177, + -57.662236395363905 ], "moduleForcesY": [ - 55.95250024879295, - -18.155758880065523, - 114.50709600750906, - 95.52739610484751 + 58.11499274397129, + -12.760758459450766, + 114.43208308109202, + 99.062856607364 ], - "timestamp": 4.486599401139207 + "timestamp": 4.543830129096603 }, { - "x": 12.56203010772394, - "y": 5.557428390445447, - "heading": -2.1690558980603147, - "angularVelocity": -4.709527030574263, - "velocityX": 0.1721892046502874, - "velocityY": 0.44290925186907815, + "x": 12.56191803403241, + "y": 5.557168661278036, + "heading": -2.156099967433693, + "angularVelocity": -4.905845531670559, + "velocityX": 0.17705150440276152, + "velocityY": 0.4481769404548373, "moduleForcesX": [ - 105.74765097197235, - 109.64221257829823, - 19.07370797888986, - -63.85460645824819 + 105.08894599974387, + 110.32756561762763, + 18.126645587310904, + -63.75008567857288 ], "moduleForcesY": [ - 45.943867600773586, - -35.22297007233559, - 113.69565987258666, - 95.71807842731238 + 47.393531907484665, + -32.91770130594804, + 113.83333151918828, + 95.74037140980943 ], - "timestamp": 4.521326751147541 + "timestamp": 4.578502354700927 }, { - "x": 12.57182488488311, - "y": 5.577061809180295, - "heading": -2.2988461247392196, - "angularVelocity": -3.7374065872506375, - "velocityX": 0.2820479292782165, - "velocityY": 0.5653589672156297, + "x": 12.571808374354218, + "y": 5.5769573204468506, + "heading": -2.292448340929877, + "angularVelocity": -3.9324955672641906, + "velocityX": 0.2852525371366751, + "velocityY": 0.5707351871391592, "moduleForcesX": [ - 109.05462491040085, - 104.57283217895744, - 25.584631264200784, - -59.524853150368294 + 108.78605491561635, + 104.6850804882193, + 24.525066052249105, + -60.73895288598403 ], "moduleForcesY": [ - 37.52781331032903, - -48.329200017604535, - 112.45689047019695, - 98.62582006054753 + 38.272268020461155, + -48.04212290386911, + 112.68375035926043, + 97.86364839715985 ], - "timestamp": 4.556054101155874 + "timestamp": 4.61317458030525 }, { "x": 12.585567474365234, "y": 5.600627422332764, "heading": -2.3943443337005537, - "angularVelocity": -2.749942305946666, - "velocityX": 0.395728135859107, - "velocityY": 0.6785894445390662, + "angularVelocity": -2.938836229710392, + "velocityX": 0.3968334818778352, + "velocityY": 0.6826819297969253, "moduleForcesX": [ - 111.09605990584453, - 99.46866631123623, - 30.695272549126692, - -55.32226749334036 + 111.07132972844772, + 98.70912927254115, + 29.84347118911907, + -56.82963740078154 ], "moduleForcesY": [ - 31.048087478724806, - -58.16713625641179, - 111.19928569615168, - 101.12190774409382 + 31.11456084047184, + -59.42057702877722, + 111.42567305703156, + 100.27389389986291 ], - "timestamp": 4.590781451164208 + "timestamp": 4.647846805909573 }, { - "x": 12.609275137181715, - "y": 5.6362066530252655, - "heading": -2.4596016370427427, - "angularVelocity": -1.490768209280979, - "velocityX": 0.5415888832830659, - "velocityY": 0.8127885050494357, + "x": 12.609526436019335, + "y": 5.636699135016749, + "heading": -2.467431135675984, + "angularVelocity": -1.651944625216517, + "velocityX": 0.541532490962821, + "velocityY": 0.8153109765384976, "moduleForcesX": [ - 112.32207187573187, - 95.02943454284713, - 34.23111294482213, - -52.31611898637682 + 112.47606598208289, + 93.16011868734647, + 33.78704517737306, + -53.65287917781383 ], "moduleForcesY": [ - 26.427771988717435, - -65.28675950904486, - 110.20104060720472, - 102.79243467120517 + 25.753841947921746, + -67.91573899096902, + 110.33638895218567, + 102.09996040314151 ], - "timestamp": 4.63455573004668 + "timestamp": 4.6920896944784625 }, { - "x": 12.640376756629546, - "y": 5.67868110060817, - "heading": -2.4756065131625133, - "angularVelocity": -0.36562283899049025, - "velocityX": 0.7104998698284803, - "velocityY": 0.9703060488316174, + "x": 12.640768978131616, + "y": 5.679449457084365, + "heading": -2.4883261932610017, + "angularVelocity": -0.4722805915459653, + "velocityX": 0.7061596365624881, + "velocityY": 0.9662642619061936, "moduleForcesX": [ - 110.97907601877183, - 106.0264798075326, - 38.76392005053645, - -36.59336535164529 + 111.543250115618, + 102.57136846109823, + 37.93524392979517, + -40.69497651884954 ], "moduleForcesY": [ - 31.540733116048838, - -45.18048489661897, - 108.67557062608937, - 109.35634824645632 + 29.466868137611527, + -52.52564969838117, + 108.96449307890866, + 107.89412812639198 ], - "timestamp": 4.6783300089291515 + "timestamp": 4.736332583047352 }, { - "x": 12.67988915693076, - "y": 5.729664244872592, - "heading": -2.451631970535245, - "angularVelocity": 0.5476856098906139, - "velocityX": 0.9026396621471977, - "velocityY": 1.164682675899803, + "x": 12.680234323228891, + "y": 5.730326735350004, + "heading": -2.464857721548348, + "angularVelocity": 0.5304461908293124, + "velocityX": 0.8920155616834367, + "velocityY": 1.1499538097838968, "moduleForcesX": [ - 107.73349084432316, - 114.74365869825861, - 42.57429428279717, - -15.73401800942879 + 108.92191896913738, + 112.92169627828845, + 40.83914052431152, + -24.073517173914706 ], "moduleForcesY": [ - 41.23196001279386, - -10.435058862443286, - 107.21934325723095, - 114.20366129024539 + 37.95851016971204, + -22.74755439175256, + 107.88598647473655, + 112.73101496176483 ], - "timestamp": 4.722104287811623 + "timestamp": 4.780575471616241 }, { - "x": 12.728715540940653, - "y": 5.790966829650067, - "heading": -2.400757331938542, - "angularVelocity": 1.1622039219262574, - "velocityX": 1.1154126408566907, - "velocityY": 1.4004247778030527, + "x": 12.728861058925617, + "y": 5.791245681753849, + "heading": -2.409256654879776, + "angularVelocity": 1.2567232490256017, + "velocityX": 1.0990859157175115, + "velocityY": 1.3769206390986344, "moduleForcesX": [ - 101.36053530623595, - 110.66151469383205, - 48.45480141271534, - 15.613856789127393 + 103.43030407712452, + 113.54722733635009, + 45.305379884050836, + 3.5622560281788673 ], "moduleForcesY": [ - 55.00994604222918, - 32.04293220940848, - 104.66041275307694, - 114.18177265531891 + 50.97945546219835, + 19.2011880487645, + 106.04826799334413, + 115.16014318689237 ], - "timestamp": 4.765878566694095 + "timestamp": 4.82481836018513 }, { "x": 12.787519454956056, "y": 5.863831043243408, "heading": -2.338954063654469, - "angularVelocity": 1.4118626248534205, - "velocityX": 1.3433439799952491, - "velocityY": 1.664544007428914, + "angularVelocity": 1.5890144947439437, + "velocityX": 1.3258265436060839, + "velocityY": 1.6406108153751708, "moduleForcesX": [ - 89.0095262170121, - 91.58391515691522, - 60.88263773717486, - 54.28386759761477 + 91.90028015401259, + 96.27958972310033, + 56.8579037507402, + 46.06087466370149 ], "moduleForcesY": [ - 73.26063193173053, - 69.9179774586011, - 97.89690993994556, - 101.64123727775404 + 69.54780453921919, + 63.17742305853098, + 100.25336076622867, + 105.5573617066181 ], - "timestamp": 4.809652845576567 + "timestamp": 4.8690612487540195 }, { - "x": 12.915220320349816, - "y": 6.020393862485399, - "heading": -2.2550043978645964, - "angularVelocity": 1.1361394897718229, - "velocityX": 1.7282498350266056, - "velocityY": 2.11885538670354, + "x": 12.914711706648111, + "y": 6.019663725891664, + "heading": -2.24237574365633, + "angularVelocity": 1.2998708875413283, + "velocityX": 1.7119111732169021, + "velocityY": 2.097389636782225, "moduleForcesX": [ - 62.139752976635314, - 64.01795106751091, - 85.86840122939797, - 83.8579203826501 + 61.50166852819614, + 63.359586176485415, + 86.30910394415389, + 83.98957274568104 ], "moduleForcesY": [ - 97.1381071719754, - 95.94171307643394, - 76.96736480457938, - 79.19011036368791 + 97.48422295362255, + 96.32955114118775, + 76.39900626600664, + 78.99253694196852 ], - "timestamp": 4.883543126255687 + "timestamp": 4.943359643251348 }, { - "x": 13.071197496085677, - "y": 6.210363644739984, - "heading": -2.1966884800371806, - "angularVelocity": 0.7892231196232886, - "velocityX": 2.1109295336583713, - "velocityY": 2.5709711819820673, + "x": 13.070533718168743, + "y": 6.2093375039790075, + "heading": -2.1683147361300525, + "angularVelocity": 0.9968049515382151, + "velocityX": 2.0972460115034464, + "velocityY": 2.5528650971611744, "moduleForcesX": [ - 58.99376208477216, - 60.82496922096946, - 89.12126008495656, - 85.23274796355747 + 61.44436515676362, + 62.09781410875336, + 87.31016658655857, + 83.73437350844729 ], "moduleForcesY": [ - 98.97383223128598, - 97.91898127763481, - 73.04209646880699, - 77.61460069122454 + 97.27543927473157, + 96.94974979682499, + 74.95382044646945, + 79.02989424707079 ], - "timestamp": 4.957433406934808 + "timestamp": 5.017658037748677 }, { - "x": 13.254669522546797, - "y": 6.4329309171083375, - "heading": -2.182092105367393, - "angularVelocity": 0.19754119940584156, - "velocityX": 2.4830332863110116, - "velocityY": 3.01213191129812, + "x": 13.250688758689678, + "y": 6.423961245560544, + "heading": -2.168369530757999, + "angularVelocity": -0.000737494104917048, + "velocityX": 2.424750113912751, + "velocityY": 2.8886726696261475, "moduleForcesX": [ - 45.294275725710335, - 52.25945512194472, - 98.3308784358966, - 90.15821094756855 + 18.853251410044052, + 40.74857935885112, + 98.53054513091199, + 92.24301069870756 ], "moduleForcesY": [ - 105.58458947812339, - 102.52257021365493, - 59.49254286882577, - 71.52845266276242 + 93.15672622133015, + 96.3145956066308, + 16.04638677085443, + 51.20564283434744 ], - "timestamp": 5.031323687613928 + "timestamp": 5.091956432246006 }, { - "x": 13.426157527489098, - "y": 6.635690019593373, - "heading": -2.2383487439162617, - "angularVelocity": -0.7613536994557007, - "velocityX": 2.3208465763855206, - "velocityY": 2.7440564661751172, + "x": 13.423176073078626, + "y": 6.629426011222936, + "heading": -2.205069527388233, + "angularVelocity": -0.4939541006037903, + "velocityX": 2.3215483397174745, + "velocityY": 2.7653998051031623, "moduleForcesX": [ - -67.52985880281344, - -56.50694068718355, - -16.560789556088512, - 15.921759844219237 + -39.5712782056326, + -27.481431549028095, + -13.336470845500253, + 1.4918968052180324 ], "moduleForcesY": [ - -46.19772680900119, - -13.18456476681599, - -81.95175795997638, - -64.74034721794925 + -22.657178376987773, + -3.7073202434867, + -42.427565932456204, + -25.44947588882923 ], - "timestamp": 5.105213968293048 + "timestamp": 5.166254826743335 }, { - "x": 13.569140494720084, - "y": 6.804691723426313, - "heading": -2.286189319497097, - "angularVelocity": -0.6474542408167393, - "velocityX": 1.9350713776810868, - "velocityY": 2.2871980222521517, + "x": 13.567172688216592, + "y": 6.8006505476140005, + "heading": -2.2561686473851945, + "angularVelocity": -0.6877553726789927, + "velocityX": 1.9380851512631625, + "velocityY": 2.304552306271156, "moduleForcesX": [ - -69.36641281157236, - -69.8462676272357, - -78.77988767550748, - -78.5597375960959 + -80.49825287187927, + -81.46564305418251, + -66.09113775652278, + -65.10081795177926 ], "moduleForcesY": [ - -91.78872830593477, - -91.46262829883032, - -83.84776974221282, - -84.0961432909433 + -82.1976309213605, + -81.15783169411546, + -94.17140740263714, + -94.78893254492681 ], - "timestamp": 5.179104248972169 + "timestamp": 5.240553221240663 }, { - "x": 13.683554684215164, - "y": 6.939904549706659, - "heading": -2.324810505911234, - "angularVelocity": -0.5226829030715882, - "velocityX": 1.5484335482759755, - "velocityY": 1.8299135561215278, + "x": 13.682388889273712, + "y": 6.937545900604296, + "heading": -2.303654079550955, + "angularVelocity": -0.6391178771361977, + "velocityX": 1.5507226210825065, + "velocityY": 1.842507552370002, "moduleForcesX": [ - -68.91646548695905, - -69.76232758546394, - -79.27764146129155, - -79.25899084877969 + -72.01424178451583, + -72.18570029563371, + -75.94750024233308, + -75.98943820596466 ], "moduleForcesY": [ - -92.3862498475593, - -91.77011872190114, - -83.6626902945486, - -83.70370167635772 + -89.99403758231816, + -89.86507715449537, + -86.69993664252142, + -86.67204720164708 ], - "timestamp": 5.252994529651289 + "timestamp": 5.314851615737992 }, { - "x": 13.769378113017817, - "y": 7.041319186543625, - "heading": -2.3539370497277994, - "angularVelocity": -0.3941864010918041, - "velocityX": 1.1614982107776157, - "velocityY": 1.3725030667751, + "x": 13.768802126651249, + "y": 7.040166816408869, + "heading": -2.3421837029749835, + "angularVelocity": -0.5185794886242573, + "velocityX": 1.1630565904172108, + "velocityY": 1.3811996409728973, "moduleForcesX": [ - -68.69416422988444, - -69.80382238745496, - -79.38562401155959, - -79.5605145541956 + -68.83655705259301, + -69.78078581158695, + -78.809584162956, + -78.94197823204145 ], "moduleForcesY": [ - -92.63831320439046, - -91.81935170246211, - -83.65606631768833, - -83.50590561929272 + -92.5349745458162, + -91.8382201142605, + -84.2019727811292, + -84.09261841954962 ], - "timestamp": 5.32688481033041 + "timestamp": 5.389150010235321 }, { - "x": 13.826599505033213, - "y": 7.108931315252294, - "heading": -2.373433389011578, - "angularVelocity": -0.2638552608623059, - "velocityX": 0.7744102673515239, - "velocityY": 0.9150341301623246, + "x": 13.826409668067303, + "y": 7.1085546328421145, + "heading": -2.3692035095547546, + "angularVelocity": -0.36366608945691725, + "velocityX": 0.7753537853112544, + "velocityY": 0.9204481051835359, "moduleForcesX": [ - -68.56304647527125, - -69.84897377197196, - -79.41828548071045, - -79.73113036544858 + -67.15141087474257, + -68.7697448512468, + -80.10733272532873, + -80.36853069934814 ], "moduleForcesY": [ - -92.77867605554368, - -91.82527817186566, - -83.67315905858817, - -83.38745301845488 + -93.80797979702136, + -92.64041961485175, + -83.01627453571552, + -82.77776530877918 ], - "timestamp": 5.40077509100953 + "timestamp": 5.46344840473265 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -0.1323754049192257, - "velocityX": 0.38723234385763017, - "velocityY": 0.4575300935677065, + "angularVelocity": -0.18857924691523403, + "velocityX": 0.38766037592671854, + "velocityY": 0.46008678483988286, "moduleForcesX": [ - -68.48839210839299, - -69.86757393943373, - -79.44566757381507, - -79.82897176171012 + -66.12682297577675, + -68.20517667619286, + -80.86078377461966, + -81.19705273807568 ], "moduleForcesY": [ - -92.85970357248277, - -91.83521466144767, - -83.67612133165606, - -83.32050872366115 + -94.55836495850359, + -93.08125167677997, + -82.3115890516093, + -81.99291564808973 ], - "timestamp": 5.47466537168865 + "timestamp": 5.5377467992299785 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -4.38467207280536e-20, - "velocityX": -4.0904408010942157e-19, - "velocityY": 2.6769636069327637e-19, + "angularVelocity": 1.080567090593154e-18, + "velocityX": 3.1368683313884955e-18, + "velocityY": -3.703942145745268e-18, "moduleForcesX": [ - -68.45716377960287, - -69.84827604991912, - -79.49268727695612, - -79.87431218532066 + -65.47502708227233, + -67.78484334953554, + -81.40565230070824, + -81.69905950491292 ], "moduleForcesY": [ - -92.89994179563085, - -91.86589702825168, - -83.65083737459666, - -83.29490255274521 + -95.02748219177589, + -93.40351824166105, + -81.79230598951985, + -81.5109337765353 ], - "timestamp": 5.548555652367771 + "timestamp": 5.612045193727307 }, { - "x": 13.861959905913299, - "y": 7.132795995001895, - "heading": -2.342514973243809, - "angularVelocity": 0.896810182021551, - "velocityX": 0.14868426993683032, - "velocityY": -0.21907789247414935, + "x": 13.861807281102129, + "y": 7.133643639193121, + "heading": -2.336022603850437, + "angularVelocity": 1.0267084963209077, + "velocityX": 0.14348211565163527, + "velocityY": -0.19786406226744235, "moduleForcesX": [ - 92.60899812029683, - 36.581383436885694, - 114.99026329766751, - -58.08810301954257 + 93.94614327648092, + 36.13879487108392, + 111.62905057926098, + -64.40510932898498 ], "moduleForcesY": [ - -68.83786410265965, - -109.44730735929382, - 3.712550595135854, - -99.6242520623601 + -67.0032729880947, + -109.595479702191, + 27.752839981561817, + -95.66578127078265 ], - "timestamp": 5.593938356989299 + "timestamp": 5.658009594679225 }, { - "x": 13.875819150724183, - "y": 7.112249186067297, - "heading": -2.2656047143722495, - "angularVelocity": 1.6947041722823237, - "velocityX": 0.305386047977193, - "velocityY": -0.4527453598446684, + "x": 13.875608290481761, + "y": 7.114745707898614, + "heading": -2.246841818550783, + "angularVelocity": 1.9402142408631486, + "velocityX": 0.3002543075470427, + "velocityY": -0.41114277360594026, "moduleForcesX": [ - 94.28574172878825, - 40.518324824763326, - 113.84938976113067, - -52.526238566412395 + 95.8672758122096, + 40.82163317785168, + 114.4218987153328, + -57.37863739639605 ], "moduleForcesY": [ - -66.49833461253938, - -108.04061737317623, - -15.264647771952621, - -102.6535173648968 + -64.19626033624898, + -107.9265810590626, + 8.587675737899398, + -100.025272764473 ], - "timestamp": 5.639321061610827 + "timestamp": 5.703973995631142 }, { - "x": 13.896716131123098, - "y": 7.0794637940045515, - "heading": -2.160842027100097, - "angularVelocity": 2.308427585923494, - "velocityX": 0.4604613271330157, - "velocityY": -0.7224204096287639, + "x": 13.896548291041885, + "y": 7.083371828358983, + "heading": -2.1286943803030045, + "angularVelocity": 2.570411792625565, + "velocityX": 0.4555699655920011, + "velocityY": -0.6825690945575763, "moduleForcesX": [ - 96.06095182204432, - 45.624218221432486, - 96.82610095310335, - -44.41977169952861 + 97.68723324634834, + 46.630127487620676, + 94.9842558173518, + -47.369366627210084 ], "moduleForcesY": [ - -63.868948710552424, - -105.96943008095943, - -61.2878116865948, - -106.39784959154366 + -61.345098525025094, + -105.52853662580156, + -63.42452839101009, + -105.11852994950135 ], - "timestamp": 5.684703766232356 + "timestamp": 5.74993839658306 }, { - "x": 13.923432914333938, - "y": 7.032861637076851, - "heading": -2.033144193714598, - "angularVelocity": 2.813799539944651, - "velocityX": 0.5886996694808474, - "velocityY": -1.026870419388657, + "x": 13.922680903431022, + "y": 7.03765513765653, + "heading": -1.985611009529513, + "angularVelocity": 3.1129171230398116, + "velocityX": 0.5685402582854093, + "velocityY": -0.9946108239347283, "moduleForcesX": [ - 97.08414428392167, - 51.22850417511766, - 45.60897792644892, - -33.41911257960123 + 98.19933570612807, + 52.70680448168723, + 22.355607509561942, + -33.65803533403781 ], "moduleForcesY": [ - -62.239918850679075, - -103.35106272656319, - -105.13082797687291, - -110.32640894319715 + -60.4417252556641, + -102.5971447878816, + -112.31949341574553, + -110.24906301300281 ], - "timestamp": 5.730086470853884 + "timestamp": 5.7959027975349775 }, { - "x": 13.955563785040498, - "y": 6.972050456195828, - "heading": -1.8825723884399712, - "angularVelocity": 3.317823530579129, - "velocityX": 0.7079981454282456, - "velocityY": -1.3399637899098766, + "x": 13.954174358221836, + "y": 6.977261876671765, + "heading": -1.8186031014993125, + "angularVelocity": 3.6334185711438747, + "velocityX": 0.6851705698015748, + "velocityY": -1.3139138057720028, "moduleForcesX": [ - 95.89341392145519, - 56.462615374362215, - 15.864319365251628, - -18.90693012956116 + 94.58841581785215, + 57.482680844528296, + 7.1519899456507785, + -15.096484175146825 ], "moduleForcesY": [ - -63.953071935174876, - -100.54214801306098, - -113.69206080698899, - -113.67892793538894 + -65.80975762610504, + -99.93840204825545, + -114.6027216210397, + -114.22968117284634 ], - "timestamp": 5.775469175475412 + "timestamp": 5.841867198486895 }, { - "x": 13.993619206361197, - "y": 6.896657883852084, - "heading": -1.7125926377755643, - "angularVelocity": 3.7454742303695787, - "velocityX": 0.8385445873723288, - "velocityY": -1.6612622137108406, + "x": 13.991786121737945, + "y": 6.901429215857203, + "heading": -1.6368319977658938, + "angularVelocity": 3.9546061727980697, + "velocityX": 0.8182802938181745, + "velocityY": -1.6498128822322675, "moduleForcesX": [ - 88.01731264292725, - 59.0840763982514, - 15.927056261416332, - 0.36287524026553974 + 75.4236461603671, + 55.684709367906514, + 21.681375782988027, + 11.701403316569385 ], "moduleForcesY": [ - -74.24824099326673, - -98.93287625654578, - -113.78600820918643, - -115.16848981625489 + -86.9055431026712, + -100.8053807575965, + -112.86388870902914, + -114.51447272213056 ], - "timestamp": 5.82085188009694 + "timestamp": 5.887831599438813 }, { - "x": 14.037908607813321, - "y": 6.80587456385112, - "heading": -1.5371335721598818, - "angularVelocity": 3.866209981950951, - "velocityX": 0.9759092548907738, - "velocityY": -2.0003946604341567, + "x": 14.03442698872517, + "y": 6.809867684125599, + "heading": -1.4712785182458679, + "angularVelocity": 3.6017760721652428, + "velocityX": 0.927693304038252, + "velocityY": -1.9920096821752111, "moduleForcesX": [ - 55.303727996361445, - 49.44678346076422, - 35.635742871578024, - 31.53872568249567 + 7.4756095549990365, + 5.543216012475767, + 53.51925630688566, + 68.6696974754232 ], "moduleForcesY": [ - -100.77984511033996, - -103.84416234160268, - -109.2529908603062, - -110.57959724006975 + -114.67118987816583, + -114.51283157214998, + -101.73623001018527, + -91.95148315152574 ], - "timestamp": 5.866234584718469 + "timestamp": 5.93379600039073 }, { - "x": 14.087144535069578, - "y": 6.700360814437641, - "heading": -1.3841105056888872, - "angularVelocity": 3.3718366445354224, - "velocityX": 1.0849050903172033, - "velocityY": -2.3249771095270226, + "x": 14.0823789754651, + "y": 6.7033924335418655, + "heading": -1.3298228673892658, + "angularVelocity": 3.0775045018986713, + "velocityX": 1.0432418512337802, + "velocityY": -2.316472060521708, "moduleForcesX": [ - 3.0133443991748976, - -9.704067691995961, - 61.74194260289858, - 81.36746218585068 + 4.9681137901011345, + -11.029616583463108, + 64.88816529721264, + 83.96314322378822 ], "moduleForcesY": [ - -114.78558445562432, - -113.97825197610892, - -96.85819727429798, - -80.62385237514702 + -114.67679488503701, + -113.78423953190108, + -94.72104394783508, + -77.77423908356108 ], - "timestamp": 5.911617289339997 + "timestamp": 5.979760401342648 }, { - "x": 14.14226859299682, - "y": 6.580743460775094, - "heading": -1.2557023174275241, - "angularVelocity": 2.829452086036561, - "velocityX": 1.2146490251507223, - "velocityY": -2.6357475752074477, + "x": 14.13685205858906, + "y": 6.582925065175055, + "heading": -1.2157167466379832, + "angularVelocity": 2.4824890216810713, + "velocityX": 1.1851146103469143, + "velocityY": -2.620884116227876, "moduleForcesX": [ - 10.480286821125896, - -8.238341876639112, - 70.90518481088853, - 89.23977661435688 + 13.212936622716347, + -8.67539830647213, + 75.84281222650095, + 94.93975692280823 ], "moduleForcesY": [ - -114.10634114609925, - -113.67173817318366, - -90.05586637958596, - -71.12492607944955 + -113.75794165587317, + -113.47578028497102, + -85.85966695629838, + -63.08562287252783 ], - "timestamp": 5.956999993961525 + "timestamp": 6.025724802294565 }, { - "x": 14.204835516401594, - "y": 6.448466508306411, - "heading": -1.1561784745953227, - "angularVelocity": 2.192990560218639, - "velocityX": 1.378651270931431, - "velocityY": -2.9146996322016308, + "x": 14.199614035606237, + "y": 6.450362835829553, + "heading": -1.1340552186650188, + "angularVelocity": 1.7766255250098648, + "velocityX": 1.3654475141061873, + "velocityY": -2.884019515106307, "moduleForcesX": [ - 20.960314391027584, - -2.842849356642393, - 84.21445543262153, - 102.93252880524909 + 25.146700133293496, + -1.1305249249662828, + 90.22993499768113, + 108.60135018234804 ], "moduleForcesY": [ - -112.09268001844573, - -112.76901447740485, - -77.01708814164486, - -47.25631657837888 + -111.12312763663773, + -112.36380391179502, + -69.79003312905782, + -31.894172457931834 ], - "timestamp": 6.0023826985830535 + "timestamp": 6.071689203246483 }, { - "x": 14.278425287943143, - "y": 6.308166137099232, - "heading": -1.0878965211530789, - "angularVelocity": 1.50458096342397, - "velocityX": 1.6215378117116461, - "velocityY": -3.0914942680746504, + "x": 14.273205196850464, + "y": 6.3096531054550145, + "heading": -1.0871135355468409, + "angularVelocity": 1.0212617187654176, + "velocityX": 1.6010468910757547, + "velocityY": -3.061276280348623, "moduleForcesX": [ - 48.859656151615134, - 39.29215925118305, - 105.39970908610701, - 110.44414210433047 + 46.32646503626852, + 29.27418934062715, + 105.8355999225502, + 109.70707968043254 ], "moduleForcesY": [ - -100.5358220207968, - -96.55667751732808, - -39.89417637595948, - 15.711330603946356 + -101.6881811618927, + -98.80485347520826, + -38.70930863434508, + 20.15623938551683 ], - "timestamp": 6.047765403204582 + "timestamp": 6.1176536041984 }, { - "x": 14.356885484045446, - "y": 6.180875846162496, - "heading": -0.9964367241653384, - "angularVelocity": 2.015300713134569, - "velocityX": 1.7288567694813934, - "velocityY": -2.804819412996273, + "x": 14.352346828521247, + "y": 6.181353766919092, + "heading": -1.0166113057323838, + "angularVelocity": 1.5338442001715178, + "velocityX": 1.7218027436835717, + "velocityY": -2.7912762024274724, "moduleForcesX": [ - 40.76242627736614, - 85.26282068126751, - -33.51474181780654, - 41.80940406660451 + 43.849222398638176, + 84.51752285087134, + -24.29503991613957, + 45.15305908679976 ], "moduleForcesY": [ - 103.28724328208311, - 69.6297540554303, - 102.88363740482494, - 83.00028269478578 + 98.75569700086677, + 64.96243676079469, + 100.34497692617356, + 69.59109447988128 ], - "timestamp": 6.09314810782611 + "timestamp": 6.163618005150318 }, { - "x": 14.428558340071614, - "y": 6.066616737623039, - "heading": -0.8768712055992656, - "angularVelocity": 2.6346053978756356, - "velocityX": 1.5792989118627854, - "velocityY": -2.5176795762246367, + "x": 14.426005725789185, + "y": 6.066518080054045, + "heading": -0.9142430526433137, + "angularVelocity": 2.2271203576906267, + "velocityX": 1.602520553786623, + "velocityY": -2.4983614381306767, "moduleForcesX": [ - -23.024650236953327, - 15.495478785366409, - -85.25414758160815, - -94.40260108810803 + -10.689838775743358, + 35.21196936002609, + -80.76361369266837, + -91.16219383556731 ], "moduleForcesY": [ - 111.58942984648242, - 112.01377982791273, - 75.3161473098706, - 60.46352938099102 + 113.07820027057511, + 106.90487109121052, + 79.40920313766219, + 62.57889090102301 ], - "timestamp": 6.138530812447638 + "timestamp": 6.2095824061022356 }, { - "x": 14.49142295848577, - "y": 5.9648432002123934, - "heading": -0.7330923745075492, - "angularVelocity": 3.168141526397992, - "velocityX": 1.385210928665889, - "velocityY": -2.24256218882046, + "x": 14.491141108334089, + "y": 5.9645168700924796, + "heading": -0.7848130827682546, + "angularVelocity": 2.815874180769878, + "velocityX": 1.4170832469467167, + "velocityY": -2.2191349794434485, "moduleForcesX": [ - -41.53032424596707, - -9.897010287228593, - -93.16938210809725, - -98.32290187749236 + -36.159456633281756, + -1.6252737093363274, + -91.97875020999615, + -99.39177635875521 ], "moduleForcesY": [ - 106.82441101026959, - 113.74543897439574, - 66.58606054965573, - 57.179734029046564 + 108.60701730025053, + 113.90438381959041, + 67.96114697240343, + 54.58321208531797 ], - "timestamp": 6.183913517069167 + "timestamp": 6.255546807054153 }, { - "x": 14.544623158669278, - "y": 5.87572493089785, - "heading": -0.5718154821303135, - "angularVelocity": 3.553708262260154, - "velocityX": 1.1722571545079534, - "velocityY": -1.9637055582683072, + "x": 14.546449970003842, + "y": 5.874850586766935, + "heading": -0.631250104240621, + "angularVelocity": 3.340911125726901, + "velocityX": 1.2032977809850718, + "velocityY": -1.9507767199956136, "moduleForcesX": [ - -53.44415602897267, - -28.980375064219814, - -93.28776986457336, - -90.81965392427354 + -49.09953189561874, + -17.172798234951614, + -97.41391226966714, + -100.50042106685149 ], "moduleForcesY": [ - 101.68618809242784, - 110.93166649748392, - 66.88592374391406, - 69.51188559031735 + 103.78581109073833, + 113.20215773897431, + 60.60212605680512, + 54.03522331953084 ], - "timestamp": 6.229296221690695 + "timestamp": 6.301511208006071 }, { - "x": 14.588733197240783, - "y": 5.800221418575717, - "heading": -0.42158738976113214, - "angularVelocity": 3.3102498765117416, - "velocityX": 0.9719570250245041, - "velocityY": -1.6637067568317254, + "x": 14.591598722413101, + "y": 5.798850919958515, + "heading": -0.4725640797467414, + "angularVelocity": 3.4523679457908694, + "velocityX": 0.9822547770499443, + "velocityY": -1.6534462591587367, "moduleForcesX": [ - -74.00444289574996, - -84.82750480070263, - -36.15663713104418, - -55.70612713734391 + -64.14132388710318, + -57.74716179082214, + -77.86191188988668, + -73.40481169623028 ], "moduleForcesY": [ - 87.85806255534847, - 77.70219291275825, - 109.19057307139701, - 100.72627828960452 + 95.36643063243639, + 99.2968998274088, + 84.48333541278747, + 88.28122283949911 ], - "timestamp": 6.274678926312223 + "timestamp": 6.347475608957988 }, { - "x": 14.623971165481974, - "y": 5.737622434633646, - "heading": -0.2905912513710962, - "angularVelocity": 2.886477116833101, - "velocityX": 0.7764624989863818, - "velocityY": -1.3793577192923712, + "x": 14.627266293632685, + "y": 5.736313352300135, + "heading": -0.32976115295452907, + "angularVelocity": 3.106815792978476, + "velocityX": 0.7759825099623375, + "velocityY": -1.3605652714543037, "moduleForcesX": [ - -80.0246768887267, - -100.14721091439696, - -10.744716582138851, - -53.763436622298244 + -79.08825052742094, + -94.49368741243654, + -24.954444481983515, + -56.365800767000515 ], "moduleForcesY": [ - 82.35913095559447, - 56.88672408353364, - 114.69341623133508, - 101.95066373478761 + 83.32375870202404, + 65.75374939597963, + 112.38552797168428, + 100.46638970550259 ], - "timestamp": 6.320061630933751 + "timestamp": 6.393440009909906 }, { - "x": 14.650491204975971, - "y": 5.687579858551526, - "heading": -0.18109509490551892, - "angularVelocity": 2.4127287560035904, - "velocityX": 0.5843644559125126, - "velocityY": -1.1026794568427392, + "x": 14.65364085378242, + "y": 5.686523155503303, + "heading": -0.2086770773830198, + "angularVelocity": 2.6343011779523207, + "velocityX": 0.5738040658318332, + "velocityY": -1.0832338889593371, "moduleForcesX": [ - -74.48364034846936, - -106.88461675230056, - -2.774309758119724, - -56.286451842231365 + -80.75753449731462, + -105.75146527274016, + -6.533917978603814, + -56.800299326668465 ], "moduleForcesY": [ - 87.30364939891406, - 43.08617697815872, - 115.24782035664737, - 100.65158178859285 + 81.56714001969844, + 45.74125215422081, + 115.06672888896286, + 100.33878741771153 ], - "timestamp": 6.36544433555528 + "timestamp": 6.439404410861823 }, { - "x": 14.668829934744329, - "y": 5.65013543062385, - "heading": -0.09419471226356198, - "angularVelocity": 1.91483481133768, - "velocityX": 0.40409071960989107, - "velocityY": -0.8250814542664746, + "x": 14.671133184520741, + "y": 5.6493303593283635, + "heading": -0.1109888357303956, + "angularVelocity": 2.1253021823304925, + "velocityX": 0.38056257399327703, + "velocityY": -0.8091652540810123, "moduleForcesX": [ - -55.32796842006375, - -110.53141862820286, - -0.4423126125758408, - -59.32807159173019 + -67.41351148580846, + -110.75420648171135, + -0.987299919919722, + -59.64430713959497 ], "moduleForcesY": [ - 100.43619981044367, - 32.748204469854116, - 115.32725877892798, - 98.9287079347535 + 92.68928093179672, + 31.95250489621746, + 115.31159659481133, + 98.72856624844064 ], - "timestamp": 6.410827040176808 + "timestamp": 6.485368811813741 }, { - "x": 14.680031947562197, - "y": 5.625376428463603, - "heading": -0.032466736730672914, - "angularVelocity": 1.3601652005466338, - "velocityX": 0.24683440335448031, - "velocityY": -0.5455603046739033, + "x": 14.681023126809134, + "y": 5.624953566198197, + "heading": -0.03923900366198559, + "angularVelocity": 1.5609869939013463, + "velocityX": 0.21516526014856754, + "velocityY": -0.5303407120581256, "moduleForcesX": [ - -22.69780248396784, - -112.62711740856216, - 0.30424038499491796, - -61.80059569568245 + -29.537208536645696, + -113.2612737604008, + 0.7703487270790108, + -62.362582583263325 ], "moduleForcesY": [ - 112.34568644194837, - 24.716987102766776, - 115.35632305606234, - 97.42837626864956 + 110.53903877031718, + 21.605385460346547, + 115.34906975588962, + 97.06559527810772 ], - "timestamp": 6.456209744798336 + "timestamp": 6.5313332127656585 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -8.02923683034453e-19, - "angularVelocity": 0.7153988948307836, - "velocityX": 0.11473292914177731, - "velocityY": -0.2699509497396526, + "heading": 6.643546626004709e-18, + "angularVelocity": 0.85368247707683, + "velocityX": 0.09171687870089658, + "velocityY": -0.2573348440090306, "moduleForcesX": [ - 10.465866206746178, - -113.77295041301616, - 1.1484884755134444, - -63.178995978692946 + 23.85828752678224, + -114.45714666054057, + 2.026107569486801, + -63.97932141399083 ], "moduleForcesY": [ - 114.14538106924414, - 18.8786582623545, - 115.36971326990154, - 96.55763623804961 + 111.84032387601461, + 14.144281910460025, + 115.35597645325024, + 96.02804598950458 ], - "timestamp": 6.5015924494198645 + "timestamp": 6.577297613717576 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -3.9015796834549723e-19, - "angularVelocity": 6.131754693956049e-20, - "velocityX": 1.318646419686023e-19, - "velocityY": -2.1826006617042474e-19, + "heading": 3.475412312586324e-18, + "angularVelocity": -5.811723191789812e-19, + "velocityX": -9.954722773585959e-19, + "velocityY": 3.489115231904606e-18, "moduleForcesX": [ - 30.956584752298998, - -114.29048140187894, - 2.8833647328699366, - -63.148669433067454 + 61.21552776416918, + -114.90954967400437, + 4.2529323110693955, + -63.89858977846906 ], "moduleForcesY": [ - 110.35051173008722, - 15.57664785043353, - 115.35208140460223, - 96.59011418775707 + 96.54516819539677, + 10.052179512840738, + 115.30969681756606, + 96.0960223654071 ], - "timestamp": 6.546975154041393 + "timestamp": 6.623262014669494 }, { - "x": 14.65591627172833, - "y": 5.612955136335095, - "heading": -8.489678129046805e-19, - "angularVelocity": -7.637362615315964e-18, - "velocityX": -0.4881043332518622, - "velocityY": -0.0028329531955231684, + "x": 14.655916256843003, + "y": 5.612955128559063, + "heading": 3.1230036756654924e-18, + "angularVelocity": -5.866203252382288e-18, + "velocityX": -0.48810444502271244, + "velocityY": -0.0028330818461293926, "moduleForcesX": [ - -115.37658317775369, - -115.37658317775369, - -115.37658317775369, - -115.37658317775369 + -115.37657744801193, + -115.37657744801193, + -115.37657744801193, + -115.37657744801193 ], "moduleForcesY": [ - -0.6696446594201887, - -0.6696446594201887, - -0.6696446594201901, - -0.6696446594201901 + -0.6696748828445834, + -0.6696748828445834, + -0.6696748828445817, + -0.6696748828445817 ], - "timestamp": 6.6070495366475 + "timestamp": 6.683336414015382 }, { - "x": 14.597275655749772, - "y": 5.612614333848124, - "heading": -1.5130034106942078e-18, - "angularVelocity": -1.1053556745448901e-17, - "velocityX": -0.9761334771103636, - "velocityY": -0.005673008563491044, + "x": 14.597275612129625, + "y": 5.6126143107496995, + "heading": 2.4415453659675053e-18, + "angularVelocity": -1.1343572587073241e-17, + "velocityX": -0.9761336834305275, + "velocityY": -0.00567326203964737, "moduleForcesX": [ - -115.35881014296135, - -115.35881014296135, - -115.35881014296135, - -115.35881014296135 + -115.35880034739998, + -115.35880034739998, + -115.35880034739998, + -115.35880034739998 ], "moduleForcesY": [ - -0.6713234488387343, - -0.6713234488387343, - -0.6713234488387362, - -0.6713234488387362 + -0.6713527676407227, + -0.6713527676407227, + -0.6713527676407209, + -0.6713527676407209 ], - "timestamp": 6.667123919253607 + "timestamp": 6.74341081336127 }, { - "x": 14.509323753069854, - "y": 5.6121022780031975, - "heading": -2.1599359012185637e-18, - "angularVelocity": -1.0768857901728596e-17, - "velocityX": -1.4640500470324869, - "velocityY": -0.008523697168628809, + "x": 14.509323668724555, + "y": 5.612102232338162, + "heading": 1.3270385910322786e-18, + "angularVelocity": -1.8552108501746105e-17, + "velocityX": -1.4640503169856367, + "velocityY": -0.008524070437876919, "moduleForcesX": [ - -115.33220026624166, - -115.33220026624166, - -115.33220026624166, - -115.33220026624166 + -115.33218317019183, + -115.33218317019183, + -115.33218317019183, + -115.33218317019183 ], "moduleForcesY": [ - -0.6738369003473637, - -0.6738369003473637, - -0.6738369003473659, - -0.6738369003473659 + -0.6738650288924735, + -0.6738650288924735, + -0.6738650288924716, + -0.6738650288924716 ], - "timestamp": 6.727198301859714 + "timestamp": 6.803485212707158 }, { - "x": 14.392071800967997, - "y": 5.611417907491215, - "heading": -2.4955664249849538e-18, - "angularVelocity": -5.586915894948488e-18, - "velocityX": -1.9517795608595285, - "velocityY": -0.01139205235732751, + "x": 14.392071667687404, + "y": 5.611417832423418, + "heading": -7.763414819258763e-20, + "angularVelocity": -2.338221862268053e-17, + "velocityX": -1.9517798315727315, + "velocityY": -0.011392538622051734, "moduleForcesX": [ - -115.28798452865676, - -115.28798452865676, - -115.28798452865676, - -115.28798452865676 + -115.28795258322376, + -115.28795258322376, + -115.28795258322376, + -115.28795258322376 ], "moduleForcesY": [ - -0.6780128723861801, - -0.6780128723861801, - -0.678012872386183, - -0.678012872386183 + -0.6780393929688643, + -0.6780393929688643, + -0.6780393929688625, + -0.6780393929688625 ], - "timestamp": 6.787272684465821 + "timestamp": 6.863559612053046 }, { - "x": 14.245542144768796, - "y": 5.610559112618229, - "heading": -2.17152151744822e-18, - "angularVelocity": 5.394061398292092e-18, - "velocityX": -2.4391371137337936, - "velocityY": -0.01429552557564081, + "x": 14.24554196375991, + "y": 5.6105590018551865, + "heading": -1.80725653301977e-18, + "angularVelocity": -2.879133879933629e-17, + "velocityX": -2.439137228552605, + "velocityY": -0.01429611577615215, "moduleForcesX": [ - -115.20006155628543, - -115.20006155628543, - -115.20006155628543, - -115.20006155628543 + -115.19999260587228, + -115.19999260587228, + -115.19999260587228, + -115.19999260587228 ], "moduleForcesY": [ - -0.6863139629294118, - -0.6863139629294118, - -0.6863139629294153, - -0.6863139629294154 + -0.6863383396984974, + -0.6863383396984974, + -0.6863383396984957, + -0.6863383396984957 ], - "timestamp": 6.847347067071928 + "timestamp": 6.923634011398934 }, { - "x": 14.06980078538855, - "y": 5.609519669852626, - "heading": -5.349757299589133e-19, - "angularVelocity": 2.724199096518095e-17, - "velocityX": -2.925396013347973, - "velocityY": -0.01730259589046419, + "x": 14.069800593542725, + "y": 5.609519517509087, + "heading": -3.822402694201517e-18, + "angularVelocity": -3.3544174940246164e-17, + "velocityX": -2.9253953785759013, + "velocityY": -0.01730328321909612, "moduleForcesX": [ - -114.94036531798051, - -114.94036531798051, - -114.94036531798051, - -114.94036531798051 + -114.94015610384217, + -114.94015610384217, + -114.94015610384217, + -114.94015610384217 ], "moduleForcesY": [ - -0.710801922179511, - -0.710801922179511, - -0.7108019221795149, - -0.710801922179515 + -0.7108246829504308, + -0.7108246829504308, + -0.7108246829504284, + -0.7108246829504284 ], - "timestamp": 6.907421449678035 + "timestamp": 6.983708410744822 }, { "x": 13.870342254638672, "y": 5.6078338623046875, - "heading": 3.933743569942127e-27, - "angularVelocity": 8.905222349190746e-18, - "velocityX": -3.320192769315282, - "velocityY": -0.028062003716167162, + "heading": 3.9144943965939805e-27, + "angularVelocity": 6.362781384131591e-17, + "velocityX": -3.3201886506702927, + "velocityY": -0.02805945998218547, "moduleForcesX": [ - -93.3208284583402, - -93.3208284583402, - -93.3208284583402, - -93.3208284583402 + -93.31997894760639, + -93.31997894760642, + -93.31997894760639, + -93.31997894760642 ], "moduleForcesY": [ - -2.5432753355726474, - -2.54327533557265, - -2.5432753355726443, - -2.5432753355726456 + -2.5425108785750434, + -2.5425108785750297, + -2.5425108785750763, + -2.5425108785750616 ], - "timestamp": 6.967495832284142 + "timestamp": 7.04378281009071 }, { - "x": 13.68164926660538, - "y": 5.606118094653867, - "heading": 3.562246310579434e-18, - "angularVelocity": 5.2260754068954895e-17, - "velocityX": -2.768263899294385, - "velocityY": -0.025171564120364344, + "x": 13.681649301516726, + "y": 5.60611809958223, + "heading": 4.016781723731204e-18, + "angularVelocity": 5.892911448413981e-17, + "velocityX": -2.7682631078990867, + "velocityY": -0.025171489278773905, "moduleForcesX": [ - 114.98181646144474, - 114.98181646144474, - 114.98181646144474, - 114.98181646144474 + 114.98111170716051, + 114.98111170716051, + 114.98111170716051, + 114.98111170716051 ], "moduleForcesY": [ - 0.6021572944443165, - 0.6021572944443164, - 0.6021572944443149, - 0.6021572944443149 + 0.6016428962296182, + 0.6016428962296182, + 0.6016428962296176, + 0.6016428962296176 ], - "timestamp": 7.0356587657679714 + "timestamp": 7.111945750449783 }, { - "x": 13.530664057996011, - "y": 5.6047070494208535, - "heading": 6.970402547713967e-18, - "angularVelocity": 5.0000140247988346e-17, - "velocityX": -2.21506324467662, - "velocityY": -0.020701063773144956, + "x": 13.53066408912991, + "y": 5.604707049037762, + "heading": 5.1354715756209854e-18, + "angularVelocity": 1.6411995171794605e-17, + "velocityX": -2.215063076672593, + "velocityY": -0.020701139608051117, "moduleForcesX": [ - 115.24676383245284, - 115.24676383245284, - 115.24676383245284, - 115.24676383245284 + 115.24662233874156, + 115.24662233874156, + 115.24662233874156, + 115.24662233874156 ], "moduleForcesY": [ - 0.9313269849343858, - 0.9313269849343858, - 0.9313269849343856, - 0.9313269849343855 + 0.931295500981224, + 0.931295500981224, + 0.9312955009812263, + 0.9312955009812263 ], - "timestamp": 7.103821699251801 + "timestamp": 7.180108690808855 }, { - "x": 13.417411634272256, - "y": 5.603631896857166, - "heading": 8.236144995060866e-18, - "angularVelocity": 1.856936577441259e-17, - "velocityX": -1.6614957416793323, - "velocityY": -0.015773273078727883, + "x": 13.4174116528594, + "y": 5.603631894326559, + "heading": 1.818783720138006e-18, + "angularVelocity": -4.865822750357439e-17, + "velocityX": -1.6614957581629166, + "velocityY": -0.015773302993372113, "moduleForcesX": [ - 115.32318834172317, - 115.32318834172317, - 115.32318834172317, - 115.32318834172317 + 115.32313827588082, + 115.32313827588082, + 115.32313827588082, + 115.32313827588082 ], "moduleForcesY": [ - 1.0265930194309745, - 1.0265930194309745, - 1.0265930194309765, - 1.0265930194309765 + 1.0266024823241802, + 1.0266024823241802, + 1.0266024823241848, + 1.026602482324185 ], - "timestamp": 7.171984632735631 + "timestamp": 7.248271631167928 }, { - "x": 13.341903875147041, - "y": 5.602907459655186, - "heading": 6.178007203351896e-18, - "angularVelocity": -3.0194384099180574e-17, - "velocityX": -1.1077539546200272, - "velocityY": -0.010628022665019901, + "x": 13.341903882006394, + "y": 5.602907458005536, + "heading": 3.991433737025843e-18, + "angularVelocity": 3.187435872955762e-17, + "velocityX": -1.107754014941875, + "velocityY": -0.01062800866874692, "moduleForcesX": [ - 115.35949645880048, - 115.35949645880048, - 115.35949645880048, - 115.35949645880048 + 115.35947569038294, + 115.35947569038294, + 115.35947569038294, + 115.35947569038294 ], "moduleForcesY": [ - 1.0718958018897309, - 1.0718958018897309, - 1.0718958018897344, - 1.0718958018897344 + 1.0719048416122896, + 1.0719048416122896, + 1.071904841612296, + 1.071904841612296 ], - "timestamp": 7.240147566219461 + "timestamp": 7.316434571527 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0496509621177646e-24, - "angularVelocity": -9.063586088757749e-17, - "velocityX": -0.5539103568522852, - "velocityY": -0.0053556863887746315, + "heading": -7.63547360856752e-25, + "angularVelocity": -5.855725242145153e-17, + "velocityX": -0.5539104016139283, + "velocityY": -0.005355661647003148, "moduleForcesX": [ - 115.38070640237679, - 115.38070640237679, - 115.38070640237679, - 115.38070640237679 + 115.38069800613746, + 115.38069800613746, + 115.38069800613746, + 115.38069800613746 ], "moduleForcesY": [ - 1.0983712484822477, - 1.0983712484822479, - 1.0983712484822528, - 1.0983712484822528 + 1.0983733762750212, + 1.0983733762750214, + 1.0983733762750287, + 1.098373376275029 ], - "timestamp": 7.308310499703291 + "timestamp": 7.3845975118860725 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0735721824105399e-24, - "angularVelocity": 3.03574595814805e-25, - "velocityX": -1.1997143110381767e-25, - "velocityY": 2.1379415454439605e-25, + "heading": -7.751526493297866e-25, + "angularVelocity": -2.26319747894764e-25, + "velocityX": 1.0079660491439562e-23, + "velocityY": 1.0284960672568687e-23, "moduleForcesX": [ - 115.39461413799822, - 115.39461413799822, - 115.39461413799822, - 115.39461413799822 + 115.39461182381044, + 115.39461182381044, + 115.39461182381044, + 115.39461182381044 ], "moduleForcesY": [ - 1.1157353471214961, - 1.1157353471214961, - 1.1157353471215021, - 1.1157353471215021 + 1.1157300801986871, + 1.1157300801986874, + 1.115730080198696, + 1.115730080198696 ], - "timestamp": 7.376473433187121 + "timestamp": 7.452760452245145 }, { - "x": 13.333301383153968, - "y": 5.573801506681172, - "heading": 0.01582323396916395, - "angularVelocity": 0.22214471367149297, - "velocityX": 0.4092925688636579, - "velocityY": -0.4034976421009908, + "x": 13.333295993090786, + "y": 5.573943438615316, + "heading": 0.020437528196768823, + "angularVelocity": 0.286600169331202, + "velocityX": 0.40875294832828113, + "velocityY": -0.40104983341622946, "moduleForcesX": [ - 83.99858675745838, - 94.50501486045636, - 67.60907694190239, - 80.27135887466491 + 84.66730708312953, + 97.79823624610925, + 63.20469705289822, + 79.91393576166892 ], "moduleForcesY": [ - -79.10404420877467, - -66.22016115527022, - -93.52088748741942, - -82.91786973993533 + -78.37881724715754, + -61.25124940458053, + -96.55297564085095, + -83.2653681457005 ], - "timestamp": 7.447702830041296 + "timestamp": 7.524070696912693 }, { - "x": 13.391608661329746, - "y": 5.516308685460145, - "heading": 0.04698081873325925, - "angularVelocity": 0.43742592440987155, - "velocityX": 0.8185844714528077, - "velocityY": -0.8071501902329565, + "x": 13.391605195610097, + "y": 5.516669588157704, + "heading": 0.05964137481241568, + "angularVelocity": 0.5497645786859513, + "velocityX": 0.8176833888475714, + "velocityY": -0.8031644082084757, "moduleForcesX": [ - 83.45340079540242, - 94.33138257713637, - 67.95070369572379, - 80.6480190559037 + 83.61176177048723, + 96.91343804537236, + 64.64704831280237, + 80.55330595264391 ], "moduleForcesY": [ - -79.65440454308327, - -66.4413647938875, - -93.25638851459766, - -82.53433216167754 + -79.47867664464073, + -62.612531761585, + -95.5764752904338, + -82.62882568534256 ], - "timestamp": 7.518932226895471 + "timestamp": 7.595380941580242 }, { - "x": 13.479069343718304, - "y": 5.430043615996792, - "heading": 0.09266849307007893, - "angularVelocity": 0.6414159933201998, - "velocityX": 1.227873409732959, - "velocityY": -1.2110880236703392, + "x": 13.479092151862174, + "y": 5.430610082205895, + "heading": 0.11503401938207429, + "angularVelocity": 0.7767838243705603, + "velocityX": 1.226849755739081, + "velocityY": -1.2068322911107945, "moduleForcesX": [ - 82.66507902834793, - 93.96622463847794, - 68.56375935722866, - 81.18607925768542 + 82.31821309565615, + 95.32187408048657, + 66.92262060727154, + 81.35076884094306 ], "moduleForcesY": [ - -80.43604135450076, - -66.91762608001522, - -92.78161616974033, - -81.97870276950549 + -80.78194903679575, + -64.9663793495728, + -93.97078846223012, + -81.81464976514656 ], - "timestamp": 7.590161623749646 + "timestamp": 7.666691186247791 }, { - "x": 13.595681225064894, - "y": 5.314972807576324, - "heading": 0.15163714964482242, - "angularVelocity": 0.827869660267757, - "velocityX": 1.6371313881166667, - "velocityY": -1.6154960381883665, + "x": 13.595776572869067, + "y": 5.3156098843885005, + "heading": 0.18248020319766606, + "angularVelocity": 0.9458133838977687, + "velocityX": 1.6362925348367765, + "velocityY": -1.6126742847893822, "moduleForcesX": [ - 81.69939794150892, - 93.23102514178395, - 69.5958264531128, - 81.83020425409691 + 81.1896130380787, + 92.24877909794785, + 70.6324201788653, + 82.06283505268615 ], "moduleForcesY": [ - -81.35800277160789, - -67.87302901661616, - -91.96759965124197, - -81.29029357501486 + -81.8607204454983, + -69.19153030778288, + -91.1668535849204, + -81.04640774388072 ], - "timestamp": 7.661391020603821 + "timestamp": 7.7380014309153395 }, { - "x": 13.741436224010505, - "y": 5.171041089911012, - "heading": 0.2217535698888416, - "angularVelocity": 0.9843747573430274, - "velocityX": 2.0462759111102518, - "velocityY": -2.020678596506685, + "x": 13.74166340562453, + "y": 5.1714841013846, + "heading": 0.2539935851566899, + "angularVelocity": 1.0028486410672468, + "velocityX": 2.0458046867682906, + "velocityY": -2.021109080130372, "moduleForcesX": [ - 80.7428208802436, - 91.63008521058406, - 71.45739720683228, - 82.43567724433055 + 81.09664380826153, + 85.27750689601766, + 77.82613865257939, + 81.9886155863237 ], "moduleForcesY": [ - -82.19417166226108, - -69.89172174791939, - -90.44018204803689, - -80.58049754682136 + -81.85175642641818, + -77.49783429262001, + -84.99010839197298, + -80.99105848577611 ], - "timestamp": 7.732620417457996 + "timestamp": 7.809311675582888 }, { - "x": 13.916293939822738, - "y": 4.998155595405218, - "heading": 0.2975701335207255, - "angularVelocity": 1.0643999104344446, - "velocityX": 2.4548532422675313, - "velocityY": -2.4271649366866526, + "x": 13.916324671873264, + "y": 4.998926787820056, + "heading": 0.3028208316702331, + "angularVelocity": 0.6847157339198316, + "velocityX": 2.4493152009646426, + "velocityY": -2.419810987453681, "moduleForcesX": [ - 80.52618577124296, - 86.7098035480735, - 76.2536897185494, - 82.32400313465453 + 84.03168175068858, + 60.98601461651429, + 100.69711811876594, + 75.69360315918162 ], "moduleForcesY": [ - -82.08532933524775, - -75.55570587121076, - -86.13264049441516, - -80.37257801256403 + -78.57987315738377, + -97.49882069315494, + -55.29287195277618, + -86.20664997158069 ], - "timestamp": 7.803849814312171 + "timestamp": 7.880621920250437 }, { - "x": 14.09087619721131, - "y": 4.825248874693559, - "heading": 0.373019602814959, - "angularVelocity": 1.0592462189269634, - "velocityX": 2.4509860408615456, - "velocityY": -2.4274629345190584, + "x": 14.090871166457541, + "y": 4.825643663887782, + "heading": 0.3511151918655964, + "angularVelocity": 0.6772429462346373, + "velocityX": 2.4477057314558563, + "velocityY": -2.42998919356015, "moduleForcesX": [ - -0.5815156712319215, - -0.8313154127123616, - -0.7105986959001992, - -0.9604102516570998 + -0.048891828234506295, + -0.413005607259846, + -0.22796342076112328, + -0.5921306405396577 ], "moduleForcesY": [ - -0.17899030509093042, - -0.275088677914427, - 0.15634311137280021, - 0.06010210281662784 + -2.2043649748922296, + -2.337697398866358, + -1.715902956438727, + -1.8492859161842365 ], - "timestamp": 7.875079211166346 + "timestamp": 7.951932164917986 }, { - "x": 14.236385775704122, - "y": 4.681164504915296, - "heading": 0.4379095506597357, - "angularVelocity": 0.9109995410690161, - "velocityX": 2.042830417204086, - "velocityY": -2.022821702017776, + "x": 14.236498874993657, + "y": 4.681149821933151, + "heading": 0.41512274351300327, + "angularVelocity": 0.8975926523014044, + "velocityX": 2.0421709281049076, + "velocityY": -2.026270455644455, "moduleForcesX": [ - -77.62580863219604, - -91.18252045297275, - -72.23833707289428, - -84.43073188208308 + -84.90374854906725, + -67.54599174060318, + -95.29586306490957, + -75.27522227287814 ], "moduleForcesY": [ - 84.80855065381803, - 70.08510741611298, - 89.57057617080255, - 78.2106668523955 + 77.6147583667962, + 93.07759399799761, + 64.18090637545481, + 86.70101544096629 ], - "timestamp": 7.946308608020521 + "timestamp": 8.023242409585535 }, { - "x": 14.352794206677883, - "y": 4.565894974920919, - "heading": 0.49049547140066846, - "angularVelocity": 0.7382614912293785, - "velocityX": 1.634275118348653, - "velocityY": -1.6182859196514374, + "x": 14.35293077040835, + "y": 4.565754778501453, + "heading": 0.47353374686901495, + "angularVelocity": 0.8191109654486024, + "velocityX": 1.632751310243042, + "velocityY": -1.6182112958618482, "moduleForcesX": [ - -76.1078859700308, - -92.8635423382786, - -71.22089704597018, - -85.60378749942646 + -79.38401877213782, + -86.70173496470736, + -76.59134612886815, + -83.43809887191112 ], "moduleForcesY": [ - 86.50055242381342, - 68.23029646989542, - 90.64276801323516, - 77.21719460477229 + 83.51024074907058, + 75.89707047860773, + 86.11608026131252, + 79.50816094167695 ], - "timestamp": 8.017538004874696 + "timestamp": 8.094552654253084 }, { - "x": 14.440098961466248, - "y": 4.4794418527905195, - "heading": 0.530262298117705, - "angularVelocity": 0.5582923409901833, - "velocityX": 1.2256843191737132, - "velocityY": -1.21372812277761, + "x": 14.440197735334287, + "y": 4.479318845326742, + "heading": 0.5205395471666466, + "angularVelocity": 0.6591731737392686, + "velocityX": 1.2237647666584326, + "velocityY": -1.2121110168346618, "moduleForcesX": [ - -75.143525628293, - -93.27282582567612, - -71.14081537799724, - -86.26725520322114 + -76.05393950763325, + -91.96458850927128, + -72.0793563135359, + -85.67235755159167 ], "moduleForcesY": [ - 87.44982615530445, - 67.80015365809159, - 90.78923076727234, - 76.56915606002673 + 86.6543340713705, + 69.55656402670749, + 90.03678616248824, + 77.22355997042732 ], - "timestamp": 8.088767401728871 + "timestamp": 8.165862898920633 }, { - "x": 14.498301446686176, - "y": 4.421807328352338, - "heading": 0.5569527942334483, - "angularVelocity": 0.3747118085301997, - "velocityX": 0.8171132677015908, - "velocityY": -0.8091395825823801, + "x": 14.498343080799437, + "y": 4.421751377581397, + "heading": 0.5533788018685339, + "angularVelocity": 0.46051243906097156, + "velocityX": 0.8153855836033778, + "velocityY": -0.8072818711214393, "moduleForcesX": [ - -74.50739015764161, - -93.4289581443932, - -71.18348402973322, - -86.68884220281491 + -73.78272693454574, + -94.2833205460505, + -70.32485404051455, + -86.89555919568168 ], "moduleForcesY": [ - 88.04747340766619, - 67.6505855793752, - 90.79681638747405, - 76.13800705299523 + 88.64901027893603, + 66.44804317305021, + 91.46155626910209, + 75.90013809981603 ], - "timestamp": 8.159996798583046 + "timestamp": 8.237173143588182 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": 0.18854710036895106, - "velocityX": 0.4085592803911904, - "velocityY": -0.4045490599221039, + "angularVelocity": 0.23845225440008352, + "velocityX": 0.40751223255026625, + "velocityY": -0.4033057928676898, "moduleForcesX": [ - -74.14598545423118, - -93.54843405198011, - -71.17867844532277, - -86.9219690308431 + -72.28092066696583, + -95.62161114658008, + -69.3711228568063, + -87.60989544654508 ], "moduleForcesY": [ - 88.38488704635118, - 67.52515136113772, - 90.82487231947144, - 75.89955258668193 + 89.90999033784944, + 64.5500491439786, + 92.21350984982257, + 75.10570426878752 ], - "timestamp": 8.231226195437221 + "timestamp": 8.30848338825573 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": -3.196480441771765e-23, - "velocityX": 5.465355710587214e-23, - "velocityY": -4.689327739245502e-23, + "angularVelocity": -4.4195950751829394e-23, + "velocityX": 6.565713979713351e-23, + "velocityY": -7.386057640213947e-23, "moduleForcesX": [ - -74.04163357665932, - -93.70754772093753, - -71.06675825660118, - -86.9833483137024 + -71.44716369701283, + -96.59228734629673, + -68.61596217852517, + -87.9404950059459 ], "moduleForcesY": [ - 88.49408635582365, - 67.33114392906674, - 90.92845417388115, - 75.84771503471553 + 90.59549675575025, + 63.117985683089984, + 92.79347338693024, + 74.73839504419418 ], - "timestamp": 8.302455592291397 + "timestamp": 8.37979363292328 }, { - "x": 14.49804638425793, - "y": 4.378378905710642, - "heading": 0.5402862689246644, - "angularVelocity": -0.46684858464490536, - "velocityX": -0.45536797020744996, - "velocityY": -0.22666627016800778, + "x": 14.498046481587462, + "y": 4.378378938668267, + "heading": 0.5402846553367175, + "angularVelocity": -0.4668735990525236, + "velocityX": -0.4553664458137136, + "velocityY": -0.2266657516477214, "moduleForcesX": [ - -86.1910855019154, - -90.31940844346722, - -113.67801849819757, - -111.02458022432769 + -86.18981380029933, + -90.31876641561904, + -113.67833215471812, + -111.02482428420291 ], "moduleForcesY": [ - -76.68979833900977, - -71.82796867166277, - -19.71491355099119, - -31.47718312544661 + -76.69122231911774, + -71.82877383631241, + -19.713086660173527, + -31.47631759103055 ], - "timestamp": 8.366923221703962 + "timestamp": 8.444261264410038 }, { - "x": 14.43931308319445, - "y": 4.34921431694764, - "heading": 0.4800316822770909, - "angularVelocity": -0.9346487096953828, - "velocityX": -0.9110510437356667, - "velocityY": -0.45239120825061385, + "x": 14.439313277482153, + "y": 4.349214387879551, + "heading": 0.48002841051040274, + "angularVelocity": -0.9346744007291639, + "velocityX": -0.9110495104411049, + "velocityY": -0.4523906046510628, "moduleForcesX": [ - -85.55141100459039, - -91.08357348554144, - -113.51227513203798, - -111.34346253684424 + -85.55134610222815, + -91.0835993926443, + -113.5122715743279, + -111.3434843298819 ], "moduleForcesY": [ - -77.35792380941993, - -70.82047716964802, - -20.46082717051418, - -30.24125186998676 + -77.35798773989127, + -70.82043772341157, + -20.460816178917394, + -30.241157017363083 ], - "timestamp": 8.431390851116527 + "timestamp": 8.508728895896796 }, { - "x": 14.351171016540066, - "y": 4.30558804082172, - "heading": 0.38972613617406754, - "angularVelocity": -1.4007889994699154, - "velocityX": -1.367229840115769, - "velocityY": -0.6767159972135817, + "x": 14.351171166249667, + "y": 4.305588083853979, + "heading": 0.38972365883361226, + "angularVelocity": -1.4007766315307923, + "velocityX": -1.36723048760664, + "velocityY": -0.6767164082107209, "moduleForcesX": [ - -84.73884598587067, - -92.22471205340597, - -113.19203585458268, - -111.77189701377912 + -84.74080845033576, + -92.22557626068495, + -113.19149333747797, + -111.77152136175108 ], "moduleForcesY": [ - -78.16109203854988, - -69.25533775826135, - -21.804600786698895, - -28.42581379359055 + -78.15894950714633, + -69.25416976459643, + -21.80736431950343, + -28.427248361937462 ], - "timestamp": 8.495858480529092 + "timestamp": 8.573196527383555 }, { - "x": 14.233589173698537, - "y": 4.247619822740085, - "heading": 0.26996789764323587, - "angularVelocity": -1.8576491740441032, - "velocityX": -1.8238896623460294, - "velocityY": -0.899183336037755, + "x": 14.233588914840404, + "y": 4.247619595905105, + "heading": 0.26997308661776914, + "angularVelocity": -1.8575301970018723, + "velocityX": -1.8238959412277143, + "velocityY": -0.8991874931961759, "moduleForcesX": [ - -83.94734279206497, - -93.71262507711467, - -112.51014857524358, - -112.18119405884299 + -83.95312347953679, + -93.71457960486222, + -112.50854673479257, + -112.18000941325678 ], "moduleForcesY": [ - -78.75950431025406, - -67.00490432643183, - -24.107835571776057, - -26.138048273426037 + -78.75329673294335, + -67.00210588095803, + -24.115214852616447, + -26.14296935585298 ], - "timestamp": 8.560326109941657 + "timestamp": 8.637664158870313 }, { - "x": 14.115079803991925, - "y": 4.1906611165057175, - "heading": 0.16138894503781345, - "angularVelocity": -1.684239882787762, - "velocityX": -1.8382771444596275, - "velocityY": -0.8835241306897931, + "x": 14.115079451175838, + "y": 4.190660759682163, + "heading": 0.1613963797549536, + "angularVelocity": -1.684204993402254, + "velocityX": -1.838278542758427, + "velocityY": -0.8835261186017336, "moduleForcesX": [ - -9.13188600483001, - 0.6594868643931586, - -7.033546414107018, - 2.829502387337377 + -9.131767443283287, + 0.657652513902004, + -7.026024173540864, + 2.827996500407243 ], "moduleForcesY": [ - 9.22236053294357, - 10.854211773830855, - -3.940291709352419, - -2.3393545564545586 + 9.220317045131871, + 10.850457001015958, + -3.937376845183369, + -2.33456033627213 ], - "timestamp": 8.624793739354223 + "timestamp": 8.702131790357072 }, { - "x": 14.026121874269307, - "y": 4.147944154593341, - "heading": 0.08059232970734283, - "angularVelocity": -1.2532896907594953, - "velocityX": -1.3798852312891086, - "velocityY": -0.6626110235728712, + "x": 14.026121631743985, + "y": 4.147943895629665, + "heading": 0.0805975262697081, + "angularVelocity": -1.2533243679324726, + "velocityX": -1.3798834760995349, + "velocityY": -0.6626094842846951, "moduleForcesX": [ - 83.4973536278126, - 96.20030583423285, - 111.30688094678439, - 112.87287120033251 + 83.50128406439772, + 96.20123306665765, + 111.30567857439888, + 112.87198136728139 ], "moduleForcesY": [ - 79.26624964258428, - 63.39232613998023, - 29.071556787646845, - 22.91076603510508 + 79.26206350790244, + 63.390860409712666, + 29.076088096144087, + 22.914988055013154 ], - "timestamp": 8.689261368766788 + "timestamp": 8.76659942184383 }, { - "x": 13.966795553083806, - "y": 4.119469408000457, - "heading": 0.026899111947888268, - "angularVelocity": -0.8328709811220388, - "velocityX": -0.9202497707157782, - "velocityY": -0.44169061050248953, + "x": 13.966795455334186, + "y": 4.119469300656433, + "heading": 0.026901223924660083, + "angularVelocity": -0.8329188013689767, + "velocityX": -0.9202474953959547, + "velocityY": -0.44168824441893756, "moduleForcesX": [ - 83.72178565794114, - 97.04105274434198, - 111.04097404028195, - 113.1692570345272 + 83.7225268890319, + 97.04118666628618, + 111.04073186741968, + 113.16906929813969 ], "moduleForcesY": [ - 79.27865285910264, - 62.33849530904982, - 30.86623247761861, - 22.16395504861237 + 79.277855670948, + 62.338271276948674, + 30.8670649445909, + 22.16486600754754 ], - "timestamp": 8.753728998179353 + "timestamp": 8.831067053330589 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -5.471472021048484e-22, - "angularVelocity": -0.4172499003452693, - "velocityX": -0.4601476014328733, - "velocityY": -0.22081995024741832, + "heading": -7.672751967232841e-22, + "angularVelocity": -0.4172826471868354, + "velocityX": -0.46014607036910227, + "velocityY": -0.22081827805865759, "moduleForcesX": [ - 83.78966430984653, - 97.43168523301408, - 110.86442475699113, - 113.29850030582718 + 83.78876895559848, + 97.43147500123011, + 110.86467892511294, + 113.29868293583837 ], "moduleForcesY": [ - 79.28878914703334, - 61.80679526055779, - 31.75377302463106, - 21.754142326817494 + 79.28972924119255, + 61.807121644078165, + 31.75285868370552, + 21.753172555886685 ], - "timestamp": 8.818196627591918 + "timestamp": 8.895534684817347 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -2.8621211551694397e-22, - "angularVelocity": 5.572576028883896e-23, - "velocityX": -4.824070785889513e-23, - "velocityY": 2.571239855995328e-23, + "heading": -4.0079483813745946e-22, + "angularVelocity": 7.869245843501478e-23, + "velocityX": -6.798727482788098e-23, + "velocityY": 3.6396954748620986e-23, "moduleForcesX": [ - 83.72024176507074, - 97.43090964153055, - 110.92939949551024, - 113.34375281098819 + 83.71833110199695, + 97.43047601274753, + 110.92997514796727, + 113.34415942502997 ], "moduleForcesY": [ - 79.40203201217798, - 61.848085945116544, - 31.65827320851069, - 21.650429300155597 + 79.40404372307425, + 61.848767947517445, + 31.65623556989346, + 21.648293642924163 ], - "timestamp": 8.882664257004484 + "timestamp": 8.960002316304106 }, { - "x": 13.963559175947621, - "y": 4.117038967947073, - "heading": 0.030366199225700365, - "angularVelocity": 0.49847391634203947, - "velocityX": 0.4338307912320192, - "velocityY": 0.19378893670305897, + "x": 13.963559067974218, + "y": 4.117038855996892, + "heading": 0.030368053809770958, + "angularVelocity": 0.4985043435513874, + "velocityX": 0.4338290043854112, + "velocityY": 0.19378709255352022, "moduleForcesX": [ - 79.65664846502816, - 96.7817820837899, - 113.52833812262094, - 114.54083675568863 + 79.65476731370322, + 96.78133854290633, + 113.52876962438681, + 114.54105043150145 ], "moduleForcesY": [ - 83.46877311897669, - 62.85593025806044, - 20.384715377312528, - 13.981072396380851 + 83.47056524407438, + 62.85661167452952, + 20.38227792487243, + 13.979310801185607 ], - "timestamp": 8.943582588395898 + "timestamp": 9.020920649720072 }, { - "x": 14.016366174130928, - "y": 4.140701386661653, - "heading": 0.09167550612380743, - "angularVelocity": 1.006418027181029, - "velocityX": 0.8668490580283776, - "velocityY": 0.3884285431677946, + "x": 14.016365911548785, + "y": 4.140701139163088, + "heading": 0.09167991518604457, + "angularVelocity": 1.0064599265646343, + "velocityX": 0.8668464912522909, + "velocityY": 0.3884263051752232, "moduleForcesX": [ - 79.75263731487117, - 95.85123578413572, - 113.82581248115163, - 114.32031499165953 + 79.75194362178686, + 95.85098527966768, + 113.82595812934248, + 114.32037290983276 ], "moduleForcesY": [ - 83.33210206979211, - 64.22511537248802, - 18.4223489250406, - 15.504096672679982 + 83.3327591230383, + 64.22548363003438, + 18.42140386226322, + 15.503643170599599 ], - "timestamp": 9.004500919787313 + "timestamp": 9.081838983136038 }, { - "x": 14.095461362866395, - "y": 4.176301641210184, - "heading": 0.18482890661175871, - "angularVelocity": 1.5291522003355542, - "velocityX": 1.2983807489286403, - "velocityY": 0.5843931331571135, + "x": 14.09546101627666, + "y": 4.176301351792292, + "heading": 0.18483456282360425, + "angularVelocity": 1.5291726219999324, + "velocityX": 1.2983793267585335, + "velocityY": 0.5843924256121095, "moduleForcesX": [ - 79.85703113409431, - 94.3761457349691, - 114.17093924825683, - 113.9597881511265 + 79.8583024750478, + 94.37638365733321, + 114.17069050727945, + 113.95958149721488 ], "moduleForcesY": [ - 83.13867501463085, - 66.29352669629836, - 15.629038984963566, - 17.657848513922918 + 83.13743831492833, + 66.2931720124335, + 15.630779550308679, + 17.659120262265205 ], - "timestamp": 9.065419251178728 + "timestamp": 9.142757316552004 }, { - "x": 14.200699287122616, - "y": 4.223965232327085, - "heading": 0.3106849191969956, - "angularVelocity": 2.065979315431074, - "velocityX": 1.727524734386503, - "velocityY": 0.7824178704214827, + "x": 14.200699188552337, + "y": 4.223965142674428, + "heading": 0.31068656428821845, + "angularVelocity": 2.065913402542767, + "velocityX": 1.7275287483175548, + "velocityY": 0.7824211236488451, "moduleForcesX": [ - 80.1960591657279, - 92.27983792176538, - 114.33788054491679, - 113.32380930105033 + 80.20103541951023, + 92.28142357461464, + 114.33707780014122, + 113.32310550893337 ], "moduleForcesY": [ - 82.52218385370314, - 68.94832064257957, - 12.575832251224803, - 20.593651711278543 + 82.51730402352764, + 68.94614202726275, + 12.582895501177102, + 20.59733382901847 ], - "timestamp": 9.126337582570143 + "timestamp": 9.20367564996797 }, { - "x": 14.30480960423839, - "y": 4.273756936630003, - "heading": 0.440274689451697, - "angularVelocity": 2.1272705160300247, - "velocityX": 1.7090145894975617, - "velocityY": 0.8173517423350791, + "x": 14.304809926372224, + "y": 4.273756975831149, + "heading": 0.44027066008733234, + "angularVelocity": 2.127177296763508, + "velocityX": 1.7090214387349074, + "velocityY": 0.8173538303605641, "moduleForcesX": [ - -7.063912641839332, - -3.684421057893775, - -4.954961279242321, - -1.555725211526507 + -7.061909627091463, + -3.68518517704315, + -4.9517960037118725, + -1.5574851448945195 ], "moduleForcesY": [ - 9.597559778514192, - 11.19198717343441, - 5.090196808910568, - 6.6929024451344965 + 9.59809098836741, + 11.190702840893662, + 5.0913730591202535, + 6.691391790761715 ], - "timestamp": 9.187255913961557 + "timestamp": 9.264593983383936 }, { - "x": 14.38290241669244, - "y": 4.311211682575675, - "heading": 0.537136017858053, - "angularVelocity": 1.5900193947204506, - "velocityX": 1.2819263211968939, - "velocityY": 0.6148353884648875, + "x": 14.382902717879288, + "y": 4.3112117278174935, + "heading": 0.5371322202602826, + "angularVelocity": 1.5900231464238184, + "velocityX": 1.2819259347399998, + "velocityY": 0.6148354671916827, "moduleForcesX": [ - -82.51336670219094, - -88.82178084722041, - -114.69665015134913, - -112.1890206641741 + -82.51888433729174, + -88.82438792099875, + -114.69599016804355, + -112.18828932823602 ], "moduleForcesY": [ - -80.15041574335491, - -73.33093047177117, - -9.21770289044376, - -26.12896176757333 + -80.14469842932262, + -73.32771655792324, + -9.225518690999811, + -26.131944406933375 ], - "timestamp": 9.248174245352972 + "timestamp": 9.325512316799902 }, { - "x": 14.43496566772784, - "y": 4.336216845215367, - "heading": 0.6015938905381637, - "angularVelocity": 1.0581030571233854, - "velocityX": 0.8546401361665806, - "velocityY": 0.4104702487503784, + "x": 14.434965804754063, + "y": 4.33621686660926, + "heading": 0.6015921619911261, + "angularVelocity": 1.0581369862943197, + "velocityX": 0.8546374129980221, + "velocityY": 0.41046984363517086, "moduleForcesX": [ - -83.61446769451484, - -87.93445802257577, - -114.93625421398835, - -111.92017771507035 + -83.61615888406612, + -87.9353553509811, + -114.93605502522537, + -111.91995391554177 ], "moduleForcesY": [ - -79.30871463146501, - -74.61104959107463, - -8.79132443274591, - -27.840746229308348 + -79.30691637646417, + -74.60997644793589, + -8.793781645274763, + -27.84160522062182 ], - "timestamp": 9.309092576744387 + "timestamp": 9.386430650215868 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 0.5296576683558456, - "velocityX": 0.4273247996047913, - "velocityY": 0.20526140282074212, + "angularVelocity": 0.529686025578064, + "velocityX": 0.42732253606019294, + "velocityY": 0.20526104480936738, "moduleForcesX": [ - -84.19152726546557, - -87.47215406723159, - -115.01634601054388, - -111.75251144456591 + -84.1911992495474, + -87.47197704017138, + -115.01637354227934, + -111.75254715698384 ], "moduleForcesY": [ - -78.80193174691267, - -75.22571028375239, - -8.61896304131099, - -28.69190883048073 + -78.8022727113627, + -75.22591033857384, + -8.618524833768987, + -28.691755739808066 ], - "timestamp": 9.370010908135802 + "timestamp": 9.447348983631834 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 1.1797364189027284e-23, - "velocityX": -1.1325605604528817e-23, - "velocityY": 2.3217947109929744e-23, + "angularVelocity": 1.5901790954601477e-23, + "velocityX": -1.5508239035272037e-23, + "velocityY": 3.190246274802254e-23, "moduleForcesX": [ - -84.15066425501406, - -87.45368989610188, - -115.05496155327525, - -111.78204650706883 + -84.14903985656575, + -87.45282015084248, + -115.05512710586952, + -111.7822513078171 ], "moduleForcesY": [ - -78.90065034494464, - -75.28457785684638, - -8.534123812406214, - -28.668166390935667 + -78.90237620597068, + -75.28558613417827, + -8.531852509603707, + -28.667363381920115 ], - "timestamp": 9.430929239527217 + "timestamp": 9.5082673170478 } ], "trajectoryWaypoints": [ @@ -3295,7 +3337,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 0.4132336745934462, + "timestamp": 0.41166807773402103, "isStopPoint": false, "x": 14.509410858154297, "y": 6.206027030944824, @@ -3306,7 +3348,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 0.6561639411726726, + "timestamp": 0.6593576083295186, "isStopPoint": false, "x": 13.630112648010254, "y": 6.272213459014893, @@ -3317,7 +3359,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.2357315017277104, + "timestamp": 1.2429852180832028, "isStopPoint": true, "x": 12.456916809082031, "y": 6.506374835968018, @@ -3325,10 +3367,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { - "timestamp": 2.607126226805618, + "timestamp": 2.636019779416831, "isStopPoint": true, "x": 9.1, "y": 7.454689979553223, @@ -3336,10 +3378,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { - "timestamp": 4.104598551047538, + "timestamp": 4.162435647449048, "isStopPoint": true, "x": 12.638096809387207, "y": 5.593123435974121, @@ -3350,7 +3392,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 4.590781451164208, + "timestamp": 4.647846805909573, "isStopPoint": false, "x": 12.585567474365234, "y": 5.600627422332764, @@ -3361,7 +3403,7 @@ "controlIntervalCount": 5 }, { - "timestamp": 4.809652845576567, + "timestamp": 4.8690612487540195, "isStopPoint": false, "x": 12.787519454956055, "y": 5.863831043243408, @@ -3372,7 +3414,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 5.548555652367771, + "timestamp": 5.612045193727307, "isStopPoint": true, "x": 13.855212211608887, "y": 7.142738342285156, @@ -3383,7 +3425,7 @@ "controlIntervalCount": 22 }, { - "timestamp": 6.546975154041393, + "timestamp": 6.623262014669494, "isStopPoint": true, "x": 14.6852388381958, "y": 5.613125324249268, @@ -3394,7 +3436,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 6.967495832284142, + "timestamp": 7.04378281009071, "isStopPoint": false, "x": 13.870342254638672, "y": 5.6078338623046875, @@ -3405,7 +3447,7 @@ "controlIntervalCount": 6 }, { - "timestamp": 7.376473433187121, + "timestamp": 7.452760452245145, "isStopPoint": true, "x": 13.304147720336914, "y": 5.602542400360107, @@ -3416,7 +3458,7 @@ "controlIntervalCount": 13 }, { - "timestamp": 8.302455592291397, + "timestamp": 8.37979363292328, "isStopPoint": true, "x": 14.527402877807617, "y": 4.392991542816162, @@ -3427,7 +3469,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 8.882664257004484, + "timestamp": 8.960002316304106, "isStopPoint": true, "x": 13.93713092803955, "y": 4.105233669281006, @@ -3438,7 +3480,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 9.430929239527217, + "timestamp": 9.5082673170478, "isStopPoint": true, "x": 14.460997581481934, "y": 4.348721027374268, @@ -3534,7 +3576,7 @@ "name": "intake", "target": 3, "trajTargetIndex": 3, - "targetTimestamp": 1.2357315017277104, + "targetTimestamp": 1.2429852180832028, "offset": 0.4, "command": { "type": "named", @@ -3547,7 +3589,7 @@ "name": "intake", "target": 9, "trajTargetIndex": 9, - "targetTimestamp": 6.546975154041393, + "targetTimestamp": 6.623262014669494, "offset": 0.2, "command": { "type": "named", @@ -3560,7 +3602,7 @@ "name": "intake", "target": 12, "trajTargetIndex": 12, - "targetTimestamp": 8.302455592291397, + "targetTimestamp": 8.37979363292328, "offset": 0.2, "command": { "type": "named", @@ -3573,7 +3615,7 @@ "name": "intake", "target": 5, "trajTargetIndex": 5, - "targetTimestamp": 4.104598551047538, + "targetTimestamp": 4.162435647449048, "offset": 0.3, "command": { "type": "named", @@ -3594,7 +3636,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 24 + "controlIntervalCount": 25 }, { "x": 8.7, @@ -3603,7 +3645,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 20 + "controlIntervalCount": 21 }, { "x": 12.89710521697998, @@ -3682,10 +3724,10 @@ { "x": 16.113388061523438, "y": 2.058690309524536, - "heading": -5.911290029889773e-27, - "angularVelocity": -2.2741368514930436e-27, - "velocityX": -1.5134316947281816e-27, - "velocityY": 1.4749091747640022e-26, + "heading": -1.3192675701555174e-27, + "angularVelocity": -5.120628312608516e-28, + "velocityX": 1.3128854005502987e-26, + "velocityY": -8.391381995810073e-27, "moduleForcesX": [ 0, 0, @@ -3701,3154 +3743,3196 @@ "timestamp": 0 }, { - "x": 16.034243809496502, - "y": 2.0445076102417237, - "heading": -1.9973497625460715e-17, - "angularVelocity": -2.0081338779051517e-16, - "velocityX": -0.7957156869122083, - "velocityY": -0.14259274695339164, + "x": 16.035595110824165, + "y": 2.0447497642817187, + "heading": -2.4595850198596315e-17, + "angularVelocity": -2.4942588059145585e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.14137070869321683, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230425, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.357774654060638, - -20.357774654060627, - -20.357774654060627 + -20.35792154651867, + -20.35792154651867, + -20.357921546518657, + -20.357921546518657 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.09860985611290378 }, { - "x": 15.875967747836052, - "y": 2.016144441360754, - "heading": -5.1600821479672036e-17, - "angularVelocity": -3.1798086502327113e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.2851630766748124, + "x": 15.88002131887555, + "y": 2.0168708438170575, + "heading": -6.714340880249808e-17, + "angularVelocity": -4.3147369116802484e-16, + "velocityX": -1.5776697997661686, + "velocityY": -0.2827194112598734, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - -20.354574176009816, - -20.35457417600981, - -20.35457417600981, - -20.354574176009802 + -20.354752580314873, + -20.354752580314873, + -20.35475258031486, + -20.35475258031486 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.19721971222580756 }, { - "x": 15.638584633735167, - "y": 1.973605239386054, - "heading": -1.0173338631202558e-16, - "angularVelocity": -5.040324121575685e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563984, + "x": 15.64669087734002, + "y": 1.9750578832915355, + "heading": -1.2272941117994356e-16, + "angularVelocity": -5.636962121969091e-16, + "velocityX": -2.366197971817096, + "velocityY": -0.4240241510711468, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.55106593310009, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - -20.348206040044566, - -20.348206040044566, - -20.34820604004456, - -20.34820604004456 + -20.348421775770348, + -20.348421775770344, + -20.34842177577033, + -20.34842177577033 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.2958295683387113 }, { - "x": 15.322167709896716, - "y": 1.9169031294556198, - "heading": -1.5831936298865416e-16, - "angularVelocity": -5.689149640432954e-16, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 15.33567611436212, + "y": 1.919323843953726, + "heading": -1.984834521633126e-16, + "angularVelocity": -7.682197699925159e-16, + "velocityX": -3.153992666025245, + "velocityY": -0.5651974511959198, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048417 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - -20.32936628350109, - -20.329366283501095, - -20.329366283501088, - -20.32936628350109 + -20.32949395931806, + -20.329493959318057, + -20.329493959318047, + -20.329493959318047 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.3944394244516151 }, { - "x": 14.933440688201186, - "y": 1.847243004928388, - "heading": -1.3388748730441698e-16, - "angularVelocity": 2.4563788587865287e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 14.96955403361122, + "y": 1.853714538930282, + "heading": -2.677696161176793e-16, + "angularVelocity": -7.02629196352577e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180248, - -103.79354790180248 + -80.47536393454658, + -80.47536393454658, + -80.47536393454658, + -80.47536393454656 ], "moduleForcesY": [ - -18.59986846406024, - -18.59986846406025, - -18.599868464060304, - -18.599868464060314 + -14.421235366152786, + -14.421235366152787, + -14.421235366152782, + -14.421235366152784 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.4930492805645189 }, { - "x": 14.544710433230385, - "y": 1.7775823009962126, - "heading": -1.3942252466686606e-16, - "angularVelocity": -5.564922203932182e-17, - "velocityX": -3.9082909236715535, - "velocityY": -0.7003681690151492, + "x": 14.603431176065946, + "y": 1.7881050947048025, + "heading": -2.763926852338733e-16, + "angularVelocity": -8.744632081727001e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - -0.004641026935404772, - -0.004641026935415979, - -0.004641026935404772, - -0.004641026935415979 + -0.0011343830986481722, + -0.0011343830986250908, + -0.0011343830986481722, + -0.0011343830986250908 ], "moduleForcesY": [ - -0.0008316749189531905, - -0.0008316749189531906, - -0.0008316749189381512, - -0.0008316749189381512 + -0.00020328215815896224, + -0.00020328215815896224, + -0.0002032821581899367, + -0.0002032821581899367 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.5916591366774226 }, { - "x": 14.155980178236081, - "y": 1.7079215970598258, - "heading": -1.1657687895751773e-16, - "angularVelocity": 2.2968994216356014e-16, - "velocityX": -3.9082909239078325, - "velocityY": -0.7003681690574903, + "x": 14.237308318515241, + "y": 1.7224956504783495, + "heading": -2.5700045344553785e-16, + "angularVelocity": 1.9665612096159002e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -3.3733252146964024e-8, - -3.373324153298994e-8, - -3.3733252146964024e-8, - -3.373324153298994e-8 + -7.931396623961562e-9, + -7.93138596456208e-9, + -7.931396623961562e-9, + -7.93138596456208e-9 ], "moduleForcesY": [ - -6.044967827882044e-9, - -6.044967827882044e-9, - -6.044982071505302e-9, - -6.044982071505302e-9 + -1.4213120821275926e-9, + -1.4213120821275924e-9, + -1.4213263867103173e-9, + -1.4213263867103171e-9 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.6902689927903264 }, { - "x": 13.76724992324178, - "y": 1.638260893123439, - "heading": -1.4660809842490734e-16, - "angularVelocity": -3.0193364413974614e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.871185460964536, + "y": 1.6568862062518965, + "heading": -2.332515600997504e-16, + "angularVelocity": 2.40836913132689e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145579, "moduleForcesX": [ - -1.7870291174645942e-13, - -1.984781114965229e-13, - -1.787029117464594e-13, - -1.984781114965229e-13 + -7.562455688591036e-14, + -7.396691286762598e-14, + -7.562455688591036e-14, + -7.396691286762598e-14 ], "moduleForcesY": [ - -8.523302234904917e-14, - -8.523302234904917e-14, - -5.869531905751317e-14, - -5.869531905751317e-14 + 1.6709316559536332e-14, + 1.6709316559536325e-14, + 1.4484809819973387e-14, + 1.4484809819973394e-14 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.7888788489032301 }, { - "x": 13.378519668247476, - "y": 1.568600189187052, - "heading": -1.8997026664410195e-16, - "angularVelocity": -4.3596289796236307e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.505062603413833, + "y": 1.5912767620254435, + "heading": -2.82486849779877e-16, + "angularVelocity": -4.992937989801628e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.2971156305683035e-14, - -2.795674260204148e-14, - -2.2971156305683035e-14, - -2.7956742602041482e-14 + -7.061347163052097e-15, + -3.483072809517994e-14, + -7.061347163052085e-15, + -3.483072809517994e-14 ], "moduleForcesY": [ - 2.0004203762822518e-15, - 2.0004203762822534e-15, - 8.690922193675191e-15, - 8.690922193675194e-15 + -2.7110230144014444e-14, + -2.7110230144014435e-14, + 1.0155415770084611e-14, + 1.0155415770084619e-14 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.8874887050161339 }, { - "x": 12.989789413253172, - "y": 1.498939485250665, - "heading": -1.9166223749477501e-16, - "angularVelocity": -1.701106162880346e-17, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.138939745863128, + "y": 1.5256673177989906, + "heading": -2.91424140142493e-16, + "angularVelocity": -9.063283035491444e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - 1.7087397903500836e-14, - 3.2671462385594046e-14, - 1.708739790350083e-14, - 3.267146238559404e-14 + -3.0037169962633365e-14, + -1.4704388976622156e-14, + -3.003716996263337e-14, + -1.4704388976622162e-14 ], "moduleForcesY": [ - 1.1214756938034063e-14, - 1.1214756938034063e-14, - -9.698573118246464e-15, - -9.698573118246464e-15 + -7.860080706118566e-15, + -7.860080706118574e-15, + -2.843619612257921e-14, + -2.8436196122579215e-14 ], - "timestamp": 0.9946297820777839 + "timestamp": 0.9860985611290376 }, { - "x": 12.60105915825887, - "y": 1.4292787813142782, - "heading": -2.1132473221281133e-16, - "angularVelocity": -1.9768656716015265e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 12.772816888312423, + "y": 1.4600578735725376, + "heading": -2.7866776993087006e-16, + "angularVelocity": 1.2936202034999922e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -3.1561091183989215e-14, - -3.8281812957585957e-14, - -3.1561091183989215e-14, - -3.828181295758595e-14 + -2.8027421800298478e-14, + -1.9773311124507672e-14, + -2.802742180029848e-14, + -1.9773311124507675e-14 ], "moduleForcesY": [ - -4.378246769835839e-15, - -4.378246769835839e-15, - 4.6407529159753206e-15, - 4.640752915975323e-15 + 1.1639794476609557e-14, + 1.1639794476609555e-14, + 5.630345541752581e-16, + 5.6303455417525595e-16 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.0847084172419414 }, { - "x": 12.212328903264568, - "y": 1.3596180773778912, - "heading": -2.338892446919063e-16, - "angularVelocity": -2.268634308989279e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 12.406694030761718, + "y": 1.3944484293460846, + "heading": -2.5646567159181086e-16, + "angularVelocity": 2.2515090492364207e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7190572709139343e-14, - 1.610525910872734e-14, - 1.7190572709139343e-14, - 1.610525910872734e-14 + -1.3808172671853046e-14, + -1.0214215575821213e-14, + -1.3808172671853046e-14, + -1.0214215575821214e-14 ], "moduleForcesY": [ - -7.29643917334954e-15, - -7.296439173349538e-15, - -5.839982061915815e-15, - -5.839982061915817e-15 + 2.222720485034565e-14, + 2.2227204850345648e-14, + 1.7404226156707074e-14, + 1.7404226156707077e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.1833182733548453 }, { - "x": 11.823598648270266, - "y": 1.2899573734415042, - "heading": -2.5927098275735137e-16, - "angularVelocity": -2.5518779478058447e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 12.040571173211013, + "y": 1.3288389851196316, + "heading": -2.2224229801002295e-16, + "angularVelocity": 3.470583461819397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.6641443511735072e-14, - 2.5587840985466278e-14, - 2.6641443511735072e-14, - 2.5587840985466278e-14 + 2.0175105295583998e-14, + 2.474901922640669e-14, + 2.0175105295583998e-14, + 2.474901922640669e-14 ], "moduleForcesY": [ - -1.386672429304071e-14, - -1.3866724293040708e-14, - -1.245282245727067e-14, - -1.2452822457270669e-14 + -6.607702607368945e-16, + -6.607702607368945e-16, + -6.798820561685491e-15, + -6.798820561685492e-15 ], - "timestamp": 1.293018716701119 + "timestamp": 1.2819281294677491 }, { - "x": 11.434868393275963, - "y": 1.2202966695051174, - "heading": -2.6144430481414593e-16, - "angularVelocity": -2.1850562913018142e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 11.674448315660308, + "y": 1.2632295408931786, + "heading": -1.749528087057396e-16, + "angularVelocity": 4.795614877086492e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 4.753825314085828e-15, - 1.343344466918967e-14, - 4.7538253140858264e-15, - 1.343344466918967e-14 + 5.420610091677358e-16, + 5.5135209844670774e-15, + 5.420610091677348e-16, + 5.513520984467076e-15 ], "moduleForcesY": [ - 1.0157777233279833e-14, - 1.0157777233279832e-14, - -1.4900021085434622e-15, - -1.4900021085434647e-15 + 3.291962753668972e-15, + 3.291962753668971e-15, + -3.3795819800228904e-15, + -3.379581980022891e-15 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.380537985580653 }, { - "x": 11.046138138281659, - "y": 1.1506359655687304, - "heading": -2.6668925840610884e-16, - "angularVelocity": -5.273272220977154e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 11.308325458109605, + "y": 1.1976200966667256, + "heading": -1.6545141916537567e-16, + "angularVelocity": 9.635334550294471e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7853846881122523e-14, - 1.6705100127704452e-14, - 1.7853846881122526e-14, - 1.6705100127704452e-14 + 2.6333944897208536e-14, + 1.1956142837319584e-14, + 2.633394489720854e-14, + 1.1956142837319587e-14 ], "moduleForcesY": [ - 1.849796258873549e-14, - 1.849796258873549e-14, - 2.003954501948825e-14, - 2.003954501948825e-14 + -1.1841756113294508e-14, + -1.1841756113294505e-14, + 7.452807272774088e-15, + 7.45280727277409e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.4791478416935568 }, { - "x": 10.657407883287357, - "y": 1.0809752616323434, - "heading": -2.7494742477186974e-16, - "angularVelocity": -8.30275397395283e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 10.9422026005589, + "y": 1.1320106524402727, + "heading": -1.526261764676561e-16, + "angularVelocity": 1.300604543963397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.1611152108969522e-14, - -2.2738051071840055e-14, - -2.1611152108969522e-14, - -2.273805107184005e-14 + 3.007335775164219e-14, + 3.1338033749628167e-14, + 3.007335775164219e-14, + 3.1338033749628167e-14 ], "moduleForcesY": [ - -2.541885019413972e-15, - -2.541885019413971e-15, - -1.029621644370098e-15, - -1.0296216443700978e-15 + 1.4884372070057383e-15, + 1.488437207005738e-15, + -2.0871866593917718e-16, + -2.0871866593917757e-16 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.5777576978064607 }, { - "x": 10.268677628293055, - "y": 1.0113145576959566, - "heading": -2.4823569959460315e-16, - "angularVelocity": 2.685594745727998e-16, - "velocityX": -3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 10.576079743008195, + "y": 1.0664012082138195, + "heading": -2.1191759554461745e-16, + "angularVelocity": -6.012727471398986e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.1832676574649537e-13, - 2.314050106112521e-13, - 2.1832676574649537e-13, - 2.314050106112521e-13 + -2.3895223984057537e-15, + -2.9828824577607686e-14, + -2.3895223984057454e-15, + -2.9828824577607686e-14 ], "moduleForcesY": [ - 5.4206089243145896e-14, - 5.420608924314589e-14, - 3.665549121220295e-14, - 3.665549121220295e-14 + -1.750033498040077e-14, + -1.7500334980400767e-14, + 1.932235550878732e-14, + 1.9322355508787322e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.6763675539193645 }, { - "x": 9.879947373322251, - "y": 0.9416538537637811, - "heading": -2.9953417979362097e-16, - "angularVelocity": -5.157545162271987e-16, - "velocityX": -3.908290923671554, - "velocityY": -0.7003681690151493, + "x": 10.20995688545749, + "y": 1.0007917639873665, + "heading": -2.51438081505781e-16, + "angularVelocity": -4.0077622585012835e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.6653436767145577, "moduleForcesX": [ - 3.3733273434030475e-8, - 3.3733244259316946e-8, - 3.3733273434030475e-8, - 3.3733244259316946e-8 + 2.725363312900704e-14, + 3.4776175004574016e-14, + 2.725363312900703e-14, + 3.477617500457401e-14 ], "moduleForcesY": [ - 6.0449968765387015e-9, - 6.0449968765387015e-9, - 6.045036028097271e-9, - 6.045036028097271e-9 + 3.7096019824998565e-14, + 3.709601982499856e-14, + 2.7001002489393173e-14, + 2.7001002489393167e-14 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.7749774100322684 }, { - "x": 9.49122035162672, - "y": 0.8719937292365494, - "heading": -3.3337730352683075e-16, - "angularVelocity": -3.402584997030302e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 9.843834027912218, + "y": 0.9351823197618869, + "heading": -2.4245001806495676e-16, + "angularVelocity": 9.114771881288216e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - 0.004641026935428245, - 0.004641026935434773, - 0.004641026935428245, - 0.004641026935434773 + 7.931400721741463e-9, + 7.931419178512931e-9, + 7.931400721741463e-9, + 7.931419178512931e-9 ], "moduleForcesY": [ - 0.0008316749189632649, - 0.0008316749189632649, - 0.0008316749189545045, - 0.0008316749189545045 + 1.4212969989409796e-9, + 1.4212969989409796e-9, + 1.4212722305274573e-9, + 1.4212722305274573e-9 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.8735872661451722 }, { - "x": 9.17480342778827, - "y": 0.8152916193061152, - "heading": -2.1211685834383712e-16, - "angularVelocity": 1.2191515613294572e-15, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223712, + "x": 9.477711947161318, + "y": 0.8695730147384431, + "heading": -2.6800974586446296e-16, + "angularVelocity": -2.5920053846645386e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - 103.79354790180251, - 103.79354790180251, - 103.79354790180251, - 103.79354790180253 + 0.0011343830986540345, + 0.0011343830986408896, + 0.0011343830986540345, + 0.0011343830986408896 ], "moduleForcesY": [ - 18.59986846406036, - 18.599868464060346, - 18.599868464060243, - 18.599868464060233 + 0.00020328215816338424, + 0.00020328215816338424, + 0.0002032821581810242, + 0.0002032821581810242 ], - "timestamp": 1.9892595641555668 + "timestamp": 1.972197122258076 }, { - "x": 8.937420313687385, - "y": 0.7727524173314154, - "heading": -1.1312637475443375e-16, - "angularVelocity": 9.95249542760621e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563973, + "x": 9.166697184183416, + "y": 0.8138389754006334, + "heading": -1.6375905468462317e-16, + "angularVelocity": 1.0572035624806777e-15, + "velocityX": -3.1539926660252453, + "velocityY": -0.5651974511959199, "moduleForcesX": [ - 113.44472985048417, - 113.44472985048417, - 113.44472985048415, - 113.44472985048415 + 80.47536393454655, + 80.47536393454658, + 80.47536393454656, + 80.47536393454658 ], "moduleForcesY": [ - 20.329366283501077, - 20.32936628350108, - 20.329366283501102, - 20.329366283501106 + 14.42123536615281, + 14.421235366152803, + 14.421235366152724, + 14.421235366152716 ], - "timestamp": 2.088722542363345 + "timestamp": 2.07080697837098 }, { - "x": 8.779144252026935, - "y": 0.7443892484504455, - "heading": -3.93728468407683e-17, - "angularVelocity": 7.415173890439025e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.28516307667481233, + "x": 8.933366742647888, + "y": 0.7720260148751115, + "heading": -8.625567458400124e-17, + "angularVelocity": 7.859597727261062e-16, + "velocityX": -2.3661979718170962, + "velocityY": -0.4240241510711469, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - 20.348206040044545, - 20.34820604004455, - 20.34820604004457, - 20.348206040044573 + 20.329493959318043, + 20.329493959318043, + 20.32949395931806, + 20.32949395931806 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.169416834483884 + }, + { + "x": 8.777792950699272, + "y": 0.7441470944104505, + "heading": -2.504882545970686e-17, + "angularVelocity": 6.206970736540284e-16, + "velocityX": -1.5776697997661688, + "velocityY": -0.2827194112598734, + "moduleForcesX": [ + 113.55106593310009, + 113.5510659331001, + 113.55106593310009, + 113.55106593310009 + ], + "moduleForcesY": [ + 20.34842177577033, + 20.348421775770326, + 20.348421775770344, + 20.348421775770348 + ], + "timestamp": 2.2680266905967876 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.2763995877770643e-23, - "angularVelocity": 3.95854163827864e-16, - "velocityX": -0.7957156869122084, - "velocityY": -0.1425927469533916, + "heading": 1.3902950846098237e-21, + "angularVelocity": 2.5403358995413573e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.1413707086932168, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060846, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - 20.354574176009788, - 20.354574176009795, - 20.354574176009816, - 20.354574176009823 + 20.35475258031486, + 20.35475258031486, + 20.354752580314877, + 20.354752580314877 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.3666365467096915 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.315227470936058e-23, - "angularVelocity": -3.969132704994349e-24, - "velocityX": 1.0890521860195893e-24, - "velocityY": 5.6866921822786504e-24, + "heading": 1.4027105999712067e-21, + "angularVelocity": 1.258894947744667e-22, + "velocityX": 1.6132701940704752e-22, + "velocityY": 3.624341577856218e-22, + "moduleForcesX": [ + 113.60407786230425, + 113.60407786230425, + 113.60407786230425, + 113.60407786230425 + ], + "moduleForcesY": [ + 20.357921546518654, + 20.357921546518654, + 20.357921546518668, + 20.35792154651867 + ], + "timestamp": 2.4652464028225953 + }, + { + "x": 8.746921743709395, + "y": 0.7475758768470208, + "heading": 0.030374708631720888, + "angularVelocity": 0.3844322390186118, + "velocityX": 0.5938569225985214, + "velocityY": 0.21983188747567822, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277731, - 113.60325815277731 + 97.08636346934237, + 103.3854037020227, + 112.73947029508177, + 113.70612876978298 ], "moduleForcesY": [ - 20.357774654060616, - 20.357774654060616, - 20.35777465406064, - 20.35777465406065 + 62.38345613408076, + 51.30130417295828, + 24.59721210153914, + 19.752811466970538 ], - "timestamp": 2.38711147698668 + "timestamp": 2.5442582690210758 }, { - "x": 8.749697525208294, - "y": 0.7486471398847376, - "heading": 0.02845270874371011, - "angularVelocity": 0.35037941350634527, - "velocityX": 0.611997609508755, - "velocityY": 0.22708570274870504, + "x": 8.840842415957127, + "y": 0.7824201103535564, + "heading": 0.0887396108421577, + "angularVelocity": 0.7386852762573924, + "velocityX": 1.1886907216164013, + "velocityY": 0.44100000649276727, "moduleForcesX": [ - 98.5991688650241, - 103.9054385308619, - 112.25808633757455, - 113.31145977613869 + 98.44357768722071, + 103.3663432807897, + 112.56382635716881, + 113.2458848815574 ], "moduleForcesY": [ - 59.96747683817386, - 50.24070001601607, - 26.723188479519543, - 21.9083400310118 + 60.18928815483851, + 51.30995429297123, + 25.32325446348916, + 22.17288947410142 ], - "timestamp": 2.4683169007271215 + "timestamp": 2.623270135219556 }, { - "x": 8.849156577034107, - "y": 0.7856168809153166, - "heading": 0.08307898135737164, - "angularVelocity": 0.6726924150813449, - "velocityX": 1.224783361068523, - "velocityY": 0.45526196807673974, + "x": 8.981875095948194, + "y": 0.8348658019205454, + "heading": 0.17117745322357367, + "angularVelocity": 1.0433602741938677, + "velocityX": 1.784955688007542, + "velocityY": 0.6637698119323436, "moduleForcesX": [ - 99.75724138640882, - 103.91806545859839, - 112.08705733206624, - 112.86307129194968 + 100.41233501810491, + 103.5548940276436, + 112.18043737384708, + 112.5008166473148 ], "moduleForcesY": [ - 57.99159008453139, - 50.18528756830434, - 27.37363860720728, - 24.052005242751928 + 56.79519440863829, + 50.8794713381393, + 26.877817481486677, + 25.594338331171862 ], - "timestamp": 2.549522324467563 + "timestamp": 2.7022820014180366 }, { - "x": 8.998468662854163, - "y": 0.8412229963489036, - "heading": 0.16020071685878773, - "angularVelocity": 0.949711631921556, - "velocityX": 1.838695975496751, - "velocityY": 0.6847586389219772, + "x": 9.170193806235403, + "y": 0.905047849903824, + "heading": 0.27014704823869273, + "angularVelocity": 1.2525915381685058, + "velocityX": 2.383423140698203, + "velocityY": 0.8882469350487014, "moduleForcesX": [ - 101.42006410641166, - 104.11265608433904, - 111.7271355600726, - 112.15378683051922 + 103.40298640344946, + 104.5638907933371, + 111.12271990152317, + 111.14222972427875 ], "moduleForcesY": [ - 54.984671240448485, - 49.73281322981778, - 28.724585734295502, - 27.08403574576014 + 51.0556107106465, + 48.6758061597135, + 30.821794358941716, + 30.820982678865775 ], - "timestamp": 2.6307277482080047 + "timestamp": 2.781293867616517 }, { - "x": 9.197770113060493, - "y": 0.9155841520343786, - "heading": 0.25288489149857346, - "angularVelocity": 1.141354485582565, - "velocityX": 2.454287423502156, - "velocityY": 0.9157166142394266, + "x": 9.40593573622577, + "y": 0.9930498413232173, + "heading": 0.36785454850899846, + "angularVelocity": 1.2366180546205672, + "velocityX": 2.983626907358139, + "velocityY": 1.113781962804538, "moduleForcesX": [ - 103.92861554586716, - 104.98869457390772, - 110.77607463143484, - 110.8945520614623 + 108.1423184266996, + 108.14622857930792, + 107.59649154427585, + 107.59500574441716 ], "moduleForcesY": [ - 49.99408871314561, - 47.7642847739149, - 32.07204722537332, - 31.71782432020252 + 39.81251263328706, + 39.79515762619855, + 41.26483057998931, + 41.26220935675603 ], - "timestamp": 2.7119331719484463 + "timestamp": 2.8603057338149975 }, { - "x": 9.44716479258539, - "y": 1.0087906432972022, - "heading": 0.34521028833138984, - "angularVelocity": 1.1369363347935713, - "velocityX": 3.0711579108563343, - "velocityY": 1.1477865266825218, + "x": 9.683387271031574, + "y": 1.0968882632669579, + "heading": 0.3737950413323585, + "angularVelocity": 0.0751848185491193, + "velocityX": 3.511517296767004, + "velocityY": 1.3142130029291395, "moduleForcesX": [ - 107.9455056410082, - 107.94355502791348, - 107.7979462288896, - 107.79557995601229 + 114.92109699391807, + 111.16467067641456, + 88.39242273361798, + 65.01654331360074 ], "moduleForcesY": [ - 40.383323246666976, - 40.386866616605445, - 40.77561046788362, - 40.780211699947586 + 4.148148544540557, + -28.016980604792366, + 73.55404230537428, + 94.40251274978336 ], - "timestamp": 2.793138595688888 + "timestamp": 2.939317600013478 }, { - "x": 9.743254546944904, - "y": 1.1197154475688877, - "heading": 0.366082064748327, - "angularVelocity": 0.25702441358658573, - "velocityX": 3.6461820001815624, - "velocityY": 1.3659777778666213, + "x": 9.962406006796718, + "y": 1.201509394881753, + "heading": 0.37391809195022235, + "angularVelocity": 0.001557368833116526, + "velocityX": 3.5313523042759076, + "velocityY": 1.3241192323186375, "moduleForcesX": [ - 114.50263359045593, - 114.48153022441875, - 92.89940889941946, - 80.3287014204201 + 6.012702465623703, + 2.809169459616938, + 4.321760134676471, + 1.1155418972110314 ], "moduleForcesY": [ - 11.01893061920688, - -8.214078066637066, - 67.83670510440811, - 81.97674297463185 + 0.25591605391839173, + -1.0053994170959915, + 4.561565207999552, + 3.3094001138140294 ], - "timestamp": 2.8743440194293295 + "timestamp": 3.0183294662119584 }, { - "x": 10.04517026477605, - "y": 1.2327664453559726, - "heading": 0.36619792232508147, - "angularVelocity": 0.001426722150047545, - "velocityX": 3.7179255267008346, - "velocityY": 1.3921606781885905, + "x": 10.241422645398577, + "y": 1.3061362496498794, + "heading": 0.374041018087458, + "angularVelocity": 0.0015557933656043376, + "velocityX": 3.5313257618920133, + "velocityY": 1.3241916664175475, "moduleForcesX": [ - 20.675376664017367, - 10.058722820162606, - 15.100494848677528, - 4.347871917595204 + -0.0047178363595807, + -0.004786508231731981, + -0.004754009184713588, + -0.004822681056852332 ], "moduleForcesY": [ - -0.6516753204632776, - -4.9242298237286946, - 13.911513369659277, - 9.978553002629607 + 0.012985423783144328, + 0.012958468742882152, + 0.013077579297975673, + 0.013050624257716973 ], - "timestamp": 2.955549443169771 + "timestamp": 3.097341332410439 }, { - "x": 10.347086763223185, - "y": 1.3458158061592695, - "heading": 0.366313361291408, - "angularVelocity": 0.0014215671935355297, - "velocityX": 3.717935139556162, - "velocityY": 1.3921405196362118, + "x": 10.520439212462904, + "y": 1.4107632952116884, + "heading": 0.3741639439073583, + "angularVelocity": 0.001555789349304766, + "velocityX": 3.531324856489611, + "velocityY": 1.3241940811647468, "moduleForcesX": [ - 0.0018470631612436685, - 0.0016277805976543929, - 0.0017341728177355192, - 0.001514890254104659 + -0.0001625873675282764, + -0.0001627624225494424, + -0.0001626796108707561, + -0.00016285466589192513 ], "moduleForcesY": [ - -0.0036301509175129874, - -0.0037142738378569294, - -0.003335880534841119, - -0.0034200034551973633 + 0.0004339008689113104, + 0.0004338321315943089, + 0.00043413578730753475, + 0.0004340670499905359 ], - "timestamp": 3.0367548669102127 + "timestamp": 3.1763531986089193 }, { - "x": 10.64900328277143, - "y": 1.4588651106250559, - "heading": 0.36642880011188633, - "angularVelocity": 0.0014215653974949576, - "velocityX": 3.717935399404689, - "velocityY": 1.3921398258708442, + "x": 10.799455776813222, + "y": 1.5153903480276578, + "heading": 0.37428686940727074, + "angularVelocity": 0.0015557852994340933, + "velocityX": 3.53132482214022, + "velocityY": 1.3241941729757738, "moduleForcesX": [ - 0.00004549695252604368, - 0.000045420555579632215, - 0.00004545760851848642, - 0.000045381211572074955 + -0.000006038575439683577, + -0.000006215085169064049, + -0.000006131618953715752, + -0.000006308128683095867 ], "moduleForcesY": [ - -0.00012135367009232236, - -0.00012138298821378404, - -0.00012125114776527303, - -0.0001212804658867347 + 0.000016416721911056802, + 0.000016347388327240465, + 0.000016653592480530648, + 0.00001658425889671332 ], - "timestamp": 3.1179602906506543 + "timestamp": 3.2553650648073997 }, { - "x": 10.950919802007403, - "y": 1.5719144159306049, - "heading": 0.36654423879403597, - "angularVelocity": 0.0014215636940539118, - "velocityX": 3.7179353955592287, - "velocityY": 1.392139836212059, + "x": 11.07847234022828, + "y": 1.6200174033544013, + "heading": 0.3744097945845876, + "angularVelocity": 0.0015557812165593802, + "velocityX": 3.5313248103033033, + "velocityY": 1.3241942047529474, "moduleForcesX": [ - -6.175555322723859e-7, - -6.900104256789466e-7, - -6.548822821618376e-7, - -7.273371755683984e-7 + -0.0000019914727432141183, + -0.0000021694123278502697, + -0.0000020853038623682895, + -0.00000226324344700444 ], "moduleForcesY": [ - 0.0000017736345295412757, - 0.000001745819615530989, - 0.0000018708667440091473, - 0.0000018430518299988607 + 0.000005626632786408257, + 0.000005556712299934303, + 0.0000058654221771894254, + 0.000005795501690715472 ], - "timestamp": 3.199165714391096 + "timestamp": 3.33437693100588 }, { - "x": 11.252836297906729, - "y": 1.6849637835662303, - "heading": 0.36665967733637467, - "angularVelocity": 0.0014215619723584874, - "velocityX": 3.7179351081812904, - "velocityY": 1.392140603772568, + "x": 11.357488887388348, + "y": 1.7246445020461594, + "heading": 0.3745327194374754, + "angularVelocity": 0.00155577711047777, + "velocityX": 3.531324604574814, + "velocityY": 1.3241947535947427, "moduleForcesX": [ - -0.00005019760036002295, - -0.00005027082844721402, - -0.00005023533845441479, - -0.000050308566541605865 + -0.00003683733250123687, + -0.00003701627484165169, + -0.00003693172647393205, + -0.00003711066881434762 ], "moduleForcesY": [ - 0.00013418637131016692, - 0.00013415824987303315, - 0.0001342846411266562, - 0.0001342565196895224 + 0.00009855422104990495, + 0.00009848388113975036, + 0.0000987943561077727, + 0.00009872401619761882 ], - "timestamp": 3.2803711381315375 + "timestamp": 3.4133887972043606 }, { - "x": 11.554752108451195, - "y": 1.7980149815274173, - "heading": 0.36677511575973815, - "angularVelocity": 0.0014215605072443334, - "velocityX": 3.7179266684142243, - "velocityY": 1.3921631432222437, + "x": 11.63650495567805, + "y": 1.8292728777764502, + "heading": 0.3746556439873936, + "angularVelocity": 0.0015557732759965874, + "velocityX": 3.5313185438349786, + "velocityY": 1.32421091621176, "moduleForcesX": [ - -0.0014757943893018654, - -0.001475856701571945, - -0.001475826513007055, - -0.0014758888252771351 + -0.0010891225625817823, + -0.0010892896605572684, + -0.0010892107403075175, + -0.0010893778382830058 ], "moduleForcesY": [ - 0.003941389083174159, - 0.003941365145432393, - 0.0039414727043032135, - 0.003941448766561447 + 0.002904703698206433, + 0.002904637990480236, + 0.0029049279384945298, + 0.002904862230768327 ], - "timestamp": 3.361576561871979 + "timestamp": 3.492400663402841 }, { - "x": 11.856647446672115, - "y": 1.911120366719257, - "heading": 0.3668909923479222, - "angularVelocity": 0.0014269562653164898, - "velocityX": 3.717674563042425, - "velocityY": 1.3928304290777476, + "x": 11.9155066014505, + "y": 1.933939583482744, + "heading": 0.3747786859738994, + "angularVelocity": 0.0015572595918276028, + "velocityX": 3.5311360077432856, + "velocityY": 1.3246960329144353, "moduleForcesX": [ - -0.04425896362884921, - -0.04402948835633619, - -0.0441406220757317, - -0.04391114680180525 + -0.032855287769666466, + -0.03279052058954477, + -0.03282109775071749, + -0.03275633057051873 ], "moduleForcesY": [ - 0.11679654129672462, - 0.11688472651506654, - 0.11648859333556225, - 0.11657677855445653 + 0.08721701632802349, + 0.08724249386316295, + 0.08713010090018317, + 0.08715557843535474 ], - "timestamp": 3.4427819856124207 + "timestamp": 3.5714125296013215 }, { - "x": 12.15185011782445, - "y": 2.023490901110545, - "heading": 0.38847604869790386, - "angularVelocity": 0.2658080625128484, - "velocityX": 3.635258059805189, - "velocityY": 1.3837811468167476, + "x": 12.192538240584097, + "y": 2.039177693852194, + "heading": 0.3803730340943993, + "angularVelocity": 0.07080389806825643, + "velocityX": 3.506202959915975, + "velocityY": 1.3319279170686587, "moduleForcesX": [ - -22.83840056240393, - -12.043870771869477, - -16.90529380786833, - -5.860331369774487 + -6.787368546566498, + -3.784269941628227, + -5.182022231798085, + -2.1704396914350084 ], "moduleForcesY": [ - 3.6231590205459683, - 8.365079303423084, - -11.362059153742951, - -6.955883377496448 + 2.7165308525253336, + 3.927000047116944, + -1.3250575905079343, + -0.11954942939397993 ], - "timestamp": 3.5239874093528623 + "timestamp": 3.650424395799802 }, { - "x": 12.400755383704196, - "y": 2.117659437341253, - "heading": 0.48329601767345703, - "angularVelocity": 1.1676556147115023, - "velocityX": 3.0651310517795785, - "velocityY": 1.1596335797926638, + "x": 12.427978262373196, + "y": 2.1280236238213828, + "heading": 0.47663420593072064, + "angularVelocity": 1.2183128492941782, + "velocityX": 2.979805858498074, + "velocityY": 1.124463124893227, "moduleForcesX": [ - -114.17872059898711, - -114.30356134591156, - -90.19939840298346, - -80.1052308451629 + -114.73981520594829, + -111.18079581607797, + -86.14799527800552, + -66.35261871218253 ], "moduleForcesY": [ - -14.08163508293927, - 10.797887995941533, - -71.37399843226963, - -82.12682115917191 + -7.795647023550036, + 28.177549378571307, + -76.14784747221293, + -93.3782667153953 ], - "timestamp": 3.605192833093304 + "timestamp": 3.7294362619982824 }, { - "x": 12.599581408201276, - "y": 2.192945515401507, - "heading": 0.5780713991757789, - "angularVelocity": 1.167106544573357, - "velocityX": 2.448432818140226, - "velocityY": 0.9271065230925032, + "x": 12.615965734027, + "y": 2.199126658591582, + "heading": 0.5737884271556586, + "angularVelocity": 1.2296155742086012, + "velocityX": 2.3792308763037235, + "velocityY": 0.89990324480611, "moduleForcesX": [ - -107.83281776344127, - -107.82986538656014, - -107.85118599185448, - -107.84823135382317 + -108.0986373688516, + -108.16057441934431, + -107.71338177916209, + -107.77431358980553 ], "moduleForcesY": [ - -40.68175318481147, - -40.689783654449414, - -40.63309333309364, - -40.64114069086623 + -39.92967545115843, + -39.756848729907475, + -40.95621385148542, + -40.790948973447925 ], - "timestamp": 3.6863982568337454 + "timestamp": 3.808448128196763 }, { - "x": 12.74846595255012, - "y": 2.2493986724180166, - "heading": 0.6567776497722155, - "angularVelocity": 0.9692240612893908, - "velocityX": 1.8334310381129904, - "velocityY": 0.6951894887828137, + "x": 12.756677891744804, + "y": 2.2524751443391073, + "heading": 0.6545619050636577, + "angularVelocity": 1.0222955334973773, + "velocityX": 1.7808990533691502, + "velocityY": 0.675195870117938, "moduleForcesX": [ - -104.92855177072474, - -103.58820516720519, - -111.54097597186703, - -110.1177486633702 + -104.71639898474407, + -103.30559580568976, + -111.8097050026696, + -110.30262425390252 ], "moduleForcesY": [ - -47.84626346354842, - -50.7219346420931, - -29.320464413930953, - -34.33041579719788 + -48.29042179755709, + -51.28282431794385, + -28.25140262149225, + -33.715070554259015 ], - "timestamp": 3.767603680574187 + "timestamp": 3.8874599943952433 }, { - "x": 12.847594216215393, - "y": 2.287032791210217, - "heading": 0.7126183270589642, - "angularVelocity": 0.687647138758041, - "velocityX": 1.2207098873360585, - "velocityY": 0.463443413736636, + "x": 12.850336914665005, + "y": 2.288054717515041, + "heading": 0.7118620959658994, + "angularVelocity": 0.7252099419889868, + "velocityX": 1.1853792022191647, + "velocityY": 0.45030670566059755, "moduleForcesX": [ - -103.65261141149999, - -101.33099886518954, - -112.89020105896142, - -110.70643780421157 + -103.22725405324366, + -100.76683441661494, + -113.21054868518623, + -110.90819056427041 ], "moduleForcesY": [ - -50.63164845334595, - -55.16991177134879, - -23.783026122978413, - -32.51491104120575 + -51.48157539975729, + -56.18800584688865, + -22.188774881580073, + -31.81204987645629 ], - "timestamp": 3.8488091043146286 + "timestamp": 3.9664718605937237 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 0.35994321486729053, - "velocityX": 0.6097006638724112, - "velocityY": 0.23169454365301478, + "angularVelocity": 0.3795072034311285, + "velocityX": 0.591914918165481, + "velocityY": 0.2251931025926012, "moduleForcesX": [ - -102.93131489378747, - -99.9529403855715, - -113.5371251884651, - -110.9614263550785 + -102.38974249930051, + -99.2333325232405, + -113.85285218516329, + -111.1591753938583 ], "moduleForcesY": [ - -52.12981175149366, - -57.669598676950365, - -20.595444632987483, - -31.70659737313563 + -53.177087365808944, + -58.89587684714717, + -18.75697096029462, + -31.00181733914533 ], - "timestamp": 3.9300145280550702 + "timestamp": 4.045483726792204 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 5.2713736123368476e-24, - "velocityX": -1.2575111514507032e-24, - "velocityY": -4.677232863444744e-24, + "angularVelocity": 4.222228434888889e-22, + "velocityX": 4.2990324061792614e-21, + "velocityY": -4.011907557779764e-21, "moduleForcesX": [ - -102.27730985577767, - -99.09462528312666, - -113.90720400078715, - -111.1883691091121 + -101.63548974867733, + -98.28908180907341, + -114.21009011513806, + -111.386618425042 ], "moduleForcesY": [ - -53.43303751633116, - -59.15782976040063, - -18.525172105483644, - -30.94741332746109 + -54.637387770778965, + -60.48460075810778, + -16.54354448292929, + -30.223370855342132 ], - "timestamp": 4.011219951795511 + "timestamp": 4.124495592990685 }, { - "x": 12.878326844262283, - "y": 2.2989594406099587, - "heading": 0.7005045669662167, - "angularVelocity": -0.7787767050645679, - "velocityX": -0.3537267099935758, - "velocityY": -0.12975255335628538, + "x": 12.877999676968232, + "y": 2.29858470070828, + "heading": 0.6929652035770414, + "angularVelocity": -0.895192392543208, + "velocityX": -0.34988280879900624, + "velocityY": -0.13300745644801076, "moduleForcesX": [ - -72.94619674814248, - -82.30668691722371, - -108.15778531261913, - -115.0598645177216 + -63.35936817512306, + -80.10356434853757, + -105.25411125517046, + -115.2316867824649 ], "moduleForcesY": [ - -89.24912908119802, - -80.86584959263499, - 40.14347495933019, - -8.857475561829991 + -96.27483320533037, + -83.05086248624922, + 47.239128737124624, + -6.268029819257333 ], - "timestamp": 4.064307186056216 + "timestamp": 4.179101133849723 }, { - "x": 12.840219976733476, - "y": 2.285572424541842, - "heading": 0.6202251467662581, - "angularVelocity": -1.5122170389535827, - "velocityX": -0.7178160260085901, - "velocityY": -0.252170154549299, + "x": 12.83896543758541, + "y": 2.2846494014998036, + "heading": 0.5985027683944565, + "angularVelocity": -1.7299056780050237, + "velocityX": -0.7148402665507607, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - -77.9377516249161, - -86.98787858056687, - -109.4406212161063, - -115.19177113993022 + -71.53272845126982, + -85.95725612054817, + -106.80144207930026, + -115.33798101701309 ], "moduleForcesY": [ - -84.91967760133534, - -75.788435232065, - 36.43023788237509, - -6.703058984175765 + -90.36459624820593, + -76.95483823713556, + 43.55724850599798, + -3.342055562830003 ], - "timestamp": 4.117394420316921 + "timestamp": 4.233706674708761 }, { - "x": 12.782177244041925, - "y": 2.266103908321777, - "heading": 0.5042008090194892, - "angularVelocity": -2.1855412014305973, - "velocityX": -1.0933463289217318, - "velocityY": -0.3667268881339164, + "x": 12.7790871054742, + "y": 2.2646755465629314, + "heading": 0.4630663339899602, + "angularVelocity": -2.480269076614779, + "velocityX": -1.096561469206608, + "velocityY": -0.3657843988476259, "moduleForcesX": [ - -83.00336971918546, - -92.33620304947924, - -111.16605663240462, - -115.29369779681878 + -79.8109340460071, + -92.6408907817173, + -109.25337437613236, + -115.36188623484176 ], "moduleForcesY": [ - -79.96612718536689, - -69.14410094650641, - 30.64026316812107, - -4.1002194480586285 + -83.13387654195827, + -68.72829018973381, + 36.84729749065963, + -0.015885734863739443 ], - "timestamp": 4.1704816545776255 + "timestamp": 4.288312215567799 }, { - "x": 12.703462361937405, - "y": 2.2408921611397123, - "heading": 0.3580649303430616, - "angularVelocity": -2.752749897626456, - "velocityX": -1.4827459595646482, - "velocityY": -0.47491167195211426, + "x": 12.697235826568717, + "y": 2.239145023664725, + "heading": 0.29538035410743513, + "angularVelocity": -3.0708601589607962, + "velocityX": -1.4989555568505593, + "velocityY": -0.46754454761490505, "moduleForcesX": [ - -89.65379875606007, - -98.13983385768606, - -113.54027185482593, - -115.30493503306579 + -90.33198646116189, + -99.85169207378266, + -113.07409659910392, + -115.31328266124063 ], "moduleForcesY": [ - -72.40887140224788, - -60.57623674894681, - 19.8541582997784, - -2.6215553765171156 + -71.52890617387138, + -57.683472950501425, + 22.212990208565554, + 1.1482981099846643 ], - "timestamp": 4.22356888883833 + "timestamp": 4.342917756426837 }, { - "x": 12.603247350879384, - "y": 2.210057158622966, - "heading": 0.19174239462916676, - "angularVelocity": -3.133004347092273, - "velocityX": -1.887742174811279, - "velocityY": -0.5808364844421805, + "x": 12.592206955696092, + "y": 2.2082229653738406, + "heading": 0.11160745845427096, + "angularVelocity": -3.3654624194194347, + "velocityX": -1.9234105041419007, + "velocityY": -0.5662805972512617, "moduleForcesX": [ - -98.79018954476506, - -104.20314131415653, - -115.19744688183164, - -115.13565568271744 + -103.97533493870596, + -107.44888382024821, + -115.0584177361961, + -115.03616740781044 ], "moduleForcesY": [ - -59.282961502664314, - -49.313671267245034, - 1.005530916636403, - -5.743342962263224 + -49.54196790951789, + -41.65055661100523, + -4.805861192354253, + -6.707031707137319 ], - "timestamp": 4.276656123099035 + "timestamp": 4.397523297285875 }, { - "x": 12.48089900238875, - "y": 2.1736228332964016, - "heading": 0.021527886856620944, - "angularVelocity": -3.206317114518393, - "velocityX": -2.3046660877037954, - "velocityY": -0.6863104818691433, + "x": 12.463838013593607, + "y": 2.1725870949498365, + "heading": -0.057259944646070635, + "angularVelocity": -3.0924957512327658, + "velocityX": -2.350840960148443, + "velocityY": -0.652605392482001, "moduleForcesX": [ - -109.90169912281644, - -110.54551793687568, - -112.66305677296602, - -112.97822127254382 + -115.06107533407756, + -114.85560912614942, + -109.41725119475672, + -105.2799977954633 ], "moduleForcesY": [ - -34.382418266787134, - -32.32487235746525, - -23.78897776007878, - -22.35582603859897 + -2.484190771745183, + -5.214634192772953, + -35.76089164102002, + -46.335491532966486 ], - "timestamp": 4.32974335735974 + "timestamp": 4.452128838144913 }, { - "x": 12.337568769520207, - "y": 2.1329281275620455, - "heading": -0.119658826861653, - "angularVelocity": -2.659522871824945, - "velocityX": -2.699900171191159, - "velocityY": -0.7665629280009049, + "x": 12.3153052167684, + "y": 2.134500210018156, + "heading": -0.1767990324670285, + "angularVelocity": -2.18913842698754, + "velocityX": -2.7201048554511935, + "velocityY": -0.6974912130254506, "moduleForcesX": [ - -114.04991592545967, - -113.57345993390194, - -105.8743122544602, - -89.38373476732247 + -109.45603084784327, + -99.09147098340229, + -104.32045073180943, + -71.24101923486771 ], "moduleForcesY": [ - 15.248423187591095, - 16.388126000916763, - -45.19852750676207, - -72.30427165301562 + 35.13049278248973, + 56.727219331269474, + -48.502488172187334, + -90.04553565784445 ], - "timestamp": 4.382830591620444 + "timestamp": 4.506734379003951 }, { - "x": 12.17519289047435, - "y": 2.089437332859002, - "heading": -0.2154342943934576, - "angularVelocity": -1.8041148472994986, - "velocityX": -3.058661490038241, - "velocityY": -0.819232633018052, + "x": 12.14665280523782, + "y": 2.093252415972482, + "heading": -0.24943106792656752, + "angularVelocity": -1.3301220776667324, + "velocityX": -3.0885585762431846, + "velocityY": -0.7553774469912005, "moduleForcesX": [ - -109.62064454997089, - -101.90531447708317, - -103.74089498833104, - -68.59046833424644 + -109.18925395485236, + -102.87029241138681, + -103.62950593233244, + -67.5771745078602 ], "moduleForcesY": [ - 34.45553967608259, - 50.94411816852015, - -49.68325972504408, - -92.07044431884985 + 34.902052219211484, + 46.81112964031985, + -49.45128884065186, + -92.47525829145374 ], - "timestamp": 4.435917825881149 + "timestamp": 4.561339919862989 }, { - "x": 11.993827203156602, - "y": 2.042600207999434, - "heading": -0.2677420696484354, - "angularVelocity": -0.9853173928425161, - "velocityX": -3.416370994711849, - "velocityY": -0.8822671874288431, + "x": 11.95823070560661, + "y": 2.047917121127896, + "heading": -0.2768116340377964, + "angularVelocity": -0.5014246847570069, + "velocityX": -3.450604035176877, + "velocityY": -0.8302325026249097, "moduleForcesX": [ - -109.2866023215497, - -104.44398071027051, - -103.15267730358437, - -65.84867153585363 + -108.8300334396521, + -103.51069866239682, + -101.6714557058711, + -62.588153422601906 ], "moduleForcesY": [ - 34.370980784960594, - 42.21513175186766, - -50.35760769522869, - -93.6724404068542 + 32.94109351617987, + 36.02257862078941, + -51.9503458632938, + -94.87769053752216 ], - "timestamp": 4.489005060141854 + "timestamp": 4.615945460722027 }, { - "x": 11.793836587977145, - "y": 1.9916718961789552, - "heading": -0.27766508814737484, - "angularVelocity": -0.18691910846605192, - "velocityX": -3.7672072761848483, - "velocityY": -0.9593325500887041, + "x": 11.76006896944174, + "y": 1.9924964021643288, + "heading": -0.2773174658125964, + "angularVelocity": -0.009263378163504579, + "velocityX": -3.628967556175626, + "velocityY": -1.0149284869576567, "moduleForcesX": [ - -108.88611511085563, - -103.69547133936662, - -101.19104160044988, - -61.605286218644906 + -68.62335338934369, + -24.81706564096114, + -62.366993278311014, + -29.7266448483014 ], "moduleForcesY": [ - 32.177770647209805, - 33.35515323370195, - -52.640976055772406, - -95.34817206799451 + -16.13797050297586, + -40.26298442970836, + -59.120123116749426, + -76.60001892131655 ], - "timestamp": 4.542092294402559 + "timestamp": 4.670551001581065 }, { - "x": 11.591451943279344, - "y": 1.933426458170254, - "heading": -0.2781082451680907, - "angularVelocity": -0.008347713473630615, - "velocityX": -3.8123034193854206, - "velocityY": -1.0971646728225646, + "x": 11.562226376151372, + "y": 1.9359085884076388, + "heading": -0.2777983149631616, + "angularVelocity": -0.008805867371710638, + "velocityX": -3.623123041690747, + "velocityY": -1.0363016804973944, "moduleForcesX": [ - -17.252714549210435, - -2.8125866154956327, - -20.620616684560133, - -7.564782178530354 + 1.5106753807232935, + 1.5405489498137173, + 1.4991886990742167, + 1.5290615087927133 ], "moduleForcesY": [ - -27.379147574375533, - -31.607890163153368, - -42.31980344027155, - -46.16688797563918 + -5.533911414001025, + -5.542359638354378, + -5.573858055453885, + -5.582305470869689 ], - "timestamp": 4.595179528663263 + "timestamp": 4.725156542440103 }, { - "x": 11.389273898801664, - "y": 1.8744592854650965, - "heading": -0.2785452808398492, - "angularVelocity": -0.008232406111274897, - "velocityX": -3.808411707507817, - "velocityY": -1.110759931767715, + "x": 11.364411791386928, + "y": 1.8792226813116377, + "heading": -0.2782788094947775, + "angularVelocity": -0.008799373178196058, + "velocityX": -3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - 1.038606533558001, - 1.0463397310111893, - 1.035632368601159, - 1.0433655330901692 + 0.1332558384274762, + 0.13367893133843997, + 0.13309362384339607, + 0.13351671673403107 ], "moduleForcesY": [ - -3.630285143013034, - -3.6324886421775022, - -3.6406473318268184, - -3.642850794642551 + -0.46681005875092235, + -0.4669309252933711, + -0.46737782224581564, + -0.46749868876945894 ], - "timestamp": 4.648266762923968 + "timestamp": 4.779762083299141 }, { - "x": 11.187060728663313, - "y": 1.8156128822911932, - "heading": -0.27898248808757475, - "angularVelocity": -0.008235638074089533, - "velocityX": -3.8090733667778998, - "velocityY": -1.1084850057344429, + "x": 11.166579234513257, + "y": 1.8225996642524476, + "heading": -0.27875936764242787, + "angularVelocity": -0.008800538188806259, + "velocityX": -3.6229392431872234, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - -0.17691923574930024, - -0.177135776816015, - -0.1768359899000005, - -0.17705253096240006 + -0.08556602339210856, + -0.0856419121099448, + -0.08553687515721092, + -0.08561276387472146 ], "moduleForcesY": [ - 0.6083390056735662, - 0.6084010281484636, - 0.6086295849668705, - 0.6086916074369444 + 0.2994423048828335, + 0.29946402445964476, + 0.2995441440606429, + 0.299565863636418 ], - "timestamp": 4.701353997184673 + "timestamp": 4.834367624158179 }, { - "x": 10.984313418298765, - "y": 1.7586381037974586, - "heading": -0.2794239203831664, - "angularVelocity": -0.008315224963949383, - "velocityX": -3.8191349236406036, - "velocityY": -1.0732293608278434, + "x": 10.968518470285098, + "y": 1.766782291857663, + "heading": -0.27924201654885805, + "angularVelocity": -0.008838826588608089, + "velocityX": -3.6271184409553947, + "velocityY": -1.0221924646598646, "moduleForcesX": [ - -2.689710937985897, - -2.695074176438558, - -2.687616330679038, - -2.6929795285133227 + -1.0860355533928898, + -1.0885317610039205, + -1.0850727795644968, + -1.0875689835908182 ], "moduleForcesY": [ - 9.42614694187036, - 9.427648428799488, - 9.43327212811977, - 9.43477357105278 + 3.8347296996097495, + 3.835442563757532, + 3.8380739343659003, + 3.8387867944503786 ], - "timestamp": 4.7544412314453774 + "timestamp": 4.888973165017217 }, { - "x": 10.778488668647217, - "y": 1.7140924382303233, - "heading": -0.27990255467751685, - "angularVelocity": -0.009015996049068832, - "velocityX": -3.8771044021764074, - "velocityY": -0.8391031513975062, + "x": 10.768382316330444, + "y": 1.7189715185814527, + "heading": -0.2797518256877861, + "angularVelocity": -0.00933621626867676, + "velocityX": -3.665125384826737, + "velocityY": -0.8755663349188755, "moduleForcesX": [ - -15.492703910893802, - -15.55336531368553, - -15.458920515444744, - -15.519558726536355 + -9.874094547382661, + -9.909831175721294, + -9.85761782165409, + -9.893348215058941 ], "moduleForcesY": [ - 62.59915932231857, - 62.60222625959514, - 62.649654814616326, - 62.65272108090153 + 38.10667280305693, + 38.11330911683297, + 38.14707559852625, + 38.15370784735128 ], - "timestamp": 4.807528465706082 + "timestamp": 4.943578705876255 }, { - "x": 10.569281338812399, - "y": 1.6902969703482535, - "heading": -0.2804899410650269, - "angularVelocity": -0.011064550558905711, - "velocityX": -3.9408217954513325, - "velocityY": -0.44823333167467494, + "x": 10.564408931858496, + "y": 1.6921473086815817, + "heading": -0.28038185385941405, + "angularVelocity": -0.011537806634941384, + "velocityX": -3.7353972007803753, + "velocityY": -0.4912360445090406, "moduleForcesX": [ - -16.989466098780625, - -17.26841193735081, - -16.819178445964713, - -17.097483761569933 + -18.223496328433487, + -18.496021684044194, + -18.05270477943314, + -18.32464726681692 ], "moduleForcesY": [ - 104.53971564488899, - 104.50562642972606, - 104.6000776405437, - 104.56645125313038 + 99.92208309280701, + 99.88968062550067, + 100.00063874310935, + 99.96866077815216 ], - "timestamp": 4.860615699966787 + "timestamp": 4.998184246735293 }, { "x": 10.358807563781738, "y": 1.6887441873550415, "heading": -0.28131737276900265, - "angularVelocity": -0.015586265050319821, - "velocityX": -3.964677722652637, - "velocityY": -0.029249649465378225, + "angularVelocity": -0.017132307360595633, + "velocityX": -3.765210724814718, + "velocityY": -0.06232190493864942, "moduleForcesX": [ - -6.18572157157631, - -6.9202746933831, - -5.844740651408106, - -6.573955564662377 + -7.529271015507784, + -8.398980799855844, + -7.110732370059438, + -7.973097440144591 ], "moduleForcesY": [ - 112.06720187117625, - 112.03161900342097, - 112.11336799839647, - 112.08016014025495 + 111.53171815583704, + 111.47999858137479, + 111.59688033555024, + 111.54866670440515 ], - "timestamp": 4.913702934227492 + "timestamp": 5.052789787594331 }, { - "x": 10.074031104225313, - "y": 1.7288019189642057, - "heading": -0.28133183349243884, - "angularVelocity": -0.00019962394982934355, - "velocityX": -3.931214224926528, - "velocityY": 0.5529794301309934, + "x": 10.08393736820923, + "y": 1.7277034984607378, + "heading": -0.28133184198304767, + "angularVelocity": -0.00019656089199339045, + "velocityX": -3.734047381979395, + "velocityY": 0.5292531383220508, "moduleForcesX": [ - 5.868356427204316, - 7.872028825010418, - 5.2245262323577535, - 7.274148654405299 + 5.273262788820698, + 7.435057509898819, + 4.561459737278025, + 6.776645494665948 ], "moduleForcesY": [ - 114.19123917565138, - 114.06618405796584, - 114.19557828660732, - 114.07858878844017 + 114.17857048927304, + 114.05312633616373, + 114.17906174500055, + 114.06354518890141 ], - "timestamp": 4.986142756445969 + "timestamp": 5.126401653608415 }, { - "x": 9.797922122377006, - "y": 1.8092440058536325, - "heading": -0.2813429282119763, - "angularVelocity": -0.00015315774111119407, - "velocityX": -3.8115634935652762, - "velocityY": 1.1104677569033128, + "x": 9.818202185590613, + "y": 1.8080829466543498, + "heading": -0.28134297586169704, + "angularVelocity": -0.0001512511399625565, + "velocityX": -3.609950365444831, + "velocityY": 1.0919360226275558, "moduleForcesX": [ - 23.452096627965147, - 23.458196144337972, - 23.451465640201057, - 23.45756560307959 + 23.93648599054604, + 23.942282612665448, + 23.93591950874844, + 23.941716534513144 ], "moduleForcesY": [ - 109.28376366394927, - 109.2824400014251, - 109.28362046955922, - 109.28229674147876 + 108.54583486390916, + 108.54454153578949, + 108.54564914640099, + 108.54435575416598 ], - "timestamp": 5.0585825786644465 + "timestamp": 5.200013519622499 }, { - "x": 9.530417627011207, - "y": 1.9148302457499569, - "heading": -0.2813548125722149, - "angularVelocity": -0.0001640583849411106, - "velocityX": -3.692782328468601, - "velocityY": 1.457571770094606, + "x": 9.55957700395428, + "y": 1.909026956405172, + "heading": -0.28135415722511536, + "angularVelocity": -0.00015189620945305375, + "velocityX": -3.5133626633897372, + "velocityY": 1.3713007863638298, "moduleForcesX": [ - 23.284729079604, - 23.283902232747476, - 23.284842009272996, - 23.284015169836746 + 18.632396331688547, + 18.63235498740305, + 18.632405037196314, + 18.632363692926397 ], "moduleForcesY": [ - 68.04154028777809, - 68.04180366771809, - 68.04204433937217, - 68.04230771680363 + 53.89121026384353, + 53.89122312286384, + 53.89124460812597, + 53.891257467141436 ], - "timestamp": 5.131022400882924 + "timestamp": 5.273625385636583 }, { - "x": 9.293245060968994, - "y": 2.010127611481761, - "heading": -0.3014330787042576, - "angularVelocity": -0.2771716649370988, - "velocityX": -3.2740633366949123, - "velocityY": 1.315538371206782, + "x": 9.314078063004189, + "y": 2.00599679218808, + "heading": -0.3009876013168922, + "angularVelocity": -0.26671575052886687, + "velocityX": -3.335045750682662, + "velocityY": 1.3173125615964598, "moduleForcesX": [ - 81.01560658870925, - 75.11544611300343, - 88.38909893685307, - 83.80155867415682 + 37.2832858474123, + 25.84642277568476, + 42.75006123891907, + 31.714081507752265 ], "moduleForcesY": [ - -39.65492799695376, - -40.25210144011162, - -17.310769456098512, - -14.151996507909613 + -21.015362736520213, + -18.1500142144038, + -3.319730193685859, + 0.8264239519393597 ], - "timestamp": 5.203462223101401 + "timestamp": 5.347237251650667 }, { - "x": 9.09552927538301, - "y": 2.0895893588177756, - "heading": -0.31844570606675093, - "angularVelocity": -0.23485186519623918, - "velocityX": -2.729379773871831, - "velocityY": 1.096934598988375, + "x": 9.10941935629468, + "y": 2.086840876505934, + "heading": -0.31798427093228115, + "angularVelocity": -0.23089578536342262, + "velocityX": -2.7802407110607743, + "velocityY": 1.0982479958107088, "moduleForcesX": [ - 107.5793065716789, - 107.64208344195727, - 105.87575754009715, - 105.99463103451073 + 107.68858293139235, + 107.738552826401, + 106.29323252806583, + 106.38126830053615 ], "moduleForcesY": [ - -40.83034886509639, - -40.697127559381315, - -45.06642730066156, - -44.81548009939982 + -40.5682562760582, + -40.462053452478216, + -44.096907679115134, + -43.90855630284436 ], - "timestamp": 5.275902045319879 + "timestamp": 5.420849117664751 }, { - "x": 8.937331011810468, - "y": 2.153175677565822, - "heading": -0.33216267776880665, - "angularVelocity": -0.1893567830783133, - "velocityX": -2.1838577004705906, - "velocityY": 0.8777812645132024, + "x": 8.945665590155809, + "y": 2.151528839125374, + "heading": -0.3318177617543003, + "angularVelocity": -0.18792474054892708, + "velocityX": -2.224556651064109, + "velocityY": 0.8787708575009153, "moduleForcesX": [ - 107.81855559484976, - 107.86118930596342, - 105.98182204499231, - 106.08769609512697 + 108.00459288569083, + 108.03895547091057, + 106.32434275384833, + 106.41201988616298 ], "moduleForcesY": [ - -40.76058786716746, - -40.66527143933629, - -45.32350556529571, - -45.0909361635883 + -40.28289239333359, + -40.20672149366398, + -44.52996596613108, + -44.33454527838807 ], - "timestamp": 5.348341867538356 + "timestamp": 5.494460983678835 }, { - "x": 8.8186706046164, - "y": 2.2008731582030556, - "heading": -0.3425003600582634, - "angularVelocity": -0.1427071736631058, - "velocityX": -1.6380549200713106, - "velocityY": 0.65844281745169, + "x": 8.822838083638423, + "y": 2.2000505965479666, + "heading": -0.3423020852827545, + "angularVelocity": -0.1424270854164775, + "velocityX": -1.6685829767430085, + "velocityY": 0.6591567372209985, "moduleForcesX": [ - 107.90467393449282, - 107.93229359869257, - 106.0198371641577, - 106.11256348212794 + 108.11666519143748, + 108.1367372735272, + 106.33573686070704, + 106.41424542733333 ], "moduleForcesY": [ - -40.72210440542275, - -40.66091896254574, - -45.404374735866405, - -45.19805154468376 + -40.168809305270315, + -40.12609997700313, + -44.67103028526917, + -44.4938843255294 ], - "timestamp": 5.420781689756834 + "timestamp": 5.5680728496929195 }, { - "x": 8.739558229904278, - "y": 2.232675064823596, - "heading": -0.3494154778567653, - "angularVelocity": -0.09546017075588695, - "velocityX": -1.0921116630231633, - "velocityY": 0.439011384161408, + "x": 8.740947438367238, + "y": 2.232401107243289, + "heading": -0.34934249092246195, + "angularVelocity": -0.09564226558745821, + "velocityX": -1.1124652818272123, + "velocityY": 0.4394741289282456, "moduleForcesX": [ - 107.94946633207205, - 107.96697591893108, - 106.03987686308874, - 106.12319819766434 + 108.1744880611608, + 108.18447910649813, + 106.34236528854647, + 106.41318223955082 ], "moduleForcesY": [ - -40.698520186674784, - -40.66122527870845, - -45.442664241769215, - -45.25595136469532 + -40.1066849659844, + -40.088485624896734, + -44.739176472038366, + -44.57832391748549 ], - "timestamp": 5.493221511975311 + "timestamp": 5.641684715707004 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -0.047850528600588194, - "velocityX": -0.5460840279946031, - "velocityY": 0.2195241654092463, + "angularVelocity": -0.048080165750898934, + "velocityX": -0.556261382633667, + "velocityY": 0.21975056429240547, "moduleForcesX": [ - 107.97604331480812, - 107.9882753754576, - 106.05139834798732, - 106.12996188400123 + 108.20892496086539, + 108.21348472478888, + 106.3458501916204, + 106.41277222504725 ], "moduleForcesY": [ - -40.68522330978408, - -40.660146907176184, - -45.466900880102564, - -45.28983190819318 + -40.06999069497857, + -40.064797915468255, + -44.78118450203358, + -44.62830082076761 ], - "timestamp": 5.565661334193789 + "timestamp": 5.715296581721088 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -4.8288976906928006e-27, - "velocityX": 1.7587671009889585e-26, - "velocityY": 3.3751021564294008e-25, + "angularVelocity": 7.228649510679406e-23, + "velocityX": 2.8012684640616525e-22, + "velocityY": -6.2742965542830935e-22, "moduleForcesX": [ - 107.99223491781001, - 108.0040016915483, - 106.05743685003779, - 106.13622374630019 + 108.23038445425983, + 108.23430457634595, + 106.34652059702094, + 106.41417815468229 ], "moduleForcesY": [ - -40.68042792406633, - -40.65537952997916, - -45.48693154917796, - -45.30833424193728 + -40.04952106692136, + -40.0449273344048, + -44.81309642327084, + -44.65756272827848 ], - "timestamp": 5.638101156412266 + "timestamp": 5.788908447735172 }, { - "x": 8.733926813861677, - "y": 2.235358433045618, - "heading": -0.35026869308585346, - "angularVelocity": 0.03903296429686566, - "velocityX": 0.5067850635723455, - "velocityY": -0.19745894526536673, + "x": 8.735160496003328, + "y": 2.2353073040625637, + "heading": -0.34950341211539854, + "angularVelocity": 0.049669524785278404, + "velocityX": 0.5169403325880028, + "velocityY": -0.195100354566496, "moduleForcesX": [ - 108.31232931165216, - 108.31646484929276, - 106.65379169981476, - 106.70790819705412 + 108.92708748634631, + 108.91169498268742, + 106.90012644635497, + 106.95921424095818 ], "moduleForcesY": [ - -39.790421347467806, - -39.78562240023523, - -44.043414234869644, - -43.917976590357014 + -38.06986059379512, + -38.12247627099088, + -43.43729059553142, + -43.29915093821453 ], - "timestamp": 5.705046329623423 + "timestamp": 5.856924993914305 }, { - "x": 8.801777689763007, - "y": 2.208924184045344, - "heading": -0.3450752782075868, - "angularVelocity": 0.07757713706835337, - "velocityX": 1.0135290215370254, - "velocityY": -0.3948641512494974, + "x": 8.805476972134196, + "y": 2.20876912539207, + "heading": -0.34277198887220717, + "angularVelocity": 0.09896743691546771, + "velocityX": 1.0338142713932752, + "velocityY": -0.39017239423773575, "moduleForcesX": [ - 108.28996331730457, - 108.30053379408332, - 106.65261534540024, - 106.71250484198276 + 108.90060339205657, + 108.8953561059007, + 106.88867772089172, + 106.95804032881324 ], "moduleForcesY": [ - -39.81362083255557, - -39.7923038373262, - -44.01229472070396, - -43.873619165906334 + -38.097560026146894, + -38.122799476396146, + -43.42345092393567, + -43.26132213447991 ], - "timestamp": 5.77199150283458 + "timestamp": 5.924941540093438 }, { - "x": 8.903548768119284, - "y": 2.1692796518761055, - "heading": -0.3373473298717038, - "angularVelocity": 0.11543697573994958, - "velocityX": 1.5202153265818417, - "velocityY": -0.5921940338281327, + "x": 8.910942661149685, + "y": 2.168965701827033, + "heading": -0.33272524311327834, + "angularVelocity": 0.14771031937536208, + "velocityX": 1.5505887161298455, + "velocityY": -0.5852020692172026, "moduleForcesX": [ - 108.25850057581366, - 108.27833136732968, - 106.65081131519337, - 106.71905743006441 + 108.86109478467073, + 108.87073710864843, + 106.87169078257577, + 106.9560671341383 ], "moduleForcesY": [ - -39.84643901580114, - -39.80130085429087, - -43.969072663952105, - -43.81111658495434 + -38.13854642095758, + -38.123667627725496, + -43.40238220899807, + -43.20515744662125 ], - "timestamp": 5.838936676045737 + "timestamp": 5.992958086272571 }, { - "x": 9.039234239007644, - "y": 2.1164324000873393, - "heading": -0.3271533501766025, - "angularVelocity": 0.15227355769097134, - "velocityX": 2.0268148453419146, - "velocityY": -0.7894109351554927, + "x": 9.051546291570848, + "y": 2.1159017878510578, + "heading": -0.3194253273769413, + "angularVelocity": 0.19553941626658664, + "velocityX": 2.067197444146294, + "velocityY": -0.7801618423291163, "moduleForcesX": [ - 108.21238741016386, - 108.24396960661257, - 106.6491337463018, - 106.7275746109919 + 108.79813451721276, + 108.8272916619506, + 106.8462010419442, + 106.94957215478408 ], "moduleForcesY": [ - -39.89260206806913, - -39.81751467144118, - -43.901653051914266, - -43.72029844384376 + -38.1988424152394, + -38.13223147648961, + -43.36068150975463, + -43.11962308400631 ], - "timestamp": 5.905881849256894 + "timestamp": 6.060974632451704 }, { - "x": 9.208824365155895, - "y": 2.0503950328281664, - "heading": -0.31460646106714574, - "angularVelocity": 0.1874203696490803, - "velocityX": 2.533268912656832, - "velocityY": -0.9864395607862412, + "x": 9.22726536615065, + "y": 2.049586749721687, + "heading": -0.30299277062018, + "angularVelocity": 0.2415964596832561, + "velocityX": 2.5834754107775137, + "velocityY": -0.9749839098668391, "moduleForcesX": [ - 108.13878069799291, - 108.18385543698201, - 106.64908314006513, - 106.7379353214454 + 108.6811050373854, + 108.73406931364026, + 106.80275120146628, + 106.92705418988609 ], "moduleForcesY": [ - -39.96046705876718, - -39.851878052023736, - -43.78233752560014, - -43.57763984939862 + -38.29522411554184, + -38.1683694994336, + -43.25999294811074, + -42.97279366403858 ], - "timestamp": 5.972827022468051 + "timestamp": 6.128991178630837 }, { - "x": 9.412299498127187, - "y": 1.971192793059601, - "heading": -0.2999281888843931, - "angularVelocity": 0.21925811046084911, - "velocityX": 3.0394294795458103, - "velocityY": -1.1830911172452587, + "x": 9.438033057725468, + "y": 1.970048065593295, + "heading": -0.2837631233482766, + "angularVelocity": 0.2827201372627604, + "velocityX": 3.0987708640736242, + "velocityY": -1.1694019852009818, "moduleForcesX": [ - 107.99968413751532, - 108.05776232379695, - 106.65408367462612, - 106.74909898164714 + 108.3626740241462, + 108.4418328543596, + 106.6908681014183, + 106.82910549783023 ], "moduleForcesY": [ - -40.073559976513465, - -39.93516235271832, - -43.53014008693058, - -43.31352925259886 + -38.50231437653497, + -38.32060078212658, + -42.92203871274231, + -42.61405148852438 ], - "timestamp": 6.039772195679208 + "timestamp": 6.19700772480997 }, { - "x": 9.64959962518174, - "y": 1.8789019078745433, - "heading": -0.28374565683521485, - "angularVelocity": 0.24172813771256552, - "velocityX": 3.5446936003297025, - "velocityY": -1.3786040241311388, + "x": 9.678076559868247, + "y": 1.879644856366163, + "heading": -0.28374820647577687, + "angularVelocity": 0.00021931240760807876, + "velocityX": 3.529192757165067, + "velocityY": -1.329135545769102, "moduleForcesX": [ - 107.61137555141407, - 107.67012594458993, - 106.67046549630616, - 106.74805702593525 + 87.67092010469722, + 82.29673746119292, + 96.41433044145562, + 93.06437688109202 ], "moduleForcesY": [ - -40.33210283996674, - -40.200949635022816, - -42.761473825206764, - -42.59175857555703 + -45.81494056023983, + -48.188084286902104, + -20.914888530025944, + -18.475969737183867 ], - "timestamp": 6.106717368890365 + "timestamp": 6.2650242709891035 }, { - "x": 9.900298294638016, - "y": 1.790758792782665, - "heading": -0.2837335320815777, - "angularVelocity": 0.00018111468020203295, - "velocityX": 3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 9.91942147309829, + "y": 1.7927653335156666, + "heading": -0.2837356440414742, + "angularVelocity": 0.00018469673937243685, + "velocityX": 3.5483264997669806, + "velocityY": -1.2773292342966782, "moduleForcesX": [ - 46.83355979424887, - 35.139698926947005, - 49.463406566005, - 38.377272751925325 + 3.9952241861110123, + 3.993394223196805, + 3.995923175642631, + 3.9940931809808093 ], "moduleForcesY": [ - 1.5254319217028312, - 6.193009340047282, - 19.63550881795331, - 25.21513933953295 + 10.81442104002948, + 10.814957408993081, + 10.816830640829714, + 10.81736703378314 ], - "timestamp": 6.173662542101522 + "timestamp": 6.333040817168237 }, { - "x": 10.15979314102593, - "y": 1.7334916000286844, - "heading": -0.2837214488432004, - "angularVelocity": 0.00018049454199105732, - "velocityX": 3.8762293671183365, - "velocityY": -0.8554342308346725, + "x": 10.169106994861316, + "y": 1.7340196610481893, + "heading": -0.28372258147039636, + "angularVelocity": 0.00019204990273192154, + "velocityX": 3.670952669449541, + "velocityY": -0.8636967880250899, "moduleForcesX": [ - 27.870855303386527, - 27.87078008363208, - 27.87085955385126, - 27.87078433416476 + 25.60101320769064, + 25.601760187553346, + 25.600945387189146, + 25.60169237360391 ], "moduleForcesY": [ - 97.83081049698777, - 97.83083198961774, - 97.83082304661332, - 97.83084453922426 + 86.35659720719445, + 86.35637664311918, + 86.35635196045361, + 86.35613139442138 ], - "timestamp": 6.240607715312679 + "timestamp": 6.40105736334737 }, { "x": 10.424600601196287, "y": 1.7113943099975586, "heading": -0.2837047824958171, - "angularVelocity": 0.00024895517606220293, - "velocityX": 3.9555870493471943, - "velocityY": -0.3300804071628431, + "angularVelocity": 0.00026168595112677055, + "velocityX": 3.756344899696669, + "velocityY": -0.33264480955917264, "moduleForcesX": [ - 16.829101110309146, - 16.838915102240243, - 16.827278780287177, - 16.837093906581575 + 17.823774151167182, + 17.83355423810466, + 17.822074295255895, + 17.83185551284743 ], "moduleForcesY": [ - 111.43715289160197, - 111.43563757699792, - 111.43710122782548, - 111.43558589017641 + 110.87155302236657, + 110.86994540179049, + 110.87145101626253, + 110.86984335012644 ], - "timestamp": 6.307552888523836 + "timestamp": 6.469073909526503 }, { - "x": 10.649647240268498, - "y": 1.7185557092564774, - "heading": -0.28304825482562407, - "angularVelocity": 0.011565209036453545, - "velocityX": 3.9643590696733866, - "velocityY": 0.1261532197089931, + "x": 10.644414774625627, + "y": 1.7193809732535479, + "heading": -0.2828019280537436, + "angularVelocity": 0.015459837026566284, + "velocityX": 3.7639414937610223, + "velocityY": 0.13675793856658902, "moduleForcesX": [ - 1.612409435028023, - 3.449197442112493, - 0.920737067471497, - 2.7948238151606644 + 1.09713864157884, + 3.483800587637876, + 0.17889110374315617, + 2.6287399657540216 ], "moduleForcesY": [ - 114.15637546330666, - 114.11007946252991, - 114.1356704809822, - 114.09921998413924 + 114.17621366105449, + 114.12110918273105, + 114.14468636650177, + 114.10669848112909 ], - "timestamp": 6.364320359662809 + "timestamp": 6.527473906921174 }, { - "x": 10.872486526800158, - "y": 1.7511786253728163, - "heading": -0.2825635463774615, - "angularVelocity": 0.008538489357327173, - "velocityX": 3.9254749605830384, - "velocityY": 0.5746762267509568, + "x": 10.861693485566251, + "y": 1.754234167279391, + "heading": -0.2821930397682389, + "angularVelocity": 0.010426169737471161, + "velocityX": 3.720526038250279, + "velocityY": 0.5968012941901759, "moduleForcesX": [ - -9.617734238949605, - -10.066815271135845, - -9.387604811781262, - -9.834772017123038 + -10.385540743401451, + -11.10514334159848, + -10.010565773367109, + -10.725324626777565 ], "moduleForcesY": [ - 112.19647225066657, - 112.1614659010998, - 112.23111915488862, - 112.19714365211973 + 111.86098322186378, + 111.79973293870482, + 111.92171623690528, + 111.86317871279545 ], - "timestamp": 6.421087830801782 + "timestamp": 6.585873904315846 }, { - "x": 11.090604076378652, - "y": 1.8073745478916146, - "heading": -0.28216255506909754, - "angularVelocity": 0.007063751481588911, - "velocityX": 3.842298154246073, - "velocityY": 0.9899317582991157, + "x": 11.073781283880631, + "y": 1.813061818721627, + "heading": -0.28170357599097573, + "angularVelocity": 0.008381229436627325, + "velocityX": 3.6316405441095316, + "velocityY": 1.0073228436069037, "moduleForcesX": [ - -20.776539685058307, - -20.95690176428432, - -20.656026809805056, - -20.836146342062964 + -21.575934691647564, + -21.80574823449794, + -21.420174805115277, + -21.649612023660485 ], "moduleForcesY": [ - 103.86595800234613, - 103.83805579833923, - 103.91143822729335, - 103.88375203666148 + 99.80080758549971, + 99.76654159220668, + 99.87324161618055, + 99.83931034438025 ], - "timestamp": 6.477855301940755 + "timestamp": 6.644273901710517 }, { - "x": 11.305331510363592, - "y": 1.8754073625880365, - "heading": -0.2817861235290747, - "angularVelocity": 0.006631113425879257, - "velocityX": 3.7825788198185237, - "velocityY": 1.1984471622818953, + "x": 11.283587635771832, + "y": 1.8795916481170019, + "heading": -0.2812364772082353, + "angularVelocity": 0.007998267184563267, + "velocityX": 3.592574678956124, + "velocityY": 1.1392094582772114, "moduleForcesX": [ - -14.93113836042353, - -14.963264037670038, - -14.913927685174185, - -14.946047731778885 + -9.49218404818873, + -9.517076511502912, + -9.480971029856981, + -9.50586093834778 ], "moduleForcesY": [ - 52.14197332650795, - 52.14527104247297, - 52.17361050090557, - 52.17690623845406 + 32.05124416889292, + 32.0564927746003, + 32.08103597153202, + 32.086282418465686 ], - "timestamp": 6.534622773079728 + "timestamp": 6.702673899105188 }, { - "x": 11.519652692450972, - "y": 1.9447110026462533, - "heading": -0.28141169188970344, - "angularVelocity": 0.006595883731628649, - "velocityX": 3.7754223992591815, - "velocityY": 1.2208336687846026, + "x": 11.493202658637001, + "y": 1.9467231127720637, + "heading": -0.2807706851083828, + "angularVelocity": 0.007975892476580818, + "velocityX": 3.5892984968573782, + "velocityY": 1.1495114323615963, "moduleForcesX": [ - -1.7894810492252815, - -1.7916911360220178, - -1.7886188443613336, - -1.7908289271510018 + -0.7961996165924138, + -0.7975621457668051, + -0.7956717132450022, + -0.7970342417583107 ], "moduleForcesY": [ - 5.59811618322889, - 5.598749349977472, - 5.601072120131871, - 5.6017052821445015 + 2.5038569339269885, + 2.5042491658535546, + 2.505684173989879, + 2.506076405059044 ], - "timestamp": 6.591390244218701 + "timestamp": 6.76107389649986 }, { - "x": 11.733959431080516, - "y": 2.014059333930838, - "heading": -0.281037272981895, - "angularVelocity": 0.006595659455954908, - "velocityX": 3.77516796731879, - "velocityY": 1.2216209370118305, + "x": 11.702813327657477, + "y": 2.0138681893180537, + "heading": -0.2803048424702293, + "angularVelocity": 0.007976757858486104, + "velocityX": 3.5892239447189, + "velocityY": 1.1497445126960992, "moduleForcesX": [ - -0.06364100877139726, - -0.06365505243487238, - -0.06363556826688263, - -0.06364961193035205 + -0.01814381941383678, + -0.018091134855889958, + -0.018164173207132702, + -0.018111488649066233 ], "moduleForcesY": [ - 0.1969210992616689, - 0.19692515330886895, - 0.19693994534373072, - 0.1969439993909239 + 0.05671736020618125, + 0.0567021930988224, + 0.05664665917209394, + 0.05663149206454538 ], - "timestamp": 6.648157715357674 + "timestamp": 6.819473893894531 }, { - "x": 11.94849901356588, - "y": 2.082663911446821, - "heading": -0.2806488087861412, - "angularVelocity": 0.006843077346228324, - "velocityX": 3.779269679992362, - "velocityY": 1.2085191772596517, + "x": 11.912555116213372, + "y": 2.0806013070151295, + "heading": -0.27983771695717125, + "angularVelocity": 0.007998724895503196, + "velocityX": 3.591469142343322, + "velocityY": 1.1426904225027354, "moduleForcesX": [ - 1.0212819494692333, - 1.0367870294859038, - 1.015272810913435, - 1.0307777743362587 + 0.545518088488526, + 0.5468558718661225, + 0.5450018966008922, + 0.5463396795091038 ], "moduleForcesY": [ - -3.264742509835954, - -3.2691983489944296, - -3.285525660592635, - -3.289981363380365 + -1.7141411533773943, + -1.7145252782998055, + -1.7159358500537687, + -1.7163199744295505 ], - "timestamp": 6.704925186496647 + "timestamp": 6.877873891289203 }, { - "x": 12.152037072754059, - "y": 2.142322529407559, - "heading": -0.2510180942418901, - "angularVelocity": 0.5219664351739706, - "velocityX": 3.585469902118673, - "velocityY": 1.0509296391711178, + "x": 12.123582090461483, + "y": 2.141695128776019, + "heading": -0.2784545161826354, + "angularVelocity": 0.023684945826077396, + "velocityX": 3.613475747643897, + "velocityY": 1.0461271316163527, "moduleForcesX": [ - -67.96426240208135, - -30.062890973818163, - -63.34891083146934, - -32.53743564226132 + 5.056830451597807, + 6.052976456784937, + 4.650734177456533, + 5.643439292990552 ], "moduleForcesY": [ - -8.235178803765649, - -27.016971831599303, - -52.69317016977563, - -69.73669104087452 + -22.732394581032693, + -22.979924677069157, + -23.981026840246905, + -24.225672996948276 ], - "timestamp": 6.76169265763562 + "timestamp": 6.936273888683874 }, { - "x": 12.334148820301001, - "y": 2.1971654821119366, - "heading": -0.17114703208449755, - "angularVelocity": 1.406986440559578, - "velocityX": 3.208029949072625, - "velocityY": 0.966098217940971, + "x": 12.312845499111194, + "y": 2.1960087754333726, + "heading": -0.22597278443049482, + "angularVelocity": 0.8986598303672022, + "velocityX": 3.240811936525529, + "velocityY": 0.930028237677772, "moduleForcesX": [ - -110.90141886725935, - -104.51767942702155, - -99.94508162050465, - -62.2972554143191 + -110.09390991333008, + -103.48471382580139, + -96.45188523190053, + -52.42834336586494 ], "moduleForcesY": [ - 26.85599963756138, - 39.311826008079045, - -55.67355131570806, - -95.37547475461713 + 24.89118915347873, + 22.28582245406149, + -60.0582233614142, + -100.03845095304496 ], - "timestamp": 6.818460128774593 + "timestamp": 6.994673886078545 }, { - "x": 12.494844000544365, - "y": 2.247628220403907, - "heading": -0.03691006304613977, - "angularVelocity": 2.36468115181193, - "velocityX": 2.8307616495715395, - "velocityY": 0.8889375777975359, + "x": 12.479529781632614, + "y": 2.2449867624612256, + "heading": -0.1184996439866557, + "angularVelocity": 1.84029358284946, + "velocityX": 2.8541830472175405, + "velocityY": 0.8386641988501548, "moduleForcesX": [ - -112.18575793402451, - -101.8689939557043, - -99.30217040259397, - -64.13275876528363 + -111.9090944895469, + -104.84618511277107, + -98.77086477361028, + -60.51536896101172 ], "moduleForcesY": [ - 24.489794047684235, - 51.11251099285013, - -57.83793809446346, - -94.97028505916231 + 24.43643622108832, + 42.12552095732977, + -58.374344881869746, + -97.04975471639112 ], - "timestamp": 6.875227599913566 + "timestamp": 7.053073883473217 }, { - "x": 12.633730382727341, - "y": 2.2936459171983987, - "heading": 0.15068702087135824, - "angularVelocity": 3.3046581105971575, - "velocityX": 2.4465839220310848, - "velocityY": 0.8106349617342448, + "x": 12.623809461398077, + "y": 2.289494145161703, + "heading": 0.04954714385936545, + "angularVelocity": 2.8775136188850925, + "velocityX": 2.470542571952716, + "velocityY": 0.7621127514731357, "moduleForcesX": [ - -113.52781849420326, - -101.72159587923039, - -98.27794501691677, - -70.87580416849228 + -112.53923361529047, + -98.88615121430331, + -98.21581874489462, + -63.49372991199005 ], "moduleForcesY": [ - 18.795877029064826, - 53.03473995293743, - -59.883306375450104, - -90.29587475253841 + 23.427197480933216, + 57.43559858001425, + -59.82012493838722, + -95.49784743209881 ], - "timestamp": 6.931995071052539 + "timestamp": 7.111473880867888 }, { - "x": 12.747373227511964, - "y": 2.33297655165956, - "heading": 0.33465067573891905, - "angularVelocity": 3.2406526339212256, - "velocityX": 2.0019007805793065, - "velocityY": 0.692837529522422, + "x": 12.742567636762507, + "y": 2.329195026608957, + "heading": 0.2532418400568153, + "angularVelocity": 3.4879230356958084, + "velocityX": 2.033530490795285, + "velocityY": 0.679809644150375, "moduleForcesX": [ - -110.15119273382385, - -110.09590584370162, - -112.42030542510648, - -112.27667812755305 + -114.89005050626218, + -111.51397335746597, + -103.13454077524403, + -95.5064562830338 ], "moduleForcesY": [ - -33.543041884285, - -33.78436386293674, - -24.91070248135435, - -25.628447678324406 + 7.12526379432016, + 27.76672389886986, + -51.10134531295922, + -63.839976213971404 ], - "timestamp": 6.988762542191512 + "timestamp": 7.1698738782625595 }, { - "x": 12.836684119739113, - "y": 2.3652177680520627, - "heading": 0.49472956453813244, - "angularVelocity": 2.8199052307142933, - "velocityX": 1.5732758644207596, - "velocityY": 0.567952310462666, + "x": 12.83479843521252, + "y": 2.3624207500453496, + "heading": 0.44054512932062534, + "angularVelocity": 3.2072482469134482, + "velocityX": 1.5792945644622498, + "velocityY": 0.5689336458673059, "moduleForcesX": [ - -99.1906995535979, - -99.97859392638925, - -115.15979579307127, - -114.54734457522899 + -106.34982483559645, + -105.95228683396374, + -115.09460575424762, + -114.4004939951579 ], "moduleForcesY": [ - -58.57964610086167, - -57.39726866081906, - 4.13728262086476, - -13.118869737078935 + -44.17247603120524, + -45.29021140358265, + -4.506204608148659, + -13.87089784378298 ], - "timestamp": 7.045530013330485 + "timestamp": 7.228273875657231 }, { - "x": 12.902648711217271, - "y": 2.3899438580710273, - "heading": 0.6212528884768642, - "angularVelocity": 2.2287997228023118, - "velocityX": 1.162013916678965, - "velocityY": 0.4355679321777755, + "x": 12.902153785945606, + "y": 2.388339311177531, + "heading": 0.5920521705772573, + "angularVelocity": 2.5942987673909688, + "velocityX": 1.1533450982521831, + "velocityY": 0.44381099808998664, "moduleForcesX": [ - -90.92322148643733, - -92.24578923617236, - -113.61714858975364, - -114.71711750544789 + -92.38930111082509, + -93.92589046885863, + -112.97863519241551, + -114.99151586069087 ], "moduleForcesY": [ - -70.78350796787741, - -69.22716039877027, - 19.619781271549844, - -12.071174524868752 + -68.80392001259384, + -66.8988698725461, + 22.89679875087174, + -8.890320559157662 ], - "timestamp": 7.1022974844694575 + "timestamp": 7.286673873051902 }, { - "x": 12.946021910632137, - "y": 2.4067236714663482, - "heading": 0.7092144892181306, - "angularVelocity": 1.549507120476202, - "velocityX": 0.7640502306097657, - "velocityY": 0.2955885308725854, + "x": 12.94599898532897, + "y": 2.4061455217676833, + "heading": 0.6987986006648391, + "angularVelocity": 1.8278499118104674, + "velocityX": 0.7507739955372641, + "velocityY": 0.3049008798719041, "moduleForcesX": [ - -85.10523672353476, - -86.41137299899846, - -112.06170126554508, - -114.61890071891574 + -81.25618436721729, + -85.27321950996416, + -110.08736666214384, + -114.93039749975733 ], "moduleForcesY": [ - -77.71146885299495, - -76.42757490922745, - 27.300042653259524, - -13.22254030124739 + -81.68368062704863, + -77.68627318980845, + 34.38228873619402, + -10.118563442601245 ], - "timestamp": 7.1590649556084305 + "timestamp": 7.345073870446574 }, { "x": 12.967412948608398, - "y": 2.415215253829956, + "y": 2.4152152538299556, "heading": 0.7551043250796196, - "angularVelocity": 0.8083825990618009, - "velocityX": 0.3768185819638491, - "velocityY": 0.14958535571928933, + "angularVelocity": 0.9641391597034191, + "velocityX": 0.36667746977301147, + "velocityY": 0.15530363813167133, "moduleForcesX": [ - -79.8120626088093, - -82.24535135891634, - -110.85189362912443, - -114.54956911255539 + -71.24184841573965, + -79.34168407653632, + -108.15322189105373, + -114.84174119771971 ], "moduleForcesY": [ - -83.1630963954795, - -80.92027537570912, - 31.94949718085646, - -13.954975426754949 + -90.57520191146978, + -83.76752129096904, + 40.14476142563533, + -11.30273600011981 ], - "timestamp": 7.215832426747403 + "timestamp": 7.403473867841245 }, { "x": 12.967412948608398, "y": 2.415215253829956, "heading": 0.7551043250796196, - "angularVelocity": -1.3336137182058527e-20, - "velocityX": 7.896803099134162e-20, - "velocityY": -8.450419355688481e-20, + "angularVelocity": 9.053251338585555e-21, + "velocityX": -3.8997560756165654e-20, + "velocityY": 8.026582215029425e-20, "moduleForcesX": [ - -73.04670295538688, - -79.74797430779527, - -109.59078372653275, - -114.65423863578631 + -59.447576805243436, + -76.0182207018807, + -106.23908134928888, + -114.93156102990737 ], "moduleForcesY": [ - -89.19074412625777, - -83.40210179987234, - 36.08914873029201, - -13.169435415720292 + -98.75016323489919, + -86.81696405456789, + 45.01411898852267, + -10.497822934908333 ], - "timestamp": 7.272599897886376 + "timestamp": 7.4618738652359164 }, { - "x": 12.970048360747468, - "y": 2.4137790529276497, - "heading": 0.7937123904808917, - "angularVelocity": 1.1279408340974115, - "velocityX": 0.07699398909111418, - "velocityY": -0.04195884012456589, + "x": 12.96998343707109, + "y": 2.414002895867038, + "heading": 0.7972120394307962, + "angularVelocity": 1.1925305688726804, + "velocityX": 0.07279868109514463, + "velocityY": -0.03433513201728092, "moduleForcesX": [ - -108.01660145288726, - 63.314454594733206, - 60.59422206639011, - 111.87513675069263 + -111.21616724439681, + 56.92485396981027, + 59.189341209886784, + 112.20973399379479 ], "moduleForcesY": [ - -39.618466232021234, - 96.33566340014396, - -98.1623898281533, - -28.183152137146752 + -29.647343877850524, + 100.25021857445405, + -99.01585760311724, + -26.82030436731245 ], - "timestamp": 7.3068287015914635 + "timestamp": 7.497183412387384 }, { - "x": 12.975621766996525, - "y": 2.4106424063814402, - "heading": 0.8697774779478025, - "angularVelocity": 2.222253752198958, - "velocityX": 0.16282795908031536, - "velocityY": -0.0916376328318483, + "x": 12.975382665164473, + "y": 2.411312891081737, + "heading": 0.8804592395786249, + "angularVelocity": 2.3576399830539327, + "velocityX": 0.15291128119587102, + "velocityY": -0.07618349716500683, "moduleForcesX": [ - -96.65015385418619, - 60.2572282410898, - 65.93464425581767, - 112.89494643133521 + -102.0282025796209, + 52.4117542511673, + 65.18685502936165, + 113.30290747157059 ], "moduleForcesY": [ - -62.329753787693775, - 98.21955261781349, - -94.63903361003725, - -23.689938883154483 + -53.14869773571917, + 102.62130539045927, + -95.15210347949893, + -21.639970807289608 ], - "timestamp": 7.3410575052965505 + "timestamp": 7.532492959538852 }, { - "x": 12.984638262041022, - "y": 2.40560314630279, - "heading": 0.981604703565313, - "angularVelocity": 3.2670503643950517, - "velocityX": 0.2634183514613656, - "velocityY": -0.14722279288698714, + "x": 12.984095673066808, + "y": 2.406910573419745, + "heading": 1.0032632315683296, + "angularVelocity": 3.477925997263877, + "velocityX": 0.24676068104083002, + "velocityY": -0.1246778284382388, "moduleForcesX": [ - -75.73920484802935, - 55.647722774813666, - 72.9840009621066, - 114.03160254054053 + -82.28667122957336, + 45.662880673923205, + 73.15743467730792, + 114.4374038272442 ], "moduleForcesY": [ - -86.50130488193668, - 100.80472826924579, - -89.2887526232794, - -17.255130186537208 + -80.3144525443013, + 105.68805654601378, + -89.1356191703524, + -14.2484998053063 ], - "timestamp": 7.375286309001638 + "timestamp": 7.56780250669032 }, { - "x": 12.997789852791989, - "y": 2.398632583933518, - "heading": 1.1269751697569061, - "angularVelocity": 4.247021527369041, - "velocityX": 0.384225836937812, - "velocityY": -0.20364609962244667, + "x": 12.996877140681336, + "y": 2.4007272960210755, + "heading": 1.1632571037667327, + "angularVelocity": 4.531178820053266, + "velocityX": 0.36198333441376895, + "velocityY": -0.17511630415825236, "moduleForcesX": [ - -47.052833680267064, - 51.55657320839896, - 81.07269190656048, - 114.89682349470702 + -51.418086814419254, + 39.35983727831288, + 82.27641388148449, + 115.13501591899251 ], "moduleForcesY": [ - -104.87988948985272, - 102.76487920670435, - -81.97187217875056, - -9.5444344265138 + -102.7787620179167, + 107.95631863586193, + -80.73399410186636, + -5.581529823013248 ], - "timestamp": 7.409515112706725 + "timestamp": 7.603112053841788 }, { - "x": 13.01604908890962, - "y": 2.3898145535116964, - "heading": 1.30230612560941, - "angularVelocity": 5.122322046751738, - "velocityX": 0.5334465170026499, - "velocityY": -0.25762017562547473, + "x": 13.015049064249819, + "y": 2.3927861943346507, + "heading": 1.3554989134366557, + "angularVelocity": 5.444471118399243, + "velocityX": 0.5146461802677791, + "velocityY": -0.22489956193372712, "moduleForcesX": [ - -13.83132865379064, - 56.89712099256609, - 89.34828449880882, - 115.20928290206547 + -10.940950643938722, + 49.962099870379674, + 91.40372157976817, + 115.15655922442267 ], "moduleForcesY": [ - -114.07904848518923, - 99.40316122357095, - -72.78432529295559, - -2.1067431308289684 + -114.29555191993943, + 102.6827935808022, + -70.09920994331412, + 1.628018794334819 ], - "timestamp": 7.443743916411812 + "timestamp": 7.638421600993256 }, { - "x": 13.041330772308694, - "y": 2.3782677142113013, - "heading": 1.4965650837086486, - "angularVelocity": 5.675306673670554, - "velocityX": 0.7386084426695338, - "velocityY": -0.337342765456264, + "x": 13.041336393679563, + "y": 2.380821542261088, + "heading": 1.5611649438949164, + "angularVelocity": 5.824657834778007, + "velocityX": 0.7444822024189007, + "velocityY": -0.3388503404537995, "moduleForcesX": [ - 23.62733870295094, - 105.17566327178272, - 96.55369553063645, - 115.09802567519542 + 44.018601789505944, + 112.32060939232755, + 98.58413579678957, + 114.80288651764442 ], "moduleForcesY": [ - -112.36357969798449, - 42.3756044319675, - -62.73241252810405, - 0.42521575450602284 + -105.76548150864933, + -13.981211872807418, + -59.14888259144886, + -4.411599951380392 ], - "timestamp": 7.477972720116899 + "timestamp": 7.673731148144724 }, { - "x": 13.074571748977242, - "y": 2.3622293034747717, - "heading": 1.6983784117666543, - "angularVelocity": 5.896008805823781, - "velocityX": 0.9711404744073342, - "velocityY": -0.46856474666171494, + "x": 13.075568670437569, + "y": 2.363605977955592, + "heading": 1.7569917778370125, + "angularVelocity": 5.546002419743737, + "velocityX": 0.9694906765912515, + "velocityY": -0.4875611752160383, "moduleForcesX": [ - 71.12553566693927, - 100.91027402459993, - 100.75435384797667, - 113.08371748677187 + 112.77483449910198, + 99.15399456797537, + 90.29830581798545, + 59.73325270720686 ], "moduleForcesY": [ - -89.84770615754807, - -53.21727890658172, - -55.16195289043256, - -19.528589252981142 + -17.7589765691773, + -57.092373513786576, + -67.32011989023349, + -97.05254853412107 ], - "timestamp": 7.512201523821986 + "timestamp": 7.709040695296192 }, { - "x": 13.114509281067164, - "y": 2.340957999926888, - "heading": 1.8863558488571963, - "angularVelocity": 5.491791028110231, - "velocityX": 1.166781417020328, - "velocityY": -0.6214445509474895, + "x": 13.116425328315025, + "y": 2.3404059032444886, + "heading": 1.936779809038105, + "angularVelocity": 5.091768252644345, + "velocityX": 1.1570994581774832, + "velocityY": -0.657048208847239, "moduleForcesX": [ - 114.25525292589651, - 101.5198450249115, - 62.82771454322464, - 46.05237264124183 + 113.58831274277301, + 99.7780845838403, + 45.433109941728226, + 42.997780804688276 ], "moduleForcesY": [ - -3.0662620881109772, - -53.164971916677835, - -92.89456142147867, - -104.56967598650544 + -8.813998457097396, + -55.91347232549451, + -102.28351156220437, + -105.6347151591242 ], - "timestamp": 7.546430327527073 + "timestamp": 7.74435024244766 }, { - "x": 13.16127250279366, - "y": 2.3144796562214776, - "heading": 2.0604510155338396, - "angularVelocity": 5.086218267417001, - "velocityX": 1.3661950364785713, - "velocityY": -0.7735690657912138, + "x": 13.164348878372106, + "y": 2.311286163678727, + "heading": 2.102441153162455, + "angularVelocity": 4.691687022031468, + "velocityX": 1.3572405743835967, + "velocityY": -0.8246987547269855, "moduleForcesX": [ - 113.85700055139108, - 103.5977835443585, - 57.60230783383877, - 55.858639098030515 + 112.23361382448608, + 101.31991173599144, + 52.83399612225048, + 55.56993463789342 ], "moduleForcesY": [ - -7.038353644791787, - -48.731921179952906, - -97.0132702772452, - -99.65856579041063 + -17.942568729740564, + -52.73023800246578, + -99.48263504998427, + -99.53598557359436 ], - "timestamp": 7.58065913123216 + "timestamp": 7.779659789599128 }, { - "x": 13.215371818566618, - "y": 2.283182129389797, - "heading": 2.222199775394, - "angularVelocity": 4.725516008499068, - "velocityX": 1.5805202027821996, - "velocityY": -0.9143622751583239, + "x": 13.219851677647156, + "y": 2.2766875060838747, + "heading": 2.255229935633236, + "angularVelocity": 4.327123817684807, + "velocityX": 1.5718921298242057, + "velocityY": -0.9798669307882757, "moduleForcesX": [ - 113.4504714545397, - 106.32220430919419, - 67.34185140885803, - 68.54608055150739 + 111.9924020775366, + 104.4925935573574, + 62.07558249791472, + 66.73912886868742 ], "moduleForcesY": [ - -9.493241665912656, - -42.053893387015094, - -90.8154825702002, - -91.27582657149121 + -17.66498742329877, + -45.65536628701666, + -94.04562308108473, + -92.24565830688235 ], - "timestamp": 7.614887934937247 + "timestamp": 7.814969336750596 }, { - "x": 13.277347449903122, - "y": 2.2478394917559394, - "heading": 2.3724726135624645, - "angularVelocity": 4.3902451123681105, - "velocityX": 1.8106280275084354, - "velocityY": -1.032540837195327, + "x": 13.28353970410351, + "y": 2.2375422812207173, + "heading": 2.3954911150696994, + "angularVelocity": 3.972330169933441, + "velocityX": 1.8037055582489414, + "velocityY": -1.1086300454442182, "moduleForcesX": [ - 113.5653767711979, - 109.86203798468613, - 78.22814414337026, - 80.19548638705947 + 112.87425186361119, + 108.91840198905972, + 73.13263930631699, + 77.98189938274406 ], "moduleForcesY": [ - -2.651547534152781, - -31.01826752750063, - -81.44565214036037, - -80.99523654285561 + -6.223365306848344, + -32.97990859437656, + -85.29569693218718, + -82.63610290053495 ], - "timestamp": 7.649116738642334 + "timestamp": 7.850278883902064 }, { - "x": 13.347738923201241, - "y": 2.209798230712871, - "heading": 2.5114070565980735, - "angularVelocity": 4.058992076750882, - "velocityX": 2.056498202642214, - "velocityY": -1.111381553700728, + "x": 13.356027725868415, + "y": 2.1954929185575316, + "heading": 2.5227266765592224, + "angularVelocity": 3.603432265605644, + "velocityX": 2.05292980547018, + "velocityY": -1.1908779935020604, "moduleForcesX": [ - 112.19207649662098, - 113.16894691538694, - 90.80572403866687, - 91.84103538443951 + 111.12012886761015, + 112.86988205346621, + 86.88778676806567, + 90.03734763330992 ], "moduleForcesY": [ - 15.928502193312395, - -13.308928426826157, - -66.37795970134175, - -67.07336672078067 + 18.73827221813339, + -12.34828439071452, + -69.97685042739457, + -68.72148386204216 ], - "timestamp": 7.683345542347421 + "timestamp": 7.885588431053532 }, { - "x": 13.426870193585469, - "y": 2.171263792990934, - "heading": 2.6387846589283668, - "angularVelocity": 3.721357118635243, - "velocityX": 2.3118327787911346, - "velocityY": -1.1257897896174638, + "x": 13.437612450726574, + "y": 2.1532107657883417, + "heading": 2.6363795977141677, + "angularVelocity": 3.2187589568171635, + "velocityX": 2.310557099704127, + "velocityY": -1.1974708309852242, "moduleForcesX": [ - 102.63355880151254, - 112.95185304826374, - 104.73192313748237, - 103.39609116937378 + 97.20248405701679, + 111.86974536596307, + 103.03466347126968, + 102.32583288762171 ], "moduleForcesY": [ - 47.5032430073068, - 13.428590930969284, - -38.36223908730184, - -46.47925525510383 + 56.63338441321471, + 18.095398070103148, + -37.97062581902301, + -47.36373949630385 ], - "timestamp": 7.717574346052508 + "timestamp": 7.920897978205 }, { - "x": 13.514211992892422, - "y": 2.1355999035658586, - "heading": 2.7553046690686678, - "angularVelocity": 3.404150818247408, - "velocityX": 2.5517047005060185, - "velocityY": -1.041926259889313, + "x": 13.52742112558017, + "y": 2.114825451689113, + "heading": 2.7381791424535917, + "angularVelocity": 2.8830600489644733, + "velocityX": 2.5434671951001175, + "velocityY": -1.0871086489602033, "moduleForcesX": [ - 75.57886955728137, - 102.96113998905116, - 107.63125638242843, - 111.88275135917017 + 65.89792156241022, + 99.43709283642043, + 97.88415343385961, + 111.45218049666381 ], "moduleForcesY": [ - 84.19790217808342, - 48.1221710956847, - 21.89000669551172, - -15.04325013116753 + 91.46142231462393, + 54.22012108641089, + 43.67400047278733, + -11.821171765210279 ], - "timestamp": 7.751803149757595 + "timestamp": 7.956207525356468 }, { - "x": 13.608382873111731, - "y": 2.104027882799267, - "heading": 2.8572670405922005, - "angularVelocity": 2.978847066991696, - "velocityX": 2.7512173966310547, - "velocityY": -0.9223816595721166, + "x": 13.624109013301569, + "y": 2.082166798124268, + "heading": 2.8283496984778993, + "angularVelocity": 2.5537160144677564, + "velocityX": 2.7382930544713884, + "velocityY": -0.9249241692269164, "moduleForcesX": [ - 43.05897579116903, - 91.6113139764606, - 86.0284662891163, - 110.3813871494816 + 47.53439495990041, + 87.45802427935757, + 68.84720326442992, + 109.56743396568841 ], "moduleForcesY": [ - 103.90780630948846, - 66.29758480169258, - 44.88832766753545, - -16.716151028620235 + 101.06114313793714, + 70.39136956871369, + 77.82924862847176, + 11.616666431402512 ], - "timestamp": 7.7860319534626825 + "timestamp": 7.991517072507936 }, { - "x": 13.709392507782326, - "y": 2.0756519490371312, - "heading": 2.94318081891027, - "angularVelocity": 2.5099848378663028, - "velocityX": 2.951012706750959, - "velocityY": -0.8290074641980617, + "x": 13.72686903772777, + "y": 2.0553682797529484, + "heading": 2.9074090191549895, + "angularVelocity": 2.2390352483975082, + "velocityX": 2.91026174834215, + "velocityY": -0.758959560040714, "moduleForcesX": [ - 44.52299290536762, - 89.70386834247236, - 89.89738881433836, - 107.4248752374718 + 40.22780438179703, + 78.40481006980285, + 57.57268745635085, + 100.4325239168598 ], "moduleForcesY": [ - 99.54624373858208, - 64.70732173234636, - 5.23775664216174, - -14.542075390294418 + 98.4313106563725, + 73.82616586327329, + 71.5409821365442, + 23.18088284906935 ], - "timestamp": 7.82026075716777 + "timestamp": 8.026826619659403 }, { - "x": 13.816873348205831, - "y": 2.0493588330156762, - "heading": 3.0127614350084757, - "angularVelocity": 2.0328088792616716, - "velocityX": 3.140070022591264, - "velocityY": -0.7681576092481421, + "x": 13.833446542907254, + "y": 2.0337946936747766, + "heading": 2.978868034125111, + "angularVelocity": 2.023787353136609, + "velocityX": 3.018376438595989, + "velocityY": -0.6109845018859891, "moduleForcesX": [ - 51.259757063966916, - 87.90465515997464, - 76.04326290186623, - 98.52235017226005 + 27.71133529028477, + 53.321617344173696, + 30.59724389817127, + 62.288742887948686 ], "moduleForcesY": [ - 83.80305982182361, - 54.18397152510217, - -19.682023673725332, - -17.32808198285826 + 77.76542044513596, + 67.01241376251376, + 54.08148222741618, + 39.18109337921699 ], - "timestamp": 7.854489560872857 + "timestamp": 8.06213616681087 }, { - "x": 13.929707201661447, - "y": 2.0240992265198385, - "heading": 3.068040845669453, - "angularVelocity": 1.6149968645489765, - "velocityX": 3.2964591584264133, - "velocityY": -0.7379634623965822, + "x": 13.941082897090102, + "y": 2.014552811875832, + "heading": 3.046276067820356, + "angularVelocity": 1.909059705752796, + "velocityX": 3.0483640506949308, + "velocityY": -0.5449484162575098, "moduleForcesX": [ - 47.295717118224054, - 78.04506650685518, - 52.74429299675803, - 81.43393391647136 + 6.338411935153288, + 18.630960550653445, + 5.06353490915197, + 18.20673219295047 ], "moduleForcesY": [ - 57.972821530832974, - 39.43293491124601, - -26.72428249075782, - -20.575978623147435 + 35.187167487602544, + 33.453819907714234, + 19.61232716700604, + 17.975782973141456 ], - "timestamp": 7.888718364577944 + "timestamp": 8.097445713962337 }, { - "x": 14.047884577428986, - "y": 2.0018097256387324, - "heading": 3.1110017017202476, - "angularVelocity": 1.2551083123132851, - "velocityX": 3.4525710213465004, - "velocityY": -0.6511913496333745, + "x": 14.05314484024913, + "y": 1.9975368200863013, + "heading": 3.1018857561383033, + "angularVelocity": 1.5749193293076669, + "velocityX": 3.173700944911924, + "velocityY": -0.4819090915135053, "moduleForcesX": [ - 40.41850941273932, - 72.26596436397179, - 60.165986562380006, - 86.20843132854377 + 32.38825659623406, + 61.429438389035255, + 39.21145043820505, + 68.59433110232229 ], "moduleForcesY": [ - 74.57460703229934, - 57.34619153849231, - 8.435378772880814, - 3.6372831123246727 + 56.694726366304984, + 45.459912121099414, + 0.48491739779044996, + -1.2312044805406857 ], - "timestamp": 7.922947168283031 + "timestamp": 8.132755261113804 }, { "x": 14.171788215637209, "y": 1.984554409980774, "heading": 3.141592653589793, - "angularVelocity": 0.8937195741082631, - "velocityX": 3.619864698625444, - "velocityY": -0.5041168194664397, + "angularVelocity": 1.124537148017186, + "velocityX": 3.360093373022707, + "velocityY": -0.36767421711301757, "moduleForcesX": [ - 31.013647911651436, - 72.0282862596618, - 73.76190608414021, - 100.81064597402093 + 36.55913016223622, + 77.99345741140219, + 82.65797442708791, + 102.63003632076331 ], "moduleForcesY": [ - 99.50918080631918, - 78.69145966069404, - 44.945495220702036, - 20.9158085162814 + 95.80128612213797, + 71.69774957943521, + 11.330071286912512, + 4.935080412220265 ], - "timestamp": 7.957175971988118 + "timestamp": 8.168064808265271 }, { - "x": 14.465911674508094, - "y": 1.9753101696961057, - "heading": 3.1416390533992677, - "angularVelocity": 0.0006259678214476079, - "velocityX": 3.9679434650520284, - "velocityY": -0.12471165328920111, + "x": 14.454593476941811, + "y": 1.97796448772176, + "heading": 3.1416429856731254, + "angularVelocity": 0.0006710133266609316, + "velocityX": 3.7702810339357056, + "velocityY": -0.08785500946360723, "moduleForcesX": [ - 12.487145015519305, - 69.66097734031248, - 72.91874659974623, - 111.66054849173449 + 18.90105163422517, + 76.09798989324729, + 102.58200087249564, + 113.03447520897573 ], "moduleForcesY": [ - 112.68237698463481, - 89.98445533687041, - 72.22468092466957, - 15.840843626755948 + 111.7491169958333, + 84.68950673878763, + 12.795896757028622, + 2.6591962220306633 ], - "timestamp": 8.03130088366123 + "timestamp": 8.243073874899594 }, { - "x": 14.759680867707536, - "y": 1.9926744865605754, - "heading": 3.141639047674968, - "angularVelocity": -7.722504859421795e-8, - "velocityX": 3.9631641585618773, - "velocityY": 0.23425750496730716, + "x": 14.73702423123013, + "y": 1.9942197501048884, + "heading": 3.141642978594246, + "angularVelocity": -9.437364784490279e-8, + "velocityX": 3.7652882106265917, + "velocityY": 0.21671063396078938, "moduleForcesX": [ - -0.9389057010062756, - -0.8918110984524966, - -0.9393548495237268, - -0.8922375760075535 + -0.9672719038049086, + -0.9227533462325223, + -0.9676691170691535, + -0.9231321771109741 ], "moduleForcesY": [ - 68.78303298559197, - 68.78336233513552, - 68.75291633774563, - 68.75324593515026 + 57.67606024664952, + 57.67635291233172, + 57.6401521151496, + 57.640444913455646 ], - "timestamp": 8.105425795334341 + "timestamp": 8.318082941533916 }, { - "x": 15.026827970969723, - "y": 2.0099691813791303, - "heading": 3.1416259895563514, - "angularVelocity": -0.00017616369884637328, - "velocityX": 3.604012432963095, - "velocityY": 0.23331825196411826, + "x": 15.010642804361149, + "y": 2.011079932044252, + "heading": 3.141629628938074, + "angularVelocity": -0.0001779739006345567, + "velocityX": 3.64780666402562, + "velocityY": 0.22477525312446248, "moduleForcesX": [ - -68.80569709908896, - -68.80055108905634, - -68.80567698548732, - -68.80053097288132 + -22.244941885332093, + -22.236580273652777, + -22.24500082399066, + -22.23663920902384 ], "moduleForcesY": [ - -0.17267223974178206, - -0.17268609942239904, - -0.18718088491331014, - -0.1871959394377115 + 1.5327560088699677, + 1.5328008081495923, + 1.5206747766652815, + 1.5207191865207244 ], - "timestamp": 8.179550707007452 + "timestamp": 8.393092008168239 }, { - "x": 15.249536975116508, - "y": 2.0243970355953347, - "heading": 3.141614954022603, - "angularVelocity": -0.00014887752982443867, - "velocityX": 3.0045095382902, - "velocityY": 0.1946424473303505, + "x": 15.238746449573442, + "y": 2.025140105667011, + "heading": 3.141617683794715, + "angularVelocity": -0.0001592493267130903, + "velocityX": 3.0410143126340383, + "velocityY": 0.18744632154013266, "moduleForcesX": [ - -114.84736831647434, - -114.84738407657306, - -114.84755033754627, - -114.84756609099593 + -114.87365016225687, + -114.8736602533315, + -114.87376789982473, + -114.87377798798217 ], "moduleForcesY": [ - -7.410652114275073, - -7.410516501125907, - -7.407821278678371, - -7.407685716920534 + -7.067858015952322, + -7.067770306332378, + -7.065937872922811, + -7.06585018696093 ], - "timestamp": 8.253675618680564 + "timestamp": 8.468101074802561 }, { - "x": 15.427734932644807, - "y": 2.035944875109631, - "heading": 3.1416060662035123, - "angularVelocity": -0.00011990326719874652, - "velocityX": 2.4040225277319003, - "velocityY": 0.15578891432912842, + "x": 15.42126048503754, + "y": 2.0363917821596837, + "heading": 3.141607829317923, + "angularVelocity": -0.0001313771419136315, + "velocityX": 2.433226323877269, + "velocityY": 0.15000421945692372, "moduleForcesX": [ - -115.03589170672049, - -115.03590480898394, - -115.03608605645235, - -115.03609915116974 + -115.06210747733799, + -115.06211903061897, + -115.06228342780778, + -115.06229497459297 ], "moduleForcesY": [ - -7.444793267880758, - -7.444648447596564, - -7.441784589248815, - -7.441639827013844 + -7.0897746850507195, + -7.0896435800698425, + -7.086913890620305, + -7.086782838153622 ], - "timestamp": 8.327800530353676 + "timestamp": 8.543110141436884 }, { - "x": 15.561397445196155, - "y": 2.0446082921325672, - "heading": 3.141599372332212, - "angularVelocity": -0.0000903052853512078, - "velocityX": 1.8032063652338357, - "velocityY": 0.11687591698101098, + "x": 15.55816017917051, + "y": 2.0448321500588196, + "heading": 3.141600301323743, + "angularVelocity": -0.0001003611232318043, + "velocityX": 1.8251086205401539, + "velocityY": 0.11252463572546204, "moduleForcesX": [ - -115.09894593189205, - -115.09895807541444, - -115.0991448304989, - -115.09915696612956 + -115.1245166883893, + -115.12452826743665, + -115.1247127410453, + -115.1247243120354 ], "moduleForcesY": [ - -7.456219470556481, - -7.4560712446453135, - -7.453145099192203, - -7.452996933892054 + -7.097039766327021, + -7.096893661739564, + -7.09385533338325, + -7.093709293863294 ], - "timestamp": 8.401925442026787 + "timestamp": 8.618119208071207 }, { - "x": 15.650512302084337, - "y": 2.0503850805660555, - "heading": 3.141594896520999, - "angularVelocity": -0.00006038201073843798, - "velocityX": 1.2022254715280745, - "velocityY": 0.07793315773480654, + "x": 15.649433203495256, + "y": 2.0504598078795278, + "heading": 3.141595218831146, + "angularVelocity": -0.00006775837675300562, + "velocityX": 1.216826557377529, + "velocityY": 0.07502636778758355, "moduleForcesX": [ - -115.13050274279995, - -115.13051439212589, - -115.13070401220862, - -115.13071565345946 + -115.15562710583616, + -115.1556386080867, + -115.15583332234816, + -115.1558448156885 ], "moduleForcesY": [ - -7.461939008917163, - -7.461789005484221, - -7.458830380578395, - -7.4586804391143025 + -7.100662428852205, + -7.100508735512367, + -7.097314584597426, + -7.09716096317408 ], - "timestamp": 8.476050353699899 + "timestamp": 8.69312827470553 }, { - "x": 15.695072174072267, - "y": 2.0532739162445135, + "x": 15.695072174072266, + "y": 2.0532739162445086, "heading": 3.141592653589793, - "angularVelocity": -0.000030258804437930826, - "velocityX": 0.6011457009815155, - "velocityY": 0.0389725345128546, + "angularVelocity": -0.00003419908376354715, + "velocityX": 0.6084460535885152, + "velocityY": 0.03751690950502779, "moduleForcesX": [ - -115.14944411679562, - -115.14945546462413, - -115.14964684268682, - -115.14965818232656 + -115.17426017282052, + -115.1742715999137, + -115.1744725223164, + -115.1744839399641 ], "moduleForcesY": [ - -7.465372303464892, - -7.465221209099038, - -7.462242621788976, - -7.462091590233925 + -7.1028324617840966, + -7.102674189928448, + -7.099386084718839, + -7.099227889075033 ], - "timestamp": 8.55017526537301 + "timestamp": 8.768137341339852 }, { "x": 15.695072174072266, "y": 2.053273916244507, "heading": 3.141592653589793, - "angularVelocity": -9.292016747356084e-24, - "velocityX": -1.793915534938115e-21, - "velocityY": 6.2893253710272155e-21, + "angularVelocity": 7.360266802879611e-18, + "velocityX": -3.548120676165313e-17, + "velocityY": 1.645505940598732e-17, "moduleForcesX": [ - -115.16207409488239, - -115.16208523948659, - -115.16227780816574, - -115.16228894450374 + -115.1866675847214, + -115.18667894938694, + -115.18688403868423, + -115.18689539353758 ], "moduleForcesY": [ - -7.467661670085714, - -7.467509839682893, - -7.464517710638041, - -7.46436594362026 + -7.104277561224014, + -7.104116229492547, + -7.100765271069564, + -7.100604018492855 ], - "timestamp": 8.624300177046122 + "timestamp": 8.843146407974174 }, { - "x": 15.683032734310219, - "y": 2.065243087486579, - "heading": 3.115114997508429, - "angularVelocity": -0.5490817512048347, - "velocityX": -0.2496684996494882, - "velocityY": 0.24821130261198696, + "x": 15.682503427057059, + "y": 2.0646337327221738, + "heading": 3.1105221295886483, + "angularVelocity": -0.6347005775094131, + "velocityX": -0.256751092735796, + "velocityY": 0.2320553744418617, "moduleForcesX": [ - -71.19396438514681, - -16.351962141394477, - -113.73960028992641, - -92.80128040966147 + -70.5113246528861, + -10.018801848294446, + -114.81418680640073, + -102.56695754289538 ], "moduleForcesY": [ - 90.82485498148873, - 114.2197124413682, - 19.306054425681616, - 68.01973967114493 + 91.35804066484329, + 114.95032459741512, + 11.291141101368888, + 51.657036115035055 ], - "timestamp": 8.672521878137562 + "timestamp": 8.89209944993148 }, { - "x": 15.658925173391546, - "y": 2.0892962989602575, - "heading": 3.062358403873359, - "angularVelocity": -1.0940425667487261, - "velocityX": -0.49993178119037096, - "velocityY": 0.498804706786825, + "x": 15.65742036306147, + "y": 2.0876131196932546, + "heading": 3.0485249865888644, + "angularVelocity": -1.2664615010820823, + "velocityX": -0.5123903028885073, + "velocityY": 0.46941693602952456, "moduleForcesX": [ - -69.20082557973149, - -16.95272733429739, - -112.51565970212599, - -96.11819363500827 + -67.98037553477958, + -10.477656621264348, + -113.74547934312902, + -104.41762909388488 ], "moduleForcesY": [ - 92.3390007447845, - 114.1166649077064, - 25.431491565284002, - 63.28910350060903 + 93.24160102529723, + 114.89176486973722, + 19.194965643610416, + 48.08504142954779 ], - "timestamp": 8.720743579229003 + "timestamp": 8.941052491888787 }, { - "x": 15.62279726830929, - "y": 2.12560868155957, - "heading": 2.9832806496410678, - "angularVelocity": -1.639878984823432, - "velocityX": -0.7492042848872155, - "velocityY": 0.7530298968602243, + "x": 15.619984364865571, + "y": 2.122583149169414, + "heading": 2.9555670776733143, + "angularVelocity": -1.898919968990331, + "velocityX": -0.7647328275973524, + "velocityY": 0.7143586604192456, "moduleForcesX": [ - -66.36796972826156, - -17.450975110192893, - -110.621364173897, - -99.18005096251872 + -64.39521228894338, + -10.835990160847423, + -111.74412944489666, + -105.82062634096789 ], "moduleForcesY": [ - 94.37769509418551, - 114.01956856414778, - 32.64856908645184, - 58.408341771039105 + 95.73186682963218, + 114.83217133102714, + 28.557801462027836, + 45.08688416388965 ], - "timestamp": 8.768965280320444 + "timestamp": 8.990005533846093 }, { - "x": 15.574792792817318, - "y": 2.1745030635707616, - "heading": 2.878098250144675, - "angularVelocity": -2.181225405071048, - "velocityX": -0.9954952729880231, - "velocityY": 1.013949755079664, + "x": 15.570467933857678, + "y": 2.170168664476953, + "heading": 2.8324199256452296, + "angularVelocity": -2.5156179698799113, + "velocityX": -1.0115087648950551, + "velocityY": 0.9720645215752571, "moduleForcesX": [ - -62.904518048583384, - -18.765520932194924, - -107.7608463249948, - -100.67752020321787 + -60.10508416922476, + -12.632263453369584, + -108.31270835066015, + -105.28692632471801 ], "moduleForcesY": [ - 96.69530558377407, - 113.77796058506848, - 41.059685679799614, - 55.80693345276965 + 98.45078742590746, + 114.60669150976062, + 39.55592248262243, + 46.40569830412261 ], - "timestamp": 8.817186981411885 + "timestamp": 9.038958575803399 }, { - "x": 15.515115418351767, - "y": 2.2365113766993776, - "heading": 2.748238313390357, - "angularVelocity": -2.6929770998345632, - "velocityX": -1.2375626142343545, - "velocityY": 1.2859005743292333, + "x": 15.509173235477315, + "y": 2.231318730757613, + "heading": 2.6823266470561213, + "angularVelocity": -3.0660664299475155, + "velocityX": -1.2521121452208077, + "velocityY": 1.249157638351185, "moduleForcesX": [ - -59.32922192701663, - -22.65425748350358, - -103.41216352884263, - -99.73769034374713 + -56.107596300781445, + -19.19352006993177, + -102.46843648837859, + -101.40533999140591 ], "moduleForcesY": [ - 98.89044870030654, - 113.0169064497809, - 50.96198665871155, - 57.464013291731035 + 100.7295111846094, + 113.62114180098361, + 52.787569948269265, + 54.3761343490552 ], - "timestamp": 8.865408682503325 + "timestamp": 9.087911617760705 }, { - "x": 15.443945120311788, - "y": 2.312397535168875, - "heading": 2.598049453482882, - "angularVelocity": -3.1145491865307253, - "velocityX": -1.475897706408575, - "velocityY": 1.5736931039740272, + "x": 15.43629756865313, + "y": 2.3072905794447975, + "heading": 2.5143967135906133, + "angularVelocity": -3.430428973381599, + "velocityX": -1.4886851543897108, + "velocityY": 1.5519331516069275, "moduleForcesX": [ - -57.02616538718774, - -32.46022038133978, - -96.42189325761598, - -94.82880396936186 + -55.566033052317195, + -37.364595107963666, + -91.32795604295461, + -90.23982224737182 ], "moduleForcesY": [ - 100.1682414386154, - 110.51663143062801, - 63.10043038238431, - 65.20814728614427 + 100.91772810006313, + 108.8790331542822, + 70.17696973257495, + 71.3402088109634 ], - "timestamp": 8.913630383594766 + "timestamp": 9.136864659718011 }, { - "x": 15.361397570597198, - "y": 2.4030627345914812, - "heading": 2.4379497025502035, - "angularVelocity": -3.3200767975623116, - "velocityX": -1.711834046626805, - "velocityY": 1.8801742238557955, + "x": 15.352292498894688, + "y": 2.3990896446839507, + "heading": 2.351450276494965, + "angularVelocity": -3.328627406602441, + "velocityX": -1.7160337008704416, + "velocityY": 1.8752474120484843, "moduleForcesX": [ - -60.19075395749284, - -52.99761897342073, - -83.00503571063983, - -81.71816250502042 + -71.99046256530353, + -72.9535224518983, + -58.21609003135491, + -60.635080354255095 ], "moduleForcesY": [ - 98.14890485863737, - 102.13208160331287, - 79.7649281328897, - 80.96099716076799 + 89.5505221976233, + 88.84114044999198, + 99.07653572080291, + 97.67708800954779 ], - "timestamp": 8.961852084686207 + "timestamp": 9.185817701675317 }, { - "x": 15.268296814292313, - "y": 2.508757545140913, - "heading": 2.2929332529509288, - "angularVelocity": -3.007286062436612, - "velocityX": -1.9306817096382098, - "velocityY": 2.1918515555684537, + "x": 15.260507627409444, + "y": 2.505421301762789, + "heading": 2.227820518874649, + "angularVelocity": -2.5254765113093023, + "velocityX": -1.8749574656677745, + "velocityY": 2.17211541550255, "moduleForcesX": [ - -85.6509418331789, - -83.21974573343564, - -39.29014814005921, - -49.62182640039944 + -103.96409482483048, + -88.63793057016247, + 27.03297066939857, + -18.83203285938997 ], "moduleForcesY": [ - 76.33230295247037, - 79.26870386093083, - 107.83989683014454, - 103.68667351103075 + 46.94680786578636, + 72.95986689454536, + 111.23995258444597, + 113.31276031147173 ], - "timestamp": 9.010073785777648 + "timestamp": 9.234770743632623 }, { - "x": 15.167273163864417, - "y": 2.6272614661882616, - "heading": 2.192483841142394, - "angularVelocity": -2.0830748301072206, - "velocityX": -2.094983132932844, - "velocityY": 2.457481141584662, + "x": 15.160614493792021, + "y": 2.625256965891475, + "heading": 2.148185511483945, + "angularVelocity": -1.6267632042183744, + "velocityX": -2.040590934152655, + "velocityY": 2.447971757052899, "moduleForcesX": [ - -111.50990385741927, - -93.77065830212739, - 31.47024486109391, - -19.72183059871059 + -109.76906836848089, + -91.60388970860063, + 28.057909186627626, + -18.87138570625826 ], "moduleForcesY": [ - 23.807930537003042, - 66.15966523066265, - 109.83338652042386, - 113.0865344229725 + 28.563607965062683, + 68.5617497423252, + 110.07521153624224, + 112.87874340021123 ], - "timestamp": 9.058295486869088 + "timestamp": 9.28372378558993 }, { - "x": 15.057713599974441, - "y": 2.758409518264657, - "heading": 2.1346911830057307, - "angularVelocity": -1.19847821268423, - "velocityX": -2.271997076217241, - "velocityY": 2.7196894574022785, + "x": 15.051627946447192, + "y": 2.757792536125906, + "heading": 2.111350366896993, + "angularVelocity": -0.7524587464672408, + "velocityX": -2.226348823013889, + "velocityY": 2.707402133469893, "moduleForcesX": [ - -111.33690202203812, - -94.29329121436452, - 20.64874218877548, - -23.524890313415185 + -110.18950347500598, + -94.4259270542439, + 14.699834174267496, + -25.62143661919158 ], "moduleForcesY": [ - 21.14398791701492, - 64.60956935693724, - 111.26982412256345, - 111.83418988380888 + 18.184454461784757, + 62.64193597534585, + 109.9317151220563, + 110.2619692224848 ], - "timestamp": 9.10651718796053 + "timestamp": 9.332676827547235 }, { - "x": 14.939123021885464, - "y": 2.9015305147589396, - "heading": 2.118515084109538, - "angularVelocity": -0.33545268064100403, - "velocityX": -2.459278196430613, - "velocityY": 2.9679790064412654, + "x": 14.932668002427238, + "y": 2.8984574184284, + "heading": 2.110069243770664, + "angularVelocity": -0.02617044978437293, + "velocityX": -2.430082774514228, + "velocityY": 2.8734656045941884, "moduleForcesX": [ - -109.90734646465863, - -95.44964108875479, - 12.323649647426928, - -27.56680498190866 + -92.36401865218923, + -91.86525255334118, + -13.775378324438481, + -38.39021742122913 ], "moduleForcesY": [ - 14.22484679740834, - 60.09889909493547, - 108.94658536069632, - 109.19219744802825 + -7.300594232715907, + 39.18020348444654, + 72.06842144476734, + 88.73734095010511 ], - "timestamp": 9.15473888905197 + "timestamp": 9.381629869504541 }, { - "x": 14.831414608923223, - "y": 3.042823929898297, - "heading": 2.079454334080419, - "angularVelocity": -0.810024307418132, - "velocityX": -2.2336087388953505, - "velocityY": 2.9300794443445275, + "x": 14.823742433714235, + "y": 3.0397405651206304, + "heading": 2.0918846184637117, + "angularVelocity": -0.37147079282243645, + "velocityX": -2.2251031673879456, + "velocityY": 2.886095348476168, "moduleForcesX": [ - 78.58895661845102, - 86.9590857830952, - 44.49000954099232, - 55.78006427224323 + 66.0958843630111, + 75.77307715908528, + 41.70517572547554, + 54.2660783742387 ], "moduleForcesY": [ - 25.485604518307493, - -12.094864031659714, - -7.044135345916485, - -50.98884566344755 + 27.97723606877112, + 0.7831305877592326, + 9.942344895823817, + -24.048273238894506 ], - "timestamp": 9.20296059014341 + "timestamp": 9.430582911461848 }, { - "x": 14.733793356735978, - "y": 3.1721894754099615, - "heading": 2.0031780174103724, - "angularVelocity": -1.5817840296717673, - "velocityX": -2.024425724885401, - "velocityY": 2.682724636079386, + "x": 14.72599195439228, + "y": 3.1702342553440688, + "heading": 2.0336869133387605, + "angularVelocity": -1.1888475730620756, + "velocityX": -1.9968213498878276, + "velocityY": 2.665691140060036, "moduleForcesX": [ - 111.37255677304942, - 95.99744403653128, - 7.645693964257517, - 31.382888958151483 + 111.27282203862381, + 101.22591211394963, + 14.318118907425358, + 38.061187531246006 ], "moduleForcesY": [ - -13.253824008375226, - -60.24311649694943, - -109.35760318563327, - -108.50694531086866 + 4.4785198846546805, + -49.58576299828389, + -105.25159638909281, + -105.37871989926775 ], - "timestamp": 9.251182291234851 + "timestamp": 9.479535953419154 }, { - "x": 14.645878240653719, - "y": 3.288248837696076, - "heading": 1.8939909192803934, - "angularVelocity": -2.2642730484130293, - "velocityX": -1.8231442295150284, - "velocityY": 2.4067869788756644, + "x": 14.638748196164602, + "y": 3.2878829961076765, + "heading": 1.9394014366639316, + "angularVelocity": -1.926039177648179, + "velocityX": -1.78219278598079, + "velocityY": 2.4032978556606244, "moduleForcesX": [ - 109.70942329970316, - 89.71754326673916, - 12.019633647312192, - 25.644712508023197 + 111.93956922977851, + 94.27122591142299, + 13.09747450250458, + 29.72774244507937 ], "moduleForcesY": [ - -30.590752966210594, - -71.02373862357852, - -112.0983625887034, - -111.31663378024953 + -18.973143563334187, + -64.43873357870562, + -111.06555752369113, + -109.98053661348601 ], - "timestamp": 9.299403992326292 + "timestamp": 9.52848899537646 }, { - "x": 14.567227788945956, - "y": 3.3902029354711787, - "heading": 1.7550450964686277, - "angularVelocity": -2.881396128027259, - "velocityX": -1.631017776801797, - "velocityY": 2.1142783325244223, + "x": 14.561389703577776, + "y": 3.3914450724763703, + "heading": 1.8130509208960486, + "angularVelocity": -2.5810554506107266, + "velocityX": -1.5802591523046463, + "velocityY": 2.115539141839674, "moduleForcesX": [ - 107.14229823866029, - 83.56953629253546, - 16.512015162582642, - 19.08365462270342 + 108.89813742754394, + 86.94044286405637, + 15.945707139726329, + 22.521649867339463 ], "moduleForcesY": [ - -40.388808530169484, - -78.71040904165837, - -112.40665921116027, - -113.04273071952844 + -34.72614750544731, + -74.77427759019352, + -112.13240268428117, + -112.25694546017392 ], - "timestamp": 9.347625693417733 + "timestamp": 9.577442037333766 }, { - "x": 14.49719619180086, - "y": 3.4776074509889465, - "heading": 1.5874267428579882, - "angularVelocity": -3.475994206276373, - "velocityX": -1.4522838381893535, - "velocityY": 1.812555624116751, + "x": 14.493202146414575, + "y": 3.4801843218782924, + "heading": 1.6568085525977703, + "angularVelocity": -3.1916784340907887, + "velocityX": -1.392917670422911, + "velocityY": 1.8127422902937624, "moduleForcesX": [ - 106.14720313378764, - 77.64221219396602, - 18.40490708195517, - 8.33801716568237 + 106.45822211595201, + 80.10960219573016, + 17.65679408253046, + 13.149875929102251 ], "moduleForcesY": [ - -43.736432029436294, - -84.81783816234795, - -112.32150159790282, - -114.52616360787027 + -42.63111245871026, + -82.37686544045971, + -112.34316617829377, + -113.98755478600889 ], - "timestamp": 9.395847394509174 + "timestamp": 9.626395079291072 }, { - "x": 14.436617373792393, - "y": 3.5501556245447876, - "heading": 1.3983005141839007, - "angularVelocity": -3.9220148686885814, - "velocityX": -1.2562563459466622, - "velocityY": 1.5044714705993272, + "x": 14.433222849775504, + "y": 3.5537494938016434, + "heading": 1.4705951628332716, + "angularVelocity": -3.803918659986439, + "velocityX": -1.2252414608224262, + "velocityY": 1.502770185148768, "moduleForcesX": [ - 101.15910205833607, - 70.91594042910839, - 49.12014885114002, - 9.707383087632545 + 106.15263304237581, + 73.3443765179212, + 17.473283255487672, + -2.41364200971868 ], "moduleForcesY": [ - -54.64864966949359, - -90.63705631390815, - -103.10697098452282, - -114.50246275576043 + -43.97011401143013, + -88.63358939438082, + -112.21755339050702, + -114.84297204095257 ], - "timestamp": 9.444069095600614 + "timestamp": 9.675348121248378 }, { - "x": 14.387392259795076, - "y": 3.6078010779952034, - "heading": 1.2154463058080842, - "angularVelocity": -3.7919485260189636, - "velocityX": -1.0208083266074082, - "velocityY": 1.1954255479520526, + "x": 14.384281474280659, + "y": 3.6117067421179105, + "heading": 1.27402659735858, + "angularVelocity": -4.015451494232434, + "velocityX": -0.9997616805356296, + "velocityY": 1.1839355841171237, "moduleForcesX": [ - 54.314455652099966, - 71.44382936842365, - 69.05779006643577, - 82.5202984339565 + 86.3744676805752, + 67.41409192129979, + 66.76192995299246, + 41.0763147581172 ], "moduleForcesY": [ - -101.45774094468416, - -90.14981383751505, - -92.14633676825393, - -80.27412481999961 + -75.94459361481906, + -93.25513893468546, + -93.38866768134871, + -107.35908537611219 ], - "timestamp": 9.492290796692055 + "timestamp": 9.724301163205684 }, { - "x": 14.349211618513907, - "y": 3.651400600452789, - "heading": 1.0506438733831094, - "angularVelocity": -3.4175988962410613, - "velocityX": -0.7917730071108346, - "velocityY": 0.9041473334777183, + "x": 14.346752541400093, + "y": 3.654620410688194, + "heading": 1.0910815045741515, + "angularVelocity": -3.737154739923585, + "velocityX": -0.7666312731561086, + "velocityY": 0.8766292521816487, "moduleForcesX": [ - 18.55584251040697, - 90.7960685839383, - 63.853520232036196, - 96.57736445012137 + 32.49392465624227, + 80.55920555280773, + 65.3512771133556, + 92.09950834270302 ], "moduleForcesY": [ - -113.64992224377941, - -70.53849669010278, - -95.98904481306886, - -62.92180680397959 + -110.42446436365066, + -82.02909062557538, + -94.9088970754182, + -69.20864919843588 ], - "timestamp": 9.540512497783496 + "timestamp": 9.77325420516299 }, { - "x": 14.32169543229896, - "y": 3.682483763115444, - "heading": 0.9151656588315976, - "angularVelocity": -2.8094864238532335, - "velocityX": -0.5706183231232216, - "velocityY": 0.6445886801818389, + "x": 14.320188407757405, + "y": 3.6843861833792286, + "heading": 0.9370514938584996, + "angularVelocity": -3.146484969207519, + "velocityX": -0.5426452081556838, + "velocityY": 0.6080474573529125, "moduleForcesX": [ - -6.332456186499789, - 110.7185031174238, - 57.28231604872361, - 98.83176021702745 + -5.385270543258571, + 108.75425048231756, + 57.78740711133415, + 98.73724209082938 ], "moduleForcesY": [ - -115.02092054012307, - -31.162381403626863, - -100.11057776943015, - -59.44262986998 + -115.0420177801382, + -37.2349168657311, + -99.80030517652864, + -59.5613318859354 ], - "timestamp": 9.588734198874937 + "timestamp": 9.822207247120296 }, { - "x": 14.304035283172022, - "y": 3.7023940350495996, - "heading": 0.8190216834517414, - "angularVelocity": -1.9937906213126355, - "velocityX": -0.3662282484280051, - "velocityY": 0.4128902855666648, + "x": 14.303469101351862, + "y": 3.703097894493808, + "heading": 0.8266449121513226, + "angularVelocity": -2.2553569153774875, + "velocityX": -0.3415376396905139, + "velocityY": 0.3822379645701155, "moduleForcesX": [ - -24.884078394615464, - 115.10010865685537, - 51.72593444923851, - 98.81097200345768 + -31.6917140615662, + 114.57748285872601, + 51.062756198166554, + 99.39891925787309 ], "moduleForcesY": [ - -112.50306629791396, - 2.2494262109702245, - -103.12309638155044, - -59.542919825583255 + -110.7628666047164, + 10.74305716248206, + -103.44652639596045, + -58.54303770810003 ], - "timestamp": 9.636955899966377 + "timestamp": 9.871160289077602 }, { "x": 14.295448303222656, "y": 3.712002992630005, - "heading": 0.7688022564378523, - "angularVelocity": -1.0414279437936045, - "velocityX": -0.17807293718407954, - "velocityY": 0.19926625073189186, + "heading": 0.7688022564378524, + "angularVelocity": -1.1815947160937619, + "velocityX": -0.1638467765895081, + "velocityY": 0.18191102693290262, "moduleForcesX": [ - -38.582698455325584, - 113.1869774052545, - 48.251824048408935, - 98.7737574928677 + -49.71533486003576, + 109.59554076263647, + 46.816698420140504, + 99.47986509579346 ], "moduleForcesY": [ - -108.59855539761742, - 21.4261400418289, - -104.81345448783509, - -59.64383290029868 + -103.9680438500685, + 35.442271926549225, + -105.4606645383995, + -58.45523278739201 ], - "timestamp": 9.685177601057818 + "timestamp": 9.920113331034909 }, { "x": 14.295448303222656, "y": 3.712002992630005, "heading": 0.7688022564378523, - "angularVelocity": 5.898913315314164e-24, - "velocityX": 1.6143876828462686e-23, - "velocityY": -7.539437488938966e-24, + "angularVelocity": -5.838715201828975e-18, + "velocityX": 3.298801988973473e-17, + "velocityY": -5.0573065053666e-17, "moduleForcesX": [ - -47.48175193227343, - 110.17194913173417, - 47.45736232942377, - 99.60618042375738 + -60.020043156793854, + 103.80869334005449, + 45.863956482431625, + 100.46070860174449 ], "moduleForcesY": [ - -105.04769902960695, - 33.78870027617788, - -105.1895227540307, - -58.26901613919841 + -98.42521384623716, + 50.03039404179523, + -105.89459694294194, + -56.78405771323294 ], - "timestamp": 9.733399302149259 + "timestamp": 9.969066372992215 } ], "trajectoryWaypoints": [ @@ -6861,10 +6945,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 24 + "controlIntervalCount": 25 }, { - "timestamp": 2.38711147698668, + "timestamp": 2.4652464028225953, "isStopPoint": true, "x": 8.7, "y": 0.7302065491676331, @@ -6872,10 +6956,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 20 + "controlIntervalCount": 21 }, { - "timestamp": 4.011219951795511, + "timestamp": 4.124495592990685, "isStopPoint": true, "x": 12.89710521697998, "y": 2.305847644805908, @@ -6886,7 +6970,7 @@ "controlIntervalCount": 17 }, { - "timestamp": 4.913702934227492, + "timestamp": 5.052789787594331, "isStopPoint": false, "x": 10.358807563781738, "y": 1.6887441873550415, @@ -6897,7 +6981,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 5.638101156412266, + "timestamp": 5.788908447735172, "isStopPoint": true, "x": 8.7, "y": 2.248577356338501, @@ -6908,7 +6992,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 6.307552888523836, + "timestamp": 6.469073909526503, "isStopPoint": false, "x": 10.424600601196289, "y": 1.7113943099975586, @@ -6919,7 +7003,7 @@ "controlIntervalCount": 17 }, { - "timestamp": 7.272599897886376, + "timestamp": 7.4618738652359164, "isStopPoint": true, "x": 12.967412948608398, "y": 2.415215253829956, @@ -6930,7 +7014,7 @@ "controlIntervalCount": 20 }, { - "timestamp": 7.957175971988118, + "timestamp": 8.168064808265271, "isStopPoint": false, "x": 14.171788215637207, "y": 1.984554409980774, @@ -6941,7 +7025,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 8.624300177046122, + "timestamp": 8.843146407974174, "isStopPoint": true, "x": 15.695072174072266, "y": 2.053273916244507, @@ -6952,7 +7036,7 @@ "controlIntervalCount": 23 }, { - "timestamp": 9.733399302149259, + "timestamp": 9.969066372992215, "isStopPoint": true, "x": 14.295448303222656, "y": 3.712002992630005, @@ -7029,7 +7113,7 @@ "name": "intake", "target": 2, "trajTargetIndex": 2, - "targetTimestamp": 4.011219951795511, + "targetTimestamp": 4.124495592990685, "offset": 0.4, "command": { "type": "named", @@ -7042,7 +7126,7 @@ "name": "intake", "target": 6, "trajTargetIndex": 6, - "targetTimestamp": 7.272599897886376, + "targetTimestamp": 7.4618738652359164, "offset": 0.5, "command": { "type": "named", @@ -7087,11 +7171,11 @@ "trajectory": [ { "x": 8.7, - "y": 7.477, - "heading": 4.817296379376439e-28, - "angularVelocity": 3.9893086811900706e-30, - "velocityX": 1.8654024236197165e-16, - "velocityY": 9.408879013592363e-17, + "y": 7.4769999999999985, + "heading": 4.3445481775720005e-28, + "angularVelocity": 3.5230479750879457e-28, + "velocityX": 6.245095163654619e-16, + "velocityY": -4.529551491696468e-16, "moduleForcesX": [ 0, 0, @@ -7107,361 +7191,361 @@ "timestamp": 0 }, { - "x": 8.751182179440617, - "y": 7.409711416685271, - "heading": 1.4146197750101355e-17, - "angularVelocity": 1.3870313406812334e-16, - "velocityX": 0.5018399951667601, - "velocityY": -0.6597628841614331, + "x": 8.750951934610828, + "y": 7.409336319308562, + "heading": 3.992684876067889e-18, + "angularVelocity": 3.9111388009155387e-17, + "velocityX": 0.49911336409082935, + "velocityY": -0.6628177625545835, "moduleForcesX": [ - 69.87246936993738, - 69.87246936993738, - 69.87246936993738, - 69.87246936993738 + 69.4275827769465, + 69.4275827769465, + 69.4275827769465, + 69.4275827769465 ], "moduleForcesY": [ - -91.8604781582405, - -91.8604781582405, - -91.8604781582405, - -91.8604781582405 + -92.19916433110537, + -92.19916433110537, + -92.19916433110537, + -92.19916433110537 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654462 }, { - "x": 8.853503148481877, - "y": 7.2751175571346485, - "heading": 2.7113703429716686e-17, - "angularVelocity": 1.2714607404735355e-16, - "velocityX": 1.0032545540329008, - "velocityY": -1.3196894419992256, + "x": 8.852823910850104, + "y": 7.274000743571707, + "heading": 2.053277549929798e-17, + "angularVelocity": 1.6202290689901917e-16, + "velocityX": 0.9979143119049112, + "velocityY": -1.3257159910201253, "moduleForcesX": [ - 69.81323478288947, - 69.81323478288947, - 69.81323478288947, - 69.81323478288947 + 69.38412510090774, + 69.38412510090774, + 69.38412510090775, + 69.38412510090774 ], "moduleForcesY": [ - -91.883266863891, - -91.88326686389098, - -91.883266863891, - -91.883266863891 + -92.21035728659838, + -92.21035728659838, + -92.2103572865984, + -92.21035728659838 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308924 }, { - "x": 9.006876144344536, - "y": 7.073185098303806, - "heading": 3.842376648398692e-17, - "angularVelocity": 1.1089488283065315e-16, - "velocityX": 1.5038184060088147, - "velocityY": -1.979942731456863, + "x": 9.005552097282301, + "y": 7.070976830585038, + "heading": 4.215359286305146e-17, + "angularVelocity": 2.1179252545200335e-16, + "velocityX": 1.496089981744527, + "velocityY": -1.9887752835153973, "moduleForcesX": [ - 69.69478868116428, - 69.69478868116428, - 69.69478868116428, - 69.69478868116428 + 69.29714778996834, + 69.29714778996835, + 69.29714778996834, + 69.29714778996834 ], "moduleForcesY": [ - -91.92875854512398, - -91.928758545124, - -91.92875854512398, - -91.92875854512398 + -92.23276158792527, + -92.23276158792527, + -92.23276158792528, + -92.23276158792527 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596339 }, { - "x": 9.21104108323236, - "y": 6.803814589003354, - "heading": 4.611053735098279e-17, - "angularVelocity": 7.536857333985494e-17, - "velocityX": 2.0018321428384445, - "velocityY": -2.6411711373500313, + "x": 9.20894459843012, + "y": 6.8002150738261875, + "heading": 5.2284316721184506e-17, + "angularVelocity": 9.923817704056193e-17, + "velocityX": 1.992385887885889, + "velocityY": -2.652319530447977, "moduleForcesX": [ - 69.33972961030769, - 69.33972961030767, - 69.33972961030767, - 69.33972961030767 + 69.03566921838615, + 69.03566921838615, + 69.03566921838615, + 69.03566921838615 ], "moduleForcesY": [ - -92.06452650681611, - -92.06452650681611, - -92.06452650681611, - -92.06452650681611 + -92.3002196376723, + -92.3002196376723, + -92.3002196376723, + -92.3002196376723 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461785 }, { - "x": 9.400539962274733, - "y": 6.468344823148687, - "heading": 2.790579728570887e-17, - "angularVelocity": -1.7849703184325878e-16, - "velocityX": 1.858031791180241, - "velocityY": -3.2892727022381854, + "x": 9.40209604536311, + "y": 6.467543964285724, + "heading": 4.733122003509853e-17, + "angularVelocity": -4.851939120316224e-17, + "velocityX": 1.8920668899735733, + "velocityY": -3.2587692280322194, "moduleForcesX": [ - -20.021691701970234, - -20.021691701970177, - -20.02169170197022, - -20.021691701970177 + -13.954556287036088, + -13.954556287036109, + -13.95455628703609, + -13.95455628703611 ], "moduleForcesY": [ - -90.2368427738075, - -90.23684277380752, - -90.23684277380742, - -90.23684277380745 + -84.3582632906046, + -84.35826329060458, + -84.3582632906046, + -84.35826329060458 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327231 }, { - "x": 9.53831969085793, - "y": 6.199601477600119, - "heading": 2.1172734583229143e-17, - "angularVelocity": -6.601751582322013e-17, - "velocityX": 1.350926808546524, - "velocityY": -2.6350218123795117, + "x": 9.540809314016872, + "y": 6.199538718872531, + "heading": 4.158863630900275e-17, + "angularVelocity": -5.625297151552388e-17, + "velocityX": 1.358803089426544, + "velocityY": -2.625317383015389, "moduleForcesX": [ - -70.60552707551035, - -70.60552707551035, - -70.60552707551035, - -70.60552707551035 + -74.1779710140498, + -74.17797101404982, + -74.1779710140498, + -74.1779710140498 ], "moduleForcesY": [ - 91.09302905748787, - 91.09302905748787, - 91.09302905748787, - 91.09302905748787 + 88.11431143550172, + 88.11431143550172, + 88.11431143550173, + 88.11431143550172 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192677 }, { - "x": 9.624576863197959, - "y": 5.997836583842571, - "heading": 9.14804300397557e-18, - "angularVelocity": -1.1790181597877335e-16, - "velocityX": 0.845749427305614, - "velocityY": -1.9782997600863548, + "x": 9.627027003037252, + "y": 5.997942442570264, + "heading": 3.560709033457718e-17, + "angularVelocity": -5.859383146830961e-17, + "velocityX": 0.8445685358078194, + "velocityY": -1.9747904848335078, "moduleForcesX": [ - -70.33714219082879, - -70.3371421908288, - -70.33714219082879, - -70.3371421908288 + -71.53096792553181, + -71.53096792553181, + -71.53096792553181, + -71.53096792553181 ], "moduleForcesY": [ - 91.43709533984783, - 91.43709533984782, - 91.43709533984783, - 91.43709533984783 + 90.48948259361192, + 90.48948259361192, + 90.48948259361192, + 90.48948259361192 ], - "timestamp": 0.713923281394681 + "timestamp": 0.7145942544058123 }, { - "x": 9.659378524344477, - "y": 5.863134773678262, - "heading": -1.5665362979803489e-18, - "angularVelocity": -1.050561836527775e-16, - "velocityX": 0.3412294211072674, - "velocityY": -1.3207478950795897, + "x": 9.661274942863438, + "y": 5.863208583334526, + "heading": 2.4497234711099608e-17, + "angularVelocity": -1.088295682681964e-16, + "velocityX": 0.3354848955240913, + "velocityY": -1.3198217153806622, "moduleForcesX": [ - -70.24561417800408, - -70.24561417800409, - -70.24561417800408, - -70.24561417800408 + -70.81446644981119, + -70.81446644981119, + -70.81446644981118, + -70.81446644981119 ], "moduleForcesY": [ - 91.55263229179096, - 91.55263229179096, - 91.55263229179096, - 91.55263229179096 + 91.10735502004113, + 91.10735502004113, + 91.10735502004111, + 91.10735502004113 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923568 }, { - "x": 9.64275859736688, - "y": 5.79553856220569, - "heading": 1.2470484727373151e-18, - "angularVelocity": 2.7587148464171453e-17, - "velocityX": -0.162957970240335, - "velocityY": -0.6627791705906012, + "x": 9.643797948064972, + "y": 5.795545668140687, + "heading": 1.2659446947028772e-17, + "angularVelocity": -1.159602211971219e-16, + "velocityX": -0.17120059787259703, + "velocityY": -0.6628102639184235, "moduleForcesX": [ - -70.19930335943926, - -70.19930335943927, - -70.19930335943926, - -70.19930335943926 + -70.48087982705175, + -70.48087982705175, + -70.48087982705175, + -70.48087982705175 ], "moduleForcesY": [ - 91.61067270642354, - 91.61067270642354, - 91.61067270642354, - 91.61067270642354 + 91.39149582749977, + 91.39149582749977, + 91.39149582749977, + 91.39149582749977 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789014 }, { "x": 9.574737548828123, - "y": 5.795073509216309, - "heading": -1.5905884047918351e-27, - "angularVelocity": -1.2227265519428621e-17, - "velocityX": -0.6669446874477082, - "velocityY": -0.004559832982767996, + "y": 5.79507350921631, + "heading": 1.9381509071890707e-28, + "angularVelocity": -1.2400901378310827e-16, + "velocityX": -0.6764996943067104, + "velocityY": -0.004625159592674334, "moduleForcesX": [ - -70.1713629843234, - -70.1713629843234, - -70.1713629843234, - -70.1713629843234 + -70.28802947120099, + -70.28802947120099, + -70.28802947120099, + -70.28802947120099 ], "moduleForcesY": [ - 91.64556621358959, - 91.64556621358957, - 91.64556621358959, - 91.64556621358959 + 91.55475308965782, + 91.55475308965782, + 91.55475308965782, + 91.55475308965782 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654461 }, { - "x": 9.459299035454817, - "y": 5.7942842678434205, - "heading": -6.253986271630234e-18, - "angularVelocity": -7.356104585269783e-17, - "velocityX": -1.3578183260610612, - "velocityY": -0.009283265770469775, + "x": 9.458756473332102, + "y": 5.794280558401382, + "heading": -1.1520815948839546e-17, + "angularVelocity": -1.3571969972482983e-16, + "velocityX": -1.3663025836623566, + "velocityY": -0.009341271776624095, "moduleForcesX": [ - -115.39417560593395, - -115.39417560593395, - -115.39417560593395, - -115.39417560593395 + -115.39290145122217, + -115.39290145122217, + -115.39290145122217, + -115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823164, - -0.7889382400823163, - -0.7889382400823175, - -0.7889382400823175 + -0.7889295288162256, + -0.7889295288162256, + -0.7889295288162312, + -0.7889295288162312 ], - "timestamp": 1.1049080447488957 + "timestamp": 1.1057357504820584 }, { - "x": 9.285142559246436, - "y": 5.793093577731747, - "heading": -1.1414667665309964e-18, - "angularVelocity": 6.0134776000088e-17, - "velocityX": -2.0484745349524145, - "velocityY": -0.014005212013280458, + "x": 9.284239365862444, + "y": 5.7930874026904595, + "heading": -2.5150521647142958e-17, + "angularVelocity": -1.6056320382009621e-16, + "velocityX": -2.0558800115403746, + "velocityY": -0.014055842503386191, "moduleForcesX": [ - -115.35785908997497, - -115.35785908997497, - -115.35785908997497, - -115.35785908997497 + -115.35518538121136, + -115.35518538121136, + -115.35518538121136, + -115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570318, - -0.7886899477570318, - -0.7886899477570327, - -0.7886899477570326 + -0.7886716678821973, + -0.7886716678821973, + -0.7886716678822024, + -0.7886716678822024 ], - "timestamp": 1.18992568750539 + "timestamp": 1.1906225660986707 }, { - "x": 9.052325497079263, - "y": 5.791501831161153, - "heading": -2.2437742110440265e-18, - "angularVelocity": -1.2965642586103366e-17, - "velocityX": -2.7384558618495793, - "velocityY": -0.018722544156549614, + "x": 9.051247330249543, + "y": 5.791494459844215, + "heading": -2.5937310124731176e-17, + "angularVelocity": -9.268656092420328e-18, + "velocityX": -2.7447376123174685, + "velocityY": -0.018765491845484074, "moduleForcesX": [ - -115.24513594206775, - -115.24513594206775, - -115.24513594206775, - -115.24513594206775 + -115.23476991325884, + -115.23476991325884, + -115.23476991325884, + -115.23476991325884 ], "moduleForcesY": [ - -0.7879192710616144, - -0.7879192710616143, - -0.7879192710616153, - -0.7879192710616153 + -0.7878483995771357, + -0.7878483995771357, + -0.7878483995771398, + -0.7878483995771398 ], - "timestamp": 1.2749433302618844 + "timestamp": 1.275509381715283 }, { - "x": 8.87619592152223, - "y": 5.790297651169946, - "heading": 6.551099092183217e-19, - "angularVelocity": 3.409743994418627e-17, - "velocityX": -2.0716826513469324, - "velocityY": -0.014163883544211484, + "x": 8.875655323306212, + "y": 5.790293955154937, + "heading": -1.1972201714753373e-17, + "angularVelocity": 1.645143773982178e-16, + "velocityX": -2.06854274916434, + "velocityY": -0.014142416352397356, "moduleForcesX": [ - 111.36876650332536, - 111.36876650332536, - 111.36876650332536, - 111.36876650332536 + 113.11649807418004, + 113.11649807418004, + 113.11649807418004, + 113.11649807418004 ], "moduleForcesY": [ - 0.761416927534731, - 0.7614169275347311, - 0.7614169275347248, - 0.7614169275347247 + 0.7733659904957185, + 0.7733659904957183, + 0.77336599049571, + 0.7733659904957098 ], - "timestamp": 1.3599609730183788 + "timestamp": 1.3603961973318952 }, { - "x": 8.758737639980005, - "y": 5.78949460084755, - "heading": 6.774136913302295e-19, - "angularVelocity": 2.6237471918863595e-19, - "velocityX": -1.3815753734627951, - "velocityY": -0.009445690286856828, + "x": 8.758557276336354, + "y": 5.7894933677196665, + "heading": -3.7706027032273264e-18, + "angularVelocity": 9.66180165445428e-17, + "velocityX": -1.379460945958553, + "velocityY": -0.009431234161101608, "moduleForcesX": [ - 115.26617308908851, - 115.26617308908851, - 115.26617308908851, - 115.26617308908851 + 115.2722753646769, + 115.2722753646769, + 115.2722753646769, + 115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957773, - 0.7880630998957774, - 0.7880630998957836, - 0.7880630998957835 + 0.7881048205332163, + 0.7881048205332163, + 0.7881048205332253, + 0.7881048205332253 ], - "timestamp": 1.4449786157748732 + "timestamp": 1.4452830129485075 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 2.2434091657543482e-27, - "angularVelocity": -7.967902100915187e-18, - "velocityX": -0.6908876566743292, - "velocityY": -0.004723528627758741, + "heading": -8.769503931077745e-28, + "angularVelocity": 4.441916565205765e-17, + "velocityX": -0.6898276948077539, + "velocityY": -0.004716281776302161, "moduleForcesX": [ - 115.36312174237496, - 115.36312174237496, - 115.36312174237496, - 115.36312174237496 + 115.3645237146873, + 115.3645237146873, + 115.3645237146873, + 115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761424, - 0.7887259279761424, - 0.788725927976148, - 0.788725927976148 + 0.7887355131182234, + 0.7887355131182234, + 0.7887355131182325, + 0.7887355131182325 ], - "timestamp": 1.5299962585313676 + "timestamp": 1.5301698285651197 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 1.1144018963854978e-27, - "angularVelocity": -1.7179212145719729e-28, - "velocityX": -2.4191591991076064e-17, - "velocityY": -1.609731132934757e-18, + "heading": -4.232324308621776e-28, + "angularVelocity": 3.5913140303197327e-28, + "velocityX": -3.294645149439053e-16, + "velocityY": -1.8487293250685584e-18, "moduleForcesX": [ - 115.3965169929829, - 115.3965169929829, - 115.3965169929829, - 115.3965169929829 + 115.39705100341173, + 115.39705100341173, + 115.39705100341173, + 115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073995, - 0.7889542479073995, - 0.7889542479074042, - 0.7889542479074043 + 0.7889578988823763, + 0.7889578988823763, + 0.7889578988823851, + 0.7889578988823851 ], - "timestamp": 1.615013901287862 + "timestamp": 1.615056644181732 } ], "trajectoryWaypoints": [ @@ -7477,7 +7561,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 1.0198904019924013, + "timestamp": 1.0208489348654461, "isStopPoint": false, "x": 9.574737548828125, "y": 5.795073509216309, @@ -7488,7 +7572,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 1.615013901287862, + "timestamp": 1.615056644181732, "isStopPoint": true, "x": 8.7, "y": 5.789093017578125, @@ -7570,10 +7654,10 @@ { "x": 8.7, "y": 5.789093017578125, - "heading": -2.0455733052614176e-22, - "angularVelocity": -3.8646051503558115e-23, - "velocityX": -1.6361619392483338e-21, - "velocityY": 8.474609168336952e-22, + "heading": 7.247326847218455e-23, + "angularVelocity": 1.03987844992159e-23, + "velocityX": -2.83848661247132e-21, + "velocityY": 1.754450024355998e-22, "moduleForcesX": [ 0, 0, @@ -7589,760 +7673,760 @@ "timestamp": 0 }, { - "x": 8.735613015250742, - "y": 5.818963407451602, - "heading": -1.0502454961256607e-9, - "angularVelocity": -1.3886948104035371e-8, - "velocityX": 0.47089570623239124, - "velocityY": 0.39496342098173537, + "x": 8.738084296106212, + "y": 5.8198955678928925, + "heading": -7.933185096139342e-10, + "angularVelocity": -1.0218405471537252e-8, + "velocityX": 0.4905479640210178, + "velocityY": 0.3967548278015508, "moduleForcesX": [ - 88.41685134026662, - 88.41685080559071, - 88.41685048601633, - 88.41684995134041 + 89.72456276282517, + 89.72456239926017, + 89.72456216050942, + 89.72456179694441 ], "moduleForcesY": [ - 74.15956644197404, - 74.15956707853893, - 74.15956746147184, - 74.15956809803674 + 72.56915852264277, + 72.56915897147265, + 72.5691592680868, + 72.56915971691669 ], - "timestamp": 0.07562824374781552 + "timestamp": 0.07763623315044796 }, { - "x": 8.806834869518331, - "y": 5.87870068413291, - "heading": -3.1448393381201233e-9, - "angularVelocity": -2.769592070627396e-8, - "velocityX": 0.9417361919057632, - "velocityY": 0.7898805224209977, + "x": 8.814247376335548, + "y": 5.881496210421434, + "heading": -2.349086353373507e-9, + "angularVelocity": -2.0039197944402956e-8, + "velocityX": 0.9810249304824148, + "velocityY": 0.7934522326600846, "moduleForcesX": [ - 88.40648295141082, - 88.406482419705, - 88.40648210214698, - 88.40648157044113 + 89.71157680696294, + 89.71157645751236, + 89.71157622824228, + 89.71157587879172 ], "moduleForcesY": [ - 74.1508693445355, - 74.15086997738463, - 74.15087035828485, - 74.15087099113398 + 72.55865549873482, + 72.55865592998228, + 72.55865621514842, + 72.55865664639586 ], - "timestamp": 0.15125648749563103 + "timestamp": 0.15527246630089592 }, { - "x": 8.913659297587033, - "y": 5.968299592298079, - "heading": -6.275037709731855e-9, - "angularVelocity": -4.138927755679822e-8, - "velocityX": 1.4124938353045782, - "velocityY": 1.1847281349536443, + "x": 8.92848023335885, + "y": 5.973887660021115, + "heading": -4.616950885211499e-9, + "angularVelocity": -2.9211418944595953e-8, + "velocityX": 1.471385877286665, + "velocityY": 1.1900558006290538, "moduleForcesX": [ - 88.39092822093185, - 88.39092769362992, - 88.39092737906077, - 88.39092685175883 + 89.69035599106219, + 89.69035566464014, + 89.6903554508019, + 89.69035512437986 ], "moduleForcesY": [ - 74.13782189710152, - 74.13782252444176, - 74.13782290232763, - 74.13782352966786 + 72.54149213079447, + 72.54149253338225, + 72.54149279985882, + 72.54149320244659 ], - "timestamp": 0.22688473124344655 + "timestamp": 0.23290869945134388 }, { - "x": 9.056075856119596, - "y": 6.087751371974113, - "heading": -1.0426526669284518e-8, - "angularVelocity": -5.489336726363388e-8, - "velocityX": 1.8831133909106106, - "velocityY": 1.5794599181008273, + "x": 9.080765498452484, + "y": 6.097055868839682, + "heading": -7.500088755521719e-9, + "angularVelocity": -3.713649868513303e-8, + "velocityX": 1.961523104792119, + "velocityY": 1.5864784240611538, "moduleForcesX": [ - 88.36500041540005, - 88.36499989530782, - 88.36499958562914, - 88.3649990655369 + 89.64943614914598, + 89.649435867025, + 89.64943568274646, + 89.64943540062548 ], "moduleForcesY": [ - 74.11607342088632, - 74.11607403920983, - 74.11607441215982, - 74.11607503048332 + 72.50839621616343, + 72.50839656371213, + 72.50839679419414, + 72.50839714174283 ], - "timestamp": 0.30251297499126206 + "timestamp": 0.31054493260179183 }, { - "x": 9.234063659046555, - "y": 6.237038503722603, - "heading": -1.557166499309143e-8, - "angularVelocity": -6.803196886289352e-8, - "velocityX": 2.3534567789312155, - "velocityY": 1.9739600491886733, + "x": 9.271055736819628, + "y": 6.250962471535493, + "heading": -1.073549075609472e-8, + "angularVelocity": -4.1673866302906887e-8, + "velocityX": 2.4510493444264494, + "velocityY": 1.9824068794986782, "moduleForcesX": [ - 88.31314630713548, - 88.31314580096671, - 88.31314550072481, - 88.31314499455604 + 89.53768214766602, + 89.53768198601387, + 89.53768188126499, + 89.53768171961285 ], "moduleForcesY": [ - 74.07257772785073, - 74.07257832876682, - 74.07257869218154, - 74.07257929309762 + 72.4180097237592, + 72.41800992227425, + 72.41801005460485, + 72.4180102531199 ], - "timestamp": 0.3781412187390776 + "timestamp": 0.3881811657522398 }, { - "x": 9.4475601226603, - "y": 6.4161084917221185, - "heading": -2.1635301021301765e-8, - "angularVelocity": -8.017687212768675e-8, - "velocityX": 2.8229726492877023, - "velocityY": 2.367766050427255, + "x": 9.49869809900886, + "y": 6.435079442411687, + "heading": -1.0740486365273446e-8, + "angularVelocity": -6.43463622084617e-11, + "velocityX": 2.9321665020518726, + "velocityY": 2.371534055746901, "moduleForcesX": [ - 88.1577689515793, - 88.15776848327017, - 88.15776820865642, - 88.1577677403473 + 87.99960165358361, + 87.9996031521215, + 87.99960401789896, + 87.99960551643677 ], "moduleForcesY": [ - 73.94224579656823, - 73.94224635017488, - 73.94224668764966, - 73.94224724125631 + 71.17401211337125, + 71.17401035154614, + 71.1740090913944, + 71.17400732956926 ], - "timestamp": 0.4537694624868931 + "timestamp": 0.4658173989026878 }, { - "x": 9.677596141882916, - "y": 6.609050171403947, - "heading": -2.1638498516596324e-8, - "angularVelocity": -4.2279116053726436e-11, - "velocityX": 3.0416681364395535, - "velocityY": 2.5511855111325596, + "x": 9.726362042155634, + "y": 6.6192137679384295, + "heading": -1.0742801140563784e-8, + "angularVelocity": -2.9815656897269894e-11, + "velocityX": 2.9324444773820186, + "velocityY": 2.3717575937760413, "moduleForcesX": [ - 41.062946226400335, - 41.06294995986298, - 41.06294742447513, - 41.06295115821872 + 0.05084357930085423, + 0.050843583739799025, + 0.050843576958301495, + 0.0508435813824658 ], "moduleForcesY": [ - 34.43941479451628, - 34.43941386958167, - 34.4394093949046, - 34.439408469304034 + 0.040886627539706996, + 0.04088662735487392, + 0.04088662742758808, + 0.040886627202427216 ], - "timestamp": 0.5293977062347086 + "timestamp": 0.5434536320531358 }, { - "x": 9.907642600238958, - "y": 6.801980462733904, - "heading": -2.1641572661594514e-8, - "angularVelocity": -4.064810771272049e-11, - "velocityX": 3.041806168646975, - "velocityY": 2.5510349278146474, + "x": 9.95402738918908, + "y": 6.8033463585260785, + "heading": -1.0745115871317797e-8, + "angularVelocity": -2.981508324339283e-11, + "velocityX": 2.9324625602618077, + "velocityY": 2.3717352467478166, "moduleForcesX": [ - 0.025917397774308324, - 0.025917328301697018, - 0.025917389351188914, - 0.025917320555020107 + 0.0033074817859168504, + 0.0033074817230494984, + 0.0033074819206924118, + 0.0033074818584953513 ], "moduleForcesY": [ - -0.028274266786933316, - -0.0282736710454231, - -0.028274315413410724, - -0.028273725786296774 + -0.004087423593544569, + -0.004087423562385858, + -0.004087423640464884, + -0.004087423608774378 ], - "timestamp": 0.6050259499825241 + "timestamp": 0.6210898652035838 }, { - "x": 10.137927088417136, - "y": 6.9946265705453845, - "heading": -2.1644649186102807e-8, - "angularVelocity": -4.0679570959587807e-11, - "velocityX": 3.0449535354287685, - "velocityY": 2.5472772903978096, + "x": 10.181733463521837, + "y": 6.9874285814533925, + "heading": -1.074743088800836e-8, + "angularVelocity": -2.981876627307324e-11, + "velocityX": 2.9329871516498844, + "velocityY": 2.371086481882621, "moduleForcesX": [ - 0.5909594800381901, - 0.5909595067609218, - 0.5909593553878006, - 0.5909593823053156 + 0.09595133636687113, + 0.09595133639419236, + 0.09595133622165525, + 0.09595133624918448 ], "moduleForcesY": [ - -0.7055458142174947, - -0.7055457144361905, - -0.7055457941638286, - -0.7055456945121257 + -0.11866351070670934, + -0.11866351061126129, + -0.11866351068580717, + -0.11866351059055767 ], - "timestamp": 0.6806541937303396 + "timestamp": 0.6987260983540318 }, { - "x": 10.373636403489725, - "y": 7.1805951955577285, - "heading": -2.1647795040480304e-8, - "angularVelocity": -4.1596290240205244e-11, - "velocityX": 3.116683706930552, - "velocityY": 2.4589837843182147, + "x": 10.410614966666717, + "y": 7.170047155234762, + "heading": -1.0749756659513525e-8, + "angularVelocity": -2.995729456285404e-11, + "velocityX": 2.948127360859176, + "velocityY": 2.352233826536657, "moduleForcesX": [ - 13.468281333716506, - 13.468281354040442, - 13.468281356188696, - 13.468281376663946 + 2.769247338429343, + 2.7692473379301106, + 2.769247340528678, + 2.7692473400289686 ], "moduleForcesY": [ - -16.57826487435633, - -16.578264863811775, - -16.578264859051377, - -16.578264848527045 + -3.448279011124121, + -3.4482790125873186, + -3.4482790114829, + -3.4482790129453678 ], - "timestamp": 0.7562824374781552 + "timestamp": 0.7763623315044798 }, { - "x": 10.632781435401837, - "y": 7.332200360310185, - "heading": -2.165141717454329e-8, - "angularVelocity": -4.7893933314891495e-11, - "velocityX": 3.426564191761982, - "velocityY": 2.0046104106025284, + "x": 10.65790363132542, + "y": 7.326837161822198, + "heading": -1.0752321554540082e-8, + "angularVelocity": -3.303734509707765e-11, + "velocityX": 3.185222345595928, + "velocityY": 2.0195468046936043, "moduleForcesX": [ - 58.184129060385196, - 58.18412905996343, - 58.1841290607348, - 58.18412906031326 + 43.36628685589712, + 43.36628685569246, + 43.36628685589522, + 43.36628685569056 ], "moduleForcesY": [ - -85.31456581480035, - -85.3145658150421, - -85.31456581447162, - -85.31456581471322 + -60.8507212350991, + -60.8507212351631, + -60.850721234945254, + -60.85072123500925 ], - "timestamp": 0.8319106812259707 + "timestamp": 0.8539985646549277 }, { - "x": 10.911920703178911, - "y": 7.442713249379176, - "heading": -2.1655494793679222e-8, - "angularVelocity": -5.39166181000609e-11, - "velocityX": 3.6909394419877284, - "velocityY": 1.461264781415528, + "x": 10.927391884645788, + "y": 7.44131210061748, + "heading": -1.0755422598178304e-8, + "angularVelocity": -3.994325217049011e-11, + "velocityX": 3.4711660056733877, + "velocityY": 1.4745040318152272, "moduleForcesX": [ - 49.63992388193298, - 49.63992388136623, - 49.63992388229504, - 49.63992388172828 + 52.3010421384724, + 52.3010421378729, + 52.301042138880945, + 52.301042138281446 ], "moduleForcesY": [ - -102.02027478490183, - -102.02027478517164, - -102.02027478470922, - -102.02027478497902 + -99.69203382162233, + -99.69203382192677, + -99.69203382138218, + -99.6920338216866 ], - "timestamp": 0.9075389249737862 + "timestamp": 0.9316347978053757 }, { - "x": 11.204682504640854, - "y": 7.509086944055442, - "heading": -2.1480921256388777e-8, - "angularVelocity": 2.3083114011317104e-9, - "velocityX": 3.8710643927970487, - "velocityY": 0.8776310461153859, + "x": 11.212087760685238, + "y": 7.509594379711241, + "heading": -1.0696752381793351e-8, + "angularVelocity": 7.557066334115547e-10, + "velocityX": 3.6670490631320467, + "velocityY": 0.8795156117561665, "moduleForcesX": [ - 33.82082406908605, - 33.82082434253934, - 33.82082395667349, - 33.82082423012678 + 35.828344760314494, + 35.82834484815565, + 35.82834472183995, + 35.8283448096811 ], "moduleForcesY": [ - -109.58489562300169, - -109.58489553923481, - -109.58489566042633, - -109.58489557665945 + -108.82743272946999, + -108.82743270079978, + -108.82743274315156, + -108.82743271448133 ], - "timestamp": 0.9831671687216017 + "timestamp": 1.0092710309558237 }, { "x": 11.504159927368164, "y": 7.529608249664307, - "heading": -1.1466343403767482e-20, - "angularVelocity": 2.840330568564602e-7, - "velocityX": 3.9598621875436577, - "velocityY": 0.2713444685730626, + "heading": 8.515600651837373e-19, + "angularVelocity": 1.3778041448657172e-7, + "velocityX": 3.7620599922323836, + "velocityY": 0.25779032728548, "moduleForcesX": [ - 16.672936827269105, - 16.672973763417115, - 16.672929594277882, - 16.672966530410555 + 17.37813883051844, + 17.378156269782195, + 17.37813526776897, + 17.378152707029315 ], "moduleForcesY": [ - -113.8382661857452, - -113.838260795902, - -113.83826742735344, - -113.8382620375149 + -113.71778825853883, + -113.71778560366965, + -113.71778889227907, + -113.71778623741098 ], - "timestamp": 1.0587954124694172 + "timestamp": 1.0869072641062716 }, { - "x": 11.723814169865044, - "y": 7.544659774408682, - "heading": 0.0003316437637817544, - "angularVelocity": 0.005977710911031631, - "velocityX": 3.959156496885198, - "velocityY": 0.2712961120273982, + "x": 11.721265473032522, + "y": 7.544485128232928, + "heading": 0.0002306514166804671, + "angularVelocity": 0.003996340436793718, + "velocityX": 3.7616403301464163, + "velocityY": 0.2577615704802419, "moduleForcesX": [ - -0.3800231783618881, - 0.018593166861936215, - -0.37983792514906145, - 0.01877807173599767 + -0.23137972399546738, + 0.02479211763118681, + -0.23129698239156646, + 0.024874744187044034 ], "moduleForcesY": [ - 0.25501866357188097, - 0.25515896497349183, - -0.27991031601977506, - -0.2797750022277884 + 0.1647812621759443, + 0.164843620265754, + -0.17899328061080347, + -0.17893257077430022 ], - "timestamp": 1.1142754731009408 + "timestamp": 1.1446229218007191 }, { - "x": 11.943468396861592, - "y": 7.559711298090919, - "heading": 0.0006633655059358208, - "angularVelocity": 0.005979116431707425, - "velocityX": 3.9591562174995163, - "velocityY": 0.27129609288285333, + "x": 11.938371013459317, + "y": 7.559362006442649, + "heading": 0.0004613303187952159, + "angularVelocity": 0.0039968166582452355, + "velocityX": 3.761640239398693, + "velocityY": 0.25776156426187075, "moduleForcesX": [ - -0.00011941564535959291, - -0.0000256129901485413, - -0.00011740546109203538, - -0.00002360245636695837 + -0.00003773149786372426, + -0.000007204180268209206, + -0.000037450447676189646, + -0.000006923116742158263 ], "moduleForcesY": [ - 0.00005720676973222099, - 0.00005871943011131621, - -0.00006851882637692969, - -0.00006700766069155643 + 0.000018849052548043464, + 0.000019058256258897704, + -0.000022118345812749114, + -0.000021908764086262358 ], - "timestamp": 1.1697555337324643 + "timestamp": 1.2023385794951666 }, { - "x": 12.163122621271087, - "y": 7.574762821595881, - "heading": 0.0009951193580978455, - "angularVelocity": 0.0059796951983416505, - "velocityX": 3.959156170869261, - "velocityY": 0.271296089687575, + "x": 12.155476553334907, + "y": 7.574238884614604, + "heading": 0.000692019206656741, + "angularVelocity": 0.0039969896744972404, + "velocityX": 3.7616402298483314, + "velocityY": 0.2577615636074444, "moduleForcesX": [ - -0.00003182466177350351, - 0.000006771270614396005, - -0.00003064136974812045, - 0.00000795445679541281 + -0.000007911344412282606, + 0.0000031796340398333965, + -0.000007879121829168663, + 0.0000032118573271210495 ], "moduleForcesY": [ - 0.000024637758118900774, - 0.000025519938305896045, - -0.000027155298678241116, - -0.00002627374076892752 + 0.000007268884671306007, + 0.000007292887095077557, + -0.000007614918696669374, + -0.000007590905782512107 ], - "timestamp": 1.2252355943639879 + "timestamp": 1.2600542371896142 }, { - "x": 12.382776843106626, - "y": 7.5898143449244655, - "heading": 0.0013269051795884396, - "angularVelocity": 0.005980271429301126, - "velocityX": 3.959156124474958, - "velocityY": 0.271296086508465, + "x": 12.372582092661531, + "y": 7.589115762748938, + "heading": 0.0009227180479962139, + "angularVelocity": 0.003997162131649172, + "velocityX": 3.7616402203368033, + "velocityY": 0.25776156295567915, "moduleForcesX": [ - -0.000031597095571567786, - 0.000006828726915437893, - -0.00003057810958084459, - 0.000007847742744020969 + -0.000007879578286144631, + 0.0000031755910350543595, + -0.00000785596949064241, + 0.000003199199714775384 ], "moduleForcesY": [ - 0.00002458955536444505, - 0.000025349959143754557, - -0.000026976250714836496, - -0.000026218053664441575 + 0.000007248684803897002, + 0.000007266281577818796, + -0.000007586995098265933, + -0.000007569405129248863 ], - "timestamp": 1.2807156549955114 + "timestamp": 1.3177698948840617 }, { - "x": 12.602431062378338, - "y": 7.604865868077367, - "heading": 0.0016587228388953486, - "angularVelocity": 0.005980845289818807, - "velocityX": 3.9591560782633017, - "velocityY": 0.2712960833418706, + "x": 12.58968763144081, + "y": 7.603992640845768, + "heading": 0.0011534268124538383, + "angularVelocity": 0.00399733406277753, + "velocityX": 3.7616402108533076, + "velocityY": 0.2577615623058348, "moduleForcesX": [ - -0.00003137643765755024, - 0.000007003898149552019, - -0.000030655866990225, - 0.00000771666589842292 + -0.000007856426270151256, + 0.0000031650199598336882, + -0.00000783160436860314, + 0.0000031898417770067777 ], "moduleForcesY": [ - 0.000024566199961317356, - 0.00002508688171878728, - -0.000026734376621624633, - -0.000026160681239715125 + 0.000007226080948355998, + 0.000007244576259354271, + -0.00000756434992770978, + -0.000007545850659556913 ], - "timestamp": 1.336195715627035 + "timestamp": 1.3754855525785092 }, { - "x": 12.822085279034965, - "y": 7.619917391051073, - "heading": 0.0019905723973486535, - "angularVelocity": 0.0059814202557801404, - "velocityX": 3.9591560311277263, - "velocityY": 0.2712960801119659, + "x": 12.806793169674307, + "y": 7.618869518905198, + "heading": 0.0013841454697995558, + "angularVelocity": 0.003997505470130205, + "velocityX": 3.7616402013969266, + "velocityY": 0.25776156165784847, "moduleForcesX": [ - -0.000030180275122252033, - 0.000009319628859125455, - -0.0000334276534927207, - 0.000006030646349786755 + -0.000007849474374256643, + 0.000003139441686262953, + -0.00000779264425404203, + 0.0000031961928870877972 ], "moduleForcesY": [ - 0.00002563136670115969, - 0.00002333338017690202, - -0.000024944009939658092, - -0.000027327530705045235 + 0.00000719180863449233, + 0.000007233883614424872, + -0.000007553109769633687, + -0.0000075102973316054884 ], - "timestamp": 1.3916757762585585 + "timestamp": 1.4332012102729568 }, { - "x": 13.041739217817087, - "y": 7.634968894983787, - "heading": 0.0023233217250107695, - "angularVelocity": 0.005997638140161826, - "velocityX": 3.959151022580424, - "velocityY": 0.2712957369076972, + "x": 13.023898706922797, + "y": 7.633746396897134, + "heading": 0.0016148753076260633, + "angularVelocity": 0.003997699186726992, + "velocityX": 3.7616401843303224, + "velocityY": 0.25776156048838134, "moduleForcesX": [ - -0.001811076616468709, - -0.0007285537490287964, - -0.0018353036207771887, - -0.0007528434903345994 + -0.000011019746567382785, + 0.0000014116140586023405, + -0.000009809503136558279, + 0.000002621561543044522 ], "moduleForcesY": [ - 0.0006476415636713516, - 0.0006274114604783823, - -0.0008052877098447759, - -0.0008211396774428359 + 0.000007586054788733624, + 0.000008490175069037687, + -0.00000906467566976256, + -0.000008162483612596876 ], - "timestamp": 1.447155836890082 + "timestamp": 1.4909168679674043 }, { - "x": 13.260174320772844, - "y": 7.649936879757519, - "heading": 0.006574946131355052, - "angularVelocity": 0.07663337707184353, - "velocityX": 3.9371821239799427, - "velocityY": 0.2697903463578355, + "x": 13.24100074826179, + "y": 7.648623035336362, + "heading": 0.0018561069459867565, + "angularVelocity": 0.004179656751687672, + "velocityX": 3.761579613080985, + "velocityY": 0.25775740992134544, "moduleForcesX": [ - -7.99310631283451, - -3.2965571422513857, - -7.948703890086734, - -3.253508368178124 + -0.020760270003833053, + -0.009094518538519383, + -0.020710863092040826, + -0.009045457185681977 ], "moduleForcesY": [ - 2.759504254840201, - 2.801876303080084, - -3.5597663854085146, - -3.5428410570857647 + 0.006786622699577082, + 0.006822833851212185, + -0.008865931591266973, + -0.008828299600102445 ], - "timestamp": 1.5026358975216056 + "timestamp": 1.5486325256618518 }, { - "x": 13.45491022910445, - "y": 7.663280907669538, - "heading": 0.03547098491568591, - "angularVelocity": 0.5208364672895163, - "velocityX": 3.5100161412036357, - "velocityY": 0.24051934623224105, + "x": 13.443353616594075, + "y": 7.662489005645776, + "heading": 0.04225938920162335, + "angularVelocity": 0.7000402294562001, + "velocityX": 3.506030710133503, + "velocityY": 0.24024624968884079, "moduleForcesX": [ - -112.65722835544774, - -110.08477802292602, - -109.61792794131873, - -104.97488015141087 + -79.0685909618201, + -50.58995823940847, + -75.86574911891587, + -45.97379077401321 ], "moduleForcesY": [ - 17.266378646952028, - 26.808134666937164, - -31.268524352599332, - -42.773795213348265 + 24.57350746925242, + 38.053994012355105, + -34.0608976536489, + -45.8001872458519 ], - "timestamp": 1.5581159581531292 + "timestamp": 1.6063481833562994 }, { - "x": 13.625911868933855, - "y": 7.674998575327416, - "heading": 0.036437057187586885, - "angularVelocity": 0.017412963520664588, - "velocityX": 3.0822179695355967, - "velocityY": 0.2112050261751085, + "x": 13.620987292267783, + "y": 7.674661125038714, + "heading": 0.04217975934168366, + "angularVelocity": -0.0013796924980265383, + "velocityX": 3.0777380483840022, + "velocityY": 0.21089804533422155, "moduleForcesX": [ - -104.3550095871483, - -109.9895441753885, - -110.29427213876139, - -113.34322693340162 + -96.77847026846838, + -107.9030731985583, + -104.77822606455094, + -112.04384390865172 ], "moduleForcesY": [ - -47.97784316156552, - -33.766005815685666, - 31.984331361894537, - 19.74736018603692 + -61.53659629054846, + -39.742791431053234, + 46.56311157639095, + 25.833282603076576 ], - "timestamp": 1.6135960187846528 + "timestamp": 1.664063841050747 }, { "x": 13.774003028869627, "y": 7.685146331787109, - "heading": -1.0216757134766161e-20, - "angularVelocity": -0.656759505538167, - "velocityX": 2.6692681704033068, - "velocityY": 0.18290817176805882, + "heading": -1.007498877189806e-18, + "angularVelocity": -0.7308200413306815, + "velocityX": 2.6511997387593604, + "velocityY": 0.1816700557048792, "moduleForcesX": [ - -96.61655453478754, - -108.47344443180624, - -105.62360385351926, - -112.06660691389176 + -95.19524925336464, + -108.15585163442557, + -104.58809520721027, + -111.83787419864792 ], "moduleForcesY": [ - -62.57662299104666, - -38.92519570430598, - 45.679141765122075, - 26.852206267299998 + -64.67933399592916, + -39.76761501132085, + 47.94032248604527, + 27.74194212984135 ], - "timestamp": 1.6690760794161763 + "timestamp": 1.7217794987451944 }, { - "x": 13.936101730471314, - "y": 7.6649237183136245, - "heading": -0.05404788012796307, - "angularVelocity": -0.8367505818789226, - "velocityX": 2.509556018957628, - "velocityY": -0.3130795056344143, + "x": 13.935035958999284, + "y": 7.664782649008714, + "heading": -0.05780109053495526, + "angularVelocity": -0.8964222673734035, + "velocityX": 2.497418353401382, + "velocityY": -0.31581512596622585, "moduleForcesX": [ - -20.093926933349476, - -41.83422551523411, - -25.248051251260648, - -53.269880817247596 + -19.9714407549644, + -40.44308656666267, + -24.49636920750514, + -50.556470643095416 ], "moduleForcesY": [ - -113.64526973932998, - -107.56161028308789, - -112.58952761642209, - -102.3603069840681 + -113.66567125217688, + -108.09087389552265, + -112.75580340484727, + -103.7266984641109 ], - "timestamp": 1.7336686608836414 + "timestamp": 1.786259256375845 }, { - "x": 14.086544019767228, - "y": 7.613116434507106, - "heading": -0.11934484607806041, - "angularVelocity": -1.010905036873114, - "velocityX": 2.3290954762613043, - "velocityY": -0.8020624447811118, + "x": 14.084799871677337, + "y": 7.612780905683724, + "heading": -0.12587786054142183, + "angularVelocity": -1.0557851410735792, + "velocityX": 2.322650056098518, + "velocityY": -0.8064816810085409, "moduleForcesX": [ - -25.536274706249685, - -46.56911838452923, - -29.770241346526483, - -56.81596418002521 + -25.499150978953384, + -45.22637504187557, + -29.09597042008306, + -54.133424993041125 ], "moduleForcesY": [ - -112.5342845020268, - -105.58420453918785, - -111.46183761296862, - -100.41663085453071 + -112.54112536251206, + -106.16430182617324, + -111.64007832404387, + -101.88695367808475 ], - "timestamp": 1.7982612423511064 + "timestamp": 1.8507390140064957 }, { - "x": 14.223301675262098, - "y": 7.530531275179706, - "heading": -0.19531452901541774, - "angularVelocity": -1.1761363489648249, - "velocityX": 2.1172347100534177, - "velocityY": -1.27855486576267, + "x": 14.221239414597168, + "y": 7.529933622115767, + "heading": -0.20362445988353564, + "angularVelocity": -1.205752040624248, + "velocityX": 2.1160058277727787, + "velocityY": -1.2848572422141997, "moduleForcesX": [ - -33.520931651827894, - -53.22911230390822, - -37.27033259543515, - -62.28363856197366 + -33.61193018096122, + -51.96652105002978, + -36.73910240668662, + -59.717154187720176 ], "moduleForcesY": [ - -110.39863935620404, - -102.36662249013638, - -109.15657312819253, - -97.09133480103486 + -110.36868341598847, + -103.01044274754193, + -109.33674686043942, + -98.68934221201837 ], - "timestamp": 1.8628538238185715 + "timestamp": 1.9152187716371463 }, { - "x": 14.343025710960973, - "y": 7.418854878805072, - "heading": -0.2809594489484934, - "angularVelocity": -1.325925020913038, - "velocityX": 1.8535261012780369, - "velocityY": -1.728935333400246, + "x": 14.340943734877591, + "y": 7.417920323946956, + "heading": -0.28999690085220237, + "angularVelocity": -1.3395280029342027, + "velocityX": 1.8564635581620241, + "velocityY": -1.7371854716086177, "moduleForcesX": [ - -46.39707082363187, - -63.43366418473748, - -50.63883300977956, - -71.42788762753942 + -46.751588789826286, + -62.37320446686807, + -50.35015435786008, + -69.15810736949086 ], "moduleForcesY": [ - -105.59817168074842, - -96.33740524696931, - -103.58836930621422, - -90.52715351089934 + -105.43790145029115, + -97.02260752007686, + -103.72888519276779, + -92.27049869774005 ], - "timestamp": 1.9274464052860365 + "timestamp": 1.9796985292677969 }, { - "x": 14.439640325423767, - "y": 7.282561627306501, - "heading": -0.3741539927257661, - "angularVelocity": -1.4428056854209232, - "velocityX": 1.4957540365755364, - "velocityY": -2.1100449680466906, + "x": 14.437683961642778, + "y": 7.281280072098083, + "heading": -0.38276450479544777, + "angularVelocity": -1.438708942962096, + "velocityX": 1.5003193299721982, + "velocityY": -2.1191185710028404, "moduleForcesX": [ - -70.2431689631601, - -81.12995040952687, - -75.69379680678863, - -87.54712653568923 + -71.23628387541437, + -80.66473849864646, + -75.82283658408791, + -86.00670611740921 ], "moduleForcesY": [ - -91.39966744732322, - -81.90176576678061, - -86.88518138121627, - -74.94978844811001 + -90.61976741253616, + -82.34976809206417, + -86.77144470833049, + -76.70722702894544 ], - "timestamp": 1.9920389867535016 + "timestamp": 2.0441782868984473 }, { - "x": 14.50377014296591, - "y": 7.136817952344609, - "heading": -0.46758899852853547, - "angularVelocity": -1.446528435310054, - "velocityX": 0.9928356490047452, - "velocityY": -2.256353154662236, + "x": 14.501936386050707, + "y": 7.1356478733639035, + "heading": -0.47425263991314337, + "angularVelocity": -1.4188659895676565, + "velocityX": 0.9964743474374752, + "velocityY": -2.2585723657396755, "moduleForcesX": [ - -110.46580054393864, - -110.54658737476862, - -110.57960043427867, - -110.65938530025993 + -111.44531662002107, + -111.05416659333267, + -110.88084813088581, + -110.46111986931393 ], "moduleForcesY": [ - -32.49781898234192, - -32.22495698602894, - -32.10463531819626, - -31.831627846959343 + -28.930831010677075, + -30.379702096445232, + -31.044847165146514, + -32.49068702774292 ], - "timestamp": 2.0566315682209666 + "timestamp": 2.108658044529098 }, { - "x": 14.53996714646827, - "y": 7.00954832171531, - "heading": -0.5431710549769495, - "angularVelocity": -1.1701352497652444, - "velocityX": 0.5603894856035541, - "velocityY": -1.9703443915367327, + "x": 14.538645426348966, + "y": 7.008815909604144, + "heading": -0.5473253251672447, + "angularVelocity": -1.1332655074895337, + "velocityX": 0.5693110775715775, + "velocityY": -1.9670043502066366, "moduleForcesX": [ - -87.53770821277456, - -84.5907695917968, - -103.58271444424955, - -104.56901726794133 + -86.23137198290863, + -82.87186793378041, + -103.10238518870169, + -104.08623484052193 ], "moduleForcesY": [ - 74.87353802308711, - 78.09476192896813, - 50.38760823256533, - 48.15163557428627 + 76.37745701415473, + 79.91712175914675, + 51.366193333691044, + 49.18404252351033 ], - "timestamp": 2.1212241496884316 + "timestamp": 2.1731378021597485 }, { - "x": 14.560150155522226, - "y": 6.911539256829025, - "heading": -0.598147081877329, - "angularVelocity": -0.8511198291102623, - "velocityX": 0.31246636371270964, - "velocityY": -1.517342435611623, + "x": 14.559418537812661, + "y": 6.911177269143886, + "heading": -0.6002567765952495, + "angularVelocity": -0.820900285190336, + "velocityX": 0.3221648502881852, + "velocityY": -1.5142525972189051, "moduleForcesX": [ - -46.109164119120734, - -30.063756225968806, - -74.99270372130417, - -66.85054699912216 + -46.145857817831676, + -30.484801894737284, + -74.56500704734023, + -66.5176061352037 ], "moduleForcesY": [ - 105.68256490842477, - 111.2770803271555, - 87.55367623297964, - 93.84303659418195 + 105.66705745601725, + 111.16368416399354, + 87.9194683312, + 94.0827685467072 ], - "timestamp": 2.1858167311558967 + "timestamp": 2.237617559790399 }, { - "x": 14.570650392409606, - "y": 6.845493549123404, - "heading": -0.6338212894662737, - "angularVelocity": -0.5522957401371792, - "velocityX": 0.16256103485613507, - "velocityY": -1.0224967976994013, + "x": 14.570390149911358, + "y": 6.84537565225515, + "heading": -0.6345291644881725, + "angularVelocity": -0.5315216612512779, + "velocityX": 0.1701559140706136, + "velocityY": -1.020500375724994, "moduleForcesX": [ - -26.678062716919186, - -6.490482928094056, - -57.014388668296064, - -41.63932401569198 + -27.295991115954983, + -7.911741357015105, + -56.732341958223465, + -41.96592679327208 ], "moduleForcesY": [ - 112.22997904008606, - 115.15324971354988, - 100.25774640780512, - 107.51146412413148 + 112.08099626886072, + 115.06446151670661, + 100.41815919051002, + 107.38703277594337 ], - "timestamp": 2.2504093126233617 + "timestamp": 2.3020973174210497 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -0.2696598841914466, - "velocityX": 0.065342965506683, - "velocityY": -0.514035511223207, + "angularVelocity": -0.2591534712639973, + "velocityX": 0.06949333381079491, + "velocityY": -0.5131065156466121, "moduleForcesX": [ - -16.65484746801905, - 4.857070171723746, - -46.43149894465741, - -27.26138342927001 + -17.497246051703055, + 3.059767167772353, + -46.22660111522497, + -28.01046724085712 ], "moduleForcesY": [ - 114.17712362294917, - 115.26897371338562, - 105.61087783646228, - 112.06865783448852 + 114.05057698106343, + 115.33044468651329, + 105.70098429664752, + 111.88568251229185 ], - "timestamp": 2.315001894090827 + "timestamp": 2.3665770750517003 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -5.645946234609016e-22, - "velocityX": -3.1761678507214283e-21, - "velocityY": 7.19219703597375e-23, + "angularVelocity": -4.1843925027882567e-20, + "velocityX": -1.2624804704208055e-19, + "velocityY": 8.893976865334932e-21, "moduleForcesX": [ - -10.902305920487686, - 11.194107913077895, - -39.6575688795007, - -18.094880741208897 + -11.831191033758017, + 9.238891886616917, + -39.495635804588694, + -19.129350517864943 ], "moduleForcesY": [ - 114.88625738279923, - 114.84784529450766, - 108.35750475803422, - 113.93583193326243 + 114.79379693930306, + 115.02128580058942, + 108.41678324342674, + 113.76815074013277 ], - "timestamp": 2.379594475558292 + "timestamp": 2.431056832682351 } ], "trajectoryWaypoints": [ @@ -8358,7 +8442,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 1.0587954124694172, + "timestamp": 1.0869072641062716, "isStopPoint": false, "x": 11.504159927368164, "y": 7.529608249664307, @@ -8369,7 +8453,7 @@ "controlIntervalCount": 11 }, { - "timestamp": 1.6690760794161763, + "timestamp": 1.7217794987451944, "isStopPoint": false, "x": 13.774003028869629, "y": 7.685146331787109, @@ -8380,7 +8464,7 @@ "controlIntervalCount": 11 }, { - "timestamp": 2.379594475558292, + "timestamp": 2.431056832682351, "isStopPoint": true, "x": 14.574871063232422, "y": 6.812290668487549, @@ -8473,7 +8557,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 17 }, { "x": 12.773889541625977, @@ -8535,9 +8619,9 @@ "x": 15.781251907348633, "y": 6.674294471740723, "heading": -1.0370884287879991, - "angularVelocity": -1.2621726109028427e-25, - "velocityX": 1.4651515238606446e-24, - "velocityY": -1.680503205752954e-25, + "angularVelocity": -1.9866208287541445e-22, + "velocityX": -1.3943691504612067e-20, + "velocityY": 1.721129501746892e-21, "moduleForcesX": [ 0, 0, @@ -8553,2482 +8637,2503 @@ "timestamp": 0 }, { - "x": 15.737579234276897, - "y": 6.679677617673034, - "heading": -1.0238784708913053, - "angularVelocity": 0.17911083631788308, - "velocityX": -0.5921479129069697, - "velocityY": 0.07298886018394904, + "x": 15.737579450239823, + "y": 6.679677689320791, + "heading": -1.0238715954789284, + "angularVelocity": 0.1792040409939818, + "velocityX": -0.592144926929208, + "velocityY": 0.07298982451690347, "moduleForcesX": [ - -111.52415378273292, - -114.49845914960217, - -114.62304761463147, - -115.39645209570611 + -111.5219305913229, + -114.498394155326, + -114.62307907253539, + -115.39636467253322 ], "moduleForcesY": [ - 29.64724689974533, - 14.302632979180668, - 13.43617051536317, - -1.1737539863505893 + 29.65555787933653, + 14.3029848589867, + 13.435844022960673, + -1.1813531589219308 ], - "timestamp": 0.07375297982110327 + "timestamp": 0.0737529870183815 }, { - "x": 15.65024272244521, - "y": 6.690442536464301, - "heading": -0.9972998437394694, - "angularVelocity": 0.36037360410800473, - "velocityX": -1.1841760433752266, - "velocityY": 0.1459591031762828, + "x": 15.650243268574524, + "y": 6.690442727379406, + "heading": -0.9972824865204766, + "angularVelocity": 0.3605156893757415, + "velocityX": -1.1841714511648371, + "velocityY": 0.14596070605154865, "moduleForcesX": [ - -111.50844636902373, - -114.41456026220695, - -114.64994745113319, - -115.37690823700736 + -111.50730603264702, + -114.41445099721365, + -114.6499789417417, + -115.37684481502328 ], "moduleForcesY": [ - 29.631929160379492, - 14.78872900282211, - 13.058413629305413, - -1.281113395748797 + 29.636133156128178, + 14.789343949904154, + 13.057990695853707, + -1.2850231166130164 ], - "timestamp": 0.14750595964220653 + "timestamp": 0.147505974036763 }, { - "x": 15.519260170047334, - "y": 6.706587085965137, - "heading": -0.9570257848318809, - "angularVelocity": 0.5460668708610573, - "velocityX": -1.7759628521530966, - "velocityY": 0.21890030124879606, + "x": 15.519260985004637, + "y": 6.706587400459137, + "heading": -0.9570001256980181, + "angularVelocity": 0.5461793813505997, + "velocityX": -1.7759590338658693, + "velocityY": 0.21890195546531085, "moduleForcesX": [ - -111.46040731354765, - -114.27773305577186, - -114.68449962172555, - -115.34136867400807 + -111.46108154508877, + -114.27765420928104, + -114.68446600714896, + -115.34135846330668 ], "moduleForcesY": [ - 29.681971808482846, - 15.525374011394444, - 12.482698846734126, - -1.5144551853011516 + 29.67926678958357, + 15.525601814683496, + 12.482626306329125, + -1.5118713708448794 ], - "timestamp": 0.2212589394633098 + "timestamp": 0.22125896105514448 }, { - "x": 15.344671348566528, - "y": 6.7281056267189525, - "heading": -0.9024652860812764, - "angularVelocity": 0.7397734828199154, - "velocityX": -2.3672104083698318, - "velocityY": 0.29176503520279506, + "x": 15.344671992310621, + "y": 6.728105972585149, + "heading": -0.9024462454019326, + "angularVelocity": 0.7396836725065657, + "velocityX": -2.367212498803648, + "velocityY": 0.29176543209902306, "moduleForcesX": [ - -111.33731276290986, - -114.047317314268, - -114.70303402913382, - -115.26103974744757 + -111.3416986263144, + -114.04761304875294, + -114.70270359118507, + -115.26119474678515 ], "moduleForcesY": [ - 29.852227212177972, - 16.537440340405904, - 11.678182443826497, - -1.9511492781752187 + 29.835398318882262, + 16.53470475362042, + 11.680162554712537, + -1.9345387090441741 ], - "timestamp": 0.29501191928441306 + "timestamp": 0.295011948073526 }, { - "x": 15.126638225171718, - "y": 6.754973444774636, - "heading": -0.8320689272797918, - "angularVelocity": 0.9544883335187218, - "velocityX": -2.956261888315243, - "velocityY": 0.3642946782740956, + "x": 15.126636955507474, + "y": 6.754973345333405, + "heading": -0.8321165267909179, + "angularVelocity": 0.9535846811666963, + "velocityX": -2.9562875432937514, + "velocityY": 0.36428860490166864, "moduleForcesX": [ - -110.76647931585221, - -113.4372446028584, - -114.54159557891052, - -114.91207845018252 + -110.78310373820221, + -113.43975897922056, + -114.53954300836371, + -114.91309615963544 ], "moduleForcesY": [ - 30.725491734044457, - 18.019343819168096, - 10.430723288375898, - -3.31692802572431 + 30.66242904873677, + 18.000125302132766, + 10.443175232183501, + -3.252087288558954 ], - "timestamp": 0.36876489910551635 + "timestamp": 0.3687649350919075 }, { - "x": 14.95206300120593, - "y": 6.77647174900219, - "heading": -0.773433535697502, - "angularVelocity": 0.7950240346155092, - "velocityX": -2.3670260427340133, - "velocityY": 0.29149065271260355, + "x": 14.952061791200475, + "y": 6.776471593869833, + "heading": -0.773477230035834, + "angularVelocity": 0.7950769063830467, + "velocityX": -2.367025002844833, + "velocityY": 0.29148986916380626, "moduleForcesX": [ - 111.67454146499206, - 113.21740142392865, - 114.23838580721042, - 114.66905825851461 + 111.69180132345558, + 113.22262332485307, + 114.23686977658001, + 114.66860726835483 ], "moduleForcesY": [ - -26.07191731663405, - -17.63441497120966, - -10.811867231610925, - -1.5517466920592173 + -26.00046807992641, + -17.609482537218337, + -10.829705083256483, + -1.6262110875675433 ], - "timestamp": 0.44251787892661965 + "timestamp": 0.442517922110289 }, { - "x": 14.821107358373453, - "y": 6.792594475814811, - "heading": -0.7289082448366585, - "angularVelocity": 0.6037083649887086, - "velocityX": -1.7755979914320057, - "velocityY": 0.21860441234684685, + "x": 14.821106606729163, + "y": 6.792594367193026, + "heading": -0.728934985378209, + "angularVelocity": 0.6039381787550343, + "velocityX": -1.7755916033431103, + "velocityY": 0.21860502164033546, "moduleForcesX": [ - 111.76581158852909, - 113.62556481771135, - 114.85540369095074, - 115.24093186284539 + 111.76902146309567, + 113.62660597529597, + 114.85509991104111, + 115.24105907142824 ], "moduleForcesY": [ - -28.104376111602893, - -19.05291831548317, - -9.730572920361016, - 0.7546034880784759 + -28.09175703488538, + -19.04718344009563, + -9.734361300742906, + 0.7411160901552712 ], - "timestamp": 0.5162708587477229 + "timestamp": 0.5162709091286705 }, { - "x": 14.733794757049841, - "y": 6.8033423608281804, - "heading": -0.699054593949396, - "angularVelocity": 0.40477891143756034, - "velocityX": -1.1838518461952143, - "velocityY": 0.14572814602799683, + "x": 14.733794470977603, + "y": 6.8033423167589095, + "heading": -0.6990646840438874, + "angularVelocity": 0.40500463156667743, + "velocityX": -1.183845418081848, + "velocityY": 0.14572900705980713, "moduleForcesX": [ - 111.79320392724134, - 113.62956435917394, - 114.97926679056616, - 115.33065660328327 + 111.7931349384804, + 113.62959134846821, + 114.9792838560784, + 115.33066788879077 ], "moduleForcesY": [ - -28.3773819380287, - -19.66367922942836, - -9.251806083394841, - 1.1672848935603741 + -28.37771557003671, + -19.66362346001396, + -9.251771451433502, + 1.167727477271745 ], - "timestamp": 0.5900238385688262 + "timestamp": 0.590023896147052 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": 0.2026753043980143, - "velocityX": -0.5919727585178587, - "velocityY": 0.07286398915017836, + "angularVelocity": 0.20281209391920932, + "velocityX": -0.591968821960951, + "velocityY": 0.07286457956489158, "moduleForcesX": [ - 111.81186730618849, - 113.62366087491984, - 115.03206722044585, - 115.36748176404834 + 111.8103126294131, + 113.62315026046184, + 115.03223801565095, + 115.36741290735165 ], "moduleForcesY": [ - -28.459057623857394, - -19.953358992688436, - -9.022048294829766, - 1.3182086277737222 + -28.465206698015187, + -19.95629133803773, + -9.02002923668353, + 1.325068049848567 ], - "timestamp": 0.6637768183899295 + "timestamp": 0.6637768831654335 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": -1.6373628874461133e-23, - "velocityX": 8.947893033904734e-24, - "velocityY": -1.1505319118510811e-23, + "angularVelocity": -2.5642140347804797e-20, + "velocityX": -3.5823449426452e-20, + "velocityY": -1.925043641959108e-19, "moduleForcesX": [ - 111.82265390196439, - 113.64454489492644, - 115.05199065534637, - 115.38802821587312 + 111.82024353932489, + 113.64374505858738, + 115.05224225386621, + 115.38791059104989 ], "moduleForcesY": [ - -28.500501780206477, - -19.972823998599004, - -9.007971358764712, - 1.3651700292396918 + -28.50998973892722, + -19.97737600929884, + -9.004897700061502, + 1.3756871088737914 ], - "timestamp": 0.7375297982110328 + "timestamp": 0.737529870183815 }, { - "x": 14.675442670065264, - "y": 6.813379455407895, - "heading": -0.6717552714338458, - "angularVelocity": 0.28012842601201576, - "velocityX": -0.3332201126313312, - "velocityY": 0.10575980127060357, + "x": 14.675427628708652, + "y": 6.813251052040293, + "heading": -0.6712306053842845, + "angularVelocity": 0.29193748147934406, + "velocityX": -0.33345810585500363, + "velocityY": 0.1028158279786869, "moduleForcesX": [ - -98.66143888298555, - -101.74059915261991, - -113.5288649606166, - -115.33460700108112 + -98.56104344072963, + -101.77209540362654, + -113.76419860866348, + -115.34193264889893 ], "moduleForcesY": [ - 59.785007713118624, - 54.28404650214978, - 20.548862722674233, - 1.6254648649671486 + 59.95036989637328, + 54.21915011775324, + 19.206886815923188, + -0.9665078147572825 ], - "timestamp": 0.7816217707961985 + "timestamp": 0.7816354809617166 }, { - "x": 14.645995324424886, - "y": 6.822611735205374, - "heading": -0.6475745131726771, - "angularVelocity": 0.5484163407400843, - "velocityX": -0.6678618332055477, - "velocityY": 0.20938686241916543, + "x": 14.645951659507638, + "y": 6.822252244551949, + "heading": -0.6460812610559683, + "angularVelocity": 0.5702073700998768, + "velocityX": -0.6683042969168805, + "velocityY": 0.20408270859191352, "moduleForcesX": [ - -99.75522587908065, - -102.42692626434821, - -113.61159697879016, - -115.30312469583279 + -99.67413943343905, + -102.41667407252237, + -113.80517697131697, + -115.33090537915734 ], "moduleForcesY": [ - 57.918836347024914, - 52.949230173428, - 20.022389058972617, - 2.6054576839941515 + 58.057715139352084, + 52.96303310230855, + 18.892577765031255, + 0.5017832153100624 ], - "timestamp": 0.8257137433813643 + "timestamp": 0.8257410917396183 }, { - "x": 14.601720929906575, - "y": 6.836296863592373, - "heading": -0.6121698252606008, - "angularVelocity": 0.802973553602993, - "velocityX": -1.0041373048754916, - "velocityY": 0.3103768687274164, + "x": 14.60163725558127, + "y": 6.835636025102194, + "heading": -0.6093693928259745, + "angularVelocity": 0.83236276706064, + "velocityX": -1.0047339362222996, + "velocityY": 0.30344848000491226, "moduleForcesX": [ - -101.05043111896799, - -103.17292508176739, - -113.72399441780098, - -115.25417706262766 + -100.991325152693, + -103.11790484339444, + -113.86495520158219, + -115.29193191628325 ], "moduleForcesY": [ - 55.59926387355985, - 51.44579662555788, - 19.28978582137924, - 3.763922989102108 + 55.705085158124895, + 51.549723350324534, + 18.43745216980293, + 2.2745321495909177 ], - "timestamp": 0.86980571596653 + "timestamp": 0.8698467025175199 }, { - "x": 14.542534274068288, - "y": 6.854289480670813, - "heading": -0.5663088411318837, - "angularVelocity": 1.04012094356029, - "velocityX": -1.3423453832546366, - "velocityY": 0.40807013212408705, + "x": 14.54240224861384, + "y": 6.853299205917846, + "heading": -0.5620118203579388, + "angularVelocity": 1.0737312471764549, + "velocityX": -1.3430265656157756, + "velocityY": 0.40047469027457633, "moduleForcesX": [ - -102.57468929953593, - -104.09282628417807, - -113.84725221188148, - -115.17640973922873 + -102.53916594922721, + -104.00399188740985, + -113.91900928393952, + -115.20317523209395 ], "moduleForcesY": [ - 52.69527446824037, - 49.514027860489485, - 18.434236842874185, - 5.208253519164049 + 52.761241240453465, + 49.693648028830694, + 17.977297280367917, + 4.521635796707823 ], - "timestamp": 0.9138976885516957 + "timestamp": 0.9139523132954216 }, { - "x": 14.468332402329434, - "y": 6.876403676556318, - "heading": -0.5110338700297112, - "angularVelocity": 1.2536289002585717, - "velocityX": -1.6828884576558436, - "velocityY": 0.501546984381149, + "x": 14.468148235945801, + "y": 6.875112546792884, + "heading": -0.5052716820349888, + "angularVelocity": 1.286460777261897, + "velocityX": -1.6835502639776507, + "velocityY": 0.4945706564383568, "moduleForcesX": [ - -104.36995920291493, - -105.32254762054377, - -113.95741323469906, - -115.04927896233585 + -104.36005213468482, + -105.22540646754365, + -113.93211638348767, + -115.02101774687752 ], "moduleForcesY": [ - 48.98783162688297, - 46.78241555241345, - 17.57930257657602, - 7.070518349276318 + 49.00253104776368, + 46.99284585116924, + 17.723543700297828, + 7.461228629108571 ], - "timestamp": 0.9579896611368615 + "timestamp": 0.9580579240733232 }, { - "x": 14.37898957009058, - "y": 6.902392060853308, - "heading": -0.44783074537436557, - "angularVelocity": 1.4334383550943604, - "velocityX": -2.026283402637178, - "velocityY": 0.5894130557845081, + "x": 14.378757412573508, + "y": 6.900907275957238, + "heading": -0.4409704067619092, + "angularVelocity": 1.4578933187633483, + "velocityX": -2.0267449377911255, + "velocityY": 0.5848400851820366, "moduleForcesX": [ - -106.49908090238071, - -107.01525529263431, - -114.02178183246805, - -114.83695790685455 + -106.52188217914602, + -106.94884746449374, + -113.84546391040449, + -114.66217685453101 ], "moduleForcesY": [ - 44.081369792919354, - 42.68370625113583, - 16.92078527818248, - 9.50620759153989 + 44.012594395755805, + 42.839962321036545, + 18.031148465609164, + 11.368492354698162 ], - "timestamp": 1.0020816337220273 + "timestamp": 1.002163534851225 }, { - "x": 14.27435337661712, - "y": 6.9319034624003555, - "heading": -0.378909376081055, - "angularVelocity": 1.5631273733599833, - "velocityX": -2.3731347757542367, - "velocityY": 0.6693146125418837, + "x": 14.274093603671082, + "y": 6.930444659197211, + "heading": -0.37184741685344586, + "angularVelocity": 1.5672153426587654, + "velocityX": -2.373027083322251, + "velocityY": 0.6696967283529704, "moduleForcesX": [ - -109.05079129956879, - -109.30978180404821, - -113.98678875725696, - -114.47840264239277 + -109.13072597484623, + -109.3202988487006, + -113.53294594518621, + -113.97055609730344 ], "moduleForcesY": [ - 37.169217718197665, - 36.26992503225888, - 16.79745494938532, - 12.695311902448891 + 36.90107882775114, + 36.22279873439767, + 19.561487229518704, + 16.596053973633666 ], - "timestamp": 1.0461736063071931 + "timestamp": 1.0462691456291267 }, { - "x": 14.154251482794562, - "y": 6.964387520079728, - "heading": -0.30775640664377, - "angularVelocity": 1.6137397640772269, - "velocityX": -2.7238947767776662, - "velocityY": 0.7367340532707765, + "x": 14.15402395976836, + "y": 6.963340036530724, + "heading": -0.30230713856933716, + "angularVelocity": 1.5766764603779295, + "velocityX": -2.7223213052722017, + "velocityY": 0.7458320325537722, "moduleForcesX": [ - -112.08031010757401, - -112.18021841591917, - -113.73249543230662, - -113.86796827837567 + -112.27314779877986, + -112.29121526331127, + -112.62446776737106, + -112.64475573276913 ], "moduleForcesY": [ - 26.31054160567366, - 25.791337814688173, - 17.883772198148794, - 16.866370546912236 + 25.3687700693123, + 25.27084960348355, + 23.762742580916523, + 23.647404391326813 ], - "timestamp": 1.090265578892359 + "timestamp": 1.0903747564070283 }, { "x": 14.018568992614746, "y": 6.998851299285889, "heading": -0.2405341289144176, - "angularVelocity": 1.5245922055201624, - "velocityX": -3.077260603792211, - "velocityY": 0.7816338708727887, + "angularVelocity": 1.4005703257570525, + "velocityX": -3.0711504673568144, + "velocityY": 0.8051416164258196, "moduleForcesX": [ - -114.82237403261927, - -114.74700757937691, - -112.85254185437864, - -112.7959826533612 + -114.88838435677177, + -114.82492813620281, + -109.50587966957576, + -110.01547367885283 ], "moduleForcesY": [ - 5.717046194433142, - 7.799925169065911, - 21.890043385783084, - 22.434461113364925 + 1.804812129477657, + 6.353046745851207, + 34.75647703160557, + 33.46666656638838 ], - "timestamp": 1.1343575514775248 + "timestamp": 1.13448036718493 }, { - "x": 13.785764027917146, - "y": 7.049557069939888, - "heading": -0.17998468944051094, - "angularVelocity": 0.9309010044100465, - "velocityX": -3.5791970553589576, - "velocityY": 0.7795621766496209, + "x": 13.788287000145154, + "y": 7.053740973657355, + "heading": -0.21166669107253983, + "angularVelocity": 0.44310544982728, + "velocityX": -3.5347510374590354, + "velocityY": 0.8425380176261146, "moduleForcesX": [ - -105.90034530214052, - -112.5578546807494, - -108.95118327774632, - -110.9158025657128 + -97.329322675789, + -112.16551931316292, + -90.56768367714201, + -104.13823940579265 ], "moduleForcesY": [ - -44.54881353554729, - -23.89201960495729, - 36.12411374491502, - 30.50757452772645 + -60.86272843982779, + -25.633925874682763, + 70.25124390630064, + 48.85031849268775 ], - "timestamp": 1.1994014596772797 + "timestamp": 1.1996283762042959 }, { - "x": 13.548480509194473, - "y": 7.083413324629865, - "heading": -0.23170832211848127, - "angularVelocity": -0.7952110214399025, - "velocityX": -3.6480513746799783, - "velocityY": 0.520513844063655, + "x": 13.55067748815617, + "y": 7.084433906415849, + "heading": -0.23000952086779244, + "angularVelocity": -0.2815562604499559, + "velocityX": -3.647225994555768, + "velocityY": 0.47112618206602946, "moduleForcesX": [ - 9.943360980697118, - -64.05615636732168, - 102.05846309668772, - -108.07396127616538 + -2.9715371277537543, + -50.32031969204716, + 26.184948512995206, + -70.95695667054495 ], "moduleForcesY": [ - -112.65864909231027, - -93.25868171164684, - -35.74086748752557, - 15.439504342633342 + -102.27224679452286, + -89.36908292050822, + -80.58938519969703, + -51.59319249987748 ], - "timestamp": 1.2644453678770347 + "timestamp": 1.2647763852236618 }, { - "x": 13.344677164525947, - "y": 7.110151219170367, - "heading": -0.28721528091170123, - "angularVelocity": -0.8533767470237762, - "velocityX": -3.1333194807825815, - "velocityY": 0.411074538423911, + "x": 13.346050543006005, + "y": 7.110014029553323, + "heading": -0.27803893764500576, + "angularVelocity": -0.7372353737308557, + "velocityX": -3.1409547003859206, + "velocityY": 0.3926462761105312, "moduleForcesX": [ - 111.64039245061323, - 111.67573063214599, - 113.05374138509697, - 113.12917537886882 + 107.29038544493396, + 105.50415195458457, + 114.90061482209745, + 113.70906001277713 ], "moduleForcesY": [ - -27.3804179148427, - -27.135696145803145, - -20.80013262963892, - -20.25362840349172 + -41.12412783239415, + -44.92027941539363, + 2.350623072487603, + 15.269282404330298 ], - "timestamp": 1.3294892760767896 + "timestamp": 1.3299243942430277 }, { - "x": 13.174758752766676, - "y": 7.131608923168944, - "heading": -0.33740943490813896, - "angularVelocity": -0.7716964645218987, - "velocityX": -2.612364731181882, - "velocityY": 0.32989567497511807, + "x": 13.17555433292844, + "y": 7.131108704498771, + "heading": -0.3278649259101783, + "angularVelocity": -0.7648121410795735, + "velocityX": -2.617059410470719, + "velocityY": 0.32379615682769, "moduleForcesX": [ - 114.5610194383314, - 114.39486717948932, - 113.08162800775546, - 112.89574776865835 + 113.95000686208219, + 114.00926980580654, + 114.37824029202245, + 114.432579234299 ], "moduleForcesY": [ - -12.147523599218806, - -13.756071322380498, - -21.984601963668993, - -23.002730233684403 + -16.845089796422403, + -16.397310132902103, + -13.650410305482506, + -13.135741678489495 ], - "timestamp": 1.3945331842765445 + "timestamp": 1.3950724032623936 }, { - "x": 13.03879537020891, - "y": 7.148379691490802, - "heading": -0.37942088256423195, - "angularVelocity": -0.6458936558220427, - "velocityX": -2.090332305067128, - "velocityY": 0.2578376482291461, + "x": 13.039211960013166, + "y": 7.1478899748634275, + "heading": -0.3721868233579608, + "angularVelocity": -0.6803262005229891, + "velocityX": -2.0928095112583573, + "velocityY": 0.257586849041975, "moduleForcesX": [ - 115.09723127896024, - 114.86715102435959, - 113.15121967782909, - 112.75876113770701 + 114.97790928984213, + 114.81105309086456, + 113.77046476766135, + 113.51984327567988 ], "moduleForcesY": [ - -6.694150425031576, - -10.065224665337288, - -22.080340952979505, - -24.086273621516778 + -8.413922151143758, + -10.5686669898906, + -18.601337026327453, + -20.14217381557217 ], - "timestamp": 1.4595770924762994 + "timestamp": 1.4602204122817595 }, { - "x": 12.93681096444313, - "y": 7.1607529171336655, - "heading": -0.4118889861172464, - "angularVelocity": -0.49917208931084484, - "velocityX": -1.5679317031900568, - "velocityY": 0.19022881596941998, + "x": 12.936993453855967, + "y": 7.16043119839742, + "heading": -0.4076788949391856, + "angularVelocity": -0.5447913468955652, + "velocityX": -1.5690196476582259, + "velocityY": 0.1925035580176633, "moduleForcesX": [ - 115.27036043262517, - 115.03722833246768, - 113.22264635282365, - 112.66564421864199 + 115.25718411477271, + 115.04192430676589, + 113.43999532206203, + 112.93907410546886 ], "moduleForcesY": [ - -3.897941495417185, - -8.482092446228034, - -21.944669919102676, - -24.71594535140867 + -4.1842117021754905, + -8.36626096655789, + -20.776774168788005, + -23.417109666661794 ], - "timestamp": 1.5246210006760543 + "timestamp": 1.5253684213011254 }, { - "x": 12.86881655254604, - "y": 7.168899399845526, - "heading": -0.4340261020129738, - "angularVelocity": -0.3403411096968923, - "velocityX": -1.045361722242647, - "velocityY": 0.1252458983067642, + "x": 12.868869943457646, + "y": 7.168770766708618, + "heading": -0.43245925393772605, + "angularVelocity": -0.38037016589677036, + "velocityX": -1.0456729441734487, + "velocityY": 0.1280095652457402, "moduleForcesX": [ - 115.34180830581067, - 115.1220732972316, - 113.27936411804733, - 112.60054698627378 + 115.34930465283051, + 115.14281844208664, + 113.24852185391626, + 112.55115361335103 ], "moduleForcesY": [ - -2.2058871322716747, - -7.623094959817495, - -21.792793628817755, - -25.125745546203547 + -1.6624491289951602, + -7.285612760344197, + -21.94224971099902, + -25.340251738278926 ], - "timestamp": 1.5896649088758092 + "timestamp": 1.5905164303204913 }, { "x": 12.83481788635254, - "y": 7.172932147979736, + "y": 7.172932147979735, "heading": -0.44530098242829574, - "angularVelocity": -0.17334260390221193, - "velocityX": -0.5227033112629944, - "velocityY": 0.06200039705217003, + "angularVelocity": -0.19711620790671255, + "velocityX": -0.5226876096087977, + "velocityY": 0.06387580117578445, "moduleForcesX": [ - 115.37550458711002, - 115.17526382073038, - 113.31339825214359, - 112.55684919025829 + 115.37974072229976, + 115.20102163601167, + 113.11488966367791, + 112.28107877840188 ], "moduleForcesY": [ - -1.08050082459098, - -7.042007188765636, - -21.71168485805975, - -25.396097743199675 + -0.004287565574101409, + -6.608776467019539, + -22.71557758012725, + -26.587848089395145 ], - "timestamp": 1.6547088170755642 + "timestamp": 1.6556644393398572 }, { "x": 12.83481788635254, "y": 7.172932147979736, "heading": -0.44530098242829574, - "angularVelocity": -3.9933853319259413e-22, - "velocityX": 8.259574098341232e-22, - "velocityY": -8.025414561021505e-21, + "angularVelocity": -4.3322696611731714e-20, + "velocityX": -8.054779748279346e-20, + "velocityY": -2.673843206569549e-19, "moduleForcesX": [ - 115.3927162988571, - 115.2157166646866, - 113.32030793770694, - 112.5314849425636 + 115.38688887330075, + 115.24383423254851, + 112.99392182289489, + 112.09250755639513 ], "moduleForcesY": [ - -0.2866941492311068, - -6.549472740050449, - -21.74513414149322, - -25.561679568405665 + 1.1556352772333405, + -6.047136158151505, + -23.37602173859373, + -27.42405623065844 ], - "timestamp": 1.719752725275319 + "timestamp": 1.720812448359223 }, { - "x": 12.807227728725032, - "y": 7.174709038499013, - "heading": -0.4281784561783119, - "angularVelocity": 0.2913880585511266, - "velocityX": -0.46952431836436137, - "velocityY": 0.030238801863144257, + "x": 12.806218245833676, + "y": 7.174820039076195, + "heading": -0.4245523778880747, + "angularVelocity": 0.3458966849026219, + "velocityX": -0.47678005649515354, + "velocityY": 0.03147273207971745, "moduleForcesX": [ - -111.63376359219195, - -113.03432284252689, - -115.30641606592077, - -113.87965459197578 + -110.78430493237788, + -112.32377906856804, + -115.23706895839638, + -113.12589486821221 ], "moduleForcesY": [ - 29.185604964347988, - 23.049027164974667, - -4.482758375470643, - -18.522278194463308 + 32.27146527448446, + 26.289960305975733, + -6.074152668020973, + -22.68521400402437 ], - "timestamp": 1.7785146605966307 + "timestamp": 1.780797424931237 }, { - "x": 12.75201337328418, - "y": 7.178230603874502, - "heading": -0.39459826783402535, - "angularVelocity": 0.5714615790080666, - "velocityX": -0.9396279264618801, - "velocityY": 0.05992936339201547, + "x": 12.748952905107773, + "y": 7.178545444277793, + "heading": -0.38415999659299915, + "angularVelocity": 0.6733749615886423, + "velocityX": -0.9546613835408188, + "velocityY": 0.062105637352804374, "moduleForcesX": [ - -111.97456605857009, - -113.08025540759344, - -115.2878683815402, - -114.07142344583939 + -111.34041034625368, + -112.46001862879739, + -115.21709287532448, + -113.49633756841047 ], "moduleForcesY": [ - 27.798664214369428, - 22.750200267155396, - -4.644259008500988, - -17.20495297529052 + 30.249349366921713, + 25.63630342009708, + -6.2116432185373744, + -20.667196776631027 ], - "timestamp": 1.8372765959179422 + "timestamp": 1.840782401503251 }, { - "x": 12.669133432086447, - "y": 7.183456533131369, - "heading": -0.34543352510474484, - "angularVelocity": 0.8366767101942217, - "velocityX": -1.410435867105893, - "velocityY": 0.08893392003330741, + "x": 12.662940297741304, + "y": 7.184048443151815, + "heading": -0.32564500296154497, + "angularVelocity": 0.975494148292365, + "velocityX": -1.4339024916215266, + "velocityY": 0.09173961862624963, "moduleForcesX": [ - -112.39241209224183, - -113.13856392421164, - -115.26232496995146, - -114.30163807419474 + -112.01287501883925, + -112.65201576445827, + -115.19409328267592, + -113.94247486613864 ], "moduleForcesY": [ - 25.984522474314748, - 22.361639151859034, - -4.855118557125519, - -15.454500356763997 + 27.582891138596644, + 24.690234496665074, + -6.303104707024134, + -17.90910605865672 ], - "timestamp": 1.8960385312392538 + "timestamp": 1.900767378075265 }, { - "x": 12.55853332818378, - "y": 7.1903382613240066, - "heading": -0.28201202301705236, - "angularVelocity": 1.0792956654831465, - "velocityX": -1.8821725883925233, - "velocityY": 0.11711200720343988, + "x": 12.548073202688675, + "y": 7.191263389762513, + "heading": -0.2514092768535465, + "angularVelocity": 1.237571978024797, + "velocityX": -1.9149310646929252, + "velocityY": 0.12027922695005987, "moduleForcesX": [ - -112.89842492883132, - -113.27691583678147, - -115.23714227829124, - -114.5802390264178 + -112.81041180905635, + -113.02354769728048, + -115.18961505698347, + -114.47046500698896 ], "moduleForcesY": [ - 23.57272456251679, - 21.510094456969895, - -4.864096919796805, - -12.981065814635949 + 23.98927394171314, + 22.793596210138528, + -5.8660066614304105, + -13.892228757886931 ], - "timestamp": 1.9548004665605654 + "timestamp": 1.960752354647279 }, { - "x": 12.420138411669608, - "y": 7.1988188813829685, - "heading": -0.20656770962185922, - "angularVelocity": 1.2838976964026465, - "velocityX": -2.3551796883037355, - "velocityY": 0.14432166014599362, + "x": 12.404212619219079, + "y": 7.200124822376674, + "heading": -0.1656029487785582, + "angularVelocity": 1.4304636423751034, + "velocityX": -2.398276896830811, + "velocityY": 0.14772753313528253, "moduleForcesX": [ - -113.50883091034551, - -113.59238050873091, - -115.2246253766407, - -114.89486558850359 + -113.74212753677462, + -113.71654311369026, + -115.22737898976276, + -115.00224148188839 ], "moduleForcesY": [ - 20.21586561081966, - 19.545611913909976, - -4.167774994305711, - -9.292159419632245 + 18.81992692642623, + 18.78236752442216, + -3.863631013963434, + -7.747401038811083 ], - "timestamp": 2.013562401881877 + "timestamp": 2.020737331219293 }, { - "x": 12.25385215279822, - "y": 7.20882879407445, - "heading": -0.12324014213695786, - "angularVelocity": 1.418053490397559, - "velocityX": -2.8298295139894725, - "velocityY": 0.17034688590065417, + "x": 12.231222631446618, + "y": 7.210562916135438, + "heading": -0.07622689905581251, + "angularVelocity": 1.4899739039732183, + "velocityX": -2.8838885610762883, + "velocityY": 0.17401180020855656, "moduleForcesX": [ - -114.24355796594509, - -114.20109143791724, - -115.21632171398484, - -115.14763181288494 + -114.76126852409654, + -114.7421155109847, + -115.16877303317679, + -115.16168855405087 ], "moduleForcesY": [ - 15.001571052472121, - 15.09888258206903, - -1.5352801286814335, - -3.4085278625122855 + 10.008825147658298, + 10.070314335440338, + 2.5624628546635875, + 2.2474118634241425 ], - "timestamp": 2.0723243372031885 + "timestamp": 2.080722307791307 }, { - "x": 12.059627085386966, - "y": 7.22024637414857, - "heading": -0.04129541884931243, - "angularVelocity": 1.3945204976583903, - "velocityX": -3.3052871105968005, - "velocityY": 0.19430231512438093, + "x": 12.029500394811427, + "y": 7.222385830186037, + "heading": -0.0039485688178259514, + "angularVelocity": 1.204940542924344, + "velocityX": -3.3628793101722345, + "velocityY": 0.19709791894983314, "moduleForcesX": [ - -114.97100473665364, - -114.97889469256124, - -114.8139912747789, - -114.82552416001533 + -114.04384036644842, + -114.49070976762575, + -111.91885906316082, + -113.1109806049009 ], "moduleForcesY": [ - 4.2427491405482245, - 4.253087696650936, - 7.355545167868264, - 7.30454562824674 + -14.076136858623709, + -11.072443207696098, + 26.086845583351657, + 20.922368283412005 ], - "timestamp": 2.1310862725245 + "timestamp": 2.140707284363321 }, { - "x": 11.839765743551363, - "y": 7.23241969553516, - "heading": -0.0006749768142111347, - "angularVelocity": 0.6912713445019788, - "velocityX": -3.7415605975772905, - "velocityY": 0.20716338425592043, + "x": 11.80460462204042, + "y": 7.235252445190618, + "heading": -0.0008006446065590651, + "angularVelocity": 0.05247854364813661, + "velocityX": -3.7492016438651103, + "velocityY": 0.2144972914865366, "moduleForcesX": [ - -102.78978326842798, - -110.70709433093434, - -99.03740787130111, - -109.17877166162 + -81.54498134539398, + -107.40451669387666, + -72.77164512682661, + -104.09396678970617 ], "moduleForcesY": [ - -49.60370655750785, - -29.865882900776136, - 56.82286597574406, - 35.07856026223796 + -79.06583770683336, + -39.74553876688151, + 87.47036330162258, + 47.81677142513769 ], - "timestamp": 2.1898482078458117 + "timestamp": 2.2006922609353348 }, { - "x": 11.606961624069507, - "y": 7.246562519511796, - "heading": -0.0005355014534405035, - "angularVelocity": 0.0023735664934787628, - "velocityX": -3.9618184494584505, - "velocityY": 0.24068002354419354, + "x": 11.578837837946322, + "y": 7.24893697247758, + "heading": -0.0006403041671407614, + "angularVelocity": 0.00267300995318069, + "velocityX": -3.763722135042569, + "velocityY": 0.22813257700507097, "moduleForcesX": [ - -38.90533896850442, - -71.13047771062192, - -35.06934232415729, - -67.80168692280769 + -1.905073107730994, + -4.979358092034403, + -1.8985551229214885, + -4.966710791426678 ], "moduleForcesY": [ - -29.244976944441376, - -20.88166507672035, - 46.999796252022335, - 35.52488241556469 + 1.1660681917013023, + 1.1666845103684094, + 5.292556396001393, + 5.28617190164468 ], - "timestamp": 2.2486101431671233 + "timestamp": 2.2606772375073487 }, { - "x": 11.374166105742725, - "y": 7.260879607361727, - "heading": -0.0004016151661947471, - "angularVelocity": 0.0022784526498942454, - "velocityX": -3.961672076555177, - "velocityY": 0.24364561465930565, + "x": 11.353074323427755, + "y": 7.262676760108333, + "heading": -0.00048021470173828523, + "angularVelocity": 0.002668826005296234, + "velocityX": -3.7636676284691517, + "velocityY": 0.22905381340371728, "moduleForcesX": [ - 0.038364732131467016, - 0.032375744635614497, - 0.038368146904853476, - 0.0323791503117189 + 0.013031053607783862, + 0.012772921444523999, + 0.013033680353923839, + 0.012775534950563829 ], "moduleForcesY": [ - 0.712634533787872, - 0.7126371600804828, - 0.7206706947523008, - 0.7206734674425367 + 0.2179094533492434, + 0.21791141098177333, + 0.21825566239591795, + 0.21825770061287675 ], - "timestamp": 2.307372078488435 + "timestamp": 2.3206622140793627 }, { - "x": 11.141371561910887, - "y": 7.275212536833178, - "heading": -0.00026773225352809773, - "angularVelocity": 0.002278395221916618, - "velocityX": -3.9616554927763006, - "velocityY": 0.24391520451254395, + "x": 11.127311121333316, + "y": 7.276421682496976, + "heading": -0.0003201284847273866, + "angularVelocity": 0.002668771851877109, + "velocityX": -3.7636624200962037, + "velocityY": 0.22913941413551184, "moduleForcesX": [ - 0.004009381579098697, - 0.004005764410869393, - 0.004009387088650458, - 0.004005769695837714 + 0.001234624812908876, + 0.0012312846204447392, + 0.0012346644208775844, + 0.0012313220175801665 ], "moduleForcesY": [ - 0.06514567586811906, - 0.06514567997746004, - 0.0651505264669484, - 0.06515053178951452 + 0.02026193639435043, + 0.020261967907305133, + 0.02026641742373401, + 0.02026644973896179 ], - "timestamp": 2.3661340138097464 + "timestamp": 2.3806471906513766 }, { - "x": 10.908578322216146, - "y": 7.289566634568185, - "heading": -0.0001338526766265076, - "angularVelocity": 0.0022783384544694425, - "velocityX": -3.9616332992067487, - "velocityY": 0.2442754421977271, + "x": 10.901548911262122, + "y": 7.290182893091728, + "heading": -0.00016004688535705913, + "angularVelocity": 0.0026686948719258762, + "velocityX": -3.7636458822345045, + "velocityY": 0.2294109522278709, "moduleForcesX": [ - 0.005365004147551414, - 0.005361429921381281, - 0.0053650047309120935, - 0.005361430429434329 + 0.003917363554224196, + 0.003912617107756982, + 0.003917372465434683, + 0.003912626035956667 ], "moduleForcesY": [ - 0.08705133042548914, - 0.0870513309885176, - 0.08705612689598109, - 0.08705612743994169 + 0.06427780505229556, + 0.06427781349839326, + 0.06428417983115862, + 0.06428418449535106 ], - "timestamp": 2.424895949131058 + "timestamp": 2.4406321672233906 }, { "x": 10.675800323486328, "y": 7.304165840148926, - "heading": 1.7042025537647997e-21, - "angularVelocity": 0.002277880670447602, - "velocityX": -3.9613739312189615, - "velocityY": 0.24844664323787644, + "heading": 4.902614731908987e-20, + "angularVelocity": 0.0026681161601341567, + "velocityX": -3.763418787115392, + "velocityY": 0.23310748551197824, "moduleForcesX": [ - 0.06269233899547927, - 0.06266351116723548, - 0.06269233826753248, - 0.06266351034664668 + 0.05377795064678017, + 0.053742159378856506, + 0.05377793434799179, + 0.05374214026788467 ], "moduleForcesY": [ - 1.007977935654259, - 1.0079779361307588, - 1.0080166121174583, - 1.008016612499835 + 0.8750534536430745, + 0.8750534628319293, + 0.875101282349867, + 0.8751012884750409 ], - "timestamp": 2.4836578844523696 + "timestamp": 2.5006171437954046 }, { - "x": 10.375996780740442, - "y": 7.329310693479934, - "heading": 2.0952126811330077e-9, - "angularVelocity": 2.764850905030086e-8, - "velocityX": -3.9562193564264954, - "velocityY": 0.33181247476771986, + "x": 10.387622426571776, + "y": 7.328344294067126, + "heading": 2.3254481669479827e-9, + "angularVelocity": 3.032787466640411e-8, + "velocityX": -3.7583392584954223, + "velocityY": 0.3153289462634989, "moduleForcesX": [ - 1.0229926855250218, - 0.9091406227519973, - 1.0226331700096871, - 0.9088211451962043 + 1.0067102595186133, + 0.8750670830655214, + 1.0063138780752319, + 0.8747253009280082 ], "moduleForcesY": [ - 15.547847834608662, - 15.548099923086475, - 15.695135166721935, - 15.695389362462524 + 15.141564196519592, + 15.141847578839105, + 15.312185150396871, + 15.312470356023791 ], - "timestamp": 2.5594381978616565 + "timestamp": 2.577294068653412 }, { - "x": 10.076214527720056, - "y": 7.354701655214317, - "heading": 2.094930318371914e-9, - "angularVelocity": -3.7260701149184505e-12, - "velocityX": -3.955938416370364, - "velocityY": 0.3350601309504519, + "x": 10.099463518452877, + "y": 7.3527474199811484, + "heading": 2.3248702362929507e-9, + "angularVelocity": -7.537217436692108e-12, + "velocityX": -3.75809161168789, + "velocityY": 0.3182590585004953, "moduleForcesX": [ - 0.05264500382423462, - 0.05264365410486792, - 0.05264500378601022, - 0.052643654069695955 + 0.04586372569533866, + 0.04586225728281445, + 0.04586372442294008, + 0.04586225608157109 ], "moduleForcesY": [ - 0.6085655004355156, - 0.6085655004799007, - 0.6085673123929624, - 0.60856731249484 + 0.5426416315110343, + 0.5426416339386481, + 0.5426435918286837, + 0.5426435952885554 ], - "timestamp": 2.6352185112709434 + "timestamp": 2.6539709935114195 }, { - "x": 9.797406327584714, - "y": 7.378325085957681, - "heading": 1.5073724891563739e-9, - "angularVelocity": -7.753436252528545e-9, - "velocityX": -3.679163988534978, - "velocityY": 0.31173572238710123, + "x": 9.814017805583175, + "y": 7.376928795577381, + "heading": 1.9467555589251595e-9, + "angularVelocity": -4.931270758027853e-9, + "velocityX": -3.722706843007822, + "velocityY": 0.31536705000900056, "moduleForcesX": [ - 51.863747239900356, - 51.86374695379424, - 51.863747256238625, - 51.86374697013233 + 6.5530881077342835, + 6.5530878919904225, + 6.553088110092179, + 6.553087894351924 ], "moduleForcesY": [ - -4.370675841289359, - -4.370675853259884, - -4.37067526479211, - -4.370675276765134 + -0.5355861518431727, + -0.5355861508230616, + -0.5355858164479997, + -0.535585816026562 ], - "timestamp": 2.7109988246802303 + "timestamp": 2.730647918369427 }, { - "x": 9.564977522412576, - "y": 7.398018834411508, - "heading": 1.0091532234135017e-9, - "angularVelocity": -6.574521050764288e-9, - "velocityX": -3.067139666166313, - "velocityY": 0.259879480142313, + "x": 9.576052798884584, + "y": 7.397087900656233, + "heading": 1.3998387250690954e-9, + "angularVelocity": -7.13274345402949e-9, + "velocityX": -3.1034761388678853, + "velocityY": 0.26290967088448547, "moduleForcesX": [ - 114.6849979131527, - 114.68499791407868, - 114.68499790306541, - 114.68499790399139 + 114.67853113769715, + 114.67853113597926, + 114.6785311563086, + 114.67853115459069 ], "moduleForcesY": [ - -9.717151397060475, - -9.717151389543696, - -9.717151516501819, - -9.71715150898504 + -9.71485297726741, + -9.714852991136166, + -9.714852756840832, + -9.714852770709586 ], - "timestamp": 2.7867791380895173 + "timestamp": 2.8073248432274345 }, { - "x": 9.379002999894094, - "y": 7.413776516620944, - "heading": 6.07279161464561e-10, - "angularVelocity": -5.303145947397083e-9, - "velocityX": -2.454127122885302, - "velocityY": 0.2079389949778709, + "x": 9.38564843718617, + "y": 7.413217936567628, + "heading": 8.817223023849284e-10, + "angularVelocity": -6.7571361741962134e-9, + "velocityX": -2.483202893843367, + "velocityY": 0.2103636255792007, "moduleForcesX": [ - 114.8701770137192, - 114.8701770145637, - 114.87017700281322, - 114.87017700365773 + 114.871604676597, + 114.8716046768432, + 114.87160467341323, + 114.87160467365942 ], "moduleForcesY": [ - -9.732937365029667, - -9.73293735690283, - -9.732937493953377, - -9.73293748582654 + -9.73127340414734, + -9.731273401774862, + -9.731273441790679, + -9.7312734394182 ], - "timestamp": 2.862559451498804 + "timestamp": 2.884001768085442 }, { - "x": 9.23950774412561, - "y": 7.425596002759894, - "heading": 3.043248809966869e-10, - "angularVelocity": -3.997796615482812e-9, - "velocityX": -1.8407848884851736, - "velocityY": 0.15597040454443006, + "x": 9.242830540920899, + "y": 7.425316707330115, + "heading": 4.5664978487651237e-10, + "angularVelocity": -5.5436823828756494e-9, + "velocityX": -1.8625929056198445, + "velocityY": 0.15778894086965362, "moduleForcesX": [ - 114.93195662610684, - 114.93195662692112, - 114.9319566149, - 114.93195661571428 + 114.93396789150813, + 114.93396789225454, + 114.93396788121369, + 114.9339678819601 ], "moduleForcesY": [ - -9.73820390689876, - -9.73820389854772, - -9.738204039306959, - -9.73820403095592 + -9.736577243932624, + -9.736577236261477, + -9.736577365581361, + -9.736577357910216 ], - "timestamp": 2.938339764908091 + "timestamp": 2.9606786929434494 }, { - "x": 9.146504246330785, - "y": 7.433476227985266, - "heading": 1.0162592903545258e-10, - "angularVelocity": -2.6748233524248435e-9, - "velocityX": -1.2272778194056342, - "velocityY": 0.10398776239958622, + "x": 9.147611861943055, + "y": 7.433383128421549, + "heading": 1.5641822672976188e-10, + "angularVelocity": -3.915539892904257e-9, + "velocityX": -1.2418166111143913, + "velocityY": 0.10520011211157348, "moduleForcesX": [ - 114.96284439351281, - 114.96284439431135, - 114.9628443821499, - 114.96284438294843 + 114.9647670121377, + 114.96476701310675, + 114.96476699831942, + 114.96476699928847 ], "moduleForcesY": [ - -9.74083700482707, - -9.740836996359715, - -9.74083713904288, - -9.740837130575525 + -9.739196633819809, + -9.739196623522792, + -9.739196797065262, + -9.739196786768243 ], - "timestamp": 3.014120078317378 + "timestamp": 3.037355617801457 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 7.916223464815508e-22, - "angularVelocity": -1.3410597616003847e-9, - "velocityX": -0.6136718659319499, - "velocityY": 0.051996690628184836, + "heading": 3.99836183035016e-20, + "angularVelocity": -2.039964787052138e-9, + "velocityX": -0.6209412027311271, + "velocityY": 0.052602853899473855, "moduleForcesX": [ - 114.98137397829139, - 114.98137397908025, - 114.98137396683289, - 114.98137396762175 + 114.98312242387729, + 114.98312242497133, + 114.98312240795504, + 114.98312240904907 ], "moduleForcesY": [ - -9.742416601179544, - -9.74241659264097, - -9.742416736502106, - -9.742416727963532 + -9.740757716301594, + -9.740757704436747, + -9.740757904372455, + -9.740757892507608 ], - "timestamp": 3.089900391726665 + "timestamp": 3.1140325426594644 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 8.037920803587129e-22, - "angularVelocity": 1.6446873974517507e-22, - "velocityX": -2.757905967086945e-22, - "velocityY": -1.294831886303353e-21, + "heading": 4.06614059613504e-20, + "angularVelocity": 8.844729643904558e-21, + "velocityX": -1.4964447302773342e-20, + "velocityY": -4.1999091669097654e-20, "moduleForcesX": [ - 114.99372507265782, - 114.99372507344016, - 114.99372506113471, - 114.99372506191705 + 114.99530721950912, + 114.99530722068296, + 114.99530720218843, + 114.99530720336229 ], "moduleForcesY": [ - -9.743469497838449, - -9.743469489251723, - -9.743469633909358, - -9.74346962532263 + -9.741794002809645, + -9.741793989902737, + -9.741794207376442, + -9.741794194469533 ], - "timestamp": 3.165680705135952 + "timestamp": 3.190709467517472 }, { - "x": 9.164075734077805, - "y": 7.4270458645926025, - "heading": -0.011277793242374901, - "angularVelocity": -0.1261254526683904, - "velocityX": 0.7165924034905254, - "velocityY": -0.11598083104372046, + "x": 9.158729002384682, + "y": 7.427913275125405, + "heading": -0.011345627876544048, + "angularVelocity": -0.1325178974362472, + "velocityX": 0.6859597370222545, + "velocityY": -0.1109990987101228, "moduleForcesX": [ - 113.09738136430255, - 112.7673730946546, - 114.71860842032127, - 114.61964933108011 + 113.00915752320314, + 112.63135889504281, + 114.77561717238223, + 114.67559733618697 ], "moduleForcesY": [ - -23.006176875829937, - -24.55462377070611, - -12.640293814526908, - -13.473735738920114 + -23.425636698784487, + -25.159294856402457, + -12.091339079978018, + -12.964745355934468 ], - "timestamp": 3.255097971863442 + "timestamp": 3.2763252831623157 }, { - "x": 9.29222001122731, - "y": 7.406304055209759, - "heading": -0.03377768545568418, - "angularVelocity": -0.2516280472079336, - "velocityX": 1.4331043862036081, - "velocityY": -0.23196648859841448, + "x": 9.276180573932086, + "y": 7.408905935250988, + "heading": -0.03395538753487, + "angularVelocity": -0.2640839135623844, + "velocityX": 1.371844333465473, + "velocityY": -0.22200734445215983, "moduleForcesX": [ - 113.0694204236125, - 112.7779690278557, - 114.69165035279205, - 114.61288648897437 + 112.98106218312499, + 112.64778912905899, + 114.74591804100635, + 114.66711046089802 ], "moduleForcesY": [ - -23.075208455820306, - -24.43716999398038, - -12.759685477746057, - -13.405832230605759 + -23.491323485598002, + -25.015409413102297, + -12.2368225134811, + -12.903529067142655 ], - "timestamp": 3.344515238590932 + "timestamp": 3.3619410988071596 }, { - "x": 9.484420777015211, - "y": 7.375190745931852, - "heading": -0.06740746126447136, - "angularVelocity": -0.37609934903599723, - "velocityX": 2.1494815578925746, - "velocityY": -0.3479563893708387, + "x": 9.452343907652057, + "y": 7.38039364196082, + "heading": -0.06769375321072268, + "angularVelocity": -0.39406697724878365, + "velocityX": 2.0576027033456232, + "velocityY": -0.3330260078166348, "moduleForcesX": [ - 113.02648757078286, - 112.79182810566901, - 114.64860236410797, - 114.59937186585587 + 112.9386256400279, + 112.67062512533334, + 114.69841226670894, + 114.65047328808508 ], "moduleForcesY": [ - -23.171552214300505, - -24.2575926575561, - -12.939705956083847, - -13.311740761370503 + -23.578915171806088, + -24.794121720549402, + -12.457213413083553, + -12.82374562009901 ], - "timestamp": 3.4339325053184218 + "timestamp": 3.4475569144520035 }, { - "x": 9.740654140944983, - "y": 7.333706777922525, - "heading": -0.11195989555510154, - "angularVelocity": -0.4982531441763822, - "velocityX": 2.8655915496799285, - "velocityY": -0.4639368829708782, + "x": 9.687197586383895, + "y": 7.342376469148144, + "heading": -0.11226638905729562, + "angularVelocity": -0.5206121732399493, + "velocityX": 2.743110918969357, + "velocityY": -0.44404380810177685, "moduleForcesX": [ - 112.96263341798881, - 112.8024310121022, - 114.57186680035291, - 114.55963723401477 + 112.87896079459628, + 112.69640034788527, + 114.61328861565241, + 114.60352473160059 ], "moduleForcesY": [ - -23.25555865139767, - -23.974881093119578, - -13.211149123897183, - -13.233026976268087 + -23.631898261793967, + -24.43715365857457, + -12.797480453077931, + -12.786890952496725 ], - "timestamp": 3.5233497720459117 + "timestamp": 3.5331727300968474 }, { - "x": 10.060848676971931, - "y": 7.281860220949749, - "heading": -0.16679543077391148, - "angularVelocity": -0.6132544331278634, - "velocityX": 3.580902746700832, - "velocityY": -0.5798271281405271, + "x": 9.980677153153964, + "y": 7.294861028140363, + "heading": -0.16677637741321044, + "angularVelocity": -0.6366812947509158, + "velocityX": 3.4278662716652395, + "velocityY": -0.5549843875211934, "moduleForcesX": [ - 112.84129933826836, - 112.76864885600135, - 114.3772823040652, - 114.40191731519991 + 112.77901668126034, + 112.69725731706323, + 114.39506493358313, + 114.4213577102299 ], "moduleForcesY": [ - -23.163205809397628, - -23.425697611861274, - -13.69531288022575, - -13.333070778392425 + -23.40728121770182, + -23.70138914183569, + -13.446589360294247, + -13.046932352219967 ], - "timestamp": 3.6127670387734017 + "timestamp": 3.6187885457416913 }, { - "x": 10.41129384334292, - "y": 7.2250876773172195, - "heading": -0.1668212421294265, - "angularVelocity": -0.0002886618710195688, - "velocityX": 3.9192113469427756, - "velocityY": -0.6349170099948512, + "x": 10.299439397239984, + "y": 7.243222544857861, + "heading": -0.16680362160119563, + "angularVelocity": -0.00031821443012600435, + "velocityX": 3.723170090539417, + "velocityY": -0.6031418715522293, "moduleForcesX": [ - 48.09172614407473, - 65.77795724959624, - 41.06473783405297, - 59.97030443873925 + 42.223193429450774, + 62.56452184359159, + 34.743970358798585, + 56.38407855591621 ], "moduleForcesY": [ - 13.930551075122137, - 7.145486045502102, - -28.297723373409983, - -27.773214670319934 + 16.217064048220223, + 8.77165872965158, + -28.615859678623103, + -28.322366228837797 ], - "timestamp": 3.7021843055008916 + "timestamp": 3.704404361386535 }, { - "x": 10.761739409451776, - "y": 7.168314324053237, - "heading": -0.16684631379631512, - "angularVelocity": -0.00028038954674184204, - "velocityX": 3.9192158174201577, - "velocityY": -0.6349260645262742, + "x": 10.618201967925774, + "y": 7.191583190738454, + "heading": -0.16683012378420822, + "angularVelocity": -0.0003095477490107596, + "velocityX": 3.723173905252498, + "velocityY": -0.60315204300127, "moduleForcesX": [ - 0.0005793240121072635, - 0.0009168544852833605, - 0.0005030425526133945, - 0.0008405728974754847 + 0.0004897050109594019, + 0.0008590684186937887, + 0.00040634585315998815, + 0.0007757061947028893 ], "moduleForcesY": [ - -0.0011830360653050716, - -0.0012398789775864547, - -0.0016359884022599947, - -0.001692832071165764 + -0.001408166713429625, + -0.0014702823341160227, + -0.0019037711048343804, + -0.001965905284357917 ], - "timestamp": 3.7916015722283816 + "timestamp": 3.790020177031379 }, { - "x": 11.112184972267482, - "y": 7.111540950421515, - "heading": -0.16687138545298627, - "angularVelocity": -0.00028038943247455934, - "velocityX": 3.9192157805911356, - "velocityY": -0.6349262923093676, + "x": 10.936964535235408, + "y": 7.139943815739948, + "heading": -0.16685662595604722, + "angularVelocity": -0.0003095476185024568, + "velocityX": 3.7231738658186835, + "velocityY": -0.6031522868709133, "moduleForcesX": [ - -0.000005850554579745332, - -0.000005845897104160572, - -0.000005851605075096937, - -0.000005846946542409484 + -0.0000065426488173444, + -0.000006537391676682717, + -0.000006543595223207877, + -0.0000065382539258484816 ], "moduleForcesY": [ - -0.000036170301490425664, - -0.00003617108561777815, - -0.0000361765653900908, - -0.00003617734391211807 + -0.00004044379525409588, + -0.000040444633841499524, + -0.00004045179634633909, + -0.000040452153945866205 ], - "timestamp": 3.8810188389558715 + "timestamp": 3.875635992676223 }, { - "x": 11.462630522276916, - "y": 7.054767497780465, - "heading": -0.16689645711343162, - "angularVelocity": -0.00028038947468350146, - "velocityX": 3.9192156373718943, - "velocityY": -0.6349271759119326, + "x": 11.255727102089605, + "y": 7.088304437930091, + "heading": -0.1668831281242396, + "angularVelocity": -0.0003095475759096733, + "velocityX": 3.7231738604991516, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - -0.000022743718365883173, - -0.000022745437083135405, - -0.000022743343544297057, - -0.000022745063428281636 + -8.829967596549955e-7, + -8.811818122884496e-7, + -8.83407730166138e-7, + -8.815927827995014e-7 ], "moduleForcesY": [ - -0.0001403246359939683, - -0.00014032435530360055, - -0.00014032231584433397, - -0.00014032204068779427 + -0.000005444926099204542, + -0.000005445232343639541, + -0.000005447361702145372, + -0.000005447667946580389 ], - "timestamp": 3.9704361056833615 + "timestamp": 3.961251808321067 }, { - "x": 11.813075052865031, - "y": 6.997991026251115, - "heading": -0.1669222646722176, - "angularVelocity": -0.0002886194102157951, - "velocityX": 3.919204236650811, - "velocityY": -0.6349609377166883, + "x": 11.574489654914423, + "y": 7.03666497355743, + "heading": -0.16690963029636716, + "angularVelocity": -0.0003095476218725492, + "velocityX": 3.723173696634823, + "velocityY": -0.6031533307686342, "moduleForcesX": [ - -0.0016805912310601232, - -0.0020163880861174925, - -0.0016046680941889473, - -0.0019404647758239804 + -0.000027178077701561358, + -0.000027179633990853534, + -0.000027177224588690765, + -0.00002717888034638878 ], "moduleForcesY": [ - -0.00561525265620871, - -0.00555867675995663, - -0.0051646268094223844, - -0.005108050168229615 + -0.00016769583752692974, + -0.00016769506176135174, + -0.00016769279541623932, + -0.00016769249521777092 ], - "timestamp": 4.059853372410852 + "timestamp": 4.046867623965911 }, { - "x": 12.133260147509837, - "y": 6.946071670476197, - "heading": -0.2214120834435135, - "angularVelocity": -0.6093881055138954, - "velocityX": 3.5807971587926977, - "velocityY": -0.5806412751705889, + "x": 11.89325121567058, + "y": 6.985022268597528, + "heading": -0.16693687038180605, + "angularVelocity": -0.00031816651203696647, + "velocityX": 3.7231621091885887, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - -48.98536673051253, - -66.16678250893118, - -40.57967406296097, - -59.23545857774057 + -0.001779708571581063, + -0.002147028456388743, + -0.001696749596509706, + -0.002064065106765412 ], "moduleForcesY": [ - -14.49226605581401, - -6.32104906707722, - 27.138034597036604, - 28.180912866906336 + -0.006555181384699155, + -0.006493363428438249, + -0.006062320028938968, + -0.006000483846621922 ], - "timestamp": 4.149270639138342 + "timestamp": 4.132483439610755 }, { - "x": 12.389484680735665, - "y": 6.904520503456371, - "heading": -0.26566908147622087, - "angularVelocity": -0.494949126185951, - "velocityX": 2.8654927913050736, - "velocityY": -0.46468840460599237, + "x": 12.18672005263425, + "y": 6.937424176402156, + "heading": -0.2210923200647369, + "angularVelocity": -0.6325402529315551, + "velocityX": 3.427740946614994, + "velocityY": -0.5559497604136832, "moduleForcesX": [ - -112.7694787816175, - -112.84469963183767, - -114.33052227126576, - -114.44010878513953 + -43.253472476542086, + -63.00675890235155, + -34.1682886774338, + -55.5650943963929 ], "moduleForcesY": [ - 23.504795933148486, - 23.05021971834787, - 14.088814392674252, - 13.013238741851007 + -16.812254107810563, + -7.912658283060262, + 27.348618818937386, + 28.718045503658878 ], - "timestamp": 4.238687905865832 + "timestamp": 4.2180992552555985 }, { - "x": 12.581677956353516, - "y": 6.873351406790412, - "heading": -0.2990847660317501, - "angularVelocity": -0.37370505472245713, - "velocityX": 2.1493977914085036, - "velocityY": -0.34858028887139747, + "x": 12.42156370881826, + "y": 6.899331547752736, + "heading": -0.2653717816908411, + "angularVelocity": -0.5171878734390234, + "velocityX": 2.7429938547592765, + "velocityY": -0.4449251386851015, "moduleForcesX": [ - -112.81581362288203, - -112.95645164652021, - -114.4800037317309, - -114.63477612228742 + -112.70336730639953, + -112.77868429037684, + -114.34574505410617, + -114.45941943627881 ], "moduleForcesY": [ - 23.952236268957105, - 23.23198064868569, - 13.993453486124862, - 12.578015209156012 + 23.762739676331556, + 23.303963933906203, + 13.868946571317782, + 12.722298748930942 ], - "timestamp": 4.328105172593322 + "timestamp": 4.303715070900442 }, { - "x": 12.70981674564107, - "y": 6.85256977540764, - "heading": -0.32145862582537077, - "angularVelocity": -0.25021856082682203, - "velocityX": 1.433043012576884, - "velocityY": -0.23241183882421468, + "x": 12.597718540040942, + "y": 6.8707567698528536, + "heading": -0.29890040217417135, + "angularVelocity": -0.39161713558176675, + "velocityX": 2.057503393454997, + "velocityY": -0.33375583336632164, "moduleForcesX": [ - -112.82068889216025, - -113.0039471018814, - -114.52336848119276, - -114.70406075329403 + -112.71749084303553, + -112.86515330511084, + -114.51664915991034, + -114.6811022921368 ], "moduleForcesY": [ - 24.148746420326255, - 23.24343434131617, - 14.012855946804562, - 12.388975239916268 + 24.3844752316013, + 23.638347947621615, + 13.64501010429044, + 12.086104233396249 ], - "timestamp": 4.417522439320812 + "timestamp": 4.389330886545286 + }, + { + "x": 12.715163878739139, + "y": 6.851704848123817, + "heading": -0.32138821070438484, + "angularVelocity": -0.26265951402599025, + "velocityX": 1.3717715332572546, + "velocityY": -0.22252806430143826, + "moduleForcesX": [ + -112.70949942311833, + -112.90541799785672, + -114.56628411956218, + -114.75934724991008 + ], + "moduleForcesY": [ + 24.64547404232941, + 23.69527448754719, + 13.628136423288359, + 11.823839632394252 + ], + "timestamp": 4.47494670219013 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -0.12555956863634032, - "velocityX": 0.7165595452629516, - "velocityY": -0.11621279716307112, + "angularVelocity": -0.13195702773884246, + "velocityX": 0.6859207314037198, + "velocityY": -0.11127036897917744, "moduleForcesX": [ - -112.8221827849924, - -113.02767779062647, - -114.54498863487578, - -114.73896316536626 + -112.70422548752346, + -112.925655713762, + -114.59090344176342, + -114.79867455728487 ], "moduleForcesY": [ - 24.250854636389008, - 23.249516784409256, - 14.022523907560226, - 12.290549417164618 + 24.780696781270144, + 23.723484974899865, + 13.620484396497059, + 11.687912648139795 ], - "timestamp": 4.506939706048302 + "timestamp": 4.560562517834974 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -6.396298753724966e-21, - "velocityX": 2.2882522060511837e-20, - "velocityY": -2.4594541543729887e-20, + "angularVelocity": -1.0481075996790548e-19, + "velocityX": 5.399599322710278e-19, + "velocityY": -9.80243210157971e-19, "moduleForcesX": [ - -112.82700125465155, - -113.0347603386625, - -114.5621659937604, - -114.75821199877026 + -112.7054623515789, + -112.92977017260733, + -114.61013224495392, + -114.8204883495519 ], "moduleForcesY": [ - 24.293809761632847, - 23.288094379310174, - 13.993645143555229, - 12.246633407284664 + 24.84159448258286, + 23.778744232903236, + 13.5778974907208, + 11.622750779733966 ], - "timestamp": 4.596356972775792 + "timestamp": 4.646178333479818 }, { - "x": 12.75399450349522, - "y": 6.841766146112416, - "heading": -0.305766058140526, - "angularVelocity": 0.5268296966780065, - "velocityX": -0.3893532656410479, - "velocityY": -0.008066879563426856, + "x": 12.753385587015702, + "y": 6.841782127477455, + "heading": -0.30142200681603537, + "angularVelocity": 0.5981564744362009, + "velocityX": -0.39229294961925354, + "velocityY": -0.00758064657775971, "moduleForcesX": [ - -109.7288300984058, - -109.4206374282859, - -112.53880632418142, - -101.12162507107456 + -108.8413082444939, + -107.42080956929516, + -112.04459817860715, + -98.01523216314021 ], "moduleForcesY": [ - 35.669533302226604, - 36.387074666689884, - -25.504590588279502, - -55.51926033598724 + 38.29718260293832, + 41.90465414683766, + -27.603083990034282, + -60.83697376383006 ], - "timestamp": 4.647454625952017 + "timestamp": 4.69844527998031 }, { - "x": 12.714061656462052, - "y": 6.840779251207409, - "heading": -0.2532975989930795, - "angularVelocity": 1.0268271806239895, - "velocityX": -0.7815006081678176, - "velocityY": -0.019313898851738565, + "x": 12.712181951373154, + "y": 6.840743713694041, + "heading": -0.24058628304443966, + "angularVelocity": 1.1639425649444288, + "velocityX": -0.7883306449165999, + "velocityY": -0.019867504281806173, "moduleForcesX": [ - -110.81993188505729, - -110.0950661211093, - -112.36550007471497, - -102.63533121639855 + -110.25146907706204, + -108.49838326382822, + -111.77509833383621, + -99.86657679489407 ], "moduleForcesY": [ - 32.07800706429278, - 34.2533713879541, - -26.203707120752757, - -52.6299968823863 + 33.98129300971091, + 38.992548405352025, + -28.619699977126256, + -57.706808413427645 ], - "timestamp": 4.698552279128243 + "timestamp": 4.750712226480801 }, { - "x": 12.65392586500865, - "y": 6.839035138240057, - "heading": -0.1770515773993922, - "angularVelocity": 1.4921628852646045, - "velocityX": -1.1768797139470222, - "velocityY": -0.03413293681682431, + "x": 12.650044214892105, + "y": 6.8387849883626215, + "heading": -0.1525027567272929, + "angularVelocity": 1.6852625266011638, + "velocityX": -1.1888533890238768, + "velocityY": -0.037475411566368036, "moduleForcesX": [ - -112.01913727447982, - -110.82018043359403, - -112.13805673866041, - -104.53092279690576 + -111.79514898339704, + -109.70138251498295, + -111.44106852220095, + -102.32802663455409 ], "moduleForcesY": [ - 27.537215204389696, - 31.77880633104241, - -27.08883274674824, - -48.700214418067695 + 28.423757447065572, + 35.415890676664, + -29.81768363836112, + -53.15724933762533 ], - "timestamp": 4.749649932304468 + "timestamp": 4.802979172981293 }, { - "x": 12.573375826882684, - "y": 6.836347748309206, - "heading": -0.07973620783654102, - "angularVelocity": 1.9044978294253423, - "velocityX": -1.5763940830739311, - "velocityY": -0.05259321639650792, + "x": 12.56665849968872, + "y": 6.835624849307061, + "heading": -0.041001428555590726, + "angularVelocity": 2.1333048061388658, + "velocityX": -1.5953814176348047, + "velocityY": -0.060461520466354446, "moduleForcesX": [ - -113.23819484894514, - -111.82728548746545, - -112.00948759102613, - -107.03013912743917 + -113.33306294894338, + -111.36765197462111, + -111.29923323362245, + -105.79188446547711 ], "moduleForcesY": [ - 21.882075353027112, - 27.953507157746554, - -27.513403358833262, - -42.84285393246143 + 21.344964061000436, + 29.67677517374125, + -30.226858179680615, + -45.774893406209785 ], - "timestamp": 4.800747585480694 + "timestamp": 4.855246119481785 }, { - "x": 12.472142423483454, - "y": 6.832556869927306, - "heading": 0.0343228381313417, - "angularVelocity": 2.2321777787820345, - "velocityX": -1.9811752029020766, - "velocityY": -0.07418889413231182, + "x": 12.461620097191034, + "y": 6.831026292095148, + "heading": 0.08742245485977619, + "angularVelocity": 2.4570764510637413, + "velocityX": -2.009652553487107, + "velocityY": -0.08798212866492651, "moduleForcesX": [ - -114.34728768901107, - -113.22575760455813, - -112.26817875434023, - -110.11846813519524 + -114.6447825791982, + -113.5383273084868, + -111.87702649396596, + -110.14647037122361 ], "moduleForcesY": [ - 14.79403533609548, - 21.457523434245793, - -26.272584682099957, - -33.98499618387014 + 12.088459054314818, + 19.59915376642277, + -27.79947446244152, + -33.7959899091021 ], - "timestamp": 4.851845238656919 + "timestamp": 4.907513065982276 }, { - "x": 12.34992963494983, - "y": 6.827548067939446, - "heading": 0.15826458263637594, - "angularVelocity": 2.4255858498546536, - "velocityX": -2.3917495410628016, - "velocityY": -0.09802411023818115, + "x": 12.334544332063512, + "y": 6.824790196070031, + "heading": 0.22169906935297032, + "angularVelocity": 2.5690541247120793, + "velocityX": -2.4312835096712537, + "velocityY": -0.11931242291082081, "moduleForcesX": [ - -115.11333345954517, - -114.74574741924968, - -113.34482631497849, - -113.1955980388714 + -115.17279654304959, + -115.14891953151032, + -113.8889949915641, + -113.99413512743355 ], "moduleForcesY": [ - 5.448077962340946, - 10.194849320269142, - -20.799257564932656, - -21.339190325625058 + -1.6355007974511553, + 1.0232280605865918, + -17.189766351140257, + -16.24596532339107 ], - "timestamp": 4.902942891833145 + "timestamp": 4.959780012482768 }, { - "x": 12.206597161799994, - "y": 6.821199257095827, - "heading": 0.2805699285354723, - "angularVelocity": 2.393560922989729, - "velocityX": -2.805069592051702, - "velocityY": -0.12424857990490915, + "x": 12.185948955691865, + "y": 6.816459874974, + "heading": 0.33880653198690125, + "angularVelocity": 2.2405644575550046, + "velocityX": -2.8430085612566742, + "velocityY": -0.15938029010259208, "moduleForcesX": [ - -114.73378991745247, - -114.6841205049078, - -115.02985196430274, - -115.00391113761037 + -109.76726168084946, + -109.54277500123322, + -113.18437639744384, + -114.94525226928013 ], "moduleForcesY": [ - -9.331880356810258, - -10.050186347462049, - -4.453466685132893, - -5.315910986053548 + -33.87003877484263, + -35.13851211848978, + 20.071079184942906, + 5.393963684061636 ], - "timestamp": 4.95404054500937 + "timestamp": 5.01204695898326 }, { - "x": 12.043550195136016, - "y": 6.812872270792408, - "heading": 0.37568052330999124, - "angularVelocity": 1.8613495701358527, - "velocityX": -3.1908895326691793, - "velocityY": -0.16296220639921025, + "x": 12.018989253325442, + "y": 6.8051390333200885, + "heading": 0.41041046526758185, + "angularVelocity": 1.3699658785310278, + "velocityX": -3.194364958069012, + "velocityY": -0.21659657607496546, "moduleForcesX": [ - -102.79608932766197, - -104.86344163188949, - -106.89092371318497, - -114.33175651351912 + -78.10169132485171, + -96.13389774106385, + -94.13325434178383, + -113.46555797863145 ], "moduleForcesY": [ - -50.77985160422074, - -47.216095581596974, - 42.06566908876746, - 12.895732740628755 + -83.01049814576065, + -62.80652414189374, + 65.38310369002106, + 18.254472024247004 ], - "timestamp": 5.005138198185596 + "timestamp": 5.064313905483751 }, { - "x": 11.86287182736092, - "y": 6.802007556416456, - "heading": 0.42796486587483507, - "angularVelocity": 1.0232239509028977, - "velocityX": -3.5359425833505957, - "velocityY": -0.21262648479142307, + "x": 11.833657880476915, + "y": 6.7914137455253085, + "heading": 0.4377864800344317, + "angularVelocity": 0.5237729884716399, + "velocityX": -3.5458618736562415, + "velocityY": -0.26259976359377907, "moduleForcesX": [ - -80.87009063485023, - -96.67728867515605, - -92.79877473998546, - -113.21907877847823 + -81.50657246245372, + -96.52600367181357, + -91.36526851275521, + -112.58926465292839 ], "moduleForcesY": [ - -79.97059189776519, - -61.82807121867147, - 67.16099978368727, - 19.43023807698715 + -77.03852162154085, + -60.91221738822319, + 67.84251293202183, + 20.114545224135288 ], - "timestamp": 5.056235851361821 + "timestamp": 5.116580851984243 }, { - "x": 11.664633065712652, - "y": 6.7891315300219, - "heading": 0.43821140426349137, - "angularVelocity": 0.20052855173833478, - "velocityX": -3.8796059960832747, - "velocityY": -0.25198860601576917, + "x": 11.636885911361938, + "y": 6.781657287742647, + "heading": 0.4381195657454411, + "angularVelocity": 0.0063727792287653654, + "velocityX": -3.764749660918859, + "velocityY": -0.18666592245960945, "moduleForcesX": [ - -82.8099099991411, - -97.03131746492355, - -89.98282568718102, - -112.19644097022719 + -39.57182354200839, + -70.977437875031, + -50.32863077942037, + -76.99706320058098 ], "moduleForcesY": [ - -74.87714839288478, - -59.775887106560354, - 69.37126688318338, - 21.526348508475152 + 6.664753543230538, + -15.9657457537299, + 58.329975351840964, + 33.49165128421014 ], - "timestamp": 5.107333504538047 + "timestamp": 5.168847798484735 }, { - "x": 11.462084020525632, - "y": 6.780072353267369, - "heading": 0.4385154377916661, - "angularVelocity": 0.00595004876498203, - "velocityX": -3.9639598415305968, - "velocityY": -0.1772914447418647, + "x": 11.44006845734196, + "y": 6.772736369563235, + "heading": 0.43843743025567056, + "angularVelocity": 0.006081558834253376, + "velocityX": -3.7656199031658693, + "velocityY": -0.1706799187000424, "moduleForcesX": [ - -13.088021988665616, - -26.977283498936934, - -20.501105728823166, - -33.202365222684826 + -0.22117703166854616, + -0.2400226961394301, + -0.23285423489332768, + -0.25167644227536323 ], "moduleForcesY": [ - 15.885560108854344, - 8.723342744728185, - 32.68451149483246, - 25.740872695475744 + 4.334916585446057, + 4.326391928789567, + 4.359954585223913, + 4.351428080985648 ], - "timestamp": 5.158431157714272 + "timestamp": 5.221114744985226 }, { - "x": 11.259528982095853, - "y": 6.771117377305431, - "heading": 0.43881605165352044, - "angularVelocity": 0.005883124628398257, - "velocityX": -3.964077131511387, - "velocityY": -0.17525219663325328, + "x": 11.243256268673136, + "y": 6.763700701720559, + "heading": 0.4387554337586175, + "angularVelocity": 0.006084218119455662, + "velocityX": -3.7655191635688174, + "velocityY": -0.17287537244203355, "moduleForcesX": [ - -0.029013194122842832, - -0.033411893880355564, - -0.03177958055818728, - -0.036176322713582246 + 0.027246197185640832, + 0.027387868108118486, + 0.027350411158643794, + 0.02749366051981494 ], "moduleForcesY": [ - 0.5648011109503727, - 0.5627467701499554, - 0.5706799263120281, - 0.5686255765235023 + -0.5963956352276373, + -0.5963054368452669, + -0.5966429834962519, + -0.59655178395572 ], - "timestamp": 5.209528810890498 + "timestamp": 5.273381691485718 }, { - "x": 11.057156198653269, - "y": 6.758726217540709, - "heading": 0.4391223685729557, - "angularVelocity": 0.005994735577754182, - "velocityX": -3.960510333902073, - "velocityY": -0.24249958646803477, + "x": 11.046545630444271, + "y": 6.752686472005722, + "heading": 0.43907714703071105, + "angularVelocity": 0.006155195465465934, + "velocityX": -3.7635762446351886, + "velocityY": -0.2107303076283464, "moduleForcesX": [ - 0.9850808010020188, - 0.9926378040046129, - 0.9898104285367836, - 0.9973672418755148 + 0.5239825346725352, + 0.5287852184841983, + 0.5269382194510348, + 0.5317492184600278 ], "moduleForcesY": [ - -18.685150756065987, - -18.681766202326127, - -18.694748257197254, - -18.691363885723828 + -10.28276906511369, + -10.280662894429112, + -10.28864362114341, + -10.286542208886416 ], - "timestamp": 5.260626464066723 + "timestamp": 5.32564863798621 }, { - "x": 10.856270538125138, - "y": 6.731334695007788, - "heading": 0.439461064317222, - "angularVelocity": 0.006628401173301292, - "velocityX": -3.9314067876134358, - "velocityY": -0.5360622422022665, + "x": 10.851002317831199, + "y": 6.728677589687026, + "heading": 0.4394302072073043, + "angularVelocity": 0.006754941702782354, + "velocityX": -3.7412423281936964, + "velocityY": -0.4593511564422143, "moduleForcesX": [ - 8.032996251393905, - 8.10506598626941, - 8.070890615781677, - 8.142908653908856 + 6.0235300238737315, + 6.080411522594157, + 6.055226639619957, + 6.112078025502511 ], "moduleForcesY": [ - -81.57543466978522, - -81.55969024172876, - -81.60424655492223, - -81.58850238971223 + -67.53691218233139, + -67.52145044143396, + -67.57213537559059, + -67.55667901028482 ], - "timestamp": 5.311724117242949 + "timestamp": 5.3779155844867015 }, { "x": 10.659042358398438, "y": 6.684422969818115, "heading": 0.4398426718598864, - "angularVelocity": 0.007468200963130881, - "velocityX": -3.859828533543358, - "velocityY": -0.9180798387722997, + "angularVelocity": 0.007891500847063856, + "velocityX": -3.6726836420596647, + "velocityY": -0.8467037550871565, "moduleForcesX": [ - 19.797209295771516, - 19.935633669547133, - 19.84811263846736, - 19.986315671242973 + 18.502266587341634, + 18.68181883852657, + 18.57123057302974, + 18.75041412959953 ], "moduleForcesY": [ - -106.1764049578853, - -106.14800306857407, - -106.17974187192408, - -106.15132868263454 + -105.25254288064538, + -105.21692402603102, + -105.25961417671951, + -105.22397106219512 ], - "timestamp": 5.362821770419174 + "timestamp": 5.430182530987193 }, { - "x": 10.544019823742392, - "y": 6.649741816530494, - "heading": 0.43765692306832477, - "angularVelocity": -0.07178828851456667, - "velocityX": -3.7777767213885807, - "velocityY": -1.1390607410335976, + "x": 10.544035049630981, + "y": 6.649793265438035, + "heading": 0.4376694651514174, + "angularVelocity": -0.06782792164292281, + "velocityX": -3.5894913709978917, + "velocityY": -1.0808271785950743, "moduleForcesX": [ - 49.61097001099647, - 29.960020675030893, - 49.810683980327475, - 23.69035732916015 + 47.53506576758568, + 29.333765309885795, + 47.10755646583849, + 23.50756589105131 ], "moduleForcesY": [ - -99.62262552981636, - -107.24025708495017, - -97.95156957526038, - -107.4372074994834 + -100.61864430851121, + -107.4084137041551, + -99.4198469130243, + -107.60905700250359 ], - "timestamp": 5.393268920459785 + "timestamp": 5.462222532447208 }, { - "x": 10.43174307337387, - "y": 6.608629575449158, - "heading": 0.4335563624753091, - "angularVelocity": -0.13467797766116807, - "velocityX": -3.687594741010725, - "velocityY": -1.3502820798170498, + "x": 10.432043306335318, + "y": 6.608067008873336, + "heading": 0.43347817669732147, + "angularVelocity": -0.13081424042150525, + "velocityX": -3.4953726027566367, + "velocityY": -1.3023175612706317, "moduleForcesX": [ - 50.47238680977663, - 35.09011732252253, - 50.89792921334029, - 31.77886111111452 + 49.756367759871594, + 35.106461239154875, + 49.99578261370558, + 31.995927341800396 ], "moduleForcesY": [ - -95.93088215086546, - -102.59136541098549, - -93.68871350341784, - -101.83371240771545 + -95.75188215465406, + -102.069745623008, + -93.60026996740459, + -101.23810381235339 ], - "timestamp": 5.4237160705003955 + "timestamp": 5.494262533907222 }, { - "x": 10.322457917154331, - "y": 6.561748076363306, - "heading": 0.42703446728967825, - "angularVelocity": -0.2142037982843, - "velocityX": -3.589339431564968, - "velocityY": -1.5397664156848374, + "x": 10.323383938634551, + "y": 6.560219585431149, + "heading": 0.42637679727464484, + "angularVelocity": -0.22164104553923633, + "velocityX": -3.39136587856971, + "velocityY": -1.4933652079236626, "moduleForcesX": [ - 54.54451585503099, - 37.80311413224697, - 56.068371436953264, - 34.884519018136295 + 55.05567925117758, + 37.86533543157213, + 56.65721776322309, + 34.80575744961734 ], "moduleForcesY": [ - -86.38037479041058, - -94.79851130258069, - -80.69537934854387, - -91.61886969958681 + -83.0438884795672, + -91.96968065788715, + -75.97006732019702, + -87.70722824777432 ], - "timestamp": 5.454163220541006 + "timestamp": 5.526302535367237 }, { - "x": 10.215423792334374, - "y": 6.510355295341807, - "heading": 0.41995401673996147, - "angularVelocity": -0.23254887699744417, - "velocityX": -3.515407014357416, - "velocityY": -1.6879340415424797, + "x": 10.216545636110244, + "y": 6.508277508435219, + "heading": 0.4196471967806787, + "angularVelocity": -0.21003745902962243, + "velocityX": -3.334528640943329, + "velocityY": -1.6211633779352665, "moduleForcesX": [ - 36.442468575381426, - 33.174927914274654, - 35.8528195340503, - 32.45465163128756 + 24.038621985218352, + 25.77272071949514, + 24.62367588838952, + 26.32651129956415 ], "moduleForcesY": [ - -69.21668807394214, - -70.77919539967725, - -67.39520207920303, - -69.02352334329365 + -56.390122550390586, + -55.61754417494375, + -57.656326035557406, + -56.89767113448526 ], - "timestamp": 5.484610370581617 + "timestamp": 5.558342536827252 }, { - "x": 10.109265668494423, - "y": 6.456274689185196, - "heading": 0.41438013914701705, - "angularVelocity": -0.18306730138977947, - "velocityX": -3.486635816434527, - "velocityY": -1.776212423313201, + "x": 10.110214948281255, + "y": 6.454517230975398, + "heading": 0.4141905501156165, + "angularVelocity": -0.17030731636737448, + "velocityX": -3.3186854863808724, + "velocityY": -1.677911205057923, "moduleForcesX": [ - 8.471205328468896, - 15.23866932736421, - 11.77361519881396, - 18.190714448046055 + 3.5123356730005804, + 8.059917813162626, + 6.035176967026881, + 10.479446367424668 ], "moduleForcesY": [ - -39.299918406604114, - -36.510563952245334, - -45.75459276690234, - -43.12295459661491 + -23.417268009154352, + -21.484740623999084, + -28.788257649111483, + -26.912755922055677 ], - "timestamp": 5.515057520622228 + "timestamp": 5.590382538287266 }, { - "x": 10.003524317388626, - "y": 6.400874064288048, - "heading": 0.4096367853957852, - "angularVelocity": -0.15578974534250664, - "velocityX": -3.4729474175663793, - "velocityY": -1.8195668502061122, + "x": 10.004109121840859, + "y": 6.3999345000371175, + "heading": 0.4093478527591147, + "angularVelocity": -0.15114535380235383, + "velocityX": -3.3116673409891164, + "velocityY": -1.7035807881104348, "moduleForcesX": [ - 3.9042382491596532, - 7.105966453517206, - 5.683970643639738, - 8.842262844225818 + 1.487894997911832, + 3.5515928558607346, + 2.674373241969133, + 4.727965710328632 ], "moduleForcesY": [ - -18.918192324174065, - -17.55122761626256, - -22.8772581877901, - -21.53331764786267 + -10.470814273459197, + -9.58171840845681, + -13.16887634219489, + -12.285842350063524 ], - "timestamp": 5.545504670662838 + "timestamp": 5.622422539747281 }, { "x": 9.898398399353027, "y": 6.344369888305664, "heading": 0.40489200306154377, - "angularVelocity": -0.15583666543215785, - "velocityX": -3.45273425904824, - "velocityY": -1.8558116574791457, + "angularVelocity": -0.13907145738216475, + "velocityX": -3.299335757514504, + "velocityY": -1.7342262546637257, "moduleForcesX": [ - 9.431345346606545, - 9.425930347002394, - 9.428431462071497, - 9.423018174876928 + 4.444919794866705, + 5.756082971948941, + 5.177358266597356, + 6.483173214059894 ], "moduleForcesY": [ - -16.906432080263507, - -16.908789517761008, - -16.8995214585308, - -16.90187811085413 + -13.01289673438949, + -12.451995720736903, + -14.711065470774846, + -14.152581305403867 ], - "timestamp": 5.575951820703449 + "timestamp": 5.6544625412072955 }, { - "x": 9.670246530984475, - "y": 6.195179516897854, - "heading": 0.4012737715516626, - "angularVelocity": -0.04837328675412599, - "velocityX": -3.050234823819816, - "velocityY": -1.9945734808167912, + "x": 9.670268652542475, + "y": 6.195147686170206, + "heading": 0.40147320180126633, + "angularVelocity": -0.04570696870230372, + "velocityX": -3.04993429091239, + "velocityY": -1.9949959074662753, "moduleForcesX": [ - 74.77834883929572, - 78.31714320835279, - 74.46722774433924, - 78.09040380789128 + 44.35336751964116, + 49.84791066719054, + 44.98425405334999, + 50.206578864953734 ], "moduleForcesY": [ - -24.40515766450398, - -20.14008207645028, - -32.569084988593396, - -28.259698256337934 + -48.756394596706954, + -45.107327355028076, + -53.79518756589766, + -50.36604891302273 ], - "timestamp": 5.65074995315767 + "timestamp": 5.729260790956576 }, { - "x": 9.4801504252691, - "y": 6.070649750515126, - "heading": 0.39828552067975415, - "angularVelocity": -0.039950875427770885, - "velocityX": -2.5414552406334514, - "velocityY": -1.6648780162919794, + "x": 9.480173271877787, + "y": 6.070616528520398, + "heading": 0.39849121405650767, + "angularVelocity": -0.039867079173030166, + "velocityX": -2.541441561826215, + "velocityY": -1.6648940057719865, "moduleForcesX": [ - 96.32186712116838, - 96.38792598998765, - 96.79419017964749, - 96.85697827552185 + 96.3494121391391, + 96.39508860152752, + 96.67696001450231, + 96.72106180217908 ], "moduleForcesY": [ - 63.00396831226178, - 62.90663890135131, - 62.274968928445375, - 62.18110701001115 + 62.9543807201797, + 62.88707197355149, + 62.44956252680797, + 62.383918224986004 ], - "timestamp": 5.725548085611892 + "timestamp": 5.804059040705856 }, { - "x": 9.32808449174239, - "y": 5.970953271268857, - "heading": 0.39590322000722883, - "angularVelocity": -0.03184973467062609, - "velocityX": -2.0330177844985764, - "velocityY": -1.3328739097501774, + "x": 9.328101551518529, + "y": 5.970928319469064, + "heading": 0.3960566471955998, + "angularVelocity": -0.03254844690976579, + "velocityX": -2.0330919622982955, + "velocityY": -1.3327612529101711, "moduleForcesX": [ - 96.26487658800978, - 96.32997314585457, - 96.7221348425724, - 96.78416991240434 + 96.27315885630196, + 96.33189190207462, + 96.686273793815, + 96.74250734840614 ], "moduleForcesY": [ - 63.427687906728025, - 63.33059042831499, - 62.72773938264778, - 62.633819804313426 + 63.41348692578717, + 63.325874029911354, + 62.78139687764546, + 62.69637660722109 ], - "timestamp": 5.800346218066113 + "timestamp": 5.878857290455136 }, { - "x": 9.214040059471193, - "y": 5.8961477456875455, - "heading": 0.39412002885262637, - "angularVelocity": -0.023840049157562253, - "velocityX": -1.524696252824158, - "velocityY": -1.0000988410652472, + "x": 9.214049861102318, + "y": 5.896133355137771, + "heading": 0.3942081084317932, + "angularVelocity": -0.02471366335446106, + "velocityX": -1.5247908981630351, + "velocityY": -0.9999560762718345, "moduleForcesX": [ - 96.24488535024153, - 96.31011450913444, - 96.69795042437514, - 96.7601725947593 + 96.2464886620466, + 96.31025854518813, + 96.6896674358515, + 96.75056013471918 ], "moduleForcesY": [ - 63.57019718383229, - 63.47252205472779, - 62.87858000727268, - 62.78399745101661 + 63.56717322481581, + 63.47168328918838, + 62.89071925102452, + 62.798188225264994 ], - "timestamp": 5.875144350520334 + "timestamp": 5.953655540204417 }, { - "x": 9.138012769594361, - "y": 5.846262014344345, - "heading": 0.3929327805602388, - "angularVelocity": -0.01587269967086738, - "velocityX": -1.0164329961495118, - "velocityY": -0.6669381935937063, + "x": 9.138016376281193, + "y": 5.84625670461297, + "heading": 0.3929651715340159, + "angularVelocity": -0.016617192273128887, + "velocityX": -1.0165142242764738, + "velocityY": -0.6668157435766093, "moduleForcesX": [ - 96.23467746677126, - 96.30009844719443, - 96.68582788542034, - 96.74826576061236 + 96.23291594154362, + 96.29939278470015, + 96.69137390831771, + 96.75477051723124 ], "moduleForcesY": [ - 63.64170695487282, - 63.54355942757056, - 62.95396491375018, - 62.85886919168339 + 63.64410996343634, + 63.54438360092073, + 62.94517892257058, + 62.84860449412174 ], - "timestamp": 5.9499424829745555 + "timestamp": 6.028453789953697 }, { "x": 9.1, - "y": 5.821313381195068, + "y": 5.821313381195065, "heading": 0.39233969745911407, - "angularVelocity": -0.007929116431986712, - "velocityX": -0.50820479532195, - "velocityY": -0.33354620403852975, + "angularVelocity": -0.008362148539550444, + "velocityX": -0.5082522172460242, + "velocityY": -0.33347469361261933, "moduleForcesX": [ - 96.2285045107745, - 96.29401110747635, - 96.67859802056262, - 96.74113494181448 + 96.22472066349764, + 96.292810190967, + 96.69245071862318, + 96.75733376592395 ], "moduleForcesY": [ - 63.68466012516553, - 63.586276007748886, - 62.99909879542885, - 62.90374389419577 + 63.690259240991296, + 63.58800475764593, + 62.977708646167464, + 62.878726323912026 ], - "timestamp": 6.024740615428777 + "timestamp": 6.103252039702977 }, { "x": 9.1, "y": 5.821313381195068, "heading": 0.39233969745911407, - "angularVelocity": 9.242967284264404e-21, - "velocityX": -5.393065463580557e-21, - "velocityY": -4.6660816363364264e-20, + "angularVelocity": 1.4293258494945315e-19, + "velocityX": -9.48788595009282e-19, + "velocityY": 6.222095483602862e-19, "moduleForcesX": [ - 96.22440473642781, - 96.28984267330931, - 96.67387504230591, - 96.73635227532323 + 96.219277135115, + 96.28830838426227, + 96.69327817490581, + 96.75901741442976 ], "moduleForcesY": [ - 63.713260147549505, - 63.61490939882356, - 63.02902588165876, - 62.93369197756521 + 63.720955818602604, + 63.617216172933794, + 62.99919868599543, + 62.89881547606205 ], - "timestamp": 6.099538747882998 + "timestamp": 6.1780502894522575 }, { - "x": 9.124426408265597, - "y": 5.838158154369932, - "heading": 0.37440374574477503, - "angularVelocity": -0.2948190027369444, - "velocityX": 0.4015047230279816, - "velocityY": 0.2768829503913697, + "x": 9.12606508426789, + "y": 5.8377585148435465, + "heading": 0.37148092735484195, + "angularVelocity": -0.3358803058762973, + "velocityX": 0.41971546897661194, + "velocityY": 0.2648093100607021, "moduleForcesX": [ - 104.6690647215055, - 103.79621548715683, - 86.74486016660066, - 79.6558343319196 + 107.06597038486554, + 106.89549145493712, + 88.60061528259641, + 81.32645261923491 ], "moduleForcesY": [ - 48.576006219936566, - 50.364330112069474, - 76.10242127485564, - 83.46976074034517 + 43.037242158674665, + 43.394757591016905, + 73.93350925841953, + 81.83966143502103 ], - "timestamp": 6.16037591084682 + "timestamp": 6.2401520850602274 }, { - "x": 9.173316821931977, - "y": 5.871875693217713, - "heading": 0.33976042091244324, - "angularVelocity": -0.5694434642347314, - "velocityX": 0.8036274422502436, - "velocityY": 0.5542260224697108, + "x": 9.178251711242993, + "y": 5.870675766257217, + "heading": 0.33123239786143516, + "angularVelocity": -0.6481057286569294, + "velocityX": 0.8403400652783892, + "velocityY": 0.5300531343967613, "moduleForcesX": [ - 104.36224405802564, - 102.97011057048299, - 87.53838797956297, - 80.57222592370948 + 106.81766172551309, + 106.04093622896602, + 89.53141023846203, + 82.33004570732504 ], "moduleForcesY": [ - 49.20246899931035, - 52.0005698939217, - 75.17096632236314, - 82.56810699384471 + 43.6115687458894, + 45.3991721549242, + 72.78287839067802, + 80.80897526070483 ], - "timestamp": 6.221213073810643 + "timestamp": 6.302253880668197 }, { - "x": 9.24671717457305, - "y": 5.9225047085781934, - "heading": 0.2901169140945015, - "angularVelocity": -0.8160062764179685, - "velocityX": 1.2065051863894711, - "velocityY": 0.8322053970627751, + "x": 9.256631385149708, + "y": 5.920106690428395, + "heading": 0.27372901582427783, + "angularVelocity": -0.9259536133247956, + "velocityX": 1.2621160650732033, + "velocityY": 0.7959661019017846, "moduleForcesX": [ - 103.86961088775287, - 101.81794700730569, - 88.59644120728534, - 81.86390049299227 + 106.36127377314644, + 104.78762461695499, + 90.79435455500894, + 83.829920572498 ], "moduleForcesY": [ - 50.19424330306308, - 54.18124068785469, - 73.89664129178026, - 81.26407249712199 + 44.65822687033308, + 48.164003127686335, + 71.17035492491335, + 79.22203469459357 ], - "timestamp": 6.282050236774465 + "timestamp": 6.364355676276167 }, { - "x": 9.344679660258, - "y": 5.990100130181784, - "heading": 0.2278705872436387, - "angularVelocity": -1.0231628797003336, - "velocityX": 1.6102408612184482, - "velocityY": 1.1110876692883864, + "x": 9.36128953490754, + "y": 5.986116860930104, + "heading": 0.20215350943413754, + "angularVelocity": -1.152551318193366, + "velocityX": 1.6852676920729739, + "velocityY": 1.0629349740289324, "moduleForcesX": [ - 102.97098993160485, - 100.2816827855571, - 89.91507313466994, - 83.78116306119976 + 105.38356550288955, + 103.01244546536586, + 92.40747603148937, + 86.2278900967571 ], "moduleForcesY": [ - 51.956544160187924, - 56.921561602046935, - 72.24946473264366, - 79.2516201108616 + 46.83633622576909, + 51.77437024681331, + 69.01195080914106, + 76.55773487195233 ], - "timestamp": 6.342887399738287 + "timestamp": 6.426457471884137 }, { - "x": 9.467258608861432, - "y": 6.074736051006052, - "heading": 0.15653642733851053, - "angularVelocity": -1.1725425123381934, - "velocityX": 2.014869573657247, - "velocityY": 1.3911878315988937, + "x": 9.492321085260913, + "y": 6.0687979662658655, + "heading": 0.121648680830616, + "angularVelocity": -1.296336568297074, + "velocityX": 2.10994785369074, + "velocityY": 1.3313802689008425, "moduleForcesX": [ - 101.19960247774684, - 98.2967857325556, - 91.51945696061505, - 86.7668507310473 + 103.06905054921917, + 100.53419705098851, + 94.48545431834287, + 90.34073398334215 ], "moduleForcesY": [ - 55.2444277985547, - 60.21289489893423, - 70.14362208312178, - 75.91533220936323 + 51.59846953149261, + 56.324216066065965, + 66.03839637354766, + 71.56970538755411 ], - "timestamp": 6.403724562702109 + "timestamp": 6.488559267492107 }, { - "x": 9.614495005457098, - "y": 6.176489945212865, - "heading": 0.08185672674254803, - "angularVelocity": -1.2275342398916924, - "velocityX": 2.4201719709254568, - "velocityY": 1.6725614616073192, + "x": 9.649780293998948, + "y": 6.1681885527545415, + "heading": 0.042497044738964006, + "angularVelocity": -1.27454665870393, + "velocityX": 2.535501706456818, + "velocityY": 1.6004462594946747, "moduleForcesX": [ - 97.31237310212737, - 95.75953255949932, - 93.57306626338041, - 91.76671164693622 + 96.2916687370116, + 96.91797721607092, + 97.71513392557925, + 98.30376883932867 ], "moduleForcesY": [ - 61.70410058784353, - 64.06733787812753, - 67.2529692333703, - 69.68084586415326 + 63.117273034962174, + 62.16157487034735, + 60.8818194493432, + 59.937833099468726 ], - "timestamp": 6.464561725665932 + "timestamp": 6.550661063100077 }, { - "x": 9.786303556479535, - "y": 6.295259954535899, - "heading": 0.01573807289290187, - "angularVelocity": -1.0868135631006441, - "velocityX": 2.8240723704457604, - "velocityY": 1.952260814556102, + "x": 9.832603238264776, + "y": 6.282083749845622, + "heading": 0.0010258848806129173, + "angularVelocity": -0.6677932490091972, + "velocityX": 2.9439236414343237, + "velocityY": 1.8340081148388663, "moduleForcesX": [ - 86.5321701180405, - 92.25427081535645, - 97.1144659926379, - 101.20179764226765 + 59.97477963943079, + 89.39704823104167, + 110.38024149575084, + 113.80694315967614 ], "moduleForcesY": [ - 75.85885179568086, - 68.8487316739205, - 61.64809216339909, - 54.78638460823519 + 97.79151184647147, + 72.20506885999235, + 28.839425985382572, + 14.78899376484699 ], - "timestamp": 6.525398888629754 + "timestamp": 6.612762858708047 }, { - "x": 9.98099357991982, - "y": 6.426527001243398, - "heading": 0.0010512168806646742, - "angularVelocity": -0.24141257245955028, - "velocityX": 3.2001824864196897, - "velocityY": 2.1576786344484677, + "x": 10.030346062720374, + "y": 6.407528929196308, + "heading": 0.0009143240312192765, + "angularVelocity": -0.001796419061662757, + "velocityX": 3.1841724143354813, + "velocityY": 2.0199927896220706, "moduleForcesX": [ - 38.81568526776312, - 84.74996163721521, - 112.94150068763072, - 114.64908329430031 + 27.910051624663126, + 63.73430047048076, + 47.02333960869323, + 81.07343060013112 ], "moduleForcesY": [ - 107.86535624618263, - 77.5428290412158, - 4.720404786879428, - 1.6603151606164208 + 78.23128798690065, + 63.59254149911866, + 17.492746703171225, + 10.792434877491871 ], - "timestamp": 6.586236051593576 + "timestamp": 6.674864654316017 }, { - "x": 10.18064296034454, - "y": 6.562363363203818, - "heading": 0.0009441064746914683, - "angularVelocity": -0.0017606081670327233, - "velocityX": 3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 10.228012029363544, + "y": 6.533099878628409, + "heading": 0.0008079294489062711, + "angularVelocity": -0.001713228760479697, + "velocityX": 3.182934804187995, + "velocityY": 2.022018014177882, "moduleForcesX": [ - 11.445573252588428, - 25.631275124727225, - 12.108894286774559, - 26.924267849023067 + -0.28545851563204555, + -0.2804480463731822, + -0.2855446348313677, + -0.28051646942635683 ], "moduleForcesY": [ - 27.856532036433503, - 26.8185016500409, - 7.889518984358191, - 7.559585000410401 + 0.4662962959748132, + 0.46648326649752214, + 0.45969100337572294, + 0.459880692548048 ], - "timestamp": 6.647073214557398 + "timestamp": 6.736966449923987 }, { - "x": 10.389186424222014, - "y": 6.684102379422477, - "heading": 0.0008315498846507851, - "angularVelocity": -0.001850128844890692, - "velocityX": 3.427895939222019, - "velocityY": 2.0010633351041336, + "x": 10.427113469333392, + "y": 6.656381795149376, + "heading": 0.0007006205611460927, + "angularVelocity": -0.0017279514498676949, + "velocityX": 3.206049648334116, + "velocityY": 1.9851586466067421, "moduleForcesX": [ - 34.125974092877684, - 34.119566969812965, - 34.12806959993071, - 34.12166225634625 + 5.285867690419364, + 5.284961607340059, + 5.285918211927382, + 5.285012064001373 ], "moduleForcesY": [ - -54.08961846611769, - -54.091189136841685, - -54.08302939294419, - -54.08460010575838 + -8.428820483504277, + -8.428859802450413, + -8.427665220567818, + -8.427704094896713 ], - "timestamp": 6.7079103775212205 + "timestamp": 6.799068245531957 }, { - "x": 10.61051606687712, - "y": 6.780644990322361, - "heading": 0.000701833947664439, - "angularVelocity": -0.0021321825454530797, - "velocityX": 3.638066469120572, - "velocityY": 1.5869019230448598, + "x": 10.636846447566278, + "y": 6.76054779134001, + "heading": 0.0005836892297171069, + "angularVelocity": -0.0018828977533457954, + "velocityX": 3.3772449923487615, + "velocityY": 1.6773427430054264, "moduleForcesX": [ - 49.06229197687783, - 49.03163546387942, - 49.0815105306153, - 49.05084786401312 + 39.14902863114247, + 39.136505585616426, + 39.15454418789416, + 39.14202011232547 ], "moduleForcesY": [ - -96.67004058315037, - -96.68438290730597, - -96.65707564207322, - -96.67142765058261 + -70.38808653661697, + -70.39220856869599, + -70.37815024115632, + -70.38227306623787 ], - "timestamp": 6.768747540485043 + "timestamp": 6.861170041139927 }, { - "x": 10.841956159147276, - "y": 6.849459835142262, - "heading": 0.0005411494775797474, - "angularVelocity": -0.002641222276920527, - "velocityX": 3.80425517882526, - "velocityY": 1.1311317206034728, + "x": 10.858199057460208, + "y": 6.836948493802416, + "heading": 0.0004443289376354839, + "angularVelocity": -0.002244062200091015, + "velocityX": 3.564351203164376, + "velocityY": 1.230249491410887, "moduleForcesX": [ - 38.80840694131433, - 38.74033390445177, - 38.8409572070115, - 38.77284195160276 + 42.79383002375116, + 42.750355155538415, + 42.817059002037766, + 42.773568530416895 ], "moduleForcesY": [ - -106.37757896352497, - -106.40184229774033, - -106.3636821482131, - -106.38798347831754 + -102.22993200522636, + -102.24725073962176, + -102.21741225918262, + -102.23474808291235 ], - "timestamp": 6.829584703448865 + "timestamp": 6.9232718367478965 }, { - "x": 11.080086659996805, - "y": 6.889216371961374, - "heading": 0.0003245280393203164, - "angularVelocity": -0.003560676200306194, - "velocityX": 3.914227574864692, - "velocityY": 0.6534909729888787, + "x": 11.087670752139442, + "y": 6.883506999197637, + "heading": 0.0002634313814932412, + "angularVelocity": -0.0029129198982296074, + "velocityX": 3.6950895289376384, + "velocityY": 0.7497127086168028, "moduleForcesX": [ - 25.717865755187493, - 25.577114001753998, - 25.76100486674207, - 25.620041504490047 + 29.92547693151462, + 29.82914130574372, + 29.960153351309838, + 29.86372234770639 ], "moduleForcesY": [ - -111.47748761628131, - -111.50955109747035, - -111.46568684412034, - -111.49785520760967 + -109.87230666320606, + -109.89810991838907, + -109.86092743160701, + -109.88678831438042 ], - "timestamp": 6.890421866412687 + "timestamp": 6.985373632355866 }, { "x": 11.321250915527344, "y": 6.899192810058594, - "heading": -5.820220043024201e-20, - "angularVelocity": -0.0053343716818830345, - "velocityX": 3.9640943755702462, - "velocityY": 0.16398591931634138, + "heading": 1.7044959641647185e-19, + "angularVelocity": -0.004241928577334639, + "velocityX": 3.7612465324259428, + "velocityY": 0.2525822435148066, "moduleForcesX": [ - 11.766242291584698, - 11.472950024585101, - 11.806680580907997, - 11.512400965900941 + 15.214683881783662, + 15.002575278462187, + 15.252598453614608, + 15.0399798318798 ], "moduleForcesY": [ - -114.24520441209951, - -114.27486879290603, - -114.2388907542841, - -114.26875836780002 + -113.66335076467918, + -113.69134460089437, + -113.65627458813691, + -113.68440690030411 ], - "timestamp": 6.9512590293765095 + "timestamp": 7.047475427963836 }, { - "x": 11.623075674299576, - "y": 6.864260942419369, - "heading": 0.0000023499430894192195, - "angularVelocity": 0.00003069941458455491, - "velocityX": 3.943007574588477, - "velocityY": -0.4563463224696058, + "x": 11.611818027854001, + "y": 6.870157772665709, + "heading": 0.000006706968945754724, + "angularVelocity": 0.00008661247380923753, + "velocityX": 3.7523263652724554, + "velocityY": -0.37495274483614, "moduleForcesX": [ - -4.2903004525975135, - -3.566125676157951, - -4.254477917247945, - -3.5363367506884154 + -1.930017347362055, + -1.3524659590983, + -1.9171433879503843, + -1.343441667490837 ], "moduleForcesY": [ - -115.06352371966176, - -115.08817444708899, - -115.06756634659666, - -115.091807306801 + -115.07098399891115, + -115.0791940311929, + -115.0737409512458, + -115.08184184287788 ], - "timestamp": 7.027805866546543 + "timestamp": 7.124911952413266 }, { - "x": 11.915766240995925, - "y": 6.782789828791696, - "heading": 0.000020549966953337708, - "angularVelocity": 0.00023776323799624486, - "velocityX": 3.8236794297091086, - "velocityY": -1.06433024066954, + "x": 11.89360394252261, + "y": 6.793457496928237, + "heading": 0.000014010027713151718, + "angularVelocity": 0.00009431026016884775, + "velocityX": 3.6389277110781117, + "velocityY": -0.9904922293815296, "moduleForcesX": [ - -22.15296905683905, - -22.126953133722456, - -22.146146005278485, - -22.120137478708045 + -20.795476451655723, + -20.794515439942504, + -20.795240317066728, + -20.794279315526506 ], "moduleForcesY": [ - -112.783738070124, - -112.78882065085001, - -112.78524441350454, - -112.79032392449628 + -112.87660869109384, + -112.87678463656188, + -112.87666020166296, + -112.87683614320375 ], - "timestamp": 7.104352703716576 + "timestamp": 7.202348476862695 }, { - "x": 12.175184864757565, - "y": 6.667702152711534, - "heading": 0.0029536724169984983, - "angularVelocity": 0.03831800971122835, - "velocityX": 3.389018192683671, - "velocityY": -1.5034935515953167, + "x": 12.158153629182106, + "y": 6.67179475203828, + "heading": 0.0004871969822431189, + "angularVelocity": 0.006110642980096399, + "velocityX": 3.4163424629454027, + "velocityY": -1.5711286857845936, "moduleForcesX": [ - -82.77126323116941, - -80.94192654719535, - -80.35273216958193, - -78.46991677908551 + -41.28977010687008, + -40.662563471279185, + -40.970425111678914, + -40.3466587799709 ], "moduleForcesY": [ - -79.32224282560553, - -81.16083698479886, - -81.80494379688955, - -83.58853211441256 + -106.29034131292164, + -106.52838528799589, + -106.42582853323141, + -106.66047133973117 ], - "timestamp": 7.180899540886609 + "timestamp": 7.279785001312124 }, { - "x": 12.387977367389736, - "y": 6.561745619437614, - "heading": 0.006312957325942295, - "angularVelocity": 0.043885352199226915, - "velocityX": 2.779899346585585, - "velocityY": -1.3842052420605957, + "x": 12.375778537307344, + "y": 6.562682372433733, + "heading": 0.003922386449226963, + "angularVelocity": 0.04436135907968387, + "velocityX": 2.810365130312186, + "velocityY": -1.4090557444349707, "moduleForcesX": [ - -112.95285116511828, - -112.9351029547452, - -113.05965579629233, - -113.04267855576265 + -110.75149967016266, + -110.51967200781796, + -111.70364987570524, + -111.51809488586058 ], "moduleForcesY": [ - 22.361919228925938, - 22.445395936831783, - 21.813838326495244, - 21.895492780162307 + 31.163125703536394, + 31.938835770863207, + 27.54075660649726, + 28.240069272526465 ], - "timestamp": 7.257446378056643 + "timestamp": 7.357221525761553 }, { - "x": 12.556502410271355, - "y": 6.473209425403713, - "heading": 0.009331441590312019, - "angularVelocity": 0.03943316766523955, - "velocityX": 2.2015938099085006, - "velocityY": -1.1566277237194698, + "x": 12.54876174639912, + "y": 6.472975043297138, + "heading": 0.007608118501472647, + "angularVelocity": 0.047596816598512205, + "velocityX": 2.233871035944323, + "velocityY": -1.1584627509358207, "moduleForcesX": [ - -107.33800844105599, - -107.38700511167124, - -107.17535879811419, - -107.22522115524384 + -105.67464605947448, + -105.63214461850302, + -105.80089159312246, + -105.75886325172866 ], "moduleForcesY": [ - 42.07330120256334, - 41.94949084700674, - 42.48667211202762, - 42.36206037528201 + 46.050955922132566, + 46.14736365416792, + 45.75956571011295, + 45.855608257532616 ], - "timestamp": 7.333993215226676 + "timestamp": 7.434658050210983 }, { - "x": 12.682025347004867, - "y": 6.405071382147858, - "heading": 0.011744144953739091, - "angularVelocity": 0.031519308342782756, - "velocityX": 1.639818722420714, - "velocityY": -0.8901483820226406, + "x": 12.677980051109994, + "y": 6.40464261213393, + "heading": 0.010776485842896305, + "angularVelocity": 0.040915670789083536, + "velocityX": 1.6686996947449795, + "velocityY": -0.8824315353645927, "moduleForcesX": [ - -104.3219357419469, - -104.4433579329168, - -103.98479429515396, - -104.10925807795152 + -103.73019304787827, + -103.83684095617447, + -103.44265988179235, + -103.55145256185558 ], "moduleForcesY": [ - 49.20870816840665, - 48.951926696699964, - 49.918130797069644, - 49.6594512669405 + 50.43388218964502, + 50.21517063638304, + 51.02184694806671, + 50.801888282932815 ], - "timestamp": 7.410540052396709 + "timestamp": 7.512094574660412 }, { - "x": 12.765280960185926, - "y": 6.358839505806994, - "heading": 0.013420862139108694, - "angularVelocity": 0.02190446068522871, - "velocityX": 1.0876427591139382, - "velocityY": -0.6039684727687442, + "x": 12.763883221887731, + "y": 6.358611977323751, + "heading": 0.013070566515867264, + "angularVelocity": 0.029625305232663646, + "velocityX": 1.1093366003769727, + "velocityY": -0.5944305369779237, "moduleForcesX": [ - -102.56600686278175, - -102.73833096424606, - -102.12754606615566, - -102.30453214622369 + -102.72849667186838, + -102.92566676985246, + -102.22155812605043, + -102.42499394558608 ], "moduleForcesY": [ - 52.83532642023232, - 52.500706634421135, - 53.67882683102995, - 53.34195778156508 + 52.51643901990649, + 52.130430374424144, + 53.49751224898022, + 53.1084108565624 ], - "timestamp": 7.487086889566743 + "timestamp": 7.589531099109841 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 0.011284751527060218, - "velocityX": 0.5416639429287425, - "velocityY": -0.30593583373417904, + "angularVelocity": 0.015678746812564974, + "velocityX": 0.5534907492707788, + "velocityY": -0.29948260373218116, "moduleForcesX": [ - -101.43052677926974, - -101.63866464193977, - -100.9273864836681, - -101.14130973054235 + -102.12022129821462, + -102.37649295640067, + -101.47905712486354, + -101.74499661591264 ], "moduleForcesY": [ - 55.02158505666223, - 54.63721275613784, - 55.9399480328183, - 55.553266367098956 + 53.73126222218935, + 53.24277344389703, + 54.93360379578871, + 54.44082769369371 ], - "timestamp": 7.563633726736776 + "timestamp": 7.6669676235592705 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 5.114105590962525e-23, - "velocityX": -8.881224909325008e-21, - "velocityY": -1.1113020413435585e-20, + "angularVelocity": -1.2522021181482855e-21, + "velocityX": -6.11163916168187e-20, + "velocityY": -8.886685040205295e-20, "moduleForcesX": [ - -100.63924602824052, - -100.8733842366393, - -100.09136074426306, - -100.33208991745954 + -101.71254310622051, + -102.0097340749321, + -100.98075222935972, + -101.2902381868248 ], "moduleForcesY": [ - 56.48082932732088, - 56.062516688082894, - 57.44686854165235, - 57.026280875989876 + 54.52603575485248, + 53.96929568440209, + 55.870598413077815, + 55.308782033960505 ], - "timestamp": 7.640180563906809 + "timestamp": 7.7444041480087 } ], "trajectoryWaypoints": [ @@ -11044,7 +11149,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 0.7375297982110328, + "timestamp": 0.737529870183815, "isStopPoint": true, "x": 14.69013500213623, "y": 6.808716297149658, @@ -11055,7 +11160,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.1343575514775248, + "timestamp": 1.13448036718493, "isStopPoint": false, "x": 14.018568992614746, "y": 6.998851299285889, @@ -11066,7 +11171,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.719752725275319, + "timestamp": 1.720812448359223, "isStopPoint": true, "x": 12.834817886352539, "y": 7.172932147979736, @@ -11077,7 +11182,7 @@ "controlIntervalCount": 13 }, { - "timestamp": 2.4836578844523696, + "timestamp": 2.5006171437954046, "isStopPoint": false, "x": 10.675800323486328, "y": 7.304165840148926, @@ -11088,7 +11193,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 3.165680705135952, + "timestamp": 3.190709467517472, "isStopPoint": true, "x": 9.1, "y": 7.4374165534973145, @@ -11096,10 +11201,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 17 }, { - "timestamp": 4.596356972775792, + "timestamp": 4.646178333479818, "isStopPoint": true, "x": 12.773889541625977, "y": 6.8421783447265625, @@ -11110,7 +11215,7 @@ "controlIntervalCount": 15 }, { - "timestamp": 5.362821770419174, + "timestamp": 5.430182530987193, "isStopPoint": false, "x": 10.659042358398438, "y": 6.684422969818115, @@ -11121,7 +11226,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 5.575951820703449, + "timestamp": 5.6544625412072955, "isStopPoint": false, "x": 9.898398399353027, "y": 6.344369888305664, @@ -11132,7 +11237,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 6.099538747882998, + "timestamp": 6.1780502894522575, "isStopPoint": true, "x": 9.1, "y": 5.821313381195068, @@ -11143,7 +11248,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 6.9512590293765095, + "timestamp": 7.047475427963836, "isStopPoint": false, "x": 11.321250915527344, "y": 6.899192810058594, @@ -11154,7 +11259,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 7.640180563906809, + "timestamp": 7.7444041480087, "isStopPoint": true, "x": 12.806743621826172, "y": 6.335421085357666, @@ -11218,7 +11323,7 @@ "name": "intake", "target": 1, "trajTargetIndex": 1, - "targetTimestamp": 0.7375297982110328, + "targetTimestamp": 0.737529870183815, "offset": 0.1, "command": { "type": "named", @@ -11231,7 +11336,7 @@ "name": "intake", "target": 3, "trajTargetIndex": 3, - "targetTimestamp": 1.719752725275319, + "targetTimestamp": 1.720812448359223, "offset": 0.2, "command": { "type": "named", @@ -11244,7 +11349,7 @@ "name": "intake", "target": 6, "trajTargetIndex": 6, - "targetTimestamp": 4.596356972775792, + "targetTimestamp": 4.646178333479818, "offset": 0.2, "command": { "type": "named", @@ -11288,12 +11393,12 @@ ], "trajectory": [ { - "x": 7.84, - "y": 7.477, + "x": 7.839999999999999, + "y": 7.4769999999999985, "heading": 3.141592653589793, - "angularVelocity": -1.0078113021558393e-27, - "velocityX": -1.8654023532984683e-16, - "velocityY": 9.408878607423118e-17, + "angularVelocity": -3.2554108069074945e-28, + "velocityX": -6.245095151781063e-16, + "velocityY": -4.52955156548901e-16, "moduleForcesX": [ 0, 0, @@ -11309,361 +11414,361 @@ "timestamp": 0 }, { - "x": 7.7888178205593785, - "y": 7.4097114166852736, + "x": 7.789048065389168, + "y": 7.409336319308564, "heading": 3.141592653589793, - "angularVelocity": -1.6796175146434201e-16, - "velocityX": -0.5018399951667901, - "velocityY": -0.6597628841614104, + "angularVelocity": -2.211714817370884e-16, + "velocityX": -0.49911336409084806, + "velocityY": -0.6628177625545706, "moduleForcesX": [ - -69.87246936994154, - -69.87246936994154, - -69.87246936994154, - -69.87246936994154 + -69.42758277694902, + -69.42758277694902, + -69.42758277694902, + -69.42758277694902 ], "moduleForcesY": [ - -91.86047815823733, - -91.86047815823733, - -91.86047815823733, - -91.86047815823733 + -92.19916433110346, + -92.19916433110346, + -92.19916433110346, + -92.19916433110346 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654473 }, { - "x": 7.6864968515181165, - "y": 7.275117557134651, + "x": 7.687176089149893, + "y": 7.27400074357171, "heading": 3.141592653589793, - "angularVelocity": -2.2017382616870134e-16, - "velocityX": -1.0032545540329136, - "velocityY": -1.3196894419992158, + "angularVelocity": -6.966527683706636e-17, + "velocityX": -0.9979143119049332, + "velocityY": -1.325715991020111, "moduleForcesX": [ - -69.81323478288708, - -69.81323478288708, - -69.81323478288708, - -69.81323478288706 + -69.38412510090812, + -69.38412510090812, + -69.38412510090812, + -69.38412510090812 ], "moduleForcesY": [ - -91.8832668638928, - -91.8832668638928, - -91.8832668638928, - -91.8832668638928 + -92.21035728659811, + -92.21035728659811, + -92.21035728659811, + -92.21035728659811 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308946 }, { - "x": 7.533123855655458, - "y": 7.073185098303809, + "x": 7.534447902717691, + "y": 7.070976830585042, "heading": 3.141592653589793, - "angularVelocity": -1.7392229984228028e-16, - "velocityX": -1.5038184060088011, - "velocityY": -1.9799427314568734, + "angularVelocity": -6.814239332649433e-17, + "velocityX": -1.4960899817445545, + "velocityY": -1.98877528351538, "moduleForcesX": [ - -69.69478868116059, - -69.69478868116057, - -69.69478868116059, - -69.69478868116057 + -69.29714778996903, + -69.29714778996902, + -69.29714778996902, + -69.29714778996902 ], "moduleForcesY": [ - -91.92875854512678, - -91.9287585451268, - -91.9287585451268, - -91.9287585451268 + -92.23276158792476, + -92.23276158792477, + -92.23276158792477, + -92.23276158792477 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596342 }, { - "x": 7.3289589167676406, - "y": 6.803814589003351, + "x": 7.331055401569866, + "y": 6.800215073826195, "heading": 3.141592653589793, - "angularVelocity": -5.667150978731249e-17, - "velocityX": -2.0018321428383743, - "velocityY": -2.6411711373500846, + "angularVelocity": -1.4682205756281464e-16, + "velocityX": -1.9923858878859297, + "velocityY": -2.652319530447951, "moduleForcesX": [ - -69.33972961029974, - -69.33972961029976, - -69.33972961029976, - -69.33972961029976 + -69.03566921838791, + -69.03566921838791, + -69.03566921838791, + -69.03566921838791 ], "moduleForcesY": [ - -92.06452650682208, - -92.06452650682208, - -92.06452650682208, - -92.06452650682206 + -92.30021963767099, + -92.30021963767099, + -92.30021963767099, + -92.30021963767098 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461789 }, { - "x": 7.139460037725265, - "y": 6.468344823148688, + "x": 7.1379039546368785, + "y": 6.467543964285728, "heading": 3.141592653589793, - "angularVelocity": -8.184523729481644e-16, - "velocityX": -1.8580317911802808, - "velocityY": -3.289272702238152, + "angularVelocity": 7.91591288584586e-18, + "velocityX": -1.8920668899735504, + "velocityY": -3.258769228032236, "moduleForcesX": [ - 20.02169170195439, - 20.021691701955483, - 20.021691701954257, - 20.021691701955366 + 13.954556287044939, + 13.954556287044953, + 13.954556287044939, + 13.954556287044952 ], "moduleForcesY": [ - -90.23684277379594, - -90.23684277379569, - -90.23684277379519, - -90.23684277379493 + -84.35826329061041, + -84.35826329061041, + -84.3582632906104, + -84.3582632906104 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327236 }, { - "x": 7.001680309142067, - "y": 6.199601477600121, + "x": 6.99919068598312, + "y": 6.1995387188725335, "heading": 3.141592653589793, - "angularVelocity": -4.434581900264256e-16, - "velocityX": -1.35092680854653, - "velocityY": -2.6350218123795046, + "angularVelocity": 1.9046475496251705e-16, + "velocityX": -1.3588030894265215, + "velocityY": -2.625317383015404, "moduleForcesX": [ - 70.60552707551508, - 70.60552707551507, - 70.60552707551507, - 70.60552707551507 + 74.17797101404966, + 74.17797101404965, + 74.17797101404965, + 74.17797101404966 ], "moduleForcesY": [ - 91.09302905748419, - 91.0930290574842, - 91.0930290574842, - 91.09302905748422 + 88.11431143550178, + 88.11431143550178, + 88.11431143550178, + 88.11431143550178 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192683 }, { - "x": 6.915423136802039, - "y": 5.997836583842572, + "x": 6.912972996962741, + "y": 5.997942442570267, "heading": 3.141592653589793, - "angularVelocity": -5.095379692959289e-16, - "velocityX": -0.8457494273056122, - "velocityY": -1.9782997600863537, + "angularVelocity": 7.847677166577354e-17, + "velocityX": -0.844568535807801, + "velocityY": -1.974790484833519, "moduleForcesX": [ - 70.33714219082988, - 70.33714219082987, - 70.33714219082988, - 70.33714219082988 + 71.53096792553119, + 71.53096792553119, + 71.53096792553119, + 71.53096792553119 ], "moduleForcesY": [ - 91.43709533984699, - 91.43709533984699, - 91.43709533984699, - 91.437095339847 + 90.48948259361241, + 90.4894825936124, + 90.4894825936124, + 90.48948259361241 ], - "timestamp": 0.713923281394681 + "timestamp": 0.714594254405813 }, { - "x": 6.88062147565552, - "y": 5.863134773678263, + "x": 6.878725057136558, + "y": 5.863208583334528, "heading": 3.141592653589793, - "angularVelocity": -5.663091225441964e-16, - "velocityX": -0.3412294211072634, - "velocityY": -1.3207478950795901, + "angularVelocity": 1.5385501117605214e-16, + "velocityX": -0.3354848955240767, + "velocityY": -1.3198217153806693, "moduleForcesX": [ - 70.24561417800437, - 70.24561417800437, - 70.24561417800437, - 70.24561417800437 + 70.81446644981058, + 70.81446644981058, + 70.81446644981058, + 70.81446644981058 ], "moduleForcesY": [ - 91.55263229179072, - 91.55263229179073, - 91.55263229179073, - 91.55263229179073 + 91.10735502004157, + 91.10735502004157, + 91.10735502004157, + 91.10735502004157 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923577 }, { - "x": 6.897241402633118, - "y": 5.79553856220569, + "x": 6.896202051935022, + "y": 5.7955456681406865, "heading": 3.141592653589793, - "angularVelocity": -5.961242927880675e-16, - "velocityX": 0.16295797024033917, - "velocityY": -0.6627791705906017, + "angularVelocity": 1.623217608850538e-17, + "velocityX": 0.17120059787260816, + "velocityY": -0.6628102639184268, "moduleForcesX": [ - 70.1993033594393, - 70.19930335943928, - 70.1993033594393, - 70.19930335943928 + 70.48087982705123, + 70.48087982705123, + 70.48087982705123, + 70.48087982705123 ], "moduleForcesY": [ - 91.61067270642351, - 91.61067270642351, - 91.61067270642351, - 91.61067270642351 + 91.39149582750018, + 91.39149582750018, + 91.39149582750018, + 91.39149582750018 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789024 }, { - "x": 6.965262451171874, - "y": 5.795073509216309, + "x": 6.965262451171875, + "y": 5.79507350921631, "heading": 3.141592653589793, - "angularVelocity": -7.988770368986943e-16, - "velocityX": 0.6669446874477116, - "velocityY": -0.004559832982767937, + "angularVelocity": 5.88565809839424e-17, + "velocityX": 0.6764996943067185, + "velocityY": -0.004625159592674305, "moduleForcesX": [ - 70.1713629843233, - 70.1713629843233, - 70.1713629843233, - 70.17136298432328 + 70.2880294712005, + 70.2880294712005, + 70.2880294712005, + 70.28802947120049 ], "moduleForcesY": [ - 91.64556621358966, - 91.64556621358966, - 91.64556621358965, - 91.64556621358966 + 91.5547530896582, + 91.5547530896582, + 91.5547530896582, + 91.5547530896582 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654473 }, { - "x": 7.08070096454518, - "y": 5.7942842678434205, + "x": 7.081243526667897, + "y": 5.794280558401382, "heading": 3.141592653589793, - "angularVelocity": -5.248105366732835e-16, - "velocityX": 1.3578183260610657, - "velocityY": -0.009283265770469635, + "angularVelocity": 8.891262469242803e-17, + "velocityX": 1.366302583662364, + "velocityY": -0.009341271776623973, "moduleForcesX": [ - 115.39417560593395, - 115.39417560593395, - 115.39417560593395, - 115.39417560593395 + 115.39290145122217, + 115.39290145122217, + 115.39290145122217, + 115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823111, - -0.7889382400823112, - -0.7889382400822926, - -0.7889382400822927 + -0.7889295288162147, + -0.7889295288162148, + -0.7889295288162135, + -0.7889295288162135 ], - "timestamp": 1.104908044748896 + "timestamp": 1.1057357504820595 }, { - "x": 7.254857440753563, - "y": 5.793093577731747, + "x": 7.255760634137555, + "y": 5.7930874026904595, "heading": 3.141592653589793, - "angularVelocity": -2.561615074692675e-16, - "velocityX": 2.0484745349524203, - "velocityY": -0.014005212013280241, + "angularVelocity": -8.106206904033818e-17, + "velocityX": 2.0558800115403812, + "velocityY": -0.01405584250338598, "moduleForcesX": [ - 115.35785908997497, - 115.35785908997497, - 115.35785908997497, - 115.35785908997497 + 115.35518538121136, + 115.35518538121136, + 115.35518538121136, + 115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570275, - -0.7886899477570275, - -0.7886899477570093, - -0.7886899477570093 + -0.7886716678821863, + -0.7886716678821865, + -0.7886716678821848, + -0.7886716678821848 ], - "timestamp": 1.1899256875053905 + "timestamp": 1.1906225660986718 }, { - "x": 7.487674502920737, - "y": 5.791501831161153, + "x": 7.488752669750456, + "y": 5.791494459844215, "heading": 3.141592653589793, - "angularVelocity": 1.0000731243848567e-17, - "velocityX": 2.7384558618495856, - "velocityY": -0.018722544156549316, + "angularVelocity": -4.386380051033386e-17, + "velocityX": 2.744737612317474, + "velocityY": -0.01876549184548377, "moduleForcesX": [ - 115.24513594206775, - 115.24513594206775, - 115.24513594206775, - 115.24513594206775 + 115.23476991325883, + 115.23476991325883, + 115.23476991325883, + 115.23476991325883 ], "moduleForcesY": [ - -0.7879192710616094, - -0.7879192710616094, - -0.7879192710615902, - -0.7879192710615902 + -0.7878483995771248, + -0.7878483995771248, + -0.7878483995771227, + -0.7878483995771227 ], - "timestamp": 1.274943330261885 + "timestamp": 1.275509381715284 }, { - "x": 7.663804078477769, - "y": 5.790297651169946, + "x": 7.664344676693786, + "y": 5.790293955154937, "heading": 3.141592653589793, - "angularVelocity": 2.7022041767467565e-16, - "velocityX": 2.071682651346936, - "velocityY": -0.014163883544211246, + "angularVelocity": 1.0120993007206391e-17, + "velocityX": 2.068542749164338, + "velocityY": -0.01414241635239708, "moduleForcesX": [ - -111.36876650332572, - -111.36876650332572, - -111.36876650332572, - -111.36876650332572 + -113.11649807418154, + -113.11649807418154, + -113.11649807418154, + -113.11649807418154 ], "moduleForcesY": [ - 0.7614169275347041, - 0.7614169275347037, - 0.7614169275347284, - 0.7614169275347282 + 0.773365990495707, + 0.7733659904957071, + 0.7733659904957131, + 0.7733659904957132 ], - "timestamp": 1.3599609730183797 + "timestamp": 1.3603961973318963 }, { - "x": 7.781262360019993, - "y": 5.78949460084755, + "x": 7.781442723663645, + "y": 5.7894933677196665, "heading": 3.141592653589793, - "angularVelocity": 2.635375031603667e-16, - "velocityX": 1.3815753734627974, - "velocityY": -0.00944569028685667, + "angularVelocity": 1.5839175733892886e-17, + "velocityX": 1.3794609459585514, + "velocityY": -0.009431234161101426, "moduleForcesX": [ - -115.26617308908851, - -115.26617308908851, - -115.26617308908851, - -115.26617308908851 + -115.2722753646769, + -115.2722753646769, + -115.2722753646769, + -115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957715, - 0.7880630998957715, - 0.7880630998957596, - 0.7880630998957596 + 0.7881048205332045, + 0.7881048205332045, + 0.7881048205332075, + 0.7881048205332074 ], - "timestamp": 1.4449786157748743 + "timestamp": 1.4452830129485086 }, { - "x": 7.84, + "x": 7.840000000000001, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 2.372133916606688e-16, - "velocityX": 0.6908876566743303, - "velocityY": -0.004723528627758663, + "angularVelocity": 1.0053087398322516e-17, + "velocityX": 0.6898276948077531, + "velocityY": -0.004716281776302069, "moduleForcesX": [ - -115.36312174237496, - -115.36312174237496, - -115.36312174237496, - -115.36312174237496 + -115.3645237146873, + -115.3645237146873, + -115.3645237146873, + -115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761378, - 0.7887259279761378, - 0.7887259279761235, - 0.7887259279761235 + 0.7887355131182131, + 0.7887355131182131, + 0.7887355131182147, + 0.7887355131182147 ], - "timestamp": 1.529996258531369 + "timestamp": 1.5301698285651208 }, { "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 4.549080377281559e-28, - "velocityX": 2.4191829688267976e-17, - "velocityY": -1.5749113533099178e-18, + "angularVelocity": 1.240515353430351e-28, + "velocityX": 3.2946392731050547e-16, + "velocityY": -1.9344571845752735e-18, "moduleForcesX": [ - -115.3965169929829, - -115.3965169929829, - -115.3965169929829, - -115.3965169929829 + -115.39705100341173, + -115.39705100341173, + -115.39705100341173, + -115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073952, - 0.7889542479073952, - 0.78895424790738, - 0.78895424790738 + 0.7889578988823658, + 0.7889578988823658, + 0.7889578988823669, + 0.7889578988823669 ], - "timestamp": 1.6150139012878635 + "timestamp": 1.6150566441817331 } ], "trajectoryWaypoints": [ @@ -11679,7 +11784,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 1.0198904019924013, + "timestamp": 1.0208489348654473, "isStopPoint": false, "x": 6.965262451171874, "y": 5.795073509216309, @@ -11690,7 +11795,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 1.6150139012878635, + "timestamp": 1.6150566441817331, "isStopPoint": true, "x": 7.84, "y": 5.789093017578125, @@ -11773,9 +11878,9 @@ "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 3.864499903901422e-23, - "velocityX": 1.6362365454470194e-21, - "velocityY": 8.475122557710336e-22, + "angularVelocity": -1.0403534656091185e-23, + "velocityX": 2.8385757952612522e-21, + "velocityY": 1.754655461207754e-22, "moduleForcesX": [ 0, 0, @@ -11791,760 +11896,760 @@ "timestamp": 0 }, { - "x": 7.804386984749256, - "y": 5.818963407451602, - "heading": 3.141592654640039, - "angularVelocity": 1.3886947562622549e-8, - "velocityX": -0.47089570623239096, - "velocityY": 0.3949634209817354, + "x": 7.801915703893787, + "y": 5.819895567892892, + "heading": 3.141592654383112, + "angularVelocity": 1.0218405417972763e-8, + "velocityX": -0.49054796402101786, + "velocityY": 0.3967548278015514, "moduleForcesX": [ - -88.41685080559067, - -88.41685134026656, - -88.41684995134041, - -88.41685048601632 + -89.72456239926012, + -89.72456276282513, + -89.72456179694437, + -89.72456216050938 ], "moduleForcesY": [ - 74.15956707853897, - 74.1595664419741, - 74.15956809803673, - 74.15956746147187 + 72.5691589714727, + 72.56915852264281, + 72.56915971691674, + 72.56915926808685 ], - "timestamp": 0.07562824374781549 + "timestamp": 0.07763623315044801 }, { - "x": 7.733165130481669, - "y": 5.87870068413291, - "heading": 3.1415926567346326, - "angularVelocity": 2.769591969019193e-8, - "velocityX": -0.9417361919057625, - "velocityY": 0.7898805224209979, + "x": 7.7257526236644525, + "y": 5.8814962104214334, + "heading": 3.1415926559388794, + "angularVelocity": 2.003919753404797e-8, + "velocityX": -0.981024930482415, + "velocityY": 0.7934522326600857, "moduleForcesX": [ - -88.40648241970496, - -88.40648295141078, - -88.40648157044113, - -88.40648210214695 + -89.71157645751234, + -89.71157680696288, + -89.71157587879169, + -89.71157622824224 ], "moduleForcesY": [ - 74.15086997738469, - 74.15086934453556, - 74.15087099113398, - 74.15087035828488 + 72.55865592998232, + 72.5586554987349, + 72.5586566463959, + 72.55865621514847 ], - "timestamp": 0.15125648749563098 + "timestamp": 0.15527246630089603 }, { - "x": 7.626340702412968, - "y": 5.968299592298079, - "heading": 3.141592659864831, - "angularVelocity": 4.138927601200874e-8, - "velocityX": -1.4124938353045773, - "velocityY": 1.1847281349536445, + "x": 7.611519766641148, + "y": 5.973887660021114, + "heading": 3.141592658206744, + "angularVelocity": 2.9211418602605457e-8, + "velocityX": -1.4713858772866655, + "velocityY": 1.1900558006290556, "moduleForcesX": [ - -88.39092769362989, - -88.3909282209318, - -88.39092685175883, - -88.39092737906076 + -89.6903556646401, + -89.69035599106215, + -89.69035512437979, + -89.69035545080186 ], "moduleForcesY": [ - 74.1378225244418, - 74.13782189710157, - 74.13782352966786, - 74.13782290232764 + 72.54149253338231, + 72.54149213079452, + 72.54149320244666, + 72.54149279985887 ], - "timestamp": 0.22688473124344646 + "timestamp": 0.23290869945134404 }, { - "x": 7.4839241438804045, - "y": 6.087751371974113, - "heading": 3.14159266401632, - "angularVelocity": 5.489336496426752e-8, - "velocityX": -1.8831133909106093, - "velocityY": 1.5794599181008275, + "x": 7.459234501547516, + "y": 6.09705586883968, + "heading": 3.1415926610898817, + "angularVelocity": 3.713649834301922e-8, + "velocityX": -1.9615231047921198, + "velocityY": 1.586478424061156, "moduleForcesX": [ - -88.36499989530778, - -88.36500041539998, - -88.3649990655369, - -88.36499958562912 + -89.64943586702498, + -89.64943614914596, + -89.64943540062544, + -89.64943568274641 ], "moduleForcesY": [ - 74.11607403920986, - 74.1160734208864, - 74.1160750304833, - 74.11607441215983 + 72.50839656371215, + 72.50839621616346, + 72.50839714174288, + 72.50839679419418 ], - "timestamp": 0.30251297499126195 + "timestamp": 0.31054493260179206 }, { - "x": 7.305936340953446, - "y": 6.237038503722604, - "heading": 3.141592669161458, - "angularVelocity": 6.803196607882386e-8, - "velocityX": -2.353456778931214, - "velocityY": 1.9739600491886735, + "x": 7.268944263180371, + "y": 6.250962471535492, + "heading": 3.141592664325284, + "angularVelocity": 4.1673866210267806e-8, + "velocityX": -2.4510493444264503, + "velocityY": 1.9824068794986809, "moduleForcesX": [ - -88.31314580096668, - -88.31314630713541, - -88.31314499455604, - -88.3131455007248 + -89.53768198601384, + -89.53768214766599, + -89.53768171961279, + -89.53768188126494 ], "moduleForcesY": [ - 74.07257832876685, - 74.0725777278508, - 74.0725792930976, - 74.07257869218155 + 72.4180099222743, + 72.41800972375923, + 72.41801025311995, + 72.41801005460489 ], - "timestamp": 0.37814121873907747 + "timestamp": 0.38818116575224004 }, { - "x": 7.092439877339699, - "y": 6.4161084917221185, - "heading": 3.1415926752250933, - "angularVelocity": 8.017686861531298e-8, - "velocityX": -2.8229726492877, - "velocityY": 2.3677660504272553, + "x": 7.041301900991139, + "y": 6.435079442411686, + "heading": 3.14159266433028, + "angularVelocity": 6.434659980226883e-11, + "velocityX": -2.9321665020518712, + "velocityY": 2.3715340557469027, "moduleForcesX": [ - -88.15776848327013, - -88.15776895157923, - -88.1577677403473, - -88.15776820865639 + -87.9996031521211, + -87.99960165358323, + -87.99960551643635, + -87.99960401789855 ], "moduleForcesY": [ - 73.94224635017493, - 73.94224579656832, - 73.94224724125631, - 73.9422466876497 + 71.17401035154589, + 71.17401211337099, + 71.17400732956905, + 71.17400909139415 ], - "timestamp": 0.453769462486893 + "timestamp": 0.46581739890268803 }, { - "x": 6.862403858117085, - "y": 6.609050171403948, - "heading": 3.141592675228291, - "angularVelocity": 4.227895638899564e-11, - "velocityX": -3.0416681364395526, - "velocityY": 2.5511855111325605, + "x": 6.8136379578443655, + "y": 6.619213767938429, + "heading": 3.1415926643325944, + "angularVelocity": 2.98162795621733e-11, + "velocityX": -2.9324444773820173, + "velocityY": 2.371757593776043, "moduleForcesX": [ - -41.06294995986311, - -41.06294622640053, - -41.06295115821892, - -41.0629474244754 + -0.05084358373972663, + -0.050843579300801696, + -0.05084358138239444, + -0.050843576958249995 ], "moduleForcesY": [ - 34.43941386958152, - 34.43941479451641, - 34.439408469304176, - 34.43940939490503 + 0.04088662735497638, + 0.040886627539810205, + 0.04088662720255321, + 0.0408866274277148 ], - "timestamp": 0.5293977062347085 + "timestamp": 0.543453632053136 }, { - "x": 6.632357399761043, - "y": 6.801980462733905, - "heading": 3.1415926752313657, - "angularVelocity": 4.0648056359994824e-11, - "velocityX": -3.041806168646974, - "velocityY": 2.5510349278146487, + "x": 6.58597261081092, + "y": 6.803346358526077, + "heading": 3.1415926643349095, + "angularVelocity": 2.9815304194295546e-11, + "velocityX": -2.932462560261807, + "velocityY": 2.371735246747818, "moduleForcesX": [ - -0.025917328301607805, - -0.025917397773985305, - -0.025917320555397437, - -0.0259173893513379 + -0.00330748172317311, + -0.003307481786022645, + -0.003307481858617945, + -0.0033074819207971947 ], "moduleForcesY": [ - -0.028273671044889415, - -0.028274266787425645, - -0.02827372578557447, - -0.02827431541372518 + -0.004087423562569713, + -0.004087423593728358, + -0.00408742360898491, + -0.00408742364067536 ], - "timestamp": 0.605025949982524 + "timestamp": 0.621089865203584 }, { - "x": 6.402072911582864, - "y": 6.994626570545385, - "heading": 3.141592675234442, - "angularVelocity": 4.067971071486534e-11, - "velocityX": -3.044953535428767, - "velocityY": 2.5472772903978105, + "x": 6.358266536478161, + "y": 6.987428581453392, + "heading": 3.1415926643372245, + "angularVelocity": 2.98196238161316e-11, + "velocityX": -2.932987151649883, + "velocityY": 2.3710864818826223, "moduleForcesX": [ - -0.5909595067608326, - -0.5909594800381297, - -0.5909593823052591, - -0.5909593553877736 + -0.09595133639405176, + -0.09595133636676093, + -0.09595133624904402, + -0.0959513362215452 ], "moduleForcesY": [ - -0.705545714436184, - -0.7055458142175607, - -0.7055456945121211, - -0.7055457941638968 + -0.11866351061120779, + -0.11866351070665564, + -0.11866351059046351, + -0.1186635106857128 ], - "timestamp": 0.6806541937303395 + "timestamp": 0.698726098354032 }, { - "x": 6.1663635965102745, - "y": 7.1805951955577285, - "heading": 3.141592675237588, - "angularVelocity": 4.1596178423747995e-11, - "velocityX": -3.1166837069305515, - "velocityY": 2.4589837843182147, + "x": 6.129385033333283, + "y": 7.170047155234762, + "heading": 3.14159266433955, + "angularVelocity": 2.995690672790387e-11, + "velocityX": -2.948127360859174, + "velocityY": 2.3522338265366587, "moduleForcesX": [ - -13.468281354040977, - -13.468281333716769, - -13.468281376664086, - -13.46828135618857 + -2.769247337930091, + -2.7692473384292775, + -2.7692473400290107, + -2.769247340528674 ], "moduleForcesY": [ - -16.578264863811963, - -16.578264874356943, - -16.57826484852706, - -16.578264859051814 + -3.44827901258727, + -3.4482790111240282, + -3.4482790129454086, + -3.4482790114828967 ], - "timestamp": 0.756282437478155 + "timestamp": 0.77636233150448 }, { - "x": 5.907218564598163, - "y": 7.332200360310185, - "heading": 3.14159267524121, - "angularVelocity": 4.7894146112420855e-11, - "velocityX": -3.426564191761982, - "velocityY": 2.004610410602528, + "x": 5.88209636867458, + "y": 7.326837161822197, + "heading": 3.1415926643421153, + "angularVelocity": 3.30371829044516e-11, + "velocityX": -3.1852223455959274, + "velocityY": 2.0195468046936056, "moduleForcesX": [ - -58.1841290599635, - -58.18412906038532, - -58.18412906031337, - -58.18412906073494 + -43.36628685569254, + -43.36628685589723, + -43.36628685569064, + -43.36628685589532 ], "moduleForcesY": [ - -85.31456581504214, - -85.31456581480037, - -85.31456581471323, - -85.31456581447162 + -60.85072123516317, + -60.85072123509917, + -60.850721235009324, + -60.850721234945325 ], - "timestamp": 0.8319106812259706 + "timestamp": 0.853998564654928 }, { - "x": 5.628079296821089, - "y": 7.442713249379176, - "heading": 3.141592675245288, - "angularVelocity": 5.391640365188102e-11, - "velocityX": -3.6909394419877284, - "velocityY": 1.4612647814155275, + "x": 5.612608115354213, + "y": 7.44131210061748, + "heading": 3.141592664345216, + "angularVelocity": 3.994305220349218e-11, + "velocityX": -3.4711660056733877, + "velocityY": 1.474504031815228, "moduleForcesX": [ - -49.639923881366215, - -49.639923881932916, - -49.63992388172823, - -49.63992388229493 + -52.30104213787289, + -52.3010421384724, + -52.30104213828144, + -52.301042138880945 ], "moduleForcesY": [ - -102.02027478517165, - -102.02027478490187, - -102.02027478497904, - -102.02027478470927 + -99.69203382192678, + -99.69203382162236, + -99.69203382168664, + -99.69203382138221 ], - "timestamp": 0.9075389249737861 + "timestamp": 0.931634797805376 }, { - "x": 5.335317495359145, - "y": 7.509086944055442, - "heading": 3.1415926750707146, - "angularVelocity": -2.3083108894089293e-9, - "velocityX": -3.8710643927970487, - "velocityY": 0.8776310461153854, + "x": 5.327912239314761, + "y": 7.50959437971124, + "heading": 3.1415926642865455, + "angularVelocity": -7.557067068121798e-10, + "velocityX": -3.6670490631320476, + "velocityY": 0.8795156117561669, "moduleForcesX": [ - -33.8208243425392, - -33.82082406908601, - -33.820824230126675, - -33.820823956673486 + -35.8283448481557, + -35.82834476031454, + -35.828344809681155, + -35.828344721840004 ], "moduleForcesY": [ - -109.58489553923485, - -109.5848956230017, - -109.58489557665949, - -109.58489566042633 + -108.82743270079975, + -108.82743272946998, + -108.82743271448132, + -108.82743274315155 ], - "timestamp": 0.9831671687216016 + "timestamp": 1.009271030955824 }, { "x": 5.035840072631835, "y": 7.529608249664307, "heading": 3.141592653589793, - "angularVelocity": -2.8403305758359793e-7, - "velocityX": -3.9598621875436577, - "velocityY": 0.27134446857306244, + "angularVelocity": -1.3778041516011634e-7, + "velocityX": -3.762059992232384, + "velocityY": 0.25779032728547985, "moduleForcesX": [ - -16.672973763417268, - -16.67293682726911, - -16.67296653041068, - -16.672929594277857 + -17.378156269782163, + -17.37813883051833, + -17.378152707029265, + -17.378135267768847 ], "moduleForcesY": [ - -113.83826079590199, - -113.83826618574518, - -113.83826203751487, - -113.83826742735344 + -113.71778560366965, + -113.71778825853885, + -113.71778623741099, + -113.7177888922791 ], - "timestamp": 1.058795412469417 + "timestamp": 1.086907264106272 }, { - "x": 4.8161858301349545, - "y": 7.544659774408683, - "heading": 3.141261009826011, - "angularVelocity": -0.005977710911032145, - "velocityX": -3.959156496885198, - "velocityY": 0.271296112027398, + "x": 4.818734526967475, + "y": 7.544485128232927, + "heading": 3.141362002173113, + "angularVelocity": -0.003996340436793055, + "velocityX": -3.7616403301464163, + "velocityY": 0.2577615704802417, "moduleForcesX": [ - -0.018593166864404487, - 0.3800231783603618, - -0.0187780717345422, - 0.37983792515152204 + -0.024792117629372414, + 0.23137972399738163, + -0.024874744188840826, + 0.23129698238991547 ], "moduleForcesY": [ - 0.25515896497117335, - 0.25501866357344083, - -0.2797750022282368, - -0.2799103160185767 + 0.16484362026686902, + 0.16478126217454553, + -0.17893257077270838, + -0.17899328061213599 ], - "timestamp": 1.1142754731009405 + "timestamp": 1.1446229218007196 }, { - "x": 4.596531603138407, - "y": 7.559711298090919, - "heading": 3.140929288083857, - "angularVelocity": -0.0059791164317072945, - "velocityX": -3.9591562174995163, - "velocityY": 0.27129609288285317, + "x": 4.60162898654068, + "y": 7.55936200644265, + "heading": 3.1411313232709985, + "angularVelocity": -0.003996816658245245, + "velocityX": -3.761640239398693, + "velocityY": 0.2577615642618706, "moduleForcesX": [ - 0.000025612992006065086, - 0.00011941564717905257, - 0.00002360245464479842, - 0.0001174054593274741 + 0.000007204180719356383, + 0.00003773149835788362, + 0.0000069231161169374015, + 0.00003745044709400768 ], "moduleForcesY": [ - 0.00005871943135136759, - 0.00005720676841727365, - -0.00006700765927160055, - -0.00006851882774530035 + 0.000019058256691630695, + 0.000018849052179001888, + -0.000021908763710286178, + -0.00002211834623925837 ], - "timestamp": 1.169755533732464 + "timestamp": 1.202338579495167 }, { - "x": 4.37687737872891, - "y": 7.574762821595881, - "heading": 3.140597534231695, - "angularVelocity": -0.005979695198340648, - "velocityX": -3.9591561708692615, - "velocityY": 0.27129608968757485, + "x": 4.38452344666509, + "y": 7.574238884614604, + "heading": 3.140900634383137, + "angularVelocity": -0.003996989674498232, + "velocityX": -3.7616402298483314, + "velocityY": 0.2577615636074443, "moduleForcesX": [ - -0.000006771269872669978, - 0.00003182466245725801, - -0.000007954457474905524, - 0.00003064136901031203 + -0.000003179633409385358, + 0.000007911345105099387, + -0.0000032118578890623888, + 0.000007879121329596486 ], "moduleForcesY": [ - 0.0000255199387963323, - 0.000024637757552653808, - -0.000026273740195479133, - -0.00002715529916690631 + 0.000007292887593340667, + 0.000007268884281012189, + -0.000007590905367963583, + -0.000007614919170638431 ], - "timestamp": 1.2252355943639877 + "timestamp": 1.2600542371896146 }, { - "x": 4.157223156893371, - "y": 7.5898143449244655, - "heading": 3.140265748410205, - "angularVelocity": -0.005980271429300119, - "velocityX": -3.959156124474958, - "velocityY": 0.27129608650846476, + "x": 4.167417907338466, + "y": 7.589115762748939, + "heading": 3.1406699355417973, + "angularVelocity": -0.003997162131650262, + "velocityX": -3.7616402203368033, + "velocityY": 0.257761562955679, "moduleForcesX": [ - -0.000006828724200291363, - 0.00003159709828148899, - -0.000007847745328245317, - 0.00003057810699160968 + -0.0000031755909448883706, + 0.000007879578382528402, + -0.0000031991997213915274, + 0.00000785596949024404 ], "moduleForcesY": [ - 0.00002534996110939576, - 0.00002458955338139237, - -0.000026218051690890895, - -0.00002697625269046444 + 0.000007266281602389286, + 0.000007248684756348649, + -0.000007569405113026906, + -0.000007586995154163464 ], - "timestamp": 1.2807156549955112 + "timestamp": 1.3177698948840622 }, { - "x": 3.9375689376216587, - "y": 7.604865868077368, - "heading": 3.1399339307508978, - "angularVelocity": -0.005980845289820074, - "velocityX": -3.9591560782633017, - "velocityY": 0.2712960833418705, + "x": 3.950312368559187, + "y": 7.603992640845768, + "heading": 3.1404392267773398, + "angularVelocity": -0.003997334062777751, + "velocityX": -3.7616402108533076, + "velocityY": 0.2577615623058347, "moduleForcesX": [ - -0.000007003893466524137, - 0.00003137644246304145, - -0.000007716670892301974, - 0.00003065586212925565 + -0.0000031650180316538163, + 0.00000785642813949844, + -0.000003189843558058993, + 0.000007831602528717756 ], "moduleForcesY": [ - 0.00002508688541999312, - 0.00002456619647907267, - -0.00002616067770793661, - -0.000026734380327000042 + 0.000007244577609204609, + 0.00000722607953419065, + -0.000007545849230742892, + -0.000007564351262925504 ], - "timestamp": 1.3361957156270348 + "timestamp": 1.3754855525785097 }, { - "x": 3.7179147209650303, - "y": 7.619917391051073, - "heading": 3.1396020811924448, - "angularVelocity": -0.005981420255779386, - "velocityX": -3.9591560311277267, - "velocityY": 0.2712960801119657, + "x": 3.7332068303256905, + "y": 7.618869518905198, + "heading": 3.140208508119994, + "angularVelocity": -0.003997505470129434, + "velocityX": -3.761640201396926, + "velocityY": 0.25776156165784825, "moduleForcesX": [ - -0.000009319624026353035, - 0.000030180280445294102, - -0.000006030651673570838, - 0.00003342764857052338 + -0.000003139443251794745, + 0.000007849472748191663, + -0.0000031961911096245354, + 0.000007792645970955111 ], "moduleForcesY": [ - 0.000023333383452071322, - 0.000025631362768478403, - -0.00002732752627695467, - -0.000024944013734834488 + 0.000007233882319316402, + 0.000007191809830107993, + -0.000007510298546544899, + -0.000007553108492988018 ], - "timestamp": 1.3916757762585583 + "timestamp": 1.4332012102729572 }, { - "x": 3.4982607821829097, - "y": 7.6349688949837855, - "heading": 3.139269331864783, - "angularVelocity": -0.0059976381401617785, - "velocityX": -3.959151022580424, - "velocityY": 0.2712957369076971, + "x": 3.5161012930772024, + "y": 7.633746396897135, + "heading": 3.139977778282167, + "angularVelocity": -0.0039976991867276025, + "velocityX": -3.7616401843303224, + "velocityY": 0.25776156048838117, "moduleForcesX": [ - 0.0007285537406330433, - 0.001811076606425356, - 0.0007528434980948667, - 0.001835303631750865 + -0.0000014116108881133617, + 0.000011019749815764846, + -0.000002621565097237515, + 0.00000980949966013142 ], "moduleForcesY": [ - 0.000627411463822769, - 0.0006476415599085048, - -0.0008211396945749756, - -0.0008052876922952627 + 0.000008490177644347142, + 0.00000758605235247693, + -0.00000816248114807126, + -0.000009064678215248934 ], - "timestamp": 1.4471558368900819 + "timestamp": 1.4909168679674047 }, { - "x": 3.2798256792271516, - "y": 7.64993687975752, - "heading": 3.1350177074584384, - "angularVelocity": -0.07663337707184525, - "velocityX": -3.9371821239799423, - "velocityY": 0.2697903463578353, + "x": 3.2989992517382074, + "y": 7.64862303533636, + "heading": 3.1397365466438067, + "angularVelocity": -0.004179656751686542, + "velocityX": -3.761579613080985, + "velocityY": 0.2577574099213453, "moduleForcesX": [ - 3.296557142281396, - 7.9931063127683935, - 3.253508368256429, - 7.948703890044839 + 0.009094518544934321, + 0.020760270010339598, + 0.00904545717923623, + 0.020710863085541747 ], "moduleForcesY": [ - 2.801876303040713, - 2.759504254960753, - -3.542841057080209, - -3.5597663854953625 + 0.006822833855844057, + 0.006786622694691792, + -0.008828299595036847, + -0.00886593159601708 ], - "timestamp": 1.5026358975216054 + "timestamp": 1.5486325256618523 }, { - "x": 3.085089770895548, - "y": 7.663280907669538, - "heading": 3.1061216686741075, - "angularVelocity": -0.5208364672895216, - "velocityX": -3.5100161412036353, - "velocityY": 0.24051934623224086, + "x": 3.096646383405922, + "y": 7.662489005645776, + "heading": 3.099333264388169, + "angularVelocity": -0.7000402294562237, + "velocityX": -3.506030710133492, + "velocityY": 0.24024624968883984, "moduleForcesX": [ - 110.08477802292596, - 112.65722835544773, - 104.97488015141077, - 109.6179279413187 + 50.58995823941143, + 79.06859096182117, + 45.97379077401858, + 75.8657491189175 ], "moduleForcesY": [ - 26.808134666937427, - 17.266378646952173, - -42.77379521334851, - -31.268524352599442 + 38.05399401236147, + 24.57350746925117, + -45.80018724585968, + -34.060897653647004 ], - "timestamp": 1.558115958153129 + "timestamp": 1.6063481833562998 }, { - "x": 2.9140881310661415, - "y": 7.674998575327416, - "heading": 3.105155596402206, - "angularVelocity": -0.017412963520669334, - "velocityX": -3.082217969535596, - "velocityY": 0.2112050261751083, + "x": 2.919012707732214, + "y": 7.674661125038715, + "heading": 3.099412894248109, + "angularVelocity": 0.0013796924980262152, + "velocityX": -3.077738048383994, + "velocityY": 0.2108980453342208, "moduleForcesX": [ - 109.9895441753885, - 104.3550095871483, - 113.34322693340162, - 110.29427213876137 + 107.90307319855803, + 96.77847026846727, + 112.04384390865157, + 104.77822606455008 ], "moduleForcesY": [ - -33.76600581568565, - -47.977843161565495, - 19.747360186036925, - 31.984331361894554 + -39.74279143105395, + -61.53659629055023, + 25.83328260307731, + 46.56311157639288 ], - "timestamp": 1.6135960187846525 + "timestamp": 1.6640638410507473 }, { "x": 2.7659969711303702, "y": 7.685146331787109, "heading": 3.141592653589793, - "angularVelocity": 0.6567595055381638, - "velocityX": -2.6692681704033054, - "velocityY": 0.1829081717680586, + "angularVelocity": 0.7308200413306929, + "velocityX": -2.6511997387593533, + "velocityY": 0.1816700557048786, "moduleForcesX": [ - 108.47344443180623, - 96.6165545347875, - 112.06660691389175, - 105.62360385351923 + 108.15585163442545, + 95.19524925336405, + 111.83787419864782, + 104.58809520720982 ], "moduleForcesY": [ - -38.92519570430599, - -62.57662299104669, - 26.852206267300026, - 45.67914176512214 + -39.76761501132118, + -64.67933399593002, + 27.74194212984173, + 47.94032248604623 ], - "timestamp": 1.669076079416176 + "timestamp": 1.7217794987451949 }, { - "x": 2.6038982695286825, - "y": 7.6649237183136245, - "heading": 3.1956405337177562, - "angularVelocity": 0.8367505818789198, - "velocityX": -2.509556018957626, - "velocityY": -0.31307950563441456, + "x": 2.6049640410007115, + "y": 7.664782649008714, + "heading": 3.199393744124749, + "angularVelocity": 0.8964222673734166, + "velocityX": -2.4974183534013745, + "velocityY": -0.31581512596622574, "moduleForcesX": [ - 41.83422551523414, - 20.093926933349472, - 53.26988081724765, - 25.248051251260662 + 40.44308656666281, + 19.971440754964316, + 50.5564706430957, + 24.496369207505076 ], "moduleForcesY": [ - -107.56161028308787, - -113.64526973932998, - -102.36030698406806, - -112.58952761642207 + -108.09087389552258, + -113.66567125217688, + -103.72669846411075, + -112.7558034048473 ], - "timestamp": 1.7336686608836411 + "timestamp": 1.7862592563758453 }, { - "x": 2.4534559802327696, - "y": 7.613116434507106, - "heading": 3.2609374996678535, - "angularVelocity": 1.0109050368731118, - "velocityX": -2.3290954762613025, - "velocityY": -0.8020624447811121, + "x": 2.4552001283226645, + "y": 7.6127809056837235, + "heading": 3.2674705141312166, + "angularVelocity": 1.0557851410735914, + "velocityX": -2.322650056098511, + "velocityY": -0.8064816810085402, "moduleForcesX": [ - 46.569118384529254, - 25.536274706249664, - 56.81596418002528, - 29.770241346526486 + 45.226375041875606, + 25.499150978953512, + 54.13342499304107, + 29.095970420083155 ], "moduleForcesY": [ - -105.58420453918784, - -112.5342845020268, - -100.41663085453068, - -111.46183761296864 + -106.16430182617323, + -112.54112536251203, + -101.88695367808478, + -111.64007832404384 ], - "timestamp": 1.7982612423511062 + "timestamp": 1.8507390140064957 }, { - "x": 2.3166983247379, - "y": 7.530531275179707, - "heading": 3.3369071826052106, - "angularVelocity": 1.1761363489648233, - "velocityX": -2.117234710053416, - "velocityY": -1.2785548657626704, + "x": 2.3187605854028295, + "y": 7.529933622115766, + "heading": 3.3452171134733306, + "angularVelocity": 1.2057520406242563, + "velocityX": -2.116005827772772, + "velocityY": -1.2848572422141984, "moduleForcesX": [ - 53.22911230390824, - 33.52093165182788, - 62.28363856197371, - 37.27033259543514 + 51.96652105002971, + 33.61193018096148, + 59.71715418771986, + 36.73910240668683 ], "moduleForcesY": [ - -102.36662249013636, - -110.39863935620404, - -97.09133480103483, - -109.15657312819252 + -103.01044274754196, + -110.36868341598839, + -98.68934221201854, + -109.33674686043935 ], - "timestamp": 1.8628538238185712 + "timestamp": 1.915218771637146 }, { - "x": 2.1969742890390256, - "y": 7.418854878805073, - "heading": 3.4225521025382863, - "angularVelocity": 1.3259250209130369, - "velocityX": -1.8535261012780346, - "velocityY": -1.7289353334002464, + "x": 2.1990562651224095, + "y": 7.417920323946954, + "heading": 3.4315895544419974, + "angularVelocity": 1.339528002934206, + "velocityX": -1.856463558162018, + "velocityY": -1.7371854716086164, "moduleForcesX": [ - 63.43366418473747, - 46.39707082363183, - 71.42788762753945, - 50.63883300977951 + 62.373204466867904, + 46.75158878982661, + 69.15810736949037, + 50.35015435786028 ], "moduleForcesY": [ - -96.33740524696931, - -105.59817168074845, - -90.52715351089934, - -103.58836930621423 + -97.02260752007696, + -105.43790145029102, + -92.27049869774041, + -103.72888519276769 ], - "timestamp": 1.9274464052860363 + "timestamp": 1.9796985292677964 }, { - "x": 2.1003596745762305, - "y": 7.282561627306502, - "heading": 3.515746646315559, - "angularVelocity": 1.4428056854209226, - "velocityX": -1.4957540365755344, - "velocityY": -2.110044968046691, + "x": 2.1023160383572215, + "y": 7.281280072098081, + "heading": 3.5243571583852424, + "angularVelocity": 1.4387089429620925, + "velocityX": -1.5003193299721926, + "velocityY": -2.1191185710028386, "moduleForcesX": [ - 81.12995040952684, - 70.24316896316002, - 87.54712653568924, - 75.69379680678855 + 80.66473849864626, + 71.23628387541477, + 86.0067061174086, + 75.822836584088 ], "moduleForcesY": [ - -81.90176576678063, - -91.3996674473233, - -74.94978844811001, - -86.88518138121633 + -82.34976809206437, + -90.61976741253586, + -76.70722702894611, + -86.77144470833042 ], - "timestamp": 1.9920389867535013 + "timestamp": 2.044178286898447 }, { - "x": 2.0362298570340878, - "y": 7.136817952344609, - "heading": 3.6091816521183286, - "angularVelocity": 1.4465284353100543, - "velocityX": -0.9928356490047431, - "velocityY": -2.256353154662237, + "x": 2.038063613949293, + "y": 7.135647873363902, + "heading": 3.6158452935029373, + "angularVelocity": 1.4188659895676503, + "velocityX": -0.9964743474374704, + "velocityY": -2.258572365739674, "moduleForcesX": [ - 110.54658737476858, - 110.46580054393857, - 110.65938530025991, - 110.57960043427866 + 111.05416659333262, + 111.44531662002107, + 110.46111986931379, + 110.88084813088572 ], "moduleForcesY": [ - -32.22495698602908, - -32.49781898234213, - -31.831627846959382, - -32.10463531819637 + -30.379702096445413, + -28.93083101067706, + -32.49068702774339, + -31.04484716514678 ], - "timestamp": 2.056631568220966 + "timestamp": 2.1086580445290974 }, { - "x": 2.0000328535317293, - "y": 7.00954832171531, - "heading": 3.684763708566743, - "angularVelocity": 1.1701352497652446, - "velocityX": -0.5603894856035522, - "velocityY": -1.9703443915367336, + "x": 2.0013545736510343, + "y": 7.0088159096041425, + "heading": 3.688917978757038, + "angularVelocity": 1.1332655074895304, + "velocityX": -0.5693110775715734, + "velocityY": -1.9670043502066354, "moduleForcesX": [ - 84.5907695917968, - 87.53770821277455, - 104.56901726794132, - 103.5827144442495 + 82.87186793378049, + 86.23137198290867, + 104.08623484052183, + 103.1023851887016 ], "moduleForcesY": [ - 78.09476192896813, - 74.87353802308712, - 48.15163557428633, - 50.38760823256537 + 79.91712175914667, + 76.3774570141547, + 49.184042523510534, + 51.3661933336912 ], - "timestamp": 2.121224149688431 + "timestamp": 2.173137802159748 }, { - "x": 1.979849844477774, - "y": 6.911539256829025, - "heading": 3.739739735467122, - "angularVelocity": 0.8511198291102626, - "velocityX": -0.3124663637127081, - "velocityY": -1.5173424356116236, + "x": 1.9805814621873397, + "y": 6.911177269143885, + "heading": 3.741849430185043, + "angularVelocity": 0.8209002851903341, + "velocityX": -0.32216485028818215, + "velocityY": -1.514252597218904, "moduleForcesX": [ - 30.06375622596869, - 46.109164119120635, - 66.85054699912203, - 74.9927037213041 + 30.484801894737167, + 46.14585781783154, + 66.51760613520348, + 74.56500704734002 ], "moduleForcesY": [ - 111.27708032715553, - 105.68256490842481, - 93.84303659418204, - 87.55367623297971 + 111.16368416399357, + 105.66705745601732, + 94.08276854670737, + 87.91946833120016 ], - "timestamp": 2.1858167311558963 + "timestamp": 2.2376175597903987 }, { - "x": 1.9693496075903936, - "y": 6.845493549123404, - "heading": 3.775413943056067, - "angularVelocity": 0.5522957401371797, - "velocityX": -0.16256103485613407, - "velocityY": -1.0224967976994015, + "x": 1.9696098500886425, + "y": 6.84537565225515, + "heading": 3.7761218180779657, + "angularVelocity": 0.5315216612512774, + "velocityX": -0.17015591407061162, + "velocityY": -1.020500375724993, "moduleForcesX": [ - 6.490482928093923, - 26.678062716919083, - 41.639324015691834, - 57.01438866829596 + 7.91174135701497, + 27.295991115954823, + 41.965926793271784, + 56.732341958223216 ], "moduleForcesY": [ - 115.1532497135499, - 112.22997904008609, - 107.51146412413155, - 100.25774640780517 + 115.06446151670663, + 112.08099626886076, + 107.38703277594348, + 100.41815919051018 ], - "timestamp": 2.2504093126233613 + "timestamp": 2.3020973174210493 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 0.2696598841914468, - "velocityX": -0.0653429655066825, - "velocityY": -0.5140355112232071, + "angularVelocity": 0.25915347126399724, + "velocityX": -0.06949333381079396, + "velocityY": -0.5131065156466116, "moduleForcesX": [ - -4.8570701717238745, - 16.654847468018957, - 27.261383429269873, - 46.43149894465734 + -3.0597671677725646, + 17.497246051702884, + 28.010467240856862, + 46.226601115224796 ], "moduleForcesY": [ - 115.26897371338562, - 114.17712362294918, - 112.06865783448855, - 105.61087783646231 + 115.33044468651329, + 114.05057698106346, + 111.88568251229192, + 105.70098429664759 ], - "timestamp": 2.3150018940908264 + "timestamp": 2.3665770750517 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 5.645981487090982e-22, - "velocityX": 3.176043053137262e-21, - "velocityY": 7.195320626100023e-23, + "angularVelocity": 4.18442017835183e-20, + "velocityX": 1.2624704293971776e-19, + "velocityY": 8.893851774089632e-21, "moduleForcesX": [ - -11.194107913078028, - 10.902305920487592, - 18.094880741208765, - 39.657568879500616 + -9.238891886617166, + 11.831191033757847, + 19.1293505178647, + 39.49563580458859 ], "moduleForcesY": [ - 114.84784529450765, - 114.88625738279924, - 113.93583193326246, - 108.35750475803425 + 115.02128580058941, + 114.79379693930308, + 113.76815074013281, + 108.41678324342678 ], - "timestamp": 2.3795944755582914 + "timestamp": 2.4310568326823505 } ], "trajectoryWaypoints": [ @@ -12560,7 +12665,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 1.058795412469417, + "timestamp": 1.086907264106272, "isStopPoint": false, "x": 5.035840072631835, "y": 7.529608249664307, @@ -12571,7 +12676,7 @@ "controlIntervalCount": 11 }, { - "timestamp": 1.669076079416176, + "timestamp": 1.7217794987451949, "isStopPoint": false, "x": 2.7659969711303702, "y": 7.685146331787109, @@ -12582,7 +12687,7 @@ "controlIntervalCount": 11 }, { - "timestamp": 2.3795944755582914, + "timestamp": 2.4310568326823505, "isStopPoint": true, "x": 1.9651289367675773, "y": 6.812290668487549, @@ -12657,7 +12762,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { "x": 7.4399999999999995, @@ -12666,7 +12771,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { "x": 3.901903190612792, @@ -12764,9 +12869,9 @@ "x": 1.3383026504516593, "y": 6.508597373962402, "heading": 3.141592653589793, - "angularVelocity": 6.630957232918865e-24, - "velocityX": 1.2060997095687284e-21, - "velocityY": 7.138625871741085e-22, + "angularVelocity": 1.3038840850576071e-23, + "velocityX": 2.4437165324259185e-20, + "velocityY": 2.3610738986678838e-20, "moduleForcesX": [ 0, 0, @@ -12782,3112 +12887,3154 @@ "timestamp": 0 }, { - "x": 1.360373693575745, - "y": 6.490858286972303, - "heading": 3.1415926537545715, - "angularVelocity": 2.791277359525368e-9, - "velocityX": 0.37387393953457276, - "velocityY": -0.30049247330305445, + "x": 1.3606762519021935, + "y": 6.491593300242642, + "heading": 3.141592653934462, + "angularVelocity": 5.860742394414825e-9, + "velocityX": 0.3804405020078545, + "velocityY": -0.28913710456614355, "moduleForcesX": [ - 89.9335744997474, - 89.93357437032692, - 89.93357471542468, - 89.93357458600421 + 91.86115898733682, + 91.86115873638171, + 91.86115942954156, + 91.86115917858646 ], "moduleForcesY": [ - -72.28201650320291, - -72.28201666391996, - -72.28201623452371, - -72.28201639524077 + -69.8150419508136, + -69.81504228033295, + -69.81504136827428, + -69.81504169779365 ], - "timestamp": 0.05903338208477806 + "timestamp": 0.058809725390574434 }, { - "x": 1.405907900199343, - "y": 6.457273283717531, - "heading": 3.141592654041051, - "angularVelocity": 4.8528378035858e-9, - "velocityX": 0.7713297970664508, - "velocityY": -0.5689154520494931, + "x": 1.4065981178654914, + "y": 6.459259290320045, + "heading": 3.141592654534016, + "angularVelocity": 1.0194809067899609e-8, + "velocityX": 0.7808549633298908, + "velocityY": -0.5498071910361221, "moduleForcesX": [ - 95.60609124537717, - 95.60609117215726, - 95.60609139046502, - 95.60609131724513 + 96.68407098415938, + 96.68407083847602, + 96.68407128358729, + 96.68407113790394 ], "moduleForcesY": [ - -64.56785412261065, - -64.56785423072633, - -64.56785390750468, - -64.56785401562036 + -62.94139609260588, + -62.9413963157317, + -62.94139563208089, + -62.941395855206714 ], - "timestamp": 0.11806676416955612 + "timestamp": 0.11761945078114887 }, { - "x": 1.4765447536535539, - "y": 6.4106030861332375, - "heading": 3.141592654382145, - "angularVelocity": 5.7779888064285394e-9, - "velocityX": 1.1965577942454484, - "velocityY": -0.7905729933831371, + "x": 1.4774683902709602, + "y": 6.414007881814992, + "heading": 3.1415926552518396, + "angularVelocity": 1.2205862140824193e-8, + "velocityX": 1.2050774244361193, + "velocityY": -0.769454511214312, "moduleForcesX": [ - 102.28654562921923, - 102.28654560786362, - 102.28654568393445, - 102.28654566257883 + 102.43275036895024, + 102.43275032289199, + 102.43275048774566, + 102.4327504416874 ], "moduleForcesY": [ - -53.318653483475146, - -53.31865352424747, - -53.31865337837213, - -53.31865341914446 + -53.03603938436765, + -53.03603947289088, + -53.03603915462784, + -53.03603924315107 ], - "timestamp": 0.17710014625433418 + "timestamp": 0.1764291761717233 }, { - "x": 1.574035572309243, - "y": 6.354993169367381, - "heading": 3.1415926546713044, - "angularVelocity": 4.898239232168307e-9, - "velocityX": 1.6514523683512157, - "velocityY": -0.9420079758600776, + "x": 1.5748401096935096, + "y": 6.359448552089576, + "heading": 3.1415926558733664, + "angularVelocity": 1.0568433440115126e-8, + "velocityX": 1.6557077724113216, + "velocityY": -0.9277263133447715, "moduleForcesX": [ - 109.4226977827373, - 109.42269779178159, - 109.4226977467203, - 109.4226977557646 + 108.80919848005884, + 108.80919849872592, + 108.80919840952849, + 108.80919842819554 ], "moduleForcesY": [ - -36.42695526387283, - -36.42695523703391, - -36.42695537221109, - -36.42695534537217 + -38.21630738279977, + -38.2163073302424, + -38.216307583892046, + -38.21630753133467 ], - "timestamp": 0.23613352833911225 + "timestamp": 0.23523890156229774 }, { - "x": 1.6996897527512385, - "y": 6.296639809307858, - "heading": 3.1415926547484605, - "angularVelocity": 1.3069855500542915e-9, - "velocityX": 2.12852755516435, - "velocityY": -0.9884807205476072, + "x": 1.7000330137492494, + "y": 6.301073904680199, + "heading": 3.1415926560683887, + "angularVelocity": 3.3161627750963975e-9, + "velocityX": 2.1287789260074454, + "velocityY": -0.9926019382286351, "moduleForcesX": [ - 114.75813729356562, - 114.758137297369, - 114.75813724814749, - 114.75813725195087 + 114.22775516938997, + 114.22775518362513, + 114.22775504044942, + 114.22775505468458 ], "moduleForcesY": [ - -11.178794576619698, - -11.178794542775297, - -11.178795043548345, - -11.178795009703942 + -15.664867188867005, + -15.664867092783892, + -15.66486813051833, + -15.664868034435214 ], - "timestamp": 0.2951669104238903 + "timestamp": 0.29404862695287215 }, { - "x": 1.8530572488614867, - "y": 6.243977280961659, - "heading": 3.1415926544261383, - "angularVelocity": -5.4599966824676236e-9, - "velocityX": 2.59797915508206, - "velocityY": -0.89208048880833, + "x": 1.8529974827402018, + "y": 6.246814000732414, + "heading": 3.14159265541152, + "angularVelocity": -1.1169390588664581e-8, + "velocityX": 2.601006346740538, + "velocityY": -0.9226348803268013, "moduleForcesX": [ - 112.92432007869411, - 112.92432010689029, - 112.92432025584654, - 112.92432028404271 + 114.02402722958729, + 114.02402726270897, + 114.02402750725163, + 114.02402754037331 ], "moduleForcesY": [ - 23.188611712515762, - 23.188611580506432, - 23.18861084835494, - 23.18861071634561 + 16.894246009646203, + 16.89424580273802, + 16.894244132302816, + 16.894243925394655 ], - "timestamp": 0.35420029250866836 + "timestamp": 0.3528583523434466 }, { "x": 2.0305891418457023, "y": 6.206027030944824, "heading": 3.141592653589793, - "angularVelocity": -1.41673272774077e-8, - "velocityX": 3.0073136031620438, - "velocityY": -0.6428608471446738, + "angularVelocity": -3.0976627423086376e-8, + "velocityX": 3.01976684852814, + "velocityY": -0.6935412385742356, "moduleForcesX": [ - 98.46342857989701, - 98.46342884163893, - 98.46342915330816, - 98.46342941505006 + 101.11390491533385, + 101.11390541508874, + 101.1139061315249, + 101.11390663127975 ], "moduleForcesY": [ - 59.94858455591424, - 59.94858412862332, - 59.9485836119735, - 59.948583184682576 + 55.31694957591115, + 55.316948669637505, + 55.31694734752721, + 55.316946441253585 ], - "timestamp": 0.4132336745934464 + "timestamp": 0.41166807773402103 }, { - "x": 2.1412933116032296, - "y": 6.191150636092829, - "heading": 3.14159265292153, - "angularVelocity": -1.9255903720714354e-8, - "velocityX": 3.1899244141732543, - "velocityY": -0.4286611356844206, + "x": 2.144123859559337, + "y": 6.189128805794054, + "heading": 3.1415926520668265, + "angularVelocity": -4.304084953192806e-8, + "velocityX": 3.2086258231614173, + "velocityY": -0.47756389125936755, "moduleForcesX": [ - 74.72006152267744, - 74.720062180148, - 74.7200622715512, - 74.72006292902178 + 75.79181974401808, + 75.79182122905927, + 75.7918214779103, + 75.79182296295147 ], "moduleForcesY": [ - 87.64550023101428, - 87.64549967297322, - 87.64549958869247, - 87.6454990306514 + 86.67481554424154, + 86.67481425219059, + 86.67481401804265, + 86.67481272599169 ], - "timestamp": 0.4479379983904787 + "timestamp": 0.4470522963905208 }, { - "x": 2.2581660072287857, - "y": 6.183842078444728, - "heading": 3.1415926521241615, - "angularVelocity": -2.2976054030823205e-8, - "velocityX": 3.3676695823000085, - "velocityY": -0.21059501665681998, + "x": 2.2639843753712037, + "y": 6.18016177358942, + "heading": 3.141592650288091, + "angularVelocity": -5.026916236661669e-8, + "velocityX": 3.3874003825106165, + "velocityY": -0.2534189688256973, "moduleForcesX": [ - 72.7291547139968, - 72.7291552190221, - 72.72915526359016, - 72.72915576861547 + 71.74479952082707, + 71.74480050570537, + 71.74480056888426, + 71.74480155376254 ], "moduleForcesY": [ - 89.22754338297806, - 89.22754297343552, - 89.22754293154452, - 89.22754252200197 + 89.9525802508206, + 89.95257946983592, + 89.95257940726893, + 89.95257862628424 ], - "timestamp": 0.482642322187511 + "timestamp": 0.48243651504702056 }, { - "x": 2.3809494713599806, - "y": 6.184294815459166, - "heading": 3.141592651266816, - "angularVelocity": -2.470428325703209e-8, - "velocityX": 3.5379875098357156, - "velocityY": 0.013045550666419022, + "x": 2.389571390134287, + "y": 6.179555476543678, + "heading": 3.14159264851177, + "angularVelocity": -5.020095867030148e-8, + "velocityX": 3.549238036940923, + "velocityY": -0.01713467383944276, "moduleForcesX": [ - 69.69010228267334, - 69.69010253451678, - 69.69010253849493, - 69.69010279033836 + 64.94777713696435, + 64.94777712617515, + 64.94777712711469, + 64.9477771163255 ], "moduleForcesY": [ - 91.50847668582237, - 91.50847649519085, - 91.50847648894374, - 91.50847629831223 + 94.8242841393538, + 94.82428414669351, + 94.82428414619828, + 94.82428415353799 ], - "timestamp": 0.5173466459845434 + "timestamp": 0.5178207337035203 }, { - "x": 2.5092046684620093, - "y": 6.192809216565774, - "heading": 3.1415926504585743, - "angularVelocity": -2.3289384208573192e-8, - "velocityX": 3.6956546928309955, - "velocityY": 0.24534121904819894, + "x": 2.5197147134837774, + "y": 6.187978683471175, + "heading": 3.141592647155592, + "angularVelocity": -3.8327187932807255e-8, + "velocityX": 3.678004723317062, + "velocityY": 0.23804982128523042, "moduleForcesX": [ - 64.51371470905569, - 64.5137144790559, - 64.51371450113164, - 64.51371427113186 + 51.67592423146398, + 51.675921865334786, + 51.675922642465125, + 51.67592027633598 ], "moduleForcesY": [ - 95.04994076157364, - 95.04994091651318, - 95.04994090501094, - 95.04994105995048 + 102.40920514483192, + 102.40920632891202, + 102.40920597290442, + 102.40920715698445 ], - "timestamp": 0.5520509697815758 + "timestamp": 0.5532049523600201 }, { - "x": 2.642036196298328, - "y": 6.209897699263131, - "heading": 3.1415926498928193, - "angularVelocity": -1.6302148367032502e-8, - "velocityX": 3.827520991712202, - "velocityY": 0.4924021224934082, + "x": 2.651628898663585, + "y": 6.206318425861407, + "heading": 3.1415926469091398, + "angularVelocity": -6.965042680926931e-9, + "velocityX": 3.7280513796388868, + "velocityY": 0.5183028787005051, "moduleForcesX": [ - 53.95659882762613, - 53.956597460085185, - 53.95659785770279, - 53.95659649016185 + 20.084447875703354, + 20.084439343980897, + 20.084445853541716, + 20.084437321820065 ], "moduleForcesY": [ - 101.09152827192861, - 101.09152899469002, - 101.09152880759252, - 101.09152953035392 + 112.46957956001775, + 112.46958106687973, + 112.46958004666081, + 112.46958155352249 ], - "timestamp": 0.5867552935786081 + "timestamp": 0.5885891710165199 }, { - "x": 2.7769445076649037, - "y": 6.236418641581392, - "heading": 3.141592649972671, - "angularVelocity": 2.300909589137675e-9, - "velocityX": 3.8873632045270536, - "velocityY": 0.7641970629760313, + "x": 2.781959966689114, + "y": 6.234528802394688, + "heading": 3.1415926469445252, + "angularVelocity": 1.0000411747845848e-9, + "velocityX": 3.683310610607146, + "velocityY": 0.7972587103629419, "moduleForcesX": [ - 24.486033599317093, - 24.486028605162087, - 24.486032145214327, - 24.4860271510596 + -17.955112905071424, + -17.95511506648689, + -17.955112448576028, + -17.95511460999148 ], "moduleForcesY": [ - 111.21211617203402, - 111.21211725559323, - 111.2121165898599, - 111.21211767341899 + 111.94898532090939, + 111.94898498074893, + 111.94898544852427, + 111.94898510836381 ], - "timestamp": 0.6214596173756405 + "timestamp": 0.6239733896730196 }, { "x": 2.9098873519897452, "y": 6.272213459014893, "heading": 3.141592653589793, - "angularVelocity": 1.0422684584050202e-7, - "velocityX": 3.8307285600017855, - "velocityY": 1.0314224141881145, + "angularVelocity": 1.8780315353423049e-7, + "velocityX": 3.6153796850091515, + "velocityY": 1.065013106154394, "moduleForcesX": [ - -23.173558952779814, - -23.173585661195226, - -23.173551615441973, - -23.173578323848453 + -27.26164138908449, + -27.261687418435052, + -27.261626473603847, + -27.261672495979123 ], "moduleForcesY": [ - 109.34234948074224, - 109.34234401324865, - 109.34235225772302, - 109.34234679023307 + 107.4536903303801, + 107.45367915993492, + 107.45369679884978, + 107.45368563018049 ], - "timestamp": 0.6561639411726728 + "timestamp": 0.6593576083295194 }, { - "x": 3.1603986784572013, - "y": 6.3231515960882705, - "heading": 3.1416374237621625, - "angularVelocity": 0.0006952279229344114, - "velocityX": 3.8901451558950786, - "velocityY": 0.7910091331222168, + "x": 3.1493843891892954, + "y": 6.321687036535868, + "heading": 3.141664767074809, + "angularVelocity": 0.0011120470558586106, + "velocityX": 3.693234005337154, + "velocityY": 0.7629217505263336, "moduleForcesX": [ - 13.121852274764045, - 13.064389136188524, - 13.139894013731855, - 13.08221911280367 + 17.08299633181651, + 16.987922786906466, + 17.109096037610176, + 17.013600230983286 ], "moduleForcesY": [ - -53.0288598867414, - -53.03975477257369, - -52.988890196634124, - -52.99881173698235 + -66.1742223370393, + -66.19005542160966, + -66.11296782712692, + -66.1285159280569 ], - "timestamp": 0.7205603367898992 + "timestamp": 0.7242051205243732 }, { - "x": 3.391041812990585, - "y": 6.368906756131182, - "heading": 3.1971668651967757, - "angularVelocity": 0.8623066695328977, - "velocityX": 3.5816155907907, - "velocityY": 0.7105236186646428, + "x": 3.382246269373911, + "y": 6.367449891304312, + "heading": 3.1619423700697604, + "angularVelocity": 0.31269669889603824, + "velocityX": 3.59091462884362, + "velocityY": 0.7056994666338948, "moduleForcesX": [ - -44.11069948337996, - -77.93257191852247, - -61.65027573650249, - -88.44467603288614 + -13.03049078611549, + -29.89084865536969, + -14.597690630033014, + -32.10384734714733 ], "moduleForcesY": [ - -66.62250167635625, - -49.06442321531918, - 29.264082865339244, - 15.43066697140624 + -25.326666831227865, + -24.010835804743515, + -0.30058703362777717, + -0.48365569924820384 ], - "timestamp": 0.7849567324071255 + "timestamp": 0.7890526327192271 }, { - "x": 3.5887658336829418, - "y": 6.408161403232978, - "heading": 3.249240648554511, - "angularVelocity": 0.8086443792174824, - "velocityX": 3.070420615893362, - "velocityY": 0.609578326947492, + "x": 3.582643713722037, + "y": 6.407094531486908, + "heading": 3.21220711122596, + "angularVelocity": 0.775122120416338, + "velocityX": 3.0902873150472114, + "velocityY": 0.6113517518370116, "moduleForcesX": [ - -113.37930141282058, - -113.31038231556873, - -112.17591781085852, - -112.03346259287214 + -101.86125988188819, + -107.37956537588973, + -114.4003441550063, + -114.86482929848356 ], "moduleForcesY": [ - -18.9747004039528, - -19.252528450952163, - -25.139953355100378, - -25.671520826831017 + -52.801268558007735, + -40.97120389792949, + 7.940512733369161, + 3.1915648360079207 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.853900144914081 }, { - "x": 3.7535388104071985, - "y": 6.440888378700207, - "heading": 3.294315536071584, - "angularVelocity": 0.6999597894422492, - "velocityX": 2.5587298038180735, - "velocityY": 0.5082112927835114, + "x": 3.74957200139756, + "y": 6.440171200929541, + "heading": 3.2643499121170314, + "angularVelocity": 0.8040832890303158, + "velocityX": 2.5741664101767947, + "velocityY": 0.5100684409179003, "moduleForcesX": [ - -114.09797780307427, - -114.09477809264078, - -111.70139457807457, - -111.44226639158964 + -112.6621836921574, + -112.71395426887672, + -113.33454508007006, + -113.36635432566645 ], "moduleForcesY": [ - -16.046789303576624, - -15.913469790924887, - -28.264792093674224, - -29.185649391513163 + -23.975233317914196, + -23.760754374517084, + -20.560125698225118, + -20.41926066788013 ], - "timestamp": 0.9137495236415781 + "timestamp": 0.9187476571089348 }, { - "x": 3.8853571288837903, - "y": 6.46707806462633, - "heading": 3.3311943975575473, - "angularVelocity": 0.5726851810957213, - "velocityX": 2.046982866248028, - "velocityY": 0.40669490388552565, + "x": 3.8830382819529596, + "y": 6.4666455306855655, + "heading": 3.310848593184776, + "angularVelocity": 0.7170464909744748, + "velocityX": 2.0581557570683664, + "velocityY": 0.4082551336198438, "moduleForcesX": [ - -114.29110618647697, - -114.36206703200219, - -111.4800422611308, - -111.25270682753366 + -113.99095150053886, + -114.00144220452556, + -112.06402825139101, + -111.92404445290259 ], "moduleForcesY": [ - -15.260854841380633, - -14.588291440363218, - -29.45468827574504, - -30.238604229916476 + -17.29547040716993, + -17.146375445393463, + -27.107357918420117, + -27.630401033774774 ], - "timestamp": 0.9781459192588045 + "timestamp": 0.9835951693037887 }, { - "x": 3.9842204502938396, - "y": 6.486724686682261, - "heading": 3.3592810829924, - "angularVelocity": 0.436153066730639, - "velocityX": 1.5352306672208056, - "velocityY": 0.3050888464738175, + "x": 3.9830877412366763, + "y": 6.486507786121201, + "heading": 3.348167817033145, + "angularVelocity": 0.5754919901357481, + "velocityX": 1.5428419055319809, + "velocityY": 0.306291710558663, "moduleForcesX": [ - -114.37291094617866, - -114.4993666671828, - -111.34420578314202, - -111.17407977417216 + -114.41545555950157, + -114.52951979915328, + -111.3213417082967, + -111.10381175028604 ], "moduleForcesY": [ - -14.958857918149443, - -13.847592290940542, - -30.121770154710845, - -30.693310454835217 + -14.610037306398736, + -13.568499959103484, + -30.197132480138382, + -30.935423415459912 ], - "timestamp": 1.0425423148760309 + "timestamp": 1.0484426814986425 }, { - "x": 4.050129030114216, - "y": 6.4998244090967265, - "heading": 3.3782210905143044, - "angularVelocity": 0.29411595696263265, - "velocityX": 1.0234824354477678, - "velocityY": 0.20342322406257038, + "x": 4.049759249513341, + "y": 6.499752126190816, + "heading": 3.374257262379604, + "angularVelocity": 0.4023199111797186, + "velocityX": 1.0281274642630942, + "velocityY": 0.20423821394749517, "moduleForcesX": [ - -114.41751735086633, - -114.58169370325807, - -111.2551454634251, - -111.13270734016963 + -114.6105493516157, + -114.80042068735355, + -110.83549271399103, + -110.59863478702998 ], "moduleForcesY": [ - -14.806913472107988, - -13.3832091553941, - -30.541558492398913, - -30.942388952573637 + -13.232312421102897, + -11.333508890236551, + -32.03182827040654, + -32.79234017749459 ], - "timestamp": 1.1069387104932573 + "timestamp": 1.1132901936934962 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": 0.14840255835934255, - "velocityX": 0.5117392128533452, - "velocityY": 0.10172039612631649, + "angularVelocity": 0.20849555419784327, + "velocityX": 0.5138815704216189, + "velocityY": 0.10212743022896026, "moduleForcesX": [ - -114.44886671702382, - -114.63396863953965, - -111.19900874167607, - -111.1008014180239 + -114.724824422317, + -114.95598681748031, + -110.5061283467708, + -110.24775114592603 ], "moduleForcesY": [ - -14.690983770851986, - -13.086624955255907, - -30.80623117071299, - -31.123047275253498 + -12.365796823336515, + -9.84830935437339, + -33.2105013101652, + -34.015560796461884 ], - "timestamp": 1.1713351061104837 + "timestamp": 1.17813770588835 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": -3.105341690772561e-20, - "velocityX": -1.4124494217269478e-19, - "velocityY": 6.271250526786711e-19, + "angularVelocity": 4.829716369297222e-20, + "velocityX": -6.470993346981879e-19, + "velocityY": 3.317822838461728e-18, "moduleForcesX": [ - -114.47707589122757, - -114.66679939987269, - -111.1697067800063, - -111.065526656675 + -114.80814664741962, + -115.0502198256128, + -110.29067964070413, + -109.96652897988713 ], "moduleForcesY": [ - -14.56120001128053, - -12.910071305056444, - -30.955087024537587, - -31.296024837316292 + -11.686076549663122, + -8.850873959259824, + -33.960278185612424, + -34.95752048556571 ], - "timestamp": 1.2357315017277102 + "timestamp": 1.2429852180832037 }, { - "x": 4.14842233006486, - "y": 6.524834886416186, - "heading": 3.37925014191358, - "angularVelocity": -0.09327225382491805, - "velocityX": 0.7146644720743753, - "velocityY": 0.20191178488512537, + "x": 4.142327477746525, + "y": 6.523112878711347, + "heading": 3.379198429591823, + "angularVelocity": -0.09853884197083598, + "velocityX": 0.6804630807934998, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - 109.86538217101113, - 109.99598273674891, - 112.06663111203557, - 112.07438057028466 + 109.71928226568595, + 109.873434250603, + 112.16839647851953, + 112.1714231836321 ], "moduleForcesY": [ - 35.34716847772429, - 34.947790309423084, - 27.583683757251283, - 27.563877482273224 + 35.788801078214966, + 35.3232395177045, + 27.154535423780896, + 27.155842975944093 ], - "timestamp": 1.3271578167329041 + "timestamp": 1.3300498781665553 }, { - "x": 4.2790937475882345, - "y": 6.561752331915095, - "heading": 3.362280414592137, - "angularVelocity": -0.18561097338855564, - "velocityX": 1.42925390262039, - "velocityY": 0.4037945256440808, + "x": 4.260809898031729, + "y": 6.556586338886186, + "heading": 3.3621463296179686, + "angularVelocity": -0.1958555854640666, + "velocityX": 1.3608554857019415, + "velocityY": 0.38446667273258245, "moduleForcesX": [ - 109.85041536836742, - 110.00945422487305, - 112.03171567433651, - 112.06416998026944 + 109.70709462938454, + 109.89245539711602, + 112.12825792036838, + 112.15861944802991 ], "moduleForcesY": [ - 35.34795624249508, - 34.861185811795494, - 27.666287641216297, - 27.549045973918602 + 35.77869126173569, + 35.21826543338535, + 27.256949433753093, + 27.148840736400928 ], - "timestamp": 1.418584131738098 + "timestamp": 1.4171145382499069 }, { - "x": 4.4750859570933414, - "y": 6.617122892086999, - "heading": 3.337013895365562, - "angularVelocity": -0.27635937448796466, - "velocityX": 2.1437176976231873, - "velocityY": 0.605630448616008, + "x": 4.438520122396817, + "y": 6.606791013546223, + "heading": 3.336801806178079, + "angularVelocity": -0.2911000102179912, + "velocityX": 2.0411292503176015, + "velocityY": 0.576636658455609, "moduleForcesX": [ - 109.82922400996979, - 110.02889664351, - 111.97547028101597, - 112.04411023069696 + 109.69117162238662, + 109.92048751533748, + 112.06359871366229, + 112.13376889158263 ], "moduleForcesY": [ - 35.337678294007155, - 34.7258621306889, - 27.79538355148314, - 27.536465024579382 + 35.748453188226485, + 35.05402926782663, + 27.417403309854702, + 27.151367351771693 ], - "timestamp": 1.510010446743292 + "timestamp": 1.5041791983332584 }, { - "x": 4.7363756738996505, - "y": 6.690938650379312, - "heading": 3.3037368442226525, - "angularVelocity": -0.3639767296868421, - "velocityX": 2.8579268101472284, - "velocityY": 0.8073797821570229, + "x": 4.675437089885676, + "y": 6.6737192302015265, + "heading": 3.30352069263772, + "angularVelocity": -0.3822574338255884, + "velocityX": 2.7211611147628285, + "velocityY": 0.7687185201346813, "moduleForcesX": [ - 109.80240908300571, - 110.05001149729426, - 111.87607678799765, - 111.99097622261095 + 109.67704537348169, + 109.95591771814277, + 111.94887517290019, + 112.06937336812729 ], "moduleForcesY": [ - 35.26876905745412, - 34.51004456710348, - 27.999126804996703, - 27.563652818630974 + 35.633500837393704, + 34.78801753120004, + 27.676054770743455, + 27.21618805639235 ], - "timestamp": 1.601436761748486 + "timestamp": 1.59124385841661 }, { - "x": 5.062891365124138, - "y": 6.783177700282454, - "heading": 3.2632360654606747, - "angularVelocity": -0.44298820049432014, - "velocityX": 3.5713535124535785, - "velocityY": 1.0088895073360595, + "x": 4.971495381970558, + "y": 6.75734995310902, + "heading": 3.2632951732216937, + "angularVelocity": -0.4620189107442214, + "velocityX": 3.4004416005466473, + "velocityY": 0.9605587712331257, "moduleForcesX": [ - 109.76393441481733, - 110.04642262897143, - 111.62926676038799, - 111.79375874723351 + 109.68108201991289, + 109.98511497469858, + 111.66164166914167, + 111.8331752723527 ], "moduleForcesY": [ - 34.92992729055453, - 34.06895702532383, - 28.399362365285945, - 27.794484147904964 + 35.14208193111417, + 34.222358457681196, + 28.211854056678618, + 27.57984056765551 ], - "timestamp": 1.6928630767536799 + "timestamp": 1.6783085184999615 }, { - "x": 5.412207246810782, - "y": 6.881877306152213, - "heading": 3.263217434387312, - "angularVelocity": -0.00020378239417672257, - "velocityX": 3.8207367503196448, - "velocityY": 1.0795535821842126, + "x": 5.28750589994817, + "y": 6.846642506147694, + "heading": 3.263275324690442, + "angularVelocity": -0.0002279746022443869, + "velocityX": 3.629607210033074, + "velocityY": 1.0255889468033226, "moduleForcesX": [ - 48.347985418760395, - 33.09132615961223, - 44.47101375150101, - 29.02496895286671 + 47.983517882331824, + 31.02179127083995, + 43.820835110311776, + 26.680968018866302 ], "moduleForcesY": [ - -0.5892512769537052, - -3.0944630152590573, - 23.826002374584476, - 23.75945657977806 + -1.930997783243996, + -4.7563348860656625, + 24.644907375594624, + 24.467961055834824 ], - "timestamp": 1.7842893917588738 + "timestamp": 1.765373178583313 }, { - "x": 5.761523007820935, - "y": 6.980578519140531, - "heading": 3.263199195569124, - "angularVelocity": -0.00019949199731637702, - "velocityX": 3.8207354303879444, - "velocityY": 1.0795711604772795, + "x": 5.603516209092675, + "y": 6.935936936057916, + "heading": 3.2632558996184238, + "angularVelocity": -0.00022311086954457106, + "velocityX": 3.6296048114352195, + "velocityY": 1.025610504017777, "moduleForcesX": [ - -0.00011234051506570799, - -0.0002512833550827778, - -0.00015898547237657224, - -0.00029742975944157266 + -0.00024178774300411554, + -0.0005154689575938757, + -0.0002665381373160101, + -0.0005410448407523983 ], "moduleForcesY": [ - 0.0026141002465316916, - 0.002591336522088985, - 0.002857548674029559, - 0.0028579490702223286 + 0.003435084191229427, + 0.0033758874708626017, + 0.0036659957788613465, + 0.003586909286046499 ], - "timestamp": 1.8757157067640677 + "timestamp": 1.8524378386666647 }, { - "x": 6.110838775175139, - "y": 7.079279709676494, - "heading": 3.26318095679076, - "angularVelocity": -0.00019949156173420396, - "velocityX": 3.820735499777717, - "velocityY": 1.0795709148985817, + "x": 5.919526506202657, + "y": 7.025231408572308, + "heading": 3.2632364745964955, + "angularVelocity": -0.00022311029422913506, + "velocityX": 3.6296046732101, + "velocityY": 1.0256109933571818, "moduleForcesX": [ - 0.000010826836750374956, - 0.000010817181672845025, - 0.000010737845312528724, - 0.000010728190235499784 + -0.00002440175771108094, + -0.000024341211132133213, + -0.00002075585254078544, + -0.00002067892578492775 ], "moduleForcesY": [ - -0.00003811622956670729, - -0.00003818254367165634, - -0.000038103272794834774, - -0.00003816958689886402 + 0.00007797336491842891, + 0.00008082252173480401, + 0.0000786107894483785, + 0.00008183721701490111 ], - "timestamp": 1.9671420217692617 + "timestamp": 1.9395024987500162 }, { - "x": 6.460154925275615, - "y": 7.17797836765492, - "heading": 3.2631623325971826, - "angularVelocity": -0.000203707144671611, - "velocityX": 3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 6.235536823112694, + "y": 7.114525811000592, + "heading": 3.2632170496152866, + "angularVelocity": -0.00022310982654494968, + "velocityX": 3.6296049006279225, + "velocityY": 1.0256101883680162, "moduleForcesX": [ - 0.000582673079646135, - 0.0007246120932044848, - 0.0005764704290552151, - 0.0007171396015932555 + 0.000037175746031209955, + 0.00003675022279394528, + 0.00003744493411169005, + 0.00003699595688581122 ], "moduleForcesY": [ - -0.004164770580860626, - -0.004183092183695803, - -0.004410331364142836, - -0.004451422952545398 + -0.0001311900906737163, + -0.00013113310161074358, + -0.00013127818825782144, + -0.00013157168451710384 ], - "timestamp": 2.0585683367744556 + "timestamp": 2.026567158833368 }, { - "x": 6.7866810369969155, - "y": 7.270191836288494, - "heading": 3.2235227609386436, - "angularVelocity": -0.4335685153261054, - "velocityX": 3.571467489450394, - "velocityY": 1.0086097052947562, + "x": 6.551547647652277, + "y": 7.203817281479636, + "heading": 3.2631972085530423, + "angularVelocity": -0.00022788881533729912, + "velocityX": 3.6296107311169497, + "velocityY": 1.025576512830357, "moduleForcesX": [ - -47.82428831475678, - -32.71681627513296, - -44.74713985759357, - -29.578062869233722 + 0.0007539903240099345, + 0.0010130422482340737, + 0.0008876422954937467, + 0.001149122654947948 ], "moduleForcesY": [ - 0.711716625651444, - 2.410633102178794, - -23.286981568980845, - -23.904505269420362 + -0.005461742387567229, + -0.00532035763040487, + -0.0056743745997740415, + -0.005513368070625849 ], - "timestamp": 2.1499946517796493 + "timestamp": 2.1136318189167196 }, { - "x": 7.047980469601503, - "y": 7.343983789856553, - "heading": 3.1910396830919887, - "angularVelocity": -0.3552924324338102, - "velocityX": 2.858033079313581, - "velocityY": 0.80711941155965, + "x": 6.847617317047974, + "y": 7.2874193702981085, + "heading": 3.223811784245632, + "angularVelocity": -0.4523698165214764, + "velocityX": 3.400572277112838, + "velocityY": 0.9602298882053439, "moduleForcesX": [ - -109.72343096717086, - -110.11042093282525, - -111.57527328961994, - -111.82904603560887 + -47.41130841069759, + -30.62118618481451, + -44.110694296736526, + -27.280967448263624 ], "moduleForcesY": [ - -35.05919820242028, - -33.86318732230928, - -28.60858970792212, - -27.64968334765918 + 2.0544391321012583, + 4.023869539315489, + -24.077548013299843, + -24.63274704987536 ], - "timestamp": 2.241420966784843 + "timestamp": 2.2006964790000714 }, { - "x": 7.243980764451501, - "y": 7.399334406788997, - "heading": 3.16642038697477, - "angularVelocity": -0.2692801970178975, - "velocityX": 2.14380613326548, - "velocityY": 0.6054123140509308, + "x": 7.084544828508775, + "y": 7.354320907313611, + "heading": 3.1912974750964462, + "angularVelocity": -0.373450136003033, + "velocityX": 2.721282219834979, + "velocityY": 0.7684120853564979, "moduleForcesX": [ - -109.71676289801981, - -110.18532231271764, - -111.76405509082994, - -112.06441279220563 + -109.63993232178557, + -110.05417979801784, + -111.60403176355548, + -111.86911447326634 ], "moduleForcesY": [ - -35.536614610144824, - -34.07720649246483, - -28.440654067765472, - -27.260877933728896 + -35.27274549289263, + -34.00135979147859, + -28.436496439475064, + -27.430888103294052 ], - "timestamp": 2.3328472817900368 + "timestamp": 2.287761139083423 }, { - "x": 7.374657916862249, - "y": 7.436237482881837, - "heading": 3.1498977666289023, - "angularVelocity": -0.1807206201510903, - "velocityX": 1.4293166294991295, - "velocityY": 0.40363735638631854, + "x": 7.262263839170718, + "y": 7.404503175997865, + "heading": 3.1665778040536177, + "angularVelocity": -0.28392313275171893, + "velocityX": 2.0412301672320603, + "velocityY": 0.5763793097705945, "moduleForcesX": [ - -109.70681368656746, - -110.21880379377983, - -111.81972024066972, - -112.148335627715 + -109.58272113098357, + -110.10406488426497, + -111.8285077107539, + -112.14908861391909 ], "moduleForcesY": [ - -35.71803758428605, - -34.11985964537683, - -28.413265173608806, - -27.106350443857995 + -35.92513988883521, + -34.31811935636691, + -28.155739191192055, + -26.882739105963577 ], - "timestamp": 2.4242735967952305 + "timestamp": 2.374825799166775 + }, + { + "x": 7.380752503700571, + "y": 7.437960457197711, + "heading": 3.14995739111321, + "angularVelocity": -0.19089735059547805, + "velocityX": 1.3609272053255352, + "velocityY": 0.3842808456130792, + "moduleForcesX": [ + -109.55438775829161, + -110.13043304849128, + -111.89507958039748, + -112.24817460065188 + ], + "moduleForcesY": [ + -36.16792173997458, + -34.39052165205662, + -28.094624382025973, + -26.671524840113754 + ], + "timestamp": 2.4618904592501267 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": -0.09083941574848778, - "velocityX": 0.7146966727690924, - "velocityY": 0.20182916341250373, + "angularVelocity": -0.09607500351358098, + "velocityX": 0.6804999438659524, + "velocityY": 0.19215055040122933, "moduleForcesX": [ - -109.70058243131004, - -110.23546235943999, - -111.8476455542373, - -112.19103002395252 + -109.53867302844934, + -110.14366836151459, + -111.92834686125505, + -112.2984794768254 ], "moduleForcesY": [ - -35.81216376796426, - -34.141192280175495, - -28.399273440528713, - -27.02553158829393 + -36.293251007942786, + -34.426167314961475, + -28.06417924516179, + -26.561761552148816 ], - "timestamp": 2.515699911800424 + "timestamp": 2.5489551193334785 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": 5.3474824222167004e-21, - "velocityX": -1.1027416520574535e-21, - "velocityY": 1.1229424922134134e-21, + "angularVelocity": 1.0070419894358123e-20, + "velocityX": -3.7291483580721005e-21, + "velocityY": 1.6507740380137376e-21, + "moduleForcesX": [ + -109.5307744441316, + -110.14478533871649, + -111.95408720798879, + -112.3269385706006 + ], + "moduleForcesY": [ + -36.36354115443014, + -34.46921393384205, + -28.022875739604935, + -26.502942730924968 + ], + "timestamp": 2.6360197794168303 + }, + { + "x": 7.374537199809908, + "y": 7.420246784454786, + "heading": 3.141592653589793, + "angularVelocity": 1.9044065108967837e-16, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - -109.69825354519149, - -110.23935489778839, - -111.8696576656152, - -112.21511593235195 + -102.137006668336, + -102.13700666833601, + -102.13700666833601, + -102.13700666833601 ], "moduleForcesY": [ - -35.86413648487148, - -34.173575075339286, - -28.370205373579967, - -26.98327252919034 + -53.739296779734275, + -53.73929677973427, + -53.73929677973426, + -53.739296779734254 ], - "timestamp": 2.607126226805618 + "timestamp": 2.731420771168844 }, { - "x": 7.368314145951493, - "y": 7.416972530106804, + "x": 7.243622128572477, + "y": 7.351365934157169, "heading": 3.141592653589793, - "angularVelocity": -5.95153116721842e-17, - "velocityX": -0.7180685701633659, - "velocityY": -0.3778111505217192, + "angularVelocity": 5.1129474419478e-16, + "velocityX": -1.3722611142002967, + "velocityY": -0.7220139857315833, "moduleForcesX": [ - -102.13925806744793, - -102.13925806744793, - -102.13925806744794, - -102.13925806744794 + -102.12057878684486, + -102.12057878684486, + -102.12057878684486, + -102.12057878684487 ], "moduleForcesY": [ - -53.740481351409, - -53.74048135140901, - -53.74048135140901, - -53.74048135140901 + -53.73065326424746, + -53.73065326424745, + -53.73065326424744, + -53.73065326424743 ], - "timestamp": 2.7069577150884125 + "timestamp": 2.8268217629208574 }, { - "x": 7.224953430741302, - "y": 7.341543415111761, + "x": 7.047275775912886, + "y": 7.2480584723333115, "heading": 3.141592653589793, - "angularVelocity": -1.0650520788048443e-16, - "velocityX": -1.4360270259027914, - "velocityY": -0.7555643644355341, + "angularVelocity": 8.440134370851153e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.0828761832203582, "moduleForcesX": [ - -102.12359521012328, - -102.12359521012328, - -102.12359521012328, - -102.12359521012328 + -102.08783014974713, + -102.08783014974715, + -102.08783014974715, + -102.08783014974716 ], "moduleForcesY": [ - -53.73224035271867, - -53.73224035271867, - -53.73224035271868, - -53.73224035271868 + -53.713422597464344, + -53.713422597464344, + -53.71342259746432, + -53.71342259746432 ], - "timestamp": 2.806789203371207 + "timestamp": 2.922222754672871 }, { - "x": 7.009939750663415, - "y": 7.228414155284034, + "x": 6.785560544972791, + "y": 7.11035723234165, "heading": 3.141592653589793, - "angularVelocity": -2.561037852315152e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246718, + "angularVelocity": 1.170740883731664e-15, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041789, "moduleForcesX": [ - -102.09239698765671, - -102.09239698765671, - -102.09239698765671, - -102.09239698765671 + -101.99046691326758, + -101.9904669132676, + -101.9904669132676, + -101.9904669132676 ], "moduleForcesY": [ - -53.715825435238514, - -53.715825435238514, - -53.715825435238514, - -53.715825435238514 + -53.66219501569665, + -53.66219501569664, + -53.662195015696625, + -53.662195015696625 ], - "timestamp": 2.906620691654002 + "timestamp": 3.0176237464248845 }, { - "x": 6.72333806652252, - "y": 7.077618929694229, + "x": 6.467102087337348, + "y": 6.942800593223961, "heading": 3.141592653589793, - "angularVelocity": -9.622527173380371e-17, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 7.597859985024076e-17, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - -101.99983969748536, - -101.99983969748537, - -101.99983969748536, - -101.99983969748537 + -88.53246892183462, + -88.5324689218346, + -88.53246892183459, + -88.53246892183458 ], "moduleForcesY": [ - -53.66712649791996, - -53.66712649791995, - -53.66712649791995, - -53.66712649791995 + -46.58128113625254, + -46.58128113625257, + -46.58128113625262, + -46.58128113625264 ], - "timestamp": 3.0064521799367965 + "timestamp": 3.113024738176898 }, { - "x": 6.372544082043546, - "y": 6.893048981392569, + "x": 6.1486418905328355, + "y": 6.7752430390439855, "heading": 3.141592653589793, - "angularVelocity": -6.334843659951388e-17, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 1.9368908161772864e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - -91.46231173778874, - -91.46231173778875, - -91.46231173778872, - -91.46231173778875 + -0.0027135032765820944, + -0.002713503276651509, + -0.002713503276474282, + -0.002713503276543846 ], "moduleForcesY": [ - -48.12281537286679, - -48.12281537286681, - -48.12281537286679, - -48.1228153728668 + -0.0014277073770261604, + -0.0014277073770890942, + -0.0014277073770684085, + -0.0014277073771313536 ], - "timestamp": 3.106283668219591 + "timestamp": 3.2084257299289116 }, { - "x": 6.021747838682743, - "y": 6.70847784458221, + "x": 5.830181693715209, + "y": 6.60768548485711, "heading": 3.141592653589793, - "angularVelocity": 2.581973087916566e-16, - "velocityX": -3.513883739437953, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.279411505105019e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - -0.0032184943191916355, - -0.003218494319210384, - -0.00321849431915981, - -0.0032184943191784733 + -2.0460998121842195e-8, + -2.0460997415959662e-8, + -2.0460987448503346e-8, + -2.0460986753393795e-8 ], "moduleForcesY": [ - -0.001693407972736863, - -0.0016934079727192893, - -0.0016934079727259645, - -0.0016934079727083226 + -1.076552819064326e-8, + -1.0765525074180139e-8, + -1.0765532984669192e-8, + -1.0765529879793362e-8 ], - "timestamp": 3.2061151565023858 + "timestamp": 3.303826721680925 }, { - "x": 5.670951595306396, - "y": 6.523906707763672, + "x": 5.511721496897583, + "y": 6.440127930670235, "heading": 3.141592653589793, - "angularVelocity": -1.7815140363007445e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720746, + "angularVelocity": -1.3368406118547953e-16, + "velocityX": -3.338122497147994, + "velocityY": -1.7563502339936574, "moduleForcesX": [ - -2.214847536392143e-8, - -2.2148460240928627e-8, - -2.2148453985353328e-8, - -2.214843887146829e-8 + -1.9163549088742217e-13, + -1.8137969156708226e-13, + -1.8770365584259915e-13, + -1.7745311999841893e-13 ], "moduleForcesY": [ - -1.1653376630868896e-8, - -1.1653364415082627e-8, - -1.1653399114124992e-8, - -1.1653386903612894e-8 + -1.1004122267769845e-13, + -1.0700562473759133e-13, + -1.2357784150329262e-13, + -1.2054149174476363e-13 ], - "timestamp": 3.3059466447851804 + "timestamp": 3.3992277134329387 }, { - "x": 5.320155351930048, - "y": 6.339335570945134, + "x": 5.193261300079957, + "y": 6.272570376483359, "heading": 3.141592653589793, - "angularVelocity": 2.4279685029555556e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720748, + "angularVelocity": 1.4138979074556637e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - -1.4908979526305142e-14, - -2.99029582883606e-14, - -5.16443761137644e-15, - -2.0160903125677875e-14 + 1.8774692991705095e-13, + 1.7710016242766854e-13, + 1.898187278749893e-13, + 1.7917566427067963e-13 ], "moduleForcesY": [ - -3.384941535047312e-14, - -2.5668639996370796e-14, - -1.2459999136873356e-14, - -4.2850979436921125e-15 + 1.0215120237248181e-13, + 1.0368953333983565e-13, + 1.1648186637867293e-13, + 1.1802465134529584e-13 ], - "timestamp": 3.405778133067975 + "timestamp": 3.4946287051849523 }, { - "x": 4.969359108569246, - "y": 6.1547644341347745, + "x": 4.874801103275445, + "y": 6.105012822303384, "heading": 3.141592653589793, - "angularVelocity": 1.199756216245544e-16, - "velocityX": -3.5138837394379534, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.5438965808528657e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - 2.214841585830023e-8, - 2.2148419462891282e-8, - 2.2148422317548562e-8, - 2.2148425924364392e-8 + 2.0460996179979618e-8, + 2.0460996946386003e-8, + 2.0460995079952845e-8, + 2.0460995868086364e-8 ], "moduleForcesY": [ - 1.165340603921551e-8, - 1.165340847836435e-8, - 1.165339922976741e-8, - 1.165340166101585e-8 + 1.07655285883098e-8, + 1.076553064507586e-8, + 1.0765530220929285e-8, + 1.0765532275345751e-8 ], - "timestamp": 3.5056096213507697 + "timestamp": 3.590029696936966 }, { - "x": 4.618565124090272, - "y": 5.970194485833114, + "x": 4.556342645640002, + "y": 5.937456183185694, "heading": 3.141592653589793, - "angularVelocity": 1.3718004475518102e-16, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 2.7082626511550756e-16, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - 0.003218494319189819, - 0.003218494319178036, - 0.0032184943192075832, - 0.003218494319195734 + 0.0027135032765694357, + 0.002713503276628145, + 0.0027135032764733255, + 0.002713503276531934 ], "moduleForcesY": [ - 0.0016934079727341249, - 0.0016934079727223734, - 0.00169340797272666, - 0.0016934079727148898 + 0.0014277073770093693, + 0.001427707377080961, + 0.0014277073770625364, + 0.0014277073771340647 ], - "timestamp": 3.6054411096335643 + "timestamp": 3.6854306886889794 }, { - "x": 4.331963439949377, - "y": 5.819399260243309, + "x": 4.294627414699907, + "y": 5.799754943194032, "heading": 3.141592653589793, - "angularVelocity": 2.659867947557739e-16, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 2.4292126054795095e-16, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 91.46231173778882, - 91.46231173778881, - 91.46231173778884, - 91.46231173778882 + 88.53246892183459, + 88.53246892183459, + 88.53246892183459, + 88.5324689218346 ], "moduleForcesY": [ - 48.12281537286683, - 48.122815372866796, - 48.12281537286684, - 48.1228153728668 + 46.58128113625262, + 46.581281136252606, + 46.58128113625261, + 46.58128113625261 ], - "timestamp": 3.705272597916359 + "timestamp": 3.780831680440993 }, { - "x": 4.11694975987149, - "y": 5.706270000415583, + "x": 4.098281062040315, + "y": 5.696447481370175, "heading": 3.141592653589793, - "angularVelocity": 2.806875129049736e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246716, + "angularVelocity": 2.1490427279263705e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 101.99983969748536, - 101.99983969748536, - 101.99983969748536, - 101.99983969748536 + 101.9904669132676, + 101.9904669132676, + 101.9904669132676, + 101.9904669132676 ], "moduleForcesY": [ - 53.667126497919966, - 53.667126497919966, - 53.66712649791996, - 53.66712649791996 + 53.66219501569664, + 53.66219501569664, + 53.66219501569663, + 53.66219501569663 ], - "timestamp": 3.8051040861991536 + "timestamp": 3.8762326721930065 }, { - "x": 3.973589044661299, - "y": 5.63084088542054, + "x": 3.967365990802884, + "y": 5.627566631072558, "heading": 3.141592653589793, - "angularVelocity": 1.561047756279207e-16, - "velocityX": -1.4360270259027916, - "velocityY": -0.7555643644355341, + "angularVelocity": 1.897239423212067e-16, + "velocityX": -1.372261114200297, + "velocityY": -0.722013985731583, "moduleForcesX": [ - 102.09239698765671, - 102.09239698765671, - 102.09239698765673, - 102.09239698765673 + 102.08783014974715, + 102.08783014974715, + 102.08783014974715, + 102.08783014974713 ], "moduleForcesY": [ - 53.715825435238514, - 53.71582543523851, - 53.7158254352385, - 53.71582543523849 + 53.71342259746434, + 53.71342259746434, + 53.713422597464344, + 53.71342259746434 ], - "timestamp": 3.9049355744819483 + "timestamp": 3.97163366394502 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -6.104345816877544e-18, - "velocityX": -0.718068570163366, - "velocityY": -0.37781115052171915, + "angularVelocity": 7.022330291742699e-17, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - 102.12359521012327, - 102.12359521012327, - 102.1235952101233, - 102.12359521012328 + 102.12057878684486, + 102.12057878684486, + 102.12057878684486, + 102.12057878684487 ], "moduleForcesY": [ - 53.732240352718684, - 53.732240352718684, - 53.73224035271866, - 53.732240352718655 + 53.730653264247444, + 53.730653264247444, + 53.730653264247444, + 53.730653264247444 ], - "timestamp": 4.004767062764743 + "timestamp": 4.067034655697033 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -5.9255248403380995e-19, - "velocityX": -4.845229805742944e-18, - "velocityY": -3.784645335362408e-18, + "angularVelocity": 1.9672491241209423e-19, + "velocityX": -4.977758209661926e-18, + "velocityY": 1.6190388601168746e-18, "moduleForcesX": [ - 102.13925806744794, - 102.13925806744793, - 102.13925806744794, - 102.13925806744794 + 102.13700666833601, + 102.13700666833601, + 102.137006668336, + 102.13700666833601 ], "moduleForcesY": [ - 53.74048135140901, - 53.74048135140901, - 53.740481351408995, - 53.740481351408995 + 53.73929677973426, + 53.73929677973426, + 53.73929677973426, + 53.73929677973426 ], - "timestamp": 4.104598551047538 + "timestamp": 4.162435647449047 }, { - "x": 3.9043982564040665, - "y": 5.59148869514806, - "heading": 3.1820618629141237, - "angularVelocity": 1.1653411306828567, - "velocityX": 0.07184728436450499, - "velocityY": -0.047073583952375805, + "x": 3.9042836995770926, + "y": 5.591477621529516, + "heading": 3.1821270543838818, + "angularVelocity": 1.1690740956944607, + "velocityX": 0.06865751831066487, + "velocityY": -0.04746780502029206, "moduleForcesX": [ - 74.23634164667679, - -6.715898232786087, - 111.49692422807223, - -61.502441740180224 + 73.9038184921626, + -8.096498399638158, + 111.13955678681799, + -64.4706603229986 ], "moduleForcesY": [ - -88.32054795571888, - -115.15629744618326, - 29.45095987899212, - 97.03134384991 + -88.59920326747556, + -115.06817413543592, + 30.77187267475827, + 95.13273018744661 ], - "timestamp": 4.139325901055871 + "timestamp": 4.19710787305337 }, { - "x": 3.909010846411328, - "y": 5.587957161161053, - "heading": 3.2630170824362428, - "angularVelocity": 2.3311660550745286, - "velocityX": 0.13282297688004016, - "velocityY": -0.10169316075544446, + "x": 3.9087131487207896, + "y": 5.587940767261187, + "heading": 3.2631546643514007, + "angularVelocity": 2.3369601620674736, + "velocityX": 0.12775208589853315, + "velocityY": -0.10200828492209969, "moduleForcesX": [ - 78.30596687432912, - -0.991357515334819, - 109.52641997223529, - -87.10790717980932 + 78.0409085702238, + -2.2065963343012998, + 109.08213048052961, + -88.10645679122378 ], "moduleForcesY": [ - -84.70847062161643, - -115.32872392835634, - 35.97383073298106, - 74.72643789734872 + -84.95264569095156, + -115.31231038297793, + 37.29784851028354, + 73.61772559552828 ], - "timestamp": 4.174053251064205 + "timestamp": 4.231780098657693 }, { - "x": 3.9154905781921414, - "y": 5.581995423382691, - "heading": 3.3836478937253207, - "angularVelocity": 3.473654375013657, - "velocityX": 0.1865887198205051, - "velocityY": -0.17167269535196633, + "x": 3.914971012728261, + "y": 5.582022220388997, + "heading": 3.3839066101537916, + "angularVelocity": 3.482670745754918, + "velocityX": 0.18048636620233685, + "velocityY": -0.170699941207466, "moduleForcesX": [ - 84.04565171589002, - 7.591385688892432, - 105.82402794571937, - -109.52068801280974 + 83.86452574104814, + 6.586730417859739, + 105.23692315427803, + -109.29775219994406 ], "moduleForcesY": [ - -78.97617075986777, - -115.05554501752253, - 45.56575373192798, - 34.00596685580122 + -79.167691364004, + -115.11732618046985, + 46.90225658105789, + 34.8506188459714 ], - "timestamp": 4.208780601072538 + "timestamp": 4.2664523242620165 }, { - "x": 3.923986661046908, - "y": 5.573089966082192, - "heading": 3.542510028867439, - "angularVelocity": 4.574553920872062, - "velocityX": 0.24465105609059282, - "velocityY": -0.25643929923708686, + "x": 3.9232012050087475, + "y": 5.573228753463622, + "heading": 3.543000568385735, + "angularVelocity": 4.588513008870894, + "velocityX": 0.23737132927112375, + "velocityY": -0.25361703127241003, "moduleForcesX": [ - 90.96637263149874, - 18.72557620908624, - 99.23256696755529, - -113.95654026368632 + 90.87202731423523, + 17.998694570452482, + 98.47791423253557, + -114.15847162608061 ], "moduleForcesY": [ - -70.81659924554174, - -113.7295099024976, - 58.29590985260526, - -12.395836704597288 + -70.93479429110407, + -113.84541579014095, + 59.553876514316784, + -10.610218755963183 ], - "timestamp": 4.243507951080872 + "timestamp": 4.30112454986634 }, { - "x": 3.9349178697914593, - "y": 5.561092759135591, - "heading": 3.7384895958061533, - "angularVelocity": 5.643378112400891, - "velocityX": 0.3147723261904048, - "velocityY": -0.3454685411850211, + "x": 3.93382849843504, + "y": 5.56138315819023, + "heading": 3.7392339798870817, + "angularVelocity": 5.659671627104292, + "velocityX": 0.3065073914657294, + "velocityY": -0.34164507951039014, "moduleForcesX": [ - 98.43585145612785, - 32.047708016397955, - 87.47440914610054, - -103.26614786570082 + 98.39402131426766, + 31.702182349064397, + 86.80709567335347, + -103.64312194333186 ], "moduleForcesY": [ - -59.81255295495207, - -110.62167229916591, - 74.32567001719525, - -49.50954102298324 + -59.87033716863679, + -110.71556436707851, + 75.08087531890547, + -48.70440721838266 ], - "timestamp": 4.278235301089206 + "timestamp": 4.335796775470663 }, { - "x": 3.9486707811612667, - "y": 5.546283772243214, - "heading": 3.971261588079422, - "angularVelocity": 6.702843499933376, - "velocityX": 0.3960253623298846, - "velocityY": -0.42643584635232096, + "x": 3.947348256782863, + "y": 5.546665747496577, + "heading": 3.9717655770283784, + "angularVelocity": 6.70656680061238, + "velocityX": 0.38993050235969523, + "velocityY": -0.42447262721486584, "moduleForcesX": [ - 105.6108108605353, - 47.31647496654562, - 65.36610720865541, - -85.39422216682203 + 105.47445484854477, + 47.63333934755148, + 67.38844623510965, + -83.8307139515503 ], "moduleForcesY": [ - -45.20977101765006, - -104.70081415221114, - 93.04952199937759, - -75.57076012474553 + -45.449760164769756, + -104.52423173953122, + 91.45753443308791, + -77.17340463952392 ], - "timestamp": 4.312962651097539 + "timestamp": 4.370469001074986 }, { - "x": 3.967957360606314, - "y": 5.534219720600956, - "heading": 4.2154072006344245, - "angularVelocity": 7.030355397011703, - "velocityX": 0.5553714706252912, - "velocityY": -0.34739338415867244, + "x": 3.967122969912724, + "y": 5.534422452953119, + "heading": 4.200687458299229, + "angularVelocity": 6.602457075680393, + "velocityX": 0.570332962052375, + "velocityY": -0.3531153345383026, "moduleForcesX": [ - 84.82446387399186, - 82.71377263232796, - 50.73806390817151, - 42.353537925270714 + 67.8872625454126, + 69.11423919448929, + 78.96383219942022, + 79.57383821480528 ], "moduleForcesY": [ - 29.67111027951777, - -3.37922189208429, - 65.43811151147439, - 37.553509838998245 + 30.388799241715233, + 41.078313608032914, + 17.15064921936294, + 28.28128265964005 ], - "timestamp": 4.347690001105873 + "timestamp": 4.4051412266793095 }, { - "x": 3.98001343373366, - "y": 5.526755385653602, - "heading": 4.472103074519516, - "angularVelocity": 7.391749552542666, - "velocityX": 0.3471636368583629, - "velocityY": -0.21494110393000895, + "x": 3.9797668128508845, + "y": 5.526847142047009, + "heading": 4.44206622644219, + "angularVelocity": 6.961732739558081, + "velocityX": 0.3646677626769925, + "velocityY": -0.21848354912542167, "moduleForcesX": [ - -37.456143843096456, - -105.72590475430376, - -87.22921676430555, - -110.13783644093463 + -36.646290938348635, + -105.1718880571878, + -85.71976737512396, + -109.38718684458635 ], "moduleForcesY": [ - 104.18797300994801, - 16.76204700591698, - 71.78839869306297, - 23.903310122835695 + 103.98341170708312, + 17.180702657672832, + 73.23873697676966, + 26.153822189075125 ], - "timestamp": 4.382417351114206 + "timestamp": 4.439813452283633 }, { - "x": 3.9851949998823097, - "y": 5.5258948814499, - "heading": 4.723311951922738, - "angularVelocity": 7.233747387662465, - "velocityX": 0.1492070701451729, - "velocityY": -0.024778861718348262, + "x": 3.9857338632021, + "y": 5.525513029563465, + "heading": 4.692744644264185, + "angularVelocity": 7.229948855395621, + "velocityX": 0.1720988557040211, + "velocityY": -0.03847784387335769, "moduleForcesX": [ - -98.91322895270021, - -85.10006434406276, - -79.17104780948137, - -60.59757319759481 + -41.96175012880925, + -79.29225853021597, + -86.89556166997009, + -107.32093626148128 ], "moduleForcesY": [ - 56.86109648752441, - 76.2892425523883, - 81.34314654485036, - 96.53986801350179 + 105.27165483765185, + 78.39773568551979, + 73.78278818931463, + 37.437021821922585 ], - "timestamp": 4.41714470112254 + "timestamp": 4.474485677887956 }, { - "x": 3.9863068884222828, - "y": 5.531340138988146, - "heading": 4.950666542673113, - "angularVelocity": 6.546845373914685, - "velocityX": 0.032017661575285794, - "velocityY": 0.1568002608013148, + "x": 3.9867659107369566, + "y": 5.530831985759421, + "heading": 4.92495896919637, + "angularVelocity": 6.697416184994794, + "velocityX": 0.029765828898150305, + "velocityY": 0.15340682933527577, "moduleForcesX": [ - -114.77127776967934, - -93.64139046455962, - 28.508230169348188, - -11.773017615919526 + -113.32252584700664, + -91.37221926721877, + -9.199917255344806, + -19.278349706082395 ], "moduleForcesY": [ - 5.619126084560698, - 66.9044442013547, - 110.10636482779911, - 114.3646878138949 + 18.159782597252036, + 69.79683643177074, + 113.1944780338604, + 113.19848312438968 ], - "timestamp": 4.451872051130874 + "timestamp": 4.509157903492279 }, { - "x": 3.9839495670536045, - "y": 5.542047325833863, - "heading": 5.14709915808565, - "angularVelocity": 5.656423981829894, - "velocityX": -0.06788083076055375, - "velocityY": 0.3083214481712091, + "x": 3.984220735671827, + "y": 5.54162936928793, + "heading": 5.12759603796946, + "angularVelocity": 5.844362893964999, + "velocityX": -0.07340674043179839, + "velocityY": 0.3114130500801563, "moduleForcesX": [ - -113.64668162060943, - -100.73960236681702, - 63.56308029673943, - -12.572866576733011 + -114.32669032012072, + -99.46991245107587, + 57.66223639535799, + -12.88514577898863 ], "moduleForcesY": [ - -18.155758880056467, - 55.952500248794294, - 95.52739610486213, - 114.50709600750847 + -12.760758459447903, + 58.11499274397251, + 99.06285660736755, + 114.43208308109199 ], - "timestamp": 4.486599401139207 + "timestamp": 4.5438301290966026 }, { - "x": 3.9779698922760582, - "y": 5.557428390445448, - "heading": 5.310648551650109, - "angularVelocity": 4.7095270305742165, - "velocityX": -0.17218920465026455, - "velocityY": 0.442909251869058, + "x": 3.9780819659675903, + "y": 5.557168661278035, + "heading": 5.297692621023495, + "angularVelocity": 4.905845531670375, + "velocityX": -0.17705150440275155, + "velocityY": 0.4481769404548229, "moduleForcesX": [ - -109.6422125783005, - -105.74765097197177, - 63.85460645823769, - -19.07370797889233 + -110.32756561762857, + -105.08894599974298, + 63.750085678570414, + -18.126645587310843 ], "moduleForcesY": [ - -35.22297007232857, - 45.94386760077495, - 95.7180784273194, - 113.69565987258625 + -32.91770130594482, + 47.39353190748665, + 95.7403714098111, + 113.83333151918829 ], - "timestamp": 4.521326751147541 + "timestamp": 4.578502354700926 }, { - "x": 3.968175115116889, - "y": 5.577061809180295, - "heading": 5.440438778329013, - "angularVelocity": 3.7374065872506352, - "velocityX": -0.2820479292781997, - "velocityY": 0.5653589672156164, + "x": 3.9681916256457823, + "y": 5.57695732044685, + "heading": 5.434040994519674, + "angularVelocity": 3.9324955672640276, + "velocityX": -0.28525253713666865, + "velocityY": 0.5707351871391523, "moduleForcesX": [ - -104.57283217896068, - -109.05462491040034, - 59.524853150361466, - -25.584631264202123 + -104.68508048822177, + -108.78605491561527, + 60.738952885980254, + -24.525066052248846 ], "moduleForcesY": [ - -48.32920001759757, - 37.52781331033054, - 98.62582006055165, - 112.45689047019665 + -48.04212290386368, + 38.27226802046422, + 97.86364839716221, + 112.68375035926049 ], - "timestamp": 4.556054101155874 + "timestamp": 4.613174580305249 }, { "x": 3.9544325256347648, "y": 5.600627422332764, "heading": 5.535936987290347, - "angularVelocity": 2.749942305946683, - "velocityX": -0.3957281358590918, - "velocityY": 0.6785894445390553, + "angularVelocity": 2.9388362297102493, + "velocityX": -0.39683348187783213, + "velocityY": 0.6826819297969259, "moduleForcesX": [ - -99.4686663112381, - -111.09605990584434, - 55.322267493338416, - -30.695272549126784 + -98.70912927254462, + -111.07132972844673, + 56.829637400778395, + -29.843471189118105 ], "moduleForcesY": [ - -58.16713625640862, - 31.04808747872548, - 101.12190774409488, - 111.19928569615166 + -59.42057702877141, + 31.1145608404754, + 100.2738938998647, + 111.42567305703182 ], - "timestamp": 4.590781451164208 + "timestamp": 4.647846805909572 }, { - "x": 3.9307248628182854, - "y": 5.6362066530252655, - "heading": 5.601194290632536, - "angularVelocity": 1.4907682092809864, - "velocityX": -0.5415888832830509, - "velocityY": 0.8127885050494256, + "x": 3.930473563980664, + "y": 5.636699135016749, + "heading": 5.6090237892657715, + "angularVelocity": 1.651944625216427, + "velocityX": -0.5415324909628186, + "velocityY": 0.8153109765385055, "moduleForcesX": [ - -95.02943454284728, - -112.32207187573187, - 52.31611898637743, - -34.23111294482164 + -93.16011868735104, + -112.47606598208196, + 53.652879177811734, + -33.78704517737121 ], "moduleForcesY": [ - -65.28675950904464, - 26.427771988717467, - 102.79243467120487, - 110.20104060720486 + -67.91573899096274, + 25.75384194792576, + 102.09996040314262, + 110.33638895218624 ], - "timestamp": 4.634555730046681 + "timestamp": 4.692089694478462 }, { - "x": 3.8996232433704536, - "y": 5.67868110060817, - "heading": 5.617199166752307, - "angularVelocity": 0.3656228389904951, - "velocityX": -0.7104998698284664, - "velocityY": 0.9703060488316098, + "x": 3.899231021868383, + "y": 5.679449457084365, + "heading": 5.629918846850788, + "angularVelocity": 0.4722805915459298, + "velocityX": -0.7061596365624855, + "velocityY": 0.966264261906209, "moduleForcesX": [ - -106.02647980753328, - -110.97907601877178, - 36.59336535164549, - -38.763920050536065 + -102.57136846110204, + -111.54325011561693, + 40.69497651884779, + -37.935243929793444 ], "moduleForcesY": [ - -45.18048489661737, - 31.540733116049065, - 109.35634824645626, - 108.67557062608951 + -52.52564969837368, + 29.4668681376155, + 107.89412812639264, + 108.96449307890926 ], - "timestamp": 4.678330008929153 + "timestamp": 4.736332583047351 }, { - "x": 3.860110843069242, - "y": 5.729664244872591, - "heading": 5.593224624125038, - "angularVelocity": -0.547685609890632, - "velocityX": -0.9026396621471824, - "velocityY": 1.1646826758997946, + "x": 3.859765676771108, + "y": 5.730326735350005, + "heading": 5.606450375138135, + "angularVelocity": -0.5304461908292993, + "velocityX": -0.8920155616834311, + "velocityY": 1.1499538097839181, "moduleForcesX": [ - -114.74365869825844, - -107.73349084432331, - 15.73401800943126, - -42.57429428279629 + -112.92169627828984, + -108.9219189691362, + 24.073517173913505, + -40.83914052431008 ], "moduleForcesY": [ - -10.4350588624452, - 41.23196001279347, - 114.20366129024507, - 107.21934325723129 + -22.74755439174561, + 37.95851016971545, + 112.7310149617651, + 107.8859864747371 ], - "timestamp": 4.722104287811626 + "timestamp": 4.78057547161624 }, { - "x": 3.8112844590593467, - "y": 5.790966829650067, - "heading": 5.542349985528334, - "angularVelocity": -1.1622039219262499, - "velocityX": -1.1154126408566776, - "velocityY": 1.4004247778030499, + "x": 3.8111389410743834, + "y": 5.79124568175385, + "heading": 5.550849308469565, + "angularVelocity": -1.2567232490255504, + "velocityX": -1.0990859157175008, + "velocityY": 1.3769206390986586, "moduleForcesX": [ - -110.66151469383081, - -101.36053530623528, - -15.613856789130313, - -48.454801412715774 + -113.54722733634918, + -103.43030407712321, + -3.5622560281797546, + -45.305379884050026 ], "moduleForcesY": [ - 32.04293220941277, - 55.00994604223042, - 114.18177265531851, - 104.66041275307676 + 19.201188048769797, + 50.979455462200974, + 115.16014318689234, + 106.04826799334447 ], - "timestamp": 4.765878566694099 + "timestamp": 4.824818360185129 }, { "x": 3.752480545043945, "y": 5.863831043243408, "heading": 5.480546717244263, - "angularVelocity": -1.4118626248533899, - "velocityX": -1.343343979995238, - "velocityY": 1.664544007428914, + "angularVelocity": -1.589014494743879, + "velocityX": -1.3258265436060674, + "velocityY": 1.6406108153751935, "moduleForcesX": [ - -91.58391515691349, - -89.00952621701097, - -54.28386759761697, - -60.88263773717588 + -96.27958972309919, + -91.90028015401168, + -46.0608746637012, + -56.857903750739794 ], "moduleForcesY": [ - 69.91797745860337, - 73.2606319317319, - 101.64123727775288, - 97.89690993994493 + 63.1774230585327, + 69.54780453922038, + 105.55736170661821, + 100.2533607662289 ], - "timestamp": 4.809652845576571 + "timestamp": 4.869061248754019 }, { - "x": 3.6247796796501865, - "y": 6.020393862485399, - "heading": 5.396597051454397, - "angularVelocity": -1.136139489771721, - "velocityX": -1.728249835026593, - "velocityY": 2.118855386703538, + "x": 3.625288293351891, + "y": 6.019663725891665, + "heading": 5.383968397246127, + "angularVelocity": -1.2998708875412803, + "velocityX": -1.7119111732168877, + "velocityY": 2.0973896367822467, "moduleForcesX": [ - -64.01795106750846, - -62.13975297663151, - -83.85792038265208, - -85.86840122940083 + -63.35958617648632, + -61.5016685281973, + -83.98957274568086, + -86.30910394415343 ], "moduleForcesY": [ - 95.94171307643556, - 97.13810717197784, - 79.19011036368579, - 76.96736480457619 + 96.32955114118715, + 97.48422295362182, + 78.99253694196872, + 76.39900626600716 ], - "timestamp": 4.883543126255692 + "timestamp": 4.943359643251347 }, { - "x": 3.4688025039143255, - "y": 6.210363644739983, - "heading": 5.3382811336269915, - "angularVelocity": -0.7892231196231553, - "velocityX": -2.1109295336583584, - "velocityY": 2.5709711819820655, + "x": 3.4694662818312585, + "y": 6.20933750397901, + "heading": 5.309907389719856, + "angularVelocity": -0.9968049515381256, + "velocityX": -2.0972460115034317, + "velocityY": 2.552865097161194, "moduleForcesX": [ - -60.82496922096849, - -58.993762084770374, - -85.23274796355844, - -89.12126008495763 + -62.09781410875213, + -61.44436515676163, + -83.73437350844854, + -87.31016658656043 ], "moduleForcesY": [ - 97.91898127763542, - 98.97383223128705, - 77.61460069122347, - 73.04209646880568 + 96.94974979682578, + 97.27543927473285, + 79.02989424706948, + 74.9538204464673 ], - "timestamp": 4.957433406934812 + "timestamp": 5.017658037748676 }, { - "x": 3.285330477453207, - "y": 6.432930917108337, - "heading": 5.323684758957203, - "angularVelocity": -0.1975411994058538, - "velocityX": -2.4830332863110067, - "velocityY": 3.0121319112981255, + "x": 3.289311241310323, + "y": 6.423961245560545, + "heading": 5.309962184347802, + "angularVelocity": 0.0007374941049159021, + "velocityX": -2.424750113912783, + "velocityY": 2.88867266962612, "moduleForcesX": [ - -52.259455121950104, - -45.29427572571881, - -90.15821094756608, - -98.33087843589153 + -40.74857935844332, + -18.853251410417336, + -92.2430106987836, + -98.53054513090648 ], "moduleForcesY": [ - 102.52257021365222, - 105.58458947811977, - 71.52845266276556, - 59.492542868834136 + 96.31459560680612, + 93.15672622123716, + 51.20564283421457, + 16.04638677086884 ], - "timestamp": 5.0313236876139324 + "timestamp": 5.091956432246005 }, { - "x": 3.1138424725109046, - "y": 6.635690019593371, - "heading": 5.379941397506073, - "angularVelocity": 0.7613536994557198, - "velocityX": -2.320846576385527, - "velocityY": 2.7440564661751154, + "x": 3.116823926921375, + "y": 6.629426011222936, + "heading": 5.346662180978036, + "angularVelocity": 0.49395410060379374, + "velocityX": -2.321548339717472, + "velocityY": 2.7653998051031645, "moduleForcesX": [ - 56.506940689491465, - 67.52985880231365, - -15.921759845031302, - 16.56078955508368 + 27.481431543061767, + 39.57127820766088, + -1.4918968027664112, + 13.336470847013707 ], "moduleForcesY": [ - -13.184564767374862, - -46.19772680767912, - -64.74034721944736, - -81.95175795924673 + -3.7073202435334416, + -22.657178376344635, + -25.44947588664071, + -42.42756593521844 ], - "timestamp": 5.105213968293053 + "timestamp": 5.166254826743334 }, { - "x": 2.9708595052799165, - "y": 6.804691723426312, - "heading": 5.427781973086904, - "angularVelocity": 0.6474542408166764, - "velocityX": -1.9350713776810924, - "velocityY": 2.2871980222521517, + "x": 2.9728273117834085, + "y": 6.8006505476140005, + "heading": 5.397761300974995, + "angularVelocity": 0.6877553726789595, + "velocityX": -1.9380851512631618, + "velocityY": 2.3045523062711557, "moduleForcesX": [ - 69.84626762723298, - 69.3664128115689, - 78.55973759609914, - 78.77988767551102 + 81.46564305418052, + 80.49825287187765, + 65.10081795178034, + 66.09113775652368 ], "moduleForcesY": [ - -91.46262829883237, - -91.7887283059373, - -84.09614329094023, - -83.84776974220942 + -81.15783169411748, + -82.19763092136209, + -94.78893254492608, + -94.17140740263652 ], - "timestamp": 5.179104248972173 + "timestamp": 5.2405532212406625 }, { - "x": 2.8564453157848377, - "y": 6.939904549706658, - "heading": 5.466403159501036, - "angularVelocity": 0.522682903071518, - "velocityX": -1.5484335482759797, - "velocityY": 1.8299135561215285, + "x": 2.857611110726288, + "y": 6.937545900604295, + "heading": 5.4452467331407535, + "angularVelocity": 0.6391178771361595, + "velocityX": -1.5507226210825067, + "velocityY": 1.842507552370001, "moduleForcesX": [ - 69.76232758546392, - 68.91646548695893, - 79.25899084878017, - 79.27764146129198 + 72.18570029563338, + 72.01424178451545, + 75.98943820596472, + 75.9475002423331 ], "moduleForcesY": [ - -91.77011872190114, - -92.3862498475594, - -83.70370167635726, - -83.66269029454818 + -89.86507715449565, + -89.99403758231846, + -86.67204720164703, + -86.6999366425214 ], - "timestamp": 5.252994529651294 + "timestamp": 5.314851615737991 }, { - "x": 2.7706218869821835, - "y": 7.041319186543625, - "heading": 5.495529703317597, - "angularVelocity": 0.3941864010917436, - "velocityX": -1.1614982107776188, - "velocityY": 1.3725030667751008, + "x": 2.771197873348752, + "y": 7.040166816408869, + "heading": 5.483776356564779, + "angularVelocity": 0.518579488624223, + "velocityX": -1.1630565904172114, + "velocityY": 1.3811996409728962, "moduleForcesX": [ - 69.80382238745547, - 68.69416422988506, - 79.5605145541954, - 79.38562401155933 + 69.78078581158707, + 68.83655705259315, + 78.94197823204128, + 78.80958416295582 ], "moduleForcesY": [ - -91.81935170246173, - -92.63831320438999, - -83.50590561929292, - -83.65606631768857 + -91.8382201142604, + -92.5349745458161, + -84.09261841954978, + -84.20197278112937 ], - "timestamp": 5.326884810330414 + "timestamp": 5.38915001023532 }, { - "x": 2.7134004949667867, - "y": 7.108931315252294, - "heading": 5.515026042601372, - "angularVelocity": 0.26385526086226124, - "velocityX": -0.7744102673515256, - "velocityY": 0.9150341301623254, + "x": 2.7135903319326986, + "y": 7.1085546328421145, + "heading": 5.510796163144548, + "angularVelocity": 0.36366608945689255, + "velocityX": -0.7753537853112552, + "velocityY": 0.9204481051835351, "moduleForcesX": [ - 69.84897377197261, - 68.56304647527213, - 79.73113036544808, - 79.41828548070994 + 68.76974485124715, + 67.15141087474308, + 80.36853069934784, + 80.1073327253284 ], "moduleForcesY": [ - -91.82527817186515, - -92.77867605554302, - -83.38745301845533, - -83.67315905858865 + -92.6404196148515, + -93.807979797021, + -82.77776530877948, + -83.01627453571585 ], - "timestamp": 5.4007750910095345 + "timestamp": 5.463448404732649 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 0.1323754049192017, - "velocityX": -0.38723234385763106, - "velocityY": 0.457530093567707, + "angularVelocity": 0.18857924691522118, + "velocityX": -0.38766037592671904, + "velocityY": 0.4600867848398824, "moduleForcesX": [ - 69.86757393943451, - 68.48839210839408, - 79.82897176170941, - 79.44566757381436 + 68.20517667619332, + 66.12682297577744, + 81.19705273807533, + 80.86078377461928 ], "moduleForcesY": [ - -91.83521466144708, - -92.85970357248195, - -83.32050872366182, - -83.67612133165673 + -93.08125167677963, + -94.5583649585031, + -81.99291564809009, + -82.31158905160967 ], - "timestamp": 5.474665371688655 + "timestamp": 5.537746799229978 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 4.3846854612017205e-20, - "velocityX": 4.0904407705530267e-19, - "velocityY": 2.676968555971792e-19, + "angularVelocity": -1.0805689415403086e-18, + "velocityX": -3.1368680539147086e-18, + "velocityY": -3.703947835290446e-18, "moduleForcesX": [ - 69.84827604991999, - 68.4571637796041, - 79.87431218531981, - 79.49268727695525 + 67.78484334953605, + 65.47502708227312, + 81.69905950491257, + 81.40565230070786 ], "moduleForcesY": [ - -91.86589702825101, - -92.89994179562993, - -83.29490255274604, - -83.6508373745975 + -93.40351824166066, + -95.02748219177536, + -81.51093377653565, + -81.79230598952022 ], - "timestamp": 5.548555652367775 + "timestamp": 5.612045193727306 }, { - "x": 2.6780400940867017, - "y": 7.132795995001895, - "heading": 5.484107626833603, - "angularVelocity": -0.8968101820215478, - "velocityX": -0.14868426993683037, - "velocityY": -0.21907789247415013, + "x": 2.6781927188978703, + "y": 7.133643639193119, + "heading": 5.477615257440236, + "angularVelocity": -1.026708496320766, + "velocityX": -0.14348211565165733, + "velocityY": -0.19786406226746447, "moduleForcesX": [ - -36.58138343688566, - -92.6089981202968, - 58.0881030195425, - -114.99026329766755 + -36.1387948710901, + -93.94614327648326, + 64.40510932897232, + -111.62905057926731 ], "moduleForcesY": [ - -109.44730735929383, - -68.83786410265968, - -99.62425206236014, - 3.712550595135027 + -109.59547970218897, + -67.00327298809147, + -95.66578127079119, + 27.752839981537313 ], - "timestamp": 5.5939383569893035 + "timestamp": 5.658009594679224 }, { - "x": 2.664180849275817, - "y": 7.112249186067297, - "heading": 5.407197367962043, - "angularVelocity": -1.694704172282317, - "velocityX": -0.30538604797719293, - "velocityY": -0.45274535984467007, + "x": 2.6643917095182355, + "y": 7.11474570789861, + "heading": 5.388434472140597, + "angularVelocity": -1.9402142408628402, + "velocityX": -0.3002543075470839, + "velocityY": -0.4111427736059914, "moduleForcesX": [ - -40.51832482476327, - -94.2857417287882, - 52.5262385664123, - -113.84938976113054 + -40.821633177857166, + -95.86727581221088, + 57.378637396381855, + -114.42189871533581 ], "moduleForcesY": [ - -108.04061737317625, - -66.49833461253947, - -102.65351736489686, - -15.26464777195355 + -107.92658105906054, + -64.19626033624714, + -100.02527276448117, + 8.587675737867313 ], - "timestamp": 5.639321061610832 + "timestamp": 5.7039739956311415 }, { - "x": 2.643283868876903, - "y": 7.0794637940045515, - "heading": 5.302434680689891, - "angularVelocity": -2.3084275859234884, - "velocityX": -0.4604613271330158, - "velocityY": -0.7224204096287653, + "x": 2.6434517089581098, + "y": 7.0833718283589775, + "heading": 5.27028703389283, + "angularVelocity": -2.5704117926253285, + "velocityX": -0.4555699655920882, + "velocityY": -0.6825690945575899, "moduleForcesX": [ - -45.62421822143242, - -96.06095182204425, - 44.41977169952854, - -96.82610095310366 + -46.630127487625636, + -97.68723324634861, + 47.369366627194026, + -94.98425581738753 ], "moduleForcesY": [ - -105.96943008095946, - -63.86894871055252, - -106.39784959154368, - -61.28781168659432 + -105.5285366257994, + -61.34509852502472, + -105.11852994950861, + -63.424528390959615 ], - "timestamp": 5.68470376623236 + "timestamp": 5.749938396583059 }, { - "x": 2.616567085666063, - "y": 7.032861637076852, - "heading": 5.174736847304393, - "angularVelocity": -2.813799539944645, - "velocityX": -0.5886996694808485, - "velocityY": -1.0268704193886582, + "x": 2.617319096568963, + "y": 7.037655137656524, + "heading": 5.127203663119358, + "angularVelocity": -3.112917123039361, + "velocityX": -0.5685402582856085, + "velocityY": -0.9946108239347264, "moduleForcesX": [ - -51.22850417511759, - -97.0841442839216, - 33.41911257960119, - -45.60897792645029 + -52.706804481691236, + -98.19933570612737, + 33.658035334020674, + -22.35560750968032 ], "moduleForcesY": [ - -103.35106272656323, - -62.239918850679175, - -110.32640894319718, - -105.13082797687231 + -102.59714478787957, + -60.44172525566534, + -110.24906301300808, + -112.31949341572266 ], - "timestamp": 5.730086470853888 + "timestamp": 5.795902797534977 }, { - "x": 2.5844362149595033, - "y": 6.972050456195828, - "heading": 5.024165042029765, - "angularVelocity": -3.3178235305791217, - "velocityX": -0.7079981454282469, - "velocityY": -1.3399637899098782, + "x": 2.585825641778137, + "y": 6.9772618766717605, + "heading": 4.960195755089189, + "angularVelocity": -3.6334185711431983, + "velocityX": -0.6851705698018459, + "velocityY": -1.3139138057719986, "moduleForcesX": [ - -56.462615374362144, - -95.89341392145514, - 18.906930129561147, - -15.864319365251827 + -57.48268084453163, + -94.58841581785144, + 15.096484175129069, + -7.151989945719544 ], "moduleForcesY": [ - -100.54214801306102, - -63.95307193517497, - -113.67892793538894, - -113.69206080698898 + -99.93840204825361, + -65.80975762610623, + -114.22968117284876, + -114.6027216210358 ], - "timestamp": 5.775469175475417 + "timestamp": 5.841867198486894 }, { - "x": 2.546380793638804, - "y": 6.896657883852084, - "heading": 4.854185291365359, - "angularVelocity": -3.7454742303695725, - "velocityX": -0.8385445873723301, - "velocityY": -1.661262213710842, + "x": 2.5482138782620107, + "y": 6.901429215857198, + "heading": 4.77842465135581, + "angularVelocity": -3.954606172797204, + "velocityX": -0.8182802938185039, + "velocityY": -1.6498128822322529, "moduleForcesX": [ - -59.08407639825137, - -88.01731264292732, - -0.36287524026541784, - -15.92705626141617 + -55.68470936791087, + -75.42364616036707, + -11.70140331659463, + -21.681375783030767 ], "moduleForcesY": [ - -98.93287625654581, - -74.24824099326665, - -115.16848981625489, - -113.78600820918646 + -100.80538075759425, + -86.90554310267157, + -114.51447272212816, + -112.86388870902134 ], - "timestamp": 5.820851880096945 + "timestamp": 5.887831599438812 }, { - "x": 2.5020913921866805, - "y": 6.80587456385112, - "heading": 4.678726225749676, - "angularVelocity": -3.8662099819509463, - "velocityX": -0.9759092548907747, - "velocityY": -2.0003946604341585, + "x": 2.5055730112747687, + "y": 6.809867684125596, + "heading": 4.612871171835818, + "angularVelocity": -3.601776072164528, + "velocityX": -0.9276933040386546, + "velocityY": -1.9920096821751843, "moduleForcesX": [ - -49.44678346076421, - -55.30372799636149, - -31.538725682495443, - -35.63574287157784 + -5.543216012523143, + -7.475609555022172, + -68.66969747543445, + -53.51925630689457 ], "moduleForcesY": [ - -103.84416234160267, - -100.77984511033993, - -110.5795972400698, - -109.25299086030626 + -114.51283157214844, + -114.67118987816475, + -91.95148315151832, + -101.73623001018109 ], - "timestamp": 5.866234584718473 + "timestamp": 5.933796000390729 }, { - "x": 2.452855464930423, - "y": 6.700360814437642, - "heading": 4.525703159278682, - "angularVelocity": -3.371836644535417, - "velocityX": -1.0849050903172024, - "velocityY": -2.324977109527025, + "x": 2.45762102453482, + "y": 6.703392433541864, + "heading": 4.471415520979255, + "angularVelocity": -3.0775045018978244, + "velocityX": -1.0432418512341903, + "velocityY": -2.316472060521667, "moduleForcesX": [ - 9.704067691996666, - -3.0133443991745454, - -81.36746218585021, - -61.74194260289828 + 11.029616583468297, + -4.968113790093944, + -83.96314322380599, + -64.888165297217 ], "moduleForcesY": [ - -113.97825197610887, - -114.78558445562433, - -80.6238523751475, - -96.85819727429818 + -113.78423953190172, + -114.67679488503815, + -77.77423908354406, + -94.7210439478332 ], - "timestamp": 5.911617289340001 + "timestamp": 5.979760401342647 }, { - "x": 2.3977314070031808, - "y": 6.580743460775094, - "heading": 4.397294971017319, - "angularVelocity": -2.8294520860365577, - "velocityX": -1.214649025150719, - "velocityY": -2.6357475752074513, + "x": 2.4031479414108436, + "y": 6.582925065175055, + "heading": 4.357309400228015, + "angularVelocity": -2.482489021680148, + "velocityX": -1.185114610347244, + "velocityY": -2.62088411622787, "moduleForcesX": [ - 8.23834187664013, - -10.480286821125317, - -89.23977661435593, - -70.90518481088789 + 8.675398306510978, + -13.212936622685156, + -94.93975692279795, + -75.84281222648211 ], "moduleForcesY": [ - -113.67173817318357, - -114.10634114609931, - -71.12492607945074, - -90.05586637958646 + -113.47578028497088, + -113.75794165587843, + -63.08562287254842, + -85.85966695631721 ], - "timestamp": 5.95699999396153 + "timestamp": 6.025724802294564 }, { - "x": 2.335164483598406, - "y": 6.448466508306411, - "heading": 4.297771128185117, - "angularVelocity": -2.1929905602186364, - "velocityX": -1.3786512709314238, - "velocityY": -2.914699632201637, + "x": 2.3403859643936706, + "y": 6.45036283582954, + "heading": 4.275647872255098, + "angularVelocity": -1.77662552500885, + "velocityX": -1.365447514106127, + "velocityY": -2.884019515106602, "moduleForcesX": [ - 2.8428493566441784, - -20.960314391026447, - -102.93252880524821, - -84.21445543262062 + 1.1305249251769165, + -25.146700133162, + -108.60135018229583, + -90.22993499759434 ], "moduleForcesY": [ - -112.7690144774048, - -112.09268001844593, - -47.256316578380776, - -77.01708814164583 + -112.36380391180697, + -111.12312763667339, + -31.894172458136484, + -69.79003312917786 ], - "timestamp": 6.002382698583058 + "timestamp": 6.071689203246482 }, { - "x": 2.2615747120568583, - "y": 6.308166137099232, - "heading": 4.229489174742873, - "angularVelocity": -1.504580963423973, - "velocityX": -1.6215378117116424, - "velocityY": -3.091494268074651, + "x": 2.266794803149496, + "y": 6.3096531054549185, + "heading": 4.22870618913707, + "angularVelocity": -1.021261718762126, + "velocityX": -1.6010468910746176, + "velocityY": -3.0612762803504263, "moduleForcesX": [ - -39.292159251187655, - -48.85965615161464, - -110.44414210433004, - -105.39970908610731 + -29.274189339164224, + -46.32646503632049, + -109.70707968061237, + -105.8355999224511 ], "moduleForcesY": [ - -96.55667751732372, - -100.53582202079686, - 15.711330603948774, - -39.894176375958565 + -98.80485347592223, + -101.68818116190897, + 20.15623938472312, + -38.70930863468574 ], - "timestamp": 6.047765403204586 + "timestamp": 6.1176536041983995 }, { - "x": 2.1831145159545553, - "y": 6.180875846162496, - "heading": 4.1380293777551325, - "angularVelocity": -2.0153007131345686, - "velocityX": -1.7288567694813948, - "velocityY": -2.8048194129962725, + "x": 2.1876531714787637, + "y": 6.181353766918992, + "heading": 4.158203959322547, + "angularVelocity": -1.5338442001729604, + "velocityX": -1.721802743682462, + "velocityY": -2.7912762024275843, "moduleForcesX": [ - -85.2628206812587, - -40.76242627735696, - -41.809404066636745, - 33.5147418178144 + -84.51752285390113, + -43.84922240056912, + -45.15305909136826, + 24.295039925634793 ], "moduleForcesY": [ - 69.629754055441, - 103.2872432820868, - 83.00028269477319, - 102.88363740482352 + 64.962436756562, + 98.75569699979742, + 69.59109448996358, + 100.3449769234843 ], - "timestamp": 6.0931481078261145 + "timestamp": 6.163618005150317 }, { - "x": 2.1114416599283863, - "y": 6.06661673762304, - "heading": 4.018463859189059, - "angularVelocity": -2.634605397875636, - "velocityX": -1.5792989118627885, - "velocityY": -2.5176795762246353, + "x": 2.113994274210826, + "y": 6.066518080053957, + "heading": 4.055835706233426, + "angularVelocity": -2.227120357691746, + "velocityX": -1.6025205537866314, + "velocityY": -2.4983614381304218, "moduleForcesX": [ - -15.49547878536738, - 23.02465023695272, - 94.40260108810763, - 85.2541475816078 + -35.21196936052455, + 10.689838775403791, + 91.16219383522305, + 80.76361369246891 ], "moduleForcesY": [ - 112.01377982791259, - 111.58942984648255, - 60.4635293809918, - 75.31614730987101 + 106.90487109103282, + 113.07820027059671, + 62.57889090145047, + 79.40920313784463 ], - "timestamp": 6.138530812447643 + "timestamp": 6.209582406102235 }, { - "x": 2.0485770415142293, - "y": 5.9648432002123934, - "heading": 3.8746850280973426, - "angularVelocity": -3.1681415263979926, - "velocityX": -1.3852109286658927, - "velocityY": -2.2425621888204583, + "x": 2.048858891665913, + "y": 5.964516870092409, + "heading": 3.9264057363583187, + "angularVelocity": -2.8158741807709244, + "velocityX": -1.4170832469469115, + "velocityY": -2.2191349794430835, "moduleForcesX": [ - 9.897010287228166, - 41.53032424596694, - 98.32290187749213, - 93.16938210809714 + 1.6252737092564529, + 36.1594566332213, + 99.39177635870605, + 91.97875020995595 ], "moduleForcesY": [ - 113.74543897439578, - 106.82441101026964, - 57.179734029047, - 66.5860605496559 + 113.90438381958636, + 108.60701730026715, + 54.58321208539396, + 67.9611469724518 ], - "timestamp": 6.183913517069171 + "timestamp": 6.255546807054152 }, { - "x": 1.9953768413307222, - "y": 5.87572493089785, - "heading": 3.7134081357201074, - "angularVelocity": -3.553708262260153, - "velocityX": -1.1722571545079572, - "velocityY": -1.9637055582683054, + "x": 1.993550029996154, + "y": 5.874850586766882, + "heading": 3.7728427578306443, + "angularVelocity": -3.340911125727801, + "velocityX": -1.2032977809852603, + "velocityY": -1.9507767199952386, "moduleForcesX": [ - 28.980375064219935, - 53.44415602897274, - 90.81965392427338, - 93.2877698645733 + 17.172798234973893, + 49.099531895619926, + 100.50042106684448, + 97.41391226965858 ], "moduleForcesY": [ - 110.93166649748387, - 101.6861880924278, - 69.51188559031758, - 66.88592374391413 + 113.20215773896902, + 103.78581109073643, + 54.03522331953967, + 60.60212605681651 ], - "timestamp": 6.229296221690699 + "timestamp": 6.30151120800607 }, { - "x": 1.9512668027592162, - "y": 5.800221418575717, - "heading": 3.563180043350926, - "angularVelocity": -3.3102498765117425, - "velocityX": -0.9719570250245071, - "velocityY": -1.6637067568317239, + "x": 1.9484012775868889, + "y": 5.798850919958476, + "heading": 3.614156733336716, + "angularVelocity": -3.452367945791928, + "velocityX": -0.9822547770500605, + "velocityY": -1.6534462591584242, "moduleForcesX": [ - 84.8275048007026, - 74.00444289575007, - 55.706127137344104, - 36.15663713104463 + 57.747161790833076, + 64.14132388711865, + 73.40481169626354, + 77.8619118899172 ], "moduleForcesY": [ - 77.70219291275828, - 87.85806255534838, - 100.72627828960442, - 109.19057307139687 + 99.29689982740135, + 95.36643063242519, + 88.28122283946998, + 84.48333541275828 ], - "timestamp": 6.274678926312228 + "timestamp": 6.347475608957987 }, { - "x": 1.9160288345180236, - "y": 5.737622434633646, - "heading": 3.4321839049608895, - "angularVelocity": -2.886477116833102, - "velocityX": -0.7764624989863842, - "velocityY": -1.3793577192923698, + "x": 1.9127337063673016, + "y": 5.736313352300109, + "heading": 3.471353806544456, + "angularVelocity": -3.106815792979521, + "velocityX": -0.7759825099624048, + "velocityY": -1.3605652714540262, "moduleForcesX": [ - 100.14721091439696, - 80.024676888727, - 53.76343662229833, - 10.744716582139088 + 94.4936874124405, + 79.08825052744707, + 56.365800767009816, + 24.954444482004966 ], "moduleForcesY": [ - 56.886724083533664, - 82.35913095559418, - 101.95066373478755, - 114.69341623133506 + 65.75374939597347, + 83.32375870199846, + 100.46638970549711, + 112.38552797167915 ], - "timestamp": 6.320061630933756 + "timestamp": 6.393440009909905 }, { - "x": 1.8895087950240261, - "y": 5.687579858551526, - "heading": 3.3226877484953126, - "angularVelocity": -2.412728756003591, - "velocityX": -0.5843644559125142, - "velocityY": -1.1026794568427385, + "x": 1.886359146217566, + "y": 5.686523155503287, + "heading": 3.3502697309729075, + "angularVelocity": -2.634301177953176, + "velocityX": -0.5738040658318472, + "velocityY": -1.083233888959123, "moduleForcesX": [ - 106.88461675230056, - 74.48364034847003, - 56.28645184223139, - 2.774309758119841 + 105.7514652727486, + 80.75753449736956, + 56.80029932667258, + 6.533917978602636 ], "moduleForcesY": [ - 43.08617697815873, - 87.30364939891349, - 100.65158178859284, - 115.24782035664735 + 45.74125215420102, + 81.56714001964295, + 100.33878741770911, + 115.0667288889628 ], - "timestamp": 6.365444335555284 + "timestamp": 6.4394044108618225 }, { - "x": 1.8711700652556698, - "y": 5.65013543062385, - "heading": 3.235787365853356, - "angularVelocity": -1.9148348113376807, - "velocityX": -0.4040907196098917, - "velocityY": -0.8250814542664743, + "x": 1.8688668154792478, + "y": 5.649330359328354, + "heading": 3.252581489320249, + "angularVelocity": -2.1253021823312412, + "velocityX": -0.38056257399321847, + "velocityY": -0.8091652540808636, "moduleForcesX": [ - 110.53141862820286, - 55.32796842006491, - 59.3280715917302, - 0.4423126125758939 + 110.75420648171638, + 67.41351148588903, + 59.644307139599306, + 0.9872999199197953 ], "moduleForcesY": [ - 32.74820446985415, - 100.43619981044304, - 98.9287079347535, - 115.32725877892798 + 31.95250489619978, + 92.68928093173696, + 98.72856624843796, + 115.31159659481125 ], - "timestamp": 6.410827040176812 + "timestamp": 6.48536881181374 }, { - "x": 1.8599680524378024, - "y": 5.625376428463603, - "heading": 3.1740593903204664, - "angularVelocity": -1.3601652005466363, - "velocityX": -0.24683440335448, - "velocityY": -0.5455603046739032, + "x": 1.858976873190861, + "y": 5.624953566198194, + "heading": 3.180831657251804, + "angularVelocity": -1.5609869939021082, + "velocityX": -0.21516526014844972, + "velocityY": -0.5303407120580114, "moduleForcesX": [ - 112.62711740856216, - 22.697802483968943, - 61.80059569568246, - -0.3042403849948985 + 113.26127376040452, + 29.537208536709745, + 62.36258258326864, + -0.7703487270785222 ], "moduleForcesY": [ - 24.716987102766762, - 112.34568644194815, - 97.42837626864956, - 115.35632305606234 + 21.60538546032672, + 110.53903877029852, + 97.06559527810428, + 115.34906975588957 ], - "timestamp": 6.456209744798341 + "timestamp": 6.531333212765658 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -0.7153988948307862, - "velocityX": -0.11473292914177677, - "velocityY": -0.2699509497396525, + "angularVelocity": -0.8536824770773792, + "velocityX": -0.09171687870080983, + "velocityY": -0.257334844008948, "moduleForcesX": [ - 113.77295041301618, - -10.465866206745924, - 63.178995978692946, - -1.1484884755134463 + 114.45714666054333, + -23.858287526830292, + 63.97932141399696, + -2.0261075694857094 ], "moduleForcesY": [ - 18.878658262354456, - 114.14538106924417, - 96.55763623804961, - 115.36971326990154 + 14.144281910437515, + 111.84032387600276, + 96.02804598950047, + 115.35597645325022 ], - "timestamp": 6.501592449419869 + "timestamp": 6.577297613717575 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -6.131753633195435e-20, - "velocityX": -1.3186452681561465e-19, - "velocityY": -2.1826000885282386e-19, + "angularVelocity": 5.811736944519793e-19, + "velocityX": 9.954723650891276e-19, + "velocityY": 3.489112214048715e-18, "moduleForcesX": [ - 114.29048140187895, - -30.95658475229967, - 63.14866943306744, - -2.883364732869972 + 114.90954967400633, + -61.21552776428465, + 63.898589778474886, + -4.252932311068719 ], "moduleForcesY": [ - 15.576647850433439, - 110.35051173008702, - 96.59011418775707, - 115.35208140460223 + 10.052179512818215, + 96.54516819532166, + 96.0960223654032, + 115.30969681756605 ], - "timestamp": 6.546975154041397 + "timestamp": 6.623262014669493 }, { - "x": 1.8840837282716696, - "y": 5.612955136335095, + "x": 1.8840837431569961, + "y": 5.612955128559063, "heading": 3.141592653589793, - "angularVelocity": -3.444422296937106e-16, - "velocityX": 0.4881043332518617, - "velocityY": -0.0028329531955217676, + "angularVelocity": 2.5735470493073093e-16, + "velocityX": 0.4881044450227128, + "velocityY": -0.0028330818461293275, "moduleForcesX": [ - 115.37658317775369, - 115.37658317775369, - 115.37658317775369, - 115.37658317775369 + 115.37657744801193, + 115.37657744801193, + 115.37657744801193, + 115.37657744801193 ], "moduleForcesY": [ - -0.6696446594198311, - -0.6696446594198309, - -0.6696446594198873, - -0.669644659419887 + -0.6696748828445868, + -0.6696748828445869, + -0.6696748828445466, + -0.6696748828445467 ], - "timestamp": 6.607049536647504 + "timestamp": 6.683336414015381 }, { - "x": 1.9427243442502276, - "y": 5.612614333848124, + "x": 1.9427243878703746, + "y": 5.6126143107496995, "heading": 3.141592653589793, - "angularVelocity": -6.866000063375061e-16, - "velocityX": 0.9761334771103626, - "velocityY": -0.005673008563488317, + "angularVelocity": 6.514156180627557e-16, + "velocityX": 0.9761336834305282, + "velocityY": -0.005673262039647179, "moduleForcesX": [ - 115.35881014296135, - 115.35881014296135, - 115.35881014296135, - 115.35881014296135 + 115.35880034739998, + 115.35880034739998, + 115.35880034739998, + 115.35880034739998 ], "moduleForcesY": [ - -0.6713234488383947, - -0.6713234488383945, - -0.6713234488384501, - -0.67132344883845 + -0.6713527676407111, + -0.6713527676407113, + -0.6713527676406713, + -0.6713527676406714 ], - "timestamp": 6.667123919253611 + "timestamp": 6.743410813361269 }, { - "x": 2.0306762469301467, - "y": 5.6121022780031975, + "x": 2.0306763312754446, + "y": 5.612102232338162, "heading": 3.141592653589793, - "angularVelocity": -1.1640886651980952e-15, - "velocityX": 1.4640500470324853, - "velocityY": -0.008523697168624842, + "angularVelocity": 9.011876293987777e-16, + "velocityX": 1.4640503169856376, + "velocityY": -0.008524070437876532, "moduleForcesX": [ - 115.33220026624166, - 115.33220026624166, - 115.33220026624166, - 115.33220026624166 + 115.33218317019183, + 115.33218317019183, + 115.33218317019183, + 115.33218317019183 ], "moduleForcesY": [ - -0.6738369003470455, - -0.6738369003470452, - -0.6738369003471, - -0.6738369003470996 + -0.6738650288924455, + -0.6738650288924457, + -0.6738650288924058, + -0.6738650288924061 ], - "timestamp": 6.727198301859718 + "timestamp": 6.803485212707157 }, { - "x": 2.1479281990320023, - "y": 5.611417907491215, + "x": 2.1479283323125955, + "y": 5.611417832423418, "heading": 3.141592653589793, - "angularVelocity": -1.6338048670731272e-15, - "velocityX": 1.9517795608595263, - "velocityY": -0.01139205235732241, + "angularVelocity": 1.2870997598446557e-15, + "velocityX": 1.9517798315727328, + "velocityY": -0.011392538622051087, "moduleForcesX": [ - 115.28798452865676, - 115.28798452865676, - 115.28798452865676, - 115.28798452865676 + 115.28795258322376, + 115.28795258322376, + 115.28795258322376, + 115.28795258322376 ], "moduleForcesY": [ - -0.6780128723858879, - -0.6780128723858877, - -0.6780128723859408, - -0.6780128723859405 + -0.6780393929688204, + -0.6780393929688205, + -0.6780393929687812, + -0.6780393929687815 ], - "timestamp": 6.787272684465825 + "timestamp": 6.863559612053045 }, { - "x": 2.2944578552312023, - "y": 5.610559112618229, + "x": 2.2944580362400884, + "y": 5.6105590018551865, "heading": 3.141592653589793, - "angularVelocity": -1.9534731275862738e-15, - "velocityX": 2.4391371137337914, - "velocityY": -0.01429552557563469, + "angularVelocity": 1.5972843309153151e-15, + "velocityX": 2.4391372285526063, + "velocityY": -0.014296115776151204, "moduleForcesX": [ - 115.20006155628543, - 115.20006155628543, - 115.20006155628543, - 115.20006155628543 + 115.19999260587228, + 115.19999260587228, + 115.19999260587228, + 115.19999260587228 ], "moduleForcesY": [ - -0.6863139629291484, - -0.6863139629291481, - -0.686313962929199, - -0.6863139629291988 + -0.6863383396984449, + -0.6863383396984452, + -0.686338339698406, + -0.6863383396984062 ], - "timestamp": 6.847347067071932 + "timestamp": 6.923634011398933 }, { - "x": 2.4701992146114495, - "y": 5.609519669852626, + "x": 2.4701994064572736, + "y": 5.609519517509087, "heading": 3.141592653589793, - "angularVelocity": -2.2612491990593445e-15, - "velocityX": 2.9253960133479704, - "velocityY": -0.017302595890457132, + "angularVelocity": 1.9694342078085813e-15, + "velocityX": 2.925395378575903, + "velocityY": -0.01730328321909502, "moduleForcesX": [ - 114.94036531798054, - 114.94036531798054, - 114.94036531798054, - 114.94036531798054 + 114.94015610384217, + 114.94015610384217, + 114.94015610384217, + 114.94015610384217 ], "moduleForcesY": [ - -0.7108019221792697, - -0.7108019221792694, - -0.7108019221793155, - -0.7108019221793153 + -0.7108246829504119, + -0.7108246829504122, + -0.7108246829503729, + -0.7108246829503732 ], - "timestamp": 6.907421449678039 + "timestamp": 6.983708410744821 }, { "x": 2.6696577453613273, "y": 5.6078338623046875, "heading": 3.141592653589793, - "angularVelocity": -9.825480348601385e-17, - "velocityX": 3.3201927693152893, - "velocityY": -0.028062003716167083, + "angularVelocity": 3.395575597829539e-15, + "velocityX": 3.3201886506702922, + "velocityY": -0.028059459982184988, "moduleForcesX": [ - 93.32082845834267, - 93.32082845834263, - 93.32082845834269, - 93.32082845834263 + 93.31997894760582, + 93.3199789476058, + 93.31997894760583, + 93.3199789476058 ], "moduleForcesY": [ - -2.543275335574423, - -2.5432753355744233, - -2.543275335574176, - -2.543275335574176 + -2.5425108785752677, + -2.5425108785752832, + -2.5425108785751096, + -2.542510878575126 ], - "timestamp": 6.967495832284146 + "timestamp": 7.043782810090709 }, { - "x": 2.8583507333946185, - "y": 5.606118094653867, + "x": 2.8583506984832723, + "y": 5.606118099582229, "heading": 3.141592653589793, - "angularVelocity": 4.096438260386225e-16, - "velocityX": 2.7682638992943907, - "velocityY": -0.025171564120366276, + "angularVelocity": 3.1559531217018772e-15, + "velocityX": 2.7682631078990863, + "velocityY": -0.02517148927877366, "moduleForcesX": [ - -114.98181646144472, - -114.98181646144472, - -114.98181646144472, - -114.98181646144472 + -114.9811117071605, + -114.9811117071605, + -114.9811117071605, + -114.9811117071605 ], "moduleForcesY": [ - 0.6021572944438656, - 0.6021572944438652, - 0.6021572944439256, - 0.6021572944439254 + 0.6016428962295894, + 0.6016428962295897, + 0.6016428962295484, + 0.6016428962295487 ], - "timestamp": 7.035658765767976 + "timestamp": 7.111945750449782 }, { - "x": 3.0093359420039882, - "y": 5.604707049420854, + "x": 3.0093359108700892, + "y": 5.604707049037761, "heading": 3.141592653589793, - "angularVelocity": 6.231776078198638e-16, - "velocityX": 2.215063244676625, - "velocityY": -0.020701063773147482, + "angularVelocity": 2.487468041927929e-15, + "velocityX": 2.2150630766725925, + "velocityY": -0.020701139608050614, "moduleForcesX": [ - -115.24676383245284, - -115.24676383245284, - -115.24676383245284, - -115.24676383245284 + -115.24662233874156, + -115.24662233874156, + -115.24662233874156, + -115.24662233874156 ], "moduleForcesY": [ - 0.9313269849342551, - 0.9313269849342553, - 0.9313269849342641, - 0.9313269849342641 + 0.9312955009813111, + 0.9312955009813114, + 0.931295500981246, + 0.9312955009812464 ], - "timestamp": 7.103821699251806 + "timestamp": 7.180108690808854 }, { - "x": 3.1225883657277436, - "y": 5.603631896857166, + "x": 3.1225883471405993, + "y": 5.603631894326559, "heading": 3.141592653589793, - "angularVelocity": 5.340009815696904e-16, - "velocityX": 1.6614957416793361, - "velocityY": -0.015773273078730332, + "angularVelocity": 1.855880207091023e-15, + "velocityX": 1.6614957581629162, + "velocityY": -0.015773302993371468, "moduleForcesX": [ - -115.32318834172317, - -115.32318834172317, - -115.32318834172317, - -115.32318834172317 + -115.32313827588082, + -115.32313827588082, + -115.32313827588082, + -115.32313827588082 ], "moduleForcesY": [ - 1.026593019430992, - 1.026593019430992, - 1.0265930194309874, - 1.0265930194309874 + 1.0266024823242474, + 1.026602482324248, + 1.0266024823241775, + 1.0266024823241777 ], - "timestamp": 7.171984632735636 + "timestamp": 7.248271631167927 }, { - "x": 3.1980961248529582, - "y": 5.602907459655186, + "x": 3.198096117993605, + "y": 5.602907458005536, "heading": 3.141592653589793, - "angularVelocity": 4.544734050494986e-16, - "velocityX": 1.1077539546200297, - "velocityY": -0.010628022665021828, + "angularVelocity": 1.2470165578599126e-15, + "velocityX": 1.1077540149418748, + "velocityY": -0.01062800866874632, "moduleForcesX": [ - -115.35949645880048, - -115.35949645880048, - -115.35949645880048, - -115.35949645880048 + -115.35947569038294, + -115.35947569038294, + -115.35947569038294, + -115.35947569038294 ], "moduleForcesY": [ - 1.0718958018898446, - 1.0718958018898443, - 1.0718958018898337, - 1.0718958018898337 + 1.0719048416123194, + 1.07190484161232, + 1.0719048416122476, + 1.0719048416122483 ], - "timestamp": 7.240147566219465 + "timestamp": 7.316434571526999 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": 2.246957301459914e-16, - "velocityX": 0.5539103568522864, - "velocityY": -0.0053556863887757175, + "angularVelocity": 6.569586620037962e-16, + "velocityX": 0.5539104016139282, + "velocityY": -0.005355661647002772, "moduleForcesX": [ - -115.38070640237679, - -115.38070640237679, - -115.38070640237679, - -115.38070640237679 + -115.38069800613746, + -115.38069800613746, + -115.38069800613746, + -115.38069800613746 ], "moduleForcesY": [ - 1.0983712484824302, - 1.0983712484824302, - 1.0983712484824162, - 1.0983712484824162 + 1.098373376275015, + 1.0983733762750154, + 1.0983733762749426, + 1.098373376274943 ], - "timestamp": 7.308310499703295 + "timestamp": 7.384597511886072 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": -3.1001175632732538e-25, - "velocityX": 2.125979487428218e-25, - "velocityY": -7.679223892443952e-26, + "angularVelocity": 2.1594191776071485e-25, + "velocityX": -1.0074564721924767e-23, + "velocityY": 1.0581704151351368e-23, "moduleForcesX": [ - -115.39461413799822, - -115.39461413799822, - -115.39461413799822, - -115.39461413799822 + -115.39461182381045, + -115.39461182381045, + -115.39461182381045, + -115.39461182381045 ], "moduleForcesY": [ - 1.1157353471217306, - 1.1157353471217306, - 1.1157353471217144, - 1.1157353471217144 + 1.1157300801986492, + 1.1157300801986496, + 1.1157300801985768, + 1.1157300801985772 ], - "timestamp": 7.376473433187125 + "timestamp": 7.452760452245144 }, { - "x": 3.2066986168460305, - "y": 5.573801506681172, - "heading": 3.125769419620629, - "angularVelocity": -0.22214471367149358, - "velocityX": -0.4092925688636585, - "velocityY": -0.4034976421009905, + "x": 3.2067040069092134, + "y": 5.573943438615316, + "heading": 3.1211551253930243, + "angularVelocity": -0.2866001693312032, + "velocityX": -0.4087529483282819, + "velocityY": -0.4010498334162292, "moduleForcesX": [ - -94.50501486045644, - -83.99858675745848, - -80.27135887466498, - -67.60907694190244 + -97.7982362461094, + -84.66730708312969, + -79.91393576166902, + -63.20469705289832 ], "moduleForcesY": [ - -66.22016115527009, - -79.10404420877457, - -82.91786973993526, - -93.52088748741936 + -61.25124940458032, + -78.37881724715737, + -83.2653681457004, + -96.55297564085089 ], - "timestamp": 7.4477028300413 + "timestamp": 7.524070696912693 }, { - "x": 3.148391338670253, - "y": 5.516308685460145, - "heading": 3.0946118348565337, - "angularVelocity": -0.4374259244098728, - "velocityX": -0.8185844714528088, - "velocityY": -0.807150190232956, + "x": 3.148394804389903, + "y": 5.516669588157704, + "heading": 3.0819512787773773, + "angularVelocity": -0.5497645786859534, + "velocityX": -0.8176833888475731, + "velocityY": -0.8031644082084749, "moduleForcesX": [ - -94.33138257713645, - -83.45340079540252, - -80.64801905590379, - -67.95070369572386 + -96.91343804537247, + -83.6117617704874, + -80.55330595264402, + -64.64704831280247 ], "moduleForcesY": [ - -66.44136479388739, - -79.65440454308316, - -82.53433216167745, - -93.2563885145976 + -62.61253176158479, + -79.47867664464056, + -82.62882568534246, + -95.57647529043373 ], - "timestamp": 7.518932226895475 + "timestamp": 7.595380941580242 }, { - "x": 3.0609306562816943, - "y": 5.430043615996792, - "heading": 3.048924160519714, - "angularVelocity": -0.6414159933202015, - "velocityX": -1.2278734097329609, - "velocityY": -1.2110880236703383, + "x": 3.060907848137827, + "y": 5.430610082205895, + "heading": 3.0265586342077184, + "angularVelocity": -0.7767838243705629, + "velocityX": -1.2268497557390838, + "velocityY": -1.2068322911107934, "moduleForcesX": [ - -93.96622463847802, - -82.66507902834802, - -81.1860792576855, - -68.56375935722876 + -95.32187408048668, + -82.31821309565629, + -81.35076884094318, + -66.92262060727167 ], "moduleForcesY": [ - -66.91762608001513, - -80.43604135450067, - -81.9787027695054, - -92.78161616974027 + -64.96637934957263, + -80.78194903679561, + -81.81464976514644, + -93.97078846223003 ], - "timestamp": 7.59016162374965 + "timestamp": 7.666691186247791 }, { - "x": 2.944318774935105, - "y": 5.314972807576324, - "heading": 2.9899555039449703, - "angularVelocity": -0.8278696602677583, - "velocityX": -1.637131388116669, - "velocityY": -1.6154960381883656, + "x": 2.9442234271309333, + "y": 5.3156098843885005, + "heading": 2.9591124503921264, + "angularVelocity": -0.9458133838977714, + "velocityX": -1.63629253483678, + "velocityY": -1.612674284789381, "moduleForcesX": [ - -93.23102514178399, - -81.699397941509, - -81.83020425409698, - -69.59582645311289 + -92.24877909794793, + -81.18961303807885, + -82.06283505268627, + -70.63242017886546 ], "moduleForcesY": [ - -67.87302901661609, - -81.3580027716078, - -81.29029357501479, - -91.9675996512419 + -69.19153030778277, + -81.86072044549816, + -81.04640774388061, + -91.16685358492028 ], - "timestamp": 7.661391020603825 + "timestamp": 7.7380014309153395 }, { - "x": 2.798563775989493, - "y": 5.171041089911012, - "heading": 2.9198390837009516, - "angularVelocity": -0.984374757343028, - "velocityX": -2.046275911110254, - "velocityY": -2.0206785965066842, + "x": 2.7983365943754688, + "y": 5.1714841013846, + "heading": 2.8875990684331025, + "angularVelocity": -1.0028486410672481, + "velocityX": -2.045804686768295, + "velocityY": -2.0211090801303704, "moduleForcesX": [ - -91.63008521058406, - -80.74282088024366, - -82.43567724433059, - -71.4573972068324 + -85.2775068960177, + -81.09664380826169, + -81.98861558632382, + -77.82613865257962 ], "moduleForcesY": [ - -69.89172174791939, - -82.19417166226101, - -80.58049754682132, - -90.4401820480368 + -77.49783429261997, + -81.85175642641804, + -80.991058485776, + -84.99010839197277 ], - "timestamp": 7.732620417458 + "timestamp": 7.809311675582888 }, { - "x": 2.6237060601772595, - "y": 4.998155595405218, - "heading": 2.8440225200690676, - "angularVelocity": -1.0643999104344437, - "velocityX": -2.454853242267534, - "velocityY": -2.427164936686651, + "x": 2.6236753281267338, + "y": 4.998926787820056, + "heading": 2.8387718219195595, + "angularVelocity": -0.684715733919828, + "velocityX": -2.449315200964648, + "velocityY": -2.4198109874536784, "moduleForcesX": [ - -86.70980354807344, - -80.52618577124305, - -82.32400313465457, - -76.2536897185496 + -60.98601461651415, + -84.03168175068872, + -75.69360315918169, + -100.69711811876627 ], "moduleForcesY": [ - -75.55570587121085, - -82.08532933524766, - -80.372578012564, - -86.13264049441499 + -97.49882069315503, + -78.57987315738362, + -86.20664997158062, + -55.29287195277558 ], - "timestamp": 7.8038498143121755 + "timestamp": 7.880621920250437 }, { - "x": 2.4491238027886877, - "y": 4.825248874693559, - "heading": 2.768573050774834, - "angularVelocity": -1.059246218926964, - "velocityX": -2.4509860408615487, - "velocityY": -2.4274629345190566, + "x": 2.4491288335424555, + "y": 4.825643663887782, + "heading": 2.7904774617241968, + "angularVelocity": -0.6772429462346313, + "velocityX": -2.447705731455862, + "velocityY": -2.429989193560148, "moduleForcesX": [ - 0.8313154124721739, - 0.5815156710986054, - 0.960410251787089, - 0.7105986961435966 + 0.4130056069714148, + 0.04889182806994197, + 0.5921306407032488, + 0.22796342105049527 ], "moduleForcesY": [ - -0.2750886779845719, - -0.17899030487484907, - 0.06010210260660461, - 0.15634311143689636 + -2.3376973989520304, + -2.204364974642423, + -1.8492859164341702, + -1.715902956353102 ], - "timestamp": 7.875079211166351 + "timestamp": 7.951932164917986 }, { - "x": 2.303614224295877, - "y": 4.681164504915296, - "heading": 2.7036831029300576, - "angularVelocity": -0.9109995410690177, - "velocityX": -2.0428304172040885, - "velocityY": -2.0228217020177746, + "x": 2.3035011250063397, + "y": 4.681149821933151, + "heading": 2.7264699100767897, + "angularVelocity": -0.8975926523014042, + "velocityX": -2.042170928104912, + "velocityY": -2.0262704556444535, "moduleForcesX": [ - 91.18252045297272, - 77.62580863219615, - 84.43073188208312, - 72.23833707289441 + 67.54599174060296, + 84.9037485490674, + 75.2752222728781, + 95.29586306490998 ], "moduleForcesY": [ - 70.08510741611299, - 84.80855065381793, - 78.21066685239548, - 89.57057617080244 + 93.07759399799777, + 77.61475836679602, + 86.7010154409663, + 64.1809063754542 ], - "timestamp": 7.946308608020526 + "timestamp": 8.023242409585535 }, { - "x": 2.1872057933221156, - "y": 4.565894974920919, - "heading": 2.6510971821891247, - "angularVelocity": -0.7382614912293802, - "velocityX": -1.6342751183486552, - "velocityY": -1.6182859196514365, + "x": 2.187069229591648, + "y": 4.565754778501453, + "heading": 2.668058906720778, + "angularVelocity": -0.819110965448604, + "velocityX": -1.6327513102430458, + "velocityY": -1.6182112958618466, "moduleForcesX": [ - 92.86354233827863, - 76.10788597003088, - 85.60378749942653, - 71.22089704597026 + 86.70173496470736, + 79.384018772138, + 83.43809887191118, + 76.59134612886838 ], "moduleForcesY": [ - 68.23029646989538, - 86.50055242381335, - 77.21719460477225, - 90.6427680132351 + 75.89707047860772, + 83.51024074907042, + 79.50816094167688, + 86.11608026131232 ], - "timestamp": 8.017538004874702 + "timestamp": 8.094552654253084 }, { - "x": 2.0999010385337513, - "y": 4.4794418527905195, - "heading": 2.6113303554720884, - "angularVelocity": -0.558292340990185, - "velocityX": -1.2256843191737148, - "velocityY": -1.213728122777609, + "x": 2.0998022646657093, + "y": 4.479318845326743, + "heading": 2.621053106423146, + "angularVelocity": -0.6591731737392705, + "velocityX": -1.2237647666584353, + "velocityY": -1.212111016834661, "moduleForcesX": [ - 93.27282582567618, - 75.14352562829308, - 86.26725520322118, - 71.1408153779973 + 91.96458850927135, + 76.0539395076334, + 85.67235755159176, + 72.07935631353604 ], "moduleForcesY": [ - 67.80015365809152, - 87.44982615530438, - 76.56915606002667, - 90.78923076727229 + 69.55656402670739, + 86.65433407137036, + 77.2235599704272, + 90.03678616248813 ], - "timestamp": 8.088767401728877 + "timestamp": 8.165862898920633 }, { - "x": 2.0416985533138226, - "y": 4.421807328352338, - "heading": 2.5846398593563444, - "angularVelocity": -0.374711808530201, - "velocityX": -0.817113267701592, - "velocityY": -0.8091395825823795, + "x": 2.0416569192005602, + "y": 4.421751377581397, + "heading": 2.588213851721259, + "angularVelocity": -0.4605124390609731, + "velocityX": -0.8153855836033795, + "velocityY": -0.8072818711214387, "moduleForcesX": [ - 93.42895814439328, - 74.50739015764167, - 86.68884220281498, - 71.18348402973328 + 94.28332054605062, + 73.78272693454588, + 86.89555919568178, + 70.32485404051467 ], "moduleForcesY": [ - 67.65058557937509, - 88.04747340766613, - 76.13800705299516, - 90.79681638747401 + 66.44804317305007, + 88.6490102789359, + 75.90013809981592, + 91.461556269102 ], - "timestamp": 8.159996798583052 + "timestamp": 8.237173143588182 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": -0.18854710036895178, - "velocityX": -0.40855928039119105, - "velocityY": -0.40454905992210366, + "angularVelocity": -0.2384522544000844, + "velocityX": -0.4075122325502672, + "velocityY": -0.40330579286768936, "moduleForcesX": [ - 93.54843405198021, - 74.14598545423124, - 86.92196903084317, - 71.17867844532283 + 95.62161114658021, + 72.28092066696597, + 87.6098954465452, + 69.37112285680641 ], "moduleForcesY": [ - 67.52515136113759, - 88.38488704635111, - 75.89955258668185, - 90.82487231947138 + 64.5500491439784, + 89.90999033784931, + 75.10570426878738, + 92.21350984982247 ], - "timestamp": 8.231226195437227 + "timestamp": 8.30848338825573 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": 3.1943459470198745e-23, - "velocityX": -5.469392050310526e-23, - "velocityY": -4.674764031709702e-23, + "angularVelocity": 4.422392455737567e-23, + "velocityX": -6.58083868918992e-23, + "velocityY": -7.421024279100438e-23, "moduleForcesX": [ - 93.70754772093763, - 74.0416335766594, - 86.98334831370248, - 71.06675825660123 + 96.59228734629687, + 71.44716369701295, + 87.94049500594602, + 68.61596217852527 ], "moduleForcesY": [ - 67.33114392906658, - 88.4940863558236, - 75.84771503471543, - 90.92845417388111 + 63.11798568308976, + 90.59549675575015, + 74.73839504419405, + 92.79347338693019 ], - "timestamp": 8.302455592291402 + "timestamp": 8.37979363292328 }, { - "x": 2.041953615742068, - "y": 4.378378905710642, - "heading": 2.6013063846651288, - "angularVelocity": 0.4668485846449045, - "velocityX": 0.4553679702074507, - "velocityY": -0.22666627016800736, + "x": 2.0419535184125355, + "y": 4.378378938668267, + "heading": 2.6013079982530756, + "angularVelocity": 0.46687359905252357, + "velocityX": 0.45536644581371355, + "velocityY": -0.22666575164772176, "moduleForcesX": [ - 90.31940844346734, - 86.19108550191558, - 111.0245802243277, - 113.67801849819759 + 90.31876641561897, + 86.18981380029929, + 111.02482428420288, + 113.67833215471809 ], "moduleForcesY": [ - -71.82796867166263, - -76.68979833900957, - -31.47718312544652, - -19.714913550991096 + -71.82877383631248, + -76.69122231911778, + -31.476317591030636, + -19.7130866601736 ], - "timestamp": 8.366923221703967 + "timestamp": 8.444261264410038 }, { - "x": 2.100686916805549, - "y": 4.34921431694764, - "heading": 2.661560971312702, - "angularVelocity": 0.9346487096953813, - "velocityX": 0.9110510437356681, - "velocityY": -0.45239120825061296, + "x": 2.1006867225178447, + "y": 4.349214387879551, + "heading": 2.66156424307939, + "angularVelocity": 0.934674400729164, + "velocityX": 0.9110495104411048, + "velocityY": -0.45239060465106323, "moduleForcesX": [ - 91.08357348554155, - 85.55141100459058, - 111.34346253684427, - 113.512275132038 + 91.08359939264427, + 85.55134610222815, + 111.34348432988189, + 113.51227157432788 ], "moduleForcesY": [ - -70.82047716964789, - -77.35792380941974, - -30.241251869986673, - -20.460827170514083 + -70.82043772341163, + -77.35798773989126, + -30.241157017363147, + -20.460816178917426 ], - "timestamp": 8.431390851116532 + "timestamp": 8.508728895896796 }, { - "x": 2.188828983459932, - "y": 4.30558804082172, - "heading": 2.7518665174157255, - "angularVelocity": 1.4007889994699134, - "velocityX": 1.367229840115771, - "velocityY": -0.6767159972135803, + "x": 2.1888288337503314, + "y": 4.305588083853979, + "heading": 2.751868994756181, + "angularVelocity": 1.400776631530792, + "velocityX": 1.36723048760664, + "velocityY": -0.6767164082107214, "moduleForcesX": [ - 92.22471205340607, - 84.73884598587084, - 111.77189701377915, - 113.1920358545827 + 92.22557626068495, + 84.74080845033583, + 111.77152136175108, + 113.19149333747797 ], "moduleForcesY": [ - -69.25533775826122, - -78.1610920385497, - -28.42581379359046, - -21.804600786698785 + -69.25416976459641, + -78.15894950714625, + -28.427248361937494, + -21.807364319503435 ], - "timestamp": 8.495858480529098 + "timestamp": 8.573196527383555 }, { - "x": 2.3064108263014638, - "y": 4.247619822740085, - "heading": 2.871624755946557, - "angularVelocity": 1.8576491740441008, - "velocityX": 1.8238896623460321, - "velocityY": -0.8991833360377534, + "x": 2.3064110851595947, + "y": 4.247619595905105, + "heading": 2.871619566972024, + "angularVelocity": 1.857530197001871, + "velocityX": 1.8238959412277145, + "velocityY": -0.899187493196176, "moduleForcesX": [ - 93.71262507711475, - 83.94734279206513, - 112.181194058843, - 112.51014857524359 + 93.71457960486228, + 83.95312347953696, + 112.18000941325678, + 112.50854673479259 ], "moduleForcesY": [ - -67.00490432643169, - -78.7595043102539, - -26.138048273425948, - -24.10783557177594 + -67.00210588095794, + -78.75329673294317, + -26.142969355852962, + -24.11521485261637 ], - "timestamp": 8.560326109941663 + "timestamp": 8.637664158870313 }, { - "x": 2.4249201960080744, - "y": 4.1906611165057175, - "heading": 2.9802037085519797, - "angularVelocity": 1.684239882787761, - "velocityX": 1.83827714445963, - "velocityY": -0.8835241306897914, + "x": 2.424920548824161, + "y": 4.190660759682163, + "heading": 2.9801962738348395, + "angularVelocity": 1.6842049934022552, + "velocityX": 1.838278542758427, + "velocityY": -0.8835261186017338, "moduleForcesX": [ - -0.6594868643756788, - 9.131886004968548, - -2.8295023873622442, - 7.033546413975622 + -0.6576525136461785, + 9.131767443761998, + -2.8279965006211887, + 7.026024173020117 ], "moduleForcesY": [ - 10.854211773799015, - 9.22236053293692, - -2.339354556360805, - -3.940291709407672 + 10.850457001056148, + 9.22031704495339, + -2.334560335904532, + -3.9373768454129094 ], - "timestamp": 8.624793739354228 + "timestamp": 8.702131790357072 }, { - "x": 2.5138781257306912, - "y": 4.147944154593341, - "heading": 3.06100032388245, - "angularVelocity": 1.2532896907594944, - "velocityX": 1.3798852312891103, - "velocityY": -0.6626110235728699, + "x": 2.5138783682560137, + "y": 4.147943895629665, + "heading": 3.0609951273200853, + "angularVelocity": 1.2533243679324737, + "velocityX": 1.3798834760995347, + "velocityY": -0.6626094842846958, "moduleForcesX": [ - -96.20030583423292, - -83.49735362781274, - -112.87287120033253, - -111.30688094678442 + -96.20123306665766, + -83.50128406439781, + -112.8719813672814, + -111.30567857439891 ], "moduleForcesY": [ - 63.39232613998012, - 79.26624964258414, - 22.910766035105024, - 29.07155678764673 + 63.390860409712616, + 79.26206350790233, + 22.914988055013122, + 29.076088096143998 ], - "timestamp": 8.689261368766793 + "timestamp": 8.76659942184383 }, { - "x": 2.5732044469161934, - "y": 4.119469408000457, - "heading": 3.1146935416419046, - "angularVelocity": 0.8328709811220385, - "velocityX": 0.9202497707157794, - "velocityY": -0.4416906105024887, + "x": 2.573204544665813, + "y": 4.119469300656433, + "heading": 3.1146914296651333, + "angularVelocity": 0.8329188013689777, + "velocityX": 0.9202474953959546, + "velocityY": -0.44168824441893817, "moduleForcesX": [ - -97.04105274434207, - -83.72178565794128, - -113.16925703452722, - -111.040974040282 + -97.04118666628617, + -83.7225268890319, + -113.16906929813969, + -111.0407318674197 ], "moduleForcesY": [ - 62.3384953090497, - 79.27865285910248, - 22.1639550486123, - 30.86623247761849 + 62.338271276948696, + 79.27785567094799, + 22.16486600754754, + 30.867064944590858 ], - "timestamp": 8.753728998179358 + "timestamp": 8.831067053330589 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": 0.41724990034526915, - "velocityX": 0.46014760143287403, - "velocityY": -0.22081995024741788, + "angularVelocity": 0.4172826471868358, + "velocityX": 0.46014607036910204, + "velocityY": -0.22081827805865795, "moduleForcesX": [ - -97.43168523301415, - -83.78966430984669, - -113.29850030582719, - -110.86442475699117 + -97.43147500123005, + -83.78876895559843, + -113.29868293583836, + -110.86467892511293 ], "moduleForcesY": [ - 61.806795260557664, - 79.28878914703319, - 21.754142326817426, - 31.75377302463092 + 61.807121644078244, + 79.2897292411926, + 21.753172555886724, + 31.752858683705533 ], - "timestamp": 8.818196627591924 + "timestamp": 8.895534684817347 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": -5.576115791345261e-23, - "velocityX": 4.832731708286524e-23, - "velocityY": 2.5949584810645407e-23, + "angularVelocity": -7.866247097183092e-23, + "velocityX": 6.78824268132765e-23, + "velocityY": 3.6098947052526804e-23, "moduleForcesX": [ - -97.43090964153063, - -83.72024176507091, - -113.3437528109882, - -110.92939949551028 + -97.43047601274746, + -83.71833110199685, + -113.34415942502996, + -110.92997514796726 ], "moduleForcesY": [ - 61.848085945116416, - 79.40203201217781, - 21.650429300155526, - 31.658273208510547 + 61.84876794751755, + 79.40404372307437, + 21.64829364292422, + 31.65623556989351 ], - "timestamp": 8.882664257004489 + "timestamp": 8.960002316304106 }, { - "x": 2.576440824052377, - "y": 4.117038967947073, - "heading": 3.1112264543640924, - "angularVelocity": -0.49847391634204, - "velocityX": -0.4338307912320184, - "velocityY": 0.19378893670305936, + "x": 2.576440932025781, + "y": 4.117038855996892, + "heading": 3.1112245997800225, + "angularVelocity": -0.49850434355138845, + "velocityX": -0.4338290043854107, + "velocityY": 0.19378709255352025, "moduleForcesX": [ - -96.78178208378979, - -79.65664846502794, - -114.54083675568862, - -113.52833812262094 + -96.78133854290625, + -79.65476731370306, + -114.54105043150145, + -113.52876962438683 ], "moduleForcesY": [ - 62.8559302580606, - 83.46877311897688, - 13.98107239638093, - 20.38471537731262 + 62.85661167452962, + 83.47056524407454, + 13.979310801185582, + 20.382277924872408 ], - "timestamp": 8.943582588395904 + "timestamp": 9.020920649720072 }, { - "x": 2.523633825869069, - "y": 4.140701386661653, - "heading": 3.049917147465986, - "angularVelocity": -1.00641802718103, - "velocityX": -0.8668490580283761, - "velocityY": 0.38842854316779524, + "x": 2.5236340884512134, + "y": 4.140701139163088, + "heading": 3.0499127384037488, + "angularVelocity": -1.006459926564636, + "velocityX": -0.86684649125229, + "velocityY": 0.3884263051752233, "moduleForcesX": [ - -95.85123578413562, - -79.75263731487098, - -114.32031499165952, - -113.82581248115163 + -95.85098527966763, + -79.75194362178674, + -114.32037290983277, + -113.8259581293425 ], "moduleForcesY": [ - 64.22511537248816, - 83.3321020697923, - 15.50409667268004, - 18.42234892504067 + 64.22548363003447, + 83.33275912303841, + 15.503643170599588, + 18.421403862263197 ], - "timestamp": 9.004500919787318 + "timestamp": 9.081838983136038 }, { - "x": 2.444538637133602, - "y": 4.176301641210184, - "heading": 2.956763746978034, - "angularVelocity": -1.5291522003355558, - "velocityX": -1.298380748928638, - "velocityY": 0.5843931331571143, + "x": 2.444538983723339, + "y": 4.176301351792292, + "heading": 2.956758090766189, + "angularVelocity": -1.5291726219999353, + "velocityX": -1.2983793267585322, + "velocityY": 0.5843924256121097, "moduleForcesX": [ - -94.376145734969, - -79.85703113409417, - -113.95978815112649, - -114.17093924825681 + -94.37638365733315, + -79.85830247504768, + -113.95958149721488, + -114.17069050727945 ], "moduleForcesY": [ - 66.29352669629847, - 83.13867501463098, - 17.657848513922975, - 15.629038984963607 + 66.2931720124336, + 83.13743831492843, + 17.659120262265198, + 15.630779550308647 ], - "timestamp": 9.065419251178733 + "timestamp": 9.142757316552004 }, { - "x": 2.339300712877381, - "y": 4.223965232327085, - "heading": 2.8309077343927975, - "angularVelocity": -2.065979315431076, - "velocityX": -1.7275247343865, - "velocityY": 0.7824178704214834, + "x": 2.3393008114476626, + "y": 4.223965142674428, + "heading": 2.8309060893015747, + "angularVelocity": -2.065913402542771, + "velocityX": -1.727528748317553, + "velocityY": 0.7824211236488453, "moduleForcesX": [ - -92.27983792176532, - -80.19605916572785, - -113.32380930105032, - -114.33788054491679 + -92.28142357461459, + -80.20103541951015, + -113.32310550893337, + -114.33707780014122 ], "moduleForcesY": [ - 68.94832064257966, - 82.52218385370321, - 20.593651711278582, - 12.575832251224798 + 68.94614202726282, + 82.51730402352771, + 20.59733382901846, + 12.582895501177047 ], - "timestamp": 9.126337582570148 + "timestamp": 9.20367564996797 }, { - "x": 2.235190395761607, - "y": 4.273756936630003, - "heading": 2.701317964138096, - "angularVelocity": -2.127270516030026, - "velocityX": -1.7090145894975588, - "velocityY": 0.8173517423350798, + "x": 2.235190073627775, + "y": 4.273756975831149, + "heading": 2.7013219935024604, + "angularVelocity": -2.127177296763512, + "velocityX": -1.7090214387349054, + "velocityY": 0.8173538303605644, "moduleForcesX": [ - 3.684421057917722, - 7.063912641861401, - 1.555725211536742, - 4.954961279186012 + 3.6851851769563395, + 7.061909627035633, + 1.557485144882814, + 4.951796003866703 ], "moduleForcesY": [ - 11.191987173441394, - 9.59755977851208, - 6.692902445124649, - 5.090196808915668 + 11.190702840872866, + 9.598090988387812, + 6.6913917907658425, + 5.091373059116531 ], - "timestamp": 9.187255913961563 + "timestamp": 9.264593983383936 }, { - "x": 2.157097583307559, - "y": 4.311211682575675, - "heading": 2.6044566357317396, - "angularVelocity": -1.5900193947204522, - "velocityX": -1.2819263211968914, - "velocityY": 0.6148353884648882, + "x": 2.1570972821207093, + "y": 4.3112117278174935, + "heading": 2.60446043332951, + "angularVelocity": -1.5900231464238217, + "velocityX": -1.2819259347399985, + "velocityY": 0.6148354671916831, "moduleForcesX": [ - 88.82178084722035, - 82.51336670219086, - 112.18902066417408, - 114.69665015134913 + 88.82438792099869, + 82.51888433729167, + 112.18828932823602, + 114.69599016804356 ], "moduleForcesY": [ - -73.33093047177124, - -80.15041574335498, - -26.12896176757338, - -9.217702890443773 + -73.32771655792331, + -80.14469842932267, + -26.131944406933393, + -9.225518690999772 ], - "timestamp": 9.248174245352978 + "timestamp": 9.325512316799902 }, { - "x": 2.10503433227216, - "y": 4.336216845215367, - "heading": 2.539998763051629, - "angularVelocity": -1.0581030571233867, - "velocityX": -0.854640136166579, - "velocityY": 0.41047024875037896, + "x": 2.105034195245937, + "y": 4.33621686660926, + "heading": 2.5400004915986667, + "angularVelocity": -1.0581369862943222, + "velocityX": -0.8546374129980211, + "velocityY": 0.4104698436351712, "moduleForcesX": [ - 87.93445802257567, - 83.61446769451473, - 111.92017771507034, - 114.93625421398835 + 87.93535535098103, + 83.61615888406604, + 111.91995391554177, + 114.93605502522537 ], "moduleForcesY": [ - -74.61104959107475, - -79.30871463146512, - -27.840746229308422, - -8.791324432745945 + -74.60997644793598, + -79.30691637646426, + -27.84160522062184, + -8.793781645274724 ], - "timestamp": 9.309092576744392 + "timestamp": 9.386430650215868 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -0.5296576683558465, - "velocityX": -0.4273247996047905, - "velocityY": 0.20526140282074246, + "angularVelocity": -0.5296860255780654, + "velocityX": -0.4273225360601924, + "velocityY": 0.20526104480936758, "moduleForcesX": [ - 87.47215406723147, - 84.19152726546542, - 111.75251144456588, - 115.01634601054388 + 87.47197704017128, + 84.19119924954728, + 111.75254715698382, + 115.01637354227935 ], "moduleForcesY": [ - -75.22571028375253, - -78.80193174691283, - -28.691908830480827, - -8.618963041311037 + -75.22591033857395, + -78.80227271136283, + -28.69175573980809, + -8.61852483376894 ], - "timestamp": 9.370010908135807 + "timestamp": 9.447348983631834 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -1.1810659900072104e-23, - "velocityX": 1.1429735881849466e-23, - "velocityY": 2.3338539139201852e-23, + "angularVelocity": -1.5930760739242085e-23, + "velocityX": 1.5568104276022208e-23, + "velocityY": 3.205093369656377e-23, "moduleForcesX": [ - 87.45368989610174, - 84.1506642550139, - 111.7820465070688, - 115.05496155327525 + 87.45282015084237, + 84.14903985656558, + 111.7822513078171, + 115.05512710586952 ], "moduleForcesY": [ - -75.28457785684655, - -78.90065034494484, - -28.668166390935777, - -8.534123812406273 + -75.28558613417842, + -78.90237620597085, + -28.667363381920158, + -8.531852509603667 ], - "timestamp": 9.430929239527222 + "timestamp": 9.5082673170478 } ], "trajectoryWaypoints": [ @@ -15903,7 +16050,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 0.4132336745934464, + "timestamp": 0.41166807773402103, "isStopPoint": false, "x": 2.0305891418457023, "y": 6.206027030944824, @@ -15914,7 +16061,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 0.6561639411726728, + "timestamp": 0.6593576083295194, "isStopPoint": false, "x": 2.9098873519897452, "y": 6.272213459014893, @@ -15925,7 +16072,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.2357315017277102, + "timestamp": 1.2429852180832037, "isStopPoint": true, "x": 4.083083190917968, "y": 6.506374835968018, @@ -15933,10 +16080,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { - "timestamp": 2.607126226805618, + "timestamp": 2.6360197794168303, "isStopPoint": true, "x": 7.4399999999999995, "y": 7.454689979553223, @@ -15944,10 +16091,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 15 + "controlIntervalCount": 16 }, { - "timestamp": 4.104598551047538, + "timestamp": 4.162435647449047, "isStopPoint": true, "x": 3.901903190612792, "y": 5.593123435974121, @@ -15958,7 +16105,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 4.590781451164208, + "timestamp": 4.647846805909572, "isStopPoint": false, "x": 3.9544325256347648, "y": 5.600627422332764, @@ -15969,7 +16116,7 @@ "controlIntervalCount": 5 }, { - "timestamp": 4.809652845576571, + "timestamp": 4.869061248754019, "isStopPoint": false, "x": 3.7524805450439445, "y": 5.863831043243408, @@ -15980,7 +16127,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 5.548555652367775, + "timestamp": 5.612045193727306, "isStopPoint": true, "x": 2.6847877883911124, "y": 7.142738342285156, @@ -15991,7 +16138,7 @@ "controlIntervalCount": 22 }, { - "timestamp": 6.546975154041397, + "timestamp": 6.623262014669493, "isStopPoint": true, "x": 1.8547611618041984, "y": 5.613125324249268, @@ -16002,7 +16149,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 6.967495832284146, + "timestamp": 7.043782810090709, "isStopPoint": false, "x": 2.6696577453613273, "y": 5.6078338623046875, @@ -16013,7 +16160,7 @@ "controlIntervalCount": 6 }, { - "timestamp": 7.376473433187125, + "timestamp": 7.452760452245144, "isStopPoint": true, "x": 3.235852279663085, "y": 5.602542400360107, @@ -16024,7 +16171,7 @@ "controlIntervalCount": 13 }, { - "timestamp": 8.302455592291402, + "timestamp": 8.37979363292328, "isStopPoint": true, "x": 2.012597122192382, "y": 4.392991542816162, @@ -16035,7 +16182,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 8.882664257004489, + "timestamp": 8.960002316304106, "isStopPoint": true, "x": 2.6028690719604484, "y": 4.105233669281006, @@ -16046,7 +16193,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 9.430929239527222, + "timestamp": 9.5082673170478, "isStopPoint": true, "x": 2.0790024185180656, "y": 4.348721027374268, @@ -16142,7 +16289,7 @@ "name": "intake", "target": 3, "trajTargetIndex": 3, - "targetTimestamp": 1.2357315017277102, + "targetTimestamp": 1.2429852180832037, "offset": 0.4, "command": { "type": "named", @@ -16155,7 +16302,7 @@ "name": "intake", "target": 9, "trajTargetIndex": 9, - "targetTimestamp": 6.546975154041397, + "targetTimestamp": 6.623262014669493, "offset": 0.2, "command": { "type": "named", @@ -16168,7 +16315,7 @@ "name": "intake", "target": 12, "trajTargetIndex": 12, - "targetTimestamp": 8.302455592291402, + "targetTimestamp": 8.37979363292328, "offset": 0.2, "command": { "type": "named", @@ -16181,7 +16328,7 @@ "name": "intake", "target": 5, "trajTargetIndex": 5, - "targetTimestamp": 4.104598551047538, + "targetTimestamp": 4.162435647449047, "offset": 0.3, "command": { "type": "named", @@ -16247,7 +16394,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 17 }, { "x": 3.7661104583740226, @@ -16309,9 +16456,9 @@ "x": 0.7587480926513663, "y": 6.674294471740723, "heading": -2.1045042248017936, - "angularVelocity": 1.5246049853933737e-25, - "velocityX": -2.0272981672250602e-24, - "velocityY": -2.368851786462168e-25, + "angularVelocity": 1.974529983201505e-22, + "velocityX": 1.3949524343162162e-20, + "velocityY": 1.7216480334359217e-21, "moduleForcesX": [ 0, 0, @@ -16327,2482 +16474,2503 @@ "timestamp": 0 }, { - "x": 0.8024207657231025, - "y": 6.679677617673034, - "heading": -2.1177141826984873, - "angularVelocity": -0.17911083631788266, - "velocityX": 0.5921479129069698, - "velocityY": 0.0729888601839491, + "x": 0.8024205497601767, + "y": 6.679677689320791, + "heading": -2.117721058110864, + "angularVelocity": -0.1792040409939818, + "velocityX": 0.592144926929208, + "velocityY": 0.07298982451690292, "moduleForcesX": [ - 114.49845914960216, - 111.52415378273294, - 115.39645209570612, - 114.62304761463147 + 114.49839415532603, + 111.52193059132293, + 115.39636467253322, + 114.62307907253539 ], "moduleForcesY": [ - 14.302632979180666, - 29.647246899745284, - -1.1737539863505286, - 13.436170515363187 + 14.30298485898657, + 29.655557879336452, + -1.181353158922053, + 13.435844022960593 ], - "timestamp": 0.07375297982110329 + "timestamp": 0.07375298701838148 }, { - "x": 0.8897572775547896, - "y": 6.690442536464301, - "heading": -2.1442928098503233, - "angularVelocity": -0.3603736041080037, - "velocityX": 1.1841760433752269, - "velocityY": 0.14595910317628294, + "x": 0.8897567314254748, + "y": 6.690442727379406, + "heading": -2.144310167069316, + "angularVelocity": -0.3605156893757417, + "velocityX": 1.184171451164837, + "velocityY": 0.14596070605154757, "moduleForcesX": [ - 114.41456026220696, - 111.50844636902374, - 115.37690823700737, - 114.64994745113319 + 114.41445099721368, + 111.50730603264704, + 115.37684481502328, + 114.6499789417417 ], "moduleForcesY": [ - 14.788729002822109, - 29.631929160379446, - -1.281113395748738, - 13.05841362930543 + 14.789343949904026, + 29.636133156128125, + -1.2850231166131485, + 13.057990695853633 ], - "timestamp": 0.14750595964220659 + "timestamp": 0.14750597403676297 }, { - "x": 1.020739829952666, - "y": 6.706587085965137, - "heading": -2.184566868757912, - "angularVelocity": -0.5460668708610559, - "velocityX": 1.7759628521530972, - "velocityY": 0.21890030124879628, + "x": 1.0207390149953617, + "y": 6.706587400459137, + "heading": -2.184592527891774, + "angularVelocity": -0.5461793813506001, + "velocityX": 1.775959033865869, + "velocityY": 0.2189019554653092, "moduleForcesX": [ - 114.27773305577186, - 111.46040731354765, - 115.34136867400807, - 114.68449962172555 + 114.27765420928105, + 111.46108154508879, + 115.34135846330668, + 114.68446600714897 ], "moduleForcesY": [ - 15.525374011394451, - 29.68197180848282, - -1.5144551853010968, - 12.482698846734147 + 15.525601814683363, + 29.679266789583505, + -1.5118713708450173, + 12.482626306329042 ], - "timestamp": 0.22125893946330988 + "timestamp": 0.22125896105514445 }, { - "x": 1.1953286514334718, - "y": 6.7281056267189525, - "heading": -2.239127367508517, - "angularVelocity": -0.7397734828199135, - "velocityX": 2.3672104083698327, - "velocityY": 0.29176503520279534, + "x": 1.1953280076893775, + "y": 6.728105972585149, + "heading": -2.23914640818786, + "angularVelocity": -0.7396836725065663, + "velocityX": 2.3672124988036476, + "velocityY": 0.2917654320990209, "moduleForcesX": [ - 114.047317314268, - 111.33731276290986, - 115.26103974744757, - 114.70303402913382 + 114.04761304875296, + 111.34169862631441, + 115.26119474678515, + 114.70270359118508 ], "moduleForcesY": [ - 16.537440340405908, - 29.85222721217794, - -1.9511492781751685, - 11.678182443826518 + 16.534704753620296, + 29.835398318882216, + -1.9345387090443167, + 11.680162554712453 ], - "timestamp": 0.29501191928441317 + "timestamp": 0.29501194807352593 }, { - "x": 1.4133617748282827, - "y": 6.754973444774636, - "heading": -2.3095237263100015, - "angularVelocity": -0.95448833351872, - "velocityX": 2.956261888315244, - "velocityY": 0.3642946782740959, + "x": 1.4133630444925243, + "y": 6.754973345333406, + "heading": -2.309476126798875, + "angularVelocity": -0.9535846811666981, + "velocityX": 2.956287543293751, + "velocityY": 0.364288604901666, "moduleForcesX": [ - 113.4372446028584, - 110.7664793158522, - 114.9120784501825, - 114.5415955789105 + 113.43975897922057, + 110.78310373820221, + 114.91309615963543, + 114.53954300836372 ], "moduleForcesY": [ - 18.019343819168103, - 30.725491734044468, - -3.316928025724304, - 10.430723288375912 + 18.000125302132677, + 30.662429048736804, + -3.2520872885591716, + 10.443175232183405 ], - "timestamp": 0.36876489910551646 + "timestamp": 0.36876493509190744 }, { - "x": 1.5879369987940704, - "y": 6.77647174900219, - "heading": -2.368159117892291, - "angularVelocity": -0.795024034615507, - "velocityX": 2.367026042734014, - "velocityY": 0.2914906527126038, + "x": 1.5879382087995237, + "y": 6.776471593869833, + "heading": -2.368115423553959, + "angularVelocity": -0.7950769063830508, + "velocityX": 2.3670250028448327, + "velocityY": 0.2914898691638042, "moduleForcesX": [ - -113.21740142392868, - -111.67454146499207, - -114.66905825851462, - -114.23838580721045 + -113.2226233248531, + -111.69180132345564, + -114.66860726835483, + -114.23686977658001 ], "moduleForcesY": [ - -17.63441497120967, - -26.071917316634075, - -1.551746692059195, - -10.811867231610922 + -17.60948253721816, + -26.00046807992614, + -1.626211087567619, + -10.829705083256428 ], - "timestamp": 0.44251787892661976 + "timestamp": 0.44251792211028895 }, { - "x": 1.7188926416265469, - "y": 6.792594475814811, - "heading": -2.4126844087531345, - "angularVelocity": -0.6037083649887068, - "velocityX": 1.7755979914320064, - "velocityY": 0.21860441234684702, + "x": 1.7188933932708355, + "y": 6.7925943671930265, + "heading": -2.412657668211584, + "angularVelocity": -0.6039381787550379, + "velocityX": 1.77559160334311, + "velocityY": 0.21860502164033385, "moduleForcesX": [ - -113.62556481771135, - -111.7658115885291, - -115.24093186284539, - -114.85540369095075 + -113.62660597529599, + -111.76902146309568, + -115.24105907142824, + -114.85509991104112 ], "moduleForcesY": [ - -19.05291831548316, - -28.10437611160287, - 0.7546034880784179, - -9.730572920361043 + -19.047183440095544, + -28.09175703488534, + 0.7411160901554255, + -9.734361300742805 ], - "timestamp": 0.516270858747723 + "timestamp": 0.5162709091286705 }, { - "x": 1.8062052429501583, - "y": 6.8033423608281804, - "heading": -2.442538059640397, - "angularVelocity": -0.4047789114375592, - "velocityX": 1.1838518461952148, - "velocityY": 0.14572814602799694, + "x": 1.8062055290223964, + "y": 6.8033423167589095, + "heading": -2.442527969545906, + "angularVelocity": -0.40500463156668004, + "velocityX": 1.183845418081848, + "velocityY": 0.14572900705980607, "moduleForcesX": [ - -113.62956435917394, - -111.79320392724135, - -115.33065660328327, - -114.97926679056616 + -113.62959134846822, + -111.79313493848042, + -115.33066788879077, + -114.97928385607841 ], "moduleForcesY": [ - -19.66367922942835, - -28.377381938028666, - 1.1672848935603133, - -9.251806083394865 + -19.663623460013877, + -28.377715570036685, + 1.1677274772719308, + -9.251771451433386 ], - "timestamp": 0.5900238385688263 + "timestamp": 0.590023896147052 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": -0.2026753043980138, - "velocityX": 0.5919727585178589, - "velocityY": 0.07286398915017842, + "angularVelocity": -0.2028120939192107, + "velocityX": 0.591968821960951, + "velocityY": 0.07286457956489104, "moduleForcesX": [ - -113.62366087491984, - -111.8118673061885, - -115.36748176404835, - -115.03206722044585 + -113.62315026046187, + -111.81031262941312, + -115.36741290735165, + -115.03223801565095 ], "moduleForcesY": [ - -19.953358992688422, - -28.459057623857348, - 1.3182086277736604, - -9.022048294829789 + -19.956291338037666, + -28.465206698015184, + 1.3250680498487681, + -9.020029236683413 ], - "timestamp": 0.6637768183899296 + "timestamp": 0.6637768831654335 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": 1.6375349145968543e-23, - "velocityX": -8.416190090857964e-24, - "velocityY": -1.1457822086284433e-23, + "angularVelocity": 2.5664532387064434e-20, + "velocityX": 3.58109733081458e-20, + "velocityY": -1.9250395612999744e-19, "moduleForcesX": [ - -113.64454489492644, - -111.8226539019644, - -115.38802821587312, - -115.05199065534637 + -113.6437450585874, + -111.82024353932489, + -115.38791059104989, + -115.05224225386623 ], "moduleForcesY": [ - -19.97282399859899, - -28.500501780206434, - 1.3651700292396303, - -9.007971358764731 + -19.977376009298773, + -28.509989738927217, + 1.375687108873998, + -9.00489770006138 ], - "timestamp": 0.7375297982110329 + "timestamp": 0.737529870183815 }, { - "x": 1.8645573299347353, - "y": 6.813379455407895, - "heading": -2.4698373821559474, - "angularVelocity": -0.28012842601201615, - "velocityX": 0.33322011263133106, - "velocityY": 0.10575980127060347, + "x": 1.8645723712913458, + "y": 6.813251052040291, + "heading": -2.470362048205509, + "angularVelocity": -0.291937481479346, + "velocityX": 0.33345810585500346, + "velocityY": 0.10281582797868585, "moduleForcesX": [ - 101.74059915261986, - 98.66143888298554, - 115.33460700108112, - 113.5288649606166 + 101.77209540362661, + 98.56104344072968, + 115.34193264889893, + 113.76419860866353 ], "moduleForcesY": [ - 54.28404650214983, - 59.78500771311867, - 1.6254648649670587, - 20.548862722674198 + 54.21915011775309, + 59.95036989637321, + -0.9665078147579121, + 19.20688681592282 ], - "timestamp": 0.7816217707961987 + "timestamp": 0.7816354809617166 }, { - "x": 1.8940046755751128, - "y": 6.822611735205374, - "heading": -2.494018140417116, - "angularVelocity": -0.5484163407400852, - "velocityX": 0.6678618332055473, - "velocityY": 0.20938686241916526, + "x": 1.8940483404923603, + "y": 6.82225224455195, + "heading": -2.4955113925338255, + "angularVelocity": -0.5702073700998803, + "velocityX": 0.6683042969168801, + "velocityY": 0.20408270859191144, "moduleForcesX": [ - 102.42692626434818, - 99.75522587908064, - 115.3031246958328, - 113.61159697879017 + 102.41667407252245, + 99.67413943343911, + 115.33090537915734, + 113.80517697131701 ], "moduleForcesY": [ - 52.94923017342802, - 57.91883634702496, - 2.6054576839940773, - 20.022389058972593 + 52.96303310230837, + 58.05771513935198, + 0.5017832153094849, + 18.8925777650309 ], - "timestamp": 0.8257137433813644 + "timestamp": 0.8257410917396183 }, { - "x": 1.9382790700934251, - "y": 6.836296863592373, - "heading": -2.529422828329192, - "angularVelocity": -0.8029735536029945, - "velocityX": 1.0041373048754911, - "velocityY": 0.3103768687274161, + "x": 1.9383627444187277, + "y": 6.835636025102196, + "heading": -2.5322232607638195, + "angularVelocity": -0.8323627670606444, + "velocityX": 1.0047339362222991, + "velocityY": 0.3034484800049092, "moduleForcesX": [ - 103.17292508176737, - 101.05043111896798, - 115.25417706262766, - 113.72399441780098 + 103.11790484339456, + 100.9913251526931, + 115.29193191628325, + 113.86495520158225 ], "moduleForcesY": [ - 51.44579662555791, - 55.5992638735599, - 3.7639229891020305, - 19.289785821379215 + 51.549723350324314, + 55.70508515812473, + 2.2745321495904243, + 18.4374521698026 ], - "timestamp": 0.8698057159665301 + "timestamp": 0.8698467025175199 }, { - "x": 1.9974657259317126, - "y": 6.854289480670813, - "heading": -2.575283812457909, - "angularVelocity": -1.0401209435602916, - "velocityX": 1.3423453832546357, - "velocityY": 0.40807013212408666, + "x": 1.9975977513861578, + "y": 6.853299205917846, + "heading": -2.5795808332318555, + "angularVelocity": -1.0737312471764597, + "velocityX": 1.343026565615775, + "velocityY": 0.4004746902745723, "moduleForcesX": [ - 104.09282628417806, - 102.57468929953592, - 115.17640973922875, - 113.84725221188148 + 104.00399188740997, + 102.53916594922732, + 115.20317523209397, + 113.91900928393956 ], "moduleForcesY": [ - 49.51402786048951, - 52.6952744682404, - 5.208253519163967, - 18.43423684287415 + 49.69364802883043, + 52.761241240453266, + 4.521635796707419, + 17.977297280367612 ], - "timestamp": 0.9138976885516958 + "timestamp": 0.9139523132954216 }, { - "x": 2.0716675976705656, - "y": 6.876403676556319, - "heading": -2.6305587835600814, - "angularVelocity": -1.2536289002585739, - "velocityX": 1.6828884576558427, - "velocityY": 0.5015469843811484, + "x": 2.0718517640541934, + "y": 6.875112546792885, + "heading": -2.6363209715548055, + "angularVelocity": -1.2864607772619008, + "velocityX": 1.68355026397765, + "velocityY": 0.4945706564383518, "moduleForcesX": [ - 105.32254762054376, - 104.36995920291493, - 115.04927896233586, - 113.95741323469908 + 105.22540646754383, + 104.36005213468499, + 115.02101774687753, + 113.9321163834877 ], "moduleForcesY": [ - 46.78241555241346, - 48.987831626883, - 7.070518349276243, - 17.579302576575984 + 46.99284585116888, + 49.00253104776336, + 7.461228629108369, + 17.723543700297594 ], - "timestamp": 0.9579896611368616 + "timestamp": 0.9580579240733232 }, { - "x": 2.1610104299094206, - "y": 6.902392060853308, - "heading": -2.6937619082154276, - "angularVelocity": -1.4334383550943628, - "velocityX": 2.026283402637177, - "velocityY": 0.5894130557845074, + "x": 2.161242587426491, + "y": 6.900907275957239, + "heading": -2.7006222468278853, + "angularVelocity": -1.457893318763349, + "velocityX": 2.026744937791125, + "velocityY": 0.5848400851820307, "moduleForcesX": [ - 107.01525529263431, - 106.49908090238071, - 114.83695790685456, - 114.02178183246805 + 106.94884746449395, + 106.5218821791462, + 114.66217685453101, + 113.84546391040449 ], "moduleForcesY": [ - 42.68370625113585, - 44.08136979291938, - 9.506207591539834, - 16.920785278182457 + 42.83996232103603, + 44.012594395755336, + 11.3684923546982, + 18.031148465609068 ], - "timestamp": 1.0020816337220273 + "timestamp": 1.0021635348512248 }, { - "x": 2.2656466233828794, - "y": 6.9319034624003555, - "heading": -2.762683277508738, - "angularVelocity": -1.5631273733599858, - "velocityX": 2.373134775754236, - "velocityY": 0.669314612541883, + "x": 2.2659063963289214, + "y": 6.930444659197214, + "heading": -2.769745236736348, + "angularVelocity": -1.5672153426587598, + "velocityX": 2.3730270833222504, + "velocityY": 0.6696967283529638, "moduleForcesX": [ - 109.3097818040482, - 109.05079129956879, - 114.47840264239278, - 113.98678875725696 + 109.32029884870086, + 109.13072597484648, + 113.97055609730337, + 113.53294594518619 ], "moduleForcesY": [ - 36.26992503225889, - 37.16921771819769, - 12.695311902448834, - 16.797454949385287 + 36.22279873439688, + 36.90107882775041, + 16.5960539736341, + 19.561487229518903 ], - "timestamp": 1.0461736063071931 + "timestamp": 1.0462691456291264 }, { - "x": 2.3857485172054367, - "y": 6.964387520079728, - "heading": -2.833836246946023, - "angularVelocity": -1.6137397640772295, - "velocityX": 2.7238947767776653, - "velocityY": 0.7367340532707757, + "x": 2.385976040231636, + "y": 6.963340036530722, + "heading": -2.8392855150204563, + "angularVelocity": -1.5766764603779193, + "velocityX": 2.7223213052722013, + "velocityY": 0.745832032553765, "moduleForcesX": [ - 112.18021841591916, - 112.08031010757401, - 113.86796827837568, - 113.7324954323066 + 112.2912152633114, + 112.27314779878, + 112.64475573276908, + 112.62446776737102 ], "moduleForcesY": [ - 25.791337814688198, - 26.310541605673688, - 16.866370546912208, - 17.883772198148773 + 25.270849603483, + 25.368770069311715, + 23.647404391327054, + 23.76274258091671 ], - "timestamp": 1.090265578892359 + "timestamp": 1.090374756407028 }, { "x": 2.521431007385253, "y": 6.998851299285889, "heading": -2.9010585246753755, - "angularVelocity": -1.5245922055201655, - "velocityX": 3.0772606037922094, - "velocityY": 0.7816338708727879, + "angularVelocity": -1.4005703257570408, + "velocityX": 3.0711504673568135, + "velocityY": 0.8051416164258121, "moduleForcesX": [ - 114.74700757937691, - 114.82237403261927, - 112.7959826533612, - 112.85254185437864 + 114.82492813620281, + 114.88838435677178, + 110.01547367885281, + 109.50587966957572 ], "moduleForcesY": [ - 7.799925169065962, - 5.71704619443321, - 22.434461113364915, - 21.890043385783073 + 6.353046745851063, + 1.804812129477414, + 33.46666656638843, + 34.75647703160566 ], - "timestamp": 1.1343575514775248 + "timestamp": 1.1344803671849297 }, { - "x": 2.7542359720828538, - "y": 7.049557069939888, - "heading": -2.9616079641492825, - "angularVelocity": -0.9309010044100505, - "velocityX": 3.5791970553589567, - "velocityY": 0.7795621766496205, + "x": 2.7517129998548477, + "y": 7.053740973657355, + "heading": -2.9299259625172533, + "angularVelocity": -0.44310544982727984, + "velocityX": 3.534751037459037, + "velocityY": 0.8425380176261076, "moduleForcesX": [ - 112.55785468074943, - 105.9003453021406, - 110.9158025657128, - 108.95118327774631 + 112.165519313163, + 97.3293226757896, + 104.13823940579273, + 90.56768367714263 ], "moduleForcesY": [ - -23.892019604957188, - -44.548813535547104, - 30.50757452772647, - 36.124113744915036 + -25.633925874682376, + -60.862728439826846, + 48.85031849268756, + 70.25124390629986 ], - "timestamp": 1.1994014596772797 + "timestamp": 1.1996283762042956 }, { - "x": 2.991519490805528, - "y": 7.083413324629865, - "heading": -2.909884331471312, - "angularVelocity": 0.7952110214398992, - "velocityX": 3.64805137467998, - "velocityY": 0.5205138440636553, + "x": 2.9893225118438314, + "y": 7.084433906415846, + "heading": -2.911583132722001, + "angularVelocity": 0.28155626044994303, + "velocityX": 3.647225994555773, + "velocityY": 0.47112618206602574, "moduleForcesX": [ - 64.05615636732261, - -9.943360980696, - 108.07396127616549, - -102.05846309668742 + 50.32031969204731, + 2.9715371277548317, + 70.95695667054349, + -26.18494851299261 ], "moduleForcesY": [ - -93.25868171164622, - -112.65864909231036, - 15.439504342633711, - -35.740867487525705 + -89.36908292050751, + -102.27224679452215, + -51.59319249987694, + -80.58938519969574 ], - "timestamp": 1.2644453678770347 + "timestamp": 1.2647763852236615 }, { - "x": 3.195322835474054, - "y": 7.110151219170366, - "heading": -2.8543773726780923, - "angularVelocity": 0.853376747023774, - "velocityX": 3.1333194807825833, - "velocityY": 0.4110745384239114, + "x": 3.1939494569939986, + "y": 7.110014029553321, + "heading": -2.8635537159447884, + "angularVelocity": 0.7372353737308496, + "velocityX": 3.140954700385925, + "velocityY": 0.3926462761105286, "moduleForcesX": [ - -111.67573063214597, - -111.64039245061323, - -113.12917537886882, - -113.05374138509698 + -105.50415195458451, + -107.29038544493396, + -113.70906001277702, + -114.90061482209744 ], "moduleForcesY": [ - -27.135696145803198, - -27.380417914842752, - -20.25362840349164, - -20.80013262963885 + -44.920279415393765, + -41.12412783239419, + 15.269282404331058, + 2.3506230724880606 ], - "timestamp": 1.3294892760767896 + "timestamp": 1.3299243942430274 }, { - "x": 3.365241247233326, - "y": 7.131608923168945, - "heading": -2.8041832186816547, - "angularVelocity": 0.771696464521897, - "velocityX": 2.6123647311818834, - "velocityY": 0.3298956749751184, + "x": 3.364445667071558, + "y": 7.131108704498771, + "heading": -2.8137277276796153, + "angularVelocity": 0.7648121410795733, + "velocityX": 2.6170594104707225, + "velocityY": 0.3237961568276881, "moduleForcesX": [ - -114.39486717948931, - -114.5610194383314, - -112.89574776865837, - -113.08162800775546 + -114.00926980580653, + -113.95000686208216, + -114.43257923429907, + -114.37824029202251 ], "moduleForcesY": [ - -13.756071322380523, - -12.147523599218845, - -23.00273023368437, - -21.98460196366896 + -16.39731013290224, + -16.845089796422634, + -13.13574167848894, + -13.650410305482065 ], - "timestamp": 1.3945331842765445 + "timestamp": 1.3950724032623933 }, { - "x": 3.5012046297910944, - "y": 7.148379691490802, - "heading": -2.7621717710255616, - "angularVelocity": 0.6458936558220414, - "velocityX": 2.0903323050671294, - "velocityY": 0.2578376482291464, + "x": 3.500788039986836, + "y": 7.147889974863427, + "heading": -2.769405830231833, + "angularVelocity": 0.6803262005229909, + "velocityX": 2.09280951125836, + "velocityY": 0.25758684904197354, "moduleForcesX": [ - -114.86715102435959, - -115.09723127896024, - -112.75876113770701, - -113.1512196778291 + -114.81105309086456, + -114.97790928984212, + -113.51984327567992, + -113.7704647676614 ], "moduleForcesY": [ - -10.065224665337308, - -6.694150425031611, - -24.086273621516757, - -22.080340952979487 + -10.56866698989057, + -8.413922151143787, + -20.14217381557191, + -18.60133702632721 ], - "timestamp": 1.4595770924762994 + "timestamp": 1.4602204122817593 }, { - "x": 3.603189035556874, - "y": 7.1607529171336655, - "heading": -2.729703667472547, - "angularVelocity": 0.49917208931084384, - "velocityX": 1.5679317031900575, - "velocityY": 0.19022881596942023, + "x": 3.603006546144034, + "y": 7.16043119839742, + "heading": -2.733913758650608, + "angularVelocity": 0.5447913468955666, + "velocityX": 1.5690196476582279, + "velocityY": 0.19250355801766228, "moduleForcesX": [ - -115.03722833246768, - -115.27036043262517, - -112.665644218642, - -113.22264635282365 + -115.0419243067659, + -115.25718411477271, + -112.93907410546888, + -113.43999532206205 ], "moduleForcesY": [ - -8.482092446228055, - -3.8979414954172227, - -24.715945351408653, - -21.94466991910266 + -8.366260966557782, + -4.184211702175365, + -23.417109666661702, + -20.7767741687879 ], - "timestamp": 1.5246210006760543 + "timestamp": 1.5253684213011252 }, { - "x": 3.671183447453962, - "y": 7.168899399845526, - "heading": -2.7075665515768197, - "angularVelocity": 0.3403411096968915, - "velocityX": 1.0453617222426475, - "velocityY": 0.12524589830676436, + "x": 3.671130056542355, + "y": 7.168770766708615, + "heading": -2.709133399652067, + "angularVelocity": 0.3803701658967712, + "velocityX": 1.04567294417345, + "velocityY": 0.12800956524573953, "moduleForcesX": [ - -115.1220732972316, - -115.34180830581067, - -112.60054698627378, - -113.27936411804733 + -115.14281844208664, + -115.34930465283051, + -112.55115361335105, + -113.24852185391627 ], "moduleForcesY": [ - -7.623094959817519, - -2.2058871322717164, - -25.12574554620353, - -21.792793628817755 + -7.285612760344089, + -1.6624491289950194, + -25.340251738278866, + -21.942249710998937 ], - "timestamp": 1.5896649088758092 + "timestamp": 1.590516430320491 }, { - "x": 3.70518211364746, + "x": 3.7051821136474588, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 0.17334260390221154, - "velocityX": 0.5227033112629946, - "velocityY": 0.062000397052170114, + "angularVelocity": 0.19711620790671266, + "velocityX": 0.5226876096087982, + "velocityY": 0.06387580117578412, "moduleForcesX": [ - -115.17526382073036, - -115.37550458711, - -112.55684919025829, - -113.31339825214359 + -115.20102163601169, + -115.37974072229976, + -112.28107877840189, + -113.11488966367791 ], "moduleForcesY": [ - -7.042007188765662, - -1.080500824591024, - -25.396097743199658, - -21.71168485805974 + -6.608776467019436, + -0.004287565573965457, + -26.587848089395084, + -22.715577580127167 ], - "timestamp": 1.6547088170755642 + "timestamp": 1.655664439339857 }, { "x": 3.70518211364746, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 3.993262685913717e-22, - "velocityX": -8.259434242676659e-22, - "velocityY": -8.025539423896893e-21, + "angularVelocity": 4.3308234278847845e-20, + "velocityX": 8.056096608901281e-20, + "velocityY": -2.6738378957205373e-19, "moduleForcesX": [ - -115.2157166646866, - -115.39271629885711, - -112.5314849425636, - -113.32030793770696 + -115.24383423254851, + -115.38688887330075, + -112.09250755639515, + -112.9939218228949 ], "moduleForcesY": [ - -6.549472740050475, - -0.2866941492311489, - -25.56167956840566, - -21.745134141493214 + -6.0471361581514245, + 1.155635277233433, + -27.42405623065836, + -23.37602173859363 ], - "timestamp": 1.719752725275319 + "timestamp": 1.7208124483592229 }, { - "x": 3.7327722712749694, - "y": 7.174709038499013, - "heading": -2.7134141974114816, - "angularVelocity": -0.2913880585511265, - "velocityX": 0.46952431836436115, - "velocityY": 0.03023880186314412, + "x": 3.733781754166325, + "y": 7.174820039076195, + "heading": -2.7170402757017182, + "angularVelocity": -0.3458966849026198, + "velocityX": 0.47678005649515276, + "velocityY": 0.03147273207971763, "moduleForcesX": [ - 113.03432284252689, - 111.63376359219197, - 113.87965459197578, - 115.30641606592077 + 112.32377906856806, + 110.78430493237788, + 113.12589486821226, + 115.23706895839639 ], "moduleForcesY": [ - 23.049027164974643, - 29.185604964347963, - -18.522278194463343, - -4.4827583754706755 + 26.289960305975715, + 32.271465274484434, + -22.685214004024196, + -6.074152668020877 ], - "timestamp": 1.7785146605966304 + "timestamp": 1.7807974249312368 }, { - "x": 3.78798662671582, - "y": 7.178230603874502, - "heading": -2.746994385755768, - "angularVelocity": -0.5714615790080665, - "velocityX": 0.9396279264618796, - "velocityY": 0.0599293633920152, + "x": 3.7910470948922277, + "y": 7.178545444277794, + "heading": -2.7574326569967935, + "angularVelocity": -0.6733749615886386, + "velocityX": 0.9546613835408172, + "velocityY": 0.06210563735280476, "moduleForcesX": [ - 113.08025540759344, - 111.9745660585701, - 114.07142344583939, - 115.2878683815402 + 112.46001862879739, + 111.34041034625368, + 113.49633756841048, + 115.21709287532448 ], "moduleForcesY": [ - 22.75020026715537, - 27.798664214369406, - -17.204952975290553, - -4.644259008501021 + 25.636303420097065, + 30.249349366921713, + -20.667196776630867, + -6.2116432185372705 ], - "timestamp": 1.8372765959179418 + "timestamp": 1.8407824015032508 }, { - "x": 3.8708665679135543, - "y": 7.183456533131369, - "heading": -2.7961591284850487, - "angularVelocity": -0.8366767101942216, - "velocityX": 1.4104358671058923, - "velocityY": 0.088933920033307, + "x": 3.8770597022586974, + "y": 7.184048443151815, + "heading": -2.8159476506282473, + "angularVelocity": -0.97549414829236, + "velocityX": 1.4339024916215242, + "velocityY": 0.09173961862625027, "moduleForcesX": [ - 113.13856392421164, - 112.39241209224183, - 114.30163807419474, - 115.26232496995145 + 112.65201576445827, + 112.01287501883925, + 113.94247486613867, + 115.19409328267592 ], "moduleForcesY": [ - 22.361639151859006, - 25.984522474314716, - -15.454500356764035, - -4.855118557125547 + 24.690234496665077, + 27.58289113859666, + -17.909106058656565, + -6.303104707024021 ], - "timestamp": 1.8960385312392531 + "timestamp": 1.9007673780752647 }, { - "x": 3.981466671816221, - "y": 7.1903382613240066, - "heading": -2.859580630572741, - "angularVelocity": -1.0792956654831463, - "velocityX": 1.8821725883925222, - "velocityY": 0.11711200720343934, + "x": 3.991926797311324, + "y": 7.191263389762513, + "heading": -2.8901833767362453, + "angularVelocity": -1.2375719780247907, + "velocityX": 1.914931064692922, + "velocityY": 0.12027922695006076, "moduleForcesX": [ - 113.27691583678147, - 112.89842492883132, - 114.5802390264178, - 115.23714227829124 + 113.02354769728046, + 112.81041180905633, + 114.47046500698897, + 115.18961505698348 ], "moduleForcesY": [ - 21.51009445696987, - 23.572724562516772, - -12.981065814635985, - -4.864096919796839 + 22.79359621013854, + 23.989273941713172, + -13.892228757886805, + -5.866006661430295 ], - "timestamp": 1.9548004665605645 + "timestamp": 1.9607523546472787 }, { - "x": 4.119861588330392, - "y": 7.198818881382969, - "heading": -2.935024943967934, - "angularVelocity": -1.2838976964026465, - "velocityX": 2.3551796883037346, - "velocityY": 0.14432166014599293, + "x": 4.135787380780922, + "y": 7.200124822376675, + "heading": -2.975989704811233, + "angularVelocity": -1.4304636423750967, + "velocityX": 2.3982768968308075, + "velocityY": 0.14772753313528372, "moduleForcesX": [ - 113.59238050873091, - 113.50883091034551, - 114.89486558850359, - 115.2246253766407 + 113.71654311369024, + 113.7421275367746, + 115.0022414818884, + 115.22737898976276 ], "moduleForcesY": [ - 19.545611913909962, - 20.215865610819638, - -9.292159419632293, - -4.1677749943057485 + 18.78236752442223, + 18.819926926426316, + -7.74740103881101, + -3.863631013963341 ], - "timestamp": 2.013562401881876 + "timestamp": 2.0207373312192924 }, { - "x": 4.2861478472017795, - "y": 7.20882879407445, - "heading": -3.0183525114528353, - "angularVelocity": -1.4180534903975592, - "velocityX": 2.829829513989471, - "velocityY": 0.1703468859006533, + "x": 4.308777368553381, + "y": 7.210562916135439, + "heading": -3.0653657545339787, + "angularVelocity": -1.4899739039732145, + "velocityX": 2.8838885610762834, + "velocityY": 0.17401180020855808, "moduleForcesX": [ - 114.20109143791724, - 114.24355796594509, - 115.14763181288494, - 115.21632171398483 + 114.74211551098469, + 114.76126852409652, + 115.16168855405087, + 115.1687730331768 ], "moduleForcesY": [ - 15.09888258206903, - 15.001571052472123, - -3.4085278625123507, - -1.5352801286814852 + 10.07031433544062, + 10.008825147658575, + 2.247411863424039, + 2.562462854663516 ], - "timestamp": 2.0723243372031876 + "timestamp": 2.0807223077913064 }, { - "x": 4.480372914613033, - "y": 7.22024637414857, - "heading": -3.100297234740481, - "angularVelocity": -1.394520497658391, - "velocityX": 3.305287110596799, - "velocityY": 0.19430231512437993, + "x": 4.510499605188572, + "y": 7.222385830186037, + "heading": -3.1376440847719658, + "angularVelocity": -1.2049405429243567, + "velocityX": 3.36287931017223, + "velocityY": 0.19709791894983528, "moduleForcesX": [ - 114.97889469256124, - 114.97100473665363, - 114.82552416001533, - 114.8139912747789 + 114.49070976762584, + 114.0438403664486, + 113.11098060490103, + 111.91885906316108 ], "moduleForcesY": [ - 4.253087696650956, - 4.242749140548247, - 7.3045456282466565, - 7.355545167868178 + -11.072443207695146, + -14.076136858622377, + 20.922368283411416, + 26.086845583350566 ], - "timestamp": 2.1310862725244992 + "timestamp": 2.1407072843633204 }, { - "x": 4.7002342564486375, - "y": 7.23241969553516, - "heading": -3.140917676775582, - "angularVelocity": -0.6912713445019829, - "velocityX": 3.741560597577289, - "velocityY": 0.2071633842559193, + "x": 4.735395377959576, + "y": 7.235252445190618, + "heading": -3.1407920089832335, + "angularVelocity": -0.05247854364815179, + "velocityX": 3.7492016438651055, + "velocityY": 0.21449729148653832, "moduleForcesX": [ - 110.70709433093435, - 102.78978326842808, - 109.17877166162005, - 99.03740787130127 + 107.40451669387667, + 81.544981345394, + 104.09396678970627, + 72.77164512682684 ], "moduleForcesY": [ - -29.86588290077606, - -49.60370655750762, - 35.07856026223783, - 56.82286597574377 + -39.74553876688157, + -79.06583770683346, + 47.816771425137595, + 87.47036330162247 ], - "timestamp": 2.189848207845811 + "timestamp": 2.2006922609353343 }, { - "x": 4.933038375930493, - "y": 7.246562519511795, - "heading": -3.141057152136353, - "angularVelocity": -0.0023735664934791357, - "velocityX": 3.961818449458451, - "velocityY": 0.24068002354419252, + "x": 4.961162162053674, + "y": 7.248936972477581, + "heading": -3.140952349422652, + "angularVelocity": -0.002673009953180685, + "velocityX": 3.763722135042569, + "velocityY": 0.22813257700507475, "moduleForcesX": [ - 71.1304777106223, - 38.90533896850497, - 67.80168692280806, - 35.069342324157596 + 4.979358092075404, + 1.9050731077303618, + 4.966710791426737, + 1.8985551228853454 ], "moduleForcesY": [ - -20.881665076720296, - -29.24497694444195, - 35.52488241556476, - 46.99979625202289 + 1.1666845104073047, + 1.1660681916904998, + 5.286171901696504, + 5.292556395923459 ], - "timestamp": 2.2486101431671224 + "timestamp": 2.2606772375073483 }, { - "x": 5.165833894257274, - "y": 7.260879607361727, - "heading": -3.141191038423599, - "angularVelocity": -0.002278452649894059, - "velocityX": 3.961672076555177, - "velocityY": 0.2436456146593047, + "x": 5.186925676572244, + "y": 7.2626767601083335, + "heading": -3.1411124388880545, + "angularVelocity": -0.0026688260052964005, + "velocityX": 3.7636676284691513, + "velocityY": 0.22905381340371825, "moduleForcesX": [ - -0.03237574463563704, - -0.03836473213153268, - -0.03237915031178789, - -0.03836814690497055 + -0.012772921443373914, + -0.013031053606581546, + -0.012775534951914544, + -0.013033680355220673 ], "moduleForcesY": [ - 0.7126371600805075, - 0.7126345337878686, - 0.7206734674426194, - 0.7206706947523183 + 0.21791141098205738, + 0.21790945334762246, + 0.21825770061312894, + 0.21825566239436 ], - "timestamp": 2.307372078488434 + "timestamp": 2.3206622140793622 }, { - "x": 5.398628438089113, - "y": 7.275212536833178, - "heading": -3.1413249213362655, - "angularVelocity": -0.002278395221917291, - "velocityX": 3.9616554927763006, - "velocityY": 0.243915204512543, + "x": 5.4126888786666845, + "y": 7.276421682496977, + "heading": -3.1412725251050655, + "angularVelocity": -0.0026687718518768853, + "velocityX": 3.763662420096203, + "velocityY": 0.22913941413551372, "moduleForcesX": [ - -0.004005764410808973, - -0.004009381578984551, - -0.0040057696957758555, - -0.004009387088534907 + -0.0012312846193631112, + -0.0012346248118715398, + -0.001231322018659915, + -0.0012346644220080894 ], "moduleForcesY": [ - 0.06514567997750087, - 0.06514567586816115, - 0.06515053178948277, - 0.06515052646691723 + 0.020261967908326156, + 0.02026193639375224, + 0.02026644973999854, + 0.020266417423147567 ], - "timestamp": 2.3661340138097455 + "timestamp": 2.380647190651376 }, { - "x": 5.6314216777838535, - "y": 7.289566634568185, - "heading": -3.1414588009131665, - "angularVelocity": -0.002278338454468591, - "velocityX": 3.961633299206749, - "velocityY": 0.24427544219772612, + "x": 5.638451088737877, + "y": 7.290182893091729, + "heading": -3.141432606704436, + "angularVelocity": -0.002668694871926455, + "velocityX": 3.7636458822345045, + "velocityY": 0.22941095222787258, "moduleForcesX": [ - -0.005361429921287933, - -0.005365004147554494, - -0.005361430429341668, - -0.005365004730915963 + -0.003912617108109038, + -0.0039173635544157495, + -0.003912626035611627, + -0.003917372464927626 ], "moduleForcesY": [ - 0.0870513309884429, - 0.08705133042541374, - 0.08705612743999552, - 0.08705612689603413 + 0.06427781349805815, + 0.06427780505250308, + 0.06428418449503422, + 0.06428417983138202 ], - "timestamp": 2.424895949131057 + "timestamp": 2.44063216722339 }, { "x": 5.864199676513671, "y": 7.304165840148926, "heading": -3.141592653589793, - "angularVelocity": -0.0022778806704472536, - "velocityX": 3.9613739312189615, - "velocityY": 0.24844664323787555, + "angularVelocity": -0.0026681161601349807, + "velocityX": 3.763418787115392, + "velocityY": 0.2331074855119802, "moduleForcesX": [ - -0.0626635111672248, - -0.06269233899543689, - -0.06266351034663582, - -0.06269233826749006 + -0.053742159378724355, + -0.053777950646836034, + -0.05374214026769295, + -0.05377793434801155 ], "moduleForcesY": [ - 1.0079779361307997, - 1.0079779356543, - 1.0080166124998338, - 1.0080166121174567 + 0.8750534628320942, + 0.8750534536432211, + 0.8751012884750247, + 0.8751012823498336 ], - "timestamp": 2.4836578844523687 + "timestamp": 2.500617143795404 }, { - "x": 6.164003219259558, - "y": 7.329310693479935, - "heading": -3.1415926556850056, - "angularVelocity": -2.7648509089600506e-8, - "velocityX": 3.9562193564264954, - "velocityY": 0.33181247476772124, + "x": 6.152377573428224, + "y": 7.328344294067127, + "heading": -3.141592655915241, + "angularVelocity": -3.0327874962943025e-8, + "velocityX": 3.7583392584954223, + "velocityY": 0.3153289462634965, "moduleForcesX": [ - -0.9091406227520445, - -1.0229926855250666, - -0.9088211451962499, - -1.0226331700097273 + -0.8750670830636976, + -1.006710259521497, + -0.874725300925445, + -1.0063138780766954 ], "moduleForcesY": [ - 15.548099923086893, - 15.54784783460909, - 15.69538936246291, - 15.695135166722325 + 15.141847578839295, + 15.141564196521003, + 15.312470356020455, + 15.312185150395404 ], - "timestamp": 2.5594381978616556 + "timestamp": 2.5772940686534116 }, { - "x": 6.463785472279943, - "y": 7.354701655214318, - "heading": -3.141592655684723, - "angularVelocity": 3.725575931858838e-12, - "velocityX": 3.9559384163703637, - "velocityY": 0.33506013095045345, + "x": 6.440536481547124, + "y": 7.3527474199811484, + "heading": -3.141592655914663, + "angularVelocity": 7.537086047151853e-12, + "velocityX": 3.7580916116878904, + "velocityY": 0.31825905850049313, "moduleForcesX": [ - -0.05264365410489091, - -0.052645003824236244, - -0.052643654069719104, - -0.05264500378601198 + -0.04586225728278299, + -0.04586372569531469, + -0.045862256081547766, + -0.04586372442292428 ], "moduleForcesY": [ - 0.6085655004799432, - 0.6085655004355581, - 0.6085673124948521, - 0.6085673123929743 + 0.542641633938682, + 0.5426416315110623, + 0.5426435952886004, + 0.5426435918287228 ], - "timestamp": 2.6352185112709425 + "timestamp": 2.653970993511419 }, { - "x": 6.7425936724152855, - "y": 7.378325085957683, - "heading": -3.141592655097165, - "angularVelocity": 7.753434822309273e-9, - "velocityX": 3.679163988534982, - "velocityY": 0.3117357223871029, + "x": 6.725982194416825, + "y": 7.376928795577381, + "heading": -3.1415926555365488, + "angularVelocity": 4.93126951023964e-9, + "velocityX": 3.7227068430078205, + "velocityY": 0.3153670500089981, "moduleForcesX": [ - -51.86374695379346, - -51.86374723989954, - -51.86374697013155, - -51.863747256237815 + -6.553087891990707, + -6.553088107734506, + -6.5530878943522115, + -6.553088110092406 ], "moduleForcesY": [ - -4.370675853259815, - -4.370675841289294, - -4.370675276765135, - -4.370675264792112 + -0.5355861508230734, + -0.5355861518431866, + -0.5355858160266412, + -0.5355858164480798 ], - "timestamp": 2.7109988246802295 + "timestamp": 2.7306479183694266 }, { - "x": 6.975022477587425, - "y": 7.398018834411509, - "heading": -3.141592654598946, - "angularVelocity": 6.574519885644753e-9, - "velocityX": 3.067139666166316, - "velocityY": 0.2598794801423144, + "x": 6.963947201115416, + "y": 7.397087900656233, + "heading": -3.141592654989632, + "angularVelocity": 7.132742196975805e-9, + "velocityX": 3.1034761388678844, + "velocityY": 0.26290967088448347, "moduleForcesX": [ - -114.68499791407866, - -114.6849979131527, - -114.68499790399139, - -114.68499790306542 + -114.67853113597924, + -114.67853113769716, + -114.6785311545907, + -114.6785311563086 ], "moduleForcesY": [ - -9.717151389543751, - -9.71715139706053, - -9.717151508985076, - -9.717151516501852 + -9.714852991136091, + -9.714852977267336, + -9.714852770709518, + -9.714852756840765 ], - "timestamp": 2.7867791380895164 + "timestamp": 2.807324843227434 }, { - "x": 7.160997000105905, - "y": 7.413776516620945, - "heading": -3.1415926541970722, - "angularVelocity": 5.303144992506214e-9, - "velocityX": 2.4541271228853043, - "velocityY": 0.20793899497787205, + "x": 7.15435156281383, + "y": 7.413217936567628, + "heading": -3.1415926544715154, + "angularVelocity": 6.757134963127845e-9, + "velocityX": 2.483202893843366, + "velocityY": 0.21036362557919908, "moduleForcesX": [ - -114.8701770145637, - -114.87017701371919, - -114.87017700365773, - -114.87017700281322 + -114.8716046768432, + -114.87160467659702, + -114.87160467365942, + -114.87160467341322 ], "moduleForcesY": [ - -9.732937356902879, - -9.732937365029716, - -9.732937485826572, - -9.732937493953408 + -9.731273401774802, + -9.731273404147279, + -9.731273439418121, + -9.731273441790599 ], - "timestamp": 2.8625594514988033 + "timestamp": 2.8840017680854415 }, { - "x": 7.30049225587439, - "y": 7.425596002759894, - "heading": -3.141592653894118, - "angularVelocity": 3.997796008011645e-9, - "velocityX": 1.8407848884851754, - "velocityY": 0.1559704045444309, + "x": 7.297169459079101, + "y": 7.425316707330115, + "heading": -3.141592654046443, + "angularVelocity": 5.543681464619214e-9, + "velocityX": 1.862592905619844, + "velocityY": 0.1577889408696524, "moduleForcesX": [ - -114.93195662692112, - -114.93195662610682, - -114.93195661571428, - -114.9319566149 + -114.93396789225454, + -114.93396789150813, + -114.9339678819601, + -114.9339678812137 ], "moduleForcesY": [ - -9.738203898547772, - -9.73820390689881, - -9.73820403095595, - -9.738204039306991 + -9.736577236261422, + -9.736577243932565, + -9.736577357910134, + -9.736577365581278 ], - "timestamp": 2.9383397649080902 + "timestamp": 2.960678692943449 }, { - "x": 7.393495753669216, - "y": 7.433476227985266, - "heading": -3.141592653691419, - "angularVelocity": 2.674823132984758e-9, - "velocityX": 1.2272778194056353, - "velocityY": 0.1039877623995868, + "x": 7.392388138056945, + "y": 7.433383128421548, + "heading": -3.141592653746211, + "angularVelocity": 3.915539345006351e-9, + "velocityX": 1.241816611114391, + "velocityY": 0.10520011211157265, "moduleForcesX": [ - -114.96284439431135, - -114.96284439351281, - -114.96284438294842, - -114.9628443821499 + -114.96476701310675, + -114.9647670121377, + -114.96476699928847, + -114.96476699831943 ], "moduleForcesY": [ - -9.740836996359766, - -9.740837004827121, - -9.740837130575558, - -9.740837139042911 + -9.739196623522735, + -9.739196633819752, + -9.739196786768158, + -9.739196797065174 ], - "timestamp": 3.014120078317377 + "timestamp": 3.0373556178014565 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": 1.3410596335989075e-9, - "velocityX": 0.6136718659319506, - "velocityY": 0.05199669062818514, + "angularVelocity": 2.0399643560339176e-9, + "velocityX": 0.6209412027311269, + "velocityY": 0.052602853899473424, "moduleForcesX": [ - -114.98137397908026, - -114.98137397829139, - -114.98137396762175, - -114.98137396683289 + -114.98312242497134, + -114.98312242387729, + -114.98312240904909, + -114.98312240795504 ], "moduleForcesY": [ - -9.742416592641025, - -9.742416601179595, - -9.742416727963565, - -9.742416736502134 + -9.740757704436696, + -9.740757716301538, + -9.740757892507524, + -9.740757904372366 ], - "timestamp": 3.089900391726664 + "timestamp": 3.114032542659464 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": -1.6449381377649227e-22, - "velocityX": 2.757023269600915e-22, - "velocityY": -1.2947040629614231e-21, + "angularVelocity": -8.844072307683423e-21, + "velocityX": 1.496452517068171e-20, + "velocityY": -4.199921037541719e-20, + "moduleForcesX": [ + -114.99530722068296, + -114.99530721950912, + -114.99530720336229, + -114.99530720218844 + ], + "moduleForcesY": [ + -9.741793989902682, + -9.74179400280959, + -9.741794194469444, + -9.74179420737635 + ], + "timestamp": 3.1907094675174714 + }, + { + "x": 7.381270997615318, + "y": 7.427913275125405, + "heading": -3.130247025713249, + "angularVelocity": 0.13251789743624745, + "velocityX": -0.6859597370222545, + "velocityY": -0.11099909871012287, "moduleForcesX": [ - -114.99372507344016, - -114.99372507265782, - -114.99372506191705, - -114.9937250611347 + -112.6313588950428, + -113.00915752320313, + -114.67559733618697, + -114.77561717238224 ], "moduleForcesY": [ - -9.74346948925178, - -9.743469497838506, - -9.743469625322668, - -9.743469633909394 + -25.159294856402493, + -23.425636698784512, + -12.964745355934465, + -12.091339079978015 ], - "timestamp": 3.165680705135951 + "timestamp": 3.2763252831623153 }, { - "x": 7.375924265922195, - "y": 7.4270458645926025, - "heading": -3.1303148603474185, - "angularVelocity": 0.12612545266839068, - "velocityX": -0.7165924034905256, - "velocityY": -0.11598083104372059, + "x": 7.263819426067914, + "y": 7.4089059352509885, + "heading": -3.107637266054923, + "angularVelocity": 0.26408391356238425, + "velocityX": -1.3718443334654729, + "velocityY": -0.22200734445215997, "moduleForcesX": [ - -112.76737309465462, - -113.09738136430255, - -114.61964933108011, - -114.71860842032127 + -112.64778912905899, + -112.98106218312499, + -114.667110460898, + -114.74591804100633 ], "moduleForcesY": [ - -24.554623770706147, - -23.006176875829965, - -13.473735738920116, - -12.640293814526906 + -25.015409413102287, + -23.491323485597995, + -12.903529067142681, + -12.236822513481128 ], - "timestamp": 3.2550979718634414 + "timestamp": 3.361941098807159 }, { - "x": 7.247779988772691, - "y": 7.406304055209759, - "heading": -3.1078149681341087, - "angularVelocity": 0.2516280472079343, - "velocityX": -1.433104386203608, - "velocityY": -0.2319664885984147, + "x": 7.0876560923479435, + "y": 7.380393641960821, + "heading": -3.07389890037907, + "angularVelocity": 0.39406697724878387, + "velocityX": -2.0576027033456232, + "velocityY": -0.33302600781663494, "moduleForcesX": [ - -112.77796902785569, - -113.0694204236125, - -114.61288648897437, - -114.69165035279205 + -112.67062512533333, + -112.9386256400279, + -114.65047328808508, + -114.69841226670894 ], "moduleForcesY": [ - -24.437169993980408, - -23.075208455820334, - -13.40583223060576, - -12.75968547774606 + -24.794121720549438, + -23.578915171806123, + -12.823745620099007, + -12.457213413083549 ], - "timestamp": 3.3445152385909314 + "timestamp": 3.447556914452003 }, { - "x": 7.05557922298479, - "y": 7.375190745931852, - "heading": -3.0741851923253214, - "angularVelocity": 0.37609934903599834, - "velocityX": -2.1494815578925746, - "velocityY": -0.3479563893708391, + "x": 6.852802413616105, + "y": 7.342376469148145, + "heading": -3.0293262645324974, + "angularVelocity": 0.5206121732399505, + "velocityX": -2.743110918969357, + "velocityY": -0.44404380810177707, "moduleForcesX": [ - -112.79182810566901, - -113.02648757078286, - -114.59937186585587, - -114.64860236410797 + -112.69640034788526, + -112.87896079459627, + -114.6035247316006, + -114.61328861565241 ], "moduleForcesY": [ - -24.25759265755613, - -23.171552214300533, - -13.311740761370507, - -12.93970595608385 + -24.43715365857463, + -23.63189826179402, + -12.786890952496687, + -12.797480453077897 ], - "timestamp": 3.4339325053184213 + "timestamp": 3.533172730096847 }, { - "x": 6.799345859055017, - "y": 7.333706777922525, - "heading": -3.0296327580346913, - "angularVelocity": 0.49825314417638356, - "velocityX": -2.865591549679929, - "velocityY": -0.46393688297087876, + "x": 6.559322846846036, + "y": 7.294861028140364, + "heading": -2.974816276176582, + "angularVelocity": 0.6366812947509165, + "velocityX": -3.427866271665239, + "velocityY": -0.5549843875211936, "moduleForcesX": [ - -112.8024310121022, - -112.96263341798881, - -114.55963723401477, - -114.57186680035291 + -112.69725731706323, + -112.77901668126033, + -114.4213577102299, + -114.39506493358313 ], "moduleForcesY": [ - -23.97488109311961, - -23.255558651397703, - -13.233026976268091, - -13.211149123897187 + -23.701389141835676, + -23.40728121770181, + -13.046932352219999, + -13.446589360294276 ], - "timestamp": 3.5233497720459113 + "timestamp": 3.618788545741691 }, { - "x": 6.479151323028066, - "y": 7.281860220949749, - "heading": -2.9747972228158814, - "angularVelocity": 0.6132544331278652, - "velocityX": -3.5809027467008328, - "velocityY": -0.5798271281405277, + "x": 6.2405606027600165, + "y": 7.243222544857862, + "heading": -2.974789031988597, + "angularVelocity": 0.0003182144301258398, + "velocityX": -3.723170090539417, + "velocityY": -0.6031418715522296, "moduleForcesX": [ - -112.76864885600135, - -112.84129933826836, - -114.40191731519991, - -114.37728230406522 + -62.564521843593084, + -42.22319342938616, + -56.384078555955455, + -34.743970358822985 ], "moduleForcesY": [ - -23.425697611861317, - -23.163205809397667, - -13.333070778392436, - -13.69531288022576 + 8.771658729738927, + 16.21706404812779, + -28.32236622881111, + -28.615859678644675 ], - "timestamp": 3.612767038773401 + "timestamp": 3.7044043613865347 }, { - "x": 6.128706156657079, - "y": 7.2250876773172195, - "heading": -2.9747714114603663, - "angularVelocity": 0.00028866187101872986, - "velocityX": -3.919211346942776, - "velocityY": -0.6349170099948519, + "x": 5.921798032074226, + "y": 7.191583190738455, + "heading": -2.9747625298055844, + "angularVelocity": 0.0003095477490101981, + "velocityX": -3.7231739052524984, + "velocityY": -0.6031520430012703, "moduleForcesX": [ - -65.77795724959567, - -48.091726144075956, - -59.97030443873823, - -41.064737834052906 + -0.0008590684242739062, + -0.0004897050181045133, + -0.0007757061877252102, + -0.0004063458477452992 ], "moduleForcesY": [ - 7.145486045497711, - 13.930551075127115, - -27.77321467031953, - -28.29772337341099 + -0.0014702823398333354, + -0.0014081667097866634, + -0.0019659052879860126, + -0.0019037710991057725 ], - "timestamp": 3.702184305500891 + "timestamp": 3.7900201770313786 }, { - "x": 5.778260590548221, - "y": 7.168314324053237, - "heading": -2.974746339793478, - "angularVelocity": 0.0002803895467417059, - "velocityX": -3.9192158174201577, - "velocityY": -0.6349260645262749, + "x": 5.603035464764593, + "y": 7.139943815739949, + "heading": -2.9747360276337456, + "angularVelocity": 0.0003095476185021631, + "velocityX": -3.7231738658186826, + "velocityY": -0.6031522868709134, "moduleForcesX": [ - -0.0009168544850962377, - -0.0005793240119023563, - -0.0008405728976593655, - -0.0005030425527797756 + 0.0000065373917647243475, + 0.000006542648884482532, + 0.000006538254086855334, + 0.000006543595363337553 ], "moduleForcesY": [ - -0.0012398789774556854, - -0.0011830360654513062, - -0.00169283207105781, - -0.0016359884024284832 + -0.00004044463387706378, + -0.00004044379523524599, + -0.00004045215395335704, + -0.00004045179629948636 ], - "timestamp": 3.791601572228381 + "timestamp": 3.8756359926762225 }, { - "x": 5.427815027732516, - "y": 7.111540950421515, - "heading": -2.9747212681368067, - "angularVelocity": 0.00028038943247385174, - "velocityX": -3.9192157805911356, - "velocityY": -0.6349262923093685, + "x": 5.284272897910396, + "y": 7.088304437930092, + "heading": -2.974709525465553, + "angularVelocity": 0.0003095475759100391, + "velocityX": -3.723173860499151, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - 0.000005845897111063432, - 0.000005850554610347957, - 0.000005846946551636274, - 0.000005851605108021885 + 8.811818431713226e-7, + 8.829967624981082e-7, + 8.815928068387048e-7, + 8.834077261655809e-7 ], "moduleForcesY": [ - -0.00003617108564124459, - -0.000036170301512162975, - -0.00003617734396736354, - -0.000036176565443598635 + -0.000005445232314593307, + -0.000005444926075258032, + -0.0000054476678799056675, + -0.000005447361640570373 ], - "timestamp": 3.881018838955871 + "timestamp": 3.9612518083210664 }, { - "x": 5.0773694777230824, - "y": 7.054767497780465, - "heading": -2.9746961964763616, - "angularVelocity": 0.00028038947468377387, - "velocityX": -3.9192156373718947, - "velocityY": -0.6349271759119333, + "x": 4.965510345085579, + "y": 7.036664973557431, + "heading": -2.974683023293425, + "angularVelocity": 0.0003095476218731829, + "velocityX": -3.723173696634823, + "velocityY": -0.6031533307686344, "moduleForcesX": [ - 0.000022745436999206383, - 0.00002274371824161806, - 0.000022745063338164777, - 0.000022743343413843666 + 0.000027179633968777115, + 0.000027178077676157867, + 0.00002717888025707332, + 0.00002717722449604533 ], "moduleForcesY": [ - -0.00014032435530920788, - -0.00014032463600418613, - -0.00014032204063925755, - -0.00014032231580040383 + -0.00016769506177041809, + -0.00016769583758608305, + -0.0001676924952224039, + -0.00016769279547100918 ], - "timestamp": 3.970436105683361 + "timestamp": 4.04686762396591 }, { - "x": 4.726924947134966, - "y": 6.997991026251115, - "heading": -2.974670388917575, - "angularVelocity": 0.0002886194102156865, - "velocityX": -3.9192042366508106, - "velocityY": -0.6349609377166889, + "x": 4.6467487843294215, + "y": 6.985022268597529, + "heading": -2.9746557832079867, + "angularVelocity": 0.00031816651203726035, + "velocityX": -3.723162109188588, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - 0.0020163880860393237, - 0.0016805912309524622, - 0.001940464776109846, - 0.001604668094445397 + 0.0021470284617356463, + 0.001779708578470208, + 0.0020640650999688786, + 0.001696749591254383 ], "moduleForcesY": [ - -0.0055586767601032185, - -0.0056152526560838715, - -0.005108050168336257, - -0.005164626809257234 + -0.006493363422829359, + -0.006555181388139426, + -0.0060004838430769165, + -0.006062320034445239 ], - "timestamp": 4.059853372410851 + "timestamp": 4.132483439610754 }, { - "x": 4.406739852490161, - "y": 6.946071670476197, - "heading": -2.9201805701462793, - "angularVelocity": 0.609388105513896, - "velocityX": -3.5807971587926986, - "velocityY": -0.5806412751705897, + "x": 4.35327994736575, + "y": 6.937424176402155, + "heading": -2.9205003335250557, + "angularVelocity": 0.6325402529315557, + "velocityX": -3.4277409466149935, + "velocityY": -0.5559497604136834, "moduleForcesX": [ - 66.16678250893183, - 48.98536673051217, - 59.2354585777396, - 40.57967406296072 + 63.0067589023219, + 43.25347247652169, + 55.56509439641217, + 34.16828867746466 ], "moduleForcesY": [ - -6.321049067077154, - -14.492266055813312, - 28.180912866909814, - 27.13803459703222 + -7.91265828309172, + -16.812254107815967, + 28.71804550358443, + 27.34861881904853 ], - "timestamp": 4.149270639138341 + "timestamp": 4.218099255255598 }, { - "x": 4.150515319264335, - "y": 6.904520503456371, - "heading": -2.875923572113572, - "angularVelocity": 0.49494912618595177, - "velocityX": -2.8654927913050745, - "velocityY": -0.46468840460599303, + "x": 4.118436291181741, + "y": 6.899331547752736, + "heading": -2.8762208718989513, + "angularVelocity": 0.5171878734390213, + "velocityX": -2.742993854759276, + "velocityY": -0.44492513868510164, "moduleForcesX": [ - 112.84469963183767, - 112.76947878161748, - 114.44010878513953, - 114.33052227126576 + 112.77868429037682, + 112.7033673063995, + 114.45941943627882, + 114.34574505410619 ], "moduleForcesY": [ - 23.05021971834789, - 23.504795933148507, - 13.013238741851021, - 14.088814392674271 + 23.303963933906324, + 23.762739676331677, + 12.722298748930815, + 13.86894657131769 ], - "timestamp": 4.238687905865831 + "timestamp": 4.3037150709004415 }, { - "x": 3.9583220436464823, - "y": 6.873351406790412, - "heading": -2.842507887558043, - "angularVelocity": 0.3737050547224577, - "velocityX": -2.1493977914085045, - "velocityY": -0.3485802888713979, + "x": 3.9422814599590574, + "y": 6.8707567698528536, + "heading": -2.8426922514156217, + "angularVelocity": 0.391617135581763, + "velocityX": -2.0575033934549967, + "velocityY": -0.3337558333663218, "moduleForcesX": [ - 112.95645164652021, - 112.81581362288203, - 114.63477612228742, - 114.4800037317309 + 112.86515330511082, + 112.7174908430355, + 114.6811022921368, + 114.51664915991034 ], "moduleForcesY": [ - 23.231980648685717, - 23.95223626895713, - 12.578015209156026, - 13.993453486124878 + 23.63834794762169, + 24.384475231601378, + 12.086104233396183, + 13.645010104290401 ], - "timestamp": 4.328105172593321 + "timestamp": 4.389330886545285 }, { - "x": 3.830183254358929, - "y": 6.85256977540764, - "heading": -2.8201340277644222, - "angularVelocity": 0.2502185608268224, - "velocityX": -1.4330430125768843, - "velocityY": -0.23241183882421498, + "x": 3.8248361212608604, + "y": 6.851704848123817, + "heading": -2.8202044428854083, + "angularVelocity": 0.26265951402598714, + "velocityX": -1.3717715332572546, + "velocityY": -0.22252806430143837, "moduleForcesX": [ - 113.00394710188138, - 112.82068889216025, - 114.70406075329403, - 114.52336848119276 + 112.90541799785672, + 112.70949942311833, + 114.75934724991006, + 114.56628411956218 ], "moduleForcesY": [ - 23.2434343413162, - 24.148746420326283, - 12.388975239916281, - 14.012855946804578 + 23.695274487547174, + 24.64547404232939, + 11.823839632394282, + 13.62813642328838 ], - "timestamp": 4.417522439320811 + "timestamp": 4.474946702190129 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 0.1255595686363405, - "velocityX": -0.7165595452629517, - "velocityY": -0.11621279716307126, + "angularVelocity": 0.1319570277388407, + "velocityX": -0.6859207314037196, + "velocityY": -0.1112703689791775, "moduleForcesX": [ - 113.02767779062647, - 112.82218278499239, - 114.73896316536627, - 114.54498863487578 + 112.925655713762, + 112.70422548752346, + 114.79867455728485, + 114.5909034417634 ], "moduleForcesY": [ - 23.249516784409284, - 24.250854636389032, - 12.290549417164629, - 14.022523907560238 + 23.723484974899822, + 24.780696781270088, + 11.687912648139877, + 13.620484396497119 ], - "timestamp": 4.506939706048301 + "timestamp": 4.560562517834973 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 6.39634760318955e-21, - "velocityX": -2.288259399396069e-20, - "velocityY": -2.4594644423852028e-20, + "angularVelocity": 1.048098737702012e-19, + "velocityX": -5.399569524753348e-19, + "velocityY": -9.802475742246663e-19, "moduleForcesX": [ - 113.0347603386625, - 112.82700125465155, - 114.75821199877026, - 114.5621659937604 + 112.92977017260735, + 112.70546235157893, + 114.82048834955188, + 114.6101322449539 ], "moduleForcesY": [ - 23.2880943793102, - 24.293809761632872, - 12.246633407284676, - 13.993645143555243 + 23.77874423290317, + 24.84159448258278, + 11.622750779734075, + 13.577897490720876 ], - "timestamp": 4.596356972775791 + "timestamp": 4.646178333479817 }, { - "x": 3.78600549650478, - "y": 6.841766146112416, - "heading": -2.8358265954492667, - "angularVelocity": -0.5268296966780072, - "velocityX": 0.3893532656410478, - "velocityY": -0.00806687956342702, + "x": 3.7866144129842945, + "y": 6.8417821274774475, + "heading": -2.8401706467737573, + "angularVelocity": -0.5981564744361981, + "velocityX": 0.392292949619254, + "velocityY": -0.0075806465777589985, "moduleForcesX": [ - 109.42063742828591, - 109.7288300984058, - 101.12162507107449, - 112.53880632418141 + 107.42080956929517, + 108.8413082444939, + 98.01523216314052, + 112.04459817860722 ], "moduleForcesY": [ - 36.38707466668986, - 35.669533302226604, - -55.51926033598735, - -25.504590588279555 + 41.904654146837636, + 38.29718260293834, + -60.83697376382957, + -27.603083990033998 ], - "timestamp": 4.647454625952016 + "timestamp": 4.698445279980309 }, { - "x": 3.825938343537949, - "y": 6.840779251207409, - "heading": -2.8882950545967137, - "angularVelocity": -1.026827180623991, - "velocityX": 0.7815006081678173, - "velocityY": -0.019313898851738894, + "x": 3.8278180486268427, + "y": 6.840743713694053, + "heading": -2.901006370545353, + "angularVelocity": -1.163942564944422, + "velocityX": 0.7883306449166008, + "velocityY": -0.019867504281804747, "moduleForcesX": [ - 110.09506612110931, - 110.81993188505729, - 102.6353312163985, - 112.36550007471496 + 108.49838326382826, + 110.25146907706204, + 99.86657679489441, + 111.77509833383628 ], "moduleForcesY": [ - 34.2533713879541, - 32.07800706429278, - -52.62999688238643, - -26.203707120752828 + 38.99254840535189, + 33.98129300971088, + -57.706808413427034, + -28.619699977125915 ], - "timestamp": 4.698552279128242 + "timestamp": 4.7507122264808 }, { - "x": 3.8860741349913512, - "y": 6.839035138240057, - "heading": -2.964541076190401, - "angularVelocity": -1.4921628852646063, - "velocityX": 1.176879713947022, - "velocityY": -0.03413293681682487, + "x": 3.889955785107897, + "y": 6.8387849883626, + "heading": -2.9890898968624993, + "angularVelocity": -1.6852625266011574, + "velocityX": 1.1888533890238777, + "velocityY": -0.0374754115663657, "moduleForcesX": [ - 110.82018043359403, - 112.01913727447982, - 104.5309227969057, - 112.13805673866038 + 109.70138251498284, + 111.79514898339698, + 102.32802663455422, + 111.44106852220102 ], "moduleForcesY": [ - 31.778806331042382, - 27.53721520438967, - -48.700214418067816, - -27.088832746748313 + 35.415890676664304, + 28.42375744706581, + -53.15724933762509, + -29.817683638360904 ], - "timestamp": 4.749649932304467 + "timestamp": 4.802979172981292 }, { - "x": 3.9666241731173164, - "y": 6.836347748309206, - "heading": -3.061856445753252, - "angularVelocity": -1.9044978294253445, - "velocityX": 1.5763940830739307, - "velocityY": -0.05259321639650871, + "x": 3.9733415003112857, + "y": 6.835624849307072, + "heading": -3.1005912250342016, + "angularVelocity": -2.1333048061388666, + "velocityX": 1.5953814176348051, + "velocityY": -0.0604615204663511, "moduleForcesX": [ - 111.82728548746546, - 113.23819484894514, - 107.03013912743913, - 112.00948759102612 + 111.36765197462086, + 113.3330629489433, + 105.79188446547697, + 111.29923323362245 ], "moduleForcesY": [ - 27.9535071577465, - 21.882075353027073, - -42.84285393246154, - -27.51340335883333 + 29.67677517374216, + 21.344964061000997, + -45.774893406210126, + -30.226858179680654 ], - "timestamp": 4.800747585480693 + "timestamp": 4.855246119481784 }, { - "x": 4.067857576516546, - "y": 6.832556869927305, - "heading": -3.175915491721135, - "angularVelocity": -2.232177778782037, - "velocityX": 1.9811752029020762, - "velocityY": -0.07418889413231283, + "x": 4.078379902808959, + "y": 6.831026292095147, + "heading": -3.229015108449569, + "angularVelocity": -2.45707645106375, + "velocityX": 2.0096525534871077, + "velocityY": -0.0879821286649223, "moduleForcesX": [ - 113.22575760455814, - 114.34728768901107, - 110.11846813519523, - 112.26817875434021 + 113.53832730848663, + 114.64478257919814, + 110.14647037122349, + 111.87702649396591 ], "moduleForcesY": [ - 21.45752343424573, - 14.794035336095424, - -33.98499618387022, - -26.27258468210002 + 19.599153766423715, + 12.088459054315411, + -33.795989909102516, + -27.799474462441705 ], - "timestamp": 4.851845238656918 + "timestamp": 4.907513065982275 }, { - "x": 4.190070365050169, - "y": 6.827548067939446, - "heading": -3.2998572362261696, - "angularVelocity": -2.425585849854656, - "velocityX": 2.3917495410628007, - "velocityY": -0.09802411023818243, + "x": 4.2054556679364925, + "y": 6.824790196070038, + "heading": -3.3632917229427637, + "angularVelocity": -2.5690541247120953, + "velocityX": 2.431283509671254, + "velocityY": -0.11931242291081591, "moduleForcesX": [ - 114.7457474192497, - 115.11333345954517, - 113.19559803887138, - 113.34482631497848 + 115.1489195315103, + 115.1727965430496, + 113.9941351274335, + 113.88899499156405 ], "moduleForcesY": [ - 10.194849320269086, - 5.448077962340892, - -21.339190325625143, - -20.799257564932734 + 1.0232280605874524, + -1.635500797450544, + -16.245965323391406, + -17.189766351140616 ], - "timestamp": 4.902942891833144 + "timestamp": 4.959780012482767 }, { - "x": 4.333402838200007, - "y": 6.821199257095827, - "heading": -3.422162582125266, - "angularVelocity": -2.3935609229897317, - "velocityX": 2.8050695920517015, - "velocityY": -0.12424857990491066, + "x": 4.354051044308127, + "y": 6.816459874974004, + "heading": -3.4803991855766943, + "angularVelocity": -2.240564457555005, + "velocityX": 2.8430085612566733, + "velocityY": -0.15938029010258697, "moduleForcesX": [ - 114.68412050490778, - 114.73378991745246, - 115.00391113761037, - 115.02985196430272 + 109.54277500123293, + 109.76726168084907, + 114.94525226928009, + 113.18437639744356 ], "moduleForcesY": [ - -10.050186347462116, - -9.331880356810323, - -5.31591098605362, - -4.453466685132969 + -35.138512118490674, + -33.87003877484381, + 5.393963684062317, + 20.071079184944495 ], - "timestamp": 4.954040545009369 + "timestamp": 5.012046958983259 }, { - "x": 4.496449804863985, - "y": 6.812872270792408, - "heading": -3.517273176899785, - "angularVelocity": -1.8613495701358547, - "velocityX": 3.190889532669179, - "velocityY": -0.16296220639921205, + "x": 4.52101074667456, + "y": 6.80513903332009, + "heading": -3.552003118857375, + "angularVelocity": -1.369965878531029, + "velocityX": 3.194364958069012, + "velocityY": -0.2165965760749598, "moduleForcesX": [ - 104.86344163188946, - 102.79608932766192, - 114.33175651351914, - 106.890923713185 + 96.13389774106393, + 78.1016913248519, + 113.46555797863142, + 94.13325434178371 ], "moduleForcesY": [ - -47.21609558159705, - -50.77985160422085, - 12.895732740628704, - 42.06566908876741 + -62.80652414189361, + -83.01049814576045, + 18.254472024247136, + 65.38310369002122 ], - "timestamp": 5.005138198185595 + "timestamp": 5.0643139054837505 }, { - "x": 4.6771281726390805, - "y": 6.802007556416455, - "heading": -3.5695575194646283, - "angularVelocity": -1.0232239509028986, - "velocityX": 3.5359425833505953, - "velocityY": -0.2126264847914251, + "x": 4.706342119523084, + "y": 6.791413745525305, + "heading": -3.5793791336242253, + "angularVelocity": -0.5237729884716399, + "velocityX": 3.5458618736562415, + "velocityY": -0.26259976359377335, "moduleForcesX": [ - 96.67728867515599, - 80.87009063485003, - 113.21907877847823, - 92.79877473998543 + 96.52600367181356, + 81.50657246245366, + 112.58926465292838, + 91.36526851275515 ], "moduleForcesY": [ - -61.82807121867156, - -79.97059189776539, - 19.430238076987123, - 67.16099978368732 + -60.91221738822322, + -77.0385216215409, + 20.114545224135323, + 67.84251293202189 ], - "timestamp": 5.05623585136182 + "timestamp": 5.116580851984242 }, { - "x": 4.875366934287349, - "y": 6.7891315300219, - "heading": -3.579804057853285, - "angularVelocity": -0.20052855173833614, - "velocityX": 3.879605996083274, - "velocityY": -0.25198860601577133, + "x": 4.903114088638074, + "y": 6.781657287742634, + "heading": -3.5797122193352346, + "angularVelocity": -0.006372779228765348, + "velocityX": 3.7647496609188598, + "velocityY": -0.18666592245959082, "moduleForcesX": [ - 97.03131746492353, - 82.80990999914111, - 112.19644097022719, - 89.98282568718108 + 70.97743787502137, + 39.57182354200292, + 76.9970632005936, + 50.328630779424536 ], "moduleForcesY": [ - -59.77588710656038, - -74.87714839288478, - 21.5263485084751, - 69.37126688318331 + -15.965745753786843, + 6.6647535433357925, + 33.49165128418184, + 58.32997535183497 ], - "timestamp": 5.107333504538046 + "timestamp": 5.168847798484734 }, { - "x": 5.077915979474368, - "y": 6.780072353267369, - "heading": -3.58010809138146, - "angularVelocity": -0.005950048764981118, - "velocityX": 3.9639598415305963, - "velocityY": -0.1772914447418665, + "x": 5.099931542658043, + "y": 6.772736369563246, + "heading": -3.5800300838454637, + "angularVelocity": -0.0060815588342526235, + "velocityX": 3.76561990316587, + "velocityY": -0.17067991870003177, "moduleForcesX": [ - 26.977283498941954, - 13.088021988666144, - 33.20236522268229, - 20.50110572882093 + 0.24002269616514235, + 0.22117703170230035, + 0.25167644223991104, + 0.23285423486863352 ], "moduleForcesY": [ - 8.723342744724212, - 15.885560108858511, - 25.74087269547646, - 32.68451149483199 + 4.326391928783615, + 4.334916585403937, + 4.351428081011753, + 4.359954585237189 ], - "timestamp": 5.158431157714271 + "timestamp": 5.2211147449852255 }, { - "x": 5.280471017904145, - "y": 6.771117377305431, - "heading": -3.580408705243314, - "angularVelocity": -0.005883124628397359, - "velocityX": 3.9640771315113867, - "velocityY": -0.17525219663325547, + "x": 5.296743731326859, + "y": 6.7637007017205635, + "heading": -3.5803480873484106, + "angularVelocity": -0.00608421811945572, + "velocityX": 3.765519163568818, + "velocityY": -0.17287537244202097, "moduleForcesX": [ - 0.0334118938803721, - 0.02901319412251914, - 0.03617632271370437, - 0.031779580558092844 + -0.02738786810423168, + -0.027246197183243195, + -0.02749366052226753, + -0.027350411162396112 ], "moduleForcesY": [ - 0.5627467701499977, - 0.564801110950385, - 0.5686255765232819, - 0.5706799263117553 + -0.5963054368442775, + -0.5963956352307891, + -0.5965517839514543, + -0.5966429834962301 ], - "timestamp": 5.209528810890497 + "timestamp": 5.273381691485717 }, { - "x": 5.482843801346731, - "y": 6.758726217540709, - "heading": -3.580715022162749, - "angularVelocity": -0.005994735577754661, - "velocityX": 3.960510333902072, - "velocityY": -0.2424995864680392, + "x": 5.493454369555724, + "y": 6.7526864720057285, + "heading": -3.580669800620504, + "angularVelocity": -0.006155195465466283, + "velocityX": 3.7635762446351886, + "velocityY": -0.2107303076283394, "moduleForcesX": [ - -0.9926378040047893, - -0.9850808010019008, - -0.9973672418757675, - -0.9898104285367338 + -0.5287852184727379, + -0.5239825347058187, + -0.5317492184247837, + -0.5269382194651111 ], "moduleForcesY": [ - -18.68176620232677, - -18.68515075606664, - -18.691363885724435, - -18.694748257197876 + -10.28066289440765, + -10.282769065093767, + -10.28654220890871, + -10.28864362116857 ], - "timestamp": 5.260626464066722 + "timestamp": 5.325648637986209 }, { - "x": 5.6837294618748615, - "y": 6.731334695007788, - "heading": -3.5810537179070154, - "angularVelocity": -0.00662840117330224, - "velocityX": 3.9314067876134344, - "velocityY": -0.5360622422022736, + "x": 5.688997682168798, + "y": 6.728677589687009, + "heading": -3.5810228607970975, + "angularVelocity": -0.0067549417027819286, + "velocityX": 3.741242328193694, + "velocityY": -0.4593511564422302, "moduleForcesX": [ - -8.105065986269624, - -8.032996251394055, - -8.142908653909107, - -8.070890615781863 + -6.080411522594813, + -6.02353002387444, + -6.11207802550282, + -6.055226639620323 ], "moduleForcesY": [ - -81.5596902417295, - -81.57543466978598, - -81.58850238971299, - -81.60424655492301 + -67.52145044144014, + -67.53691218233755, + -67.55667901029105, + -67.57213537559683 ], - "timestamp": 5.311724117242948 + "timestamp": 5.377915584486701 }, { "x": 5.880957641601562, "y": 6.684422969818115, "heading": -3.5814353254496796, - "angularVelocity": -0.007468200963131239, - "velocityX": 3.859828533543356, - "velocityY": -0.9180798387723068, + "angularVelocity": -0.007891500847064156, + "velocityX": 3.6726836420596607, + "velocityY": -0.8467037550871748, "moduleForcesX": [ - -19.93563366954746, - -19.797209295771946, - -19.98631567124326, - -19.848112638467743 + -18.681818838527086, + -18.502266587342042, + -18.750414129600102, + -18.5712305730302 ], "moduleForcesY": [ - -106.14800306857413, - -106.17640495788532, - -106.1513286826346, - -106.17974187192411 + -105.21692402603168, + -105.25254288064605, + -105.22397106219577, + -105.25961417672018 ], - "timestamp": 5.362821770419173 + "timestamp": 5.430182530987192 }, { - "x": 5.995980176257607, - "y": 6.6497418165304945, - "heading": -3.579249576658118, - "angularVelocity": 0.07178828851457016, - "velocityX": 3.7777767213885776, - "velocityY": -1.1390607410336038, + "x": 5.995964950369022, + "y": 6.649793265437975, + "heading": -3.579262118741216, + "angularVelocity": 0.0678279216427609, + "velocityX": 3.589491370997937, + "velocityY": -1.0808271785951162, "moduleForcesX": [ - -29.960020675030847, - -49.61097001099723, - -23.69035732915975, - -49.81068398032844 + -29.33376530988018, + -47.53506576754961, + -23.5075658910571, + -47.10755646578757 ], "moduleForcesY": [ - -107.24025708495026, - -99.62262552981605, - -107.4372074994835, - -97.95156957525988 + -107.40841370415603, + -100.61864430852758, + -107.60905700250362, + -99.41984691304988 ], - "timestamp": 5.393268920459784 + "timestamp": 5.462222532447207 }, { - "x": 6.1082569266261295, - "y": 6.608629575449157, - "heading": -3.575149016065102, - "angularVelocity": 0.13467797766117506, - "velocityX": 3.6875947410107215, - "velocityY": -1.3502820798170554, + "x": 6.107956693664685, + "y": 6.608067008873313, + "heading": -3.5750708302871326, + "angularVelocity": 0.1308142404211006, + "velocityX": 3.4953726027567464, + "velocityY": -1.302317561270707, "moduleForcesX": [ - -35.09011732252264, - -50.4723868097775, - -31.778861111114438, - -50.897929213341364 + -35.10646123915215, + -49.75636775982228, + -31.99592734180901, + -49.99578261363511 ], "moduleForcesY": [ - -102.59136541098559, - -95.93088215086516, - -101.83371240771552, - -93.68871350341732 + -102.06974562300634, + -95.75188215467672, + -101.23810381235252, + -93.60026996744395 ], - "timestamp": 5.423716070500395 + "timestamp": 5.4942625339072215 }, { - "x": 6.217542082845669, - "y": 6.561748076363306, - "heading": -3.568627120879471, - "angularVelocity": 0.21420379828430375, - "velocityX": 3.5893394315649645, - "velocityY": -1.5397664156848434, + "x": 6.21661606136549, + "y": 6.560219585431066, + "heading": -3.56796945086452, + "angularVelocity": 0.22164104553723224, + "velocityX": 3.3913658785702108, + "velocityY": -1.4933652079240145, "moduleForcesX": [ - -37.80311413224733, - -54.54451585503094, - -34.88451901813677, - -56.068371436952425 + -37.865335431574195, + -55.05567925095188, + -34.8057574496384, + -56.6572177627318 ], "moduleForcesY": [ - -94.79851130258078, - -86.38037479041088, - -91.61886969958682, - -80.69537934854469 + -91.9696806578777, + -83.04388847970704, + -87.7072282477682, + -75.97006732056381 ], - "timestamp": 5.454163220541005 + "timestamp": 5.526302535367236 }, { - "x": 6.324576207665626, - "y": 6.510355295341809, - "heading": -3.5615466703297547, - "angularVelocity": 0.23254887699743812, - "velocityX": 3.515407014357414, - "velocityY": -1.6879340415424884, + "x": 6.3234543638897875, + "y": 6.508277508435261, + "heading": -3.5612398503705793, + "angularVelocity": 0.21003745902883333, + "velocityX": 3.3345286409433434, + "velocityY": -1.6211633779357917, "moduleForcesX": [ - -33.17492791427454, - -36.44246857537978, - -32.454651631287796, - -35.85281953404848 + -25.772720719503052, + -24.038621985626055, + -26.326511299596437, + -24.623675888804087 ], "moduleForcesY": [ - -70.77919539967775, - -69.2166880739434, - -69.02352334329501, - -67.39520207920545 + -55.617544175097784, + -56.3901225503694, + -56.897671134657024, + -57.65632603556039 ], - "timestamp": 5.484610370581616 + "timestamp": 5.558342536827251 }, { - "x": 6.430734331505576, - "y": 6.456274689185194, - "heading": -3.55597279273681, - "angularVelocity": 0.18306730138979413, - "velocityX": 3.486635816434521, - "velocityY": -1.776212423313204, + "x": 6.429785051718747, + "y": 6.454517230975465, + "heading": -3.555783203705424, + "angularVelocity": 0.17030731637027208, + "velocityX": 3.3186854863804274, + "velocityY": -1.6779112050568066, "moduleForcesX": [ - -15.238669327364391, - -8.471205328474737, - -18.190714448045004, - -11.773615198816776 + -8.059917813217185, + -3.5123356736370575, + -10.479446367245371, + -6.03517696733037 ], "moduleForcesY": [ - -36.510563952243956, - -39.29991840660133, - -43.12295459661239, - -45.75459276689898 + -21.48474062356099, + -23.417268008535252, + -26.91275592119492, + -28.788257648118933 ], - "timestamp": 5.515057520622227 + "timestamp": 5.590382538287265 }, { - "x": 6.536475682611372, - "y": 6.400874064288047, - "heading": -3.5512294389855783, - "angularVelocity": 0.1557897453425012, - "velocityX": 3.4729474175663744, - "velocityY": -1.8195668502061235, + "x": 6.535890878159139, + "y": 6.3999345000370695, + "heading": -3.5509405063489323, + "angularVelocity": 0.15114535380203434, + "velocityX": 3.3116673409890054, + "velocityY": -1.7035807881108644, "moduleForcesX": [ - -7.105966453517452, - -3.904238249156235, - -8.842262844227525, - -5.683970643638691 + -3.551592855801476, + -1.4878949974649047, + -4.727965710468891, + -2.6743732417422237 ], "moduleForcesY": [ - -17.55122761626494, - -18.91819232417745, - -21.53331764786734, - -22.877258187795352 + -9.581718408852653, + -10.470814274008577, + -12.285842350891826, + -13.168876343162887 ], - "timestamp": 5.5455046706628375 + "timestamp": 5.62242253974728 }, { "x": 6.641601600646972, "y": 6.344369888305664, "heading": -3.546484656651337, - "angularVelocity": 0.1558366654321555, - "velocityX": 3.4527342590482366, - "velocityY": -1.8558116574791523, + "angularVelocity": 0.1390714573829294, + "velocityX": 3.2993357575144002, + "velocityY": -1.7342262546633984, "moduleForcesX": [ - -9.425930347001255, - -9.431345346606202, - -9.423018174875864, - -9.428431462071117 + -5.7560829719013995, + -4.444919794975055, + -6.483173213952547, + -5.177358266631704 ], "moduleForcesY": [ - -16.908789517759143, - -16.906432080261197, - -16.901878110852078, - -16.89952145852833 + -12.451995720494438, + -13.01289673408783, + -14.152581305031367, + -14.711065470349547 ], - "timestamp": 5.575951820703448 + "timestamp": 5.654462541207295 }, { - "x": 6.869753469015524, - "y": 6.195179516897854, - "heading": -3.542866425141456, - "angularVelocity": 0.048373286754126776, - "velocityX": 3.050234823819821, - "velocityY": -1.994573480816792, + "x": 6.869731347457535, + "y": 6.195147686170208, + "heading": -3.5430658553910614, + "angularVelocity": 0.045706968702274815, + "velocityX": 3.0499342909124034, + "velocityY": -1.9949959074662678, "moduleForcesX": [ - -78.31714320835097, - -74.77834883929404, - -78.09040380788947, - -74.46722774433756 + -49.847910667256336, + -44.35336751958273, + -50.2065788649508, + -44.98425405325641 ], "moduleForcesY": [ - -20.140082076449396, - -24.405157664502912, - -28.259698256336822, - -32.56908498859212 + -45.107327355027664, + -48.75639459683009, + -50.366048913041745, + -53.79518756599839 ], - "timestamp": 5.6507499531576695 + "timestamp": 5.729260790956575 }, { - "x": 7.0598495747309, - "y": 6.070649750515125, - "heading": -3.539878174269547, - "angularVelocity": 0.0399508754277714, - "velocityX": 2.5414552406334554, - "velocityY": -1.66487801629198, + "x": 7.059826728122221, + "y": 6.070616528520401, + "heading": -3.5400838676463033, + "angularVelocity": 0.03986707917302543, + "velocityX": 2.5414415618262263, + "velocityY": -1.66489400577198, "moduleForcesX": [ - -96.38792598998765, - -96.32186712116838, - -96.85697827552185, - -96.7941901796475 + -96.39508860152831, + -96.3494121391401, + -96.72106180217853, + -96.67696001450193 ], "moduleForcesY": [ - 62.906638901351315, - 63.00396831226178, - 62.18110701001113, - 62.27496892844536 + 62.88707197355026, + 62.95438072017819, + 62.38391822498686, + 62.44956252680856 ], - "timestamp": 5.725548085611891 + "timestamp": 5.804059040705855 }, { - "x": 7.211915508257611, - "y": 5.970953271268857, - "heading": -3.537495873597022, - "angularVelocity": 0.031849734670626455, - "velocityX": 2.0330177844985795, - "velocityY": -1.332873909750178, + "x": 7.211898448481457, + "y": 5.970928319469068, + "heading": -3.537649300785395, + "angularVelocity": 0.032548446909771406, + "velocityX": 2.0330919622983044, + "velocityY": -1.332761252910166, "moduleForcesX": [ - -96.32997314585461, - -96.2648765880098, - -96.78416991240438, - -96.72213484257243 + -96.33189190207509, + -96.27315885630252, + -96.74250734840605, + -96.68627379381498 ], "moduleForcesY": [ - 63.33059042831494, - 63.42768790672798, - 62.633819804313376, - 62.72773938264774 + 63.32587402991062, + 63.413486925786316, + 62.696376607221254, + 62.7813968776455 ], - "timestamp": 5.800346218066112 + "timestamp": 5.8788572904551355 }, { - "x": 7.325959940528807, - "y": 5.8961477456875455, - "heading": -3.5357126824424197, - "angularVelocity": 0.02384004915756235, - "velocityX": 1.5246962528241605, - "velocityY": -1.0000988410652476, + "x": 7.325950138897687, + "y": 5.896133355137769, + "heading": -3.535800762021587, + "angularVelocity": 0.02471366335447362, + "velocityX": 1.5247908981630418, + "velocityY": -0.9999560762718304, "moduleForcesX": [ - -96.31011450913448, - -96.24488535024157, - -96.76017259475934, - -96.69795042437518 + -96.31025854518855, + -96.24648866204707, + -96.7505601347192, + -96.68966743585159 ], "moduleForcesY": [ - 63.472522054727726, - 63.57019718383225, - 62.78399745101653, - 62.87858000727262 + 63.47168328918775, + 63.567173224815086, + 62.79818822526497, + 62.89071925102441 ], - "timestamp": 5.875144350520333 + "timestamp": 5.953655540204416 }, { - "x": 7.401987230405639, - "y": 5.846262014344345, - "heading": -3.5345254341500323, - "angularVelocity": 0.01587269967086741, - "velocityX": 1.0164329961495133, - "velocityY": -0.6669381935937067, + "x": 7.401983623718805, + "y": 5.846256704612968, + "heading": -3.5345578251238092, + "angularVelocity": 0.016617192273138574, + "velocityX": 1.0165142242764782, + "velocityY": -0.6668157435766066, "moduleForcesX": [ - -96.30009844719447, - -96.2346774667713, - -96.7482657606124, - -96.68582788542037 + -96.29939278470033, + -96.2329159415438, + -96.75477051723158, + -96.69137390831803 ], "moduleForcesY": [ - 63.543559427570486, - 63.64170695487276, - 62.858869191683326, - 62.95396491375012 + 63.54438360092045, + 63.644109963436094, + 62.84860449412121, + 62.94517892257007 ], - "timestamp": 5.949942482974555 + "timestamp": 6.028453789953696 }, { - "x": 7.44, + "x": 7.439999999999993, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": 0.007929116431986636, - "velocityX": 0.5082047953219507, - "velocityY": -0.3335462040385299, + "angularVelocity": 0.008362148539556004, + "velocityX": 0.5082522172460263, + "velocityY": -0.33347469361261795, "moduleForcesX": [ - -96.29401110747638, - -96.22850451077451, - -96.74113494181451, - -96.67859802056265 + -96.29281019096716, + -96.22472066349776, + -96.75733376592433, + -96.69245071862353 ], "moduleForcesY": [ - 63.58627600774885, - 63.68466012516549, - 62.90374389419573, - 62.99909879542881 + 63.588004757645685, + 63.6902592409911, + 62.87872632391144, + 62.97770864616691 ], - "timestamp": 6.024740615428776 + "timestamp": 6.103252039702976 }, { "x": 7.44, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": -9.243044313287906e-21, - "velocityX": 5.393146768307059e-21, - "velocityY": -4.66608405771598e-20, + "angularVelocity": -1.4293252202182307e-19, + "velocityX": 9.48790104088937e-19, + "velocityY": 6.222110897117571e-19, "moduleForcesX": [ - -96.28984267330934, - -96.22440473642784, - -96.73635227532326, - -96.67387504230592 + -96.28830838426238, + -96.21927713511505, + -96.75901741443018, + -96.6932781749062 ], "moduleForcesY": [ - 63.61490939882352, - 63.713260147549455, - 62.93369197756516, - 63.029025881658725 + 63.61721617293362, + 63.720955818602505, + 62.898815476061394, + 62.99919868599484 ], - "timestamp": 6.099538747882997 + "timestamp": 6.178050289452257 }, { - "x": 7.415573591734402, - "y": 5.838158154369932, - "heading": -3.5159963993345684, - "angularVelocity": 0.29481900273694317, - "velocityX": -0.40150472302798135, - "velocityY": 0.2768829503913695, + "x": 7.413934915732111, + "y": 5.837758514843543, + "heading": -3.513073580944635, + "angularVelocity": 0.33588030587629836, + "velocityX": -0.41971546897661216, + "velocityY": 0.26480931006070224, "moduleForcesX": [ - -103.79621548715679, - -104.66906472150548, - -79.65583433191968, - -86.74486016660069 + -106.89549145493714, + -107.06597038486555, + -81.32645261923486, + -88.6006152825964 ], "moduleForcesY": [ - 50.36433011206954, - 48.57600621993662, - 83.4697607403451, - 76.10242127485562 + 43.394757591016855, + 43.037242158674616, + 81.83966143502107, + 73.93350925841955 ], - "timestamp": 6.1603759108468195 + "timestamp": 6.240152085060227 }, { - "x": 7.366683178068024, - "y": 5.871875693217713, - "heading": -3.4813530745022363, - "angularVelocity": 0.5694434642347287, - "velocityX": -0.8036274422502431, - "velocityY": 0.5542260224697102, + "x": 7.361748288757007, + "y": 5.870675766257217, + "heading": -3.472825051451228, + "angularVelocity": 0.6481057286569312, + "velocityX": -0.8403400652783898, + "velocityY": 0.5300531343967616, "moduleForcesX": [ - -102.97011057048296, - -104.36224405802562, - -80.57222592370957, - -87.538387979563 + -106.04093622896603, + -106.8176617255131, + -82.330045707325, + -89.53141023846203 ], "moduleForcesY": [ - 52.000569893921764, - 49.2024689993104, - 82.56810699384464, - 75.1709663223631 + 45.39917215492418, + 43.61156874588938, + 80.80897526070487, + 72.78287839067804 ], - "timestamp": 6.221213073810642 + "timestamp": 6.3022538806681965 }, { - "x": 7.293282825426951, - "y": 5.9225047085781934, - "heading": -3.431709567684295, - "angularVelocity": 0.8160062764179649, - "velocityX": -1.2065051863894705, - "velocityY": 0.8322053970627743, + "x": 7.283368614850293, + "y": 5.920106690428392, + "heading": -3.415321669414071, + "angularVelocity": 0.9259536133247971, + "velocityX": -1.2621160650732042, + "velocityY": 0.7959661019017853, "moduleForcesX": [ - -101.81794700730566, - -103.86961088775284, - -81.86390049299231, - -88.59644120728534 + -104.78762461695497, + -106.36127377314644, + -83.82992057249801, + -90.79435455500895 ], "moduleForcesY": [ - 54.181240687854725, - 50.19424330306314, - 81.26407249712193, - 73.89664129178023 + 48.16400312768637, + 44.6582268703331, + 79.22203469459356, + 71.17035492491334 ], - "timestamp": 6.282050236774464 + "timestamp": 6.364355676276166 }, { - "x": 7.1953203397420005, - "y": 5.990100130181784, - "heading": -3.3694632408334324, - "angularVelocity": 1.0231628797003296, - "velocityX": -1.6102408612184471, - "velocityY": 1.1110876692883858, + "x": 7.178710465092463, + "y": 5.986116860930105, + "heading": -3.3437461630239302, + "angularVelocity": 1.1525513181933658, + "velocityX": -1.6852676920729752, + "velocityY": 1.0629349740289333, "moduleForcesX": [ - -100.2816827855571, - -102.97098993160482, - -83.78116306119979, - -89.91507313466994 + -103.01244546536581, + -105.38356550288951, + -86.22789009675718, + -92.4074760314894 ], "moduleForcesY": [ - 56.92156160204695, - 51.95654416018795, - 79.25162011086157, - 72.24946473264367 + 51.77437024681341, + 46.836336225769195, + 76.55773487195223, + 69.011950809141 ], - "timestamp": 6.342887399738286 + "timestamp": 6.426457471884136 }, { - "x": 7.0727413911385675, - "y": 6.0747360510060515, - "heading": -3.2981290809283044, - "angularVelocity": 1.1725425123381896, - "velocityX": -2.0148695736572453, - "velocityY": 1.391187831598893, + "x": 7.0476789147390875, + "y": 6.068797966265863, + "heading": -3.263241334420409, + "angularVelocity": 1.2963365682970727, + "velocityX": -2.1099478536907417, + "velocityY": 1.3313802689008434, "moduleForcesX": [ - -98.2967857325556, - -101.19960247774685, - -86.76685073104727, - -91.51945696061503 + -100.53419705098847, + -103.06905054921911, + -90.34073398334222, + -94.4854543183429 ], "moduleForcesY": [ - 60.21289489893422, - 55.24442779855469, - 75.91533220936326, - 70.14362208312181 + 56.32421606606602, + 51.598469531492704, + 71.56970538755402, + 66.03839637354763 ], - "timestamp": 6.403724562702108 + "timestamp": 6.488559267492106 }, { - "x": 6.925504994542901, - "y": 6.1764899452128645, - "heading": -3.2234493803323416, - "angularVelocity": 1.2275342398916893, - "velocityX": -2.420171970925455, - "velocityY": 1.6725614616073183, + "x": 6.890219706001051, + "y": 6.168188552754541, + "heading": -3.184089698328757, + "angularVelocity": 1.274546658703927, + "velocityX": -2.5355017064568197, + "velocityY": 1.6004462594946758, "moduleForcesX": [ - -95.75953255949935, - -97.31237310212741, - -91.76671164693617, - -93.57306626338037 + -96.91797721607088, + -96.29166873701149, + -98.30376883932875, + -97.7151339255793 ], "moduleForcesY": [ - 64.06733787812749, - 61.704100587843456, - 69.68084586415333, - 67.25296923337032 + 62.16157487034742, + 63.11727303496232, + 59.937833099468605, + 60.88181944934315 ], - "timestamp": 6.464561725665931 + "timestamp": 6.550661063100076 }, { - "x": 6.7536964435204645, - "y": 6.295259954535899, - "heading": -3.1573307264826953, - "angularVelocity": 1.086813563100644, - "velocityX": -2.8240723704457587, - "velocityY": 1.9522608145561011, + "x": 6.707396761735225, + "y": 6.282083749845621, + "heading": -3.1426185384704066, + "angularVelocity": 0.667793249009192, + "velocityX": -2.943923641434326, + "velocityY": 1.8340081148388676, "moduleForcesX": [ - -92.25427081535649, - -86.53217011804067, - -101.20179764226755, - -97.11446599263788 + -89.39704823104165, + -59.974779639430686, + -113.80694315967615, + -110.38024149575088 ], "moduleForcesY": [ - 68.84873167392043, - 75.85885179568066, - 54.786384608235366, - 61.64809216339915 + 72.20506885999238, + 97.79151184647154, + 14.788993764846895, + 28.839425985382416 ], - "timestamp": 6.525398888629753 + "timestamp": 6.612762858708046 }, { - "x": 6.5590064200801805, - "y": 6.426527001243398, - "heading": -3.142643870470458, - "angularVelocity": 0.24141257245955464, - "velocityX": -3.200182486419688, - "velocityY": 2.157678634448467, + "x": 6.5096539372796265, + "y": 6.407528929196308, + "heading": -3.1425069776210126, + "angularVelocity": 0.0017964190616627644, + "velocityX": -3.1841724143354817, + "velocityY": 2.0199927896220715, "moduleForcesX": [ - -84.74996163721526, - -38.815685267763385, - -114.64908329430031, - -112.94150068763071 + -63.73430047048059, + -27.910051624661733, + -81.07343060013055, + -47.0233396086935 ], "moduleForcesY": [ - 77.54282904121575, - 107.86535624618253, - 1.6603151606166382, - 4.720404786880023 + 63.59254149911791, + 78.23128798690023, + 10.792434877490132, + 17.49274670317357 ], - "timestamp": 6.586236051593575 + "timestamp": 6.674864654316016 }, { - "x": 6.359357039655459, - "y": 6.562363363203817, - "heading": -3.142536760064485, - "angularVelocity": 0.0017606081670331869, - "velocityX": -3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 6.311987970636452, + "y": 6.533099878628413, + "heading": -3.1424005830387, + "angularVelocity": 0.001713228760479499, + "velocityX": -3.182934804187995, + "velocityY": 2.0220180141778825, "moduleForcesX": [ - -25.631275124724667, - -11.445573252590584, - -26.924267849020588, - -12.108894286779364 + 0.28044804636635795, + 0.2854585156252423, + 0.2805164694315654, + 0.28554463484010184 ], "moduleForcesY": [ - 26.818501650047196, - 27.856532036432693, - 7.559585000412651, - 7.889518984351467 + 0.4664832664910793, + 0.46629629597971395, + 0.45988069254081865, + 0.45969100338396346 ], - "timestamp": 6.647073214557397 + "timestamp": 6.736966449923986 }, { - "x": 6.150813575777984, - "y": 6.684102379422477, - "heading": -3.142424203474444, - "angularVelocity": 0.001850128844891342, - "velocityX": -3.4278959392220183, - "velocityY": 2.001063335104134, + "x": 6.112886530666606, + "y": 6.656381795149372, + "heading": -3.1422932741509393, + "angularVelocity": 0.001727951449866915, + "velocityX": -3.206049648334116, + "velocityY": 1.9851586466067415, "moduleForcesX": [ - -34.11956696981292, - -34.125974092877726, - -34.12166225634603, - -34.128069599930605 + -5.284961607212092, + -5.285867690384544, + -5.2850120640368585, + -5.28591821205513 ], "moduleForcesY": [ - -54.09118913684165, - -54.08961846611762, - -54.08460010575841, - -54.083029392944155 + -8.428859802481485, + -8.428820483404417, + -8.427704094995518, + -8.427665220538435 ], - "timestamp": 6.70791037752122 + "timestamp": 6.799068245531956 }, { - "x": 5.92948393312288, - "y": 6.78064499032236, - "heading": -3.1422944875374577, - "angularVelocity": 0.0021321825454533767, - "velocityX": -3.6380664691205715, - "velocityY": 1.586901923044861, + "x": 5.903153552433724, + "y": 6.76054779134001, + "heading": -3.1421763428195106, + "angularVelocity": 0.001882897753344962, + "velocityX": -3.377244992348762, + "velocityY": 1.6773427430054257, "moduleForcesX": [ - -49.03163546387958, - -49.062291976877944, - -49.05084786401326, - -49.08151053061538 + -39.13650558561692, + -39.149028631143274, + -39.14202011232457, + -39.15454418789349 ], "moduleForcesY": [ - -96.68438290730587, - -96.67004058315028, - -96.6714276505825, - -96.65707564207314 + -70.39220856869584, + -70.38808653661687, + -70.38227306623791, + -70.37815024115646 ], - "timestamp": 6.768747540485042 + "timestamp": 6.861170041139926 }, { - "x": 5.698043840852722, - "y": 6.849459835142262, - "heading": -3.142133803067373, - "angularVelocity": 0.0026412222769214106, - "velocityX": -3.80425517882526, - "velocityY": 1.1311317206034748, + "x": 5.681800942539791, + "y": 6.836948493802415, + "heading": -3.142036982527429, + "angularVelocity": 0.002244062200092101, + "velocityX": -3.5643512031643763, + "velocityY": 1.2302494914108861, "moduleForcesX": [ - -38.74033390445188, - -38.80840694131451, - -38.772841951602906, - -38.84095720701171 + -42.75035515553822, + -42.79383002375121, + -42.77356853041684, + -42.81705900203794 ], "moduleForcesY": [ - -106.40184229774029, - -106.37757896352488, - -106.38798347831748, - -106.36368214821303 + -102.24725073962186, + -102.22993200522637, + -102.23474808291238, + -102.21741225918257 ], - "timestamp": 6.829584703448864 + "timestamp": 6.923271836747896 }, { - "x": 5.459913340003193, - "y": 6.889216371961373, - "heading": -3.1419171816291134, - "angularVelocity": 0.003560676200305988, - "velocityX": -3.9142275748646917, - "velocityY": 0.653490972988881, + "x": 5.452329247860557, + "y": 6.883506999197636, + "heading": -3.141856084971286, + "angularVelocity": 0.002912919898230047, + "velocityX": -3.6950895289376384, + "velocityY": 0.7497127086168015, "moduleForcesX": [ - -25.577114001754065, - -25.717865755187383, - -25.620041504490064, - -25.761004866741906 + -29.82914130574372, + -29.925476931514535, + -29.863722347706368, + -29.960153351309717 ], "moduleForcesY": [ - -111.50955109747034, - -111.47748761628132, - -111.49785520760967, - -111.46568684412037 + -109.89810991838907, + -109.87230666320609, + -109.88678831438045, + -109.86092743160704 ], - "timestamp": 6.890421866412686 + "timestamp": 6.9853736323558655 }, { "x": 5.218749084472655, "y": 6.899192810058594, "heading": -3.141592653589793, - "angularVelocity": 0.005334371681882162, - "velocityX": -3.964094375570246, - "velocityY": 0.16398591931634418, + "angularVelocity": 0.004241928577334819, + "velocityX": -3.7612465324259428, + "velocityY": 0.2525822435148049, "moduleForcesX": [ - -11.472950024585305, - -11.766242291584785, - -11.512400965901131, - -11.806680580908067 + -15.002575278462157, + -15.2146838817836, + -15.03997983187976, + -15.25259845361454 ], "moduleForcesY": [ - -114.27486879290602, - -114.2452044120995, - -114.2687583678, - -114.2388907542841 + -113.69134460089438, + -113.66335076467918, + -113.68440690030413, + -113.65627458813692 ], - "timestamp": 6.951259029376509 + "timestamp": 7.047475427963835 }, { - "x": 4.916924325700423, - "y": 6.864260942419369, - "heading": -3.1415950035328826, - "angularVelocity": -0.00003069941458382123, - "velocityX": -3.943007574588477, - "velocityY": -0.4563463224696035, + "x": 4.928181972145996, + "y": 6.87015777266571, + "heading": -3.141599360558739, + "angularVelocity": -0.0000866124738088435, + "velocityX": -3.7523263652724554, + "velocityY": -0.3749527448361419, "moduleForcesX": [ - 3.5661256761579754, - 4.290300452597265, - 3.5363367506884513, - 4.254477917247712 + 1.3524659590982626, + 1.9300173473620212, + 1.3434416674907999, + 1.9171433879503503 ], "moduleForcesY": [ - -115.08817444708899, - -115.06352371966176, - -115.091807306801, - -115.06756634659668 + -115.0791940311929, + -115.07098399891115, + -115.08184184287786, + -115.0737409512458 ], - "timestamp": 7.027805866546542 + "timestamp": 7.124911952413265 }, { - "x": 4.624233759004072, - "y": 6.782789828791696, - "heading": -3.141613203556746, - "angularVelocity": -0.0002377632379964541, - "velocityX": -3.823679429709109, - "velocityY": -1.0643302406695383, + "x": 4.646396057477393, + "y": 6.793457496928237, + "heading": -3.141606663617506, + "angularVelocity": -0.00009431026016780606, + "velocityX": -3.6389277110781113, + "velocityY": -0.9904922293815314, "moduleForcesX": [ - 22.126953133722363, - 22.152969056839062, - 22.120137478707928, - 22.146146005278467 + 20.7945154399426, + 20.79547645165578, + 20.794279315526616, + 20.795240317066792 ], "moduleForcesY": [ - -112.78882065085001, - -112.783738070124, - -112.7903239244963, - -112.78524441350454 + -112.87678463656185, + -112.87660869109382, + -112.87683614320373, + -112.87666020166296 ], - "timestamp": 7.104352703716575 + "timestamp": 7.202348476862694 }, { - "x": 4.364815135242433, - "y": 6.667702152711534, - "heading": -3.1445463260067914, - "angularVelocity": -0.03831800971122916, - "velocityX": -3.389018192683674, - "velocityY": -1.5034935515953176, + "x": 4.381846370817898, + "y": 6.67179475203828, + "heading": -3.1420798505720358, + "angularVelocity": -0.00611064298009589, + "velocityX": -3.4163424629454022, + "velocityY": -1.5711286857845959, "moduleForcesX": [ - 80.9419265471949, - 82.77126323116903, - 78.469916779085, - 80.35273216958149 + 40.66256347127909, + 41.289770106870066, + 40.34665877997078, + 40.970425111678864 ], "moduleForcesY": [ - -81.16083698479932, - -79.32224282560593, - -83.58853211441301, - -81.80494379688997 + -106.52838528799592, + -106.29034131292164, + -106.66047133973122, + -106.42582853323142 ], - "timestamp": 7.1808995408866085 + "timestamp": 7.279785001312123 }, { - "x": 4.152022632610264, - "y": 6.561745619437614, - "heading": -3.1479056109157355, - "angularVelocity": -0.04388535219922793, - "velocityX": -2.7798993465855872, - "velocityY": -1.3842052420605961, + "x": 4.164221462692653, + "y": 6.562682372433733, + "heading": -3.14551504003902, + "angularVelocity": -0.04436135907968595, + "velocityX": -2.810365130312185, + "velocityY": -1.4090557444349736, "moduleForcesX": [ - 112.9351029547452, - 112.95285116511826, - 113.04267855576263, - 113.05965579629232 + 110.51967200781795, + 110.75149967016266, + 111.51809488586062, + 111.7036498757053 ], "moduleForcesY": [ - 22.445395936831837, - 22.361919228925984, - 21.895492780162357, - 21.813838326495294 + 31.93883577086322, + 31.16312570353636, + 28.240069272526224, + 27.540756606496988 ], - "timestamp": 7.257446378056642 + "timestamp": 7.3572215257615525 }, { - "x": 3.9834975897286435, - "y": 6.473209425403713, - "heading": -3.150924095180105, - "angularVelocity": -0.03943316766524029, - "velocityX": -2.2015938099085024, - "velocityY": -1.15662772371947, + "x": 3.9912382536008786, + "y": 6.472975043297138, + "heading": -3.1492007720912656, + "angularVelocity": -0.047596816598514495, + "velocityX": -2.2338710359443223, + "velocityY": -1.1584627509358232, "moduleForcesX": [ - 107.38700511167124, - 107.33800844105599, - 107.22522115524383, - 107.17535879811417 + 105.63214461850299, + 105.67464605947447, + 105.75886325172861, + 105.80089159312243 ], "moduleForcesY": [ - 41.949490847006764, - 42.073301202563364, - 42.36206037528205, - 42.486672112027655 + 46.14736365416799, + 46.050955922132644, + 45.85560825753269, + 45.759565710113016 ], - "timestamp": 7.333993215226675 + "timestamp": 7.434658050210982 }, { - "x": 3.8579746529951326, - "y": 6.405071382147857, - "heading": -3.153336798543532, - "angularVelocity": -0.03151930834278344, - "velocityX": -1.6398187224207155, - "velocityY": -0.8901483820226407, + "x": 3.8620199488900053, + "y": 6.40464261213393, + "heading": -3.1523691394326896, + "angularVelocity": -0.04091567078908538, + "velocityX": -1.6686996947449793, + "velocityY": -0.8824315353645945, "moduleForcesX": [ - 104.4433579329168, - 104.3219357419469, - 104.10925807795152, - 103.98479429515396 + 103.83684095617444, + 103.73019304787823, + 103.55145256185551, + 103.44265988179228 ], "moduleForcesY": [ - 48.95192669669994, - 49.20870816840664, - 49.6594512669405, - 49.91813079706965 + 50.21517063638313, + 50.43388218964512, + 50.80188828293292, + 51.02184694806683 ], - "timestamp": 7.410540052396708 + "timestamp": 7.512094574660411 }, { - "x": 3.774719039814072, - "y": 6.358839505806994, - "heading": -3.1550135157289017, - "angularVelocity": -0.021904460685229093, - "velocityX": -1.087642759113939, - "velocityY": -0.6039684727687442, + "x": 3.7761167781122684, + "y": 6.358611977323752, + "heading": -3.1546632201056606, + "angularVelocity": -0.029625305232664833, + "velocityX": -1.1093366003769725, + "velocityY": -0.5944305369779248, "moduleForcesX": [ - 102.73833096424609, - 102.56600686278176, - 102.3045321462237, - 102.12754606615566 + 102.92566676985241, + 102.72849667186833, + 102.42499394558602, + 102.22155812605034 ], "moduleForcesY": [ - 52.50070663442109, - 52.83532642023229, - 53.34195778156506, - 53.67882683102995 + 52.13043037442421, + 52.516439019906585, + 53.108410856562514, + 53.49751224898036 ], - "timestamp": 7.487086889566742 + "timestamp": 7.58953109910984 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -0.01128475152706064, - "velocityX": -0.5416639429287429, - "velocityY": -0.305935833734179, + "angularVelocity": -0.01567874681256553, + "velocityX": -0.5534907492707787, + "velocityY": -0.29948260373218166, "moduleForcesX": [ - 101.63866464193978, - 101.43052677926975, - 101.14130973054236, - 100.92738648366812 + 102.37649295640064, + 102.12022129821456, + 101.74499661591258, + 101.47905712486347 ], "moduleForcesY": [ - 54.637212756137814, - 55.0215850566622, - 55.55326636709894, - 55.939948032818286 + 53.242773443897086, + 53.731262222189436, + 54.44082769369383, + 54.93360379578886 ], - "timestamp": 7.563633726736775 + "timestamp": 7.66696762355927 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -5.114527347233404e-23, - "velocityX": 8.88120104270887e-21, - "velocityY": -1.1112992505795778e-20, + "angularVelocity": 1.2481966357163992e-21, + "velocityX": 6.111631210383028e-20, + "velocityY": -8.886773491570175e-20, "moduleForcesX": [ - 100.87338423663934, - 100.63924602824056, - 100.33208991745956, - 100.09136074426307 + 102.00973407493207, + 101.71254310622048, + 101.29023818682474, + 100.98075222935965 ], "moduleForcesY": [ - 56.06251668808282, - 56.480829327320826, - 57.02628087598985, - 57.44686854165232 + 53.969295684402134, + 54.526035754852536, + 55.3087820339606, + 55.870598413077936 ], - "timestamp": 7.640180563906808 + "timestamp": 7.744404148008699 } ], "trajectoryWaypoints": [ @@ -18818,7 +18986,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 0.7375297982110329, + "timestamp": 0.737529870183815, "isStopPoint": true, "x": 1.8498649978637687, "y": 6.808716297149658, @@ -18829,7 +18997,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.1343575514775248, + "timestamp": 1.1344803671849297, "isStopPoint": false, "x": 2.521431007385253, "y": 6.998851299285889, @@ -18840,7 +19008,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 1.719752725275319, + "timestamp": 1.7208124483592229, "isStopPoint": true, "x": 3.70518211364746, "y": 7.172932147979736, @@ -18851,7 +19019,7 @@ "controlIntervalCount": 13 }, { - "timestamp": 2.4836578844523687, + "timestamp": 2.500617143795404, "isStopPoint": false, "x": 5.864199676513671, "y": 7.304165840148926, @@ -18862,7 +19030,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 3.165680705135951, + "timestamp": 3.1907094675174714, "isStopPoint": true, "x": 7.4399999999999995, "y": 7.4374165534973145, @@ -18870,10 +19038,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 16 + "controlIntervalCount": 17 }, { - "timestamp": 4.596356972775791, + "timestamp": 4.646178333479817, "isStopPoint": true, "x": 3.7661104583740226, "y": 6.8421783447265625, @@ -18884,7 +19052,7 @@ "controlIntervalCount": 15 }, { - "timestamp": 5.362821770419173, + "timestamp": 5.430182530987192, "isStopPoint": false, "x": 5.880957641601562, "y": 6.684422969818115, @@ -18895,7 +19063,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 5.575951820703448, + "timestamp": 5.654462541207295, "isStopPoint": false, "x": 6.641601600646972, "y": 6.344369888305664, @@ -18906,7 +19074,7 @@ "controlIntervalCount": 7 }, { - "timestamp": 6.099538747882997, + "timestamp": 6.178050289452257, "isStopPoint": true, "x": 7.4399999999999995, "y": 5.821313381195068, @@ -18917,7 +19085,7 @@ "controlIntervalCount": 14 }, { - "timestamp": 6.951259029376509, + "timestamp": 7.047475427963835, "isStopPoint": false, "x": 5.218749084472655, "y": 6.899192810058594, @@ -18928,7 +19096,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 7.640180563906808, + "timestamp": 7.744404148008699, "isStopPoint": true, "x": 3.7332563781738273, "y": 6.335421085357666, @@ -18992,7 +19160,7 @@ "name": "intake", "target": 1, "trajTargetIndex": 1, - "targetTimestamp": 0.7375297982110329, + "targetTimestamp": 0.737529870183815, "offset": 0.1, "command": { "type": "named", @@ -19005,7 +19173,7 @@ "name": "intake", "target": 3, "trajTargetIndex": 3, - "targetTimestamp": 1.719752725275319, + "targetTimestamp": 1.7208124483592229, "offset": 0.2, "command": { "type": "named", @@ -19018,7 +19186,7 @@ "name": "intake", "target": 6, "trajTargetIndex": 6, - "targetTimestamp": 4.596356972775791, + "targetTimestamp": 4.646178333479817, "offset": 0.2, "command": { "type": "named", @@ -19039,7 +19207,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 24 + "controlIntervalCount": 25 }, { "x": 7.84, @@ -19048,7 +19216,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 20 + "controlIntervalCount": 21 }, { "x": 3.6428947830200187, @@ -19128,9 +19296,9 @@ "x": 0.4266119384765617, "y": 2.058690309524536, "heading": 3.141592653589793, - "angularVelocity": -1.0052674025899142e-27, - "velocityX": 1.6142788826895295e-27, - "velocityY": 1.3181347462088108e-26, + "angularVelocity": -2.636030265121926e-29, + "velocityX": 8.6332357029436e-27, + "velocityY": -6.3927224094377434e-27, "moduleForcesX": [ 0, 0, @@ -19146,3154 +19314,3196 @@ "timestamp": 0 }, { - "x": 0.5057561905034981, - "y": 2.0445076102417237, + "x": 0.5044048891758348, + "y": 2.0447497642817187, "heading": 3.141592653589793, - "angularVelocity": 2.542506773731786e-17, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 2.5937711703524665e-17, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277733, - 113.60325815277733 + 113.60407786230424, + 113.60407786230424, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.35777465406064, - -20.357774654060623, - -20.357774654060627 + -20.35792154651868, + -20.357921546518682, + -20.35792154651867, + -20.35792154651867 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.0986098561129038 }, { - "x": 0.6640322521639479, - "y": 2.016144441360754, + "x": 0.6599786811244505, + "y": 2.016870843817058, "heading": 3.141592653589793, - "angularVelocity": 1.83628749749613e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.2851630766748123, + "angularVelocity": 1.5389337606196853e-16, + "velocityX": 1.577669799766169, + "velocityY": -0.28271941125987365, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060845, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - -20.354574176009805, - -20.354574176009812, - -20.354574176009788, - -20.354574176009795 + -20.354752580314884, + -20.354752580314884, + -20.354752580314873, + -20.354752580314873 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.1972197122258076 }, { - "x": 0.9014153662648319, - "y": 1.9736052393860541, - "heading": 3.1415926535897927, - "angularVelocity": 4.3044410493591116e-16, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156397, + "x": 0.8933091226599791, + "y": 1.975057883291536, + "heading": 3.141592653589793, + "angularVelocity": 2.681654742601167e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.42402415107114716, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.55106593310009, + 113.55106593310009, + 113.5510659331001, + 113.5510659331001 ], "moduleForcesY": [ - -20.348206040044563, - -20.348206040044566, - -20.348206040044545, - -20.34820604004455 + -20.34842177577035, + -20.34842177577035, + -20.348421775770344, + -20.348421775770344 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.2958295683387114 }, { - "x": 1.217832290103284, - "y": 1.9169031294556198, - "heading": 3.1415926535897927, - "angularVelocity": 6.223805757251702e-16, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223711, + "x": 1.2043238856378824, + "y": 1.9193238439537263, + "heading": 3.141592653589793, + "angularVelocity": 3.119234538163159e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959204, "moduleForcesX": [ - 113.44472985048415, - 113.44472985048415, - 113.44472985048417, - 113.44472985048417 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - -20.329366283501095, - -20.3293662835011, - -20.32936628350108, - -20.329366283501084 + -20.32949395931806, + -20.32949395931806, + -20.32949395931805, + -20.329493959318054 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.3944394244516152 }, { - "x": 1.6065593117988135, - "y": 1.8472430049283879, - "heading": 3.1415926535897927, - "angularVelocity": -5.941810710402389e-17, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 1.5704459663887822, + "y": 1.8537145389302825, + "heading": 3.141592653589793, + "angularVelocity": 2.834733594304735e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - 103.79354790180253, - 103.79354790180253, - 103.79354790180251, - 103.79354790180253 + 80.47536393454654, + 80.47536393454654, + 80.47536393454652, + 80.47536393454654 ], "moduleForcesY": [ - -18.599868464060304, - -18.5998684640603, - -18.59986846406034, - -18.59986846406034 + -14.42123536615277, + -14.42123536615277, + -14.421235366152768, + -14.421235366152768 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.49304928056451897 }, { - "x": 1.9952895667696153, - "y": 1.7775823009962126, - "heading": 3.1415926535897927, - "angularVelocity": 9.709734106788374e-17, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151492, + "x": 1.9365688239340553, + "y": 1.7881050947048027, + "heading": 3.141592653589793, + "angularVelocity": -8.681093170147199e-17, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046883, "moduleForcesX": [ - 0.004641026935483716, - 0.004641026935477894, - 0.004641026935483716, - 0.004641026935477894 + 0.0011343830985909456, + 0.0011343830986048384, + 0.0011343830985909456, + 0.0011343830986048384 ], "moduleForcesY": [ - -0.0008316749189463459, - -0.0008316749189463459, - -0.0008316749189385331, - -0.0008316749189385331 + -0.00020328215814713693, + -0.00020328215814713693, + -0.00020328215816578076, + -0.00020328215816578076 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.5916591366774228 }, { - "x": 2.384019821763918, - "y": 1.7079215970598256, - "heading": 3.1415926535897927, - "angularVelocity": -2.3094137904516824e-16, - "velocityX": 3.9082909239078325, - "velocityY": -0.7003681690574906, + "x": 2.3026916814847596, + "y": 1.7224956504783495, + "heading": 3.141592653589793, + "angularVelocity": 4.734074192918141e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 3.373320326366702e-8, - 3.3733215465968396e-8, - 3.373320326366702e-8, - 3.3733215465968396e-8 + 7.931400211976679e-9, + 7.931379192828927e-9, + 7.931400211976679e-9, + 7.931379192828927e-9 ], "moduleForcesY": [ - -6.0450200846646806e-9, - -6.0450200846646806e-9, - -6.045036459773772e-9, - -6.045036459773772e-9 + -1.421325763882383e-9, + -1.421325763882383e-9, + -1.4212975568395444e-9, + -1.4212975568395444e-9 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.6902689927903265 }, { - "x": 2.772750076758221, - "y": 1.6382608931234386, - "heading": 3.1415926535897927, - "angularVelocity": 2.6440232206689406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 2.668814539035464, + "y": 1.6568862062518965, + "heading": 3.141592653589793, + "angularVelocity": -3.989113893494158e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 2.7260590797900104e-13, - 2.5418023822544317e-13, - 2.726059079790011e-13, - 2.5418023822544317e-13 + 1.0621117148556482e-13, + 1.389401920423077e-13, + 1.0621117148556477e-13, + 1.389401920423077e-13 ], "moduleForcesY": [ - -2.389781832125078e-14, - -2.3897818321250773e-14, - 8.288576692751096e-16, - 8.288576692751175e-16 + 3.264252305613286e-14, + 3.264252305613286e-14, + -1.1278805048511687e-14, + -1.12788050485117e-14 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.7888788489032303 }, { - "x": 3.1614803317525237, - "y": 1.5686001891870518, - "heading": 3.1415926535897927, - "angularVelocity": 3.64658642558291e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.0349373965861686, + "y": 1.5912767620254435, + "heading": 3.141592653589793, + "angularVelocity": 3.8177893619679035e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - -2.1187937111675137e-15, - -5.848102972462486e-15, - -2.1187937111675106e-15, - -5.848102972462483e-15 + -1.0065015410704733e-14, + -3.93561753170835e-14, + -1.0065015410704727e-14, + -3.935617531708349e-14 ], "moduleForcesY": [ - -3.79352555329438e-15, - -3.793525553294378e-15, - 1.2110915382879926e-15, - 1.2110915382879942e-15 + -3.845752753351914e-14, + -3.845752753351914e-14, + 8.502984548337096e-16, + 8.502984548337159e-16 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.8874887050161342 }, { - "x": 3.5502105867468265, - "y": 1.4989394852506648, - "heading": 3.1415926535897927, - "angularVelocity": 3.0984512311067555e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.401060254136873, + "y": 1.5256673177989906, + "heading": 3.141592653589793, + "angularVelocity": 2.8475078392542003e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - -1.1805625548476553e-14, - -9.766686110860697e-15, - -1.1805625548476553e-14, - -9.766686110860699e-15 + 2.702347393042644e-14, + 3.066392780900211e-14, + 2.7023473930426435e-14, + 3.0663927809002107e-14 ], "moduleForcesY": [ - 2.2856139854462812e-15, - 2.2856139854462805e-15, - -4.505793531159297e-16, - -4.505793531159307e-16 + 7.65129265833603e-15, + 7.65129265833603e-15, + 2.7659167280194507e-15, + 2.76591672801945e-15 ], - "timestamp": 0.9946297820777839 + "timestamp": 0.986098561129038 }, { - "x": 3.9389408417411294, - "y": 1.4292787813142778, - "heading": 3.1415926535897927, - "angularVelocity": 2.6938201259937605e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.7671831116875776, + "y": 1.4600578735725376, + "heading": 3.141592653589793, + "angularVelocity": -6.625521634806447e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.3582614867510558e-15, - -8.531249324574269e-16, - -2.3582614867510566e-15, - -8.531249324574281e-16 + -2.7558380308157566e-14, + 7.984012372117386e-15, + -2.755838030815758e-14, + 7.984012372117377e-15 ], "moduleForcesY": [ - -3.0992634216346065e-15, - -3.0992634216346073e-15, - -5.1191098856866794e-15, - -5.119109885686679e-15 + 3.433627959014811e-14, + 3.4336279590148096e-14, + -1.3360506441930727e-14, + -1.3360506441930734e-14 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.084708417241942 }, { - "x": 4.327671096735433, - "y": 1.359618077377891, - "heading": 3.1415926535897927, - "angularVelocity": -1.238903049402388e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 4.1333059692382825, + "y": 1.3944484293460846, + "heading": 3.141592653589793, + "angularVelocity": 2.626196468380025e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.639857812880446e-14, - 3.102742236349073e-14, - 1.6398578128804444e-14, - 3.102742236349072e-14 + 5.218701888727073e-14, + 1.7474976800726986e-14, + 5.2187018887270745e-14, + 1.7474976800726996e-14 ], "moduleForcesY": [ - -1.6461928460837335e-15, - -1.6461928460837406e-15, - -2.1277647026310398e-14, - -2.1277647026310404e-14 + -1.3519320045963935e-14, + -1.3519320045963913e-14, + 3.3063161303335716e-14, + 3.306316130333573e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.1833182733548457 }, { - "x": 4.716401351729735, - "y": 1.289957373441504, - "heading": 3.1415926535897927, - "angularVelocity": -1.136445427284406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 4.499428826788987, + "y": 1.3288389851196316, + "heading": 3.141592653589793, + "angularVelocity": -3.612388438354753e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, + "moduleForcesX": [ + -3.317589814336674e-14, + -9.769000156659927e-15, + -3.3175898143366745e-14, + -9.769000156659935e-15 + ], + "moduleForcesY": [ + 4.3145001853369944e-15, + 4.3145001853369944e-15, + -2.7096829237238478e-14, + -2.7096829237238475e-14 + ], + "timestamp": 1.2819281294677496 + }, + { + "x": 4.865551684339691, + "y": 1.2632295408931786, + "heading": 3.141592653589793, + "angularVelocity": 6.373929698977975e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.0678916244800482e-14, - 1.029779697253711e-14, - 1.0678916244800482e-14, - 1.0297796972537104e-14 + 1.7589203863345612e-14, + -1.9879025454332904e-14, + 1.758920386334562e-14, + -1.9879025454332894e-14 ], "moduleForcesY": [ - -1.2590263470365182e-14, - -1.2590263470365181e-14, - -1.2078813255255259e-14, - -1.2078813255255259e-14 + -1.6636808224988317e-14, + -1.663680822498831e-14, + 3.3644390703917045e-14, + 3.364439070391706e-14 ], - "timestamp": 1.293018716701119 + "timestamp": 1.3805379855806534 }, { - "x": 5.105131606724038, - "y": 1.2202966695051172, - "heading": 3.1415926535897927, - "angularVelocity": 2.9818590278219814e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.231674541890395, + "y": 1.1976200966667256, + "heading": 3.141592653589793, + "angularVelocity": -2.0111488524479928e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 2.769886946545534e-14, - 1.2379704678654201e-14, - 2.769886946545535e-14, - 1.2379704678654214e-14 + 6.3838812836279954e-15, + 3.784432963816933e-14, + 6.383881283627987e-15, + 3.7844329638169315e-14 ], "moduleForcesY": [ - 9.496370048803752e-15, - 9.49637004880376e-15, - 3.005421294922601e-14, - 3.005421294922601e-14 + 4.030686794000322e-14, + 4.0306867940003206e-14, + -1.9120757067646953e-15, + -1.9120757067647064e-15 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.4791478416935573 }, { - "x": 5.493861861718341, - "y": 1.1506359655687302, - "heading": 3.1415926535897927, - "angularVelocity": 3.7716775113186575e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.597797399441099, + "y": 1.1320106524402727, + "heading": 3.141592653589793, + "angularVelocity": 4.608632320582683e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.875775797486784e-14, - 1.5819811149361853e-14, - 1.8757757974867845e-14, - 1.5819811149361856e-14 + 3.918114304682504e-14, + 1.4344013324637785e-14, + 3.9181143046825054e-14, + 1.434401332463779e-14 ], "moduleForcesY": [ - 5.14793052073305e-15, - 5.147930520733051e-15, - 9.090563825427617e-15, - 9.090563825427614e-15 + -2.8224321170465307e-14, + -2.8224321170465303e-14, + 5.106334777962157e-15, + 5.106334777962165e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.5777576978064611 }, { - "x": 5.882592116712644, - "y": 1.0809752616323431, - "heading": 3.1415926535897927, - "angularVelocity": 4.0491763613005573e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.963920256991803, + "y": 1.0664012082138197, + "heading": 3.141592653589793, + "angularVelocity": -2.9208162371439364e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.1753860824189263e-14, - -2.2786094030199463e-14, - -2.1753860824189263e-14, - -2.278609403019946e-14 + 1.2013443615486301e-14, + 4.02636056188286e-14, + 1.2013443615486301e-14, + 4.02636056188286e-14 ], "moduleForcesY": [ - -6.901925353374897e-15, - -6.901925353374896e-15, - -5.516700481060696e-15, - -5.516700481060695e-15 + 1.289444461580083e-14, + 1.2894444615800824e-14, + -2.501639454930619e-14, + -2.50163945493062e-14 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.676367553919365 }, { - "x": 6.271322371706947, - "y": 1.0113145576959566, - "heading": 3.1415926535897927, - "angularVelocity": 4.793115078142994e-16, - "velocityX": 3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 6.330043114542507, + "y": 1.0007917639873667, + "heading": 3.141592653589793, + "angularVelocity": -1.2364755766957827e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -2.3335563331205926e-13, - -2.3612291774158497e-13, - -2.3335563331205926e-13, - -2.3612291774158497e-13 + -1.0552174459678842e-13, + -1.1184131716065804e-13, + -1.0552174459678844e-13, + -1.1184131716065804e-13 ], "moduleForcesY": [ - 2.5534936481984513e-14, - 2.5534936481984522e-14, - 2.924854615684032e-14, - 2.9248546156840326e-14 + 2.5387864477856727e-14, + 2.538786447785674e-14, + 3.386853439517406e-14, + 3.3868534395174075e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.7749774100322688 }, { - "x": 6.660052626677748, - "y": 0.9416538537637811, - "heading": 3.1415926535897927, - "angularVelocity": -3.3113004994684937e-16, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151491, + "x": 6.69616597208778, + "y": 0.9351823197618869, + "heading": 3.141592653589793, + "angularVelocity": -3.2114621171744805e-16, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046882, "moduleForcesX": [ - -3.37332422685154e-8, - -3.373321212191524e-8, - -3.37332422685154e-8, - -3.373321212191524e-8 + -7.93135794252456e-9, + -7.931350532461352e-9, + -7.93135794252456e-9, + -7.931350532461352e-9 ], "moduleForcesY": [ - 6.045047048260069e-9, - 6.045047048260069e-9, - 6.045006592459861e-9, - 6.045006592459861e-9 + 1.4213044027536005e-9, + 1.4213044027536005e-9, + 1.4212944586791418e-9, + 1.4212944586791416e-9 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.8735872661451727 }, { - "x": 7.048779648373277, - "y": 0.8719937292365493, - "heading": 3.1415926535897927, - "angularVelocity": -2.927541680761118e-16, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824061, + "x": 7.06228805283868, + "y": 0.8695730147384431, + "heading": 3.141592653589793, + "angularVelocity": -5.032939008461686e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - -0.004641026935458204, - -0.004641026935459632, - -0.004641026935458204, - -0.004641026935459632 + -0.0011343830986322845, + -0.0011343830986254506, + -0.0011343830986322845, + -0.0011343830986254506 ], "moduleForcesY": [ - 0.0008316749189556608, - 0.0008316749189556608, - 0.0008316749189575763, - 0.0008316749189575763 + 0.00020328215814718062, + 0.00020328215814718062, + 0.0002032821581380095, + 0.0002032821581380095 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.9721971222580765 }, { - "x": 7.36519657221173, - "y": 0.8152916193061152, - "heading": 3.1415926535897927, - "angularVelocity": 1.34800275257632e-15, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 7.373302815816583, + "y": 0.8138389754006333, + "heading": 3.141592653589793, + "angularVelocity": 7.522639458662454e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959202, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180247, - -103.79354790180248 + -80.47536393454648, + -80.47536393454651, + -80.47536393454646, + -80.4753639345465 ], "moduleForcesY": [ - 18.599868464060222, - 18.599868464060204, - 18.599868464060343, - 18.599868464060325 + 14.421235366152747, + 14.421235366152738, + 14.421235366152821, + 14.421235366152812 ], - "timestamp": 1.9892595641555668 + "timestamp": 2.0708069783709804 }, { - "x": 7.602579686312613, - "y": 0.7727524173314154, + "x": 7.606633257352112, + "y": 0.7720260148751114, "heading": 3.141592653589793, - "angularVelocity": 1.0489291061445997e-15, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156398, + "angularVelocity": 6.995668606739556e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.4240241510711471, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048415 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - 20.329366283501095, - 20.329366283501102, - 20.329366283501077, - 20.329366283501084 + 20.329493959318064, + 20.329493959318064, + 20.329493959318047, + 20.32949395931805 ], - "timestamp": 2.088722542363345 + "timestamp": 2.1694168344838842 }, { - "x": 7.760855747973063, - "y": 0.7443892484504455, + "x": 7.762207049300727, + "y": 0.7441470944104503, "heading": 3.141592653589793, - "angularVelocity": 6.60732824682179e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.28516307667481233, + "angularVelocity": 4.3371547132759497e-16, + "velocityX": 1.5776697997661688, + "velocityY": -0.28271941125987354, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.5510659331001, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - 20.348206040044566, - 20.348206040044573, - 20.348206040044545, - 20.34820604004455 + 20.34842177577035, + 20.348421775770355, + 20.34842177577033, + 20.348421775770333 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.268026690596788 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 3.6252603672857176e-16, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 1.5788584640316286e-16, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - 20.354574176009816, - 20.354574176009823, - 20.354574176009788, - 20.354574176009795 + 20.354752580314884, + 20.354752580314884, + 20.354752580314862, + 20.354752580314862 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.366636546709692 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 6.745149212805757e-24, - "velocityX": -2.3977049906460955e-24, - "velocityY": 5.457735537774418e-24, + "angularVelocity": -2.881387559058349e-22, + "velocityX": -2.0695827234177623e-22, + "velocityY": 3.9145962895148407e-22, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230424, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - 20.357774654060638, - 20.357774654060645, - 20.357774654060613, - 20.357774654060623 + 20.35792154651868, + 20.35792154651868, + 20.35792154651866, + 20.357921546518664 ], - "timestamp": 2.38711147698668 + "timestamp": 2.4652464028225958 }, { - "x": 7.790302474791704, - "y": 0.7486471398847376, - "heading": 3.113139944846083, - "angularVelocity": -0.35037941350634544, - "velocityX": -0.6119976095087556, - "velocityY": 0.227085702748705, + "x": 7.793078256290604, + "y": 0.747575876847021, + "heading": 3.1112179449580726, + "angularVelocity": -0.38443223901861173, + "velocityX": -0.5938569225985211, + "velocityY": 0.2198318874756783, "moduleForcesX": [ - -103.90543853086191, - -98.59916886502413, - -113.31145977613869, - -112.25808633757457 + -103.38540370202267, + -97.08636346934234, + -113.70612876978298, + -112.73947029508176 ], "moduleForcesY": [ - 50.24070001601602, - 59.96747683817382, - 21.908340031011765, - 26.7231884795195 + 51.30130417295831, + 62.38345613408081, + 19.75281146697054, + 24.597212101539153 ], - "timestamp": 2.4683169007271215 + "timestamp": 2.544258269021076 }, { - "x": 7.6908434229658935, - "y": 0.7856168809153167, - "heading": 3.0585136722324213, - "angularVelocity": -0.6726924150813451, - "velocityX": -1.2247833610685241, - "velocityY": 0.45526196807673963, + "x": 7.699157584042874, + "y": 0.7824201103535565, + "heading": 3.0528530427476355, + "angularVelocity": -0.7386852762573926, + "velocityX": -1.1886907216164007, + "velocityY": 0.44100000649276744, "moduleForcesX": [ - -103.9180654585984, - -99.75724138640885, - -112.86307129194968, - -112.08705733206625 + -103.36634328078968, + -98.44357768722068, + -113.2458848815574, + -112.56382635716881 ], "moduleForcesY": [ - 50.18528756830429, - 57.99159008453135, - 24.052005242751903, - 27.373638607207237 + 51.30995429297126, + 60.18928815483856, + 22.172889474101435, + 25.32325446348918 ], - "timestamp": 2.549522324467563 + "timestamp": 2.6232701352195567 }, { - "x": 7.541531337145835, - "y": 0.8412229963489037, - "heading": 2.981391936731005, - "angularVelocity": -0.9497116319215562, - "velocityX": -1.8386959754967525, - "velocityY": 0.6847586389219771, + "x": 7.558124904051805, + "y": 0.8348658019205454, + "heading": 2.970415200366219, + "angularVelocity": -1.0433602741938681, + "velocityX": -1.7849556880075408, + "velocityY": 0.6637698119323439, "moduleForcesX": [ - -104.11265608433906, - -101.42006410641169, - -112.15378683051924, - -111.72713556007261 + -103.55489402764358, + -100.41233501810488, + -112.50081664731479, + -112.18043737384707 ], "moduleForcesY": [ - 49.732813229817744, - 54.984671240448414, - 27.084035745760126, - 28.72458573429547 + 50.87947133813933, + 56.79519440863833, + 25.59433833117188, + 26.8778174814867 ], - "timestamp": 2.6307277482080047 + "timestamp": 2.702282001418037 }, { - "x": 7.3422298869395055, - "y": 0.9155841520343788, - "heading": 2.888707762091219, - "angularVelocity": -1.1413544855825648, - "velocityX": -2.4542874235021577, - "velocityY": 0.9157166142394264, + "x": 7.369806193764596, + "y": 0.905047849903824, + "heading": 2.8714456053511004, + "angularVelocity": -1.2525915381685058, + "velocityX": -2.383423140698201, + "velocityY": 0.8882469350487018, "moduleForcesX": [ - -104.98869457390775, - -103.9286155458672, - -110.8945520614623, - -110.77607463143485 + -104.5638907933371, + -103.40298640344945, + -111.14222972427874, + -111.12271990152317 ], "moduleForcesY": [ - 47.76428477391485, - 49.99408871314553, - 31.717824320202514, - 32.072047225373296 + 48.67580615971352, + 51.05561071064651, + 30.82098267886581, + 30.82179435894176 ], - "timestamp": 2.7119331719484463 + "timestamp": 2.7812938676165175 }, { - "x": 7.092835207414608, - "y": 1.0087906432972025, - "heading": 2.7963823652584026, - "angularVelocity": -1.13693633479357, - "velocityX": -3.071157910856337, - "velocityY": 1.1477865266825216, + "x": 7.134064263774228, + "y": 0.9930498413232173, + "heading": 2.7737381050807945, + "angularVelocity": -1.2366180546205667, + "velocityX": -2.983626907358137, + "velocityY": 1.1137819628045385, "moduleForcesX": [ - -107.94355502791352, - -107.94550564100822, - -107.79557995601229, - -107.79794622888959 + -108.14622857930792, + -108.14231842669959, + -107.59500574441715, + -107.59649154427582 ], "moduleForcesY": [ - 40.38686661660537, - 40.3833232466669, - 40.78021169994761, - 40.77561046788363 + 39.79515762619855, + 39.812512633287064, + 41.26220935675609, + 41.264830579989365 ], - "timestamp": 2.793138595688888 + "timestamp": 2.860305733814998 }, { - "x": 6.796745453055094, - "y": 1.1197154475688882, - "heading": 2.775510588841466, - "angularVelocity": -0.25702441358657924, - "velocityX": -3.6461820001815646, - "velocityY": 1.365977777866621, + "x": 6.8566127289684236, + "y": 1.0968882632669579, + "heading": 2.7677976122574344, + "angularVelocity": -0.0751848185491247, + "velocityX": -3.5115172967670025, + "velocityY": 1.3142130029291403, "moduleForcesX": [ - -114.48153022441872, - -114.50263359045594, - -80.3287014204199, - -92.8994088994194 + -111.16467067641464, + -114.92109699391807, + -65.016543313601, + -88.39242273361802 ], "moduleForcesY": [ - -8.214078066637384, - 11.01893061920677, - 81.97674297463203, - 67.8367051044082 + -28.016980604792003, + 4.148148544540663, + 94.40251274978314, + 73.55404230537421 ], - "timestamp": 2.8743440194293295 + "timestamp": 2.9393176000134784 }, { - "x": 6.494829735223949, - "y": 1.232766445355973, - "heading": 2.7753947312647114, - "angularVelocity": -0.0014267221500469003, - "velocityX": -3.7179255267008355, - "velocityY": 1.3921606781885885, + "x": 6.577593993203279, + "y": 1.201509394881753, + "heading": 2.7676745616395704, + "angularVelocity": -0.0015573688331172865, + "velocityX": -3.5313523042759076, + "velocityY": 1.3241192323186386, "moduleForcesX": [ - -10.058722820162451, - -20.67537666401696, - -4.347871917595185, - -15.100494848677254 + -2.8091694596169208, + -6.012702465623992, + -1.1155418972111872, + -4.321760134676918 ], "moduleForcesY": [ - -4.924229823728783, - -0.6516753204634617, - 9.978553002629143, - 13.911513369658744 + -1.0053994170960971, + 0.255916053918154, + 3.3094001138142786, + 4.561565207999692 ], - "timestamp": 2.955549443169771 + "timestamp": 3.018329466211959 }, { - "x": 6.192913236776813, - "y": 1.34581580615927, - "heading": 2.7752792922983844, - "angularVelocity": -0.0014215671935348026, - "velocityX": -3.7179351395561624, - "velocityY": 1.3921405196362102, + "x": 6.298577354601419, + "y": 1.3061362496498794, + "heading": 2.7675516355023344, + "angularVelocity": -0.0015557933656047968, + "velocityX": -3.5313257618920133, + "velocityY": 1.324191666417548, "moduleForcesX": [ - -0.0016277805976752818, - -0.001847063161268062, - -0.0015148902541237436, - -0.001734172817758108 + 0.004786508231746084, + 0.004717836359581643, + 0.004822681056873213, + 0.004754009184721306 ], "moduleForcesY": [ - -0.0037142738377341908, - -0.0036301509173889052, - -0.003420003455069923, - -0.0033358805347123346 + 0.01295846874279039, + 0.01298542378305762, + 0.013050624257642878, + 0.013077579297906624 ], - "timestamp": 3.0367548669102127 + "timestamp": 3.0973413324104393 }, { - "x": 5.8909967172285675, - "y": 1.458865110625056, - "heading": 2.775163853477906, - "angularVelocity": -0.0014215653974960305, - "velocityX": -3.7179353994046904, - "velocityY": 1.3921398258708426, + "x": 6.019560787537094, + "y": 1.4107632952116882, + "heading": 2.7674287096824344, + "angularVelocity": -0.0015557893493045325, + "velocityX": -3.531324856489611, + "velocityY": 1.3241940811647472, "moduleForcesX": [ - -0.00004542055571195788, - -0.00004549695258179801, - -0.00004538121174383447, - -0.00004545760861367461 + 0.00016276242258108617, + 0.00016258736752973322, + 0.00016285466593947583, + 0.0001626796108881199 ], "moduleForcesY": [ - -0.00012138298819942749, - -0.00012135367010735092, - -0.00012128046597513451, - -0.00012125114788305795 + 0.0004338321315768353, + 0.0004339008689056902, + 0.00043406705001357217, + 0.0004341357873424245 ], - "timestamp": 3.1179602906506543 + "timestamp": 3.1763531986089197 }, { - "x": 5.589080197992595, - "y": 1.5719144159306049, - "heading": 2.775048414795757, - "angularVelocity": -0.0014215636940543507, - "velocityX": -3.7179353955592296, - "velocityY": 1.3921398362120572, + "x": 5.740544223186777, + "y": 1.5153903480276578, + "heading": 2.767305784182522, + "angularVelocity": -0.0015557852994348927, + "velocityX": -3.5313248221402196, + "velocityY": 1.3241941729757745, "moduleForcesX": [ - 6.900104711158049e-7, - 6.175555507382957e-7, - 7.273372348999605e-7, - 6.548823145224512e-7 + 0.000006215085286239505, + 0.000006038575601884941, + 0.0000063081287765344795, + 0.000006131619092180273 ], "moduleForcesY": [ - 0.0000017458195351588234, - 0.000001773634459523078, - 0.0000018430517858208699, - 0.0000018708667101851245 + 0.000016347388393537852, + 0.00001641672195966612, + 0.00001658425890258734, + 0.000016653592468716595 ], - "timestamp": 3.199165714391096 + "timestamp": 3.2553650648074 }, { - "x": 5.2871637020932685, - "y": 1.6849637835662303, - "heading": 2.774932976253418, - "angularVelocity": -0.0014215619723587569, - "velocityX": -3.717935108181291, - "velocityY": 1.3921406037725665, + "x": 5.461527659771718, + "y": 1.6200174033544015, + "heading": 2.7671828590052048, + "angularVelocity": -0.001555781216559394, + "velocityX": -3.5313248103033033, + "velocityY": 1.3241942047529485, "moduleForcesX": [ - 0.0000502708285116954, - 0.00005019760041729749, - 0.00005030856660980123, - 0.000050235338515403327 + 0.0000021694123254773052, + 0.0000019914727065847287, + 0.0000022632434626927816, + 0.000002085303843800205 ], "moduleForcesY": [ - 0.00013415824992900224, - 0.0001341863713689036, - 0.00013425651975516287, - 0.00013428464119506422 + 0.0000055567123093686425, + 0.000005626632809301405, + 0.000005795501746120869, + 0.0000058654222460536335 ], - "timestamp": 3.2803711381315375 + "timestamp": 3.3343769310058806 }, { - "x": 4.985247891548803, - "y": 1.7980149815274176, - "heading": 2.7748175378300544, - "angularVelocity": -0.0014215605072442536, - "velocityX": -3.7179266684142243, - "velocityY": 1.3921631432222419, + "x": 5.1825111126116505, + "y": 1.7246445020461594, + "heading": 2.7670599341523174, + "angularVelocity": -0.0015557771104789896, + "velocityX": -3.531324604574814, + "velocityY": 1.3241947535947438, "moduleForcesX": [ - 0.001475856701570743, - 0.0014757943892858075, - 0.0014758888252835915, - 0.0014758265129986559 + 0.000037016274754465266, + 0.000036837332466608477, + 0.00003711066869943973, + 0.00003693172641158219 ], "moduleForcesY": [ - 0.003941365145401281, - 0.003941389083148754, - 0.003941448766550271, - 0.003941472704297744 + 0.00009848388119271718, + 0.00009855422108221447, + 0.0000987240161800544, + 0.00009879435606955096 ], - "timestamp": 3.361576561871979 + "timestamp": 3.413388797204361 }, { - "x": 4.683352553327882, - "y": 1.911120366719257, - "heading": 2.77470166124187, - "angularVelocity": -0.0014269562653176273, - "velocityX": -3.7176745630424253, - "velocityY": 1.392830429077746, + "x": 4.903495044321948, + "y": 1.8292728777764504, + "heading": 2.766937009602399, + "angularVelocity": -0.0015557732759970146, + "velocityX": -3.5313185438349777, + "velocityY": 1.3242109162117603, "moduleForcesX": [ - 0.04402948835625871, - 0.04425896362882348, - 0.0439111468017011, - 0.04414062207567931 + 0.0010892896607136175, + 0.0010891225627036043, + 0.0010893778384575773, + 0.0010892107404475615 ], "moduleForcesY": [ - 0.11688472651519642, - 0.11679654129683462, - 0.11657677855451694, - 0.11648859333560278 + 0.002904637990345418, + 0.0029047036980851936, + 0.0029048622306798427, + 0.0029049279384196244 ], - "timestamp": 3.4427819856124207 + "timestamp": 3.4924006634028415 }, { - "x": 4.388149882175546, - "y": 2.023490901110545, - "heading": 2.7531166048918894, - "angularVelocity": -0.2658080625128395, - "velocityX": -3.6352580598051922, - "velocityY": 1.3837811468167465, + "x": 4.6244933985494985, + "y": 1.933939583482744, + "heading": 2.7668139676158936, + "angularVelocity": -0.0015572595918266297, + "velocityX": -3.531136007743285, + "velocityY": 1.3246960329144357, "moduleForcesX": [ - 12.043870771869061, - 22.83840056240313, - 5.860331369774312, - 16.90529380786774 + 0.032790520589515496, + 0.03285528776957622, + 0.032756330570521824, + 0.0328210977506596 ], "moduleForcesY": [ - 8.365079303422721, - 3.623159020545799, - -6.955883377496195, - -11.362059153742544 + 0.08724249386313424, + 0.08721701632801891, + 0.08715557843540787, + 0.08713010090026041 ], - "timestamp": 3.5239874093528623 + "timestamp": 3.571412529601322 }, { - "x": 4.139244616295801, - "y": 2.117659437341253, - "heading": 2.6582966359163365, - "angularVelocity": -1.1676556147115003, - "velocityX": -3.065131051779582, - "velocityY": 1.159633579792663, + "x": 4.347461759415901, + "y": 2.039177693852194, + "heading": 2.7612196194953933, + "angularVelocity": -0.07080389806825951, + "velocityX": -3.5062029599159743, + "velocityY": 1.331927917068659, "moduleForcesX": [ - 114.3035613459115, - 114.17872059898714, - 80.10523084516268, - 90.1993984029834 + 3.7842699416281302, + 6.787368546566622, + 2.1704396914350492, + 5.18202223179837 ], "moduleForcesY": [ - 10.797887995941974, - -14.08163508293908, - -82.12682115917214, - -71.37399843226972 + 3.927000047117058, + 2.7165308525255325, + -0.11954942939422283, + -1.3250575905080704 ], - "timestamp": 3.605192833093304 + "timestamp": 3.6504243957998024 }, { - "x": 3.94041859179872, - "y": 2.1929455154015076, - "heading": 2.5635212544140145, - "angularVelocity": -1.1671065445733562, - "velocityX": -2.4484328181402284, - "velocityY": 0.9271065230925025, + "x": 4.112021737626803, + "y": 2.1280236238213828, + "heading": 2.6649584476590715, + "angularVelocity": -1.2183128492941773, + "velocityX": -2.9798058584980724, + "velocityY": 1.1244631248932273, "moduleForcesX": [ - 107.82986538656019, - 107.83281776344131, - 107.84823135382315, - 107.85118599185446 + 111.18079581607803, + 114.73981520594828, + 66.3526187121827, + 86.14799527800557 ], "moduleForcesY": [ - -40.68978365444929, - -40.681753184811356, - -40.64114069086622, - -40.63309333309364 + 28.1775493785711, + -7.795647023550137, + -93.37826671539518, + -76.14784747221287 ], - "timestamp": 3.6863982568337454 + "timestamp": 3.729436261998283 }, { - "x": 3.7915340474498773, - "y": 2.2493986724180166, - "heading": 2.4848150038175776, - "angularVelocity": -0.9692240612893903, - "velocityX": -1.833431038112992, - "velocityY": 0.6951894887828133, + "x": 3.924034265973, + "y": 2.199126658591582, + "heading": 2.567804226434134, + "angularVelocity": -1.2296155742086001, + "velocityX": -2.379230876303722, + "velocityY": 0.8999032448061102, "moduleForcesX": [ - 103.58820516720523, - 104.92855177072477, - 110.11774866337021, - 111.54097597186704 + 108.16057441934431, + 108.09863736885157, + 107.77431358980552, + 107.71338177916209 ], "moduleForcesY": [ - -50.72193464209301, - -47.84626346354833, - -34.33041579719783, - -29.320464413930928 + -39.756848729907496, + -39.92967545115846, + -40.79094897344794, + -40.956213851485444 ], - "timestamp": 3.767603680574187 + "timestamp": 3.8084481281967633 }, { - "x": 3.6924057837846056, - "y": 2.287032791210217, - "heading": 2.428974326530829, - "angularVelocity": -0.6876471387580406, - "velocityX": -1.2207098873360598, - "velocityY": 0.4634434137366357, + "x": 3.783322108255196, + "y": 2.252475144339107, + "heading": 2.487030748526135, + "angularVelocity": -1.0222955334973765, + "velocityX": -1.7808990533691496, + "velocityY": 0.6751958701179381, "moduleForcesX": [ - 101.33099886518957, - 103.65261141150002, - 110.70643780421159, - 112.89020105896144 + 103.30559580568975, + 104.71639898474407, + 110.30262425390252, + 111.80970500266959 ], "moduleForcesY": [ - -55.169911771348715, - -50.63164845334588, - -32.514911041205714, - -23.78302612297838 + -51.28282431794387, + -48.29042179755711, + -33.715070554259036, + -28.25140262149227 ], - "timestamp": 3.8488091043146286 + "timestamp": 3.8874599943952437 + }, + { + "x": 3.6896630853349937, + "y": 2.288054717515041, + "heading": 2.4297305576238934, + "angularVelocity": -0.7252099419889863, + "velocityX": -1.185379202219164, + "velocityY": 0.45030670566059755, + "moduleForcesX": [ + 100.76683441661493, + 103.22725405324366, + 110.9081905642704, + 113.21054868518621 + ], + "moduleForcesY": [ + -56.18800584688867, + -51.48157539975731, + -31.812049876456324, + -22.18877488158011 + ], + "timestamp": 3.966471860593724 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -0.3599432148672905, - "velocityX": -0.6097006638724116, - "velocityY": 0.23169454365301467, + "angularVelocity": -0.3795072034311282, + "velocityX": -0.5919149181654807, + "velocityY": 0.22519310259260125, "moduleForcesX": [ - 99.95294038557154, - 102.93131489378752, - 110.96142635507852, - 113.53712518846511 + 99.2333325232405, + 102.38974249930051, + 111.1591753938583, + 113.85285218516327 ], "moduleForcesY": [ - -57.66959867695029, - -52.12981175149356, - -31.706597373135576, - -20.595444632987434 + -58.89587684714718, + -53.17708736580895, + -31.00181733914535, + -18.756970960294648 ], - "timestamp": 3.9300145280550702 + "timestamp": 4.045483726792205 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -8.79545003714153e-24, - "velocityX": 4.316544263240465e-24, - "velocityY": -5.434912078864282e-24, + "angularVelocity": -2.40180265717108e-22, + "velocityX": -4.286083557700099e-21, + "velocityY": -4.01439908756407e-21, "moduleForcesX": [ - 99.09462528312669, - 102.27730985577772, - 111.18836910911212, - 113.90720400078715 + 98.28908180907341, + 101.63548974867733, + 111.386618425042, + 114.21009011513806 ], "moduleForcesY": [ - -59.15782976040057, - -53.43303751633107, - -30.94741332746105, - -18.52517210548361 + -60.484600758107796, + -54.63738777077898, + -30.223370855342147, + -16.543544482929317 ], - "timestamp": 4.011219951795511 + "timestamp": 4.1244955929906855 }, { - "x": 3.6616731557377156, - "y": 2.2989594406099587, - "heading": 2.4410880866235765, - "angularVelocity": 0.7787767050645694, - "velocityX": 0.3537267099935761, - "velocityY": -0.12975255335628544, + "x": 3.662000323031767, + "y": 2.29858470070828, + "heading": 2.4486274500127516, + "angularVelocity": 0.8951923925432088, + "velocityX": 0.34988280879900624, + "velocityY": -0.1330074564480108, "moduleForcesX": [ - 82.3066869172237, - 72.94619674814246, - 115.0598645177216, - 108.15778531261908 + 80.10356434853756, + 63.35936817512299, + 115.2316867824649, + 105.25411125517041 ], "moduleForcesY": [ - -80.865849592635, - -89.24912908119805, - -8.857475561829947, - 40.14347495933029 + -83.05086248624924, + -96.27483320533042, + -6.26802981925732, + 47.23912873712468 ], - "timestamp": 4.064307186056216 + "timestamp": 4.1791011338497235 }, { - "x": 3.6997800232665217, - "y": 2.285572424541842, - "heading": 2.5213675068235353, - "angularVelocity": 1.5122170389535854, - "velocityX": 0.7178160260085905, - "velocityY": -0.2521701545492991, + "x": 3.7010345624145904, + "y": 2.284649401499804, + "heading": 2.5430898851953367, + "angularVelocity": 1.7299056780050255, + "velocityX": 0.7148402665507606, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - 86.98787858056687, - 77.9377516249161, - 115.19177113993021, - 109.44062121610627 + 85.95725612054815, + 71.53272845126975, + 115.3379810170131, + 106.80144207930023 ], "moduleForcesY": [ - -75.788435232065, - -84.91967760133532, - -6.703058984175722, - 36.43023788237517 + -76.95483823713558, + -90.36459624820597, + -3.342055562829985, + 43.55724850599804 ], - "timestamp": 4.117394420316921 + "timestamp": 4.2337066747087615 }, { - "x": 3.757822755958072, - "y": 2.266103908321777, - "heading": 2.6373918445703044, - "angularVelocity": 2.1855412014306013, - "velocityX": 1.0933463289217327, - "velocityY": -0.36672688813391646, + "x": 3.7609128945257986, + "y": 2.2646755465629314, + "heading": 2.6785263195998334, + "angularVelocity": 2.4802690766147815, + "velocityX": 1.0965614692066081, + "velocityY": -0.3657843988476258, "moduleForcesX": [ - 92.33620304947925, - 83.00336971918547, - 115.29369779681878, - 111.16605663240459 + 92.6408907817173, + 79.8109340460071, + 115.36188623484176, + 109.25337437613233 ], "moduleForcesY": [ - -69.1441009465064, - -79.96612718536689, - -4.100219448058572, - 30.640263168121162 + -68.72829018973381, + -83.13387654195829, + -0.01588573486371081, + 36.84729749065968 ], - "timestamp": 4.1704816545776255 + "timestamp": 4.2883122155677995 }, { - "x": 3.8365376380625946, - "y": 2.240892161139712, - "heading": 2.7835277232467326, - "angularVelocity": 2.75274989762646, - "velocityX": 1.4827459595646495, - "velocityY": -0.4749116719521142, + "x": 3.8427641734312834, + "y": 2.239145023664725, + "heading": 2.8462122994823584, + "angularVelocity": 3.070860158960799, + "velocityX": 1.4989555568505595, + "velocityY": -0.46754454761490494, "moduleForcesX": [ - 98.13983385768609, - 89.6537987560601, - 115.30493503306579, - 113.54027185482593 + 99.85169207378267, + 90.33198646116189, + 115.31328266124063, + 113.07409659910392 ], "moduleForcesY": [ - -60.57623674894674, - -72.40887140224785, - -2.6215553765170494, - 19.854158299778444 + -57.683472950501404, + -71.52890617387136, + 1.148298109984689, + 22.21299020856557 ], - "timestamp": 4.22356888883833 + "timestamp": 4.3429177564268375 }, { - "x": 3.936752649120614, - "y": 2.2100571586229654, - "heading": 2.9498502589606272, - "angularVelocity": 3.1330043470922764, - "velocityX": 1.8877421748112806, - "velocityY": -0.5808364844421804, + "x": 3.9477930443039067, + "y": 2.2082229653738414, + "heading": 3.029985195135523, + "angularVelocity": 3.3654624194194365, + "velocityX": 1.9234105041419012, + "velocityY": -0.5662805972512616, "moduleForcesX": [ - 104.20314131415655, - 98.79018954476513, - 115.13565568271744, - 115.19744688183164 + 107.44888382024823, + 103.975334938706, + 115.03616740781044, + 115.0584177361961 ], "moduleForcesY": [ - -49.313671267244956, - -59.28296150266422, - -5.743342962263197, - 1.0055309166363822 + -41.650556611005165, + -49.54196790951779, + -6.70703170713735, + -4.805861192354321 ], - "timestamp": 4.276656123099035 + "timestamp": 4.3975232972858755 }, { - "x": 4.059100997611248, - "y": 2.173622833296401, - "heading": 3.1200647667331736, - "angularVelocity": 3.2063171145183946, - "velocityX": 2.304666087703798, - "velocityY": -0.686310481869143, + "x": 4.076161986406392, + "y": 2.1725870949498374, + "heading": 3.1988525982358644, + "angularVelocity": 3.0924957512327635, + "velocityX": 2.3508409601484432, + "velocityY": -0.6526053924820007, "moduleForcesX": [ - 110.54551793687573, - 109.90169912281651, - 112.97822127254379, - 112.66305677296599 + 114.85560912614943, + 115.06107533407756, + 105.27999779546317, + 109.41725119475669 ], "moduleForcesY": [ - -32.324872357465075, - -34.3824182667869, - -22.35582603859909, - -23.788977760078865 + -5.214634192772637, + -2.4841907717448946, + -46.33549153296675, + -35.76089164102011 ], - "timestamp": 4.32974335735974 + "timestamp": 4.452128838144914 }, { - "x": 4.2024312304797915, - "y": 2.132928127562045, - "heading": 3.261251480451447, - "angularVelocity": 2.6595228718249397, - "velocityX": 2.699900171191161, - "velocityY": -0.766562928000904, + "x": 4.2246947832316, + "y": 2.134500210018156, + "heading": 3.318391686056822, + "angularVelocity": 2.1891384269875385, + "velocityX": 2.720104855451194, + "velocityY": -0.6974912130254503, "moduleForcesX": [ - 113.57345993390184, - 114.04991592545962, - 89.38373476732211, - 105.87431225446016 + 99.09147098340235, + 109.45603084784327, + 71.24101923486774, + 104.32045073180943 ], "moduleForcesY": [ - 16.388126000917513, - 15.248423187591555, - -72.30427165301604, - -45.19852750676215 + 56.72721933126937, + 35.13049278248973, + -90.04553565784443, + -48.50248817218731 ], - "timestamp": 4.382830591620444 + "timestamp": 4.506734379003952 }, { - "x": 4.364807109525649, - "y": 2.0894373328590015, - "heading": 3.3570269479832517, - "angularVelocity": 1.8041148472994926, - "velocityX": 3.0586614900382436, - "velocityY": -0.8192326330180512, + "x": 4.393347194762179, + "y": 2.093252415972482, + "heading": 3.3910237215163614, + "angularVelocity": 1.3301220776667309, + "velocityX": 3.088558576243185, + "velocityY": -0.7553774469912, "moduleForcesX": [ - 101.90531447708315, - 109.62064454997088, - 68.59046833424642, - 103.74089498833104 + 102.8702924113868, + 109.18925395485235, + 67.57717450786018, + 103.62950593233244 ], "moduleForcesY": [ - 50.944118168520156, - 34.455539676082644, - -92.07044431884987, - -49.68325972504405 + 46.811129640319855, + 34.90205221921152, + -92.47525829145376, + -49.45128884065186 ], - "timestamp": 4.435917825881149 + "timestamp": 4.56133991986299 }, { - "x": 4.546172796843396, - "y": 2.042600207999433, - "heading": 3.409334723238229, - "angularVelocity": 0.985317392842509, - "velocityX": 3.416370994711852, - "velocityY": -0.8822671874288422, + "x": 4.581769294393391, + "y": 2.047917121127897, + "heading": 3.41840428762759, + "angularVelocity": 0.5014246847570052, + "velocityX": 3.450604035176878, + "velocityY": -0.8302325026249093, "moduleForcesX": [ - 104.44398071027045, - 109.28660232154968, - 65.84867153585355, - 103.15267730358437 + 103.51069866239682, + 108.8300334396521, + 62.58815342260189, + 101.67145570587108 ], "moduleForcesY": [ - 42.21513175186775, - 34.370980784960636, - -93.67244040685424, - -50.35760769522869 + 36.02257862078937, + 32.94109351617987, + -94.87769053752216, + -51.95034586329381 ], - "timestamp": 4.489005060141854 + "timestamp": 4.615945460722028 }, { - "x": 4.746163412022853, - "y": 1.9916718961789543, - "heading": 3.419257741737168, - "angularVelocity": 0.18691910846604462, - "velocityX": 3.7672072761848523, - "velocityY": -0.9593325500887032, + "x": 4.779931030558261, + "y": 1.9924964021643286, + "heading": 3.41891011940239, + "angularVelocity": 0.009263378163504843, + "velocityX": 3.628967556175626, + "velocityY": -1.0149284869576565, "moduleForcesX": [ - 103.69547133936663, - 108.88611511085561, - 61.605286218644885, - 101.19104160044986 + 24.817065640960916, + 68.62335338934336, + 29.726644848301333, + 62.36699327831083 ], "moduleForcesY": [ - 33.35515323370187, - 32.17777064720978, - -95.34817206799453, - -52.64097605577242 + -40.262984429708354, + -16.137970502976035, + -76.60001892131636, + -59.12012311674933 ], - "timestamp": 4.542092294402559 + "timestamp": 4.670551001581066 }, { - "x": 4.948548056720655, - "y": 1.9334264581702532, - "heading": 3.419700898757884, - "angularVelocity": 0.00834771347363082, - "velocityX": 3.8123034193854215, - "velocityY": -1.0971646728225626, + "x": 4.977773623848627, + "y": 1.9359085884076386, + "heading": 3.419390968552955, + "angularVelocity": 0.00880586737170981, + "velocityX": 3.6231230416907465, + "velocityY": -1.0363016804973941, "moduleForcesX": [ - 2.812586615495257, - 17.25271454920937, - 7.564782178529809, - 20.62061668455904 + -1.5405489498138385, + -1.510675380723342, + -1.5290615087928063, + -1.4991886990742376 ], "moduleForcesY": [ - -31.60789016315328, - -27.37914757437569, - -46.16688797563849, - -42.31980344027108 + -5.542359638354407, + -5.533911414001032, + -5.5823054708698105, + -5.5738580554539885 ], - "timestamp": 4.595179528663263 + "timestamp": 4.725156542440104 }, { - "x": 5.150726101198334, - "y": 1.8744592854650957, - "heading": 3.4201379344296425, - "angularVelocity": 0.008232406111274728, - "velocityX": 3.8084117075078177, - "velocityY": -1.1107599317677133, + "x": 5.175588208613072, + "y": 1.879222681311638, + "heading": 3.4198714630845712, + "angularVelocity": 0.008799373178195607, + "velocityX": 3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - -1.0463397310112488, - -1.0386065335580354, - -1.043365533090219, - -1.0356323686011837 + -0.13367893133837125, + -0.13325583842743188, + -0.13351671673397217, + -0.1330936238433616 ], "moduleForcesY": [ - -3.632488642177522, - -3.6302851430130465, - -3.6428507946426043, - -3.6406473318268646 + -0.4669309252934178, + -0.46681005875097636, + -0.4674986887694729, + -0.467377822245837 ], - "timestamp": 4.648266762923968 + "timestamp": 4.779762083299142 }, { - "x": 5.352939271336686, - "y": 1.8156128822911926, - "heading": 3.420575141677368, - "angularVelocity": 0.008235638074089262, - "velocityX": 3.8090733667778998, - "velocityY": -1.1084850057344409, + "x": 5.373420765486743, + "y": 1.8225996642524482, + "heading": 3.4203520212322216, + "angularVelocity": 0.008800538188806615, + "velocityX": 3.622939243187224, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - 0.17713577681591305, - 0.17691923574920496, - 0.17705253096230064, - 0.1768359898999078 + 0.08564191211003895, + 0.08556602339215008, + 0.08561276387479577, + 0.08553687515723264 ], "moduleForcesY": [ - 0.6084010281485345, - 0.608339005673639, - 0.6086916074370062, - 0.6086295849669343 + 0.299464024459614, + 0.29944230488278817, + 0.2995658636364578, + 0.299544144060668 ], - "timestamp": 4.701353997184673 + "timestamp": 4.83436762415818 }, { - "x": 5.555686581701234, - "y": 1.758638103797458, - "heading": 3.4210165739729597, - "angularVelocity": 0.008315224963949961, - "velocityX": 3.8191349236406045, - "velocityY": -1.0732293608278416, + "x": 5.5714815297149025, + "y": 1.7667822918576632, + "heading": 3.4208346701386514, + "angularVelocity": 0.008838826588608227, + "velocityX": 3.6271184409553947, + "velocityY": -1.0221924646598644, "moduleForcesX": [ - 2.6950741764387947, - 2.6897109379860757, - 2.692979528513537, - 2.687616330679195 + 1.0885317610039127, + 1.0860355533928958, + 1.0875689835908162, + 1.0850727795645088 ], "moduleForcesY": [ - 9.427648428799428, - 9.426146941870284, - 9.434773571052796, - 9.433272128119771 + 3.8354425637576255, + 3.8347296996098477, + 3.8387867944504532, + 3.8380739343659793 ], - "timestamp": 4.7544412314453774 + "timestamp": 4.888973165017218 }, { - "x": 5.761511331352785, - "y": 1.7140924382303229, - "heading": 3.4214952082673102, - "angularVelocity": 0.009015996049068666, - "velocityX": 3.877104402176408, - "velocityY": -0.8391031513975044, + "x": 5.771617683669556, + "y": 1.7189715185814523, + "heading": 3.4213444792775793, + "angularVelocity": 0.009336216268676605, + "velocityX": 3.665125384826737, + "velocityY": -0.8755663349188748, "moduleForcesX": [ - 15.553365313685392, - 15.492703910893727, - 15.519558726536253, - 15.458920515444706 + 9.90983117572121, + 9.8740945473826, + 9.893348215058872, + 9.85761782165404 ], "moduleForcesY": [ - 62.60222625959512, - 62.59915932231855, - 62.65272108090147, - 62.64965481461626 + 38.11330911683303, + 38.106672803056995, + 38.15370784735131, + 38.147075598526285 ], - "timestamp": 4.807528465706082 + "timestamp": 4.943578705876256 }, { - "x": 5.970718661187601, - "y": 1.6902969703482533, - "heading": 3.42208259465482, - "angularVelocity": 0.011064550558905548, - "velocityX": 3.9408217954513325, - "velocityY": -0.4482333316746726, + "x": 5.975591068141504, + "y": 1.6921473086815817, + "heading": 3.4219745074492076, + "angularVelocity": 0.011537806634941703, + "velocityX": 3.7353972007803753, + "velocityY": -0.4912360445090396, "moduleForcesX": [ - 17.268411937350706, - 16.98946609878052, - 17.097483761569833, - 16.819178445964624 + 18.49602168404423, + 18.223496328433463, + 18.32464726681692, + 18.05270477943307 ], "moduleForcesY": [ - 104.50562642972609, - 104.53971564488901, - 104.56645125313041, - 104.60007764054373 + 99.88968062550072, + 99.92208309280707, + 99.96866077815221, + 100.00063874310942 ], - "timestamp": 4.860615699966787 + "timestamp": 4.998184246735294 }, { "x": 6.181192436218261, "y": 1.6887441873550415, "heading": 3.422910026358796, - "angularVelocity": 0.015586265050321107, - "velocityX": 3.9646777226526373, - "velocityY": -0.02924964946537556, + "angularVelocity": 0.017132307360596073, + "velocityX": 3.7652107248147186, + "velocityY": -0.06232190493864833, "moduleForcesX": [ - 6.920274693383353, - 6.185721571576322, - 6.573955564662514, - 5.844740651408007 + 8.398980799856114, + 7.52927101550806, + 7.973097440144859, + 7.110732370059712 ], "moduleForcesY": [ - 112.03161900342096, - 112.06720187117624, - 112.08016014025495, - 112.11336799839647 + 111.47999858137477, + 111.53171815583704, + 111.54866670440515, + 111.59688033555022 ], - "timestamp": 4.913702934227492 + "timestamp": 5.052789787594332 }, { - "x": 6.465968895774687, - "y": 1.7288019189642057, - "heading": 3.422924487082232, - "angularVelocity": 0.00019962394982911663, - "velocityX": 3.9312142249265274, - "velocityY": 0.5529794301309958, + "x": 6.456062631790769, + "y": 1.727703498460738, + "heading": 3.422924495572841, + "angularVelocity": 0.00019656089199281753, + "velocityX": 3.734047381979395, + "velocityY": 0.5292531383220516, "moduleForcesX": [ - -7.872028825010754, - -5.868356427204452, - -7.274148654405582, - -5.224526232357825 + -7.435057509899166, + -5.273262788820908, + -6.776645494666261, + -4.561459737278193 ], "moduleForcesY": [ - 114.06618405796583, - 114.19123917565138, - 114.07858878844016, - 114.19557828660732 + 114.0531263361637, + 114.17857048927304, + 114.06354518890139, + 114.17906174500054 ], - "timestamp": 4.986142756445969 + "timestamp": 5.126401653608416 }, { - "x": 6.742077877622993, - "y": 1.8092440058536328, - "heading": 3.4229355818017693, - "angularVelocity": 0.00015315774111255494, - "velocityX": 3.8115634935652754, - "velocityY": 1.110467756903315, + "x": 6.7217978144093875, + "y": 1.808082946654349, + "heading": 3.42293562945149, + "angularVelocity": 0.00015125113996228022, + "velocityX": 3.609950365444831, + "velocityY": 1.0919360226275563, "moduleForcesX": [ - -23.458196144337897, - -23.45209662796528, - -23.457565603079534, - -23.451465640201203 + -23.942282612665448, + -23.936485990546096, + -23.941716534513144, + -23.93591950874849 ], "moduleForcesY": [ - 109.28244000142513, - 109.28376366394924, - 109.28229674147879, - 109.2836204695592 + 108.54454153578949, + 108.54583486390915, + 108.54435575416598, + 108.54564914640099 ], - "timestamp": 5.0585825786644465 + "timestamp": 5.2000135196225 }, { - "x": 7.009582372988793, - "y": 1.914830245749957, - "heading": 3.422947466162008, - "angularVelocity": 0.00016405838494088897, - "velocityX": 3.6927823284686, - "velocityY": 1.4575717700946087, + "x": 6.980422996045719, + "y": 1.9090269564051716, + "heading": 3.4229468108149086, + "angularVelocity": 0.0001518962094530346, + "velocityX": 3.513362663389737, + "velocityY": 1.371300786363831, "moduleForcesX": [ - -23.28390223274763, - -23.28472907960402, - -23.284015169836888, - -23.284842009273003 + -18.632354987403158, + -18.632396331688668, + -18.63236369292651, + -18.632405037196442 ], "moduleForcesY": [ - 68.04180366771824, - 68.04154028777829, - 68.04230771680372, - 68.0420443393723 + 53.89122312286404, + 53.8912102638437, + 53.89125746714164, + 53.891244608126165 ], - "timestamp": 5.131022400882924 + "timestamp": 5.273625385636584 }, { - "x": 7.246754939031006, - "y": 2.0101276114817614, - "heading": 3.4430257322940507, - "angularVelocity": 0.2771716649370985, - "velocityX": 3.2740633366949092, - "velocityY": 1.3155383712067839, + "x": 7.22592193699581, + "y": 2.005996792188081, + "heading": 3.442580254906685, + "angularVelocity": 0.2667157505288677, + "velocityX": 3.3350457506826596, + "velocityY": 1.3173125615964607, "moduleForcesX": [ - -75.11544611300371, - -81.01560658870949, - -83.80155867415714, - -88.38909893685336 + -25.84642277568509, + -37.283285847412664, + -31.7140815077526, + -42.75006123891945 ], "moduleForcesY": [ - -40.252101440111836, - -39.65492799695394, - -14.151996507909777, - -17.310769456098647 + -18.150014214403896, + -21.015362736520334, + 0.8264239519393268, + -3.3197301936858925 ], - "timestamp": 5.203462223101401 + "timestamp": 5.347237251650668 }, { - "x": 7.4444707246169886, - "y": 2.0895893588177756, - "heading": 3.460038359656544, - "angularVelocity": 0.234851865196239, - "velocityX": 2.729379773871829, - "velocityY": 1.0969345989883763, + "x": 7.430580643705318, + "y": 2.086840876505934, + "heading": 3.459576924522074, + "angularVelocity": 0.23089578536342303, + "velocityX": 2.7802407110607725, + "velocityY": 1.0982479958107094, "moduleForcesX": [ - -107.64208344195724, - -107.57930657167886, - -105.9946310345107, - -105.87575754009714 + -107.73855282640099, + -107.68858293139232, + -106.38126830053612, + -106.2932325280658 ], "moduleForcesY": [ - -40.69712755938141, - -40.83034886509647, - -44.8154800993999, - -45.06642730066164 + -40.462053452478244, + -40.56825627605823, + -43.908556302844424, + -44.096907679115205 ], - "timestamp": 5.275902045319879 + "timestamp": 5.420849117664752 }, { - "x": 7.602668988189531, - "y": 2.153175677565822, - "heading": 3.4737553313586, - "angularVelocity": 0.1893567830783131, - "velocityX": 2.1838577004705892, - "velocityY": 0.8777812645132035, + "x": 7.594334409844189, + "y": 2.151528839125374, + "heading": 3.4734104153440932, + "angularVelocity": 0.1879247405489274, + "velocityX": 2.2245566510641077, + "velocityY": 0.878770857500916, "moduleForcesX": [ - -107.86118930596339, - -107.81855559484973, - -106.08769609512694, - -105.98182204499227 + -108.03895547091055, + -108.00459288569081, + -106.41201988616295, + -106.3243427538483 ], "moduleForcesY": [ - -40.665271439336365, - -40.760587867167544, - -45.090936163588374, - -45.32350556529579 + -40.20672149366401, + -40.28289239333363, + -44.33454527838811, + -44.52996596613114 ], - "timestamp": 5.348341867538356 + "timestamp": 5.494460983678836 }, { - "x": 7.721329395383598, - "y": 2.2008731582030556, - "heading": 3.4840930136480566, - "angularVelocity": 0.14270717366310565, - "velocityX": 1.6380549200713095, - "velocityY": 0.6584428174516908, + "x": 7.717161916361577, + "y": 2.2000505965479666, + "heading": 3.4838947388725474, + "angularVelocity": 0.14242708541647775, + "velocityX": 1.6685829767430076, + "velocityY": 0.659156737220999, "moduleForcesX": [ - -107.93229359869254, - -107.9046739344928, - -106.11256348212791, - -106.01983716415766 + -108.13673727352719, + -108.11666519143746, + -106.4142454273333, + -106.33573686070703 ], "moduleForcesY": [ - -40.66091896254582, - -40.722104405422826, - -45.19805154468384, - -45.40437473586649 + -40.12609997700318, + -40.168809305270365, + -44.49388432552946, + -44.671030285269225 ], - "timestamp": 5.420781689756834 + "timestamp": 5.56807284969292 }, { - "x": 7.800441770095721, - "y": 2.232675064823596, - "heading": 3.4910081314465584, - "angularVelocity": 0.09546017075588673, - "velocityX": 1.0921116630231624, - "velocityY": 0.4390113841614085, + "x": 7.799052561632761, + "y": 2.2324011072432888, + "heading": 3.490935144512255, + "angularVelocity": 0.09564226558745835, + "velocityX": 1.1124652818272118, + "velocityY": 0.43947412892824594, "moduleForcesX": [ - -107.96697591893106, - -107.94946633207202, - -106.12319819766431, - -106.03987686308871 + -108.18447910649813, + -108.17448806116079, + -106.4131822395508, + -106.34236528854645 ], "moduleForcesY": [ - -40.66122527870853, - -40.69852018667486, - -45.25595136469539, - -45.442664241769286 + -40.08848562489677, + -40.10668496598445, + -44.57832391748555, + -44.739176472038416 ], - "timestamp": 5.493221511975311 + "timestamp": 5.6416847157070045 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 0.047850528600588006, - "velocityX": 0.5460840279946026, - "velocityY": 0.21952416540924652, + "angularVelocity": 0.048080165750899, + "velocityX": 0.5562613826336666, + "velocityY": 0.21975056429240558, "moduleForcesX": [ - -107.98827537545758, - -107.9760433148081, - -106.1299618840012, - -106.05139834798729 + -108.21348472478886, + -108.20892496086536, + -106.41277222504723, + -106.34585019162039 ], "moduleForcesY": [ - -40.660146907176276, - -40.685223309784156, - -45.289831908193264, - -45.466900880102635 + -40.0647979154683, + -40.06999069497862, + -44.62830082076768, + -44.78118450203363 ], - "timestamp": 5.565661334193789 + "timestamp": 5.715296581721089 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 9.96657849481802e-27, - "velocityX": -3.894219970851099e-27, - "velocityY": 3.742285984085537e-25, + "angularVelocity": -7.217019249839112e-23, + "velocityX": -2.800882773502241e-22, + "velocityY": -6.277947352339611e-22, "moduleForcesX": [ - -108.00400169154827, - -107.99223491780998, - -106.13622374630016, - -106.05743685003775 + -108.23430457634592, + -108.23038445425982, + -106.41417815468228, + -106.34652059702091 ], "moduleForcesY": [ - -40.65537952997924, - -40.680427924066414, - -45.308334241937345, - -45.48693154917803 + -40.04492733440483, + -40.0495210669214, + -44.65756272827853, + -44.813096423270885 ], - "timestamp": 5.638101156412266 + "timestamp": 5.788908447735173 }, { - "x": 7.806073186138322, - "y": 2.235358433045618, - "heading": 3.4918613466756465, - "angularVelocity": -0.03903296429686534, - "velocityX": -0.5067850635723453, - "velocityY": -0.19745894526536698, + "x": 7.804839503996671, + "y": 2.2353073040625637, + "heading": 3.4910960657051917, + "angularVelocity": -0.049669524785278085, + "velocityX": -0.5169403325880029, + "velocityY": -0.19510035456649585, "moduleForcesX": [ - -108.31646484929273, - -108.31232931165214, - -106.70790819705411, - -106.65379169981476 + -108.91169498268742, + -108.92708748634632, + -106.9592142409582, + -106.900126446355 ], "moduleForcesY": [ - -39.785622400235304, - -39.79042134746788, - -43.91797659035705, - -44.043414234869665 + -38.12247627099087, + -38.06986059379512, + -43.29915093821448, + -43.43729059553137 ], - "timestamp": 5.705046329623423 + "timestamp": 5.856924993914306 }, { - "x": 7.738222310236991, - "y": 2.208924184045344, - "heading": 3.4866679317973803, - "angularVelocity": -0.07757713706835251, - "velocityX": -1.0135290215370247, - "velocityY": -0.3948641512494979, + "x": 7.734523027865804, + "y": 2.20876912539207, + "heading": 3.4843646424620003, + "angularVelocity": -0.0989674369154671, + "velocityX": -1.0338142713932752, + "velocityY": -0.3901723942377354, "moduleForcesX": [ - -108.3005337940833, - -108.28996331730454, - -106.71250484198275, - -106.65261534540024 + -108.89535610590072, + -108.90060339205658, + -106.95804032881327, + -106.88867772089174 ], "moduleForcesY": [ - -39.79230383732628, - -39.813620832555635, - -43.87361916590637, - -44.01229472070399 + -38.122799476396125, + -38.09756002614687, + -43.26132213447986, + -43.42345092393562 ], - "timestamp": 5.77199150283458 + "timestamp": 5.924941540093439 }, { - "x": 7.636451231880714, - "y": 2.1692796518761055, - "heading": 3.478939983461497, - "angularVelocity": -0.11543697573994834, - "velocityX": -1.520215326581841, - "velocityY": -0.5921940338281333, + "x": 7.629057338850315, + "y": 2.1689657018270334, + "heading": 3.4743178967030715, + "angularVelocity": -0.14771031937536128, + "velocityX": -1.5505887161298457, + "velocityY": -0.5852020692172022, "moduleForcesX": [ - -108.27833136732967, - -108.25850057581364, - -106.7190574300644, - -106.65081131519337 + -108.87073710864843, + -108.86109478467073, + -106.95606713413832, + -106.8716907825758 ], "moduleForcesY": [ - -39.80130085429092, - -39.846439015801195, - -43.811116584954355, - -43.969072663952105 + -38.12366762772549, + -38.138546420957574, + -43.20515744662121, + -43.40238220899802 ], - "timestamp": 5.838936676045737 + "timestamp": 5.992958086272572 }, { - "x": 7.500765760992354, - "y": 2.1164324000873393, - "heading": 3.468746003766396, - "angularVelocity": -0.15227355769096984, - "velocityX": -2.0268148453419133, - "velocityY": -0.7894109351554932, + "x": 7.4884537084291525, + "y": 2.1159017878510578, + "heading": 3.4610179809667345, + "angularVelocity": -0.19553941626658541, + "velocityX": -2.067197444146294, + "velocityY": -0.7801618423291158, "moduleForcesX": [ - -108.24396960661254, - -108.21238741016384, - -106.72757461099188, - -106.64913374630179 + -108.8272916619506, + -108.79813451721276, + -106.94957215478411, + -106.8462010419442 ], "moduleForcesY": [ - -39.81751467144124, - -39.892602068069195, - -43.72029844384378, - -43.90165305191429 + -38.13223147648961, + -38.19884241523941, + -43.11962308400627, + -43.36068150975459 ], - "timestamp": 5.905881849256894 + "timestamp": 6.060974632451705 }, { - "x": 7.331175634844102, - "y": 2.0503950328281664, - "heading": 3.456199114656939, - "angularVelocity": -0.18742036964907863, - "velocityX": -2.53326891265683, - "velocityY": -0.9864395607862418, + "x": 7.312734633849349, + "y": 2.049586749721688, + "heading": 3.4445854242099734, + "angularVelocity": -0.24159645968325458, + "velocityX": -2.583475410777514, + "velocityY": -0.9749839098668387, "moduleForcesX": [ - -108.183855436982, - -108.13878069799289, - -106.73793532144539, - -106.64908314006512 + -108.73406931364026, + -108.68110503738541, + -106.92705418988612, + -106.8027512014663 ], "moduleForcesY": [ - -39.8518780520238, - -39.96046705876725, - -43.57763984939865, - -43.78233752560017 + -38.1683694994336, + -38.295224115541835, + -42.972793664038555, + -43.259992948110714 ], - "timestamp": 5.972827022468051 + "timestamp": 6.128991178630838 }, { - "x": 7.12770050187281, - "y": 1.971192793059601, - "heading": 3.441520842474186, - "angularVelocity": -0.21925811046084745, - "velocityX": -3.0394294795458086, - "velocityY": -1.1830911172452596, + "x": 7.101966942274532, + "y": 1.9700480655932946, + "heading": 3.4253557769380705, + "angularVelocity": -0.28272013726275863, + "velocityX": -3.0987708640736242, + "velocityY": -1.1694019852009814, "moduleForcesX": [ - -108.05776232379694, - -107.9996841375153, - -106.74909898164714, - -106.65408367462611 + -108.4418328543596, + -108.3626740241462, + -106.82910549783024, + -106.6908681014183 ], "moduleForcesY": [ - -39.935162352718365, - -40.07355997651351, - -43.31352925259889, - -43.53014008693061 + -38.32060078212658, + -38.50231437653497, + -42.61405148852435, + -42.92203871274227 ], - "timestamp": 6.039772195679208 + "timestamp": 6.197007724809971 }, { - "x": 6.890400374818258, - "y": 1.8789019078745433, - "heading": 3.4253383104250084, - "angularVelocity": -0.24172813771256388, - "velocityX": -3.5446936003297003, - "velocityY": -1.3786040241311397, + "x": 6.861923440131751, + "y": 1.879644856366164, + "heading": 3.4253408600655706, + "angularVelocity": -0.00021931240760809082, + "velocityX": -3.5291927571650676, + "velocityY": -1.3291355457691012, "moduleForcesX": [ - -107.67012594458991, - -107.61137555141406, - -106.74805702593524, - -106.67046549630615 + -82.29673746119303, + -87.67092010469727, + -93.06437688109203, + -96.4143304414556 ], "moduleForcesY": [ - -40.20094963502285, - -40.332102839966765, - -42.591758575557066, - -42.761473825206814 + -48.18808428690188, + -45.81494056023967, + -18.475969737183824, + -20.9148885300259 ], - "timestamp": 6.106717368890365 + "timestamp": 6.265024270989104 }, { - "x": 6.63970170536198, - "y": 1.790758792782665, - "heading": 3.4253261856713713, - "angularVelocity": -0.0001811146802023973, - "velocityX": -3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 6.620578526901708, + "y": 1.7927653335156666, + "heading": 3.4253282976312676, + "angularVelocity": -0.00018469673937319495, + "velocityX": -3.5483264997669806, + "velocityY": -1.2773292342966776, "moduleForcesX": [ - -35.13969892694759, - -46.833559794249325, - -38.37727275192584, - -49.463406566005396 + -3.99339422319668, + -3.9952241861108564, + -3.9940931809806606, + -3.9959231756424614 ], "moduleForcesY": [ - 6.193009340047558, - 1.5254319217031, - 25.2151393395331, - 19.635508817953465 + 10.814957408993067, + 10.814421040029472, + 10.817367033783066, + 10.816830640829638 ], - "timestamp": 6.173662542101522 + "timestamp": 6.3330408171682375 }, { - "x": 6.380206858974069, - "y": 1.7334916000286844, - "heading": 3.425314102432994, - "angularVelocity": -0.00018049454199152838, - "velocityX": -3.8762293671183365, - "velocityY": -0.855434230834672, + "x": 6.37089300513868, + "y": 1.734019661048189, + "heading": 3.42531523506019, + "angularVelocity": -0.0001920499027328796, + "velocityX": -3.6709526694495414, + "velocityY": -0.863696788025089, "moduleForcesX": [ - -27.870780083632145, - -27.87085530338658, - -27.870784334164817, - -27.87085955385131 + -25.601760187553467, + -25.60101320769075, + -25.601692373604028, + -25.60094538718925 ], "moduleForcesY": [ - 97.83083198961785, - 97.83081049698788, - 97.83084453922437, - 97.83082304661343 + 86.35637664311925, + 86.35659720719453, + 86.35613139442144, + 86.35635196045367 ], - "timestamp": 6.240607715312679 + "timestamp": 6.401057363347371 }, { "x": 6.11539939880371, "y": 1.7113943099975586, "heading": 3.4252974360856103, - "angularVelocity": -0.00024895517606207744, - "velocityX": -3.9555870493471943, - "velocityY": -0.3300804071628426, + "angularVelocity": -0.0002616859511262737, + "velocityX": -3.756344899696669, + "velocityY": -0.3326448095591715, "moduleForcesX": [ - -16.83891510224018, - -16.829101110309182, - -16.83709390658153, - -16.82727878028723 + -17.83355423810439, + -17.823774151167132, + -17.8318555128472, + -17.822074295255884 ], "moduleForcesY": [ - 111.43563757699793, - 111.43715289160197, - 111.43558589017643, - 111.43710122782548 + 110.86994540179053, + 110.87155302236657, + 110.8698433501265, + 110.87145101626253 ], - "timestamp": 6.307552888523836 + "timestamp": 6.469073909526504 }, { - "x": 5.890352759731499, - "y": 1.7185557092564774, - "heading": 3.4246409084154172, - "angularVelocity": -0.011565209036453538, - "velocityX": -3.9643590696733866, - "velocityY": 0.12615321970899335, + "x": 5.89558522537437, + "y": 1.7193809732535483, + "heading": 3.4243945816435364, + "angularVelocity": -0.015459837026566448, + "velocityX": -3.7639414937610223, + "velocityY": 0.1367579385665902, "moduleForcesX": [ - -3.4491974421125313, - -1.6124094350280327, - -2.7948238151606937, - -0.9207370674714969 + -3.4838005876379103, + -1.0971386415787967, + -2.628739965754029, + -0.17889110374308226 ], "moduleForcesY": [ - 114.11007946252991, - 114.15637546330666, - 114.09921998413924, - 114.13567048098221 + 114.12110918273105, + 114.1762136610545, + 114.10669848112909, + 114.14468636650177 ], - "timestamp": 6.364320359662809 + "timestamp": 6.527473906921175 }, { - "x": 5.66751347319984, - "y": 1.7511786253728163, - "heading": 3.4241561999672547, - "angularVelocity": -0.008538489357326316, - "velocityX": -3.925474960583039, - "velocityY": 0.5746762267509569, + "x": 5.678306514433747, + "y": 1.7542341672793909, + "heading": 3.4237856933580315, + "angularVelocity": -0.01042616973747129, + "velocityX": -3.7205260382502785, + "velocityY": 0.596801294190177, "moduleForcesX": [ - 10.066815271135868, - 9.617734238949494, - 9.834772017122992, - 9.387604811781081 + 11.105143341598554, + 10.385540743401508, + 10.725324626777631, + 10.010565773367157 ], "moduleForcesY": [ - 112.16146590109982, - 112.19647225066659, - 112.19714365211975, - 112.23111915488865 + 111.7997329387048, + 111.86098322186378, + 111.86317871279545, + 111.92171623690527 ], - "timestamp": 6.421087830801782 + "timestamp": 6.5858739043158465 }, { - "x": 5.449395923621346, - "y": 1.8073745478916146, - "heading": 3.423755208658891, - "angularVelocity": -0.0070637514815886995, - "velocityX": -3.8422981542460732, - "velocityY": 0.989931758299116, + "x": 5.466218716119367, + "y": 1.8130618187216272, + "heading": 3.4232962295807683, + "angularVelocity": -0.008381229436627441, + "velocityX": -3.631640544109531, + "velocityY": 1.0073228436069053, "moduleForcesX": [ - 20.95690176428424, - 20.776539685058307, - 20.836146342062943, - 20.656026809805113 + 21.80574823449787, + 21.575934691647497, + 21.64961202366041, + 21.42017480511521 ], "moduleForcesY": [ - 103.83805579833934, - 103.86595800234623, - 103.88375203666156, - 103.91143822729342 + 99.76654159220674, + 99.80080758549977, + 99.83931034438031, + 99.87324161618062 ], - "timestamp": 6.477855301940755 + "timestamp": 6.644273901710518 }, { - "x": 5.234668489636406, - "y": 1.8754073625880365, - "heading": 3.423378777118868, - "angularVelocity": -0.006631113425878504, - "velocityX": -3.7825788198185224, - "velocityY": 1.198447162281897, + "x": 5.256412364228166, + "y": 1.879591648117002, + "heading": 3.422829130798028, + "angularVelocity": -0.007998267184563366, + "velocityX": -3.5925746789561237, + "velocityY": 1.139209458277213, "moduleForcesX": [ - 14.963264037670479, - 14.931138360423935, - 14.946047731779307, - 14.91392768517457 + 9.51707651150292, + 9.492184048188738, + 9.505860938347789, + 9.48097102985699 ], "moduleForcesY": [ - 52.14527104247343, - 52.14197332650841, - 52.17690623845456, - 52.17361050090606 + 32.05649277460031, + 32.05124416889293, + 32.08628241846569, + 32.081035971532025 ], - "timestamp": 6.534622773079728 + "timestamp": 6.702673899105189 }, { - "x": 5.020347307549028, - "y": 1.9447110026462533, - "heading": 3.4230043454794967, - "angularVelocity": -0.006595883731627919, - "velocityX": -3.77542239925918, - "velocityY": 1.2208336687846049, + "x": 5.046797341362997, + "y": 1.9467231127720641, + "heading": 3.4223633386981755, + "angularVelocity": -0.007975892476580843, + "velocityX": -3.589298496857378, + "velocityY": 1.149511432361598, "moduleForcesX": [ - 1.791691136022014, - 1.789481049225279, - 1.7908289271509987, - 1.7886188443613316 + 0.7975621457668832, + 0.796199616592488, + 0.7970342417583864, + 0.7956717132450739 ], "moduleForcesY": [ - 5.598749349977525, - 5.598116183228942, - 5.601705282144552, - 5.6010721201319225 + 2.5042491658536608, + 2.5038569339270924, + 2.506076405059156, + 2.5056841739899895 ], - "timestamp": 6.591390244218701 + "timestamp": 6.761073896499861 }, { - "x": 4.8060405689194825, - "y": 2.0140593339308377, - "heading": 3.4226299265716884, - "angularVelocity": -0.006595659455954859, - "velocityX": -3.7751679673187892, - "velocityY": 1.2216209370118332, + "x": 4.83718667234252, + "y": 2.013868189318054, + "heading": 3.4218974960600224, + "angularVelocity": -0.007976757858485664, + "velocityX": -3.5892239447188996, + "velocityY": 1.1497445126961008, "moduleForcesX": [ - 0.06365505243475648, - 0.06364100877132398, - 0.06364961193025265, - 0.06363556826682583 + 0.018091134855906132, + 0.01814381941382445, + 0.018111488649072027, + 0.018164173207109984 ], "moduleForcesY": [ - 0.19692515330903454, - 0.19692109926184684, - 0.19694399939103238, - 0.1969399453438515 + 0.05670219309874917, + 0.05671736020610039, + 0.056631492064510326, + 0.05664665917205125 ], - "timestamp": 6.648157715357674 + "timestamp": 6.819473893894532 }, { - "x": 4.591500986434119, - "y": 2.082663911446821, - "heading": 3.4222414623759345, - "angularVelocity": -0.006843077346227929, - "velocityX": -3.7792696799923613, - "velocityY": 1.2085191772596529, + "x": 4.627444883786628, + "y": 2.0806013070151304, + "heading": 3.4214303705469638, + "angularVelocity": -0.007998724895503174, + "velocityX": -3.5914691423433216, + "velocityY": 1.1426904225027372, "moduleForcesX": [ - -1.036787029486011, - -1.0212819494693623, - -1.0307777743363744, - -1.0152728109135725 + -0.5468558718662196, + -0.5455180884885984, + -0.5463396795091894, + -0.5450018966009532 ], "moduleForcesY": [ - -3.2691983489948386, - -3.264742509836368, - -3.2899813633807438, - -3.285525660593021 + -1.714525278299725, + -1.7141411533773045, + -1.7163199744295032, + -1.7159358500537125 ], - "timestamp": 6.704925186496647 + "timestamp": 6.8778738912892035 }, { - "x": 4.38796292724594, - "y": 2.1423225294075587, - "heading": 3.392610747831683, - "angularVelocity": -0.5219664351739753, - "velocityX": -3.5854699021186707, - "velocityY": 1.0509296391711191, + "x": 4.416417909538516, + "y": 2.1416951287760204, + "heading": 3.420047169772428, + "angularVelocity": -0.02368494582607703, + "velocityX": -3.6134757476438963, + "velocityY": 1.0461271316163543, "moduleForcesX": [ - 30.062890973818472, - 67.96426240208197, - 32.537435642261514, - 63.348910831469794 + -6.0529764567849105, + -5.056830451597798, + -5.643439292990528, + -4.650734177456534 ], "moduleForcesY": [ - -27.016971831599164, - -8.235178803765258, - -69.73669104087492, - -52.69317016977578 + -22.9799246770692, + -22.73239458103274, + -24.22567299694829, + -23.981026840246923 ], - "timestamp": 6.76169265763562 + "timestamp": 6.936273888683875 }, { - "x": 4.205851179698999, - "y": 2.197165482111936, - "heading": 3.3127396856742903, - "angularVelocity": -1.406986440559581, - "velocityX": -3.208029949072623, - "velocityY": 0.9660982179409718, + "x": 4.227154500888805, + "y": 2.196008775433373, + "heading": 3.3675654380202875, + "angularVelocity": -0.8986598303672014, + "velocityX": -3.240811936525528, + "velocityY": 0.9300282376777734, "moduleForcesX": [ - 104.51767942702163, - 110.90141886725938, - 62.29725541431908, - 99.94508162050462 + 103.48471382580142, + 110.09390991333008, + 52.428343365864905, + 96.4518852319005 ], "moduleForcesY": [ - 39.31182600807883, - 26.855999637561276, - -95.37547475461713, - -55.6735513157081 + 22.285822454061403, + 24.891189153478663, + -100.03845095304497, + -60.05822336141424 ], - "timestamp": 6.818460128774593 + "timestamp": 6.994673886078546 }, { - "x": 4.045155999455634, - "y": 2.247628220403907, - "heading": 3.1785027166359323, - "angularVelocity": -2.3646811518119346, - "velocityX": -2.8307616495715378, - "velocityY": 0.8889375777975367, + "x": 4.060470218367385, + "y": 2.2449867624612265, + "heading": 3.260092297576448, + "angularVelocity": -1.840293582849461, + "velocityX": -2.85418304721754, + "velocityY": 0.8386641988501563, "moduleForcesX": [ - 101.86899395570421, - 112.18575793402451, - 64.1327587652835, - 99.30217040259392 + 104.84618511277098, + 111.9090944895469, + 60.51536896101153, + 98.77086477361023 ], "moduleForcesY": [ - 51.1125109928503, - 24.489794047684235, - -94.97028505916239, - -57.83793809446354 + 42.12552095732997, + 24.43643622108832, + -97.04975471639123, + -58.374344881869824 ], - "timestamp": 6.875227599913566 + "timestamp": 7.053073883473218 }, { - "x": 3.9062696172726583, - "y": 2.2936459171983983, - "heading": 2.9909056327184347, - "angularVelocity": -3.3046581105971597, - "velocityX": -2.4465839220310834, - "velocityY": 0.8106349617342454, + "x": 3.9161905386019207, + "y": 2.2894941451617035, + "heading": 3.0920455097304274, + "angularVelocity": -2.8775136188850934, + "velocityX": -2.470542571952716, + "velocityY": 0.762112751473137, "moduleForcesX": [ - 101.72159587923049, - 113.52781849420327, - 70.87580416849237, - 98.27794501691677 + 98.88615121430338, + 112.5392336152905, + 63.49372991199003, + 98.21581874489458 ], "moduleForcesY": [ - 53.03473995293723, - 18.795877029064727, - -90.29587475253834, - -59.88330637545011 + 57.43559858001414, + 23.427197480933113, + -95.49784743209882, + -59.82012493838729 ], - "timestamp": 6.931995071052539 + "timestamp": 7.111473880867889 }, { - "x": 3.792626772488035, - "y": 2.33297655165956, - "heading": 2.8069419778508737, - "angularVelocity": -3.2406526339212274, - "velocityX": -2.001900780579305, - "velocityY": 0.6928375295224226, + "x": 3.7974323632374913, + "y": 2.329195026608959, + "heading": 2.8883508135329774, + "angularVelocity": -3.4879230356958066, + "velocityX": -2.0335304907952847, + "velocityY": 0.6798096441503758, "moduleForcesX": [ - 110.09590584370159, - 110.15119273382382, - 112.27667812755305, - 112.42030542510648 + 111.51397335746604, + 114.89005050626218, + 95.50645628303386, + 103.13454077524403 ], "moduleForcesY": [ - -33.78436386293684, - -33.54304188428511, - -25.62844767832441, - -24.91070248135434 + 27.766723898869564, + 7.125263794319992, + -63.839976213971326, + -51.101345312959225 ], - "timestamp": 6.988762542191512 + "timestamp": 7.16987387826256 }, { - "x": 3.7033158802608868, - "y": 2.3652177680520627, - "heading": 2.646863089051661, - "angularVelocity": -2.819905230714294, - "velocityX": -1.5732758644207585, - "velocityY": 0.5679523104626665, + "x": 3.705201564787477, + "y": 2.36242075004535, + "heading": 2.7010475242691676, + "angularVelocity": -3.2072482469134465, + "velocityX": -1.5792945644622496, + "velocityY": 0.5689336458673064, "moduleForcesX": [ - 99.97859392638921, - 99.19069955359782, - 114.54734457522899, - 115.15979579307127 + 105.95228683396371, + 106.34982483559641, + 114.4004939951579, + 115.09460575424761 ], "moduleForcesY": [ - -57.39726866081913, - -58.57964610086177, - -13.118869737078962, - 4.137282620864764 + -45.29021140358274, + -44.17247603120534, + -13.870897843783036, + -4.506204608148711 ], - "timestamp": 7.045530013330485 + "timestamp": 7.228273875657232 }, { - "x": 3.637351288782728, - "y": 2.3899438580710273, - "heading": 2.5203397651129293, - "angularVelocity": -2.2287997228023126, - "velocityX": -1.1620139166789638, - "velocityY": 0.4355679321777759, + "x": 3.6378462140543926, + "y": 2.3883393111775315, + "heading": 2.5495404830125357, + "angularVelocity": -2.594298767390968, + "velocityX": -1.1533450982521831, + "velocityY": 0.443810998089987, "moduleForcesX": [ - 92.24578923617231, - 90.92322148643724, - 114.71711750544789, - 113.61714858975364 + 93.92589046885861, + 92.38930111082504, + 114.99151586069087, + 112.97863519241554 ], "moduleForcesY": [ - -69.22716039877031, - -70.7835079678775, - -12.071174524868779, - 19.61978127154983 + -66.89886987254614, + -68.8039200125939, + -8.89032055915772, + 22.896798750871643 ], - "timestamp": 7.1022974844694575 + "timestamp": 7.286673873051903 }, { - "x": 3.5939780893678623, - "y": 2.4067236714663482, - "heading": 2.432378164371663, - "angularVelocity": -1.5495071204762023, - "velocityX": -0.764050230609765, - "velocityY": 0.29558853087258563, + "x": 3.5940010146710293, + "y": 2.4061455217676833, + "heading": 2.442794052924954, + "angularVelocity": -1.8278499118104665, + "velocityX": -0.7507739955372641, + "velocityY": 0.3049008798719044, "moduleForcesX": [ - 86.41137299899842, - 85.10523672353465, - 114.61890071891574, - 112.0617012655451 + 85.27321950996415, + 81.25618436721727, + 114.93039749975732, + 110.08736666214386 ], "moduleForcesY": [ - -76.42757490922749, - -77.71146885299508, - -13.222540301247415, - 27.30004265325952 + -77.68627318980846, + -81.68368062704864, + -10.1185634426013, + 34.38228873619394 ], - "timestamp": 7.1590649556084305 + "timestamp": 7.345073870446575 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": -0.808382599061801, - "velocityX": -0.37681858196384876, - "velocityY": 0.1495853557192894, + "angularVelocity": -0.9641391597034187, + "velocityX": -0.3666774697730115, + "velocityY": 0.15530363813167142, "moduleForcesX": [ - 82.24535135891628, - 79.8120626088092, - 114.54956911255539, - 110.85189362912443 + 79.3416840765363, + 71.24184841573963, + 114.8417411977197, + 108.15322189105376 ], "moduleForcesY": [ - -80.92027537570917, - -83.1630963954796, - -13.95497542675499, - 31.949497180856433 + -83.76752129096906, + -90.57520191146979, + -11.302736000119857, + 40.14476142563526 ], - "timestamp": 7.215832426747403 + "timestamp": 7.403473867841246 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": 1.3320780406337021e-20, - "velocityX": -7.91420075044239e-20, - "velocityY": -8.454931019375793e-20, + "angularVelocity": -9.0989818312144e-21, + "velocityX": 3.9183156510716546e-20, + "velocityY": 8.026400730264575e-20, "moduleForcesX": [ - 79.74797430779523, - 73.04670295538676, - 114.65423863578631, - 109.59078372653275 + 76.01822070188068, + 59.44757680524343, + 114.93156102990737, + 106.23908134928891 ], "moduleForcesY": [ - -83.4021017998724, - -89.19074412625787, - -13.169435415720322, - 36.089148730291996 + -86.8169640545679, + -98.75016323489919, + -10.497822934908383, + 45.01411898852261 ], - "timestamp": 7.272599897886376 + "timestamp": 7.461873865235917 }, { - "x": 3.5699516392525266, - "y": 2.4137790529276644, - "heading": 2.3478802631089017, - "angularVelocity": -1.127940834097408, - "velocityX": -0.07699398909111405, - "velocityY": -0.04195884012456622, + "x": 3.570016562928905, + "y": 2.414002895867037, + "heading": 2.3443806141589976, + "angularVelocity": -1.1925305688726726, + "velocityX": -0.07279868109514546, + "velocityY": -0.034335132017282326, "moduleForcesX": [ - -63.3144545947333, - 108.01660145288706, - -111.8751367506926, - -60.59422206639 + -56.92485396981133, + 111.21616724439636, + -112.20973399379473, + -59.18934120988699 ], "moduleForcesY": [ - 96.33566340014389, - -39.61846623202172, - -28.183152137146912, - -98.16238982815337 + 100.25021857445346, + -29.64734387785221, + -26.8203043673127, + -99.01585760311711 ], - "timestamp": 7.3068287015914635 + "timestamp": 7.497183412387385 }, { - "x": 3.564378233003473, - "y": 2.4106424063814575, - "heading": 2.2718151756419913, - "angularVelocity": -2.222253752198952, - "velocityX": -0.16282795908031492, - "velocityY": -0.09163763283184874, + "x": 3.5646173348355323, + "y": 2.4113128910817276, + "heading": 2.26113341401117, + "angularVelocity": -2.3576399830539163, + "velocityX": -0.152911281195873, + "velocityY": -0.07618349716500973, "moduleForcesX": [ - -60.25722824108982, - 96.6501538541861, - -112.89494643133519, - -65.93464425581752 + -52.4117542511686, + 102.02820257962003, + -113.30290747157052, + -65.18685502936177 ], "moduleForcesY": [ - 98.21955261781348, - -62.32975378769388, - -23.68993888315466, - -94.63903361003736 + 102.6213053904586, + -53.1486977357208, + -21.639970807289966, + -95.15210347949885 ], - "timestamp": 7.3410575052965505 + "timestamp": 7.532492959538853 }, { - "x": 3.5553617379589757, - "y": 2.4056031463027416, - "heading": 2.159987950024481, - "angularVelocity": -3.267050364395044, - "velocityX": -0.2634183514613645, - "velocityY": -0.14722279288698742, + "x": 3.555904326933192, + "y": 2.4069105734197564, + "heading": 2.1383294220214664, + "angularVelocity": -3.4779259972638497, + "velocityX": -0.2467606810408336, + "velocityY": -0.12467782843824318, "moduleForcesX": [ - -55.647722774813495, - 75.73920484802964, - -114.0316025405405, - -72.98400096210639 + -45.66288067392498, + 82.28667122957205, + -114.43740382724414, + -73.15743467730793 ], "moduleForcesY": [ - 100.80472826924587, - -86.50130488193642, - -17.255130186537396, - -89.28875262327956 + 105.688056546013, + -80.31445254430263, + -14.248499805306832, + -89.13561917035238 ], - "timestamp": 7.375286309001638 + "timestamp": 7.567802506690321 }, { - "x": 3.542210147208017, - "y": 2.3986325839335767, - "heading": 2.0146174838328887, - "angularVelocity": -4.247021527369034, - "velocityX": -0.38422583693780954, - "velocityY": -0.20364609962244665, + "x": 3.5431228593186614, + "y": 2.400727296021074, + "heading": 1.9783355498230653, + "angularVelocity": -4.531178820053225, + "velocityX": -0.3619833344137748, + "velocityY": -0.17511630415825824, "moduleForcesX": [ - -51.5565732083985, - 47.05283368026791, - -114.89682349470701, - -81.07269190656022 + -39.35983727831561, + 51.41808681441776, + -115.13501591899248, + -82.27641388148437 ], "moduleForcesY": [ - 102.76487920670458, - -104.87988948985232, - -9.544434426513986, - -81.9718721787508 + 107.95631863586092, + -102.77876201791744, + -5.581529823014008, + -80.73399410186649 ], - "timestamp": 7.409515112706725 + "timestamp": 7.603112053841789 }, { - "x": 3.5239509110903704, - "y": 2.389814553511627, - "heading": 1.8392865279803854, - "angularVelocity": -5.122322046751736, - "velocityX": -0.5334465170026451, - "velocityY": -0.25762017562547423, + "x": 3.5249509357501743, + "y": 2.3927861943346422, + "heading": 1.7860937401531451, + "angularVelocity": -5.444471118399184, + "velocityX": -0.514646180267788, + "velocityY": -0.2248995619337351, "moduleForcesX": [ - -56.897120992564666, - 13.831328653792013, - -115.20928290206547, - -89.34828449880852 + -49.96209987038422, + 10.940950643937366, + -115.15655922442268, + -91.40372157976795 ], "moduleForcesY": [ - 99.40316122357176, - -114.07904848518908, - -2.1067431308290923, - -72.78432529295594 + 102.6827935808, + -114.29555191993956, + 1.6280187943338387, + -70.09920994331443 ], - "timestamp": 7.443743916411812 + "timestamp": 7.638421600993257 }, { - "x": 3.498669227691315, - "y": 2.3782677142113307, - "heading": 1.6450275698811467, - "angularVelocity": -5.675306673670566, - "velocityX": -0.7386084426695263, - "velocityY": -0.3373427654562614, + "x": 3.4986636063204344, + "y": 2.3808215422611085, + "heading": 1.5804277096948873, + "angularVelocity": -5.824657834777944, + "velocityX": -0.7444822024189094, + "velocityY": -0.3388503404538074, "moduleForcesX": [ - -105.17566327178112, - -23.62733870294902, - -115.09802567519542, - -96.55369553063619 + -112.32060939232774, + -44.01860178950653, + -114.80288651764441, + -98.58413579678934 ], "moduleForcesY": [ - 42.375604431971254, - -112.36357969798489, - 0.4252157545061834, - -62.73241252810446 + -13.981211872806785, + -105.7654815086491, + -4.41159995138123, + -59.14888259144925 ], - "timestamp": 7.477972720116899 + "timestamp": 7.673731148144725 }, { - "x": 3.4654282510227628, - "y": 2.3622293034748987, - "heading": 1.4432142418231406, - "angularVelocity": -5.896008805823804, - "velocityX": -0.9711404744073245, - "velocityY": -0.468564746661713, + "x": 3.464431329562427, + "y": 2.3636059779555727, + "heading": 1.3846008757527926, + "angularVelocity": -5.546002419743707, + "velocityX": -0.9694906765912646, + "velocityY": -0.48756117521604403, "moduleForcesX": [ - -100.91027402459957, - -71.1255356669369, - -113.08371748677206, - -100.75435384797646 + -99.15399456797527, + -112.77483449910136, + -59.73325270721248, + -90.29830581798875 ], "moduleForcesY": [ - -53.21727890658225, - -89.84770615754992, - -19.528589252979987, - -55.16195289043296 + -57.092373513786754, + -17.758976569181463, + -97.05254853411765, + -67.32011989022973 ], - "timestamp": 7.512201523821986 + "timestamp": 7.709040695296193 }, { - "x": 3.4254907189328243, - "y": 2.3409579999268493, - "heading": 1.2552368047325984, - "angularVelocity": -5.491791028110254, - "velocityX": -1.1667814170203163, - "velocityY": -0.6214445509474886, + "x": 3.4235746716849746, + "y": 2.340405903244497, + "heading": 1.2048128445517017, + "angularVelocity": -5.091768252644312, + "velocityX": -1.1570994581774947, + "velocityY": -0.6570482088472442, "moduleForcesX": [ - -101.51984502491118, - -114.25525292589644, - -46.05237264124134, - -62.82771454322337 + -99.77808458384018, + -113.58831274277311, + -42.9977808046872, + -45.43310994172789 ], "moduleForcesY": [ - -53.16497191667841, - -3.066262088111863, - -104.56967598650562, - -92.89456142147945 + -55.91347232549474, + -8.813998457096558, + -105.63471515912464, + -102.28351156220445 ], - "timestamp": 7.546430327527073 + "timestamp": 7.744350242447661 }, { - "x": 3.378727497206346, - "y": 2.3144796562214807, - "heading": 1.0811416380559544, - "angularVelocity": -5.086218267417026, - "velocityX": -1.3661950364785587, - "velocityY": -0.7735690657912138, + "x": 3.375651121627886, + "y": 2.3112861636787048, + "heading": 1.0391515004273537, + "angularVelocity": -4.691687022031433, + "velocityX": -1.3572405743836062, + "velocityY": -0.824698754726991, "moduleForcesX": [ - -103.59778354435822, - -113.857000551391, - -55.858639098030196, - -57.60230783383814 + -101.3199117359912, + -112.23361382448618, + -55.56993463789227, + -52.83399612224958 ], "moduleForcesY": [ - -48.73192117995345, - -7.0383536447927435, - -99.65856579041078, - -97.01327027724552 + -52.730238002466315, + -17.94256872974015, + -99.53598557359503, + -99.48263504998475 ], - "timestamp": 7.58065913123216 + "timestamp": 7.779659789599129 }, { - "x": 3.3246281814333827, - "y": 2.2831821293897963, - "heading": 0.9193928781957939, - "angularVelocity": -4.7255160084990955, - "velocityX": -1.580520202782186, - "velocityY": -0.9143622751583245, + "x": 3.3201483223528383, + "y": 2.2766875060838894, + "heading": 0.8863627179565744, + "angularVelocity": -4.327123817684768, + "velocityX": -1.5718921298242126, + "velocityY": -0.9798669307882836, "moduleForcesX": [ - -106.32220430919398, - -113.45047145453957, - -68.54608055150727, - -67.34185140885786 + -104.49259355735687, + -111.99240207753651, + -66.73912886868585, + -62.075582497913004 ], "moduleForcesY": [ - -42.05389338701554, - -9.493241665913557, - -91.27582657149124, - -90.81548257020026 + -45.65536628701796, + -17.664987423299614, + -92.24565830688351, + -94.04562308108589 ], - "timestamp": 7.614887934937247 + "timestamp": 7.814969336750597 }, { - "x": 3.2626525500968637, - "y": 2.2478394917560407, - "heading": 0.7691200400273281, - "angularVelocity": -4.390245112368141, - "velocityX": -1.8106280275084217, - "velocityY": -1.0325408371953264, + "x": 3.2564602958964812, + "y": 2.237542281220726, + "heading": 0.7461015385201132, + "angularVelocity": -3.9723301699333993, + "velocityX": -1.8037055582489439, + "velocityY": -1.108630045444232, "moduleForcesX": [ - -109.86203798468615, - -113.56537677119788, - -80.19548638705977, - -78.22814414337074 + -108.91840198905898, + -112.87425186361108, + -77.98189938274184, + -73.13263930631419 ], "moduleForcesY": [ - -31.018267527500402, - -2.651547534152617, - -80.99523654285528, - -81.44565214035984 + -32.979908594379154, + -6.223365306851065, + -82.63610290053708, + -85.29569693218967 ], - "timestamp": 7.649116738642334 + "timestamp": 7.850278883902065 }, { - "x": 3.1922610767987623, - "y": 2.2097982307128565, - "heading": 0.6301855969917186, - "angularVelocity": -4.058992076750915, - "velocityX": -2.056498202642201, - "velocityY": -1.1113815537007243, + "x": 3.1839722741315835, + "y": 2.195492918557526, + "heading": 0.6188659770305921, + "angularVelocity": -3.6034322656055986, + "velocityX": -2.052929805470177, + "velocityY": -1.1908779935020866, "moduleForcesX": [ - -113.16894691538705, - -112.19207649662077, - -91.84103538444018, - -90.80572403866798 + -112.86988205346567, + -111.12012886761111, + -90.03734763330685, + -86.88778676806119 ], "moduleForcesY": [ - -13.308928426825096, - 15.928502193313712, - -67.0733667207797, - -66.37795970134016 + -12.348284390719446, + 18.73827221812754, + -68.72148386204621, + -69.97685042740027 ], - "timestamp": 7.683345542347421 + "timestamp": 7.885588431053533 }, { - "x": 3.1131298064145425, - "y": 2.171263792990809, - "heading": 0.5028079946614243, - "angularVelocity": -3.7213571186352805, - "velocityX": -2.3118327787911217, - "velocityY": -1.1257897896174542, + "x": 3.1023875492734194, + "y": 2.153210765788329, + "heading": 0.5052130558756492, + "angularVelocity": -3.2187589568171084, + "velocityX": -2.3105570997041225, + "velocityY": -1.1974708309852726, "moduleForcesX": [ - -112.95185304826352, - -102.63355880151158, - -103.39609116937459, - -104.73192313748356 + -111.86974536596428, + -97.20248405702162, + -102.32583288761865, + -103.03466347126516 ], "moduleForcesY": [ - 13.428590930971126, - 47.503243007308896, - -46.479255255102, - -38.36223908729842 + 18.095398070095523, + 56.63338441320622, + -47.363739496310544, + -37.97062581903604 ], - "timestamp": 7.717574346052508 + "timestamp": 7.920897978205001 }, { - "x": 3.02578800710757, - "y": 2.1355999035659368, - "heading": 0.3862879845211218, - "angularVelocity": -3.404150818247454, - "velocityX": -2.551704700506004, - "velocityY": -1.041926259889298, + "x": 3.01257887441982, + "y": 2.114825451689115, + "heading": 0.4034135111362285, + "angularVelocity": -2.8830600489643863, + "velocityX": -2.5434671951001233, + "velocityY": -1.087108648960283, "moduleForcesX": [ - -102.96113998905054, - -75.57886955728041, - -111.88275135917057, - -107.63125638242771 + -99.43709283642428, + -65.89792156241508, + -111.45218049666224, + -97.88415343386902 ], "moduleForcesY": [ - 48.12217109568619, - 84.19790217808439, - -15.043250131164976, - 21.89000669551637 + 54.220121086403616, + 91.46142231462018, + -11.821171765224456, + 43.674000472763154 ], - "timestamp": 7.751803149757595 + "timestamp": 7.956207525356469 }, { - "x": 2.9316171268882734, - "y": 2.1040278827992327, - "heading": 0.28432561299758846, - "angularVelocity": -2.97884706699173, - "velocityX": -2.7512173966310405, - "velocityY": -0.922381659572107, + "x": 2.9158909866984235, + "y": 2.0821667981242555, + "heading": 0.3132429551119237, + "angularVelocity": -2.553716014467678, + "velocityX": -2.738293054471397, + "velocityY": -0.9249241692269979, "moduleForcesX": [ - -91.61131397646075, - -43.05897579116841, - -110.38138714948137, - -86.02846628911873 + -87.45802427935932, + -47.53439495990343, + -109.56743396568875, + -68.84720326443009 ], "moduleForcesY": [ - 66.29758480169242, - 103.90780630948875, - -16.716151028622146, - 44.888327667528124 + 70.39136956871182, + 101.06114313793599, + 11.616666431402345, + 77.82924862847288 ], - "timestamp": 7.7860319534626825 + "timestamp": 7.9915170725079365 }, { - "x": 2.8306074922176707, - "y": 2.075651949037232, - "heading": 0.19841183467951823, - "angularVelocity": -2.5099848378663183, - "velocityX": -2.951012706750948, - "velocityY": -0.8290074641980628, + "x": 2.813130962272225, + "y": 2.055368279752934, + "heading": 0.23418363443483467, + "angularVelocity": -2.2390352483974785, + "velocityX": -2.9102617483421525, + "velocityY": -0.7589595600407787, "moduleForcesX": [ - -89.70386834247377, - -44.52299290536978, - -107.42487523747174, - -89.89738881434096 + -78.40481006980207, + -40.22780438179953, + -100.43252391685763, + -57.57268745634338 ], "moduleForcesY": [ - 64.70732173234461, - 99.54624373858115, - -14.542075390297216, - 5.237756642149965 + 73.82616586327488, + 98.43131065637236, + 23.180882849082177, + 71.54098213655774 ], - "timestamp": 7.82026075716777 + "timestamp": 8.026826619659404 }, { - "x": 2.7231266517941735, - "y": 2.0493588330157047, - "heading": 0.12883121858131338, - "angularVelocity": -2.0328088792616628, - "velocityX": -3.1400700225912583, - "velocityY": -0.768157609248157, + "x": 2.706553457092742, + "y": 2.0337946936747824, + "heading": 0.1627246194647116, + "angularVelocity": -2.023787353136663, + "velocityX": -3.018376438595981, + "velocityY": -0.6109845018860041, "moduleForcesX": [ - -87.9046551599776, - -51.259757063971065, - -98.52235017226083, - -76.04326290186813 + -53.32161734417227, + -27.711335290285316, + -62.288742887942306, + -30.59724389816153 ], "moduleForcesY": [ - 54.18397152509916, - 83.80305982182196, - -17.328081982863527, - -19.68202367373811 + 67.01241376252486, + 77.76542044514504, + 39.181093379247706, + 54.08148222744581 ], - "timestamp": 7.854489560872857 + "timestamp": 8.062136166810872 }, { - "x": 2.6102927983385573, - "y": 2.024099226519776, - "heading": 0.07355180792033715, - "angularVelocity": -1.6149968645489394, - "velocityX": -3.2964591584264182, - "velocityY": -0.7379634623966059, + "x": 2.598917102909892, + "y": 2.0145528118758143, + "heading": 0.09531658576945162, + "angularVelocity": -1.9090597057532068, + "velocityX": -3.0483640506948286, + "velocityY": -0.5449484162573617, "moduleForcesX": [ - -78.04506650685977, - -47.29571711822892, - -81.43393391647491, - -52.744292996762205 + -18.63096055061113, + -6.33841193513332, + -18.206732192882292, + -5.0635349091313255 ], "moduleForcesY": [ - 39.432934911244786, - 57.97282153083376, - -20.57597862315234, - -26.724282490767077 + 33.453819907756156, + 35.18716748764008, + 17.975782973252848, + 19.612327167077936 ], - "timestamp": 7.888718364577944 + "timestamp": 8.097445713962339 }, { - "x": 2.4921154225710165, - "y": 2.001809725638736, - "heading": 0.03059095186954446, - "angularVelocity": -1.2551083123132423, - "velocityX": -3.4525710213465097, - "velocityY": -0.6511913496333991, + "x": 2.486855159750872, + "y": 1.9975368200862922, + "heading": 0.03970689745149529, + "angularVelocity": -1.5749193293079313, + "velocityX": -3.1737009449118583, + "velocityY": -0.48190909151338635, "moduleForcesX": [ - -72.26596436397355, - -40.418509412740924, - -86.20843132854587, - -60.16598656238315 + -61.42943838905159, + -32.38825659624322, + -68.59433110233935, + -39.21145043822103 ], "moduleForcesY": [ - 57.346191538492576, - 74.57460703230042, - 3.6372831123236704, - 8.435378772879556 + 45.459912121097865, + 56.69472636631261, + -1.2312044805624582, + 0.48491739775957093 ], - "timestamp": 7.922947168283031 + "timestamp": 8.132755261113806 }, { "x": 2.368211784362792, "y": 1.984554409980774, - "heading": 8.034662982186301e-20, - "angularVelocity": -0.8937195741082333, - "velocityX": -3.619864698625451, - "velocityY": -0.5041168194664591, + "heading": -1.4675807226889294e-19, + "angularVelocity": -1.1245371480173394, + "velocityX": -3.360093373022665, + "velocityY": -0.3676742171129455, "moduleForcesX": [ - -72.02828625966096, - -31.013647911650974, - -100.81064597402042, - -73.76190608413815 + -77.99345741141066, + -36.55913016224614, + -102.6300363207676, + -82.65797442710468 ], "moduleForcesY": [ - 78.69145966069489, - 99.5091808063195, - 20.91580851628405, - 44.94549522070697 + 71.69774957942901, + 95.80128612213636, + 4.935080412204652, + 11.330071286860962 ], - "timestamp": 7.957175971988118 + "timestamp": 8.168064808265273 }, { - "x": 2.0740883254919082, - "y": 1.9753101696961048, - "heading": -0.00004639980947503465, - "angularVelocity": -0.0006259678214478826, - "velocityX": -3.967943465052028, - "velocityY": -0.12471165328920732, + "x": 2.0854065230581886, + "y": 1.9779644877217577, + "heading": -0.00005033208333207429, + "angularVelocity": -0.0006710133266615486, + "velocityX": -3.770281033935705, + "velocityY": -0.08785500946361233, "moduleForcesX": [ - -69.66097734031177, - -12.487145015519467, - -111.66054849173405, - -72.91874659974125 + -76.09798989325385, + -18.90105163423638, + -113.03447520897639, + -102.58200087250829 ], "moduleForcesY": [ - 89.98445533687095, - 112.68237698463479, - 15.840843626758858, - 72.2246809246762 + 84.68950673878201, + 111.74911699583157, + 2.6591962220241836, + 12.79589675698398 ], - "timestamp": 8.03130088366123 + "timestamp": 8.243073874899595 }, { - "x": 1.7803191322924656, - "y": 1.9926744865605654, - "heading": -0.00004639408517515487, - "angularVelocity": 7.72250482405318e-8, - "velocityX": -3.9631641585618773, - "velocityY": 0.23425750496730705, + "x": 1.8029757687698704, + "y": 1.9942197501048913, + "heading": -0.00005032500445291454, + "angularVelocity": 9.43736467786952e-8, + "velocityX": -3.7652882106265917, + "velocityY": 0.2167106339607911, "moduleForcesX": [ - 0.8918110984523644, - 0.9389057010061419, - 0.892237576007421, - 0.939354849523593 + 0.9227533462325225, + 0.9672719038047999, + 0.9231321771109395, + 0.9676691170690845 ], "moduleForcesY": [ - 68.78336233513667, - 68.78303298559312, - 68.75324593515143, - 68.7529163377468 + 57.67635291233299, + 57.67606024665079, + 57.64044491345691, + 57.64015211515086 ], - "timestamp": 8.105425795334341 + "timestamp": 8.318082941533918 }, { - "x": 1.5131720290302764, - "y": 2.0099691813791325, - "heading": -0.00003333596655810217, - "angularVelocity": 0.0001761636988471363, - "velocityX": -3.604012432963096, - "velocityY": 0.23331825196411896, + "x": 1.5293571956388503, + "y": 2.0110799320442485, + "heading": -0.00003697534828095201, + "angularVelocity": 0.00017797390063582162, + "velocityX": -3.647806664025621, + "velocityY": 0.22477525312446503, "moduleForcesX": [ - 68.8005510890561, - 68.80569709908875, - 68.80053097288106, - 68.80567698548711 + 22.23658027365265, + 22.24494188533207, + 22.23663920902371, + 22.245000823990633 ], "moduleForcesY": [ - -0.17268609942219681, - -0.1726722397415803, - -0.1871959394376103, - -0.18718088491320875 + 1.5328008081498175, + 1.5327560088702128, + 1.5207191865207947, + 1.5206747766653563 ], - "timestamp": 8.179550707007452 + "timestamp": 8.39309200816824 }, { - "x": 1.2904630248834932, - "y": 2.02439703559534, - "heading": -0.000022300432809716404, - "angularVelocity": 0.00014887752982495307, - "velocityX": -3.004509538290201, - "velocityY": 0.19464244733035105, + "x": 1.3012535504265574, + "y": 2.025140105667011, + "heading": -0.00002503020492197509, + "angularVelocity": 0.00015924932671420783, + "velocityX": -3.041014312634039, + "velocityY": 0.18744632154013477, "moduleForcesX": [ - 114.84738407657306, - 114.84736831647434, - 114.84756609099593, - 114.84755033754627 + 114.8736602533315, + 114.87365016225685, + 114.87377798798217, + 114.87376789982471 ], "moduleForcesY": [ - -7.410516501125932, - -7.410652114275096, - -7.407685716920552, - -7.40782127867839 + -7.0677703063324575, + -7.067858015952402, + -7.065850186961006, + -7.065937872922886 ], - "timestamp": 8.253675618680564 + "timestamp": 8.468101074802563 }, { - "x": 1.1122650673551955, - "y": 2.0359448751096245, - "heading": -0.000013412613719255738, - "angularVelocity": 0.00011990326719923239, - "velocityX": -2.404022527731901, - "velocityY": 0.15578891432912884, + "x": 1.1187395149624608, + "y": 2.0363917821596864, + "heading": -0.000015175728129877333, + "angularVelocity": 0.0001313771419145834, + "velocityX": -2.43322632387727, + "velocityY": 0.1500042194569254, "moduleForcesX": [ - 115.03590480898393, - 115.03589170672048, - 115.03609915116972, - 115.03608605645235 + 115.06211903061896, + 115.06210747733799, + 115.06229497459297, + 115.06228342780778 ], "moduleForcesY": [ - -7.444648447596588, - -7.444793267880781, - -7.44163982701386, - -7.441784589248835 + -7.089643580069927, + -7.089774685050805, + -7.086782838153691, + -7.086913890620375 ], - "timestamp": 8.327800530353676 + "timestamp": 8.543110141436886 }, { - "x": 0.9786025548038448, - "y": 2.0446082921325717, - "heading": -0.0000067187424189621245, - "angularVelocity": 0.00009030528535147962, - "velocityX": -1.8032063652338362, - "velocityY": 0.11687591698101128, + "x": 0.9818398208294886, + "y": 2.0448321500588227, + "heading": -0.00000764773394984441, + "angularVelocity": 0.00010036112323237913, + "velocityX": -1.8251086205401545, + "velocityY": 0.11252463572546331, "moduleForcesX": [ - 115.09895807541444, - 115.09894593189205, - 115.09915696612956, - 115.0991448304989 + 115.12452826743665, + 115.1245166883893, + 115.1247243120354, + 115.12471274104529 ], "moduleForcesY": [ - -7.456071244645336, - -7.456219470556505, - -7.452996933892072, - -7.453145099192222 + -7.0968936617396485, + -7.097039766327108, + -7.093709293863361, + -7.09385533338332 ], - "timestamp": 8.401925442026787 + "timestamp": 8.618119208071208 }, { - "x": 0.8894876979156582, - "y": 2.050385080566063, - "heading": -0.00000224293120630737, - "angularVelocity": 0.000060382010738750023, - "velocityX": -1.202225471528075, - "velocityY": 0.07793315773480675, + "x": 0.8905667965047449, + "y": 2.0504598078795286, + "heading": -0.0000025652413529172724, + "angularVelocity": 0.00006775837675337155, + "velocityX": -1.2168265573775296, + "velocityY": 0.07502636778758441, "moduleForcesX": [ - 115.13051439212589, - 115.13050274279996, - 115.13071565345948, - 115.13070401220862 + 115.15563860808672, + 115.15562710583616, + 115.15584481568848, + 115.15583332234814 ], "moduleForcesY": [ - -7.461789005484244, - -7.461939008917187, - -7.458680439114321, - -7.458830380578413 + -7.100508735512452, + -7.10066242885229, + -7.0971609631741455, + -7.097314584597493 ], - "timestamp": 8.476050353699899 + "timestamp": 8.693128274705531 }, { - "x": 0.8449278259277327, - "y": 2.053273916244506, - "heading": 1.1657882349600636e-23, - "angularVelocity": 0.00003025880443808967, - "velocityX": -0.6011457009815157, - "velocityY": 0.0389725345128547, + "x": 0.8449278259277329, + "y": 2.053273916244507, + "heading": -4.943196764260765e-17, + "angularVelocity": 0.00003419908376374945, + "velocityX": -0.6084460535885156, + "velocityY": 0.037516909505028215, "moduleForcesX": [ - 115.14945546462411, - 115.14944411679562, - 115.14965818232656, - 115.14964684268682 + 115.17427159991368, + 115.17426017282052, + 115.1744839399641, + 115.17447252231639 ], "moduleForcesY": [ - -7.465221209099063, - -7.4653723034649175, - -7.462091590233946, - -7.462242621788996 + -7.102674189928534, + -7.102832461784182, + -7.099227889075101, + -7.099386084718906 ], - "timestamp": 8.55017526537301 + "timestamp": 8.768137341339854 }, { "x": 0.8449278259277335, "y": 2.053273916244507, - "heading": 1.8876778820126578e-23, - "angularVelocity": 9.40052478351043e-24, - "velocityX": 1.7951476472942267e-21, - "velocityY": 6.283263153886402e-21, + "heading": -4.998402134118911e-17, + "angularVelocity": -7.358356992609877e-18, + "velocityX": 3.54800413086263e-17, + "velocityY": 1.645945977459796e-17, "moduleForcesX": [ - 115.16208523948659, - 115.1620740948824, - 115.16228894450373, - 115.16227780816573 + 115.18667894938693, + 115.1866675847214, + 115.18689539353758, + 115.18688403868421 ], "moduleForcesY": [ - -7.467509839682914, - -7.467661670085734, - -7.464365943620278, - -7.464517710638055 + -7.104116229492631, + -7.104277561224099, + -7.10060401849292, + -7.100765271069628 ], - "timestamp": 8.624300177046122 + "timestamp": 8.843146407974176 }, { - "x": 0.8569672656897795, - "y": 2.065243087486579, - "heading": 0.026477656081364466, - "angularVelocity": 0.5490817512048349, - "velocityX": 0.24966849964948779, - "velocityY": 0.24821130261198687, + "x": 0.8574965729428564, + "y": 2.0646337327234905, + "heading": 0.03107052400011723, + "angularVelocity": 0.6347005774884072, + "velocityX": 0.2567510927355298, + "velocityY": 0.2320553744470217, "moduleForcesX": [ - 16.351962141394313, - 71.19396438514677, - 92.80128040966142, - 113.73960028992643 + 10.01880185007666, + 70.51132465323059, + 102.56695754062756, + 114.81418680623135 ], "moduleForcesY": [ - 114.21971244136823, - 90.82485498148876, - 68.01973967114503, - 19.30605442568154 + 114.950324597259, + 91.35804066457668, + 51.6570361197242, + 11.291141103086447 ], - "timestamp": 8.672521878137562 + "timestamp": 8.892099449931484 }, { - "x": 0.8810748266084533, - "y": 2.0892962989602575, - "heading": 0.07923424971643432, - "angularVelocity": 1.0940425667487266, - "velocityX": 0.49993178119037013, - "velocityY": 0.49880470678682487, + "x": 0.8825796369390675, + "y": 2.087613119693452, + "heading": 0.09306766699787188, + "angularVelocity": 1.2664615010405897, + "velocityX": 0.5123903028885677, + "velocityY": 0.4694169360387412, "moduleForcesX": [ - 16.952727334297226, - 69.20082557973143, - 96.11819363500824, - 112.515659702126 + 10.47765662313607, + 67.98037553526417, + 104.41762909212838, + 113.74547934290659 ], "moduleForcesY": [ - 114.11666490770641, - 92.33900074478456, - 63.28910350060908, - 25.431491565283945 + 114.89176486956586, + 93.24160102494326, + 48.08504143345789, + 19.19496564492602 ], - "timestamp": 8.720743579229003 + "timestamp": 8.941052491888792 }, { - "x": 0.9172027316907112, - "y": 2.1256086815595694, - "heading": 0.1583120039487254, - "angularVelocity": 1.6398789848234328, - "velocityX": 0.7492042848872142, - "velocityY": 0.7530298968602241, + "x": 0.9200156351341261, + "y": 2.122583149166543, + "heading": 0.18602557591039684, + "angularVelocity": 1.8989199689284813, + "velocityX": 0.7647328275983716, + "velocityY": 0.7143586604314295, "moduleForcesX": [ - 17.450975110192726, - 66.36796972826151, - 99.18005096251873, - 110.62136417389704 + 10.835990162849878, + 64.39521228962572, + 105.82062633961313, + 111.7441294446777 ], "moduleForcesY": [ - 114.0195685641478, - 94.37769509418555, - 58.40834177103907, - 32.64856908645179 + 114.83217133083784, + 95.73186682917266, + 45.08688416711994, + 28.55780146288301 ], - "timestamp": 8.768965280320444 + "timestamp": 8.9900055338461 }, { - "x": 0.9652072071826819, - "y": 2.1745030635707607, - "heading": 0.2634944034451186, - "angularVelocity": 2.181225405071049, - "velocityX": 0.9954952729880217, - "velocityY": 1.0139497550796635, + "x": 0.9695320661427651, + "y": 2.1701686644794913, + "heading": 0.30917272793451045, + "angularVelocity": 2.515617969798724, + "velocityX": 1.0115087648976933, + "velocityY": 0.9720645215891337, "moduleForcesX": [ - 18.76552093219475, - 62.90451804858331, - 100.67752020321791, - 107.76084632499483 + 12.632263455497991, + 60.105084170150185, + 105.28692632368393, + 108.31270835051731 ], "moduleForcesY": [ - 113.77796058506851, - 96.69530558377411, - 55.80693345276955, - 41.05968567979955 + 114.60669150952644, + 98.45078742534218, + 46.40569830649411, + 39.5559224830126 ], - "timestamp": 8.817186981411885 + "timestamp": 9.038958575803408 }, { - "x": 1.024884581648233, - "y": 2.236511376699377, - "heading": 0.3933543401994364, - "angularVelocity": 2.6929770998345655, - "velocityX": 1.2375626142343528, - "velocityY": 1.2859005743292329, + "x": 1.0308267645231524, + "y": 2.231318730759998, + "heading": 0.45926600651888, + "angularVelocity": 3.066066429850625, + "velocityX": 1.2521121452256427, + "velocityY": 1.2491576383652396, "moduleForcesX": [ - 22.65425748350341, - 59.32922192701658, - 99.73769034374716, - 103.41216352884265 + 19.193520071956605, + 56.10759630193776, + 101.40533999072578, + 102.46843648842588 ], "moduleForcesY": [ - 113.01690644978095, - 98.89044870030656, - 57.46401329173098, - 50.96198665871151 + 113.62114180064377, + 100.72951118396574, + 54.37613435033577, + 52.78756994817754 ], - "timestamp": 8.865408682503325 + "timestamp": 9.087911617760716 }, { - "x": 1.0960548796882106, - "y": 2.312397535168875, - "heading": 0.5435432001069115, - "angularVelocity": 3.114549186530728, - "velocityX": 1.475897706408573, - "velocityY": 1.5736931039740263, + "x": 1.1037024313475479, + "y": 2.307290579447881, + "heading": 0.6271959399792888, + "angularVelocity": 3.430428973277341, + "velocityX": 1.4886851543970687, + "velocityY": 1.5519331516196186, "moduleForcesX": [ - 32.460220381339624, - 57.02616538718768, - 94.82880396936191, - 96.42189325761602 + 37.36459510931641, + 55.56603305352279, + 90.23982224732244, + 91.32795604337164 ], "moduleForcesY": [ - 110.51663143062805, - 100.16824143861544, - 65.2081472861442, - 63.10043038238427 + 108.87903315382371, + 100.91772809940203, + 71.34020881103348, + 70.17696973203493 ], - "timestamp": 8.913630383594766 + "timestamp": 9.136864659718023 }, { - "x": 1.1786024294028, - "y": 2.403062734591481, - "heading": 0.7036429510395898, - "angularVelocity": 3.320076797562315, - "velocityX": 1.7118340466268027, - "velocityY": 1.8801742238557946, + "x": 1.187707501106803, + "y": 2.399089644687687, + "heading": 0.7901423770708541, + "angularVelocity": 3.328627406518933, + "velocityX": 1.7160337008812905, + "velocityY": 1.8752474120592397, "moduleForcesX": [ - 52.9976189734206, - 60.19075395749276, - 81.71816250502049, - 83.00503571063987 + 72.95352245157491, + 71.99046256490783, + 60.63508035638164, + 58.216090033997624 ], "moduleForcesY": [ - 102.13208160331293, - 98.14890485863742, - 80.96099716076793, - 79.76492813288964 + 88.84114045026165, + 89.5505221979616, + 97.67708800823013, + 99.07653571926552 ], - "timestamp": 8.961852084686207 + "timestamp": 9.185817701675331 }, { - "x": 1.2717031857076855, - "y": 2.5087575451409125, - "heading": 0.8486594006388647, - "angularVelocity": 3.007286062436618, - "velocityX": 1.9306817096382076, - "velocityY": 2.191851555568453, + "x": 1.2794923725931218, + "y": 2.5054213017641063, + "heading": 0.9137721346902739, + "angularVelocity": 2.525476511290922, + "velocityX": 1.874957465686411, + "velocityY": 2.1721154155194395, "moduleForcesX": [ - 83.21974573343562, - 85.65094183317885, - 49.621826400399556, - 39.29014814005943 + 88.63793057003053, + 103.9640948222794, + 18.832032863293776, + -27.032970661587502 ], "moduleForcesY": [ - 79.26870386093087, - 76.33230295247044, - 103.68667351103069, - 107.83989683014447 + 72.95986689469186, + 46.946807871504056, + 113.3127603108155, + 111.23995258635053 ], - "timestamp": 9.010073785777648 + "timestamp": 9.23477074363264 }, { - "x": 1.3727268361355833, - "y": 2.6272614661882607, - "heading": 0.9491088124473993, - "angularVelocity": 2.0830748301072264, - "velocityX": 2.0949831329328408, - "velocityY": 2.457481141584661, + "x": 1.3793855062107108, + "y": 2.6252569658957277, + "heading": 0.993407142079515, + "angularVelocity": 1.6267632041884466, + "velocityX": 2.0405909341728408, + "velocityY": 2.4479717570665778, "moduleForcesX": [ - 93.77065830212727, - 111.5099038574192, - 19.72183059871037, - -31.4702448610942 + 91.60388970964502, + 109.76906836890673, + 18.87138570722908, + -28.05790918727498 ], "moduleForcesY": [ - 66.15966523066282, - 23.807930537003287, - 113.08653442297255, - 109.83338652042379 + 68.56174974089363, + 28.56360796309666, + 112.87874340003955, + 110.07521153608074 ], - "timestamp": 9.058295486869088 + "timestamp": 9.283723785589947 }, { - "x": 1.4822864000255587, - "y": 2.7584095182646564, - "heading": 1.0069014705840629, - "angularVelocity": 1.1984782126842373, - "velocityX": 2.2719970762172372, - "velocityY": 2.7196894574022776, + "x": 1.4883720535567364, + "y": 2.757792536136217, + "heading": 1.0302422866644179, + "angularVelocity": 0.7524587464253547, + "velocityX": 2.226348823035134, + "velocityY": 2.7074021334802443, "moduleForcesX": [ - 94.29329121436436, - 111.33690202203805, - 23.524890313414957, - -20.64874218877574 + 94.42592705513906, + 110.18950347508573, + 25.62143662023805, + -14.69983417505771 ], "moduleForcesY": [ - 64.60956935693747, - 21.14398791701532, - 111.83418988380892, - 111.26982412256342 + 62.64193597383056, + 18.18445445993043, + 110.26196922217056, + 109.93171512187207 ], - "timestamp": 9.10651718796053 + "timestamp": 9.332676827547255 }, { - "x": 1.6008769781145331, - "y": 2.9015305147589388, - "heading": 1.0230775694802563, - "angularVelocity": 0.3354526806410118, - "velocityX": 2.4592781964306085, - "velocityY": 2.967979006441265, + "x": 1.6073319975777907, + "y": 2.898457418435302, + "heading": 1.0315234097906527, + "angularVelocity": 0.02617044978244855, + "velocityX": 2.430082774526686, + "velocityY": 2.8734656045848084, "moduleForcesX": [ - 95.44964108875462, - 109.9073464646586, - 27.566804981908373, - -12.323649647427327 + 91.86525254968076, + 92.36401864504138, + 38.39021742136879, + 13.775378324910177 ], "moduleForcesY": [ - 60.09889909493574, - 14.224846797408755, - 109.19219744802835, - 108.94658536069632 + 39.180203480228606, + -7.300594234141006, + 88.73734094363414, + 72.068421433988 ], - "timestamp": 9.15473888905197 + "timestamp": 9.381629869504563 }, { - "x": 1.7085853910767748, - "y": 3.042823929898296, - "heading": 1.062138319509375, - "angularVelocity": 0.810024307418135, - "velocityX": 2.233608738895347, - "velocityY": 2.930079444344529, + "x": 1.7162575662900155, + "y": 3.0397405651243345, + "heading": 1.0497080350999417, + "angularVelocity": 0.37147079287016466, + "velocityX": 2.225103167380434, + "velocityY": 2.8860953484648526, "moduleForcesX": [ - -86.9590857830949, - -78.5889566184507, - -55.780064272243294, - -44.49000954099238 + -75.77307716623498, + -66.09588436894305, + -54.266078380096815, + -41.705175729701644 ], "moduleForcesY": [ - -12.094864031659382, - 25.4856045183075, - -50.988845663446746, - -7.044135345915785 + 0.7831305875666112, + 27.97723607278229, + -24.048273245185072, + 9.94234489604884 ], - "timestamp": 9.20296059014341 + "timestamp": 9.43058291146187 }, { - "x": 1.806206643264022, - "y": 3.1721894754099607, - "heading": 1.1384146361794218, - "angularVelocity": 1.581784029671771, - "velocityX": 2.024425724885398, - "velocityY": 2.682724636079387, + "x": 1.8140080456118037, + "y": 3.170234255344365, + "heading": 1.1079057402275676, + "angularVelocity": 1.1888475731166737, + "velocityX": 1.996821349878699, + "velocityY": 2.6656911400507988, "moduleForcesX": [ - -95.99744403653119, - -111.3725567730494, - -31.38288895815133, - -7.645693964257284 + -101.22591211460183, + -111.27282203858992, + -38.06118753259128, + -14.318118907330136 ], "moduleForcesY": [ - -60.243116496949554, - -13.253824008375362, - -108.5069453108687, - -109.35760318563328 + -49.58576299702025, + 4.478519885777167, + -105.37871989885554, + -105.25159638947153 ], - "timestamp": 9.251182291234851 + "timestamp": 9.479535953419179 }, { - "x": 1.894121759346281, - "y": 3.288248837696075, - "heading": 1.2476017343094008, - "angularVelocity": 2.264273048413032, - "velocityX": 1.8231442295150255, - "velocityY": 2.4067869788756653, + "x": 1.9012518038388722, + "y": 3.287882996112528, + "heading": 1.2021912169050675, + "angularVelocity": 1.9260391777026817, + "velocityX": 1.7821927859701392, + "velocityY": 2.4032978556520344, "moduleForcesX": [ - -89.71754326673906, - -109.70942329970309, - -25.64471250802308, - -12.01963364731208 + -94.27122591184543, + -111.9395692297356, + -29.7277424462474, + -13.09747450271598 ], "moduleForcesY": [ - -71.02373862357867, - -30.590752966210808, - -111.31663378024956, - -112.0983625887034 + -64.43873357807499, + -18.973143563435727, + -109.98053661317853, + -111.0655575237677 ], - "timestamp": 9.299403992326292 + "timestamp": 9.528488995376486 }, { - "x": 1.9727722110540435, - "y": 3.3902029354711782, - "heading": 1.3865475571211665, - "angularVelocity": 2.8813961280272613, - "velocityX": 1.6310177768017946, - "velocityY": 2.1142783325244228, + "x": 1.9786102964253314, + "y": 3.391445072486045, + "heading": 1.3285417326754196, + "angularVelocity": 2.5810554506610948, + "velocityX": 1.5802591522928626, + "velocityY": 2.115539141830753, "moduleForcesX": [ - -83.56953629253536, - -107.14229823866022, - -19.083654622703264, - -16.5120151625824 + -86.9404428642643, + -108.8981374272585, + -22.521649868470654, + -15.945707139978866 ], "moduleForcesY": [ - -78.71040904165848, - -40.388808530169634, - -113.04273071952846, - -112.4066592111603 + -74.77427758993828, + -34.72614750627809, + -112.25694545994725, + -112.13240268430516 ], - "timestamp": 9.347625693417733 + "timestamp": 9.577442037333794 }, { - "x": 2.042803808199141, - "y": 3.477607450988946, - "heading": 1.5541659107318062, - "angularVelocity": 3.4759942062763747, - "velocityX": 1.4522838381893517, - "velocityY": 1.8125556241167515, + "x": 2.0467978535870746, + "y": 3.4801843218746016, + "heading": 1.484784100975893, + "angularVelocity": 3.1916784341355413, + "velocityX": 1.3929176704103385, + "velocityY": 1.8127422902839905, "moduleForcesX": [ - -77.64221219396589, - -106.14720313378757, - -8.338017165682224, - -18.404907081955013 + -80.10960219579854, + -106.45822211547039, + -13.149875930332756, + -17.65679408261992 ], "moduleForcesY": [ - -84.81783816234807, - -43.73643202943646, - -114.52616360787027, - -112.32150159790285 + -82.37686544038085, + -42.631112459868845, + -113.98755478586436, + -112.34316617833551 ], - "timestamp": 9.395847394509174 + "timestamp": 9.626395079291102 }, { - "x": 2.1033826262076065, - "y": 3.550155624544787, - "heading": 1.7432921394058938, - "angularVelocity": 3.9220148686885787, - "velocityX": 1.2562563459466602, - "velocityY": 1.5044714705993274, + "x": 2.1067771502269776, + "y": 3.5537494938021474, + "heading": 1.670997490742332, + "angularVelocity": 3.8039186600259614, + "velocityX": 1.225241460809306, + "velocityY": 1.5027701851378008, "moduleForcesX": [ - -70.91594042910828, - -101.15910205833582, - -9.707383087632953, - -49.1201488511403 + -73.34437651796223, + -106.15263304185436, + 2.413642008170467, + -17.473283255047654 ], "moduleForcesY": [ - -90.63705631390823, - -54.64864966949406, - -114.5024627557604, - -103.10697098452272 + -88.6335893943357, + -43.97011401265027, + -114.84297204098115, + -112.21755339067951 ], - "timestamp": 9.444069095600614 + "timestamp": 9.67534812124841 }, { - "x": 2.152607740204923, - "y": 3.607801077995203, - "heading": 1.9261463477817098, - "angularVelocity": 3.7919485260189596, - "velocityX": 1.0208083266074068, - "velocityY": 1.195425547952053, + "x": 2.1557185257205664, + "y": 3.611706742126399, + "heading": 1.8675660562205407, + "angularVelocity": 4.015451494304166, + "velocityX": 0.9997616805266244, + "velocityY": 1.1839355841054042, "moduleForcesX": [ - -71.44382936842356, - -54.31445565209966, - -82.52029843395653, - -69.05779006643566 + -67.41409192098914, + -86.37446768247753, + -41.076314753076424, + -66.76192995165273 ], "moduleForcesY": [ - -90.14981383751513, - -101.45774094468433, - -80.2741248199996, - -92.14633676825402 + -93.25513893490984, + -75.94459361264344, + -107.35908537802607, + -93.3886676822394 ], - "timestamp": 9.492290796692055 + "timestamp": 9.724301163205718 }, { - "x": 2.190788381486093, - "y": 3.651400600452789, - "heading": 2.090948780206684, - "angularVelocity": 3.4175988962410573, - "velocityX": 0.7917730071108338, - "velocityY": 0.9041473334777186, + "x": 2.1932474586006316, + "y": 3.65462041068866, + "heading": 2.050511149008698, + "angularVelocity": 3.7371547399996508, + "velocityX": 0.7666312731477015, + "velocityY": 0.8766292521689998, "moduleForcesX": [ - -90.79606858393824, - -18.55584251040676, - -96.57736445012134, - -63.853520232036104 + -80.55920555192586, + -32.49392465665238, + -92.09950834240892, + -65.3512771134131 ], "moduleForcesY": [ - -70.53849669010287, - -113.64992224377944, - -62.92180680397964, - -95.98904481306892 + -82.02909062643297, + -110.42446436352448, + -69.20864919881635, + -94.9088970753719 ], - "timestamp": 9.540512497783496 + "timestamp": 9.773254205163026 }, { - "x": 2.2183045677010402, - "y": 3.682483763115444, - "heading": 2.2264269947581963, - "angularVelocity": 2.80948642385323, - "velocityX": 0.570618323123221, - "velocityY": 0.6445886801818393, + "x": 2.219811592242873, + "y": 3.684386183378235, + "heading": 2.2045411597277322, + "angularVelocity": 3.1464849692765178, + "velocityX": 0.5426452081477267, + "velocityY": 0.608047457341234, "moduleForcesX": [ - -110.71850311742375, - 6.332456186499907, - -98.8317602170274, - -57.28231604872353 + -108.75425048256633, + 5.385270544240483, + -98.73724209101452, + -57.787407111346226 ], "moduleForcesY": [ - -31.162381403627016, - -115.02092054012306, - -59.44262986998008, - -100.1105777694302 + -37.23491686496145, + -115.04201778008925, + -59.561331885625044, + -99.80030517652003 ], - "timestamp": 9.588734198874937 + "timestamp": 9.822207247120334 }, { - "x": 2.2359647168279775, - "y": 3.7023940350495996, - "heading": 2.322570970138052, - "angularVelocity": 1.9937906213126328, - "velocityX": 0.3662282484280048, - "velocityY": 0.41289028556666507, + "x": 2.236530898648883, + "y": 3.703097894493539, + "heading": 2.3149477414372774, + "angularVelocity": 2.2553569154258097, + "velocityX": 0.341537639684345, + "velocityY": 0.38223796456182474, "moduleForcesX": [ - -115.10010865685537, - 24.884078394615532, - -98.81097200345764, - -51.72593444923844 + -114.57748285843158, + 31.6917140634627, + -99.3989192581002, + -51.062756198042344 ], "moduleForcesY": [ - 2.2494262109699688, - -112.50306629791393, - -59.54291982558333, - -103.12309638155047 + 10.74305716556114, + -110.76286660417196, + -58.543037707713566, + -103.44652639602133 ], - "timestamp": 9.636955899966377 + "timestamp": 9.871160289077642 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": 1.041427943793603, - "velocityX": 0.17807293718407943, - "velocityY": 0.199266250731892, + "angularVelocity": 1.1815947161180913, + "velocityX": 0.163846776586212, + "velocityY": 0.18191102692862865, "moduleForcesX": [ - -113.18697740525452, - 38.58269845532561, - -98.77375749286766, - -48.251824048408885 + -109.59554076157117, + 49.71533486232882, + -99.47986509601193, + -46.81669841993476 ], "moduleForcesY": [ - 21.426140041828702, - -108.59855539761742, - -59.643832900298754, - -104.81345448783512 + 35.44227192984209, + -103.9680438489712, + -58.45523278702017, + -105.46066453849079 ], - "timestamp": 9.685177601057818 + "timestamp": 9.92011333103495 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": -5.850639937158215e-24, - "velocityX": -1.5909300119313646e-23, - "velocityY": -7.26803393218573e-24, + "angularVelocity": 5.839447282391598e-18, + "velocityX": -3.299113784734962e-17, + "velocityY": -5.057039344587014e-17, "moduleForcesX": [ - -110.17194913173422, - 47.48175193227342, - -99.60618042375734, - -47.457362329423724 + -103.80869333848717, + 60.02004315909284, + -100.4607086019751, + -45.86395648223105 ], "moduleForcesY": [ - 33.78870027617767, - -105.04769902960695, - -58.26901613919847, - -105.18952275403072 + 50.030394045050265, + -98.4252138448354, + -56.78405771282525, + -105.89459694302894 ], - "timestamp": 9.733399302149259 + "timestamp": 9.969066372992257 } ], "trajectoryWaypoints": [ @@ -22306,10 +22516,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 24 + "controlIntervalCount": 25 }, { - "timestamp": 2.38711147698668, + "timestamp": 2.4652464028225958, "isStopPoint": true, "x": 7.84, "y": 0.7302065491676331, @@ -22317,10 +22527,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 20 + "controlIntervalCount": 21 }, { - "timestamp": 4.011219951795511, + "timestamp": 4.1244955929906855, "isStopPoint": true, "x": 3.6428947830200187, "y": 2.305847644805908, @@ -22331,7 +22541,7 @@ "controlIntervalCount": 17 }, { - "timestamp": 4.913702934227492, + "timestamp": 5.052789787594332, "isStopPoint": false, "x": 6.181192436218261, "y": 1.6887441873550415, @@ -22342,7 +22552,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 5.638101156412266, + "timestamp": 5.788908447735173, "isStopPoint": true, "x": 7.84, "y": 2.248577356338501, @@ -22353,7 +22563,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 6.307552888523836, + "timestamp": 6.469073909526504, "isStopPoint": false, "x": 6.11539939880371, "y": 1.7113943099975586, @@ -22364,7 +22574,7 @@ "controlIntervalCount": 17 }, { - "timestamp": 7.272599897886376, + "timestamp": 7.461873865235917, "isStopPoint": true, "x": 3.5725870513916007, "y": 2.415215253829956, @@ -22375,7 +22585,7 @@ "controlIntervalCount": 20 }, { - "timestamp": 7.957175971988118, + "timestamp": 8.168064808265273, "isStopPoint": false, "x": 2.368211784362792, "y": 1.984554409980774, @@ -22386,7 +22596,7 @@ "controlIntervalCount": 9 }, { - "timestamp": 8.624300177046122, + "timestamp": 8.843146407974176, "isStopPoint": true, "x": 0.8449278259277335, "y": 2.053273916244507, @@ -22397,7 +22607,7 @@ "controlIntervalCount": 23 }, { - "timestamp": 9.733399302149259, + "timestamp": 9.969066372992257, "isStopPoint": true, "x": 2.244551696777343, "y": 3.712002992630005, @@ -22474,7 +22684,7 @@ "name": "intake", "target": 2, "trajTargetIndex": 2, - "targetTimestamp": 4.011219951795511, + "targetTimestamp": 4.1244955929906855, "offset": 0.4, "command": { "type": "named", @@ -22487,7 +22697,7 @@ "name": "intake", "target": 6, "trajTargetIndex": 6, - "targetTimestamp": 7.272599897886376, + "targetTimestamp": 7.461873865235917, "offset": 0.5, "command": { "type": "named", diff --git a/src/main/deploy/choreo/Blue 4 to 5.1.traj b/src/main/deploy/choreo/Blue 4 to 5.1.traj index b3c8434..5e46076 100644 --- a/src/main/deploy/choreo/Blue 4 to 5.1.traj +++ b/src/main/deploy/choreo/Blue 4 to 5.1.traj @@ -1,12 +1,12 @@ { "samples": [ { - "x": 7.84, - "y": 7.477, + "x": 7.839999999999999, + "y": 7.4769999999999985, "heading": 3.141592653589793, - "angularVelocity": -1.0078113021558393e-27, - "velocityX": -1.8654023532984683e-16, - "velocityY": 9.408878607423118e-17, + "angularVelocity": -3.2554108069074945e-28, + "velocityX": -6.245095151781063e-16, + "velocityY": -4.52955156548901e-16, "moduleForcesX": [ 0, 0, @@ -22,361 +22,361 @@ "timestamp": 0 }, { - "x": 7.7888178205593785, - "y": 7.4097114166852736, + "x": 7.789048065389168, + "y": 7.409336319308564, "heading": 3.141592653589793, - "angularVelocity": -1.6796175146434201e-16, - "velocityX": -0.5018399951667901, - "velocityY": -0.6597628841614104, + "angularVelocity": -2.211714817370884e-16, + "velocityX": -0.49911336409084806, + "velocityY": -0.6628177625545706, "moduleForcesX": [ - -69.87246936994154, - -69.87246936994154, - -69.87246936994154, - -69.87246936994154 + -69.42758277694902, + -69.42758277694902, + -69.42758277694902, + -69.42758277694902 ], "moduleForcesY": [ - -91.86047815823733, - -91.86047815823733, - -91.86047815823733, - -91.86047815823733 + -92.19916433110346, + -92.19916433110346, + -92.19916433110346, + -92.19916433110346 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654473 }, { - "x": 7.6864968515181165, - "y": 7.275117557134651, + "x": 7.687176089149893, + "y": 7.27400074357171, "heading": 3.141592653589793, - "angularVelocity": -2.2017382616870134e-16, - "velocityX": -1.0032545540329136, - "velocityY": -1.3196894419992158, + "angularVelocity": -6.966527683706636e-17, + "velocityX": -0.9979143119049332, + "velocityY": -1.325715991020111, "moduleForcesX": [ - -69.81323478288708, - -69.81323478288708, - -69.81323478288708, - -69.81323478288706 + -69.38412510090812, + -69.38412510090812, + -69.38412510090812, + -69.38412510090812 ], "moduleForcesY": [ - -91.8832668638928, - -91.8832668638928, - -91.8832668638928, - -91.8832668638928 + -92.21035728659811, + -92.21035728659811, + -92.21035728659811, + -92.21035728659811 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308946 }, { - "x": 7.533123855655458, - "y": 7.073185098303809, + "x": 7.534447902717691, + "y": 7.070976830585042, "heading": 3.141592653589793, - "angularVelocity": -1.7392229984228028e-16, - "velocityX": -1.5038184060088011, - "velocityY": -1.9799427314568734, + "angularVelocity": -6.814239332649433e-17, + "velocityX": -1.4960899817445545, + "velocityY": -1.98877528351538, "moduleForcesX": [ - -69.69478868116059, - -69.69478868116057, - -69.69478868116059, - -69.69478868116057 + -69.29714778996903, + -69.29714778996902, + -69.29714778996902, + -69.29714778996902 ], "moduleForcesY": [ - -91.92875854512678, - -91.9287585451268, - -91.9287585451268, - -91.9287585451268 + -92.23276158792476, + -92.23276158792477, + -92.23276158792477, + -92.23276158792477 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596342 }, { - "x": 7.3289589167676406, - "y": 6.803814589003351, + "x": 7.331055401569866, + "y": 6.800215073826195, "heading": 3.141592653589793, - "angularVelocity": -5.667150978731249e-17, - "velocityX": -2.0018321428383743, - "velocityY": -2.6411711373500846, + "angularVelocity": -1.4682205756281464e-16, + "velocityX": -1.9923858878859297, + "velocityY": -2.652319530447951, "moduleForcesX": [ - -69.33972961029974, - -69.33972961029976, - -69.33972961029976, - -69.33972961029976 + -69.03566921838791, + -69.03566921838791, + -69.03566921838791, + -69.03566921838791 ], "moduleForcesY": [ - -92.06452650682208, - -92.06452650682208, - -92.06452650682208, - -92.06452650682206 + -92.30021963767099, + -92.30021963767099, + -92.30021963767099, + -92.30021963767098 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461789 }, { - "x": 7.139460037725265, - "y": 6.468344823148688, + "x": 7.1379039546368785, + "y": 6.467543964285728, "heading": 3.141592653589793, - "angularVelocity": -8.184523729481644e-16, - "velocityX": -1.8580317911802808, - "velocityY": -3.289272702238152, + "angularVelocity": 7.91591288584586e-18, + "velocityX": -1.8920668899735504, + "velocityY": -3.258769228032236, "moduleForcesX": [ - 20.02169170195439, - 20.021691701955483, - 20.021691701954257, - 20.021691701955366 + 13.954556287044939, + 13.954556287044953, + 13.954556287044939, + 13.954556287044952 ], "moduleForcesY": [ - -90.23684277379594, - -90.23684277379569, - -90.23684277379519, - -90.23684277379493 + -84.35826329061041, + -84.35826329061041, + -84.3582632906104, + -84.3582632906104 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327236 }, { - "x": 7.001680309142067, - "y": 6.199601477600121, + "x": 6.99919068598312, + "y": 6.1995387188725335, "heading": 3.141592653589793, - "angularVelocity": -4.434581900264256e-16, - "velocityX": -1.35092680854653, - "velocityY": -2.6350218123795046, + "angularVelocity": 1.9046475496251705e-16, + "velocityX": -1.3588030894265215, + "velocityY": -2.625317383015404, "moduleForcesX": [ - 70.60552707551508, - 70.60552707551507, - 70.60552707551507, - 70.60552707551507 + 74.17797101404966, + 74.17797101404965, + 74.17797101404965, + 74.17797101404966 ], "moduleForcesY": [ - 91.09302905748419, - 91.0930290574842, - 91.0930290574842, - 91.09302905748422 + 88.11431143550178, + 88.11431143550178, + 88.11431143550178, + 88.11431143550178 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192683 }, { - "x": 6.915423136802039, - "y": 5.997836583842572, + "x": 6.912972996962741, + "y": 5.997942442570267, "heading": 3.141592653589793, - "angularVelocity": -5.095379692959289e-16, - "velocityX": -0.8457494273056122, - "velocityY": -1.9782997600863537, + "angularVelocity": 7.847677166577354e-17, + "velocityX": -0.844568535807801, + "velocityY": -1.974790484833519, "moduleForcesX": [ - 70.33714219082988, - 70.33714219082987, - 70.33714219082988, - 70.33714219082988 + 71.53096792553119, + 71.53096792553119, + 71.53096792553119, + 71.53096792553119 ], "moduleForcesY": [ - 91.43709533984699, - 91.43709533984699, - 91.43709533984699, - 91.437095339847 + 90.48948259361241, + 90.4894825936124, + 90.4894825936124, + 90.48948259361241 ], - "timestamp": 0.713923281394681 + "timestamp": 0.714594254405813 }, { - "x": 6.88062147565552, - "y": 5.863134773678263, + "x": 6.878725057136558, + "y": 5.863208583334528, "heading": 3.141592653589793, - "angularVelocity": -5.663091225441964e-16, - "velocityX": -0.3412294211072634, - "velocityY": -1.3207478950795901, + "angularVelocity": 1.5385501117605214e-16, + "velocityX": -0.3354848955240767, + "velocityY": -1.3198217153806693, "moduleForcesX": [ - 70.24561417800437, - 70.24561417800437, - 70.24561417800437, - 70.24561417800437 + 70.81446644981058, + 70.81446644981058, + 70.81446644981058, + 70.81446644981058 ], "moduleForcesY": [ - 91.55263229179072, - 91.55263229179073, - 91.55263229179073, - 91.55263229179073 + 91.10735502004157, + 91.10735502004157, + 91.10735502004157, + 91.10735502004157 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923577 }, { - "x": 6.897241402633118, - "y": 5.79553856220569, + "x": 6.896202051935022, + "y": 5.7955456681406865, "heading": 3.141592653589793, - "angularVelocity": -5.961242927880675e-16, - "velocityX": 0.16295797024033917, - "velocityY": -0.6627791705906017, + "angularVelocity": 1.623217608850538e-17, + "velocityX": 0.17120059787260816, + "velocityY": -0.6628102639184268, "moduleForcesX": [ - 70.1993033594393, - 70.19930335943928, - 70.1993033594393, - 70.19930335943928 + 70.48087982705123, + 70.48087982705123, + 70.48087982705123, + 70.48087982705123 ], "moduleForcesY": [ - 91.61067270642351, - 91.61067270642351, - 91.61067270642351, - 91.61067270642351 + 91.39149582750018, + 91.39149582750018, + 91.39149582750018, + 91.39149582750018 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789024 }, { - "x": 6.965262451171874, - "y": 5.795073509216309, + "x": 6.965262451171875, + "y": 5.79507350921631, "heading": 3.141592653589793, - "angularVelocity": -7.988770368986943e-16, - "velocityX": 0.6669446874477116, - "velocityY": -0.004559832982767937, + "angularVelocity": 5.88565809839424e-17, + "velocityX": 0.6764996943067185, + "velocityY": -0.004625159592674305, "moduleForcesX": [ - 70.1713629843233, - 70.1713629843233, - 70.1713629843233, - 70.17136298432328 + 70.2880294712005, + 70.2880294712005, + 70.2880294712005, + 70.28802947120049 ], "moduleForcesY": [ - 91.64556621358966, - 91.64556621358966, - 91.64556621358965, - 91.64556621358966 + 91.5547530896582, + 91.5547530896582, + 91.5547530896582, + 91.5547530896582 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654473 }, { - "x": 7.08070096454518, - "y": 5.7942842678434205, + "x": 7.081243526667897, + "y": 5.794280558401382, "heading": 3.141592653589793, - "angularVelocity": -5.248105366732835e-16, - "velocityX": 1.3578183260610657, - "velocityY": -0.009283265770469635, + "angularVelocity": 8.891262469242803e-17, + "velocityX": 1.366302583662364, + "velocityY": -0.009341271776623973, "moduleForcesX": [ - 115.39417560593395, - 115.39417560593395, - 115.39417560593395, - 115.39417560593395 + 115.39290145122217, + 115.39290145122217, + 115.39290145122217, + 115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823111, - -0.7889382400823112, - -0.7889382400822926, - -0.7889382400822927 + -0.7889295288162147, + -0.7889295288162148, + -0.7889295288162135, + -0.7889295288162135 ], - "timestamp": 1.104908044748896 + "timestamp": 1.1057357504820595 }, { - "x": 7.254857440753563, - "y": 5.793093577731747, + "x": 7.255760634137555, + "y": 5.7930874026904595, "heading": 3.141592653589793, - "angularVelocity": -2.561615074692675e-16, - "velocityX": 2.0484745349524203, - "velocityY": -0.014005212013280241, + "angularVelocity": -8.106206904033818e-17, + "velocityX": 2.0558800115403812, + "velocityY": -0.01405584250338598, "moduleForcesX": [ - 115.35785908997497, - 115.35785908997497, - 115.35785908997497, - 115.35785908997497 + 115.35518538121136, + 115.35518538121136, + 115.35518538121136, + 115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570275, - -0.7886899477570275, - -0.7886899477570093, - -0.7886899477570093 + -0.7886716678821863, + -0.7886716678821865, + -0.7886716678821848, + -0.7886716678821848 ], - "timestamp": 1.1899256875053905 + "timestamp": 1.1906225660986718 }, { - "x": 7.487674502920737, - "y": 5.791501831161153, + "x": 7.488752669750456, + "y": 5.791494459844215, "heading": 3.141592653589793, - "angularVelocity": 1.0000731243848567e-17, - "velocityX": 2.7384558618495856, - "velocityY": -0.018722544156549316, + "angularVelocity": -4.386380051033386e-17, + "velocityX": 2.744737612317474, + "velocityY": -0.01876549184548377, "moduleForcesX": [ - 115.24513594206775, - 115.24513594206775, - 115.24513594206775, - 115.24513594206775 + 115.23476991325883, + 115.23476991325883, + 115.23476991325883, + 115.23476991325883 ], "moduleForcesY": [ - -0.7879192710616094, - -0.7879192710616094, - -0.7879192710615902, - -0.7879192710615902 + -0.7878483995771248, + -0.7878483995771248, + -0.7878483995771227, + -0.7878483995771227 ], - "timestamp": 1.274943330261885 + "timestamp": 1.275509381715284 }, { - "x": 7.663804078477769, - "y": 5.790297651169946, + "x": 7.664344676693786, + "y": 5.790293955154937, "heading": 3.141592653589793, - "angularVelocity": 2.7022041767467565e-16, - "velocityX": 2.071682651346936, - "velocityY": -0.014163883544211246, + "angularVelocity": 1.0120993007206391e-17, + "velocityX": 2.068542749164338, + "velocityY": -0.01414241635239708, "moduleForcesX": [ - -111.36876650332572, - -111.36876650332572, - -111.36876650332572, - -111.36876650332572 + -113.11649807418154, + -113.11649807418154, + -113.11649807418154, + -113.11649807418154 ], "moduleForcesY": [ - 0.7614169275347041, - 0.7614169275347037, - 0.7614169275347284, - 0.7614169275347282 + 0.773365990495707, + 0.7733659904957071, + 0.7733659904957131, + 0.7733659904957132 ], - "timestamp": 1.3599609730183797 + "timestamp": 1.3603961973318963 }, { - "x": 7.781262360019993, - "y": 5.78949460084755, + "x": 7.781442723663645, + "y": 5.7894933677196665, "heading": 3.141592653589793, - "angularVelocity": 2.635375031603667e-16, - "velocityX": 1.3815753734627974, - "velocityY": -0.00944569028685667, + "angularVelocity": 1.5839175733892886e-17, + "velocityX": 1.3794609459585514, + "velocityY": -0.009431234161101426, "moduleForcesX": [ - -115.26617308908851, - -115.26617308908851, - -115.26617308908851, - -115.26617308908851 + -115.2722753646769, + -115.2722753646769, + -115.2722753646769, + -115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957715, - 0.7880630998957715, - 0.7880630998957596, - 0.7880630998957596 + 0.7881048205332045, + 0.7881048205332045, + 0.7881048205332075, + 0.7881048205332074 ], - "timestamp": 1.4449786157748743 + "timestamp": 1.4452830129485086 }, { - "x": 7.84, + "x": 7.840000000000001, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 2.372133916606688e-16, - "velocityX": 0.6908876566743303, - "velocityY": -0.004723528627758663, + "angularVelocity": 1.0053087398322516e-17, + "velocityX": 0.6898276948077531, + "velocityY": -0.004716281776302069, "moduleForcesX": [ - -115.36312174237496, - -115.36312174237496, - -115.36312174237496, - -115.36312174237496 + -115.3645237146873, + -115.3645237146873, + -115.3645237146873, + -115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761378, - 0.7887259279761378, - 0.7887259279761235, - 0.7887259279761235 + 0.7887355131182131, + 0.7887355131182131, + 0.7887355131182147, + 0.7887355131182147 ], - "timestamp": 1.529996258531369 + "timestamp": 1.5301698285651208 }, { "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 4.549080377281559e-28, - "velocityX": 2.4191829688267976e-17, - "velocityY": -1.5749113533099178e-18, + "angularVelocity": 1.240515353430351e-28, + "velocityX": 3.2946392731050547e-16, + "velocityY": -1.9344571845752735e-18, "moduleForcesX": [ - -115.3965169929829, - -115.3965169929829, - -115.3965169929829, - -115.3965169929829 + -115.39705100341173, + -115.39705100341173, + -115.39705100341173, + -115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073952, - 0.7889542479073952, - 0.78895424790738, - 0.78895424790738 + 0.7889578988823658, + 0.7889578988823658, + 0.7889578988823669, + 0.7889578988823669 ], - "timestamp": 1.6150139012878635 + "timestamp": 1.6150566441817331 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue 4 to 5.traj b/src/main/deploy/choreo/Blue 4 to 5.traj index b3c8434..5e46076 100644 --- a/src/main/deploy/choreo/Blue 4 to 5.traj +++ b/src/main/deploy/choreo/Blue 4 to 5.traj @@ -1,12 +1,12 @@ { "samples": [ { - "x": 7.84, - "y": 7.477, + "x": 7.839999999999999, + "y": 7.4769999999999985, "heading": 3.141592653589793, - "angularVelocity": -1.0078113021558393e-27, - "velocityX": -1.8654023532984683e-16, - "velocityY": 9.408878607423118e-17, + "angularVelocity": -3.2554108069074945e-28, + "velocityX": -6.245095151781063e-16, + "velocityY": -4.52955156548901e-16, "moduleForcesX": [ 0, 0, @@ -22,361 +22,361 @@ "timestamp": 0 }, { - "x": 7.7888178205593785, - "y": 7.4097114166852736, + "x": 7.789048065389168, + "y": 7.409336319308564, "heading": 3.141592653589793, - "angularVelocity": -1.6796175146434201e-16, - "velocityX": -0.5018399951667901, - "velocityY": -0.6597628841614104, + "angularVelocity": -2.211714817370884e-16, + "velocityX": -0.49911336409084806, + "velocityY": -0.6628177625545706, "moduleForcesX": [ - -69.87246936994154, - -69.87246936994154, - -69.87246936994154, - -69.87246936994154 + -69.42758277694902, + -69.42758277694902, + -69.42758277694902, + -69.42758277694902 ], "moduleForcesY": [ - -91.86047815823733, - -91.86047815823733, - -91.86047815823733, - -91.86047815823733 + -92.19916433110346, + -92.19916433110346, + -92.19916433110346, + -92.19916433110346 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654473 }, { - "x": 7.6864968515181165, - "y": 7.275117557134651, + "x": 7.687176089149893, + "y": 7.27400074357171, "heading": 3.141592653589793, - "angularVelocity": -2.2017382616870134e-16, - "velocityX": -1.0032545540329136, - "velocityY": -1.3196894419992158, + "angularVelocity": -6.966527683706636e-17, + "velocityX": -0.9979143119049332, + "velocityY": -1.325715991020111, "moduleForcesX": [ - -69.81323478288708, - -69.81323478288708, - -69.81323478288708, - -69.81323478288706 + -69.38412510090812, + -69.38412510090812, + -69.38412510090812, + -69.38412510090812 ], "moduleForcesY": [ - -91.8832668638928, - -91.8832668638928, - -91.8832668638928, - -91.8832668638928 + -92.21035728659811, + -92.21035728659811, + -92.21035728659811, + -92.21035728659811 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308946 }, { - "x": 7.533123855655458, - "y": 7.073185098303809, + "x": 7.534447902717691, + "y": 7.070976830585042, "heading": 3.141592653589793, - "angularVelocity": -1.7392229984228028e-16, - "velocityX": -1.5038184060088011, - "velocityY": -1.9799427314568734, + "angularVelocity": -6.814239332649433e-17, + "velocityX": -1.4960899817445545, + "velocityY": -1.98877528351538, "moduleForcesX": [ - -69.69478868116059, - -69.69478868116057, - -69.69478868116059, - -69.69478868116057 + -69.29714778996903, + -69.29714778996902, + -69.29714778996902, + -69.29714778996902 ], "moduleForcesY": [ - -91.92875854512678, - -91.9287585451268, - -91.9287585451268, - -91.9287585451268 + -92.23276158792476, + -92.23276158792477, + -92.23276158792477, + -92.23276158792477 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596342 }, { - "x": 7.3289589167676406, - "y": 6.803814589003351, + "x": 7.331055401569866, + "y": 6.800215073826195, "heading": 3.141592653589793, - "angularVelocity": -5.667150978731249e-17, - "velocityX": -2.0018321428383743, - "velocityY": -2.6411711373500846, + "angularVelocity": -1.4682205756281464e-16, + "velocityX": -1.9923858878859297, + "velocityY": -2.652319530447951, "moduleForcesX": [ - -69.33972961029974, - -69.33972961029976, - -69.33972961029976, - -69.33972961029976 + -69.03566921838791, + -69.03566921838791, + -69.03566921838791, + -69.03566921838791 ], "moduleForcesY": [ - -92.06452650682208, - -92.06452650682208, - -92.06452650682208, - -92.06452650682206 + -92.30021963767099, + -92.30021963767099, + -92.30021963767099, + -92.30021963767098 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461789 }, { - "x": 7.139460037725265, - "y": 6.468344823148688, + "x": 7.1379039546368785, + "y": 6.467543964285728, "heading": 3.141592653589793, - "angularVelocity": -8.184523729481644e-16, - "velocityX": -1.8580317911802808, - "velocityY": -3.289272702238152, + "angularVelocity": 7.91591288584586e-18, + "velocityX": -1.8920668899735504, + "velocityY": -3.258769228032236, "moduleForcesX": [ - 20.02169170195439, - 20.021691701955483, - 20.021691701954257, - 20.021691701955366 + 13.954556287044939, + 13.954556287044953, + 13.954556287044939, + 13.954556287044952 ], "moduleForcesY": [ - -90.23684277379594, - -90.23684277379569, - -90.23684277379519, - -90.23684277379493 + -84.35826329061041, + -84.35826329061041, + -84.3582632906104, + -84.3582632906104 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327236 }, { - "x": 7.001680309142067, - "y": 6.199601477600121, + "x": 6.99919068598312, + "y": 6.1995387188725335, "heading": 3.141592653589793, - "angularVelocity": -4.434581900264256e-16, - "velocityX": -1.35092680854653, - "velocityY": -2.6350218123795046, + "angularVelocity": 1.9046475496251705e-16, + "velocityX": -1.3588030894265215, + "velocityY": -2.625317383015404, "moduleForcesX": [ - 70.60552707551508, - 70.60552707551507, - 70.60552707551507, - 70.60552707551507 + 74.17797101404966, + 74.17797101404965, + 74.17797101404965, + 74.17797101404966 ], "moduleForcesY": [ - 91.09302905748419, - 91.0930290574842, - 91.0930290574842, - 91.09302905748422 + 88.11431143550178, + 88.11431143550178, + 88.11431143550178, + 88.11431143550178 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192683 }, { - "x": 6.915423136802039, - "y": 5.997836583842572, + "x": 6.912972996962741, + "y": 5.997942442570267, "heading": 3.141592653589793, - "angularVelocity": -5.095379692959289e-16, - "velocityX": -0.8457494273056122, - "velocityY": -1.9782997600863537, + "angularVelocity": 7.847677166577354e-17, + "velocityX": -0.844568535807801, + "velocityY": -1.974790484833519, "moduleForcesX": [ - 70.33714219082988, - 70.33714219082987, - 70.33714219082988, - 70.33714219082988 + 71.53096792553119, + 71.53096792553119, + 71.53096792553119, + 71.53096792553119 ], "moduleForcesY": [ - 91.43709533984699, - 91.43709533984699, - 91.43709533984699, - 91.437095339847 + 90.48948259361241, + 90.4894825936124, + 90.4894825936124, + 90.48948259361241 ], - "timestamp": 0.713923281394681 + "timestamp": 0.714594254405813 }, { - "x": 6.88062147565552, - "y": 5.863134773678263, + "x": 6.878725057136558, + "y": 5.863208583334528, "heading": 3.141592653589793, - "angularVelocity": -5.663091225441964e-16, - "velocityX": -0.3412294211072634, - "velocityY": -1.3207478950795901, + "angularVelocity": 1.5385501117605214e-16, + "velocityX": -0.3354848955240767, + "velocityY": -1.3198217153806693, "moduleForcesX": [ - 70.24561417800437, - 70.24561417800437, - 70.24561417800437, - 70.24561417800437 + 70.81446644981058, + 70.81446644981058, + 70.81446644981058, + 70.81446644981058 ], "moduleForcesY": [ - 91.55263229179072, - 91.55263229179073, - 91.55263229179073, - 91.55263229179073 + 91.10735502004157, + 91.10735502004157, + 91.10735502004157, + 91.10735502004157 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923577 }, { - "x": 6.897241402633118, - "y": 5.79553856220569, + "x": 6.896202051935022, + "y": 5.7955456681406865, "heading": 3.141592653589793, - "angularVelocity": -5.961242927880675e-16, - "velocityX": 0.16295797024033917, - "velocityY": -0.6627791705906017, + "angularVelocity": 1.623217608850538e-17, + "velocityX": 0.17120059787260816, + "velocityY": -0.6628102639184268, "moduleForcesX": [ - 70.1993033594393, - 70.19930335943928, - 70.1993033594393, - 70.19930335943928 + 70.48087982705123, + 70.48087982705123, + 70.48087982705123, + 70.48087982705123 ], "moduleForcesY": [ - 91.61067270642351, - 91.61067270642351, - 91.61067270642351, - 91.61067270642351 + 91.39149582750018, + 91.39149582750018, + 91.39149582750018, + 91.39149582750018 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789024 }, { - "x": 6.965262451171874, - "y": 5.795073509216309, + "x": 6.965262451171875, + "y": 5.79507350921631, "heading": 3.141592653589793, - "angularVelocity": -7.988770368986943e-16, - "velocityX": 0.6669446874477116, - "velocityY": -0.004559832982767937, + "angularVelocity": 5.88565809839424e-17, + "velocityX": 0.6764996943067185, + "velocityY": -0.004625159592674305, "moduleForcesX": [ - 70.1713629843233, - 70.1713629843233, - 70.1713629843233, - 70.17136298432328 + 70.2880294712005, + 70.2880294712005, + 70.2880294712005, + 70.28802947120049 ], "moduleForcesY": [ - 91.64556621358966, - 91.64556621358966, - 91.64556621358965, - 91.64556621358966 + 91.5547530896582, + 91.5547530896582, + 91.5547530896582, + 91.5547530896582 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654473 }, { - "x": 7.08070096454518, - "y": 5.7942842678434205, + "x": 7.081243526667897, + "y": 5.794280558401382, "heading": 3.141592653589793, - "angularVelocity": -5.248105366732835e-16, - "velocityX": 1.3578183260610657, - "velocityY": -0.009283265770469635, + "angularVelocity": 8.891262469242803e-17, + "velocityX": 1.366302583662364, + "velocityY": -0.009341271776623973, "moduleForcesX": [ - 115.39417560593395, - 115.39417560593395, - 115.39417560593395, - 115.39417560593395 + 115.39290145122217, + 115.39290145122217, + 115.39290145122217, + 115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823111, - -0.7889382400823112, - -0.7889382400822926, - -0.7889382400822927 + -0.7889295288162147, + -0.7889295288162148, + -0.7889295288162135, + -0.7889295288162135 ], - "timestamp": 1.104908044748896 + "timestamp": 1.1057357504820595 }, { - "x": 7.254857440753563, - "y": 5.793093577731747, + "x": 7.255760634137555, + "y": 5.7930874026904595, "heading": 3.141592653589793, - "angularVelocity": -2.561615074692675e-16, - "velocityX": 2.0484745349524203, - "velocityY": -0.014005212013280241, + "angularVelocity": -8.106206904033818e-17, + "velocityX": 2.0558800115403812, + "velocityY": -0.01405584250338598, "moduleForcesX": [ - 115.35785908997497, - 115.35785908997497, - 115.35785908997497, - 115.35785908997497 + 115.35518538121136, + 115.35518538121136, + 115.35518538121136, + 115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570275, - -0.7886899477570275, - -0.7886899477570093, - -0.7886899477570093 + -0.7886716678821863, + -0.7886716678821865, + -0.7886716678821848, + -0.7886716678821848 ], - "timestamp": 1.1899256875053905 + "timestamp": 1.1906225660986718 }, { - "x": 7.487674502920737, - "y": 5.791501831161153, + "x": 7.488752669750456, + "y": 5.791494459844215, "heading": 3.141592653589793, - "angularVelocity": 1.0000731243848567e-17, - "velocityX": 2.7384558618495856, - "velocityY": -0.018722544156549316, + "angularVelocity": -4.386380051033386e-17, + "velocityX": 2.744737612317474, + "velocityY": -0.01876549184548377, "moduleForcesX": [ - 115.24513594206775, - 115.24513594206775, - 115.24513594206775, - 115.24513594206775 + 115.23476991325883, + 115.23476991325883, + 115.23476991325883, + 115.23476991325883 ], "moduleForcesY": [ - -0.7879192710616094, - -0.7879192710616094, - -0.7879192710615902, - -0.7879192710615902 + -0.7878483995771248, + -0.7878483995771248, + -0.7878483995771227, + -0.7878483995771227 ], - "timestamp": 1.274943330261885 + "timestamp": 1.275509381715284 }, { - "x": 7.663804078477769, - "y": 5.790297651169946, + "x": 7.664344676693786, + "y": 5.790293955154937, "heading": 3.141592653589793, - "angularVelocity": 2.7022041767467565e-16, - "velocityX": 2.071682651346936, - "velocityY": -0.014163883544211246, + "angularVelocity": 1.0120993007206391e-17, + "velocityX": 2.068542749164338, + "velocityY": -0.01414241635239708, "moduleForcesX": [ - -111.36876650332572, - -111.36876650332572, - -111.36876650332572, - -111.36876650332572 + -113.11649807418154, + -113.11649807418154, + -113.11649807418154, + -113.11649807418154 ], "moduleForcesY": [ - 0.7614169275347041, - 0.7614169275347037, - 0.7614169275347284, - 0.7614169275347282 + 0.773365990495707, + 0.7733659904957071, + 0.7733659904957131, + 0.7733659904957132 ], - "timestamp": 1.3599609730183797 + "timestamp": 1.3603961973318963 }, { - "x": 7.781262360019993, - "y": 5.78949460084755, + "x": 7.781442723663645, + "y": 5.7894933677196665, "heading": 3.141592653589793, - "angularVelocity": 2.635375031603667e-16, - "velocityX": 1.3815753734627974, - "velocityY": -0.00944569028685667, + "angularVelocity": 1.5839175733892886e-17, + "velocityX": 1.3794609459585514, + "velocityY": -0.009431234161101426, "moduleForcesX": [ - -115.26617308908851, - -115.26617308908851, - -115.26617308908851, - -115.26617308908851 + -115.2722753646769, + -115.2722753646769, + -115.2722753646769, + -115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957715, - 0.7880630998957715, - 0.7880630998957596, - 0.7880630998957596 + 0.7881048205332045, + 0.7881048205332045, + 0.7881048205332075, + 0.7881048205332074 ], - "timestamp": 1.4449786157748743 + "timestamp": 1.4452830129485086 }, { - "x": 7.84, + "x": 7.840000000000001, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 2.372133916606688e-16, - "velocityX": 0.6908876566743303, - "velocityY": -0.004723528627758663, + "angularVelocity": 1.0053087398322516e-17, + "velocityX": 0.6898276948077531, + "velocityY": -0.004716281776302069, "moduleForcesX": [ - -115.36312174237496, - -115.36312174237496, - -115.36312174237496, - -115.36312174237496 + -115.3645237146873, + -115.3645237146873, + -115.3645237146873, + -115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761378, - 0.7887259279761378, - 0.7887259279761235, - 0.7887259279761235 + 0.7887355131182131, + 0.7887355131182131, + 0.7887355131182147, + 0.7887355131182147 ], - "timestamp": 1.529996258531369 + "timestamp": 1.5301698285651208 }, { "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 4.549080377281559e-28, - "velocityX": 2.4191829688267976e-17, - "velocityY": -1.5749113533099178e-18, + "angularVelocity": 1.240515353430351e-28, + "velocityX": 3.2946392731050547e-16, + "velocityY": -1.9344571845752735e-18, "moduleForcesX": [ - -115.3965169929829, - -115.3965169929829, - -115.3965169929829, - -115.3965169929829 + -115.39705100341173, + -115.39705100341173, + -115.39705100341173, + -115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073952, - 0.7889542479073952, - 0.78895424790738, - 0.78895424790738 + 0.7889578988823658, + 0.7889578988823658, + 0.7889578988823669, + 0.7889578988823669 ], - "timestamp": 1.6150139012878635 + "timestamp": 1.6150566441817331 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue 5 to Amp.1.traj b/src/main/deploy/choreo/Blue 5 to Amp.1.traj index fd9ae6d..a59c71c 100644 --- a/src/main/deploy/choreo/Blue 5 to Amp.1.traj +++ b/src/main/deploy/choreo/Blue 5 to Amp.1.traj @@ -4,9 +4,9 @@ "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 3.864499903901422e-23, - "velocityX": 1.6362365454470194e-21, - "velocityY": 8.475122557710336e-22, + "angularVelocity": -1.0403534656091185e-23, + "velocityX": 2.8385757952612522e-21, + "velocityY": 1.754655461207754e-22, "moduleForcesX": [ 0, 0, @@ -22,760 +22,760 @@ "timestamp": 0 }, { - "x": 7.804386984749256, - "y": 5.818963407451602, - "heading": 3.141592654640039, - "angularVelocity": 1.3886947562622549e-8, - "velocityX": -0.47089570623239096, - "velocityY": 0.3949634209817354, + "x": 7.801915703893787, + "y": 5.819895567892892, + "heading": 3.141592654383112, + "angularVelocity": 1.0218405417972763e-8, + "velocityX": -0.49054796402101786, + "velocityY": 0.3967548278015514, "moduleForcesX": [ - -88.41685080559067, - -88.41685134026656, - -88.41684995134041, - -88.41685048601632 + -89.72456239926012, + -89.72456276282513, + -89.72456179694437, + -89.72456216050938 ], "moduleForcesY": [ - 74.15956707853897, - 74.1595664419741, - 74.15956809803673, - 74.15956746147187 + 72.5691589714727, + 72.56915852264281, + 72.56915971691674, + 72.56915926808685 ], - "timestamp": 0.07562824374781549 + "timestamp": 0.07763623315044801 }, { - "x": 7.733165130481669, - "y": 5.87870068413291, - "heading": 3.1415926567346326, - "angularVelocity": 2.769591969019193e-8, - "velocityX": -0.9417361919057625, - "velocityY": 0.7898805224209979, + "x": 7.7257526236644525, + "y": 5.8814962104214334, + "heading": 3.1415926559388794, + "angularVelocity": 2.003919753404797e-8, + "velocityX": -0.981024930482415, + "velocityY": 0.7934522326600857, "moduleForcesX": [ - -88.40648241970496, - -88.40648295141078, - -88.40648157044113, - -88.40648210214695 + -89.71157645751234, + -89.71157680696288, + -89.71157587879169, + -89.71157622824224 ], "moduleForcesY": [ - 74.15086997738469, - 74.15086934453556, - 74.15087099113398, - 74.15087035828488 + 72.55865592998232, + 72.5586554987349, + 72.5586566463959, + 72.55865621514847 ], - "timestamp": 0.15125648749563098 + "timestamp": 0.15527246630089603 }, { - "x": 7.626340702412968, - "y": 5.968299592298079, - "heading": 3.141592659864831, - "angularVelocity": 4.138927601200874e-8, - "velocityX": -1.4124938353045773, - "velocityY": 1.1847281349536445, + "x": 7.611519766641148, + "y": 5.973887660021114, + "heading": 3.141592658206744, + "angularVelocity": 2.9211418602605457e-8, + "velocityX": -1.4713858772866655, + "velocityY": 1.1900558006290556, "moduleForcesX": [ - -88.39092769362989, - -88.3909282209318, - -88.39092685175883, - -88.39092737906076 + -89.6903556646401, + -89.69035599106215, + -89.69035512437979, + -89.69035545080186 ], "moduleForcesY": [ - 74.1378225244418, - 74.13782189710157, - 74.13782352966786, - 74.13782290232764 + 72.54149253338231, + 72.54149213079452, + 72.54149320244666, + 72.54149279985887 ], - "timestamp": 0.22688473124344646 + "timestamp": 0.23290869945134404 }, { - "x": 7.4839241438804045, - "y": 6.087751371974113, - "heading": 3.14159266401632, - "angularVelocity": 5.489336496426752e-8, - "velocityX": -1.8831133909106093, - "velocityY": 1.5794599181008275, + "x": 7.459234501547516, + "y": 6.09705586883968, + "heading": 3.1415926610898817, + "angularVelocity": 3.713649834301922e-8, + "velocityX": -1.9615231047921198, + "velocityY": 1.586478424061156, "moduleForcesX": [ - -88.36499989530778, - -88.36500041539998, - -88.3649990655369, - -88.36499958562912 + -89.64943586702498, + -89.64943614914596, + -89.64943540062544, + -89.64943568274641 ], "moduleForcesY": [ - 74.11607403920986, - 74.1160734208864, - 74.1160750304833, - 74.11607441215983 + 72.50839656371215, + 72.50839621616346, + 72.50839714174288, + 72.50839679419418 ], - "timestamp": 0.30251297499126195 + "timestamp": 0.31054493260179206 }, { - "x": 7.305936340953446, - "y": 6.237038503722604, - "heading": 3.141592669161458, - "angularVelocity": 6.803196607882386e-8, - "velocityX": -2.353456778931214, - "velocityY": 1.9739600491886735, + "x": 7.268944263180371, + "y": 6.250962471535492, + "heading": 3.141592664325284, + "angularVelocity": 4.1673866210267806e-8, + "velocityX": -2.4510493444264503, + "velocityY": 1.9824068794986809, "moduleForcesX": [ - -88.31314580096668, - -88.31314630713541, - -88.31314499455604, - -88.3131455007248 + -89.53768198601384, + -89.53768214766599, + -89.53768171961279, + -89.53768188126494 ], "moduleForcesY": [ - 74.07257832876685, - 74.0725777278508, - 74.0725792930976, - 74.07257869218155 + 72.4180099222743, + 72.41800972375923, + 72.41801025311995, + 72.41801005460489 ], - "timestamp": 0.37814121873907747 + "timestamp": 0.38818116575224004 }, { - "x": 7.092439877339699, - "y": 6.4161084917221185, - "heading": 3.1415926752250933, - "angularVelocity": 8.017686861531298e-8, - "velocityX": -2.8229726492877, - "velocityY": 2.3677660504272553, + "x": 7.041301900991139, + "y": 6.435079442411686, + "heading": 3.14159266433028, + "angularVelocity": 6.434659980226883e-11, + "velocityX": -2.9321665020518712, + "velocityY": 2.3715340557469027, "moduleForcesX": [ - -88.15776848327013, - -88.15776895157923, - -88.1577677403473, - -88.15776820865639 + -87.9996031521211, + -87.99960165358323, + -87.99960551643635, + -87.99960401789855 ], "moduleForcesY": [ - 73.94224635017493, - 73.94224579656832, - 73.94224724125631, - 73.9422466876497 + 71.17401035154589, + 71.17401211337099, + 71.17400732956905, + 71.17400909139415 ], - "timestamp": 0.453769462486893 + "timestamp": 0.46581739890268803 }, { - "x": 6.862403858117085, - "y": 6.609050171403948, - "heading": 3.141592675228291, - "angularVelocity": 4.227895638899564e-11, - "velocityX": -3.0416681364395526, - "velocityY": 2.5511855111325605, + "x": 6.8136379578443655, + "y": 6.619213767938429, + "heading": 3.1415926643325944, + "angularVelocity": 2.98162795621733e-11, + "velocityX": -2.9324444773820173, + "velocityY": 2.371757593776043, "moduleForcesX": [ - -41.06294995986311, - -41.06294622640053, - -41.06295115821892, - -41.0629474244754 + -0.05084358373972663, + -0.050843579300801696, + -0.05084358138239444, + -0.050843576958249995 ], "moduleForcesY": [ - 34.43941386958152, - 34.43941479451641, - 34.439408469304176, - 34.43940939490503 + 0.04088662735497638, + 0.040886627539810205, + 0.04088662720255321, + 0.0408866274277148 ], - "timestamp": 0.5293977062347085 + "timestamp": 0.543453632053136 }, { - "x": 6.632357399761043, - "y": 6.801980462733905, - "heading": 3.1415926752313657, - "angularVelocity": 4.0648056359994824e-11, - "velocityX": -3.041806168646974, - "velocityY": 2.5510349278146487, + "x": 6.58597261081092, + "y": 6.803346358526077, + "heading": 3.1415926643349095, + "angularVelocity": 2.9815304194295546e-11, + "velocityX": -2.932462560261807, + "velocityY": 2.371735246747818, "moduleForcesX": [ - -0.025917328301607805, - -0.025917397773985305, - -0.025917320555397437, - -0.0259173893513379 + -0.00330748172317311, + -0.003307481786022645, + -0.003307481858617945, + -0.0033074819207971947 ], "moduleForcesY": [ - -0.028273671044889415, - -0.028274266787425645, - -0.02827372578557447, - -0.02827431541372518 + -0.004087423562569713, + -0.004087423593728358, + -0.00408742360898491, + -0.00408742364067536 ], - "timestamp": 0.605025949982524 + "timestamp": 0.621089865203584 }, { - "x": 6.402072911582864, - "y": 6.994626570545385, - "heading": 3.141592675234442, - "angularVelocity": 4.067971071486534e-11, - "velocityX": -3.044953535428767, - "velocityY": 2.5472772903978105, + "x": 6.358266536478161, + "y": 6.987428581453392, + "heading": 3.1415926643372245, + "angularVelocity": 2.98196238161316e-11, + "velocityX": -2.932987151649883, + "velocityY": 2.3710864818826223, "moduleForcesX": [ - -0.5909595067608326, - -0.5909594800381297, - -0.5909593823052591, - -0.5909593553877736 + -0.09595133639405176, + -0.09595133636676093, + -0.09595133624904402, + -0.0959513362215452 ], "moduleForcesY": [ - -0.705545714436184, - -0.7055458142175607, - -0.7055456945121211, - -0.7055457941638968 + -0.11866351061120779, + -0.11866351070665564, + -0.11866351059046351, + -0.1186635106857128 ], - "timestamp": 0.6806541937303395 + "timestamp": 0.698726098354032 }, { - "x": 6.1663635965102745, - "y": 7.1805951955577285, - "heading": 3.141592675237588, - "angularVelocity": 4.1596178423747995e-11, - "velocityX": -3.1166837069305515, - "velocityY": 2.4589837843182147, + "x": 6.129385033333283, + "y": 7.170047155234762, + "heading": 3.14159266433955, + "angularVelocity": 2.995690672790387e-11, + "velocityX": -2.948127360859174, + "velocityY": 2.3522338265366587, "moduleForcesX": [ - -13.468281354040977, - -13.468281333716769, - -13.468281376664086, - -13.46828135618857 + -2.769247337930091, + -2.7692473384292775, + -2.7692473400290107, + -2.769247340528674 ], "moduleForcesY": [ - -16.578264863811963, - -16.578264874356943, - -16.57826484852706, - -16.578264859051814 + -3.44827901258727, + -3.4482790111240282, + -3.4482790129454086, + -3.4482790114828967 ], - "timestamp": 0.756282437478155 + "timestamp": 0.77636233150448 }, { - "x": 5.907218564598163, - "y": 7.332200360310185, - "heading": 3.14159267524121, - "angularVelocity": 4.7894146112420855e-11, - "velocityX": -3.426564191761982, - "velocityY": 2.004610410602528, + "x": 5.88209636867458, + "y": 7.326837161822197, + "heading": 3.1415926643421153, + "angularVelocity": 3.30371829044516e-11, + "velocityX": -3.1852223455959274, + "velocityY": 2.0195468046936056, "moduleForcesX": [ - -58.1841290599635, - -58.18412906038532, - -58.18412906031337, - -58.18412906073494 + -43.36628685569254, + -43.36628685589723, + -43.36628685569064, + -43.36628685589532 ], "moduleForcesY": [ - -85.31456581504214, - -85.31456581480037, - -85.31456581471323, - -85.31456581447162 + -60.85072123516317, + -60.85072123509917, + -60.850721235009324, + -60.850721234945325 ], - "timestamp": 0.8319106812259706 + "timestamp": 0.853998564654928 }, { - "x": 5.628079296821089, - "y": 7.442713249379176, - "heading": 3.141592675245288, - "angularVelocity": 5.391640365188102e-11, - "velocityX": -3.6909394419877284, - "velocityY": 1.4612647814155275, + "x": 5.612608115354213, + "y": 7.44131210061748, + "heading": 3.141592664345216, + "angularVelocity": 3.994305220349218e-11, + "velocityX": -3.4711660056733877, + "velocityY": 1.474504031815228, "moduleForcesX": [ - -49.639923881366215, - -49.639923881932916, - -49.63992388172823, - -49.63992388229493 + -52.30104213787289, + -52.3010421384724, + -52.30104213828144, + -52.301042138880945 ], "moduleForcesY": [ - -102.02027478517165, - -102.02027478490187, - -102.02027478497904, - -102.02027478470927 + -99.69203382192678, + -99.69203382162236, + -99.69203382168664, + -99.69203382138221 ], - "timestamp": 0.9075389249737861 + "timestamp": 0.931634797805376 }, { - "x": 5.335317495359145, - "y": 7.509086944055442, - "heading": 3.1415926750707146, - "angularVelocity": -2.3083108894089293e-9, - "velocityX": -3.8710643927970487, - "velocityY": 0.8776310461153854, + "x": 5.327912239314761, + "y": 7.50959437971124, + "heading": 3.1415926642865455, + "angularVelocity": -7.557067068121798e-10, + "velocityX": -3.6670490631320476, + "velocityY": 0.8795156117561669, "moduleForcesX": [ - -33.8208243425392, - -33.82082406908601, - -33.820824230126675, - -33.820823956673486 + -35.8283448481557, + -35.82834476031454, + -35.828344809681155, + -35.828344721840004 ], "moduleForcesY": [ - -109.58489553923485, - -109.5848956230017, - -109.58489557665949, - -109.58489566042633 + -108.82743270079975, + -108.82743272946998, + -108.82743271448132, + -108.82743274315155 ], - "timestamp": 0.9831671687216016 + "timestamp": 1.009271030955824 }, { "x": 5.035840072631835, "y": 7.529608249664307, "heading": 3.141592653589793, - "angularVelocity": -2.8403305758359793e-7, - "velocityX": -3.9598621875436577, - "velocityY": 0.27134446857306244, + "angularVelocity": -1.3778041516011634e-7, + "velocityX": -3.762059992232384, + "velocityY": 0.25779032728547985, "moduleForcesX": [ - -16.672973763417268, - -16.67293682726911, - -16.67296653041068, - -16.672929594277857 + -17.378156269782163, + -17.37813883051833, + -17.378152707029265, + -17.378135267768847 ], "moduleForcesY": [ - -113.83826079590199, - -113.83826618574518, - -113.83826203751487, - -113.83826742735344 + -113.71778560366965, + -113.71778825853885, + -113.71778623741099, + -113.7177888922791 ], - "timestamp": 1.058795412469417 + "timestamp": 1.086907264106272 }, { - "x": 4.8161858301349545, - "y": 7.544659774408683, - "heading": 3.141261009826011, - "angularVelocity": -0.005977710911032145, - "velocityX": -3.959156496885198, - "velocityY": 0.271296112027398, + "x": 4.818734526967475, + "y": 7.544485128232927, + "heading": 3.141362002173113, + "angularVelocity": -0.003996340436793055, + "velocityX": -3.7616403301464163, + "velocityY": 0.2577615704802417, "moduleForcesX": [ - -0.018593166864404487, - 0.3800231783603618, - -0.0187780717345422, - 0.37983792515152204 + -0.024792117629372414, + 0.23137972399738163, + -0.024874744188840826, + 0.23129698238991547 ], "moduleForcesY": [ - 0.25515896497117335, - 0.25501866357344083, - -0.2797750022282368, - -0.2799103160185767 + 0.16484362026686902, + 0.16478126217454553, + -0.17893257077270838, + -0.17899328061213599 ], - "timestamp": 1.1142754731009405 + "timestamp": 1.1446229218007196 }, { - "x": 4.596531603138407, - "y": 7.559711298090919, - "heading": 3.140929288083857, - "angularVelocity": -0.0059791164317072945, - "velocityX": -3.9591562174995163, - "velocityY": 0.27129609288285317, + "x": 4.60162898654068, + "y": 7.55936200644265, + "heading": 3.1411313232709985, + "angularVelocity": -0.003996816658245245, + "velocityX": -3.761640239398693, + "velocityY": 0.2577615642618706, "moduleForcesX": [ - 0.000025612992006065086, - 0.00011941564717905257, - 0.00002360245464479842, - 0.0001174054593274741 + 0.000007204180719356383, + 0.00003773149835788362, + 0.0000069231161169374015, + 0.00003745044709400768 ], "moduleForcesY": [ - 0.00005871943135136759, - 0.00005720676841727365, - -0.00006700765927160055, - -0.00006851882774530035 + 0.000019058256691630695, + 0.000018849052179001888, + -0.000021908763710286178, + -0.00002211834623925837 ], - "timestamp": 1.169755533732464 + "timestamp": 1.202338579495167 }, { - "x": 4.37687737872891, - "y": 7.574762821595881, - "heading": 3.140597534231695, - "angularVelocity": -0.005979695198340648, - "velocityX": -3.9591561708692615, - "velocityY": 0.27129608968757485, + "x": 4.38452344666509, + "y": 7.574238884614604, + "heading": 3.140900634383137, + "angularVelocity": -0.003996989674498232, + "velocityX": -3.7616402298483314, + "velocityY": 0.2577615636074443, "moduleForcesX": [ - -0.000006771269872669978, - 0.00003182466245725801, - -0.000007954457474905524, - 0.00003064136901031203 + -0.000003179633409385358, + 0.000007911345105099387, + -0.0000032118578890623888, + 0.000007879121329596486 ], "moduleForcesY": [ - 0.0000255199387963323, - 0.000024637757552653808, - -0.000026273740195479133, - -0.00002715529916690631 + 0.000007292887593340667, + 0.000007268884281012189, + -0.000007590905367963583, + -0.000007614919170638431 ], - "timestamp": 1.2252355943639877 + "timestamp": 1.2600542371896146 }, { - "x": 4.157223156893371, - "y": 7.5898143449244655, - "heading": 3.140265748410205, - "angularVelocity": -0.005980271429300119, - "velocityX": -3.959156124474958, - "velocityY": 0.27129608650846476, + "x": 4.167417907338466, + "y": 7.589115762748939, + "heading": 3.1406699355417973, + "angularVelocity": -0.003997162131650262, + "velocityX": -3.7616402203368033, + "velocityY": 0.257761562955679, "moduleForcesX": [ - -0.000006828724200291363, - 0.00003159709828148899, - -0.000007847745328245317, - 0.00003057810699160968 + -0.0000031755909448883706, + 0.000007879578382528402, + -0.0000031991997213915274, + 0.00000785596949024404 ], "moduleForcesY": [ - 0.00002534996110939576, - 0.00002458955338139237, - -0.000026218051690890895, - -0.00002697625269046444 + 0.000007266281602389286, + 0.000007248684756348649, + -0.000007569405113026906, + -0.000007586995154163464 ], - "timestamp": 1.2807156549955112 + "timestamp": 1.3177698948840622 }, { - "x": 3.9375689376216587, - "y": 7.604865868077368, - "heading": 3.1399339307508978, - "angularVelocity": -0.005980845289820074, - "velocityX": -3.9591560782633017, - "velocityY": 0.2712960833418705, + "x": 3.950312368559187, + "y": 7.603992640845768, + "heading": 3.1404392267773398, + "angularVelocity": -0.003997334062777751, + "velocityX": -3.7616402108533076, + "velocityY": 0.2577615623058347, "moduleForcesX": [ - -0.000007003893466524137, - 0.00003137644246304145, - -0.000007716670892301974, - 0.00003065586212925565 + -0.0000031650180316538163, + 0.00000785642813949844, + -0.000003189843558058993, + 0.000007831602528717756 ], "moduleForcesY": [ - 0.00002508688541999312, - 0.00002456619647907267, - -0.00002616067770793661, - -0.000026734380327000042 + 0.000007244577609204609, + 0.00000722607953419065, + -0.000007545849230742892, + -0.000007564351262925504 ], - "timestamp": 1.3361957156270348 + "timestamp": 1.3754855525785097 }, { - "x": 3.7179147209650303, - "y": 7.619917391051073, - "heading": 3.1396020811924448, - "angularVelocity": -0.005981420255779386, - "velocityX": -3.9591560311277267, - "velocityY": 0.2712960801119657, + "x": 3.7332068303256905, + "y": 7.618869518905198, + "heading": 3.140208508119994, + "angularVelocity": -0.003997505470129434, + "velocityX": -3.761640201396926, + "velocityY": 0.25776156165784825, "moduleForcesX": [ - -0.000009319624026353035, - 0.000030180280445294102, - -0.000006030651673570838, - 0.00003342764857052338 + -0.000003139443251794745, + 0.000007849472748191663, + -0.0000031961911096245354, + 0.000007792645970955111 ], "moduleForcesY": [ - 0.000023333383452071322, - 0.000025631362768478403, - -0.00002732752627695467, - -0.000024944013734834488 + 0.000007233882319316402, + 0.000007191809830107993, + -0.000007510298546544899, + -0.000007553108492988018 ], - "timestamp": 1.3916757762585583 + "timestamp": 1.4332012102729572 }, { - "x": 3.4982607821829097, - "y": 7.6349688949837855, - "heading": 3.139269331864783, - "angularVelocity": -0.0059976381401617785, - "velocityX": -3.959151022580424, - "velocityY": 0.2712957369076971, + "x": 3.5161012930772024, + "y": 7.633746396897135, + "heading": 3.139977778282167, + "angularVelocity": -0.0039976991867276025, + "velocityX": -3.7616401843303224, + "velocityY": 0.25776156048838117, "moduleForcesX": [ - 0.0007285537406330433, - 0.001811076606425356, - 0.0007528434980948667, - 0.001835303631750865 + -0.0000014116108881133617, + 0.000011019749815764846, + -0.000002621565097237515, + 0.00000980949966013142 ], "moduleForcesY": [ - 0.000627411463822769, - 0.0006476415599085048, - -0.0008211396945749756, - -0.0008052876922952627 + 0.000008490177644347142, + 0.00000758605235247693, + -0.00000816248114807126, + -0.000009064678215248934 ], - "timestamp": 1.4471558368900819 + "timestamp": 1.4909168679674047 }, { - "x": 3.2798256792271516, - "y": 7.64993687975752, - "heading": 3.1350177074584384, - "angularVelocity": -0.07663337707184525, - "velocityX": -3.9371821239799423, - "velocityY": 0.2697903463578353, + "x": 3.2989992517382074, + "y": 7.64862303533636, + "heading": 3.1397365466438067, + "angularVelocity": -0.004179656751686542, + "velocityX": -3.761579613080985, + "velocityY": 0.2577574099213453, "moduleForcesX": [ - 3.296557142281396, - 7.9931063127683935, - 3.253508368256429, - 7.948703890044839 + 0.009094518544934321, + 0.020760270010339598, + 0.00904545717923623, + 0.020710863085541747 ], "moduleForcesY": [ - 2.801876303040713, - 2.759504254960753, - -3.542841057080209, - -3.5597663854953625 + 0.006822833855844057, + 0.006786622694691792, + -0.008828299595036847, + -0.00886593159601708 ], - "timestamp": 1.5026358975216054 + "timestamp": 1.5486325256618523 }, { - "x": 3.085089770895548, - "y": 7.663280907669538, - "heading": 3.1061216686741075, - "angularVelocity": -0.5208364672895216, - "velocityX": -3.5100161412036353, - "velocityY": 0.24051934623224086, + "x": 3.096646383405922, + "y": 7.662489005645776, + "heading": 3.099333264388169, + "angularVelocity": -0.7000402294562237, + "velocityX": -3.506030710133492, + "velocityY": 0.24024624968883984, "moduleForcesX": [ - 110.08477802292596, - 112.65722835544773, - 104.97488015141077, - 109.6179279413187 + 50.58995823941143, + 79.06859096182117, + 45.97379077401858, + 75.8657491189175 ], "moduleForcesY": [ - 26.808134666937427, - 17.266378646952173, - -42.77379521334851, - -31.268524352599442 + 38.05399401236147, + 24.57350746925117, + -45.80018724585968, + -34.060897653647004 ], - "timestamp": 1.558115958153129 + "timestamp": 1.6063481833562998 }, { - "x": 2.9140881310661415, - "y": 7.674998575327416, - "heading": 3.105155596402206, - "angularVelocity": -0.017412963520669334, - "velocityX": -3.082217969535596, - "velocityY": 0.2112050261751083, + "x": 2.919012707732214, + "y": 7.674661125038715, + "heading": 3.099412894248109, + "angularVelocity": 0.0013796924980262152, + "velocityX": -3.077738048383994, + "velocityY": 0.2108980453342208, "moduleForcesX": [ - 109.9895441753885, - 104.3550095871483, - 113.34322693340162, - 110.29427213876137 + 107.90307319855803, + 96.77847026846727, + 112.04384390865157, + 104.77822606455008 ], "moduleForcesY": [ - -33.76600581568565, - -47.977843161565495, - 19.747360186036925, - 31.984331361894554 + -39.74279143105395, + -61.53659629055023, + 25.83328260307731, + 46.56311157639288 ], - "timestamp": 1.6135960187846525 + "timestamp": 1.6640638410507473 }, { "x": 2.7659969711303702, "y": 7.685146331787109, "heading": 3.141592653589793, - "angularVelocity": 0.6567595055381638, - "velocityX": -2.6692681704033054, - "velocityY": 0.1829081717680586, + "angularVelocity": 0.7308200413306929, + "velocityX": -2.6511997387593533, + "velocityY": 0.1816700557048786, "moduleForcesX": [ - 108.47344443180623, - 96.6165545347875, - 112.06660691389175, - 105.62360385351923 + 108.15585163442545, + 95.19524925336405, + 111.83787419864782, + 104.58809520720982 ], "moduleForcesY": [ - -38.92519570430599, - -62.57662299104669, - 26.852206267300026, - 45.67914176512214 + -39.76761501132118, + -64.67933399593002, + 27.74194212984173, + 47.94032248604623 ], - "timestamp": 1.669076079416176 + "timestamp": 1.7217794987451949 }, { - "x": 2.6038982695286825, - "y": 7.6649237183136245, - "heading": 3.1956405337177562, - "angularVelocity": 0.8367505818789198, - "velocityX": -2.509556018957626, - "velocityY": -0.31307950563441456, + "x": 2.6049640410007115, + "y": 7.664782649008714, + "heading": 3.199393744124749, + "angularVelocity": 0.8964222673734166, + "velocityX": -2.4974183534013745, + "velocityY": -0.31581512596622574, "moduleForcesX": [ - 41.83422551523414, - 20.093926933349472, - 53.26988081724765, - 25.248051251260662 + 40.44308656666281, + 19.971440754964316, + 50.5564706430957, + 24.496369207505076 ], "moduleForcesY": [ - -107.56161028308787, - -113.64526973932998, - -102.36030698406806, - -112.58952761642207 + -108.09087389552258, + -113.66567125217688, + -103.72669846411075, + -112.7558034048473 ], - "timestamp": 1.7336686608836411 + "timestamp": 1.7862592563758453 }, { - "x": 2.4534559802327696, - "y": 7.613116434507106, - "heading": 3.2609374996678535, - "angularVelocity": 1.0109050368731118, - "velocityX": -2.3290954762613025, - "velocityY": -0.8020624447811121, + "x": 2.4552001283226645, + "y": 7.6127809056837235, + "heading": 3.2674705141312166, + "angularVelocity": 1.0557851410735914, + "velocityX": -2.322650056098511, + "velocityY": -0.8064816810085402, "moduleForcesX": [ - 46.569118384529254, - 25.536274706249664, - 56.81596418002528, - 29.770241346526486 + 45.226375041875606, + 25.499150978953512, + 54.13342499304107, + 29.095970420083155 ], "moduleForcesY": [ - -105.58420453918784, - -112.5342845020268, - -100.41663085453068, - -111.46183761296864 + -106.16430182617323, + -112.54112536251203, + -101.88695367808478, + -111.64007832404384 ], - "timestamp": 1.7982612423511062 + "timestamp": 1.8507390140064957 }, { - "x": 2.3166983247379, - "y": 7.530531275179707, - "heading": 3.3369071826052106, - "angularVelocity": 1.1761363489648233, - "velocityX": -2.117234710053416, - "velocityY": -1.2785548657626704, + "x": 2.3187605854028295, + "y": 7.529933622115766, + "heading": 3.3452171134733306, + "angularVelocity": 1.2057520406242563, + "velocityX": -2.116005827772772, + "velocityY": -1.2848572422141984, "moduleForcesX": [ - 53.22911230390824, - 33.52093165182788, - 62.28363856197371, - 37.27033259543514 + 51.96652105002971, + 33.61193018096148, + 59.71715418771986, + 36.73910240668683 ], "moduleForcesY": [ - -102.36662249013636, - -110.39863935620404, - -97.09133480103483, - -109.15657312819252 + -103.01044274754196, + -110.36868341598839, + -98.68934221201854, + -109.33674686043935 ], - "timestamp": 1.8628538238185712 + "timestamp": 1.915218771637146 }, { - "x": 2.1969742890390256, - "y": 7.418854878805073, - "heading": 3.4225521025382863, - "angularVelocity": 1.3259250209130369, - "velocityX": -1.8535261012780346, - "velocityY": -1.7289353334002464, + "x": 2.1990562651224095, + "y": 7.417920323946954, + "heading": 3.4315895544419974, + "angularVelocity": 1.339528002934206, + "velocityX": -1.856463558162018, + "velocityY": -1.7371854716086164, "moduleForcesX": [ - 63.43366418473747, - 46.39707082363183, - 71.42788762753945, - 50.63883300977951 + 62.373204466867904, + 46.75158878982661, + 69.15810736949037, + 50.35015435786028 ], "moduleForcesY": [ - -96.33740524696931, - -105.59817168074845, - -90.52715351089934, - -103.58836930621423 + -97.02260752007696, + -105.43790145029102, + -92.27049869774041, + -103.72888519276769 ], - "timestamp": 1.9274464052860363 + "timestamp": 1.9796985292677964 }, { - "x": 2.1003596745762305, - "y": 7.282561627306502, - "heading": 3.515746646315559, - "angularVelocity": 1.4428056854209226, - "velocityX": -1.4957540365755344, - "velocityY": -2.110044968046691, + "x": 2.1023160383572215, + "y": 7.281280072098081, + "heading": 3.5243571583852424, + "angularVelocity": 1.4387089429620925, + "velocityX": -1.5003193299721926, + "velocityY": -2.1191185710028386, "moduleForcesX": [ - 81.12995040952684, - 70.24316896316002, - 87.54712653568924, - 75.69379680678855 + 80.66473849864626, + 71.23628387541477, + 86.0067061174086, + 75.822836584088 ], "moduleForcesY": [ - -81.90176576678063, - -91.3996674473233, - -74.94978844811001, - -86.88518138121633 + -82.34976809206437, + -90.61976741253586, + -76.70722702894611, + -86.77144470833042 ], - "timestamp": 1.9920389867535013 + "timestamp": 2.044178286898447 }, { - "x": 2.0362298570340878, - "y": 7.136817952344609, - "heading": 3.6091816521183286, - "angularVelocity": 1.4465284353100543, - "velocityX": -0.9928356490047431, - "velocityY": -2.256353154662237, + "x": 2.038063613949293, + "y": 7.135647873363902, + "heading": 3.6158452935029373, + "angularVelocity": 1.4188659895676503, + "velocityX": -0.9964743474374704, + "velocityY": -2.258572365739674, "moduleForcesX": [ - 110.54658737476858, - 110.46580054393857, - 110.65938530025991, - 110.57960043427866 + 111.05416659333262, + 111.44531662002107, + 110.46111986931379, + 110.88084813088572 ], "moduleForcesY": [ - -32.22495698602908, - -32.49781898234213, - -31.831627846959382, - -32.10463531819637 + -30.379702096445413, + -28.93083101067706, + -32.49068702774339, + -31.04484716514678 ], - "timestamp": 2.056631568220966 + "timestamp": 2.1086580445290974 }, { - "x": 2.0000328535317293, - "y": 7.00954832171531, - "heading": 3.684763708566743, - "angularVelocity": 1.1701352497652446, - "velocityX": -0.5603894856035522, - "velocityY": -1.9703443915367336, + "x": 2.0013545736510343, + "y": 7.0088159096041425, + "heading": 3.688917978757038, + "angularVelocity": 1.1332655074895304, + "velocityX": -0.5693110775715734, + "velocityY": -1.9670043502066354, "moduleForcesX": [ - 84.5907695917968, - 87.53770821277455, - 104.56901726794132, - 103.5827144442495 + 82.87186793378049, + 86.23137198290867, + 104.08623484052183, + 103.1023851887016 ], "moduleForcesY": [ - 78.09476192896813, - 74.87353802308712, - 48.15163557428633, - 50.38760823256537 + 79.91712175914667, + 76.3774570141547, + 49.184042523510534, + 51.3661933336912 ], - "timestamp": 2.121224149688431 + "timestamp": 2.173137802159748 }, { - "x": 1.979849844477774, - "y": 6.911539256829025, - "heading": 3.739739735467122, - "angularVelocity": 0.8511198291102626, - "velocityX": -0.3124663637127081, - "velocityY": -1.5173424356116236, + "x": 1.9805814621873397, + "y": 6.911177269143885, + "heading": 3.741849430185043, + "angularVelocity": 0.8209002851903341, + "velocityX": -0.32216485028818215, + "velocityY": -1.514252597218904, "moduleForcesX": [ - 30.06375622596869, - 46.109164119120635, - 66.85054699912203, - 74.9927037213041 + 30.484801894737167, + 46.14585781783154, + 66.51760613520348, + 74.56500704734002 ], "moduleForcesY": [ - 111.27708032715553, - 105.68256490842481, - 93.84303659418204, - 87.55367623297971 + 111.16368416399357, + 105.66705745601732, + 94.08276854670737, + 87.91946833120016 ], - "timestamp": 2.1858167311558963 + "timestamp": 2.2376175597903987 }, { - "x": 1.9693496075903936, - "y": 6.845493549123404, - "heading": 3.775413943056067, - "angularVelocity": 0.5522957401371797, - "velocityX": -0.16256103485613407, - "velocityY": -1.0224967976994015, + "x": 1.9696098500886425, + "y": 6.84537565225515, + "heading": 3.7761218180779657, + "angularVelocity": 0.5315216612512774, + "velocityX": -0.17015591407061162, + "velocityY": -1.020500375724993, "moduleForcesX": [ - 6.490482928093923, - 26.678062716919083, - 41.639324015691834, - 57.01438866829596 + 7.91174135701497, + 27.295991115954823, + 41.965926793271784, + 56.732341958223216 ], "moduleForcesY": [ - 115.1532497135499, - 112.22997904008609, - 107.51146412413155, - 100.25774640780517 + 115.06446151670663, + 112.08099626886076, + 107.38703277594348, + 100.41815919051018 ], - "timestamp": 2.2504093126233613 + "timestamp": 2.3020973174210493 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 0.2696598841914468, - "velocityX": -0.0653429655066825, - "velocityY": -0.5140355112232071, + "angularVelocity": 0.25915347126399724, + "velocityX": -0.06949333381079396, + "velocityY": -0.5131065156466116, "moduleForcesX": [ - -4.8570701717238745, - 16.654847468018957, - 27.261383429269873, - 46.43149894465734 + -3.0597671677725646, + 17.497246051702884, + 28.010467240856862, + 46.226601115224796 ], "moduleForcesY": [ - 115.26897371338562, - 114.17712362294918, - 112.06865783448855, - 105.61087783646231 + 115.33044468651329, + 114.05057698106346, + 111.88568251229192, + 105.70098429664759 ], - "timestamp": 2.3150018940908264 + "timestamp": 2.3665770750517 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 5.645981487090982e-22, - "velocityX": 3.176043053137262e-21, - "velocityY": 7.195320626100023e-23, + "angularVelocity": 4.18442017835183e-20, + "velocityX": 1.2624704293971776e-19, + "velocityY": 8.893851774089632e-21, "moduleForcesX": [ - -11.194107913078028, - 10.902305920487592, - 18.094880741208765, - 39.657568879500616 + -9.238891886617166, + 11.831191033757847, + 19.1293505178647, + 39.49563580458859 ], "moduleForcesY": [ - 114.84784529450765, - 114.88625738279924, - 113.93583193326246, - 108.35750475803425 + 115.02128580058941, + 114.79379693930308, + 113.76815074013281, + 108.41678324342678 ], - "timestamp": 2.3795944755582914 + "timestamp": 2.4310568326823505 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue 5 to Amp.traj b/src/main/deploy/choreo/Blue 5 to Amp.traj index fd9ae6d..a59c71c 100644 --- a/src/main/deploy/choreo/Blue 5 to Amp.traj +++ b/src/main/deploy/choreo/Blue 5 to Amp.traj @@ -4,9 +4,9 @@ "x": 7.84, "y": 5.789093017578125, "heading": 3.141592653589793, - "angularVelocity": 3.864499903901422e-23, - "velocityX": 1.6362365454470194e-21, - "velocityY": 8.475122557710336e-22, + "angularVelocity": -1.0403534656091185e-23, + "velocityX": 2.8385757952612522e-21, + "velocityY": 1.754655461207754e-22, "moduleForcesX": [ 0, 0, @@ -22,760 +22,760 @@ "timestamp": 0 }, { - "x": 7.804386984749256, - "y": 5.818963407451602, - "heading": 3.141592654640039, - "angularVelocity": 1.3886947562622549e-8, - "velocityX": -0.47089570623239096, - "velocityY": 0.3949634209817354, + "x": 7.801915703893787, + "y": 5.819895567892892, + "heading": 3.141592654383112, + "angularVelocity": 1.0218405417972763e-8, + "velocityX": -0.49054796402101786, + "velocityY": 0.3967548278015514, "moduleForcesX": [ - -88.41685080559067, - -88.41685134026656, - -88.41684995134041, - -88.41685048601632 + -89.72456239926012, + -89.72456276282513, + -89.72456179694437, + -89.72456216050938 ], "moduleForcesY": [ - 74.15956707853897, - 74.1595664419741, - 74.15956809803673, - 74.15956746147187 + 72.5691589714727, + 72.56915852264281, + 72.56915971691674, + 72.56915926808685 ], - "timestamp": 0.07562824374781549 + "timestamp": 0.07763623315044801 }, { - "x": 7.733165130481669, - "y": 5.87870068413291, - "heading": 3.1415926567346326, - "angularVelocity": 2.769591969019193e-8, - "velocityX": -0.9417361919057625, - "velocityY": 0.7898805224209979, + "x": 7.7257526236644525, + "y": 5.8814962104214334, + "heading": 3.1415926559388794, + "angularVelocity": 2.003919753404797e-8, + "velocityX": -0.981024930482415, + "velocityY": 0.7934522326600857, "moduleForcesX": [ - -88.40648241970496, - -88.40648295141078, - -88.40648157044113, - -88.40648210214695 + -89.71157645751234, + -89.71157680696288, + -89.71157587879169, + -89.71157622824224 ], "moduleForcesY": [ - 74.15086997738469, - 74.15086934453556, - 74.15087099113398, - 74.15087035828488 + 72.55865592998232, + 72.5586554987349, + 72.5586566463959, + 72.55865621514847 ], - "timestamp": 0.15125648749563098 + "timestamp": 0.15527246630089603 }, { - "x": 7.626340702412968, - "y": 5.968299592298079, - "heading": 3.141592659864831, - "angularVelocity": 4.138927601200874e-8, - "velocityX": -1.4124938353045773, - "velocityY": 1.1847281349536445, + "x": 7.611519766641148, + "y": 5.973887660021114, + "heading": 3.141592658206744, + "angularVelocity": 2.9211418602605457e-8, + "velocityX": -1.4713858772866655, + "velocityY": 1.1900558006290556, "moduleForcesX": [ - -88.39092769362989, - -88.3909282209318, - -88.39092685175883, - -88.39092737906076 + -89.6903556646401, + -89.69035599106215, + -89.69035512437979, + -89.69035545080186 ], "moduleForcesY": [ - 74.1378225244418, - 74.13782189710157, - 74.13782352966786, - 74.13782290232764 + 72.54149253338231, + 72.54149213079452, + 72.54149320244666, + 72.54149279985887 ], - "timestamp": 0.22688473124344646 + "timestamp": 0.23290869945134404 }, { - "x": 7.4839241438804045, - "y": 6.087751371974113, - "heading": 3.14159266401632, - "angularVelocity": 5.489336496426752e-8, - "velocityX": -1.8831133909106093, - "velocityY": 1.5794599181008275, + "x": 7.459234501547516, + "y": 6.09705586883968, + "heading": 3.1415926610898817, + "angularVelocity": 3.713649834301922e-8, + "velocityX": -1.9615231047921198, + "velocityY": 1.586478424061156, "moduleForcesX": [ - -88.36499989530778, - -88.36500041539998, - -88.3649990655369, - -88.36499958562912 + -89.64943586702498, + -89.64943614914596, + -89.64943540062544, + -89.64943568274641 ], "moduleForcesY": [ - 74.11607403920986, - 74.1160734208864, - 74.1160750304833, - 74.11607441215983 + 72.50839656371215, + 72.50839621616346, + 72.50839714174288, + 72.50839679419418 ], - "timestamp": 0.30251297499126195 + "timestamp": 0.31054493260179206 }, { - "x": 7.305936340953446, - "y": 6.237038503722604, - "heading": 3.141592669161458, - "angularVelocity": 6.803196607882386e-8, - "velocityX": -2.353456778931214, - "velocityY": 1.9739600491886735, + "x": 7.268944263180371, + "y": 6.250962471535492, + "heading": 3.141592664325284, + "angularVelocity": 4.1673866210267806e-8, + "velocityX": -2.4510493444264503, + "velocityY": 1.9824068794986809, "moduleForcesX": [ - -88.31314580096668, - -88.31314630713541, - -88.31314499455604, - -88.3131455007248 + -89.53768198601384, + -89.53768214766599, + -89.53768171961279, + -89.53768188126494 ], "moduleForcesY": [ - 74.07257832876685, - 74.0725777278508, - 74.0725792930976, - 74.07257869218155 + 72.4180099222743, + 72.41800972375923, + 72.41801025311995, + 72.41801005460489 ], - "timestamp": 0.37814121873907747 + "timestamp": 0.38818116575224004 }, { - "x": 7.092439877339699, - "y": 6.4161084917221185, - "heading": 3.1415926752250933, - "angularVelocity": 8.017686861531298e-8, - "velocityX": -2.8229726492877, - "velocityY": 2.3677660504272553, + "x": 7.041301900991139, + "y": 6.435079442411686, + "heading": 3.14159266433028, + "angularVelocity": 6.434659980226883e-11, + "velocityX": -2.9321665020518712, + "velocityY": 2.3715340557469027, "moduleForcesX": [ - -88.15776848327013, - -88.15776895157923, - -88.1577677403473, - -88.15776820865639 + -87.9996031521211, + -87.99960165358323, + -87.99960551643635, + -87.99960401789855 ], "moduleForcesY": [ - 73.94224635017493, - 73.94224579656832, - 73.94224724125631, - 73.9422466876497 + 71.17401035154589, + 71.17401211337099, + 71.17400732956905, + 71.17400909139415 ], - "timestamp": 0.453769462486893 + "timestamp": 0.46581739890268803 }, { - "x": 6.862403858117085, - "y": 6.609050171403948, - "heading": 3.141592675228291, - "angularVelocity": 4.227895638899564e-11, - "velocityX": -3.0416681364395526, - "velocityY": 2.5511855111325605, + "x": 6.8136379578443655, + "y": 6.619213767938429, + "heading": 3.1415926643325944, + "angularVelocity": 2.98162795621733e-11, + "velocityX": -2.9324444773820173, + "velocityY": 2.371757593776043, "moduleForcesX": [ - -41.06294995986311, - -41.06294622640053, - -41.06295115821892, - -41.0629474244754 + -0.05084358373972663, + -0.050843579300801696, + -0.05084358138239444, + -0.050843576958249995 ], "moduleForcesY": [ - 34.43941386958152, - 34.43941479451641, - 34.439408469304176, - 34.43940939490503 + 0.04088662735497638, + 0.040886627539810205, + 0.04088662720255321, + 0.0408866274277148 ], - "timestamp": 0.5293977062347085 + "timestamp": 0.543453632053136 }, { - "x": 6.632357399761043, - "y": 6.801980462733905, - "heading": 3.1415926752313657, - "angularVelocity": 4.0648056359994824e-11, - "velocityX": -3.041806168646974, - "velocityY": 2.5510349278146487, + "x": 6.58597261081092, + "y": 6.803346358526077, + "heading": 3.1415926643349095, + "angularVelocity": 2.9815304194295546e-11, + "velocityX": -2.932462560261807, + "velocityY": 2.371735246747818, "moduleForcesX": [ - -0.025917328301607805, - -0.025917397773985305, - -0.025917320555397437, - -0.0259173893513379 + -0.00330748172317311, + -0.003307481786022645, + -0.003307481858617945, + -0.0033074819207971947 ], "moduleForcesY": [ - -0.028273671044889415, - -0.028274266787425645, - -0.02827372578557447, - -0.02827431541372518 + -0.004087423562569713, + -0.004087423593728358, + -0.00408742360898491, + -0.00408742364067536 ], - "timestamp": 0.605025949982524 + "timestamp": 0.621089865203584 }, { - "x": 6.402072911582864, - "y": 6.994626570545385, - "heading": 3.141592675234442, - "angularVelocity": 4.067971071486534e-11, - "velocityX": -3.044953535428767, - "velocityY": 2.5472772903978105, + "x": 6.358266536478161, + "y": 6.987428581453392, + "heading": 3.1415926643372245, + "angularVelocity": 2.98196238161316e-11, + "velocityX": -2.932987151649883, + "velocityY": 2.3710864818826223, "moduleForcesX": [ - -0.5909595067608326, - -0.5909594800381297, - -0.5909593823052591, - -0.5909593553877736 + -0.09595133639405176, + -0.09595133636676093, + -0.09595133624904402, + -0.0959513362215452 ], "moduleForcesY": [ - -0.705545714436184, - -0.7055458142175607, - -0.7055456945121211, - -0.7055457941638968 + -0.11866351061120779, + -0.11866351070665564, + -0.11866351059046351, + -0.1186635106857128 ], - "timestamp": 0.6806541937303395 + "timestamp": 0.698726098354032 }, { - "x": 6.1663635965102745, - "y": 7.1805951955577285, - "heading": 3.141592675237588, - "angularVelocity": 4.1596178423747995e-11, - "velocityX": -3.1166837069305515, - "velocityY": 2.4589837843182147, + "x": 6.129385033333283, + "y": 7.170047155234762, + "heading": 3.14159266433955, + "angularVelocity": 2.995690672790387e-11, + "velocityX": -2.948127360859174, + "velocityY": 2.3522338265366587, "moduleForcesX": [ - -13.468281354040977, - -13.468281333716769, - -13.468281376664086, - -13.46828135618857 + -2.769247337930091, + -2.7692473384292775, + -2.7692473400290107, + -2.769247340528674 ], "moduleForcesY": [ - -16.578264863811963, - -16.578264874356943, - -16.57826484852706, - -16.578264859051814 + -3.44827901258727, + -3.4482790111240282, + -3.4482790129454086, + -3.4482790114828967 ], - "timestamp": 0.756282437478155 + "timestamp": 0.77636233150448 }, { - "x": 5.907218564598163, - "y": 7.332200360310185, - "heading": 3.14159267524121, - "angularVelocity": 4.7894146112420855e-11, - "velocityX": -3.426564191761982, - "velocityY": 2.004610410602528, + "x": 5.88209636867458, + "y": 7.326837161822197, + "heading": 3.1415926643421153, + "angularVelocity": 3.30371829044516e-11, + "velocityX": -3.1852223455959274, + "velocityY": 2.0195468046936056, "moduleForcesX": [ - -58.1841290599635, - -58.18412906038532, - -58.18412906031337, - -58.18412906073494 + -43.36628685569254, + -43.36628685589723, + -43.36628685569064, + -43.36628685589532 ], "moduleForcesY": [ - -85.31456581504214, - -85.31456581480037, - -85.31456581471323, - -85.31456581447162 + -60.85072123516317, + -60.85072123509917, + -60.850721235009324, + -60.850721234945325 ], - "timestamp": 0.8319106812259706 + "timestamp": 0.853998564654928 }, { - "x": 5.628079296821089, - "y": 7.442713249379176, - "heading": 3.141592675245288, - "angularVelocity": 5.391640365188102e-11, - "velocityX": -3.6909394419877284, - "velocityY": 1.4612647814155275, + "x": 5.612608115354213, + "y": 7.44131210061748, + "heading": 3.141592664345216, + "angularVelocity": 3.994305220349218e-11, + "velocityX": -3.4711660056733877, + "velocityY": 1.474504031815228, "moduleForcesX": [ - -49.639923881366215, - -49.639923881932916, - -49.63992388172823, - -49.63992388229493 + -52.30104213787289, + -52.3010421384724, + -52.30104213828144, + -52.301042138880945 ], "moduleForcesY": [ - -102.02027478517165, - -102.02027478490187, - -102.02027478497904, - -102.02027478470927 + -99.69203382192678, + -99.69203382162236, + -99.69203382168664, + -99.69203382138221 ], - "timestamp": 0.9075389249737861 + "timestamp": 0.931634797805376 }, { - "x": 5.335317495359145, - "y": 7.509086944055442, - "heading": 3.1415926750707146, - "angularVelocity": -2.3083108894089293e-9, - "velocityX": -3.8710643927970487, - "velocityY": 0.8776310461153854, + "x": 5.327912239314761, + "y": 7.50959437971124, + "heading": 3.1415926642865455, + "angularVelocity": -7.557067068121798e-10, + "velocityX": -3.6670490631320476, + "velocityY": 0.8795156117561669, "moduleForcesX": [ - -33.8208243425392, - -33.82082406908601, - -33.820824230126675, - -33.820823956673486 + -35.8283448481557, + -35.82834476031454, + -35.828344809681155, + -35.828344721840004 ], "moduleForcesY": [ - -109.58489553923485, - -109.5848956230017, - -109.58489557665949, - -109.58489566042633 + -108.82743270079975, + -108.82743272946998, + -108.82743271448132, + -108.82743274315155 ], - "timestamp": 0.9831671687216016 + "timestamp": 1.009271030955824 }, { "x": 5.035840072631835, "y": 7.529608249664307, "heading": 3.141592653589793, - "angularVelocity": -2.8403305758359793e-7, - "velocityX": -3.9598621875436577, - "velocityY": 0.27134446857306244, + "angularVelocity": -1.3778041516011634e-7, + "velocityX": -3.762059992232384, + "velocityY": 0.25779032728547985, "moduleForcesX": [ - -16.672973763417268, - -16.67293682726911, - -16.67296653041068, - -16.672929594277857 + -17.378156269782163, + -17.37813883051833, + -17.378152707029265, + -17.378135267768847 ], "moduleForcesY": [ - -113.83826079590199, - -113.83826618574518, - -113.83826203751487, - -113.83826742735344 + -113.71778560366965, + -113.71778825853885, + -113.71778623741099, + -113.7177888922791 ], - "timestamp": 1.058795412469417 + "timestamp": 1.086907264106272 }, { - "x": 4.8161858301349545, - "y": 7.544659774408683, - "heading": 3.141261009826011, - "angularVelocity": -0.005977710911032145, - "velocityX": -3.959156496885198, - "velocityY": 0.271296112027398, + "x": 4.818734526967475, + "y": 7.544485128232927, + "heading": 3.141362002173113, + "angularVelocity": -0.003996340436793055, + "velocityX": -3.7616403301464163, + "velocityY": 0.2577615704802417, "moduleForcesX": [ - -0.018593166864404487, - 0.3800231783603618, - -0.0187780717345422, - 0.37983792515152204 + -0.024792117629372414, + 0.23137972399738163, + -0.024874744188840826, + 0.23129698238991547 ], "moduleForcesY": [ - 0.25515896497117335, - 0.25501866357344083, - -0.2797750022282368, - -0.2799103160185767 + 0.16484362026686902, + 0.16478126217454553, + -0.17893257077270838, + -0.17899328061213599 ], - "timestamp": 1.1142754731009405 + "timestamp": 1.1446229218007196 }, { - "x": 4.596531603138407, - "y": 7.559711298090919, - "heading": 3.140929288083857, - "angularVelocity": -0.0059791164317072945, - "velocityX": -3.9591562174995163, - "velocityY": 0.27129609288285317, + "x": 4.60162898654068, + "y": 7.55936200644265, + "heading": 3.1411313232709985, + "angularVelocity": -0.003996816658245245, + "velocityX": -3.761640239398693, + "velocityY": 0.2577615642618706, "moduleForcesX": [ - 0.000025612992006065086, - 0.00011941564717905257, - 0.00002360245464479842, - 0.0001174054593274741 + 0.000007204180719356383, + 0.00003773149835788362, + 0.0000069231161169374015, + 0.00003745044709400768 ], "moduleForcesY": [ - 0.00005871943135136759, - 0.00005720676841727365, - -0.00006700765927160055, - -0.00006851882774530035 + 0.000019058256691630695, + 0.000018849052179001888, + -0.000021908763710286178, + -0.00002211834623925837 ], - "timestamp": 1.169755533732464 + "timestamp": 1.202338579495167 }, { - "x": 4.37687737872891, - "y": 7.574762821595881, - "heading": 3.140597534231695, - "angularVelocity": -0.005979695198340648, - "velocityX": -3.9591561708692615, - "velocityY": 0.27129608968757485, + "x": 4.38452344666509, + "y": 7.574238884614604, + "heading": 3.140900634383137, + "angularVelocity": -0.003996989674498232, + "velocityX": -3.7616402298483314, + "velocityY": 0.2577615636074443, "moduleForcesX": [ - -0.000006771269872669978, - 0.00003182466245725801, - -0.000007954457474905524, - 0.00003064136901031203 + -0.000003179633409385358, + 0.000007911345105099387, + -0.0000032118578890623888, + 0.000007879121329596486 ], "moduleForcesY": [ - 0.0000255199387963323, - 0.000024637757552653808, - -0.000026273740195479133, - -0.00002715529916690631 + 0.000007292887593340667, + 0.000007268884281012189, + -0.000007590905367963583, + -0.000007614919170638431 ], - "timestamp": 1.2252355943639877 + "timestamp": 1.2600542371896146 }, { - "x": 4.157223156893371, - "y": 7.5898143449244655, - "heading": 3.140265748410205, - "angularVelocity": -0.005980271429300119, - "velocityX": -3.959156124474958, - "velocityY": 0.27129608650846476, + "x": 4.167417907338466, + "y": 7.589115762748939, + "heading": 3.1406699355417973, + "angularVelocity": -0.003997162131650262, + "velocityX": -3.7616402203368033, + "velocityY": 0.257761562955679, "moduleForcesX": [ - -0.000006828724200291363, - 0.00003159709828148899, - -0.000007847745328245317, - 0.00003057810699160968 + -0.0000031755909448883706, + 0.000007879578382528402, + -0.0000031991997213915274, + 0.00000785596949024404 ], "moduleForcesY": [ - 0.00002534996110939576, - 0.00002458955338139237, - -0.000026218051690890895, - -0.00002697625269046444 + 0.000007266281602389286, + 0.000007248684756348649, + -0.000007569405113026906, + -0.000007586995154163464 ], - "timestamp": 1.2807156549955112 + "timestamp": 1.3177698948840622 }, { - "x": 3.9375689376216587, - "y": 7.604865868077368, - "heading": 3.1399339307508978, - "angularVelocity": -0.005980845289820074, - "velocityX": -3.9591560782633017, - "velocityY": 0.2712960833418705, + "x": 3.950312368559187, + "y": 7.603992640845768, + "heading": 3.1404392267773398, + "angularVelocity": -0.003997334062777751, + "velocityX": -3.7616402108533076, + "velocityY": 0.2577615623058347, "moduleForcesX": [ - -0.000007003893466524137, - 0.00003137644246304145, - -0.000007716670892301974, - 0.00003065586212925565 + -0.0000031650180316538163, + 0.00000785642813949844, + -0.000003189843558058993, + 0.000007831602528717756 ], "moduleForcesY": [ - 0.00002508688541999312, - 0.00002456619647907267, - -0.00002616067770793661, - -0.000026734380327000042 + 0.000007244577609204609, + 0.00000722607953419065, + -0.000007545849230742892, + -0.000007564351262925504 ], - "timestamp": 1.3361957156270348 + "timestamp": 1.3754855525785097 }, { - "x": 3.7179147209650303, - "y": 7.619917391051073, - "heading": 3.1396020811924448, - "angularVelocity": -0.005981420255779386, - "velocityX": -3.9591560311277267, - "velocityY": 0.2712960801119657, + "x": 3.7332068303256905, + "y": 7.618869518905198, + "heading": 3.140208508119994, + "angularVelocity": -0.003997505470129434, + "velocityX": -3.761640201396926, + "velocityY": 0.25776156165784825, "moduleForcesX": [ - -0.000009319624026353035, - 0.000030180280445294102, - -0.000006030651673570838, - 0.00003342764857052338 + -0.000003139443251794745, + 0.000007849472748191663, + -0.0000031961911096245354, + 0.000007792645970955111 ], "moduleForcesY": [ - 0.000023333383452071322, - 0.000025631362768478403, - -0.00002732752627695467, - -0.000024944013734834488 + 0.000007233882319316402, + 0.000007191809830107993, + -0.000007510298546544899, + -0.000007553108492988018 ], - "timestamp": 1.3916757762585583 + "timestamp": 1.4332012102729572 }, { - "x": 3.4982607821829097, - "y": 7.6349688949837855, - "heading": 3.139269331864783, - "angularVelocity": -0.0059976381401617785, - "velocityX": -3.959151022580424, - "velocityY": 0.2712957369076971, + "x": 3.5161012930772024, + "y": 7.633746396897135, + "heading": 3.139977778282167, + "angularVelocity": -0.0039976991867276025, + "velocityX": -3.7616401843303224, + "velocityY": 0.25776156048838117, "moduleForcesX": [ - 0.0007285537406330433, - 0.001811076606425356, - 0.0007528434980948667, - 0.001835303631750865 + -0.0000014116108881133617, + 0.000011019749815764846, + -0.000002621565097237515, + 0.00000980949966013142 ], "moduleForcesY": [ - 0.000627411463822769, - 0.0006476415599085048, - -0.0008211396945749756, - -0.0008052876922952627 + 0.000008490177644347142, + 0.00000758605235247693, + -0.00000816248114807126, + -0.000009064678215248934 ], - "timestamp": 1.4471558368900819 + "timestamp": 1.4909168679674047 }, { - "x": 3.2798256792271516, - "y": 7.64993687975752, - "heading": 3.1350177074584384, - "angularVelocity": -0.07663337707184525, - "velocityX": -3.9371821239799423, - "velocityY": 0.2697903463578353, + "x": 3.2989992517382074, + "y": 7.64862303533636, + "heading": 3.1397365466438067, + "angularVelocity": -0.004179656751686542, + "velocityX": -3.761579613080985, + "velocityY": 0.2577574099213453, "moduleForcesX": [ - 3.296557142281396, - 7.9931063127683935, - 3.253508368256429, - 7.948703890044839 + 0.009094518544934321, + 0.020760270010339598, + 0.00904545717923623, + 0.020710863085541747 ], "moduleForcesY": [ - 2.801876303040713, - 2.759504254960753, - -3.542841057080209, - -3.5597663854953625 + 0.006822833855844057, + 0.006786622694691792, + -0.008828299595036847, + -0.00886593159601708 ], - "timestamp": 1.5026358975216054 + "timestamp": 1.5486325256618523 }, { - "x": 3.085089770895548, - "y": 7.663280907669538, - "heading": 3.1061216686741075, - "angularVelocity": -0.5208364672895216, - "velocityX": -3.5100161412036353, - "velocityY": 0.24051934623224086, + "x": 3.096646383405922, + "y": 7.662489005645776, + "heading": 3.099333264388169, + "angularVelocity": -0.7000402294562237, + "velocityX": -3.506030710133492, + "velocityY": 0.24024624968883984, "moduleForcesX": [ - 110.08477802292596, - 112.65722835544773, - 104.97488015141077, - 109.6179279413187 + 50.58995823941143, + 79.06859096182117, + 45.97379077401858, + 75.8657491189175 ], "moduleForcesY": [ - 26.808134666937427, - 17.266378646952173, - -42.77379521334851, - -31.268524352599442 + 38.05399401236147, + 24.57350746925117, + -45.80018724585968, + -34.060897653647004 ], - "timestamp": 1.558115958153129 + "timestamp": 1.6063481833562998 }, { - "x": 2.9140881310661415, - "y": 7.674998575327416, - "heading": 3.105155596402206, - "angularVelocity": -0.017412963520669334, - "velocityX": -3.082217969535596, - "velocityY": 0.2112050261751083, + "x": 2.919012707732214, + "y": 7.674661125038715, + "heading": 3.099412894248109, + "angularVelocity": 0.0013796924980262152, + "velocityX": -3.077738048383994, + "velocityY": 0.2108980453342208, "moduleForcesX": [ - 109.9895441753885, - 104.3550095871483, - 113.34322693340162, - 110.29427213876137 + 107.90307319855803, + 96.77847026846727, + 112.04384390865157, + 104.77822606455008 ], "moduleForcesY": [ - -33.76600581568565, - -47.977843161565495, - 19.747360186036925, - 31.984331361894554 + -39.74279143105395, + -61.53659629055023, + 25.83328260307731, + 46.56311157639288 ], - "timestamp": 1.6135960187846525 + "timestamp": 1.6640638410507473 }, { "x": 2.7659969711303702, "y": 7.685146331787109, "heading": 3.141592653589793, - "angularVelocity": 0.6567595055381638, - "velocityX": -2.6692681704033054, - "velocityY": 0.1829081717680586, + "angularVelocity": 0.7308200413306929, + "velocityX": -2.6511997387593533, + "velocityY": 0.1816700557048786, "moduleForcesX": [ - 108.47344443180623, - 96.6165545347875, - 112.06660691389175, - 105.62360385351923 + 108.15585163442545, + 95.19524925336405, + 111.83787419864782, + 104.58809520720982 ], "moduleForcesY": [ - -38.92519570430599, - -62.57662299104669, - 26.852206267300026, - 45.67914176512214 + -39.76761501132118, + -64.67933399593002, + 27.74194212984173, + 47.94032248604623 ], - "timestamp": 1.669076079416176 + "timestamp": 1.7217794987451949 }, { - "x": 2.6038982695286825, - "y": 7.6649237183136245, - "heading": 3.1956405337177562, - "angularVelocity": 0.8367505818789198, - "velocityX": -2.509556018957626, - "velocityY": -0.31307950563441456, + "x": 2.6049640410007115, + "y": 7.664782649008714, + "heading": 3.199393744124749, + "angularVelocity": 0.8964222673734166, + "velocityX": -2.4974183534013745, + "velocityY": -0.31581512596622574, "moduleForcesX": [ - 41.83422551523414, - 20.093926933349472, - 53.26988081724765, - 25.248051251260662 + 40.44308656666281, + 19.971440754964316, + 50.5564706430957, + 24.496369207505076 ], "moduleForcesY": [ - -107.56161028308787, - -113.64526973932998, - -102.36030698406806, - -112.58952761642207 + -108.09087389552258, + -113.66567125217688, + -103.72669846411075, + -112.7558034048473 ], - "timestamp": 1.7336686608836411 + "timestamp": 1.7862592563758453 }, { - "x": 2.4534559802327696, - "y": 7.613116434507106, - "heading": 3.2609374996678535, - "angularVelocity": 1.0109050368731118, - "velocityX": -2.3290954762613025, - "velocityY": -0.8020624447811121, + "x": 2.4552001283226645, + "y": 7.6127809056837235, + "heading": 3.2674705141312166, + "angularVelocity": 1.0557851410735914, + "velocityX": -2.322650056098511, + "velocityY": -0.8064816810085402, "moduleForcesX": [ - 46.569118384529254, - 25.536274706249664, - 56.81596418002528, - 29.770241346526486 + 45.226375041875606, + 25.499150978953512, + 54.13342499304107, + 29.095970420083155 ], "moduleForcesY": [ - -105.58420453918784, - -112.5342845020268, - -100.41663085453068, - -111.46183761296864 + -106.16430182617323, + -112.54112536251203, + -101.88695367808478, + -111.64007832404384 ], - "timestamp": 1.7982612423511062 + "timestamp": 1.8507390140064957 }, { - "x": 2.3166983247379, - "y": 7.530531275179707, - "heading": 3.3369071826052106, - "angularVelocity": 1.1761363489648233, - "velocityX": -2.117234710053416, - "velocityY": -1.2785548657626704, + "x": 2.3187605854028295, + "y": 7.529933622115766, + "heading": 3.3452171134733306, + "angularVelocity": 1.2057520406242563, + "velocityX": -2.116005827772772, + "velocityY": -1.2848572422141984, "moduleForcesX": [ - 53.22911230390824, - 33.52093165182788, - 62.28363856197371, - 37.27033259543514 + 51.96652105002971, + 33.61193018096148, + 59.71715418771986, + 36.73910240668683 ], "moduleForcesY": [ - -102.36662249013636, - -110.39863935620404, - -97.09133480103483, - -109.15657312819252 + -103.01044274754196, + -110.36868341598839, + -98.68934221201854, + -109.33674686043935 ], - "timestamp": 1.8628538238185712 + "timestamp": 1.915218771637146 }, { - "x": 2.1969742890390256, - "y": 7.418854878805073, - "heading": 3.4225521025382863, - "angularVelocity": 1.3259250209130369, - "velocityX": -1.8535261012780346, - "velocityY": -1.7289353334002464, + "x": 2.1990562651224095, + "y": 7.417920323946954, + "heading": 3.4315895544419974, + "angularVelocity": 1.339528002934206, + "velocityX": -1.856463558162018, + "velocityY": -1.7371854716086164, "moduleForcesX": [ - 63.43366418473747, - 46.39707082363183, - 71.42788762753945, - 50.63883300977951 + 62.373204466867904, + 46.75158878982661, + 69.15810736949037, + 50.35015435786028 ], "moduleForcesY": [ - -96.33740524696931, - -105.59817168074845, - -90.52715351089934, - -103.58836930621423 + -97.02260752007696, + -105.43790145029102, + -92.27049869774041, + -103.72888519276769 ], - "timestamp": 1.9274464052860363 + "timestamp": 1.9796985292677964 }, { - "x": 2.1003596745762305, - "y": 7.282561627306502, - "heading": 3.515746646315559, - "angularVelocity": 1.4428056854209226, - "velocityX": -1.4957540365755344, - "velocityY": -2.110044968046691, + "x": 2.1023160383572215, + "y": 7.281280072098081, + "heading": 3.5243571583852424, + "angularVelocity": 1.4387089429620925, + "velocityX": -1.5003193299721926, + "velocityY": -2.1191185710028386, "moduleForcesX": [ - 81.12995040952684, - 70.24316896316002, - 87.54712653568924, - 75.69379680678855 + 80.66473849864626, + 71.23628387541477, + 86.0067061174086, + 75.822836584088 ], "moduleForcesY": [ - -81.90176576678063, - -91.3996674473233, - -74.94978844811001, - -86.88518138121633 + -82.34976809206437, + -90.61976741253586, + -76.70722702894611, + -86.77144470833042 ], - "timestamp": 1.9920389867535013 + "timestamp": 2.044178286898447 }, { - "x": 2.0362298570340878, - "y": 7.136817952344609, - "heading": 3.6091816521183286, - "angularVelocity": 1.4465284353100543, - "velocityX": -0.9928356490047431, - "velocityY": -2.256353154662237, + "x": 2.038063613949293, + "y": 7.135647873363902, + "heading": 3.6158452935029373, + "angularVelocity": 1.4188659895676503, + "velocityX": -0.9964743474374704, + "velocityY": -2.258572365739674, "moduleForcesX": [ - 110.54658737476858, - 110.46580054393857, - 110.65938530025991, - 110.57960043427866 + 111.05416659333262, + 111.44531662002107, + 110.46111986931379, + 110.88084813088572 ], "moduleForcesY": [ - -32.22495698602908, - -32.49781898234213, - -31.831627846959382, - -32.10463531819637 + -30.379702096445413, + -28.93083101067706, + -32.49068702774339, + -31.04484716514678 ], - "timestamp": 2.056631568220966 + "timestamp": 2.1086580445290974 }, { - "x": 2.0000328535317293, - "y": 7.00954832171531, - "heading": 3.684763708566743, - "angularVelocity": 1.1701352497652446, - "velocityX": -0.5603894856035522, - "velocityY": -1.9703443915367336, + "x": 2.0013545736510343, + "y": 7.0088159096041425, + "heading": 3.688917978757038, + "angularVelocity": 1.1332655074895304, + "velocityX": -0.5693110775715734, + "velocityY": -1.9670043502066354, "moduleForcesX": [ - 84.5907695917968, - 87.53770821277455, - 104.56901726794132, - 103.5827144442495 + 82.87186793378049, + 86.23137198290867, + 104.08623484052183, + 103.1023851887016 ], "moduleForcesY": [ - 78.09476192896813, - 74.87353802308712, - 48.15163557428633, - 50.38760823256537 + 79.91712175914667, + 76.3774570141547, + 49.184042523510534, + 51.3661933336912 ], - "timestamp": 2.121224149688431 + "timestamp": 2.173137802159748 }, { - "x": 1.979849844477774, - "y": 6.911539256829025, - "heading": 3.739739735467122, - "angularVelocity": 0.8511198291102626, - "velocityX": -0.3124663637127081, - "velocityY": -1.5173424356116236, + "x": 1.9805814621873397, + "y": 6.911177269143885, + "heading": 3.741849430185043, + "angularVelocity": 0.8209002851903341, + "velocityX": -0.32216485028818215, + "velocityY": -1.514252597218904, "moduleForcesX": [ - 30.06375622596869, - 46.109164119120635, - 66.85054699912203, - 74.9927037213041 + 30.484801894737167, + 46.14585781783154, + 66.51760613520348, + 74.56500704734002 ], "moduleForcesY": [ - 111.27708032715553, - 105.68256490842481, - 93.84303659418204, - 87.55367623297971 + 111.16368416399357, + 105.66705745601732, + 94.08276854670737, + 87.91946833120016 ], - "timestamp": 2.1858167311558963 + "timestamp": 2.2376175597903987 }, { - "x": 1.9693496075903936, - "y": 6.845493549123404, - "heading": 3.775413943056067, - "angularVelocity": 0.5522957401371797, - "velocityX": -0.16256103485613407, - "velocityY": -1.0224967976994015, + "x": 1.9696098500886425, + "y": 6.84537565225515, + "heading": 3.7761218180779657, + "angularVelocity": 0.5315216612512774, + "velocityX": -0.17015591407061162, + "velocityY": -1.020500375724993, "moduleForcesX": [ - 6.490482928093923, - 26.678062716919083, - 41.639324015691834, - 57.01438866829596 + 7.91174135701497, + 27.295991115954823, + 41.965926793271784, + 56.732341958223216 ], "moduleForcesY": [ - 115.1532497135499, - 112.22997904008609, - 107.51146412413155, - 100.25774640780517 + 115.06446151670663, + 112.08099626886076, + 107.38703277594348, + 100.41815919051018 ], - "timestamp": 2.2504093126233613 + "timestamp": 2.3020973174210493 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 0.2696598841914468, - "velocityX": -0.0653429655066825, - "velocityY": -0.5140355112232071, + "angularVelocity": 0.25915347126399724, + "velocityX": -0.06949333381079396, + "velocityY": -0.5131065156466116, "moduleForcesX": [ - -4.8570701717238745, - 16.654847468018957, - 27.261383429269873, - 46.43149894465734 + -3.0597671677725646, + 17.497246051702884, + 28.010467240856862, + 46.226601115224796 ], "moduleForcesY": [ - 115.26897371338562, - 114.17712362294918, - 112.06865783448855, - 105.61087783646231 + 115.33044468651329, + 114.05057698106346, + 111.88568251229192, + 105.70098429664759 ], - "timestamp": 2.3150018940908264 + "timestamp": 2.3665770750517 }, { "x": 1.9651289367675773, "y": 6.812290668487549, "heading": 3.79283197109421, - "angularVelocity": 5.645981487090982e-22, - "velocityX": 3.176043053137262e-21, - "velocityY": 7.195320626100023e-23, + "angularVelocity": 4.18442017835183e-20, + "velocityX": 1.2624704293971776e-19, + "velocityY": 8.893851774089632e-21, "moduleForcesX": [ - -11.194107913078028, - 10.902305920487592, - 18.094880741208765, - 39.657568879500616 + -9.238891886617166, + 11.831191033757847, + 19.1293505178647, + 39.49563580458859 ], "moduleForcesY": [ - 114.84784529450765, - 114.88625738279924, - 113.93583193326246, - 108.35750475803425 + 115.02128580058941, + 114.79379693930308, + 113.76815074013281, + 108.41678324342678 ], - "timestamp": 2.3795944755582914 + "timestamp": 2.4310568326823505 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.1.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.1.traj index 9346e8b..6567eb8 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.1.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.1.traj @@ -4,9 +4,9 @@ "x": 1.3383026504516593, "y": 6.508597373962402, "heading": 3.141592653589793, - "angularVelocity": 6.630957232918865e-24, - "velocityX": 1.2060997095687284e-21, - "velocityY": 7.138625871741085e-22, + "angularVelocity": 1.3038840850576071e-23, + "velocityX": 2.4437165324259185e-20, + "velocityY": 2.3610738986678838e-20, "moduleForcesX": [ 0, 0, @@ -22,487 +22,487 @@ "timestamp": 0 }, { - "x": 1.360373693575745, - "y": 6.490858286972303, - "heading": 3.1415926537545715, - "angularVelocity": 2.791277359525368e-9, - "velocityX": 0.37387393953457276, - "velocityY": -0.30049247330305445, + "x": 1.3606762519021935, + "y": 6.491593300242642, + "heading": 3.141592653934462, + "angularVelocity": 5.860742394414825e-9, + "velocityX": 0.3804405020078545, + "velocityY": -0.28913710456614355, "moduleForcesX": [ - 89.9335744997474, - 89.93357437032692, - 89.93357471542468, - 89.93357458600421 + 91.86115898733682, + 91.86115873638171, + 91.86115942954156, + 91.86115917858646 ], "moduleForcesY": [ - -72.28201650320291, - -72.28201666391996, - -72.28201623452371, - -72.28201639524077 + -69.8150419508136, + -69.81504228033295, + -69.81504136827428, + -69.81504169779365 ], - "timestamp": 0.05903338208477806 + "timestamp": 0.058809725390574434 }, { - "x": 1.405907900199343, - "y": 6.457273283717531, - "heading": 3.141592654041051, - "angularVelocity": 4.8528378035858e-9, - "velocityX": 0.7713297970664508, - "velocityY": -0.5689154520494931, + "x": 1.4065981178654914, + "y": 6.459259290320045, + "heading": 3.141592654534016, + "angularVelocity": 1.0194809067899609e-8, + "velocityX": 0.7808549633298908, + "velocityY": -0.5498071910361221, "moduleForcesX": [ - 95.60609124537717, - 95.60609117215726, - 95.60609139046502, - 95.60609131724513 + 96.68407098415938, + 96.68407083847602, + 96.68407128358729, + 96.68407113790394 ], "moduleForcesY": [ - -64.56785412261065, - -64.56785423072633, - -64.56785390750468, - -64.56785401562036 + -62.94139609260588, + -62.9413963157317, + -62.94139563208089, + -62.941395855206714 ], - "timestamp": 0.11806676416955612 + "timestamp": 0.11761945078114887 }, { - "x": 1.4765447536535539, - "y": 6.4106030861332375, - "heading": 3.141592654382145, - "angularVelocity": 5.7779888064285394e-9, - "velocityX": 1.1965577942454484, - "velocityY": -0.7905729933831371, + "x": 1.4774683902709602, + "y": 6.414007881814992, + "heading": 3.1415926552518396, + "angularVelocity": 1.2205862140824193e-8, + "velocityX": 1.2050774244361193, + "velocityY": -0.769454511214312, "moduleForcesX": [ - 102.28654562921923, - 102.28654560786362, - 102.28654568393445, - 102.28654566257883 + 102.43275036895024, + 102.43275032289199, + 102.43275048774566, + 102.4327504416874 ], "moduleForcesY": [ - -53.318653483475146, - -53.31865352424747, - -53.31865337837213, - -53.31865341914446 + -53.03603938436765, + -53.03603947289088, + -53.03603915462784, + -53.03603924315107 ], - "timestamp": 0.17710014625433418 + "timestamp": 0.1764291761717233 }, { - "x": 1.574035572309243, - "y": 6.354993169367381, - "heading": 3.1415926546713044, - "angularVelocity": 4.898239232168307e-9, - "velocityX": 1.6514523683512157, - "velocityY": -0.9420079758600776, + "x": 1.5748401096935096, + "y": 6.359448552089576, + "heading": 3.1415926558733664, + "angularVelocity": 1.0568433440115126e-8, + "velocityX": 1.6557077724113216, + "velocityY": -0.9277263133447715, "moduleForcesX": [ - 109.4226977827373, - 109.42269779178159, - 109.4226977467203, - 109.4226977557646 + 108.80919848005884, + 108.80919849872592, + 108.80919840952849, + 108.80919842819554 ], "moduleForcesY": [ - -36.42695526387283, - -36.42695523703391, - -36.42695537221109, - -36.42695534537217 + -38.21630738279977, + -38.2163073302424, + -38.216307583892046, + -38.21630753133467 ], - "timestamp": 0.23613352833911225 + "timestamp": 0.23523890156229774 }, { - "x": 1.6996897527512385, - "y": 6.296639809307858, - "heading": 3.1415926547484605, - "angularVelocity": 1.3069855500542915e-9, - "velocityX": 2.12852755516435, - "velocityY": -0.9884807205476072, + "x": 1.7000330137492494, + "y": 6.301073904680199, + "heading": 3.1415926560683887, + "angularVelocity": 3.3161627750963975e-9, + "velocityX": 2.1287789260074454, + "velocityY": -0.9926019382286351, "moduleForcesX": [ - 114.75813729356562, - 114.758137297369, - 114.75813724814749, - 114.75813725195087 + 114.22775516938997, + 114.22775518362513, + 114.22775504044942, + 114.22775505468458 ], "moduleForcesY": [ - -11.178794576619698, - -11.178794542775297, - -11.178795043548345, - -11.178795009703942 + -15.664867188867005, + -15.664867092783892, + -15.66486813051833, + -15.664868034435214 ], - "timestamp": 0.2951669104238903 + "timestamp": 0.29404862695287215 }, { - "x": 1.8530572488614867, - "y": 6.243977280961659, - "heading": 3.1415926544261383, - "angularVelocity": -5.4599966824676236e-9, - "velocityX": 2.59797915508206, - "velocityY": -0.89208048880833, + "x": 1.8529974827402018, + "y": 6.246814000732414, + "heading": 3.14159265541152, + "angularVelocity": -1.1169390588664581e-8, + "velocityX": 2.601006346740538, + "velocityY": -0.9226348803268013, "moduleForcesX": [ - 112.92432007869411, - 112.92432010689029, - 112.92432025584654, - 112.92432028404271 + 114.02402722958729, + 114.02402726270897, + 114.02402750725163, + 114.02402754037331 ], "moduleForcesY": [ - 23.188611712515762, - 23.188611580506432, - 23.18861084835494, - 23.18861071634561 + 16.894246009646203, + 16.89424580273802, + 16.894244132302816, + 16.894243925394655 ], - "timestamp": 0.35420029250866836 + "timestamp": 0.3528583523434466 }, { "x": 2.0305891418457023, "y": 6.206027030944824, "heading": 3.141592653589793, - "angularVelocity": -1.41673272774077e-8, - "velocityX": 3.0073136031620438, - "velocityY": -0.6428608471446738, + "angularVelocity": -3.0976627423086376e-8, + "velocityX": 3.01976684852814, + "velocityY": -0.6935412385742356, "moduleForcesX": [ - 98.46342857989701, - 98.46342884163893, - 98.46342915330816, - 98.46342941505006 + 101.11390491533385, + 101.11390541508874, + 101.1139061315249, + 101.11390663127975 ], "moduleForcesY": [ - 59.94858455591424, - 59.94858412862332, - 59.9485836119735, - 59.948583184682576 + 55.31694957591115, + 55.316948669637505, + 55.31694734752721, + 55.316946441253585 ], - "timestamp": 0.4132336745934464 + "timestamp": 0.41166807773402103 }, { - "x": 2.1412933116032296, - "y": 6.191150636092829, - "heading": 3.14159265292153, - "angularVelocity": -1.9255903720714354e-8, - "velocityX": 3.1899244141732543, - "velocityY": -0.4286611356844206, + "x": 2.144123859559337, + "y": 6.189128805794054, + "heading": 3.1415926520668265, + "angularVelocity": -4.304084953192806e-8, + "velocityX": 3.2086258231614173, + "velocityY": -0.47756389125936755, "moduleForcesX": [ - 74.72006152267744, - 74.720062180148, - 74.7200622715512, - 74.72006292902178 + 75.79181974401808, + 75.79182122905927, + 75.7918214779103, + 75.79182296295147 ], "moduleForcesY": [ - 87.64550023101428, - 87.64549967297322, - 87.64549958869247, - 87.6454990306514 + 86.67481554424154, + 86.67481425219059, + 86.67481401804265, + 86.67481272599169 ], - "timestamp": 0.4479379983904787 + "timestamp": 0.4470522963905208 }, { - "x": 2.2581660072287857, - "y": 6.183842078444728, - "heading": 3.1415926521241615, - "angularVelocity": -2.2976054030823205e-8, - "velocityX": 3.3676695823000085, - "velocityY": -0.21059501665681998, + "x": 2.2639843753712037, + "y": 6.18016177358942, + "heading": 3.141592650288091, + "angularVelocity": -5.026916236661669e-8, + "velocityX": 3.3874003825106165, + "velocityY": -0.2534189688256973, "moduleForcesX": [ - 72.7291547139968, - 72.7291552190221, - 72.72915526359016, - 72.72915576861547 + 71.74479952082707, + 71.74480050570537, + 71.74480056888426, + 71.74480155376254 ], "moduleForcesY": [ - 89.22754338297806, - 89.22754297343552, - 89.22754293154452, - 89.22754252200197 + 89.9525802508206, + 89.95257946983592, + 89.95257940726893, + 89.95257862628424 ], - "timestamp": 0.482642322187511 + "timestamp": 0.48243651504702056 }, { - "x": 2.3809494713599806, - "y": 6.184294815459166, - "heading": 3.141592651266816, - "angularVelocity": -2.470428325703209e-8, - "velocityX": 3.5379875098357156, - "velocityY": 0.013045550666419022, + "x": 2.389571390134287, + "y": 6.179555476543678, + "heading": 3.14159264851177, + "angularVelocity": -5.020095867030148e-8, + "velocityX": 3.549238036940923, + "velocityY": -0.01713467383944276, "moduleForcesX": [ - 69.69010228267334, - 69.69010253451678, - 69.69010253849493, - 69.69010279033836 + 64.94777713696435, + 64.94777712617515, + 64.94777712711469, + 64.9477771163255 ], "moduleForcesY": [ - 91.50847668582237, - 91.50847649519085, - 91.50847648894374, - 91.50847629831223 + 94.8242841393538, + 94.82428414669351, + 94.82428414619828, + 94.82428415353799 ], - "timestamp": 0.5173466459845434 + "timestamp": 0.5178207337035203 }, { - "x": 2.5092046684620093, - "y": 6.192809216565774, - "heading": 3.1415926504585743, - "angularVelocity": -2.3289384208573192e-8, - "velocityX": 3.6956546928309955, - "velocityY": 0.24534121904819894, + "x": 2.5197147134837774, + "y": 6.187978683471175, + "heading": 3.141592647155592, + "angularVelocity": -3.8327187932807255e-8, + "velocityX": 3.678004723317062, + "velocityY": 0.23804982128523042, "moduleForcesX": [ - 64.51371470905569, - 64.5137144790559, - 64.51371450113164, - 64.51371427113186 + 51.67592423146398, + 51.675921865334786, + 51.675922642465125, + 51.67592027633598 ], "moduleForcesY": [ - 95.04994076157364, - 95.04994091651318, - 95.04994090501094, - 95.04994105995048 + 102.40920514483192, + 102.40920632891202, + 102.40920597290442, + 102.40920715698445 ], - "timestamp": 0.5520509697815758 + "timestamp": 0.5532049523600201 }, { - "x": 2.642036196298328, - "y": 6.209897699263131, - "heading": 3.1415926498928193, - "angularVelocity": -1.6302148367032502e-8, - "velocityX": 3.827520991712202, - "velocityY": 0.4924021224934082, + "x": 2.651628898663585, + "y": 6.206318425861407, + "heading": 3.1415926469091398, + "angularVelocity": -6.965042680926931e-9, + "velocityX": 3.7280513796388868, + "velocityY": 0.5183028787005051, "moduleForcesX": [ - 53.95659882762613, - 53.956597460085185, - 53.95659785770279, - 53.95659649016185 + 20.084447875703354, + 20.084439343980897, + 20.084445853541716, + 20.084437321820065 ], "moduleForcesY": [ - 101.09152827192861, - 101.09152899469002, - 101.09152880759252, - 101.09152953035392 + 112.46957956001775, + 112.46958106687973, + 112.46958004666081, + 112.46958155352249 ], - "timestamp": 0.5867552935786081 + "timestamp": 0.5885891710165199 }, { - "x": 2.7769445076649037, - "y": 6.236418641581392, - "heading": 3.141592649972671, - "angularVelocity": 2.300909589137675e-9, - "velocityX": 3.8873632045270536, - "velocityY": 0.7641970629760313, + "x": 2.781959966689114, + "y": 6.234528802394688, + "heading": 3.1415926469445252, + "angularVelocity": 1.0000411747845848e-9, + "velocityX": 3.683310610607146, + "velocityY": 0.7972587103629419, "moduleForcesX": [ - 24.486033599317093, - 24.486028605162087, - 24.486032145214327, - 24.4860271510596 + -17.955112905071424, + -17.95511506648689, + -17.955112448576028, + -17.95511460999148 ], "moduleForcesY": [ - 111.21211617203402, - 111.21211725559323, - 111.2121165898599, - 111.21211767341899 + 111.94898532090939, + 111.94898498074893, + 111.94898544852427, + 111.94898510836381 ], - "timestamp": 0.6214596173756405 + "timestamp": 0.6239733896730196 }, { "x": 2.9098873519897452, "y": 6.272213459014893, "heading": 3.141592653589793, - "angularVelocity": 1.0422684584050202e-7, - "velocityX": 3.8307285600017855, - "velocityY": 1.0314224141881145, + "angularVelocity": 1.8780315353423049e-7, + "velocityX": 3.6153796850091515, + "velocityY": 1.065013106154394, "moduleForcesX": [ - -23.173558952779814, - -23.173585661195226, - -23.173551615441973, - -23.173578323848453 + -27.26164138908449, + -27.261687418435052, + -27.261626473603847, + -27.261672495979123 ], "moduleForcesY": [ - 109.34234948074224, - 109.34234401324865, - 109.34235225772302, - 109.34234679023307 + 107.4536903303801, + 107.45367915993492, + 107.45369679884978, + 107.45368563018049 ], - "timestamp": 0.6561639411726728 + "timestamp": 0.6593576083295194 }, { - "x": 3.1603986784572013, - "y": 6.3231515960882705, - "heading": 3.1416374237621625, - "angularVelocity": 0.0006952279229344114, - "velocityX": 3.8901451558950786, - "velocityY": 0.7910091331222168, + "x": 3.1493843891892954, + "y": 6.321687036535868, + "heading": 3.141664767074809, + "angularVelocity": 0.0011120470558586106, + "velocityX": 3.693234005337154, + "velocityY": 0.7629217505263336, "moduleForcesX": [ - 13.121852274764045, - 13.064389136188524, - 13.139894013731855, - 13.08221911280367 + 17.08299633181651, + 16.987922786906466, + 17.109096037610176, + 17.013600230983286 ], "moduleForcesY": [ - -53.0288598867414, - -53.03975477257369, - -52.988890196634124, - -52.99881173698235 + -66.1742223370393, + -66.19005542160966, + -66.11296782712692, + -66.1285159280569 ], - "timestamp": 0.7205603367898992 + "timestamp": 0.7242051205243732 }, { - "x": 3.391041812990585, - "y": 6.368906756131182, - "heading": 3.1971668651967757, - "angularVelocity": 0.8623066695328977, - "velocityX": 3.5816155907907, - "velocityY": 0.7105236186646428, + "x": 3.382246269373911, + "y": 6.367449891304312, + "heading": 3.1619423700697604, + "angularVelocity": 0.31269669889603824, + "velocityX": 3.59091462884362, + "velocityY": 0.7056994666338948, "moduleForcesX": [ - -44.11069948337996, - -77.93257191852247, - -61.65027573650249, - -88.44467603288614 + -13.03049078611549, + -29.89084865536969, + -14.597690630033014, + -32.10384734714733 ], "moduleForcesY": [ - -66.62250167635625, - -49.06442321531918, - 29.264082865339244, - 15.43066697140624 + -25.326666831227865, + -24.010835804743515, + -0.30058703362777717, + -0.48365569924820384 ], - "timestamp": 0.7849567324071255 + "timestamp": 0.7890526327192271 }, { - "x": 3.5887658336829418, - "y": 6.408161403232978, - "heading": 3.249240648554511, - "angularVelocity": 0.8086443792174824, - "velocityX": 3.070420615893362, - "velocityY": 0.609578326947492, + "x": 3.582643713722037, + "y": 6.407094531486908, + "heading": 3.21220711122596, + "angularVelocity": 0.775122120416338, + "velocityX": 3.0902873150472114, + "velocityY": 0.6113517518370116, "moduleForcesX": [ - -113.37930141282058, - -113.31038231556873, - -112.17591781085852, - -112.03346259287214 + -101.86125988188819, + -107.37956537588973, + -114.4003441550063, + -114.86482929848356 ], "moduleForcesY": [ - -18.9747004039528, - -19.252528450952163, - -25.139953355100378, - -25.671520826831017 + -52.801268558007735, + -40.97120389792949, + 7.940512733369161, + 3.1915648360079207 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.853900144914081 }, { - "x": 3.7535388104071985, - "y": 6.440888378700207, - "heading": 3.294315536071584, - "angularVelocity": 0.6999597894422492, - "velocityX": 2.5587298038180735, - "velocityY": 0.5082112927835114, + "x": 3.74957200139756, + "y": 6.440171200929541, + "heading": 3.2643499121170314, + "angularVelocity": 0.8040832890303158, + "velocityX": 2.5741664101767947, + "velocityY": 0.5100684409179003, "moduleForcesX": [ - -114.09797780307427, - -114.09477809264078, - -111.70139457807457, - -111.44226639158964 + -112.6621836921574, + -112.71395426887672, + -113.33454508007006, + -113.36635432566645 ], "moduleForcesY": [ - -16.046789303576624, - -15.913469790924887, - -28.264792093674224, - -29.185649391513163 + -23.975233317914196, + -23.760754374517084, + -20.560125698225118, + -20.41926066788013 ], - "timestamp": 0.9137495236415781 + "timestamp": 0.9187476571089348 }, { - "x": 3.8853571288837903, - "y": 6.46707806462633, - "heading": 3.3311943975575473, - "angularVelocity": 0.5726851810957213, - "velocityX": 2.046982866248028, - "velocityY": 0.40669490388552565, + "x": 3.8830382819529596, + "y": 6.4666455306855655, + "heading": 3.310848593184776, + "angularVelocity": 0.7170464909744748, + "velocityX": 2.0581557570683664, + "velocityY": 0.4082551336198438, "moduleForcesX": [ - -114.29110618647697, - -114.36206703200219, - -111.4800422611308, - -111.25270682753366 + -113.99095150053886, + -114.00144220452556, + -112.06402825139101, + -111.92404445290259 ], "moduleForcesY": [ - -15.260854841380633, - -14.588291440363218, - -29.45468827574504, - -30.238604229916476 + -17.29547040716993, + -17.146375445393463, + -27.107357918420117, + -27.630401033774774 ], - "timestamp": 0.9781459192588045 + "timestamp": 0.9835951693037887 }, { - "x": 3.9842204502938396, - "y": 6.486724686682261, - "heading": 3.3592810829924, - "angularVelocity": 0.436153066730639, - "velocityX": 1.5352306672208056, - "velocityY": 0.3050888464738175, + "x": 3.9830877412366763, + "y": 6.486507786121201, + "heading": 3.348167817033145, + "angularVelocity": 0.5754919901357481, + "velocityX": 1.5428419055319809, + "velocityY": 0.306291710558663, "moduleForcesX": [ - -114.37291094617866, - -114.4993666671828, - -111.34420578314202, - -111.17407977417216 + -114.41545555950157, + -114.52951979915328, + -111.3213417082967, + -111.10381175028604 ], "moduleForcesY": [ - -14.958857918149443, - -13.847592290940542, - -30.121770154710845, - -30.693310454835217 + -14.610037306398736, + -13.568499959103484, + -30.197132480138382, + -30.935423415459912 ], - "timestamp": 1.0425423148760309 + "timestamp": 1.0484426814986425 }, { - "x": 4.050129030114216, - "y": 6.4998244090967265, - "heading": 3.3782210905143044, - "angularVelocity": 0.29411595696263265, - "velocityX": 1.0234824354477678, - "velocityY": 0.20342322406257038, + "x": 4.049759249513341, + "y": 6.499752126190816, + "heading": 3.374257262379604, + "angularVelocity": 0.4023199111797186, + "velocityX": 1.0281274642630942, + "velocityY": 0.20423821394749517, "moduleForcesX": [ - -114.41751735086633, - -114.58169370325807, - -111.2551454634251, - -111.13270734016963 + -114.6105493516157, + -114.80042068735355, + -110.83549271399103, + -110.59863478702998 ], "moduleForcesY": [ - -14.806913472107988, - -13.3832091553941, - -30.541558492398913, - -30.942388952573637 + -13.232312421102897, + -11.333508890236551, + -32.03182827040654, + -32.79234017749459 ], - "timestamp": 1.1069387104932573 + "timestamp": 1.1132901936934962 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": 0.14840255835934255, - "velocityX": 0.5117392128533452, - "velocityY": 0.10172039612631649, + "angularVelocity": 0.20849555419784327, + "velocityX": 0.5138815704216189, + "velocityY": 0.10212743022896026, "moduleForcesX": [ - -114.44886671702382, - -114.63396863953965, - -111.19900874167607, - -111.1008014180239 + -114.724824422317, + -114.95598681748031, + -110.5061283467708, + -110.24775114592603 ], "moduleForcesY": [ - -14.690983770851986, - -13.086624955255907, - -30.80623117071299, - -31.123047275253498 + -12.365796823336515, + -9.84830935437339, + -33.2105013101652, + -34.015560796461884 ], - "timestamp": 1.1713351061104837 + "timestamp": 1.17813770588835 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": -3.105341690772561e-20, - "velocityX": -1.4124494217269478e-19, - "velocityY": 6.271250526786711e-19, + "angularVelocity": 4.829716369297222e-20, + "velocityX": -6.470993346981879e-19, + "velocityY": 3.317822838461728e-18, "moduleForcesX": [ - -114.47707589122757, - -114.66679939987269, - -111.1697067800063, - -111.065526656675 + -114.80814664741962, + -115.0502198256128, + -110.29067964070413, + -109.96652897988713 ], "moduleForcesY": [ - -14.56120001128053, - -12.910071305056444, - -30.955087024537587, - -31.296024837316292 + -11.686076549663122, + -8.850873959259824, + -33.960278185612424, + -34.95752048556571 ], - "timestamp": 1.2357315017277102 + "timestamp": 1.2429852180832037 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.2.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.2.traj index 53a352e..aa08f41 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.2.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.2.traj @@ -4,337 +4,358 @@ "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": -3.105341690772561e-20, - "velocityX": -1.4124494217269478e-19, - "velocityY": 6.271250526786711e-19, + "angularVelocity": 4.829716369297222e-20, + "velocityX": -6.470993346981879e-19, + "velocityY": 3.317822838461728e-18, "moduleForcesX": [ - -114.47707589122757, - -114.66679939987269, - -111.1697067800063, - -111.065526656675 + -114.80814664741962, + -115.0502198256128, + -110.29067964070413, + -109.96652897988713 ], "moduleForcesY": [ - -14.56120001128053, - -12.910071305056444, - -30.955087024537587, - -31.296024837316292 + -11.686076549663122, + -8.850873959259824, + -33.960278185612424, + -34.95752048556571 ], "timestamp": 0 }, { - "x": 4.14842233006486, - "y": 6.524834886416186, - "heading": 3.37925014191358, - "angularVelocity": -0.09327225382491805, - "velocityX": 0.7146644720743753, - "velocityY": 0.20191178488512537, + "x": 4.142327477746525, + "y": 6.523112878711347, + "heading": 3.379198429591823, + "angularVelocity": -0.09853884197083598, + "velocityX": 0.6804630807934998, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - 109.86538217101113, - 109.99598273674891, - 112.06663111203557, - 112.07438057028466 + 109.71928226568595, + 109.873434250603, + 112.16839647851953, + 112.1714231836321 ], "moduleForcesY": [ - 35.34716847772429, - 34.947790309423084, - 27.583683757251283, - 27.563877482273224 + 35.788801078214966, + 35.3232395177045, + 27.154535423780896, + 27.155842975944093 ], - "timestamp": 0.09142631500519394 + "timestamp": 0.08706466008335156 }, { - "x": 4.2790937475882345, - "y": 6.561752331915095, - "heading": 3.362280414592137, - "angularVelocity": -0.18561097338855564, - "velocityX": 1.42925390262039, - "velocityY": 0.4037945256440808, + "x": 4.260809898031729, + "y": 6.556586338886186, + "heading": 3.3621463296179686, + "angularVelocity": -0.1958555854640666, + "velocityX": 1.3608554857019415, + "velocityY": 0.38446667273258245, "moduleForcesX": [ - 109.85041536836742, - 110.00945422487305, - 112.03171567433651, - 112.06416998026944 + 109.70709462938454, + 109.89245539711602, + 112.12825792036838, + 112.15861944802991 ], "moduleForcesY": [ - 35.34795624249508, - 34.861185811795494, - 27.666287641216297, - 27.549045973918602 + 35.77869126173569, + 35.21826543338535, + 27.256949433753093, + 27.148840736400928 ], - "timestamp": 0.18285263001038787 + "timestamp": 0.17412932016670313 }, { - "x": 4.4750859570933414, - "y": 6.617122892086999, - "heading": 3.337013895365562, - "angularVelocity": -0.27635937448796466, - "velocityX": 2.1437176976231873, - "velocityY": 0.605630448616008, + "x": 4.438520122396817, + "y": 6.606791013546223, + "heading": 3.336801806178079, + "angularVelocity": -0.2911000102179912, + "velocityX": 2.0411292503176015, + "velocityY": 0.576636658455609, "moduleForcesX": [ - 109.82922400996979, - 110.02889664351, - 111.97547028101597, - 112.04411023069696 + 109.69117162238662, + 109.92048751533748, + 112.06359871366229, + 112.13376889158263 ], "moduleForcesY": [ - 35.337678294007155, - 34.7258621306889, - 27.79538355148314, - 27.536465024579382 + 35.748453188226485, + 35.05402926782663, + 27.417403309854702, + 27.151367351771693 ], - "timestamp": 0.2742789450155818 + "timestamp": 0.2611939802500547 }, { - "x": 4.7363756738996505, - "y": 6.690938650379312, - "heading": 3.3037368442226525, - "angularVelocity": -0.3639767296868421, - "velocityX": 2.8579268101472284, - "velocityY": 0.8073797821570229, + "x": 4.675437089885676, + "y": 6.6737192302015265, + "heading": 3.30352069263772, + "angularVelocity": -0.3822574338255884, + "velocityX": 2.7211611147628285, + "velocityY": 0.7687185201346813, "moduleForcesX": [ - 109.80240908300571, - 110.05001149729426, - 111.87607678799765, - 111.99097622261095 + 109.67704537348169, + 109.95591771814277, + 111.94887517290019, + 112.06937336812729 ], "moduleForcesY": [ - 35.26876905745412, - 34.51004456710348, - 27.999126804996703, - 27.563652818630974 + 35.633500837393704, + 34.78801753120004, + 27.676054770743455, + 27.21618805639235 ], - "timestamp": 0.36570526002077575 + "timestamp": 0.34825864033340626 }, { - "x": 5.062891365124138, - "y": 6.783177700282454, - "heading": 3.2632360654606747, - "angularVelocity": -0.44298820049432014, - "velocityX": 3.5713535124535785, - "velocityY": 1.0088895073360595, + "x": 4.971495381970558, + "y": 6.75734995310902, + "heading": 3.2632951732216937, + "angularVelocity": -0.4620189107442214, + "velocityX": 3.4004416005466473, + "velocityY": 0.9605587712331257, "moduleForcesX": [ - 109.76393441481733, - 110.04642262897143, - 111.62926676038799, - 111.79375874723351 + 109.68108201991289, + 109.98511497469858, + 111.66164166914167, + 111.8331752723527 ], "moduleForcesY": [ - 34.92992729055453, - 34.06895702532383, - 28.399362365285945, - 27.794484147904964 + 35.14208193111417, + 34.222358457681196, + 28.211854056678618, + 27.57984056765551 ], - "timestamp": 0.4571315750259697 + "timestamp": 0.4353233004167578 }, { - "x": 5.412207246810782, - "y": 6.881877306152213, - "heading": 3.263217434387312, - "angularVelocity": -0.00020378239417672257, - "velocityX": 3.8207367503196448, - "velocityY": 1.0795535821842126, + "x": 5.28750589994817, + "y": 6.846642506147694, + "heading": 3.263275324690442, + "angularVelocity": -0.0002279746022443869, + "velocityX": 3.629607210033074, + "velocityY": 1.0255889468033226, "moduleForcesX": [ - 48.347985418760395, - 33.09132615961223, - 44.47101375150101, - 29.02496895286671 + 47.983517882331824, + 31.02179127083995, + 43.820835110311776, + 26.680968018866302 ], "moduleForcesY": [ - -0.5892512769537052, - -3.0944630152590573, - 23.826002374584476, - 23.75945657977806 + -1.930997783243996, + -4.7563348860656625, + 24.644907375594624, + 24.467961055834824 ], - "timestamp": 0.5485578900311636 + "timestamp": 0.5223879605001094 }, { - "x": 5.761523007820935, - "y": 6.980578519140531, - "heading": 3.263199195569124, - "angularVelocity": -0.00019949199731637702, - "velocityX": 3.8207354303879444, - "velocityY": 1.0795711604772795, + "x": 5.603516209092675, + "y": 6.935936936057916, + "heading": 3.2632558996184238, + "angularVelocity": -0.00022311086954457106, + "velocityX": 3.6296048114352195, + "velocityY": 1.025610504017777, "moduleForcesX": [ - -0.00011234051506570799, - -0.0002512833550827778, - -0.00015898547237657224, - -0.00029742975944157266 + -0.00024178774300411554, + -0.0005154689575938757, + -0.0002665381373160101, + -0.0005410448407523983 ], "moduleForcesY": [ - 0.0026141002465316916, - 0.002591336522088985, - 0.002857548674029559, - 0.0028579490702223286 + 0.003435084191229427, + 0.0033758874708626017, + 0.0036659957788613465, + 0.003586909286046499 ], - "timestamp": 0.6399842050363576 + "timestamp": 0.609452620583461 }, { - "x": 6.110838775175139, - "y": 7.079279709676494, - "heading": 3.26318095679076, - "angularVelocity": -0.00019949156173420396, - "velocityX": 3.820735499777717, - "velocityY": 1.0795709148985817, + "x": 5.919526506202657, + "y": 7.025231408572308, + "heading": 3.2632364745964955, + "angularVelocity": -0.00022311029422913506, + "velocityX": 3.6296046732101, + "velocityY": 1.0256109933571818, "moduleForcesX": [ - 0.000010826836750374956, - 0.000010817181672845025, - 0.000010737845312528724, - 0.000010728190235499784 + -0.00002440175771108094, + -0.000024341211132133213, + -0.00002075585254078544, + -0.00002067892578492775 ], "moduleForcesY": [ - -0.00003811622956670729, - -0.00003818254367165634, - -0.000038103272794834774, - -0.00003816958689886402 + 0.00007797336491842891, + 0.00008082252173480401, + 0.0000786107894483785, + 0.00008183721701490111 ], - "timestamp": 0.7314105200415515 + "timestamp": 0.6965172806668125 }, { - "x": 6.460154925275615, - "y": 7.17797836765492, - "heading": 3.2631623325971826, - "angularVelocity": -0.000203707144671611, - "velocityX": 3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 6.235536823112694, + "y": 7.114525811000592, + "heading": 3.2632170496152866, + "angularVelocity": -0.00022310982654494968, + "velocityX": 3.6296049006279225, + "velocityY": 1.0256101883680162, "moduleForcesX": [ - 0.000582673079646135, - 0.0007246120932044848, - 0.0005764704290552151, - 0.0007171396015932555 + 0.000037175746031209955, + 0.00003675022279394528, + 0.00003744493411169005, + 0.00003699595688581122 ], "moduleForcesY": [ - -0.004164770580860626, - -0.004183092183695803, - -0.004410331364142836, - -0.004451422952545398 + -0.0001311900906737163, + -0.00013113310161074358, + -0.00013127818825782144, + -0.00013157168451710384 ], - "timestamp": 0.8228368350467454 + "timestamp": 0.7835819407501641 }, { - "x": 6.7866810369969155, - "y": 7.270191836288494, - "heading": 3.2235227609386436, - "angularVelocity": -0.4335685153261054, - "velocityX": 3.571467489450394, - "velocityY": 1.0086097052947562, + "x": 6.551547647652277, + "y": 7.203817281479636, + "heading": 3.2631972085530423, + "angularVelocity": -0.00022788881533729912, + "velocityX": 3.6296107311169497, + "velocityY": 1.025576512830357, "moduleForcesX": [ - -47.82428831475678, - -32.71681627513296, - -44.74713985759357, - -29.578062869233722 + 0.0007539903240099345, + 0.0010130422482340737, + 0.0008876422954937467, + 0.001149122654947948 ], "moduleForcesY": [ - 0.711716625651444, - 2.410633102178794, - -23.286981568980845, - -23.904505269420362 + -0.005461742387567229, + -0.00532035763040487, + -0.0056743745997740415, + -0.005513368070625849 ], - "timestamp": 0.9142631500519391 + "timestamp": 0.8706466008335159 }, { - "x": 7.047980469601503, - "y": 7.343983789856553, - "heading": 3.1910396830919887, - "angularVelocity": -0.3552924324338102, - "velocityX": 2.858033079313581, - "velocityY": 0.80711941155965, + "x": 6.847617317047974, + "y": 7.2874193702981085, + "heading": 3.223811784245632, + "angularVelocity": -0.4523698165214764, + "velocityX": 3.400572277112838, + "velocityY": 0.9602298882053439, "moduleForcesX": [ - -109.72343096717086, - -110.11042093282525, - -111.57527328961994, - -111.82904603560887 + -47.41130841069759, + -30.62118618481451, + -44.110694296736526, + -27.280967448263624 ], "moduleForcesY": [ - -35.05919820242028, - -33.86318732230928, - -28.60858970792212, - -27.64968334765918 + 2.0544391321012583, + 4.023869539315489, + -24.077548013299843, + -24.63274704987536 ], - "timestamp": 1.0056894650571329 + "timestamp": 0.9577112609168676 }, { - "x": 7.243980764451501, - "y": 7.399334406788997, - "heading": 3.16642038697477, - "angularVelocity": -0.2692801970178975, - "velocityX": 2.14380613326548, - "velocityY": 0.6054123140509308, + "x": 7.084544828508775, + "y": 7.354320907313611, + "heading": 3.1912974750964462, + "angularVelocity": -0.373450136003033, + "velocityX": 2.721282219834979, + "velocityY": 0.7684120853564979, "moduleForcesX": [ - -109.71676289801981, - -110.18532231271764, - -111.76405509082994, - -112.06441279220563 + -109.63993232178557, + -110.05417979801784, + -111.60403176355548, + -111.86911447326634 ], "moduleForcesY": [ - -35.536614610144824, - -34.07720649246483, - -28.440654067765472, - -27.260877933728896 + -35.27274549289263, + -34.00135979147859, + -28.436496439475064, + -27.430888103294052 ], - "timestamp": 1.0971157800623266 + "timestamp": 1.0447759210002194 }, { - "x": 7.374657916862249, - "y": 7.436237482881837, - "heading": 3.1498977666289023, - "angularVelocity": -0.1807206201510903, - "velocityX": 1.4293166294991295, - "velocityY": 0.40363735638631854, + "x": 7.262263839170718, + "y": 7.404503175997865, + "heading": 3.1665778040536177, + "angularVelocity": -0.28392313275171893, + "velocityX": 2.0412301672320603, + "velocityY": 0.5763793097705945, "moduleForcesX": [ - -109.70681368656746, - -110.21880379377983, - -111.81972024066972, - -112.148335627715 + -109.58272113098357, + -110.10406488426497, + -111.8285077107539, + -112.14908861391909 ], "moduleForcesY": [ - -35.71803758428605, - -34.11985964537683, - -28.413265173608806, - -27.106350443857995 + -35.92513988883521, + -34.31811935636691, + -28.155739191192055, + -26.882739105963577 ], - "timestamp": 1.1885420950675203 + "timestamp": 1.1318405810835712 + }, + { + "x": 7.380752503700571, + "y": 7.437960457197711, + "heading": 3.14995739111321, + "angularVelocity": -0.19089735059547805, + "velocityX": 1.3609272053255352, + "velocityY": 0.3842808456130792, + "moduleForcesX": [ + -109.55438775829161, + -110.13043304849128, + -111.89507958039748, + -112.24817460065188 + ], + "moduleForcesY": [ + -36.16792173997458, + -34.39052165205662, + -28.094624382025973, + -26.671524840113754 + ], + "timestamp": 1.218905241166923 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": -0.09083941574848778, - "velocityX": 0.7146966727690924, - "velocityY": 0.20182916341250373, + "angularVelocity": -0.09607500351358098, + "velocityX": 0.6804999438659524, + "velocityY": 0.19215055040122933, "moduleForcesX": [ - -109.70058243131004, - -110.23546235943999, - -111.8476455542373, - -112.19103002395252 + -109.53867302844934, + -110.14366836151459, + -111.92834686125505, + -112.2984794768254 ], "moduleForcesY": [ - -35.81216376796426, - -34.141192280175495, - -28.399273440528713, - -27.02553158829393 + -36.293251007942786, + -34.426167314961475, + -28.06417924516179, + -26.561761552148816 ], - "timestamp": 1.279968410072714 + "timestamp": 1.3059699012502748 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": 5.3474824222167004e-21, - "velocityX": -1.1027416520574535e-21, - "velocityY": 1.1229424922134134e-21, + "angularVelocity": 1.0070419894358123e-20, + "velocityX": -3.7291483580721005e-21, + "velocityY": 1.6507740380137376e-21, "moduleForcesX": [ - -109.69825354519149, - -110.23935489778839, - -111.8696576656152, - -112.21511593235195 + -109.5307744441316, + -110.14478533871649, + -111.95408720798879, + -112.3269385706006 ], "moduleForcesY": [ - -35.86413648487148, - -34.173575075339286, - -28.370205373579967, - -26.98327252919034 + -36.36354115443014, + -34.46921393384205, + -28.022875739604935, + -26.502942730924968 ], - "timestamp": 1.3713947250779077 + "timestamp": 1.3930345613336266 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.3.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.3.traj index f431e6f..2245d85 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.3.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.3.traj @@ -4,337 +4,358 @@ "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": 5.3474824222167004e-21, - "velocityX": -1.1027416520574535e-21, - "velocityY": 1.1229424922134134e-21, + "angularVelocity": 1.0070419894358123e-20, + "velocityX": -3.7291483580721005e-21, + "velocityY": 1.6507740380137376e-21, "moduleForcesX": [ - -109.69825354519149, - -110.23935489778839, - -111.8696576656152, - -112.21511593235195 + -109.5307744441316, + -110.14478533871649, + -111.95408720798879, + -112.3269385706006 ], "moduleForcesY": [ - -35.86413648487148, - -34.173575075339286, - -28.370205373579967, - -26.98327252919034 + -36.36354115443014, + -34.46921393384205, + -28.022875739604935, + -26.502942730924968 ], "timestamp": 0 }, { - "x": 7.368314145951493, - "y": 7.416972530106804, + "x": 7.374537199809908, + "y": 7.420246784454786, "heading": 3.141592653589793, - "angularVelocity": -5.95153116721842e-17, - "velocityX": -0.7180685701633659, - "velocityY": -0.3778111505217192, + "angularVelocity": 1.9044065108967837e-16, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - -102.13925806744793, - -102.13925806744793, - -102.13925806744794, - -102.13925806744794 + -102.137006668336, + -102.13700666833601, + -102.13700666833601, + -102.13700666833601 ], "moduleForcesY": [ - -53.740481351409, - -53.74048135140901, - -53.74048135140901, - -53.74048135140901 + -53.739296779734275, + -53.73929677973427, + -53.73929677973426, + -53.739296779734254 ], - "timestamp": 0.09983148828279464 + "timestamp": 0.09540099175201355 }, { - "x": 7.224953430741302, - "y": 7.341543415111761, + "x": 7.243622128572477, + "y": 7.351365934157169, "heading": 3.141592653589793, - "angularVelocity": -1.0650520788048443e-16, - "velocityX": -1.4360270259027914, - "velocityY": -0.7555643644355341, + "angularVelocity": 5.1129474419478e-16, + "velocityX": -1.3722611142002967, + "velocityY": -0.7220139857315833, "moduleForcesX": [ - -102.12359521012328, - -102.12359521012328, - -102.12359521012328, - -102.12359521012328 + -102.12057878684486, + -102.12057878684486, + -102.12057878684486, + -102.12057878684487 ], "moduleForcesY": [ - -53.73224035271867, - -53.73224035271867, - -53.73224035271868, - -53.73224035271868 + -53.73065326424746, + -53.73065326424745, + -53.73065326424744, + -53.73065326424743 ], - "timestamp": 0.1996629765655893 + "timestamp": 0.1908019835040271 }, { - "x": 7.009939750663415, - "y": 7.228414155284034, + "x": 7.047275775912886, + "y": 7.2480584723333115, "heading": 3.141592653589793, - "angularVelocity": -2.561037852315152e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246718, + "angularVelocity": 8.440134370851153e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.0828761832203582, "moduleForcesX": [ - -102.09239698765671, - -102.09239698765671, - -102.09239698765671, - -102.09239698765671 + -102.08783014974713, + -102.08783014974715, + -102.08783014974715, + -102.08783014974716 ], "moduleForcesY": [ - -53.715825435238514, - -53.715825435238514, - -53.715825435238514, - -53.715825435238514 + -53.713422597464344, + -53.713422597464344, + -53.71342259746432, + -53.71342259746432 ], - "timestamp": 0.29949446484838393 + "timestamp": 0.28620297525604066 }, { - "x": 6.72333806652252, - "y": 7.077618929694229, + "x": 6.785560544972791, + "y": 7.11035723234165, "heading": 3.141592653589793, - "angularVelocity": -9.622527173380371e-17, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 1.170740883731664e-15, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041789, "moduleForcesX": [ - -101.99983969748536, - -101.99983969748537, - -101.99983969748536, - -101.99983969748537 + -101.99046691326758, + -101.9904669132676, + -101.9904669132676, + -101.9904669132676 ], "moduleForcesY": [ - -53.66712649791996, - -53.66712649791995, - -53.66712649791995, - -53.66712649791995 + -53.66219501569665, + -53.66219501569664, + -53.662195015696625, + -53.662195015696625 ], - "timestamp": 0.3993259531311786 + "timestamp": 0.3816039670080542 }, { - "x": 6.372544082043546, - "y": 6.893048981392569, + "x": 6.467102087337348, + "y": 6.942800593223961, "heading": 3.141592653589793, - "angularVelocity": -6.334843659951388e-17, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 7.597859985024076e-17, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - -91.46231173778874, - -91.46231173778875, - -91.46231173778872, - -91.46231173778875 + -88.53246892183462, + -88.5324689218346, + -88.53246892183459, + -88.53246892183458 ], "moduleForcesY": [ - -48.12281537286679, - -48.12281537286681, - -48.12281537286679, - -48.1228153728668 + -46.58128113625254, + -46.58128113625257, + -46.58128113625262, + -46.58128113625264 ], - "timestamp": 0.4991574414139732 + "timestamp": 0.47700495876006777 }, { - "x": 6.021747838682743, - "y": 6.70847784458221, + "x": 6.1486418905328355, + "y": 6.7752430390439855, "heading": 3.141592653589793, - "angularVelocity": 2.581973087916566e-16, - "velocityX": -3.513883739437953, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.9368908161772864e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - -0.0032184943191916355, - -0.003218494319210384, - -0.00321849431915981, - -0.0032184943191784733 + -0.0027135032765820944, + -0.002713503276651509, + -0.002713503276474282, + -0.002713503276543846 ], "moduleForcesY": [ - -0.001693407972736863, - -0.0016934079727192893, - -0.0016934079727259645, - -0.0016934079727083226 + -0.0014277073770261604, + -0.0014277073770890942, + -0.0014277073770684085, + -0.0014277073771313536 ], - "timestamp": 0.5989889296967679 + "timestamp": 0.5724059505120813 }, { - "x": 5.670951595306396, - "y": 6.523906707763672, + "x": 5.830181693715209, + "y": 6.60768548485711, "heading": 3.141592653589793, - "angularVelocity": -1.7815140363007445e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720746, + "angularVelocity": 1.279411505105019e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - -2.214847536392143e-8, - -2.2148460240928627e-8, - -2.2148453985353328e-8, - -2.214843887146829e-8 + -2.0460998121842195e-8, + -2.0460997415959662e-8, + -2.0460987448503346e-8, + -2.0460986753393795e-8 ], "moduleForcesY": [ - -1.1653376630868896e-8, - -1.1653364415082627e-8, - -1.1653399114124992e-8, - -1.1653386903612894e-8 + -1.076552819064326e-8, + -1.0765525074180139e-8, + -1.0765532984669192e-8, + -1.0765529879793362e-8 ], - "timestamp": 0.6988204179795625 + "timestamp": 0.6678069422640949 }, { - "x": 5.320155351930048, - "y": 6.339335570945134, + "x": 5.511721496897583, + "y": 6.440127930670235, "heading": 3.141592653589793, - "angularVelocity": 2.4279685029555556e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720748, + "angularVelocity": -1.3368406118547953e-16, + "velocityX": -3.338122497147994, + "velocityY": -1.7563502339936574, "moduleForcesX": [ - -1.4908979526305142e-14, - -2.99029582883606e-14, - -5.16443761137644e-15, - -2.0160903125677875e-14 + -1.9163549088742217e-13, + -1.8137969156708226e-13, + -1.8770365584259915e-13, + -1.7745311999841893e-13 ], "moduleForcesY": [ - -3.384941535047312e-14, - -2.5668639996370796e-14, - -1.2459999136873356e-14, - -4.2850979436921125e-15 + -1.1004122267769845e-13, + -1.0700562473759133e-13, + -1.2357784150329262e-13, + -1.2054149174476363e-13 ], - "timestamp": 0.7986519062623572 + "timestamp": 0.7632079340161084 }, { - "x": 4.969359108569246, - "y": 6.1547644341347745, + "x": 5.193261300079957, + "y": 6.272570376483359, "heading": 3.141592653589793, - "angularVelocity": 1.199756216245544e-16, - "velocityX": -3.5138837394379534, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.4138979074556637e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - 2.214841585830023e-8, - 2.2148419462891282e-8, - 2.2148422317548562e-8, - 2.2148425924364392e-8 + 1.8774692991705095e-13, + 1.7710016242766854e-13, + 1.898187278749893e-13, + 1.7917566427067963e-13 ], "moduleForcesY": [ - 1.165340603921551e-8, - 1.165340847836435e-8, - 1.165339922976741e-8, - 1.165340166101585e-8 + 1.0215120237248181e-13, + 1.0368953333983565e-13, + 1.1648186637867293e-13, + 1.1802465134529584e-13 ], - "timestamp": 0.8984833945451518 + "timestamp": 0.858608925768122 }, { - "x": 4.618565124090272, - "y": 5.970194485833114, + "x": 4.874801103275445, + "y": 6.105012822303384, "heading": 3.141592653589793, - "angularVelocity": 1.3718004475518102e-16, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 1.5438965808528657e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - 0.003218494319189819, - 0.003218494319178036, - 0.0032184943192075832, - 0.003218494319195734 + 2.0460996179979618e-8, + 2.0460996946386003e-8, + 2.0460995079952845e-8, + 2.0460995868086364e-8 ], "moduleForcesY": [ - 0.0016934079727341249, - 0.0016934079727223734, - 0.00169340797272666, - 0.0016934079727148898 + 1.07655285883098e-8, + 1.076553064507586e-8, + 1.0765530220929285e-8, + 1.0765532275345751e-8 ], - "timestamp": 0.9983148828279464 + "timestamp": 0.9540099175201355 }, { - "x": 4.331963439949377, - "y": 5.819399260243309, + "x": 4.556342645640002, + "y": 5.937456183185694, "heading": 3.141592653589793, - "angularVelocity": 2.659867947557739e-16, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 2.7082626511550756e-16, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - 91.46231173778882, - 91.46231173778881, - 91.46231173778884, - 91.46231173778882 + 0.0027135032765694357, + 0.002713503276628145, + 0.0027135032764733255, + 0.002713503276531934 ], "moduleForcesY": [ - 48.12281537286683, - 48.122815372866796, - 48.12281537286684, - 48.1228153728668 + 0.0014277073770093693, + 0.001427707377080961, + 0.0014277073770625364, + 0.0014277073771340647 ], - "timestamp": 1.098146371110741 + "timestamp": 1.049410909272149 }, { - "x": 4.11694975987149, - "y": 5.706270000415583, + "x": 4.294627414699907, + "y": 5.799754943194032, "heading": 3.141592653589793, - "angularVelocity": 2.806875129049736e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246716, + "angularVelocity": 2.4292126054795095e-16, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 101.99983969748536, - 101.99983969748536, - 101.99983969748536, - 101.99983969748536 + 88.53246892183459, + 88.53246892183459, + 88.53246892183459, + 88.5324689218346 ], "moduleForcesY": [ - 53.667126497919966, - 53.667126497919966, - 53.66712649791996, - 53.66712649791996 + 46.58128113625262, + 46.581281136252606, + 46.58128113625261, + 46.58128113625261 ], - "timestamp": 1.1979778593935357 + "timestamp": 1.1448119010241626 }, { - "x": 3.973589044661299, - "y": 5.63084088542054, + "x": 4.098281062040315, + "y": 5.696447481370175, "heading": 3.141592653589793, - "angularVelocity": 1.561047756279207e-16, - "velocityX": -1.4360270259027916, - "velocityY": -0.7555643644355341, + "angularVelocity": 2.1490427279263705e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 102.09239698765671, - 102.09239698765671, - 102.09239698765673, - 102.09239698765673 + 101.9904669132676, + 101.9904669132676, + 101.9904669132676, + 101.9904669132676 ], "moduleForcesY": [ - 53.715825435238514, - 53.71582543523851, - 53.7158254352385, - 53.71582543523849 + 53.66219501569664, + 53.66219501569664, + 53.66219501569663, + 53.66219501569663 ], - "timestamp": 1.2978093476763304 + "timestamp": 1.2402128927761762 + }, + { + "x": 3.967365990802884, + "y": 5.627566631072558, + "heading": 3.141592653589793, + "angularVelocity": 1.897239423212067e-16, + "velocityX": -1.372261114200297, + "velocityY": -0.722013985731583, + "moduleForcesX": [ + 102.08783014974715, + 102.08783014974715, + 102.08783014974715, + 102.08783014974713 + ], + "moduleForcesY": [ + 53.71342259746434, + 53.71342259746434, + 53.713422597464344, + 53.71342259746434 + ], + "timestamp": 1.3356138845281897 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -6.104345816877544e-18, - "velocityX": -0.718068570163366, - "velocityY": -0.37781115052171915, + "angularVelocity": 7.022330291742699e-17, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - 102.12359521012327, - 102.12359521012327, - 102.1235952101233, - 102.12359521012328 + 102.12057878684486, + 102.12057878684486, + 102.12057878684486, + 102.12057878684487 ], "moduleForcesY": [ - 53.732240352718684, - 53.732240352718684, - 53.73224035271866, - 53.732240352718655 + 53.730653264247444, + 53.730653264247444, + 53.730653264247444, + 53.730653264247444 ], - "timestamp": 1.397640835959125 + "timestamp": 1.4310148762802029 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -5.9255248403380995e-19, - "velocityX": -4.845229805742944e-18, - "velocityY": -3.784645335362408e-18, + "angularVelocity": 1.9672491241209423e-19, + "velocityX": -4.977758209661926e-18, + "velocityY": 1.6190388601168746e-18, "moduleForcesX": [ - 102.13925806744794, - 102.13925806744793, - 102.13925806744794, - 102.13925806744794 + 102.13700666833601, + 102.13700666833601, + 102.137006668336, + 102.13700666833601 ], "moduleForcesY": [ - 53.74048135140901, - 53.74048135140901, - 53.740481351408995, - 53.740481351408995 + 53.73929677973426, + 53.73929677973426, + 53.73929677973426, + 53.73929677973426 ], - "timestamp": 1.4974723242419197 + "timestamp": 1.5264158680322164 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.4.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.4.traj index 6ed2935..0721e52 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.4.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.4.traj @@ -4,631 +4,631 @@ "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -5.9255248403380995e-19, - "velocityX": -4.845229805742944e-18, - "velocityY": -3.784645335362408e-18, + "angularVelocity": 1.9672491241209423e-19, + "velocityX": -4.977758209661926e-18, + "velocityY": 1.6190388601168746e-18, "moduleForcesX": [ - 102.13925806744794, - 102.13925806744793, - 102.13925806744794, - 102.13925806744794 + 102.13700666833601, + 102.13700666833601, + 102.137006668336, + 102.13700666833601 ], "moduleForcesY": [ - 53.74048135140901, - 53.74048135140901, - 53.740481351408995, - 53.740481351408995 + 53.73929677973426, + 53.73929677973426, + 53.73929677973426, + 53.73929677973426 ], "timestamp": 0 }, { - "x": 3.9043982564040665, - "y": 5.59148869514806, - "heading": 3.1820618629141237, - "angularVelocity": 1.1653411306828567, - "velocityX": 0.07184728436450499, - "velocityY": -0.047073583952375805, + "x": 3.9042836995770926, + "y": 5.591477621529516, + "heading": 3.1821270543838818, + "angularVelocity": 1.1690740956944607, + "velocityX": 0.06865751831066487, + "velocityY": -0.04746780502029206, "moduleForcesX": [ - 74.23634164667679, - -6.715898232786087, - 111.49692422807223, - -61.502441740180224 + 73.9038184921626, + -8.096498399638158, + 111.13955678681799, + -64.4706603229986 ], "moduleForcesY": [ - -88.32054795571888, - -115.15629744618326, - 29.45095987899212, - 97.03134384991 + -88.59920326747556, + -115.06817413543592, + 30.77187267475827, + 95.13273018744661 ], - "timestamp": 0.0347273500083336 + "timestamp": 0.03467222560432326 }, { - "x": 3.909010846411328, - "y": 5.587957161161053, - "heading": 3.2630170824362428, - "angularVelocity": 2.3311660550745286, - "velocityX": 0.13282297688004016, - "velocityY": -0.10169316075544446, + "x": 3.9087131487207896, + "y": 5.587940767261187, + "heading": 3.2631546643514007, + "angularVelocity": 2.3369601620674736, + "velocityX": 0.12775208589853315, + "velocityY": -0.10200828492209969, "moduleForcesX": [ - 78.30596687432912, - -0.991357515334819, - 109.52641997223529, - -87.10790717980932 + 78.0409085702238, + -2.2065963343012998, + 109.08213048052961, + -88.10645679122378 ], "moduleForcesY": [ - -84.70847062161643, - -115.32872392835634, - 35.97383073298106, - 74.72643789734872 + -84.95264569095156, + -115.31231038297793, + 37.29784851028354, + 73.61772559552828 ], - "timestamp": 0.0694547000166672 + "timestamp": 0.06934445120864652 }, { - "x": 3.9154905781921414, - "y": 5.581995423382691, - "heading": 3.3836478937253207, - "angularVelocity": 3.473654375013657, - "velocityX": 0.1865887198205051, - "velocityY": -0.17167269535196633, + "x": 3.914971012728261, + "y": 5.582022220388997, + "heading": 3.3839066101537916, + "angularVelocity": 3.482670745754918, + "velocityX": 0.18048636620233685, + "velocityY": -0.170699941207466, "moduleForcesX": [ - 84.04565171589002, - 7.591385688892432, - 105.82402794571937, - -109.52068801280974 + 83.86452574104814, + 6.586730417859739, + 105.23692315427803, + -109.29775219994406 ], "moduleForcesY": [ - -78.97617075986777, - -115.05554501752253, - 45.56575373192798, - 34.00596685580122 + -79.167691364004, + -115.11732618046985, + 46.90225658105789, + 34.8506188459714 ], - "timestamp": 0.1041820500250008 + "timestamp": 0.10401667681296978 }, { - "x": 3.923986661046908, - "y": 5.573089966082192, - "heading": 3.542510028867439, - "angularVelocity": 4.574553920872062, - "velocityX": 0.24465105609059282, - "velocityY": -0.25643929923708686, + "x": 3.9232012050087475, + "y": 5.573228753463622, + "heading": 3.543000568385735, + "angularVelocity": 4.588513008870894, + "velocityX": 0.23737132927112375, + "velocityY": -0.25361703127241003, "moduleForcesX": [ - 90.96637263149874, - 18.72557620908624, - 99.23256696755529, - -113.95654026368632 + 90.87202731423523, + 17.998694570452482, + 98.47791423253557, + -114.15847162608061 ], "moduleForcesY": [ - -70.81659924554174, - -113.7295099024976, - 58.29590985260526, - -12.395836704597288 + -70.93479429110407, + -113.84541579014095, + 59.553876514316784, + -10.610218755963183 ], - "timestamp": 0.1389094000333344 + "timestamp": 0.13868890241729304 }, { - "x": 3.9349178697914593, - "y": 5.561092759135591, - "heading": 3.7384895958061533, - "angularVelocity": 5.643378112400891, - "velocityX": 0.3147723261904048, - "velocityY": -0.3454685411850211, + "x": 3.93382849843504, + "y": 5.56138315819023, + "heading": 3.7392339798870817, + "angularVelocity": 5.659671627104292, + "velocityX": 0.3065073914657294, + "velocityY": -0.34164507951039014, "moduleForcesX": [ - 98.43585145612785, - 32.047708016397955, - 87.47440914610054, - -103.26614786570082 + 98.39402131426766, + 31.702182349064397, + 86.80709567335347, + -103.64312194333186 ], "moduleForcesY": [ - -59.81255295495207, - -110.62167229916591, - 74.32567001719525, - -49.50954102298324 + -59.87033716863679, + -110.71556436707851, + 75.08087531890547, + -48.70440721838266 ], - "timestamp": 0.173636750041668 + "timestamp": 0.1733611280216163 }, { - "x": 3.9486707811612667, - "y": 5.546283772243214, - "heading": 3.971261588079422, - "angularVelocity": 6.702843499933376, - "velocityX": 0.3960253623298846, - "velocityY": -0.42643584635232096, + "x": 3.947348256782863, + "y": 5.546665747496577, + "heading": 3.9717655770283784, + "angularVelocity": 6.70656680061238, + "velocityX": 0.38993050235969523, + "velocityY": -0.42447262721486584, "moduleForcesX": [ - 105.6108108605353, - 47.31647496654562, - 65.36610720865541, - -85.39422216682203 + 105.47445484854477, + 47.63333934755148, + 67.38844623510965, + -83.8307139515503 ], "moduleForcesY": [ - -45.20977101765006, - -104.70081415221114, - 93.04952199937759, - -75.57076012474553 + -45.449760164769756, + -104.52423173953122, + 91.45753443308791, + -77.17340463952392 ], - "timestamp": 0.2083641000500016 + "timestamp": 0.20803335362593955 }, { - "x": 3.967957360606314, - "y": 5.534219720600956, - "heading": 4.2154072006344245, - "angularVelocity": 7.030355397011703, - "velocityX": 0.5553714706252912, - "velocityY": -0.34739338415867244, + "x": 3.967122969912724, + "y": 5.534422452953119, + "heading": 4.200687458299229, + "angularVelocity": 6.602457075680393, + "velocityX": 0.570332962052375, + "velocityY": -0.3531153345383026, "moduleForcesX": [ - 84.82446387399186, - 82.71377263232796, - 50.73806390817151, - 42.353537925270714 + 67.8872625454126, + 69.11423919448929, + 78.96383219942022, + 79.57383821480528 ], "moduleForcesY": [ - 29.67111027951777, - -3.37922189208429, - 65.43811151147439, - 37.553509838998245 + 30.388799241715233, + 41.078313608032914, + 17.15064921936294, + 28.28128265964005 ], - "timestamp": 0.2430914500583352 + "timestamp": 0.2427055792302628 }, { - "x": 3.98001343373366, - "y": 5.526755385653602, - "heading": 4.472103074519516, - "angularVelocity": 7.391749552542666, - "velocityX": 0.3471636368583629, - "velocityY": -0.21494110393000895, + "x": 3.9797668128508845, + "y": 5.526847142047009, + "heading": 4.44206622644219, + "angularVelocity": 6.961732739558081, + "velocityX": 0.3646677626769925, + "velocityY": -0.21848354912542167, "moduleForcesX": [ - -37.456143843096456, - -105.72590475430376, - -87.22921676430555, - -110.13783644093463 + -36.646290938348635, + -105.1718880571878, + -85.71976737512396, + -109.38718684458635 ], "moduleForcesY": [ - 104.18797300994801, - 16.76204700591698, - 71.78839869306297, - 23.903310122835695 + 103.98341170708312, + 17.180702657672832, + 73.23873697676966, + 26.153822189075125 ], - "timestamp": 0.2778188000666688 + "timestamp": 0.2773778048345861 }, { - "x": 3.9851949998823097, - "y": 5.5258948814499, - "heading": 4.723311951922738, - "angularVelocity": 7.233747387662465, - "velocityX": 0.1492070701451729, - "velocityY": -0.024778861718348262, + "x": 3.9857338632021, + "y": 5.525513029563465, + "heading": 4.692744644264185, + "angularVelocity": 7.229948855395621, + "velocityX": 0.1720988557040211, + "velocityY": -0.03847784387335769, "moduleForcesX": [ - -98.91322895270021, - -85.10006434406276, - -79.17104780948137, - -60.59757319759481 + -41.96175012880925, + -79.29225853021597, + -86.89556166997009, + -107.32093626148128 ], "moduleForcesY": [ - 56.86109648752441, - 76.2892425523883, - 81.34314654485036, - 96.53986801350179 + 105.27165483765185, + 78.39773568551979, + 73.78278818931463, + 37.437021821922585 ], - "timestamp": 0.3125461500750024 + "timestamp": 0.31205003043890933 }, { - "x": 3.9863068884222828, - "y": 5.531340138988146, - "heading": 4.950666542673113, - "angularVelocity": 6.546845373914685, - "velocityX": 0.032017661575285794, - "velocityY": 0.1568002608013148, + "x": 3.9867659107369566, + "y": 5.530831985759421, + "heading": 4.92495896919637, + "angularVelocity": 6.697416184994794, + "velocityX": 0.029765828898150305, + "velocityY": 0.15340682933527577, "moduleForcesX": [ - -114.77127776967934, - -93.64139046455962, - 28.508230169348188, - -11.773017615919526 + -113.32252584700664, + -91.37221926721877, + -9.199917255344806, + -19.278349706082395 ], "moduleForcesY": [ - 5.619126084560698, - 66.9044442013547, - 110.10636482779911, - 114.3646878138949 + 18.159782597252036, + 69.79683643177074, + 113.1944780338604, + 113.19848312438968 ], - "timestamp": 0.347273500083336 + "timestamp": 0.3467222560432326 }, { - "x": 3.9839495670536045, - "y": 5.542047325833863, - "heading": 5.14709915808565, - "angularVelocity": 5.656423981829894, - "velocityX": -0.06788083076055375, - "velocityY": 0.3083214481712091, + "x": 3.984220735671827, + "y": 5.54162936928793, + "heading": 5.12759603796946, + "angularVelocity": 5.844362893964999, + "velocityX": -0.07340674043179839, + "velocityY": 0.3114130500801563, "moduleForcesX": [ - -113.64668162060943, - -100.73960236681702, - 63.56308029673943, - -12.572866576733011 + -114.32669032012072, + -99.46991245107587, + 57.66223639535799, + -12.88514577898863 ], "moduleForcesY": [ - -18.155758880056467, - 55.952500248794294, - 95.52739610486213, - 114.50709600750847 + -12.760758459447903, + 58.11499274397251, + 99.06285660736755, + 114.43208308109199 ], - "timestamp": 0.3820008500916696 + "timestamp": 0.38139448164755585 }, { - "x": 3.9779698922760582, - "y": 5.557428390445448, - "heading": 5.310648551650109, - "angularVelocity": 4.7095270305742165, - "velocityX": -0.17218920465026455, - "velocityY": 0.442909251869058, + "x": 3.9780819659675903, + "y": 5.557168661278035, + "heading": 5.297692621023495, + "angularVelocity": 4.905845531670375, + "velocityX": -0.17705150440275155, + "velocityY": 0.4481769404548229, "moduleForcesX": [ - -109.6422125783005, - -105.74765097197177, - 63.85460645823769, - -19.07370797889233 + -110.32756561762857, + -105.08894599974298, + 63.750085678570414, + -18.126645587310843 ], "moduleForcesY": [ - -35.22297007232857, - 45.94386760077495, - 95.7180784273194, - 113.69565987258625 + -32.91770130594482, + 47.39353190748665, + 95.7403714098111, + 113.83333151918829 ], - "timestamp": 0.4167282001000032 + "timestamp": 0.4160667072518791 }, { - "x": 3.968175115116889, - "y": 5.577061809180295, - "heading": 5.440438778329013, - "angularVelocity": 3.7374065872506352, - "velocityX": -0.2820479292781997, - "velocityY": 0.5653589672156164, + "x": 3.9681916256457823, + "y": 5.57695732044685, + "heading": 5.434040994519674, + "angularVelocity": 3.9324955672640276, + "velocityX": -0.28525253713666865, + "velocityY": 0.5707351871391523, "moduleForcesX": [ - -104.57283217896068, - -109.05462491040034, - 59.524853150361466, - -25.584631264202123 + -104.68508048822177, + -108.78605491561527, + 60.738952885980254, + -24.525066052248846 ], "moduleForcesY": [ - -48.32920001759757, - 37.52781331033054, - 98.62582006055165, - 112.45689047019665 + -48.04212290386368, + 38.27226802046422, + 97.86364839716221, + 112.68375035926049 ], - "timestamp": 0.4514555501083368 + "timestamp": 0.45073893285620237 }, { "x": 3.9544325256347648, "y": 5.600627422332764, "heading": 5.535936987290347, - "angularVelocity": 2.749942305946683, - "velocityX": -0.3957281358590918, - "velocityY": 0.6785894445390553, + "angularVelocity": 2.9388362297102493, + "velocityX": -0.39683348187783213, + "velocityY": 0.6826819297969259, "moduleForcesX": [ - -99.4686663112381, - -111.09605990584434, - 55.322267493338416, - -30.695272549126784 + -98.70912927254462, + -111.07132972844673, + 56.829637400778395, + -29.843471189118105 ], "moduleForcesY": [ - -58.16713625640862, - 31.04808747872548, - 101.12190774409488, - 111.19928569615166 + -59.42057702877141, + 31.1145608404754, + 100.2738938998647, + 111.42567305703182 ], - "timestamp": 0.4861829001166704 + "timestamp": 0.4854111584605256 }, { - "x": 3.9307248628182854, - "y": 5.6362066530252655, - "heading": 5.601194290632536, - "angularVelocity": 1.4907682092809864, - "velocityX": -0.5415888832830509, - "velocityY": 0.8127885050494256, + "x": 3.930473563980664, + "y": 5.636699135016749, + "heading": 5.6090237892657715, + "angularVelocity": 1.651944625216427, + "velocityX": -0.5415324909628186, + "velocityY": 0.8153109765385055, "moduleForcesX": [ - -95.02943454284728, - -112.32207187573187, - 52.31611898637743, - -34.23111294482164 + -93.16011868735104, + -112.47606598208196, + 53.652879177811734, + -33.78704517737121 ], "moduleForcesY": [ - -65.28675950904464, - 26.427771988717467, - 102.79243467120487, - 110.20104060720486 + -67.91573899096274, + 25.75384194792576, + 102.09996040314262, + 110.33638895218624 ], - "timestamp": 0.5299571789991431 + "timestamp": 0.5296540470294149 }, { - "x": 3.8996232433704536, - "y": 5.67868110060817, - "heading": 5.617199166752307, - "angularVelocity": 0.3656228389904951, - "velocityX": -0.7104998698284664, - "velocityY": 0.9703060488316098, + "x": 3.899231021868383, + "y": 5.679449457084365, + "heading": 5.629918846850788, + "angularVelocity": 0.4722805915459298, + "velocityX": -0.7061596365624855, + "velocityY": 0.966264261906209, "moduleForcesX": [ - -106.02647980753328, - -110.97907601877178, - 36.59336535164549, - -38.763920050536065 + -102.57136846110204, + -111.54325011561693, + 40.69497651884779, + -37.935243929793444 ], "moduleForcesY": [ - -45.18048489661737, - 31.540733116049065, - 109.35634824645626, - 108.67557062608951 + -52.52564969837368, + 29.4668681376155, + 107.89412812639264, + 108.96449307890926 ], - "timestamp": 0.5737314578816157 + "timestamp": 0.5738969355983041 }, { - "x": 3.860110843069242, - "y": 5.729664244872591, - "heading": 5.593224624125038, - "angularVelocity": -0.547685609890632, - "velocityX": -0.9026396621471824, - "velocityY": 1.1646826758997946, + "x": 3.859765676771108, + "y": 5.730326735350005, + "heading": 5.606450375138135, + "angularVelocity": -0.5304461908292993, + "velocityX": -0.8920155616834311, + "velocityY": 1.1499538097839181, "moduleForcesX": [ - -114.74365869825844, - -107.73349084432331, - 15.73401800943126, - -42.57429428279629 + -112.92169627828984, + -108.9219189691362, + 24.073517173913505, + -40.83914052431008 ], "moduleForcesY": [ - -10.4350588624452, - 41.23196001279347, - 114.20366129024507, - 107.21934325723129 + -22.74755439174561, + 37.95851016971545, + 112.7310149617651, + 107.8859864747371 ], - "timestamp": 0.6175057367640884 + "timestamp": 0.6181398241671934 }, { - "x": 3.8112844590593467, - "y": 5.790966829650067, - "heading": 5.542349985528334, - "angularVelocity": -1.1622039219262499, - "velocityX": -1.1154126408566776, - "velocityY": 1.4004247778030499, + "x": 3.8111389410743834, + "y": 5.79124568175385, + "heading": 5.550849308469565, + "angularVelocity": -1.2567232490255504, + "velocityX": -1.0990859157175008, + "velocityY": 1.3769206390986586, "moduleForcesX": [ - -110.66151469383081, - -101.36053530623528, - -15.613856789130313, - -48.454801412715774 + -113.54722733634918, + -103.43030407712321, + -3.5622560281797546, + -45.305379884050026 ], "moduleForcesY": [ - 32.04293220941277, - 55.00994604223042, - 114.18177265531851, - 104.66041275307676 + 19.201188048769797, + 50.979455462200974, + 115.16014318689234, + 106.04826799334447 ], - "timestamp": 0.661280015646561 + "timestamp": 0.6623827127360826 }, { "x": 3.752480545043945, "y": 5.863831043243408, "heading": 5.480546717244263, - "angularVelocity": -1.4118626248533899, - "velocityX": -1.343343979995238, - "velocityY": 1.664544007428914, + "angularVelocity": -1.589014494743879, + "velocityX": -1.3258265436060674, + "velocityY": 1.6406108153751935, "moduleForcesX": [ - -91.58391515691349, - -89.00952621701097, - -54.28386759761697, - -60.88263773717588 + -96.27958972309919, + -91.90028015401168, + -46.0608746637012, + -56.857903750739794 ], "moduleForcesY": [ - 69.91797745860337, - 73.2606319317319, - 101.64123727775288, - 97.89690993994493 + 63.1774230585327, + 69.54780453922038, + 105.55736170661821, + 100.2533607662289 ], - "timestamp": 0.7050542945290337 + "timestamp": 0.7066256013049719 }, { - "x": 3.6247796796501865, - "y": 6.020393862485399, - "heading": 5.396597051454397, - "angularVelocity": -1.136139489771721, - "velocityX": -1.728249835026593, - "velocityY": 2.118855386703538, + "x": 3.625288293351891, + "y": 6.019663725891665, + "heading": 5.383968397246127, + "angularVelocity": -1.2998708875412803, + "velocityX": -1.7119111732168877, + "velocityY": 2.0973896367822467, "moduleForcesX": [ - -64.01795106750846, - -62.13975297663151, - -83.85792038265208, - -85.86840122940083 + -63.35958617648632, + -61.5016685281973, + -83.98957274568086, + -86.30910394415343 ], "moduleForcesY": [ - 95.94171307643556, - 97.13810717197784, - 79.19011036368579, - 76.96736480457619 + 96.32955114118715, + 97.48422295362182, + 78.99253694196872, + 76.39900626600716 ], - "timestamp": 0.7789445752081541 + "timestamp": 0.7809239958023007 }, { - "x": 3.4688025039143255, - "y": 6.210363644739983, - "heading": 5.3382811336269915, - "angularVelocity": -0.7892231196231553, - "velocityX": -2.1109295336583584, - "velocityY": 2.5709711819820655, + "x": 3.4694662818312585, + "y": 6.20933750397901, + "heading": 5.309907389719856, + "angularVelocity": -0.9968049515381256, + "velocityX": -2.0972460115034317, + "velocityY": 2.552865097161194, "moduleForcesX": [ - -60.82496922096849, - -58.993762084770374, - -85.23274796355844, - -89.12126008495763 + -62.09781410875213, + -61.44436515676163, + -83.73437350844854, + -87.31016658656043 ], "moduleForcesY": [ - 97.91898127763542, - 98.97383223128705, - 77.61460069122347, - 73.04209646880568 + 96.94974979682578, + 97.27543927473285, + 79.02989424706948, + 74.9538204464673 ], - "timestamp": 0.8528348558872745 + "timestamp": 0.8552223902996294 }, { - "x": 3.285330477453207, - "y": 6.432930917108337, - "heading": 5.323684758957203, - "angularVelocity": -0.1975411994058538, - "velocityX": -2.4830332863110067, - "velocityY": 3.0121319112981255, + "x": 3.289311241310323, + "y": 6.423961245560545, + "heading": 5.309962184347802, + "angularVelocity": 0.0007374941049159021, + "velocityX": -2.424750113912783, + "velocityY": 2.88867266962612, "moduleForcesX": [ - -52.259455121950104, - -45.29427572571881, - -90.15821094756608, - -98.33087843589153 + -40.74857935844332, + -18.853251410417336, + -92.2430106987836, + -98.53054513090648 ], "moduleForcesY": [ - 102.52257021365222, - 105.58458947811977, - 71.52845266276556, - 59.492542868834136 + 96.31459560680612, + 93.15672622123716, + 51.20564283421457, + 16.04638677086884 ], - "timestamp": 0.9267251365663949 + "timestamp": 0.9295207847969582 }, { - "x": 3.1138424725109046, - "y": 6.635690019593371, - "heading": 5.379941397506073, - "angularVelocity": 0.7613536994557198, - "velocityX": -2.320846576385527, - "velocityY": 2.7440564661751154, + "x": 3.116823926921375, + "y": 6.629426011222936, + "heading": 5.346662180978036, + "angularVelocity": 0.49395410060379374, + "velocityX": -2.321548339717472, + "velocityY": 2.7653998051031645, "moduleForcesX": [ - 56.506940689491465, - 67.52985880231365, - -15.921759845031302, - 16.56078955508368 + 27.481431543061767, + 39.57127820766088, + -1.4918968027664112, + 13.336470847013707 ], "moduleForcesY": [ - -13.184564767374862, - -46.19772680767912, - -64.74034721944736, - -81.95175795924673 + -3.7073202435334416, + -22.657178376344635, + -25.44947588664071, + -42.42756593521844 ], - "timestamp": 1.0006154172455153 + "timestamp": 1.003819179294287 }, { - "x": 2.9708595052799165, - "y": 6.804691723426312, - "heading": 5.427781973086904, - "angularVelocity": 0.6474542408166764, - "velocityX": -1.9350713776810924, - "velocityY": 2.2871980222521517, + "x": 2.9728273117834085, + "y": 6.8006505476140005, + "heading": 5.397761300974995, + "angularVelocity": 0.6877553726789595, + "velocityX": -1.9380851512631618, + "velocityY": 2.3045523062711557, "moduleForcesX": [ - 69.84626762723298, - 69.3664128115689, - 78.55973759609914, - 78.77988767551102 + 81.46564305418052, + 80.49825287187765, + 65.10081795178034, + 66.09113775652368 ], "moduleForcesY": [ - -91.46262829883237, - -91.7887283059373, - -84.09614329094023, - -83.84776974220942 + -81.15783169411748, + -82.19763092136209, + -94.78893254492608, + -94.17140740263652 ], - "timestamp": 1.0745056979246357 + "timestamp": 1.0781175737916158 }, { - "x": 2.8564453157848377, - "y": 6.939904549706658, - "heading": 5.466403159501036, - "angularVelocity": 0.522682903071518, - "velocityX": -1.5484335482759797, - "velocityY": 1.8299135561215285, + "x": 2.857611110726288, + "y": 6.937545900604295, + "heading": 5.4452467331407535, + "angularVelocity": 0.6391178771361595, + "velocityX": -1.5507226210825067, + "velocityY": 1.842507552370001, "moduleForcesX": [ - 69.76232758546392, - 68.91646548695893, - 79.25899084878017, - 79.27764146129198 + 72.18570029563338, + 72.01424178451545, + 75.98943820596472, + 75.9475002423331 ], "moduleForcesY": [ - -91.77011872190114, - -92.3862498475594, - -83.70370167635726, - -83.66269029454818 + -89.86507715449565, + -89.99403758231846, + -86.67204720164703, + -86.6999366425214 ], - "timestamp": 1.148395978603756 + "timestamp": 1.1524159682889445 }, { - "x": 2.7706218869821835, - "y": 7.041319186543625, - "heading": 5.495529703317597, - "angularVelocity": 0.3941864010917436, - "velocityX": -1.1614982107776188, - "velocityY": 1.3725030667751008, + "x": 2.771197873348752, + "y": 7.040166816408869, + "heading": 5.483776356564779, + "angularVelocity": 0.518579488624223, + "velocityX": -1.1630565904172114, + "velocityY": 1.3811996409728962, "moduleForcesX": [ - 69.80382238745547, - 68.69416422988506, - 79.5605145541954, - 79.38562401155933 + 69.78078581158707, + 68.83655705259315, + 78.94197823204128, + 78.80958416295582 ], "moduleForcesY": [ - -91.81935170246173, - -92.63831320438999, - -83.50590561929292, - -83.65606631768857 + -91.8382201142604, + -92.5349745458161, + -84.09261841954978, + -84.20197278112937 ], - "timestamp": 1.2222862592828765 + "timestamp": 1.2267143627862733 }, { - "x": 2.7134004949667867, - "y": 7.108931315252294, - "heading": 5.515026042601372, - "angularVelocity": 0.26385526086226124, - "velocityX": -0.7744102673515256, - "velocityY": 0.9150341301623254, + "x": 2.7135903319326986, + "y": 7.1085546328421145, + "heading": 5.510796163144548, + "angularVelocity": 0.36366608945689255, + "velocityX": -0.7753537853112552, + "velocityY": 0.9204481051835351, "moduleForcesX": [ - 69.84897377197261, - 68.56304647527213, - 79.73113036544808, - 79.41828548070994 + 68.76974485124715, + 67.15141087474308, + 80.36853069934784, + 80.1073327253284 ], "moduleForcesY": [ - -91.82527817186515, - -92.77867605554302, - -83.38745301845533, - -83.67315905858865 + -92.6404196148515, + -93.807979797021, + -82.77776530877948, + -83.01627453571585 ], - "timestamp": 1.2961765399619969 + "timestamp": 1.301012757283602 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 0.1323754049192017, - "velocityX": -0.38723234385763106, - "velocityY": 0.457530093567707, + "angularVelocity": 0.18857924691522118, + "velocityX": -0.38766037592671904, + "velocityY": 0.4600867848398824, "moduleForcesX": [ - 69.86757393943451, - 68.48839210839408, - 79.82897176170941, - 79.44566757381436 + 68.20517667619332, + 66.12682297577744, + 81.19705273807533, + 80.86078377461928 ], "moduleForcesY": [ - -91.83521466144708, - -92.85970357248195, - -83.32050872366182, - -83.67612133165673 + -93.08125167677963, + -94.5583649585031, + -81.99291564809009, + -82.31158905160967 ], - "timestamp": 1.3700668206411173 + "timestamp": 1.3753111517809309 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 4.3846854612017205e-20, - "velocityX": 4.0904407705530267e-19, - "velocityY": 2.676968555971792e-19, + "angularVelocity": -1.0805689415403086e-18, + "velocityX": -3.1368680539147086e-18, + "velocityY": -3.703947835290446e-18, "moduleForcesX": [ - 69.84827604991999, - 68.4571637796041, - 79.87431218531981, - 79.49268727695525 + 67.78484334953605, + 65.47502708227312, + 81.69905950491257, + 81.40565230070786 ], "moduleForcesY": [ - -91.86589702825101, - -92.89994179562993, - -83.29490255274604, - -83.6508373745975 + -93.40351824166066, + -95.02748219177536, + -81.51093377653565, + -81.79230598952022 ], - "timestamp": 1.4439571013202377 + "timestamp": 1.4496095462782597 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.5.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.5.traj index 6251c0c..d63519e 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.5.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.5.traj @@ -4,484 +4,484 @@ "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 4.3846854612017205e-20, - "velocityX": 4.0904407705530267e-19, - "velocityY": 2.676968555971792e-19, + "angularVelocity": -1.0805689415403086e-18, + "velocityX": -3.1368680539147086e-18, + "velocityY": -3.703947835290446e-18, "moduleForcesX": [ - 69.84827604991999, - 68.4571637796041, - 79.87431218531981, - 79.49268727695525 + 67.78484334953605, + 65.47502708227312, + 81.69905950491257, + 81.40565230070786 ], "moduleForcesY": [ - -91.86589702825101, - -92.89994179562993, - -83.29490255274604, - -83.6508373745975 + -93.40351824166066, + -95.02748219177536, + -81.51093377653565, + -81.79230598952022 ], "timestamp": 0 }, { - "x": 2.6780400940867017, - "y": 7.132795995001895, - "heading": 5.484107626833603, - "angularVelocity": -0.8968101820215478, - "velocityX": -0.14868426993683037, - "velocityY": -0.21907789247415013, + "x": 2.6781927188978703, + "y": 7.133643639193119, + "heading": 5.477615257440236, + "angularVelocity": -1.026708496320766, + "velocityX": -0.14348211565165733, + "velocityY": -0.19786406226746447, "moduleForcesX": [ - -36.58138343688566, - -92.6089981202968, - 58.0881030195425, - -114.99026329766755 + -36.1387948710901, + -93.94614327648326, + 64.40510932897232, + -111.62905057926731 ], "moduleForcesY": [ - -109.44730735929383, - -68.83786410265968, - -99.62425206236014, - 3.712550595135027 + -109.59547970218897, + -67.00327298809147, + -95.66578127079119, + 27.752839981537313 ], - "timestamp": 0.04538270462152827 + "timestamp": 0.04596440095191756 }, { - "x": 2.664180849275817, - "y": 7.112249186067297, - "heading": 5.407197367962043, - "angularVelocity": -1.694704172282317, - "velocityX": -0.30538604797719293, - "velocityY": -0.45274535984467007, + "x": 2.6643917095182355, + "y": 7.11474570789861, + "heading": 5.388434472140597, + "angularVelocity": -1.9402142408628402, + "velocityX": -0.3002543075470839, + "velocityY": -0.4111427736059914, "moduleForcesX": [ - -40.51832482476327, - -94.2857417287882, - 52.5262385664123, - -113.84938976113054 + -40.821633177857166, + -95.86727581221088, + 57.378637396381855, + -114.42189871533581 ], "moduleForcesY": [ - -108.04061737317625, - -66.49833461253947, - -102.65351736489686, - -15.26464777195355 + -107.92658105906054, + -64.19626033624714, + -100.02527276448117, + 8.587675737867313 ], - "timestamp": 0.09076540924305654 + "timestamp": 0.09192880190383512 }, { - "x": 2.643283868876903, - "y": 7.0794637940045515, - "heading": 5.302434680689891, - "angularVelocity": -2.3084275859234884, - "velocityX": -0.4604613271330158, - "velocityY": -0.7224204096287653, + "x": 2.6434517089581098, + "y": 7.0833718283589775, + "heading": 5.27028703389283, + "angularVelocity": -2.5704117926253285, + "velocityX": -0.4555699655920882, + "velocityY": -0.6825690945575899, "moduleForcesX": [ - -45.62421822143242, - -96.06095182204425, - 44.41977169952854, - -96.82610095310366 + -46.630127487625636, + -97.68723324634861, + 47.369366627194026, + -94.98425581738753 ], "moduleForcesY": [ - -105.96943008095946, - -63.86894871055252, - -106.39784959154368, - -61.28781168659432 + -105.5285366257994, + -61.34509852502472, + -105.11852994950861, + -63.424528390959615 ], - "timestamp": 0.1361481138645848 + "timestamp": 0.13789320285575268 }, { - "x": 2.616567085666063, - "y": 7.032861637076852, - "heading": 5.174736847304393, - "angularVelocity": -2.813799539944645, - "velocityX": -0.5886996694808485, - "velocityY": -1.0268704193886582, + "x": 2.617319096568963, + "y": 7.037655137656524, + "heading": 5.127203663119358, + "angularVelocity": -3.112917123039361, + "velocityX": -0.5685402582856085, + "velocityY": -0.9946108239347264, "moduleForcesX": [ - -51.22850417511759, - -97.0841442839216, - 33.41911257960119, - -45.60897792645029 + -52.706804481691236, + -98.19933570612737, + 33.658035334020674, + -22.35560750968032 ], "moduleForcesY": [ - -103.35106272656323, - -62.239918850679175, - -110.32640894319718, - -105.13082797687231 + -102.59714478787957, + -60.44172525566534, + -110.24906301300808, + -112.31949341572266 ], - "timestamp": 0.18153081848611308 + "timestamp": 0.18385760380767024 }, { - "x": 2.5844362149595033, - "y": 6.972050456195828, - "heading": 5.024165042029765, - "angularVelocity": -3.3178235305791217, - "velocityX": -0.7079981454282469, - "velocityY": -1.3399637899098782, + "x": 2.585825641778137, + "y": 6.9772618766717605, + "heading": 4.960195755089189, + "angularVelocity": -3.6334185711431983, + "velocityX": -0.6851705698018459, + "velocityY": -1.3139138057719986, "moduleForcesX": [ - -56.462615374362144, - -95.89341392145514, - 18.906930129561147, - -15.864319365251827 + -57.48268084453163, + -94.58841581785144, + 15.096484175129069, + -7.151989945719544 ], "moduleForcesY": [ - -100.54214801306102, - -63.95307193517497, - -113.67892793538894, - -113.69206080698898 + -99.93840204825361, + -65.80975762610623, + -114.22968117284876, + -114.6027216210358 ], - "timestamp": 0.22691352310764135 + "timestamp": 0.2298220047595878 }, { - "x": 2.546380793638804, - "y": 6.896657883852084, - "heading": 4.854185291365359, - "angularVelocity": -3.7454742303695725, - "velocityX": -0.8385445873723301, - "velocityY": -1.661262213710842, + "x": 2.5482138782620107, + "y": 6.901429215857198, + "heading": 4.77842465135581, + "angularVelocity": -3.954606172797204, + "velocityX": -0.8182802938185039, + "velocityY": -1.6498128822322529, "moduleForcesX": [ - -59.08407639825137, - -88.01731264292732, - -0.36287524026541784, - -15.92705626141617 + -55.68470936791087, + -75.42364616036707, + -11.70140331659463, + -21.681375783030767 ], "moduleForcesY": [ - -98.93287625654581, - -74.24824099326665, - -115.16848981625489, - -113.78600820918646 + -100.80538075759425, + -86.90554310267157, + -114.51447272212816, + -112.86388870902134 ], - "timestamp": 0.2722962277291696 + "timestamp": 0.27578640571150537 }, { - "x": 2.5020913921866805, - "y": 6.80587456385112, - "heading": 4.678726225749676, - "angularVelocity": -3.8662099819509463, - "velocityX": -0.9759092548907747, - "velocityY": -2.0003946604341585, + "x": 2.5055730112747687, + "y": 6.809867684125596, + "heading": 4.612871171835818, + "angularVelocity": -3.601776072164528, + "velocityX": -0.9276933040386546, + "velocityY": -1.9920096821751843, "moduleForcesX": [ - -49.44678346076421, - -55.30372799636149, - -31.538725682495443, - -35.63574287157784 + -5.543216012523143, + -7.475609555022172, + -68.66969747543445, + -53.51925630689457 ], "moduleForcesY": [ - -103.84416234160267, - -100.77984511033993, - -110.5795972400698, - -109.25299086030626 + -114.51283157214844, + -114.67118987816475, + -91.95148315151832, + -101.73623001018109 ], - "timestamp": 0.3176789323506979 + "timestamp": 0.32175080666342293 }, { - "x": 2.452855464930423, - "y": 6.700360814437642, - "heading": 4.525703159278682, - "angularVelocity": -3.371836644535417, - "velocityX": -1.0849050903172024, - "velocityY": -2.324977109527025, + "x": 2.45762102453482, + "y": 6.703392433541864, + "heading": 4.471415520979255, + "angularVelocity": -3.0775045018978244, + "velocityX": -1.0432418512341903, + "velocityY": -2.316472060521667, "moduleForcesX": [ - 9.704067691996666, - -3.0133443991745454, - -81.36746218585021, - -61.74194260289828 + 11.029616583468297, + -4.968113790093944, + -83.96314322380599, + -64.888165297217 ], "moduleForcesY": [ - -113.97825197610887, - -114.78558445562433, - -80.6238523751475, - -96.85819727429818 + -113.78423953190172, + -114.67679488503815, + -77.77423908354406, + -94.7210439478332 ], - "timestamp": 0.36306163697222615 + "timestamp": 0.3677152076153405 }, { - "x": 2.3977314070031808, - "y": 6.580743460775094, - "heading": 4.397294971017319, - "angularVelocity": -2.8294520860365577, - "velocityX": -1.214649025150719, - "velocityY": -2.6357475752074513, + "x": 2.4031479414108436, + "y": 6.582925065175055, + "heading": 4.357309400228015, + "angularVelocity": -2.482489021680148, + "velocityX": -1.185114610347244, + "velocityY": -2.62088411622787, "moduleForcesX": [ - 8.23834187664013, - -10.480286821125317, - -89.23977661435593, - -70.90518481088789 + 8.675398306510978, + -13.212936622685156, + -94.93975692279795, + -75.84281222648211 ], "moduleForcesY": [ - -113.67173817318357, - -114.10634114609931, - -71.12492607945074, - -90.05586637958646 + -113.47578028497088, + -113.75794165587843, + -63.08562287254842, + -85.85966695631721 ], - "timestamp": 0.4084443415937544 + "timestamp": 0.41367960856725805 }, { - "x": 2.335164483598406, - "y": 6.448466508306411, - "heading": 4.297771128185117, - "angularVelocity": -2.1929905602186364, - "velocityX": -1.3786512709314238, - "velocityY": -2.914699632201637, + "x": 2.3403859643936706, + "y": 6.45036283582954, + "heading": 4.275647872255098, + "angularVelocity": -1.77662552500885, + "velocityX": -1.365447514106127, + "velocityY": -2.884019515106602, "moduleForcesX": [ - 2.8428493566441784, - -20.960314391026447, - -102.93252880524821, - -84.21445543262062 + 1.1305249251769165, + -25.146700133162, + -108.60135018229583, + -90.22993499759434 ], "moduleForcesY": [ - -112.7690144774048, - -112.09268001844593, - -47.256316578380776, - -77.01708814164583 + -112.36380391180697, + -111.12312763667339, + -31.894172458136484, + -69.79003312917786 ], - "timestamp": 0.4538270462152827 + "timestamp": 0.4596440095191756 }, { - "x": 2.2615747120568583, - "y": 6.308166137099232, - "heading": 4.229489174742873, - "angularVelocity": -1.504580963423973, - "velocityX": -1.6215378117116424, - "velocityY": -3.091494268074651, + "x": 2.266794803149496, + "y": 6.3096531054549185, + "heading": 4.22870618913707, + "angularVelocity": -1.021261718762126, + "velocityX": -1.6010468910746176, + "velocityY": -3.0612762803504263, "moduleForcesX": [ - -39.292159251187655, - -48.85965615161464, - -110.44414210433004, - -105.39970908610731 + -29.274189339164224, + -46.32646503632049, + -109.70707968061237, + -105.8355999224511 ], "moduleForcesY": [ - -96.55667751732372, - -100.53582202079686, - 15.711330603948774, - -39.894176375958565 + -98.80485347592223, + -101.68818116190897, + 20.15623938472312, + -38.70930863468574 ], - "timestamp": 0.49920975083681096 + "timestamp": 0.5056084104710932 }, { - "x": 2.1831145159545553, - "y": 6.180875846162496, - "heading": 4.1380293777551325, - "angularVelocity": -2.0153007131345686, - "velocityX": -1.7288567694813948, - "velocityY": -2.8048194129962725, + "x": 2.1876531714787637, + "y": 6.181353766918992, + "heading": 4.158203959322547, + "angularVelocity": -1.5338442001729604, + "velocityX": -1.721802743682462, + "velocityY": -2.7912762024275843, "moduleForcesX": [ - -85.2628206812587, - -40.76242627735696, - -41.809404066636745, - 33.5147418178144 + -84.51752285390113, + -43.84922240056912, + -45.15305909136826, + 24.295039925634793 ], "moduleForcesY": [ - 69.629754055441, - 103.2872432820868, - 83.00028269477319, - 102.88363740482352 + 64.962436756562, + 98.75569699979742, + 69.59109448996358, + 100.3449769234843 ], - "timestamp": 0.5445924554583392 + "timestamp": 0.5515728114230107 }, { - "x": 2.1114416599283863, - "y": 6.06661673762304, - "heading": 4.018463859189059, - "angularVelocity": -2.634605397875636, - "velocityX": -1.5792989118627885, - "velocityY": -2.5176795762246353, + "x": 2.113994274210826, + "y": 6.066518080053957, + "heading": 4.055835706233426, + "angularVelocity": -2.227120357691746, + "velocityX": -1.6025205537866314, + "velocityY": -2.4983614381304218, "moduleForcesX": [ - -15.49547878536738, - 23.02465023695272, - 94.40260108810763, - 85.2541475816078 + -35.21196936052455, + 10.689838775403791, + 91.16219383522305, + 80.76361369246891 ], "moduleForcesY": [ - 112.01377982791259, - 111.58942984648255, - 60.4635293809918, - 75.31614730987101 + 106.90487109103282, + 113.07820027059671, + 62.57889090145047, + 79.40920313784463 ], - "timestamp": 0.5899751600798675 + "timestamp": 0.5975372123749283 }, { - "x": 2.0485770415142293, - "y": 5.9648432002123934, - "heading": 3.8746850280973426, - "angularVelocity": -3.1681415263979926, - "velocityX": -1.3852109286658927, - "velocityY": -2.2425621888204583, + "x": 2.048858891665913, + "y": 5.964516870092409, + "heading": 3.9264057363583187, + "angularVelocity": -2.8158741807709244, + "velocityX": -1.4170832469469115, + "velocityY": -2.2191349794430835, "moduleForcesX": [ - 9.897010287228166, - 41.53032424596694, - 98.32290187749213, - 93.16938210809714 + 1.6252737092564529, + 36.1594566332213, + 99.39177635870605, + 91.97875020995595 ], "moduleForcesY": [ - 113.74543897439578, - 106.82441101026964, - 57.179734029047, - 66.5860605496559 + 113.90438381958636, + 108.60701730026715, + 54.58321208539396, + 67.9611469724518 ], - "timestamp": 0.6353578647013958 + "timestamp": 0.6435016133268459 }, { - "x": 1.9953768413307222, - "y": 5.87572493089785, - "heading": 3.7134081357201074, - "angularVelocity": -3.553708262260153, - "velocityX": -1.1722571545079572, - "velocityY": -1.9637055582683054, + "x": 1.993550029996154, + "y": 5.874850586766882, + "heading": 3.7728427578306443, + "angularVelocity": -3.340911125727801, + "velocityX": -1.2032977809852603, + "velocityY": -1.9507767199952386, "moduleForcesX": [ - 28.980375064219935, - 53.44415602897274, - 90.81965392427338, - 93.2877698645733 + 17.172798234973893, + 49.099531895619926, + 100.50042106684448, + 97.41391226965858 ], "moduleForcesY": [ - 110.93166649748387, - 101.6861880924278, - 69.51188559031758, - 66.88592374391413 + 113.20215773896902, + 103.78581109073643, + 54.03522331953967, + 60.60212605681651 ], - "timestamp": 0.680740569322924 + "timestamp": 0.6894660142787634 }, { - "x": 1.9512668027592162, - "y": 5.800221418575717, - "heading": 3.563180043350926, - "angularVelocity": -3.3102498765117425, - "velocityX": -0.9719570250245071, - "velocityY": -1.6637067568317239, + "x": 1.9484012775868889, + "y": 5.798850919958476, + "heading": 3.614156733336716, + "angularVelocity": -3.452367945791928, + "velocityX": -0.9822547770500605, + "velocityY": -1.6534462591584242, "moduleForcesX": [ - 84.8275048007026, - 74.00444289575007, - 55.706127137344104, - 36.15663713104463 + 57.747161790833076, + 64.14132388711865, + 73.40481169626354, + 77.8619118899172 ], "moduleForcesY": [ - 77.70219291275828, - 87.85806255534838, - 100.72627828960442, - 109.19057307139687 + 99.29689982740135, + 95.36643063242519, + 88.28122283946998, + 84.48333541275828 ], - "timestamp": 0.7261232739444523 + "timestamp": 0.735430415230681 }, { - "x": 1.9160288345180236, - "y": 5.737622434633646, - "heading": 3.4321839049608895, - "angularVelocity": -2.886477116833102, - "velocityX": -0.7764624989863842, - "velocityY": -1.3793577192923698, + "x": 1.9127337063673016, + "y": 5.736313352300109, + "heading": 3.471353806544456, + "angularVelocity": -3.106815792979521, + "velocityX": -0.7759825099624048, + "velocityY": -1.3605652714540262, "moduleForcesX": [ - 100.14721091439696, - 80.024676888727, - 53.76343662229833, - 10.744716582139088 + 94.4936874124405, + 79.08825052744707, + 56.365800767009816, + 24.954444482004966 ], "moduleForcesY": [ - 56.886724083533664, - 82.35913095559418, - 101.95066373478755, - 114.69341623133506 + 65.75374939597347, + 83.32375870199846, + 100.46638970549711, + 112.38552797167915 ], - "timestamp": 0.7715059785659806 + "timestamp": 0.7813948161825985 }, { - "x": 1.8895087950240261, - "y": 5.687579858551526, - "heading": 3.3226877484953126, - "angularVelocity": -2.412728756003591, - "velocityX": -0.5843644559125142, - "velocityY": -1.1026794568427385, + "x": 1.886359146217566, + "y": 5.686523155503287, + "heading": 3.3502697309729075, + "angularVelocity": -2.634301177953176, + "velocityX": -0.5738040658318472, + "velocityY": -1.083233888959123, "moduleForcesX": [ - 106.88461675230056, - 74.48364034847003, - 56.28645184223139, - 2.774309758119841 + 105.7514652727486, + 80.75753449736956, + 56.80029932667258, + 6.533917978602636 ], "moduleForcesY": [ - 43.08617697815873, - 87.30364939891349, - 100.65158178859284, - 115.24782035664735 + 45.74125215420102, + 81.56714001964295, + 100.33878741770911, + 115.0667288889628 ], - "timestamp": 0.8168886831875088 + "timestamp": 0.8273592171345161 }, { - "x": 1.8711700652556698, - "y": 5.65013543062385, - "heading": 3.235787365853356, - "angularVelocity": -1.9148348113376807, - "velocityX": -0.4040907196098917, - "velocityY": -0.8250814542664743, + "x": 1.8688668154792478, + "y": 5.649330359328354, + "heading": 3.252581489320249, + "angularVelocity": -2.1253021823312412, + "velocityX": -0.38056257399321847, + "velocityY": -0.8091652540808636, "moduleForcesX": [ - 110.53141862820286, - 55.32796842006491, - 59.3280715917302, - 0.4423126125758939 + 110.75420648171638, + 67.41351148588903, + 59.644307139599306, + 0.9872999199197953 ], "moduleForcesY": [ - 32.74820446985415, - 100.43619981044304, - 98.9287079347535, - 115.32725877892798 + 31.95250489619978, + 92.68928093173696, + 98.72856624843796, + 115.31159659481125 ], - "timestamp": 0.8622713878090371 + "timestamp": 0.8733236180864337 }, { - "x": 1.8599680524378024, - "y": 5.625376428463603, - "heading": 3.1740593903204664, - "angularVelocity": -1.3601652005466363, - "velocityX": -0.24683440335448, - "velocityY": -0.5455603046739032, + "x": 1.858976873190861, + "y": 5.624953566198194, + "heading": 3.180831657251804, + "angularVelocity": -1.5609869939021082, + "velocityX": -0.21516526014844972, + "velocityY": -0.5303407120580114, "moduleForcesX": [ - 112.62711740856216, - 22.697802483968943, - 61.80059569568246, - -0.3042403849948985 + 113.26127376040452, + 29.537208536709745, + 62.36258258326864, + -0.7703487270785222 ], "moduleForcesY": [ - 24.716987102766762, - 112.34568644194815, - 97.42837626864956, - 115.35632305606234 + 21.60538546032672, + 110.53903877029852, + 97.06559527810428, + 115.34906975588957 ], - "timestamp": 0.9076540924305654 + "timestamp": 0.9192880190383512 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -0.7153988948307862, - "velocityX": -0.11473292914177677, - "velocityY": -0.2699509497396525, + "angularVelocity": -0.8536824770773792, + "velocityX": -0.09171687870080983, + "velocityY": -0.257334844008948, "moduleForcesX": [ - 113.77295041301618, - -10.465866206745924, - 63.178995978692946, - -1.1484884755134463 + 114.45714666054333, + -23.858287526830292, + 63.97932141399696, + -2.0261075694857094 ], "moduleForcesY": [ - 18.878658262354456, - 114.14538106924417, - 96.55763623804961, - 115.36971326990154 + 14.144281910437515, + 111.84032387600276, + 96.02804598950047, + 115.35597645325022 ], - "timestamp": 0.9530367970520937 + "timestamp": 0.9652524199902688 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -6.131753633195435e-20, - "velocityX": -1.3186452681561465e-19, - "velocityY": -2.1826000885282386e-19, + "angularVelocity": 5.811736944519793e-19, + "velocityX": 9.954723650891276e-19, + "velocityY": 3.489112214048715e-18, "moduleForcesX": [ - 114.29048140187895, - -30.95658475229967, - 63.14866943306744, - -2.883364732869972 + 114.90954967400633, + -61.21552776428465, + 63.898589778474886, + -4.252932311068719 ], "moduleForcesY": [ - 15.576647850433439, - 110.35051173008702, - 96.59011418775707, - 115.35208140460223 + 10.052179512818215, + 96.54516819532166, + 96.0960223654032, + 115.30969681756605 ], - "timestamp": 0.9984195016736219 + "timestamp": 1.0112168209421863 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.6.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.6.traj index 81cd58c..5098c88 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.6.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.6.traj @@ -4,295 +4,295 @@ "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -6.131753633195435e-20, - "velocityX": -1.3186452681561465e-19, - "velocityY": -2.1826000885282386e-19, + "angularVelocity": 5.811736944519793e-19, + "velocityX": 9.954723650891276e-19, + "velocityY": 3.489112214048715e-18, "moduleForcesX": [ - 114.29048140187895, - -30.95658475229967, - 63.14866943306744, - -2.883364732869972 + 114.90954967400633, + -61.21552776428465, + 63.898589778474886, + -4.252932311068719 ], "moduleForcesY": [ - 15.576647850433439, - 110.35051173008702, - 96.59011418775707, - 115.35208140460223 + 10.052179512818215, + 96.54516819532166, + 96.0960223654032, + 115.30969681756605 ], "timestamp": 0 }, { - "x": 1.8840837282716696, - "y": 5.612955136335095, + "x": 1.8840837431569961, + "y": 5.612955128559063, "heading": 3.141592653589793, - "angularVelocity": -3.444422296937106e-16, - "velocityX": 0.4881043332518617, - "velocityY": -0.0028329531955217676, + "angularVelocity": 2.5735470493073093e-16, + "velocityX": 0.4881044450227128, + "velocityY": -0.0028330818461293275, "moduleForcesX": [ - 115.37658317775369, - 115.37658317775369, - 115.37658317775369, - 115.37658317775369 + 115.37657744801193, + 115.37657744801193, + 115.37657744801193, + 115.37657744801193 ], "moduleForcesY": [ - -0.6696446594198311, - -0.6696446594198309, - -0.6696446594198873, - -0.669644659419887 + -0.6696748828445868, + -0.6696748828445869, + -0.6696748828445466, + -0.6696748828445467 ], - "timestamp": 0.06007438260610698 + "timestamp": 0.060074399345888096 }, { - "x": 1.9427243442502276, - "y": 5.612614333848124, + "x": 1.9427243878703746, + "y": 5.6126143107496995, "heading": 3.141592653589793, - "angularVelocity": -6.866000063375061e-16, - "velocityX": 0.9761334771103626, - "velocityY": -0.005673008563488317, + "angularVelocity": 6.514156180627557e-16, + "velocityX": 0.9761336834305282, + "velocityY": -0.005673262039647179, "moduleForcesX": [ - 115.35881014296135, - 115.35881014296135, - 115.35881014296135, - 115.35881014296135 + 115.35880034739998, + 115.35880034739998, + 115.35880034739998, + 115.35880034739998 ], "moduleForcesY": [ - -0.6713234488383947, - -0.6713234488383945, - -0.6713234488384501, - -0.67132344883845 + -0.6713527676407111, + -0.6713527676407113, + -0.6713527676406713, + -0.6713527676406714 ], - "timestamp": 0.12014876521221396 + "timestamp": 0.12014879869177619 }, { - "x": 2.0306762469301467, - "y": 5.6121022780031975, + "x": 2.0306763312754446, + "y": 5.612102232338162, "heading": 3.141592653589793, - "angularVelocity": -1.1640886651980952e-15, - "velocityX": 1.4640500470324853, - "velocityY": -0.008523697168624842, + "angularVelocity": 9.011876293987777e-16, + "velocityX": 1.4640503169856376, + "velocityY": -0.008524070437876532, "moduleForcesX": [ - 115.33220026624166, - 115.33220026624166, - 115.33220026624166, - 115.33220026624166 + 115.33218317019183, + 115.33218317019183, + 115.33218317019183, + 115.33218317019183 ], "moduleForcesY": [ - -0.6738369003470455, - -0.6738369003470452, - -0.6738369003471, - -0.6738369003470996 + -0.6738650288924455, + -0.6738650288924457, + -0.6738650288924058, + -0.6738650288924061 ], - "timestamp": 0.18022314781832094 + "timestamp": 0.1802231980376643 }, { - "x": 2.1479281990320023, - "y": 5.611417907491215, + "x": 2.1479283323125955, + "y": 5.611417832423418, "heading": 3.141592653589793, - "angularVelocity": -1.6338048670731272e-15, - "velocityX": 1.9517795608595263, - "velocityY": -0.01139205235732241, + "angularVelocity": 1.2870997598446557e-15, + "velocityX": 1.9517798315727328, + "velocityY": -0.011392538622051087, "moduleForcesX": [ - 115.28798452865676, - 115.28798452865676, - 115.28798452865676, - 115.28798452865676 + 115.28795258322376, + 115.28795258322376, + 115.28795258322376, + 115.28795258322376 ], "moduleForcesY": [ - -0.6780128723858879, - -0.6780128723858877, - -0.6780128723859408, - -0.6780128723859405 + -0.6780393929688204, + -0.6780393929688205, + -0.6780393929687812, + -0.6780393929687815 ], - "timestamp": 0.24029753042442792 + "timestamp": 0.24029759738355239 }, { - "x": 2.2944578552312023, - "y": 5.610559112618229, + "x": 2.2944580362400884, + "y": 5.6105590018551865, "heading": 3.141592653589793, - "angularVelocity": -1.9534731275862738e-15, - "velocityX": 2.4391371137337914, - "velocityY": -0.01429552557563469, + "angularVelocity": 1.5972843309153151e-15, + "velocityX": 2.4391372285526063, + "velocityY": -0.014296115776151204, "moduleForcesX": [ - 115.20006155628543, - 115.20006155628543, - 115.20006155628543, - 115.20006155628543 + 115.19999260587228, + 115.19999260587228, + 115.19999260587228, + 115.19999260587228 ], "moduleForcesY": [ - -0.6863139629291484, - -0.6863139629291481, - -0.686313962929199, - -0.6863139629291988 + -0.6863383396984449, + -0.6863383396984452, + -0.686338339698406, + -0.6863383396984062 ], - "timestamp": 0.3003719130305349 + "timestamp": 0.3003719967294405 }, { - "x": 2.4701992146114495, - "y": 5.609519669852626, + "x": 2.4701994064572736, + "y": 5.609519517509087, "heading": 3.141592653589793, - "angularVelocity": -2.2612491990593445e-15, - "velocityX": 2.9253960133479704, - "velocityY": -0.017302595890457132, + "angularVelocity": 1.9694342078085813e-15, + "velocityX": 2.925395378575903, + "velocityY": -0.01730328321909502, "moduleForcesX": [ - 114.94036531798054, - 114.94036531798054, - 114.94036531798054, - 114.94036531798054 + 114.94015610384217, + 114.94015610384217, + 114.94015610384217, + 114.94015610384217 ], "moduleForcesY": [ - -0.7108019221792697, - -0.7108019221792694, - -0.7108019221793155, - -0.7108019221793153 + -0.7108246829504119, + -0.7108246829504122, + -0.7108246829503729, + -0.7108246829503732 ], - "timestamp": 0.3604462956366419 + "timestamp": 0.3604463960753286 }, { "x": 2.6696577453613273, "y": 5.6078338623046875, "heading": 3.141592653589793, - "angularVelocity": -9.825480348601385e-17, - "velocityX": 3.3201927693152893, - "velocityY": -0.028062003716167083, + "angularVelocity": 3.395575597829539e-15, + "velocityX": 3.3201886506702922, + "velocityY": -0.028059459982184988, "moduleForcesX": [ - 93.32082845834267, - 93.32082845834263, - 93.32082845834269, - 93.32082845834263 + 93.31997894760582, + 93.3199789476058, + 93.31997894760583, + 93.3199789476058 ], "moduleForcesY": [ - -2.543275335574423, - -2.5432753355744233, - -2.543275335574176, - -2.543275335574176 + -2.5425108785752677, + -2.5425108785752832, + -2.5425108785751096, + -2.542510878575126 ], - "timestamp": 0.42052067824274886 + "timestamp": 0.4205207954212167 }, { - "x": 2.8583507333946185, - "y": 5.606118094653867, + "x": 2.8583506984832723, + "y": 5.606118099582229, "heading": 3.141592653589793, - "angularVelocity": 4.096438260386225e-16, - "velocityX": 2.7682638992943907, - "velocityY": -0.025171564120366276, + "angularVelocity": 3.1559531217018772e-15, + "velocityX": 2.7682631078990863, + "velocityY": -0.02517148927877366, "moduleForcesX": [ - -114.98181646144472, - -114.98181646144472, - -114.98181646144472, - -114.98181646144472 + -114.9811117071605, + -114.9811117071605, + -114.9811117071605, + -114.9811117071605 ], "moduleForcesY": [ - 0.6021572944438656, - 0.6021572944438652, - 0.6021572944439256, - 0.6021572944439254 + 0.6016428962295894, + 0.6016428962295897, + 0.6016428962295484, + 0.6016428962295487 ], - "timestamp": 0.4886836117265787 + "timestamp": 0.4886837357802891 }, { - "x": 3.0093359420039882, - "y": 5.604707049420854, + "x": 3.0093359108700892, + "y": 5.604707049037761, "heading": 3.141592653589793, - "angularVelocity": 6.231776078198638e-16, - "velocityX": 2.215063244676625, - "velocityY": -0.020701063773147482, + "angularVelocity": 2.487468041927929e-15, + "velocityX": 2.2150630766725925, + "velocityY": -0.020701139608050614, "moduleForcesX": [ - -115.24676383245284, - -115.24676383245284, - -115.24676383245284, - -115.24676383245284 + -115.24662233874156, + -115.24662233874156, + -115.24662233874156, + -115.24662233874156 ], "moduleForcesY": [ - 0.9313269849342551, - 0.9313269849342553, - 0.9313269849342641, - 0.9313269849342641 + 0.9312955009813111, + 0.9312955009813114, + 0.931295500981246, + 0.9312955009812464 ], - "timestamp": 0.5568465452104086 + "timestamp": 0.5568466761393616 }, { - "x": 3.1225883657277436, - "y": 5.603631896857166, + "x": 3.1225883471405993, + "y": 5.603631894326559, "heading": 3.141592653589793, - "angularVelocity": 5.340009815696904e-16, - "velocityX": 1.6614957416793361, - "velocityY": -0.015773273078730332, + "angularVelocity": 1.855880207091023e-15, + "velocityX": 1.6614957581629162, + "velocityY": -0.015773302993371468, "moduleForcesX": [ - -115.32318834172317, - -115.32318834172317, - -115.32318834172317, - -115.32318834172317 + -115.32313827588082, + -115.32313827588082, + -115.32313827588082, + -115.32313827588082 ], "moduleForcesY": [ - 1.026593019430992, - 1.026593019430992, - 1.0265930194309874, - 1.0265930194309874 + 1.0266024823242474, + 1.026602482324248, + 1.0266024823241775, + 1.0266024823241777 ], - "timestamp": 0.6250094786942384 + "timestamp": 0.625009616498434 }, { - "x": 3.1980961248529582, - "y": 5.602907459655186, + "x": 3.198096117993605, + "y": 5.602907458005536, "heading": 3.141592653589793, - "angularVelocity": 4.544734050494986e-16, - "velocityX": 1.1077539546200297, - "velocityY": -0.010628022665021828, + "angularVelocity": 1.2470165578599126e-15, + "velocityX": 1.1077540149418748, + "velocityY": -0.01062800866874632, "moduleForcesX": [ - -115.35949645880048, - -115.35949645880048, - -115.35949645880048, - -115.35949645880048 + -115.35947569038294, + -115.35947569038294, + -115.35947569038294, + -115.35947569038294 ], "moduleForcesY": [ - 1.0718958018898446, - 1.0718958018898443, - 1.0718958018898337, - 1.0718958018898337 + 1.0719048416123194, + 1.07190484161232, + 1.0719048416122476, + 1.0719048416122483 ], - "timestamp": 0.6931724121780682 + "timestamp": 0.6931725568575065 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": 2.246957301459914e-16, - "velocityX": 0.5539103568522864, - "velocityY": -0.0053556863887757175, + "angularVelocity": 6.569586620037962e-16, + "velocityX": 0.5539104016139282, + "velocityY": -0.005355661647002772, "moduleForcesX": [ - -115.38070640237679, - -115.38070640237679, - -115.38070640237679, - -115.38070640237679 + -115.38069800613746, + -115.38069800613746, + -115.38069800613746, + -115.38069800613746 ], "moduleForcesY": [ - 1.0983712484824302, - 1.0983712484824302, - 1.0983712484824162, - 1.0983712484824162 + 1.098373376275015, + 1.0983733762750154, + 1.0983733762749426, + 1.098373376274943 ], - "timestamp": 0.7613353456618981 + "timestamp": 0.7613354972165789 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": -3.1001175632732538e-25, - "velocityX": 2.125979487428218e-25, - "velocityY": -7.679223892443952e-26, + "angularVelocity": 2.1594191776071485e-25, + "velocityX": -1.0074564721924767e-23, + "velocityY": 1.0581704151351368e-23, "moduleForcesX": [ - -115.39461413799822, - -115.39461413799822, - -115.39461413799822, - -115.39461413799822 + -115.39461182381045, + -115.39461182381045, + -115.39461182381045, + -115.39461182381045 ], "moduleForcesY": [ - 1.1157353471217306, - 1.1157353471217306, - 1.1157353471217144, - 1.1157353471217144 + 1.1157300801986492, + 1.1157300801986496, + 1.1157300801985768, + 1.1157300801985772 ], - "timestamp": 0.8294982791457279 + "timestamp": 0.8294984375756513 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.7.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.7.traj index ec13c92..5999674 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.7.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.7.traj @@ -4,295 +4,295 @@ "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": -3.1001175632732538e-25, - "velocityX": 2.125979487428218e-25, - "velocityY": -7.679223892443952e-26, + "angularVelocity": 2.1594191776071485e-25, + "velocityX": -1.0074564721924767e-23, + "velocityY": 1.0581704151351368e-23, "moduleForcesX": [ - -115.39461413799822, - -115.39461413799822, - -115.39461413799822, - -115.39461413799822 + -115.39461182381045, + -115.39461182381045, + -115.39461182381045, + -115.39461182381045 ], "moduleForcesY": [ - 1.1157353471217306, - 1.1157353471217306, - 1.1157353471217144, - 1.1157353471217144 + 1.1157300801986492, + 1.1157300801986496, + 1.1157300801985768, + 1.1157300801985772 ], "timestamp": 0 }, { - "x": 3.2066986168460305, - "y": 5.573801506681172, - "heading": 3.125769419620629, - "angularVelocity": -0.22214471367149358, - "velocityX": -0.4092925688636585, - "velocityY": -0.4034976421009905, + "x": 3.2067040069092134, + "y": 5.573943438615316, + "heading": 3.1211551253930243, + "angularVelocity": -0.2866001693312032, + "velocityX": -0.4087529483282819, + "velocityY": -0.4010498334162292, "moduleForcesX": [ - -94.50501486045644, - -83.99858675745848, - -80.27135887466498, - -67.60907694190244 + -97.7982362461094, + -84.66730708312969, + -79.91393576166902, + -63.20469705289832 ], "moduleForcesY": [ - -66.22016115527009, - -79.10404420877457, - -82.91786973993526, - -93.52088748741936 + -61.25124940458032, + -78.37881724715737, + -83.2653681457004, + -96.55297564085089 ], - "timestamp": 0.07122939685417506 + "timestamp": 0.07131024466754887 }, { - "x": 3.148391338670253, - "y": 5.516308685460145, - "heading": 3.0946118348565337, - "angularVelocity": -0.4374259244098728, - "velocityX": -0.8185844714528088, - "velocityY": -0.807150190232956, + "x": 3.148394804389903, + "y": 5.516669588157704, + "heading": 3.0819512787773773, + "angularVelocity": -0.5497645786859534, + "velocityX": -0.8176833888475731, + "velocityY": -0.8031644082084749, "moduleForcesX": [ - -94.33138257713645, - -83.45340079540252, - -80.64801905590379, - -67.95070369572386 + -96.91343804537247, + -83.6117617704874, + -80.55330595264402, + -64.64704831280247 ], "moduleForcesY": [ - -66.44136479388739, - -79.65440454308316, - -82.53433216167745, - -93.2563885145976 + -62.61253176158479, + -79.47867664464056, + -82.62882568534246, + -95.57647529043373 ], - "timestamp": 0.14245879370835013 + "timestamp": 0.14262048933509774 }, { - "x": 3.0609306562816943, - "y": 5.430043615996792, - "heading": 3.048924160519714, - "angularVelocity": -0.6414159933202015, - "velocityX": -1.2278734097329609, - "velocityY": -1.2110880236703383, + "x": 3.060907848137827, + "y": 5.430610082205895, + "heading": 3.0265586342077184, + "angularVelocity": -0.7767838243705629, + "velocityX": -1.2268497557390838, + "velocityY": -1.2068322911107934, "moduleForcesX": [ - -93.96622463847802, - -82.66507902834802, - -81.1860792576855, - -68.56375935722876 + -95.32187408048668, + -82.31821309565629, + -81.35076884094318, + -66.92262060727167 ], "moduleForcesY": [ - -66.91762608001513, - -80.43604135450067, - -81.9787027695054, - -92.78161616974027 + -64.96637934957263, + -80.78194903679561, + -81.81464976514644, + -93.97078846223003 ], - "timestamp": 0.2136881905625252 + "timestamp": 0.21393073400264662 }, { - "x": 2.944318774935105, - "y": 5.314972807576324, - "heading": 2.9899555039449703, - "angularVelocity": -0.8278696602677583, - "velocityX": -1.637131388116669, - "velocityY": -1.6154960381883656, + "x": 2.9442234271309333, + "y": 5.3156098843885005, + "heading": 2.9591124503921264, + "angularVelocity": -0.9458133838977714, + "velocityX": -1.63629253483678, + "velocityY": -1.612674284789381, "moduleForcesX": [ - -93.23102514178399, - -81.699397941509, - -81.83020425409698, - -69.59582645311289 + -92.24877909794793, + -81.18961303807885, + -82.06283505268627, + -70.63242017886546 ], "moduleForcesY": [ - -67.87302901661609, - -81.3580027716078, - -81.29029357501479, - -91.9675996512419 + -69.19153030778277, + -81.86072044549816, + -81.04640774388061, + -91.16685358492028 ], - "timestamp": 0.28491758741670026 + "timestamp": 0.2852409786701955 }, { - "x": 2.798563775989493, - "y": 5.171041089911012, - "heading": 2.9198390837009516, - "angularVelocity": -0.984374757343028, - "velocityX": -2.046275911110254, - "velocityY": -2.0206785965066842, + "x": 2.7983365943754688, + "y": 5.1714841013846, + "heading": 2.8875990684331025, + "angularVelocity": -1.0028486410672481, + "velocityX": -2.045804686768295, + "velocityY": -2.0211090801303704, "moduleForcesX": [ - -91.63008521058406, - -80.74282088024366, - -82.43567724433059, - -71.4573972068324 + -85.2775068960177, + -81.09664380826169, + -81.98861558632382, + -77.82613865257962 ], "moduleForcesY": [ - -69.89172174791939, - -82.19417166226101, - -80.58049754682132, - -90.4401820480368 + -77.49783429261997, + -81.85175642641804, + -80.991058485776, + -84.99010839197277 ], - "timestamp": 0.3561469842708753 + "timestamp": 0.35655122333774436 }, { - "x": 2.6237060601772595, - "y": 4.998155595405218, - "heading": 2.8440225200690676, - "angularVelocity": -1.0643999104344437, - "velocityX": -2.454853242267534, - "velocityY": -2.427164936686651, + "x": 2.6236753281267338, + "y": 4.998926787820056, + "heading": 2.8387718219195595, + "angularVelocity": -0.684715733919828, + "velocityX": -2.449315200964648, + "velocityY": -2.4198109874536784, "moduleForcesX": [ - -86.70980354807344, - -80.52618577124305, - -82.32400313465457, - -76.2536897185496 + -60.98601461651415, + -84.03168175068872, + -75.69360315918169, + -100.69711811876627 ], "moduleForcesY": [ - -75.55570587121085, - -82.08532933524766, - -80.372578012564, - -86.13264049441499 + -97.49882069315503, + -78.57987315738362, + -86.20664997158062, + -55.29287195277558 ], - "timestamp": 0.4273763811250504 + "timestamp": 0.42786146800529323 }, { - "x": 2.4491238027886877, - "y": 4.825248874693559, - "heading": 2.768573050774834, - "angularVelocity": -1.059246218926964, - "velocityX": -2.4509860408615487, - "velocityY": -2.4274629345190566, + "x": 2.4491288335424555, + "y": 4.825643663887782, + "heading": 2.7904774617241968, + "angularVelocity": -0.6772429462346313, + "velocityX": -2.447705731455862, + "velocityY": -2.429989193560148, "moduleForcesX": [ - 0.8313154124721739, - 0.5815156710986054, - 0.960410251787089, - 0.7105986961435966 + 0.4130056069714148, + 0.04889182806994197, + 0.5921306407032488, + 0.22796342105049527 ], "moduleForcesY": [ - -0.2750886779845719, - -0.17899030487484907, - 0.06010210260660461, - 0.15634311143689636 + -2.3376973989520304, + -2.204364974642423, + -1.8492859164341702, + -1.715902956353102 ], - "timestamp": 0.49860577797922545 + "timestamp": 0.4991717126728421 }, { - "x": 2.303614224295877, - "y": 4.681164504915296, - "heading": 2.7036831029300576, - "angularVelocity": -0.9109995410690177, - "velocityX": -2.0428304172040885, - "velocityY": -2.0228217020177746, + "x": 2.3035011250063397, + "y": 4.681149821933151, + "heading": 2.7264699100767897, + "angularVelocity": -0.8975926523014042, + "velocityX": -2.042170928104912, + "velocityY": -2.0262704556444535, "moduleForcesX": [ - 91.18252045297272, - 77.62580863219615, - 84.43073188208312, - 72.23833707289441 + 67.54599174060296, + 84.9037485490674, + 75.2752222728781, + 95.29586306490998 ], "moduleForcesY": [ - 70.08510741611299, - 84.80855065381793, - 78.21066685239548, - 89.57057617080244 + 93.07759399799777, + 77.61475836679602, + 86.7010154409663, + 64.1809063754542 ], - "timestamp": 0.5698351748334005 + "timestamp": 0.570481957340391 }, { - "x": 2.1872057933221156, - "y": 4.565894974920919, - "heading": 2.6510971821891247, - "angularVelocity": -0.7382614912293802, - "velocityX": -1.6342751183486552, - "velocityY": -1.6182859196514365, + "x": 2.187069229591648, + "y": 4.565754778501453, + "heading": 2.668058906720778, + "angularVelocity": -0.819110965448604, + "velocityX": -1.6327513102430458, + "velocityY": -1.6182112958618466, "moduleForcesX": [ - 92.86354233827863, - 76.10788597003088, - 85.60378749942653, - 71.22089704597026 + 86.70173496470736, + 79.384018772138, + 83.43809887191118, + 76.59134612886838 ], "moduleForcesY": [ - 68.23029646989538, - 86.50055242381335, - 77.21719460477225, - 90.6427680132351 + 75.89707047860772, + 83.51024074907042, + 79.50816094167688, + 86.11608026131232 ], - "timestamp": 0.6410645716875765 + "timestamp": 0.6417922020079398 }, { - "x": 2.0999010385337513, - "y": 4.4794418527905195, - "heading": 2.6113303554720884, - "angularVelocity": -0.558292340990185, - "velocityX": -1.2256843191737148, - "velocityY": -1.213728122777609, + "x": 2.0998022646657093, + "y": 4.479318845326743, + "heading": 2.621053106423146, + "angularVelocity": -0.6591731737392705, + "velocityX": -1.2237647666584353, + "velocityY": -1.212111016834661, "moduleForcesX": [ - 93.27282582567618, - 75.14352562829308, - 86.26725520322118, - 71.1408153779973 + 91.96458850927135, + 76.0539395076334, + 85.67235755159176, + 72.07935631353604 ], "moduleForcesY": [ - 67.80015365809152, - 87.44982615530438, - 76.56915606002667, - 90.78923076727229 + 69.55656402670739, + 86.65433407137036, + 77.2235599704272, + 90.03678616248813 ], - "timestamp": 0.7122939685417515 + "timestamp": 0.7131024466754887 }, { - "x": 2.0416985533138226, - "y": 4.421807328352338, - "heading": 2.5846398593563444, - "angularVelocity": -0.374711808530201, - "velocityX": -0.817113267701592, - "velocityY": -0.8091395825823795, + "x": 2.0416569192005602, + "y": 4.421751377581397, + "heading": 2.588213851721259, + "angularVelocity": -0.4605124390609731, + "velocityX": -0.8153855836033795, + "velocityY": -0.8072818711214387, "moduleForcesX": [ - 93.42895814439328, - 74.50739015764167, - 86.68884220281498, - 71.18348402973328 + 94.28332054605062, + 73.78272693454588, + 86.89555919568178, + 70.32485404051467 ], "moduleForcesY": [ - 67.65058557937509, - 88.04747340766613, - 76.13800705299516, - 90.79681638747401 + 66.44804317305007, + 88.6490102789359, + 75.90013809981592, + 91.461556269102 ], - "timestamp": 0.7835233653959266 + "timestamp": 0.7844126913430376 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": -0.18854710036895178, - "velocityX": -0.40855928039119105, - "velocityY": -0.40454905992210366, + "angularVelocity": -0.2384522544000844, + "velocityX": -0.4075122325502672, + "velocityY": -0.40330579286768936, "moduleForcesX": [ - 93.54843405198021, - 74.14598545423124, - 86.92196903084317, - 71.17867844532283 + 95.62161114658021, + 72.28092066696597, + 87.6098954465452, + 69.37112285680641 ], "moduleForcesY": [ - 67.52515136113759, - 88.38488704635111, - 75.89955258668185, - 90.82487231947138 + 64.5500491439784, + 89.90999033784931, + 75.10570426878738, + 92.21350984982247 ], - "timestamp": 0.8547527622501017 + "timestamp": 0.8557229360105865 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": 3.1943459470198745e-23, - "velocityX": -5.469392050310526e-23, - "velocityY": -4.674764031709702e-23, + "angularVelocity": 4.422392455737567e-23, + "velocityX": -6.58083868918992e-23, + "velocityY": -7.421024279100438e-23, "moduleForcesX": [ - 93.70754772093763, - 74.0416335766594, - 86.98334831370248, - 71.06675825660123 + 96.59228734629687, + 71.44716369701295, + 87.94049500594602, + 68.61596217852527 ], "moduleForcesY": [ - 67.33114392906658, - 88.4940863558236, - 75.84771503471543, - 90.92845417388111 + 63.11798568308976, + 90.59549675575015, + 74.73839504419405, + 92.79347338693019 ], - "timestamp": 0.9259821591042767 + "timestamp": 0.9270331806781353 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.8.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.8.traj index efdb33d..9eb76c8 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.8.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.8.traj @@ -4,211 +4,211 @@ "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": 3.1943459470198745e-23, - "velocityX": -5.469392050310526e-23, - "velocityY": -4.674764031709702e-23, + "angularVelocity": 4.422392455737567e-23, + "velocityX": -6.58083868918992e-23, + "velocityY": -7.421024279100438e-23, "moduleForcesX": [ - 93.70754772093763, - 74.0416335766594, - 86.98334831370248, - 71.06675825660123 + 96.59228734629687, + 71.44716369701295, + 87.94049500594602, + 68.61596217852527 ], "moduleForcesY": [ - 67.33114392906658, - 88.4940863558236, - 75.84771503471543, - 90.92845417388111 + 63.11798568308976, + 90.59549675575015, + 74.73839504419405, + 92.79347338693019 ], "timestamp": 0 }, { - "x": 2.041953615742068, - "y": 4.378378905710642, - "heading": 2.6013063846651288, - "angularVelocity": 0.4668485846449045, - "velocityX": 0.4553679702074507, - "velocityY": -0.22666627016800736, + "x": 2.0419535184125355, + "y": 4.378378938668267, + "heading": 2.6013079982530756, + "angularVelocity": 0.46687359905252357, + "velocityX": 0.45536644581371355, + "velocityY": -0.22666575164772176, "moduleForcesX": [ - 90.31940844346734, - 86.19108550191558, - 111.0245802243277, - 113.67801849819759 + 90.31876641561897, + 86.18981380029929, + 111.02482428420288, + 113.67833215471809 ], "moduleForcesY": [ - -71.82796867166263, - -76.68979833900957, - -31.47718312544652, - -19.714913550991096 + -71.82877383631248, + -76.69122231911778, + -31.476317591030636, + -19.7130866601736 ], - "timestamp": 0.06446762941256523 + "timestamp": 0.06446763148675849 }, { - "x": 2.100686916805549, - "y": 4.34921431694764, - "heading": 2.661560971312702, - "angularVelocity": 0.9346487096953813, - "velocityX": 0.9110510437356681, - "velocityY": -0.45239120825061296, + "x": 2.1006867225178447, + "y": 4.349214387879551, + "heading": 2.66156424307939, + "angularVelocity": 0.934674400729164, + "velocityX": 0.9110495104411048, + "velocityY": -0.45239060465106323, "moduleForcesX": [ - 91.08357348554155, - 85.55141100459058, - 111.34346253684427, - 113.512275132038 + 91.08359939264427, + 85.55134610222815, + 111.34348432988189, + 113.51227157432788 ], "moduleForcesY": [ - -70.82047716964789, - -77.35792380941974, - -30.241251869986673, - -20.460827170514083 + -70.82043772341163, + -77.35798773989126, + -30.241157017363147, + -20.460816178917426 ], - "timestamp": 0.12893525882513046 + "timestamp": 0.12893526297351698 }, { - "x": 2.188828983459932, - "y": 4.30558804082172, - "heading": 2.7518665174157255, - "angularVelocity": 1.4007889994699134, - "velocityX": 1.367229840115771, - "velocityY": -0.6767159972135803, + "x": 2.1888288337503314, + "y": 4.305588083853979, + "heading": 2.751868994756181, + "angularVelocity": 1.400776631530792, + "velocityX": 1.36723048760664, + "velocityY": -0.6767164082107214, "moduleForcesX": [ - 92.22471205340607, - 84.73884598587084, - 111.77189701377915, - 113.1920358545827 + 92.22557626068495, + 84.74080845033583, + 111.77152136175108, + 113.19149333747797 ], "moduleForcesY": [ - -69.25533775826122, - -78.1610920385497, - -28.42581379359046, - -21.804600786698785 + -69.25416976459641, + -78.15894950714625, + -28.427248361937494, + -21.807364319503435 ], - "timestamp": 0.1934028882376957 + "timestamp": 0.19340289446027548 }, { - "x": 2.3064108263014638, - "y": 4.247619822740085, - "heading": 2.871624755946557, - "angularVelocity": 1.8576491740441008, - "velocityX": 1.8238896623460321, - "velocityY": -0.8991833360377534, + "x": 2.3064110851595947, + "y": 4.247619595905105, + "heading": 2.871619566972024, + "angularVelocity": 1.857530197001871, + "velocityX": 1.8238959412277145, + "velocityY": -0.899187493196176, "moduleForcesX": [ - 93.71262507711475, - 83.94734279206513, - 112.181194058843, - 112.51014857524359 + 93.71457960486228, + 83.95312347953696, + 112.18000941325678, + 112.50854673479259 ], "moduleForcesY": [ - -67.00490432643169, - -78.7595043102539, - -26.138048273425948, - -24.10783557177594 + -67.00210588095794, + -78.75329673294317, + -26.142969355852962, + -24.11521485261637 ], - "timestamp": 0.2578705176502609 + "timestamp": 0.25787052594703397 }, { - "x": 2.4249201960080744, - "y": 4.1906611165057175, - "heading": 2.9802037085519797, - "angularVelocity": 1.684239882787761, - "velocityX": 1.83827714445963, - "velocityY": -0.8835241306897914, + "x": 2.424920548824161, + "y": 4.190660759682163, + "heading": 2.9801962738348395, + "angularVelocity": 1.6842049934022552, + "velocityX": 1.838278542758427, + "velocityY": -0.8835261186017338, "moduleForcesX": [ - -0.6594868643756788, - 9.131886004968548, - -2.8295023873622442, - 7.033546413975622 + -0.6576525136461785, + 9.131767443761998, + -2.8279965006211887, + 7.026024173020117 ], "moduleForcesY": [ - 10.854211773799015, - 9.22236053293692, - -2.339354556360805, - -3.940291709407672 + 10.850457001056148, + 9.22031704495339, + -2.334560335904532, + -3.9373768454129094 ], - "timestamp": 0.32233814706282615 + "timestamp": 0.32233815743379246 }, { - "x": 2.5138781257306912, - "y": 4.147944154593341, - "heading": 3.06100032388245, - "angularVelocity": 1.2532896907594944, - "velocityX": 1.3798852312891103, - "velocityY": -0.6626110235728699, + "x": 2.5138783682560137, + "y": 4.147943895629665, + "heading": 3.0609951273200853, + "angularVelocity": 1.2533243679324737, + "velocityX": 1.3798834760995347, + "velocityY": -0.6626094842846958, "moduleForcesX": [ - -96.20030583423292, - -83.49735362781274, - -112.87287120033253, - -111.30688094678442 + -96.20123306665766, + -83.50128406439781, + -112.8719813672814, + -111.30567857439891 ], "moduleForcesY": [ - 63.39232613998012, - 79.26624964258414, - 22.910766035105024, - 29.07155678764673 + 63.390860409712616, + 79.26206350790233, + 22.914988055013122, + 29.076088096143998 ], - "timestamp": 0.3868057764753914 + "timestamp": 0.38680578892055095 }, { - "x": 2.5732044469161934, - "y": 4.119469408000457, - "heading": 3.1146935416419046, - "angularVelocity": 0.8328709811220385, - "velocityX": 0.9202497707157794, - "velocityY": -0.4416906105024887, + "x": 2.573204544665813, + "y": 4.119469300656433, + "heading": 3.1146914296651333, + "angularVelocity": 0.8329188013689777, + "velocityX": 0.9202474953959546, + "velocityY": -0.44168824441893817, "moduleForcesX": [ - -97.04105274434207, - -83.72178565794128, - -113.16925703452722, - -111.040974040282 + -97.04118666628617, + -83.7225268890319, + -113.16906929813969, + -111.0407318674197 ], "moduleForcesY": [ - 62.3384953090497, - 79.27865285910248, - 22.1639550486123, - 30.86623247761849 + 62.338271276948696, + 79.27785567094799, + 22.16486600754754, + 30.867064944590858 ], - "timestamp": 0.4512734058879566 + "timestamp": 0.45127342040730944 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": 0.41724990034526915, - "velocityX": 0.46014760143287403, - "velocityY": -0.22081995024741788, + "angularVelocity": 0.4172826471868358, + "velocityX": 0.46014607036910204, + "velocityY": -0.22081827805865795, "moduleForcesX": [ - -97.43168523301415, - -83.78966430984669, - -113.29850030582719, - -110.86442475699117 + -97.43147500123005, + -83.78876895559843, + -113.29868293583836, + -110.86467892511293 ], "moduleForcesY": [ - 61.806795260557664, - 79.28878914703319, - 21.754142326817426, - 31.75377302463092 + 61.807121644078244, + 79.2897292411926, + 21.753172555886724, + 31.752858683705533 ], - "timestamp": 0.5157410353005218 + "timestamp": 0.5157410518940679 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": -5.576115791345261e-23, - "velocityX": 4.832731708286524e-23, - "velocityY": 2.5949584810645407e-23, + "angularVelocity": -7.866247097183092e-23, + "velocityX": 6.78824268132765e-23, + "velocityY": 3.6098947052526804e-23, "moduleForcesX": [ - -97.43090964153063, - -83.72024176507091, - -113.3437528109882, - -110.92939949551028 + -97.43047601274746, + -83.71833110199685, + -113.34415942502996, + -110.92997514796726 ], "moduleForcesY": [ - 61.848085945116416, - 79.40203201217781, - 21.650429300155526, - 31.658273208510547 + 61.84876794751755, + 79.40404372307437, + 21.64829364292422, + 31.65623556989351 ], - "timestamp": 0.5802086647130871 + "timestamp": 0.5802086833808264 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.9.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.9.traj index 17bc5d3..1cd5853 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.9.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.9.traj @@ -4,211 +4,211 @@ "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": -5.576115791345261e-23, - "velocityX": 4.832731708286524e-23, - "velocityY": 2.5949584810645407e-23, + "angularVelocity": -7.866247097183092e-23, + "velocityX": 6.78824268132765e-23, + "velocityY": 3.6098947052526804e-23, "moduleForcesX": [ - -97.43090964153063, - -83.72024176507091, - -113.3437528109882, - -110.92939949551028 + -97.43047601274746, + -83.71833110199685, + -113.34415942502996, + -110.92997514796726 ], "moduleForcesY": [ - 61.848085945116416, - 79.40203201217781, - 21.650429300155526, - 31.658273208510547 + 61.84876794751755, + 79.40404372307437, + 21.64829364292422, + 31.65623556989351 ], "timestamp": 0 }, { - "x": 2.576440824052377, - "y": 4.117038967947073, - "heading": 3.1112264543640924, - "angularVelocity": -0.49847391634204, - "velocityX": -0.4338307912320184, - "velocityY": 0.19378893670305936, + "x": 2.576440932025781, + "y": 4.117038855996892, + "heading": 3.1112245997800225, + "angularVelocity": -0.49850434355138845, + "velocityX": -0.4338290043854107, + "velocityY": 0.19378709255352025, "moduleForcesX": [ - -96.78178208378979, - -79.65664846502794, - -114.54083675568862, - -113.52833812262094 + -96.78133854290625, + -79.65476731370306, + -114.54105043150145, + -113.52876962438683 ], "moduleForcesY": [ - 62.8559302580606, - 83.46877311897688, - 13.98107239638093, - 20.38471537731262 + 62.85661167452962, + 83.47056524407454, + 13.979310801185582, + 20.382277924872408 ], - "timestamp": 0.06091833139141478 + "timestamp": 0.060918333415965975 }, { - "x": 2.523633825869069, - "y": 4.140701386661653, - "heading": 3.049917147465986, - "angularVelocity": -1.00641802718103, - "velocityX": -0.8668490580283761, - "velocityY": 0.38842854316779524, + "x": 2.5236340884512134, + "y": 4.140701139163088, + "heading": 3.0499127384037488, + "angularVelocity": -1.006459926564636, + "velocityX": -0.86684649125229, + "velocityY": 0.3884263051752233, "moduleForcesX": [ - -95.85123578413562, - -79.75263731487098, - -114.32031499165952, - -113.82581248115163 + -95.85098527966763, + -79.75194362178674, + -114.32037290983277, + -113.8259581293425 ], "moduleForcesY": [ - 64.22511537248816, - 83.3321020697923, - 15.50409667268004, - 18.42234892504067 + 64.22548363003447, + 83.33275912303841, + 15.503643170599588, + 18.421403862263197 ], - "timestamp": 0.12183666278282956 + "timestamp": 0.12183666683193195 }, { - "x": 2.444538637133602, - "y": 4.176301641210184, - "heading": 2.956763746978034, - "angularVelocity": -1.5291522003355558, - "velocityX": -1.298380748928638, - "velocityY": 0.5843931331571143, + "x": 2.444538983723339, + "y": 4.176301351792292, + "heading": 2.956758090766189, + "angularVelocity": -1.5291726219999353, + "velocityX": -1.2983793267585322, + "velocityY": 0.5843924256121097, "moduleForcesX": [ - -94.376145734969, - -79.85703113409417, - -113.95978815112649, - -114.17093924825681 + -94.37638365733315, + -79.85830247504768, + -113.95958149721488, + -114.17069050727945 ], "moduleForcesY": [ - 66.29352669629847, - 83.13867501463098, - 17.657848513922975, - 15.629038984963607 + 66.2931720124336, + 83.13743831492843, + 17.659120262265198, + 15.630779550308647 ], - "timestamp": 0.18275499417424435 + "timestamp": 0.18275500024789793 }, { - "x": 2.339300712877381, - "y": 4.223965232327085, - "heading": 2.8309077343927975, - "angularVelocity": -2.065979315431076, - "velocityX": -1.7275247343865, - "velocityY": 0.7824178704214834, + "x": 2.3393008114476626, + "y": 4.223965142674428, + "heading": 2.8309060893015747, + "angularVelocity": -2.065913402542771, + "velocityX": -1.727528748317553, + "velocityY": 0.7824211236488453, "moduleForcesX": [ - -92.27983792176532, - -80.19605916572785, - -113.32380930105032, - -114.33788054491679 + -92.28142357461459, + -80.20103541951015, + -113.32310550893337, + -114.33707780014122 ], "moduleForcesY": [ - 68.94832064257966, - 82.52218385370321, - 20.593651711278582, - 12.575832251224798 + 68.94614202726282, + 82.51730402352771, + 20.59733382901846, + 12.582895501177047 ], - "timestamp": 0.24367332556565913 + "timestamp": 0.2436733336638639 }, { - "x": 2.235190395761607, - "y": 4.273756936630003, - "heading": 2.701317964138096, - "angularVelocity": -2.127270516030026, - "velocityX": -1.7090145894975588, - "velocityY": 0.8173517423350798, + "x": 2.235190073627775, + "y": 4.273756975831149, + "heading": 2.7013219935024604, + "angularVelocity": -2.127177296763512, + "velocityX": -1.7090214387349054, + "velocityY": 0.8173538303605644, "moduleForcesX": [ - 3.684421057917722, - 7.063912641861401, - 1.555725211536742, - 4.954961279186012 + 3.6851851769563395, + 7.061909627035633, + 1.557485144882814, + 4.951796003866703 ], "moduleForcesY": [ - 11.191987173441394, - 9.59755977851208, - 6.692902445124649, - 5.090196808915668 + 11.190702840872866, + 9.598090988387812, + 6.6913917907658425, + 5.091373059116531 ], - "timestamp": 0.3045916569570739 + "timestamp": 0.3045916670798299 }, { - "x": 2.157097583307559, - "y": 4.311211682575675, - "heading": 2.6044566357317396, - "angularVelocity": -1.5900193947204522, - "velocityX": -1.2819263211968914, - "velocityY": 0.6148353884648882, + "x": 2.1570972821207093, + "y": 4.3112117278174935, + "heading": 2.60446043332951, + "angularVelocity": -1.5900231464238217, + "velocityX": -1.2819259347399985, + "velocityY": 0.6148354671916831, "moduleForcesX": [ - 88.82178084722035, - 82.51336670219086, - 112.18902066417408, - 114.69665015134913 + 88.82438792099869, + 82.51888433729167, + 112.18828932823602, + 114.69599016804356 ], "moduleForcesY": [ - -73.33093047177124, - -80.15041574335498, - -26.12896176757338, - -9.217702890443773 + -73.32771655792331, + -80.14469842932267, + -26.131944406933393, + -9.225518690999772 ], - "timestamp": 0.3655099883484887 + "timestamp": 0.36551000049579585 }, { - "x": 2.10503433227216, - "y": 4.336216845215367, - "heading": 2.539998763051629, - "angularVelocity": -1.0581030571233867, - "velocityX": -0.854640136166579, - "velocityY": 0.41047024875037896, + "x": 2.105034195245937, + "y": 4.33621686660926, + "heading": 2.5400004915986667, + "angularVelocity": -1.0581369862943222, + "velocityX": -0.8546374129980211, + "velocityY": 0.4104698436351712, "moduleForcesX": [ - 87.93445802257567, - 83.61446769451473, - 111.92017771507034, - 114.93625421398835 + 87.93535535098103, + 83.61615888406604, + 111.91995391554177, + 114.93605502522537 ], "moduleForcesY": [ - -74.61104959107475, - -79.30871463146512, - -27.840746229308422, - -8.791324432745945 + -74.60997644793598, + -79.30691637646426, + -27.84160522062184, + -8.793781645274724 ], - "timestamp": 0.42642831973990347 + "timestamp": 0.4264283339117618 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -0.5296576683558465, - "velocityX": -0.4273247996047905, - "velocityY": 0.20526140282074246, + "angularVelocity": -0.5296860255780654, + "velocityX": -0.4273225360601924, + "velocityY": 0.20526104480936758, "moduleForcesX": [ - 87.47215406723147, - 84.19152726546542, - 111.75251144456588, - 115.01634601054388 + 87.47197704017128, + 84.19119924954728, + 111.75254715698382, + 115.01637354227935 ], "moduleForcesY": [ - -75.22571028375253, - -78.80193174691283, - -28.691908830480827, - -8.618963041311037 + -75.22591033857395, + -78.80227271136283, + -28.69175573980809, + -8.61852483376894 ], - "timestamp": 0.48734665113131825 + "timestamp": 0.4873466673277278 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -1.1810659900072104e-23, - "velocityX": 1.1429735881849466e-23, - "velocityY": 2.3338539139201852e-23, + "angularVelocity": -1.5930760739242085e-23, + "velocityX": 1.5568104276022208e-23, + "velocityY": 3.205093369656377e-23, "moduleForcesX": [ - 87.45368989610174, - 84.1506642550139, - 111.7820465070688, - 115.05496155327525 + 87.45282015084237, + 84.14903985656558, + 111.7822513078171, + 115.05512710586952 ], "moduleForcesY": [ - -75.28457785684655, - -78.90065034494484, - -28.668166390935777, - -8.534123812406273 + -75.28558613417842, + -78.90237620597085, + -28.667363381920158, + -8.531852509603667 ], - "timestamp": 0.548264982522733 + "timestamp": 0.5482650007436938 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Amp 5 Piece.traj b/src/main/deploy/choreo/Blue Amp 5 Piece.traj index 854fd7c..f17493e 100644 --- a/src/main/deploy/choreo/Blue Amp 5 Piece.traj +++ b/src/main/deploy/choreo/Blue Amp 5 Piece.traj @@ -4,9 +4,9 @@ "x": 1.3383026504516593, "y": 6.508597373962402, "heading": 3.141592653589793, - "angularVelocity": 6.630957232918865e-24, - "velocityX": 1.2060997095687284e-21, - "velocityY": 7.138625871741085e-22, + "angularVelocity": 1.3038840850576071e-23, + "velocityX": 2.4437165324259185e-20, + "velocityY": 2.3610738986678838e-20, "moduleForcesX": [ 0, 0, @@ -22,3117 +22,3159 @@ "timestamp": 0 }, { - "x": 1.360373693575745, - "y": 6.490858286972303, - "heading": 3.1415926537545715, - "angularVelocity": 2.791277359525368e-9, - "velocityX": 0.37387393953457276, - "velocityY": -0.30049247330305445, + "x": 1.3606762519021935, + "y": 6.491593300242642, + "heading": 3.141592653934462, + "angularVelocity": 5.860742394414825e-9, + "velocityX": 0.3804405020078545, + "velocityY": -0.28913710456614355, "moduleForcesX": [ - 89.9335744997474, - 89.93357437032692, - 89.93357471542468, - 89.93357458600421 + 91.86115898733682, + 91.86115873638171, + 91.86115942954156, + 91.86115917858646 ], "moduleForcesY": [ - -72.28201650320291, - -72.28201666391996, - -72.28201623452371, - -72.28201639524077 + -69.8150419508136, + -69.81504228033295, + -69.81504136827428, + -69.81504169779365 ], - "timestamp": 0.05903338208477806 + "timestamp": 0.058809725390574434 }, { - "x": 1.405907900199343, - "y": 6.457273283717531, - "heading": 3.141592654041051, - "angularVelocity": 4.8528378035858e-9, - "velocityX": 0.7713297970664508, - "velocityY": -0.5689154520494931, + "x": 1.4065981178654914, + "y": 6.459259290320045, + "heading": 3.141592654534016, + "angularVelocity": 1.0194809067899609e-8, + "velocityX": 0.7808549633298908, + "velocityY": -0.5498071910361221, "moduleForcesX": [ - 95.60609124537717, - 95.60609117215726, - 95.60609139046502, - 95.60609131724513 + 96.68407098415938, + 96.68407083847602, + 96.68407128358729, + 96.68407113790394 ], "moduleForcesY": [ - -64.56785412261065, - -64.56785423072633, - -64.56785390750468, - -64.56785401562036 + -62.94139609260588, + -62.9413963157317, + -62.94139563208089, + -62.941395855206714 ], - "timestamp": 0.11806676416955612 + "timestamp": 0.11761945078114887 }, { - "x": 1.4765447536535539, - "y": 6.4106030861332375, - "heading": 3.141592654382145, - "angularVelocity": 5.7779888064285394e-9, - "velocityX": 1.1965577942454484, - "velocityY": -0.7905729933831371, + "x": 1.4774683902709602, + "y": 6.414007881814992, + "heading": 3.1415926552518396, + "angularVelocity": 1.2205862140824193e-8, + "velocityX": 1.2050774244361193, + "velocityY": -0.769454511214312, "moduleForcesX": [ - 102.28654562921923, - 102.28654560786362, - 102.28654568393445, - 102.28654566257883 + 102.43275036895024, + 102.43275032289199, + 102.43275048774566, + 102.4327504416874 ], "moduleForcesY": [ - -53.318653483475146, - -53.31865352424747, - -53.31865337837213, - -53.31865341914446 + -53.03603938436765, + -53.03603947289088, + -53.03603915462784, + -53.03603924315107 ], - "timestamp": 0.17710014625433418 + "timestamp": 0.1764291761717233 }, { - "x": 1.574035572309243, - "y": 6.354993169367381, - "heading": 3.1415926546713044, - "angularVelocity": 4.898239232168307e-9, - "velocityX": 1.6514523683512157, - "velocityY": -0.9420079758600776, + "x": 1.5748401096935096, + "y": 6.359448552089576, + "heading": 3.1415926558733664, + "angularVelocity": 1.0568433440115126e-8, + "velocityX": 1.6557077724113216, + "velocityY": -0.9277263133447715, "moduleForcesX": [ - 109.4226977827373, - 109.42269779178159, - 109.4226977467203, - 109.4226977557646 + 108.80919848005884, + 108.80919849872592, + 108.80919840952849, + 108.80919842819554 ], "moduleForcesY": [ - -36.42695526387283, - -36.42695523703391, - -36.42695537221109, - -36.42695534537217 + -38.21630738279977, + -38.2163073302424, + -38.216307583892046, + -38.21630753133467 ], - "timestamp": 0.23613352833911225 + "timestamp": 0.23523890156229774 }, { - "x": 1.6996897527512385, - "y": 6.296639809307858, - "heading": 3.1415926547484605, - "angularVelocity": 1.3069855500542915e-9, - "velocityX": 2.12852755516435, - "velocityY": -0.9884807205476072, + "x": 1.7000330137492494, + "y": 6.301073904680199, + "heading": 3.1415926560683887, + "angularVelocity": 3.3161627750963975e-9, + "velocityX": 2.1287789260074454, + "velocityY": -0.9926019382286351, "moduleForcesX": [ - 114.75813729356562, - 114.758137297369, - 114.75813724814749, - 114.75813725195087 + 114.22775516938997, + 114.22775518362513, + 114.22775504044942, + 114.22775505468458 ], "moduleForcesY": [ - -11.178794576619698, - -11.178794542775297, - -11.178795043548345, - -11.178795009703942 + -15.664867188867005, + -15.664867092783892, + -15.66486813051833, + -15.664868034435214 ], - "timestamp": 0.2951669104238903 + "timestamp": 0.29404862695287215 }, { - "x": 1.8530572488614867, - "y": 6.243977280961659, - "heading": 3.1415926544261383, - "angularVelocity": -5.4599966824676236e-9, - "velocityX": 2.59797915508206, - "velocityY": -0.89208048880833, + "x": 1.8529974827402018, + "y": 6.246814000732414, + "heading": 3.14159265541152, + "angularVelocity": -1.1169390588664581e-8, + "velocityX": 2.601006346740538, + "velocityY": -0.9226348803268013, "moduleForcesX": [ - 112.92432007869411, - 112.92432010689029, - 112.92432025584654, - 112.92432028404271 + 114.02402722958729, + 114.02402726270897, + 114.02402750725163, + 114.02402754037331 ], "moduleForcesY": [ - 23.188611712515762, - 23.188611580506432, - 23.18861084835494, - 23.18861071634561 + 16.894246009646203, + 16.89424580273802, + 16.894244132302816, + 16.894243925394655 ], - "timestamp": 0.35420029250866836 + "timestamp": 0.3528583523434466 }, { "x": 2.0305891418457023, "y": 6.206027030944824, "heading": 3.141592653589793, - "angularVelocity": -1.41673272774077e-8, - "velocityX": 3.0073136031620438, - "velocityY": -0.6428608471446738, + "angularVelocity": -3.0976627423086376e-8, + "velocityX": 3.01976684852814, + "velocityY": -0.6935412385742356, "moduleForcesX": [ - 98.46342857989701, - 98.46342884163893, - 98.46342915330816, - 98.46342941505006 + 101.11390491533385, + 101.11390541508874, + 101.1139061315249, + 101.11390663127975 ], "moduleForcesY": [ - 59.94858455591424, - 59.94858412862332, - 59.9485836119735, - 59.948583184682576 + 55.31694957591115, + 55.316948669637505, + 55.31694734752721, + 55.316946441253585 ], - "timestamp": 0.4132336745934464 + "timestamp": 0.41166807773402103 }, { - "x": 2.1412933116032296, - "y": 6.191150636092829, - "heading": 3.14159265292153, - "angularVelocity": -1.9255903720714354e-8, - "velocityX": 3.1899244141732543, - "velocityY": -0.4286611356844206, + "x": 2.144123859559337, + "y": 6.189128805794054, + "heading": 3.1415926520668265, + "angularVelocity": -4.304084953192806e-8, + "velocityX": 3.2086258231614173, + "velocityY": -0.47756389125936755, "moduleForcesX": [ - 74.72006152267744, - 74.720062180148, - 74.7200622715512, - 74.72006292902178 + 75.79181974401808, + 75.79182122905927, + 75.7918214779103, + 75.79182296295147 ], "moduleForcesY": [ - 87.64550023101428, - 87.64549967297322, - 87.64549958869247, - 87.6454990306514 + 86.67481554424154, + 86.67481425219059, + 86.67481401804265, + 86.67481272599169 ], - "timestamp": 0.4479379983904787 + "timestamp": 0.4470522963905208 }, { - "x": 2.2581660072287857, - "y": 6.183842078444728, - "heading": 3.1415926521241615, - "angularVelocity": -2.2976054030823205e-8, - "velocityX": 3.3676695823000085, - "velocityY": -0.21059501665681998, + "x": 2.2639843753712037, + "y": 6.18016177358942, + "heading": 3.141592650288091, + "angularVelocity": -5.026916236661669e-8, + "velocityX": 3.3874003825106165, + "velocityY": -0.2534189688256973, "moduleForcesX": [ - 72.7291547139968, - 72.7291552190221, - 72.72915526359016, - 72.72915576861547 + 71.74479952082707, + 71.74480050570537, + 71.74480056888426, + 71.74480155376254 ], "moduleForcesY": [ - 89.22754338297806, - 89.22754297343552, - 89.22754293154452, - 89.22754252200197 + 89.9525802508206, + 89.95257946983592, + 89.95257940726893, + 89.95257862628424 ], - "timestamp": 0.482642322187511 + "timestamp": 0.48243651504702056 }, { - "x": 2.3809494713599806, - "y": 6.184294815459166, - "heading": 3.141592651266816, - "angularVelocity": -2.470428325703209e-8, - "velocityX": 3.5379875098357156, - "velocityY": 0.013045550666419022, + "x": 2.389571390134287, + "y": 6.179555476543678, + "heading": 3.14159264851177, + "angularVelocity": -5.020095867030148e-8, + "velocityX": 3.549238036940923, + "velocityY": -0.01713467383944276, "moduleForcesX": [ - 69.69010228267334, - 69.69010253451678, - 69.69010253849493, - 69.69010279033836 + 64.94777713696435, + 64.94777712617515, + 64.94777712711469, + 64.9477771163255 ], "moduleForcesY": [ - 91.50847668582237, - 91.50847649519085, - 91.50847648894374, - 91.50847629831223 + 94.8242841393538, + 94.82428414669351, + 94.82428414619828, + 94.82428415353799 ], - "timestamp": 0.5173466459845434 + "timestamp": 0.5178207337035203 }, { - "x": 2.5092046684620093, - "y": 6.192809216565774, - "heading": 3.1415926504585743, - "angularVelocity": -2.3289384208573192e-8, - "velocityX": 3.6956546928309955, - "velocityY": 0.24534121904819894, + "x": 2.5197147134837774, + "y": 6.187978683471175, + "heading": 3.141592647155592, + "angularVelocity": -3.8327187932807255e-8, + "velocityX": 3.678004723317062, + "velocityY": 0.23804982128523042, "moduleForcesX": [ - 64.51371470905569, - 64.5137144790559, - 64.51371450113164, - 64.51371427113186 + 51.67592423146398, + 51.675921865334786, + 51.675922642465125, + 51.67592027633598 ], "moduleForcesY": [ - 95.04994076157364, - 95.04994091651318, - 95.04994090501094, - 95.04994105995048 + 102.40920514483192, + 102.40920632891202, + 102.40920597290442, + 102.40920715698445 ], - "timestamp": 0.5520509697815758 + "timestamp": 0.5532049523600201 }, { - "x": 2.642036196298328, - "y": 6.209897699263131, - "heading": 3.1415926498928193, - "angularVelocity": -1.6302148367032502e-8, - "velocityX": 3.827520991712202, - "velocityY": 0.4924021224934082, + "x": 2.651628898663585, + "y": 6.206318425861407, + "heading": 3.1415926469091398, + "angularVelocity": -6.965042680926931e-9, + "velocityX": 3.7280513796388868, + "velocityY": 0.5183028787005051, "moduleForcesX": [ - 53.95659882762613, - 53.956597460085185, - 53.95659785770279, - 53.95659649016185 + 20.084447875703354, + 20.084439343980897, + 20.084445853541716, + 20.084437321820065 ], "moduleForcesY": [ - 101.09152827192861, - 101.09152899469002, - 101.09152880759252, - 101.09152953035392 + 112.46957956001775, + 112.46958106687973, + 112.46958004666081, + 112.46958155352249 ], - "timestamp": 0.5867552935786081 + "timestamp": 0.5885891710165199 }, { - "x": 2.7769445076649037, - "y": 6.236418641581392, - "heading": 3.141592649972671, - "angularVelocity": 2.300909589137675e-9, - "velocityX": 3.8873632045270536, - "velocityY": 0.7641970629760313, + "x": 2.781959966689114, + "y": 6.234528802394688, + "heading": 3.1415926469445252, + "angularVelocity": 1.0000411747845848e-9, + "velocityX": 3.683310610607146, + "velocityY": 0.7972587103629419, "moduleForcesX": [ - 24.486033599317093, - 24.486028605162087, - 24.486032145214327, - 24.4860271510596 + -17.955112905071424, + -17.95511506648689, + -17.955112448576028, + -17.95511460999148 ], "moduleForcesY": [ - 111.21211617203402, - 111.21211725559323, - 111.2121165898599, - 111.21211767341899 + 111.94898532090939, + 111.94898498074893, + 111.94898544852427, + 111.94898510836381 ], - "timestamp": 0.6214596173756405 + "timestamp": 0.6239733896730196 }, { "x": 2.9098873519897452, "y": 6.272213459014893, "heading": 3.141592653589793, - "angularVelocity": 1.0422684584050202e-7, - "velocityX": 3.8307285600017855, - "velocityY": 1.0314224141881145, + "angularVelocity": 1.8780315353423049e-7, + "velocityX": 3.6153796850091515, + "velocityY": 1.065013106154394, "moduleForcesX": [ - -23.173558952779814, - -23.173585661195226, - -23.173551615441973, - -23.173578323848453 + -27.26164138908449, + -27.261687418435052, + -27.261626473603847, + -27.261672495979123 ], "moduleForcesY": [ - 109.34234948074224, - 109.34234401324865, - 109.34235225772302, - 109.34234679023307 + 107.4536903303801, + 107.45367915993492, + 107.45369679884978, + 107.45368563018049 ], - "timestamp": 0.6561639411726728 + "timestamp": 0.6593576083295194 }, { - "x": 3.1603986784572013, - "y": 6.3231515960882705, - "heading": 3.1416374237621625, - "angularVelocity": 0.0006952279229344114, - "velocityX": 3.8901451558950786, - "velocityY": 0.7910091331222168, + "x": 3.1493843891892954, + "y": 6.321687036535868, + "heading": 3.141664767074809, + "angularVelocity": 0.0011120470558586106, + "velocityX": 3.693234005337154, + "velocityY": 0.7629217505263336, "moduleForcesX": [ - 13.121852274764045, - 13.064389136188524, - 13.139894013731855, - 13.08221911280367 + 17.08299633181651, + 16.987922786906466, + 17.109096037610176, + 17.013600230983286 ], "moduleForcesY": [ - -53.0288598867414, - -53.03975477257369, - -52.988890196634124, - -52.99881173698235 + -66.1742223370393, + -66.19005542160966, + -66.11296782712692, + -66.1285159280569 ], - "timestamp": 0.7205603367898992 + "timestamp": 0.7242051205243732 }, { - "x": 3.391041812990585, - "y": 6.368906756131182, - "heading": 3.1971668651967757, - "angularVelocity": 0.8623066695328977, - "velocityX": 3.5816155907907, - "velocityY": 0.7105236186646428, + "x": 3.382246269373911, + "y": 6.367449891304312, + "heading": 3.1619423700697604, + "angularVelocity": 0.31269669889603824, + "velocityX": 3.59091462884362, + "velocityY": 0.7056994666338948, "moduleForcesX": [ - -44.11069948337996, - -77.93257191852247, - -61.65027573650249, - -88.44467603288614 + -13.03049078611549, + -29.89084865536969, + -14.597690630033014, + -32.10384734714733 ], "moduleForcesY": [ - -66.62250167635625, - -49.06442321531918, - 29.264082865339244, - 15.43066697140624 + -25.326666831227865, + -24.010835804743515, + -0.30058703362777717, + -0.48365569924820384 ], - "timestamp": 0.7849567324071255 + "timestamp": 0.7890526327192271 }, { - "x": 3.5887658336829418, - "y": 6.408161403232978, - "heading": 3.249240648554511, - "angularVelocity": 0.8086443792174824, - "velocityX": 3.070420615893362, - "velocityY": 0.609578326947492, + "x": 3.582643713722037, + "y": 6.407094531486908, + "heading": 3.21220711122596, + "angularVelocity": 0.775122120416338, + "velocityX": 3.0902873150472114, + "velocityY": 0.6113517518370116, "moduleForcesX": [ - -113.37930141282058, - -113.31038231556873, - -112.17591781085852, - -112.03346259287214 + -101.86125988188819, + -107.37956537588973, + -114.4003441550063, + -114.86482929848356 ], "moduleForcesY": [ - -18.9747004039528, - -19.252528450952163, - -25.139953355100378, - -25.671520826831017 + -52.801268558007735, + -40.97120389792949, + 7.940512733369161, + 3.1915648360079207 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.853900144914081 }, { - "x": 3.7535388104071985, - "y": 6.440888378700207, - "heading": 3.294315536071584, - "angularVelocity": 0.6999597894422492, - "velocityX": 2.5587298038180735, - "velocityY": 0.5082112927835114, + "x": 3.74957200139756, + "y": 6.440171200929541, + "heading": 3.2643499121170314, + "angularVelocity": 0.8040832890303158, + "velocityX": 2.5741664101767947, + "velocityY": 0.5100684409179003, "moduleForcesX": [ - -114.09797780307427, - -114.09477809264078, - -111.70139457807457, - -111.44226639158964 + -112.6621836921574, + -112.71395426887672, + -113.33454508007006, + -113.36635432566645 ], "moduleForcesY": [ - -16.046789303576624, - -15.913469790924887, - -28.264792093674224, - -29.185649391513163 + -23.975233317914196, + -23.760754374517084, + -20.560125698225118, + -20.41926066788013 ], - "timestamp": 0.9137495236415781 + "timestamp": 0.9187476571089348 }, { - "x": 3.8853571288837903, - "y": 6.46707806462633, - "heading": 3.3311943975575473, - "angularVelocity": 0.5726851810957213, - "velocityX": 2.046982866248028, - "velocityY": 0.40669490388552565, + "x": 3.8830382819529596, + "y": 6.4666455306855655, + "heading": 3.310848593184776, + "angularVelocity": 0.7170464909744748, + "velocityX": 2.0581557570683664, + "velocityY": 0.4082551336198438, "moduleForcesX": [ - -114.29110618647697, - -114.36206703200219, - -111.4800422611308, - -111.25270682753366 + -113.99095150053886, + -114.00144220452556, + -112.06402825139101, + -111.92404445290259 ], "moduleForcesY": [ - -15.260854841380633, - -14.588291440363218, - -29.45468827574504, - -30.238604229916476 + -17.29547040716993, + -17.146375445393463, + -27.107357918420117, + -27.630401033774774 ], - "timestamp": 0.9781459192588045 + "timestamp": 0.9835951693037887 }, { - "x": 3.9842204502938396, - "y": 6.486724686682261, - "heading": 3.3592810829924, - "angularVelocity": 0.436153066730639, - "velocityX": 1.5352306672208056, - "velocityY": 0.3050888464738175, + "x": 3.9830877412366763, + "y": 6.486507786121201, + "heading": 3.348167817033145, + "angularVelocity": 0.5754919901357481, + "velocityX": 1.5428419055319809, + "velocityY": 0.306291710558663, "moduleForcesX": [ - -114.37291094617866, - -114.4993666671828, - -111.34420578314202, - -111.17407977417216 + -114.41545555950157, + -114.52951979915328, + -111.3213417082967, + -111.10381175028604 ], "moduleForcesY": [ - -14.958857918149443, - -13.847592290940542, - -30.121770154710845, - -30.693310454835217 + -14.610037306398736, + -13.568499959103484, + -30.197132480138382, + -30.935423415459912 ], - "timestamp": 1.0425423148760309 + "timestamp": 1.0484426814986425 }, { - "x": 4.050129030114216, - "y": 6.4998244090967265, - "heading": 3.3782210905143044, - "angularVelocity": 0.29411595696263265, - "velocityX": 1.0234824354477678, - "velocityY": 0.20342322406257038, + "x": 4.049759249513341, + "y": 6.499752126190816, + "heading": 3.374257262379604, + "angularVelocity": 0.4023199111797186, + "velocityX": 1.0281274642630942, + "velocityY": 0.20423821394749517, "moduleForcesX": [ - -114.41751735086633, - -114.58169370325807, - -111.2551454634251, - -111.13270734016963 + -114.6105493516157, + -114.80042068735355, + -110.83549271399103, + -110.59863478702998 ], "moduleForcesY": [ - -14.806913472107988, - -13.3832091553941, - -30.541558492398913, - -30.942388952573637 + -13.232312421102897, + -11.333508890236551, + -32.03182827040654, + -32.79234017749459 ], - "timestamp": 1.1069387104932573 + "timestamp": 1.1132901936934962 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": 0.14840255835934255, - "velocityX": 0.5117392128533452, - "velocityY": 0.10172039612631649, + "angularVelocity": 0.20849555419784327, + "velocityX": 0.5138815704216189, + "velocityY": 0.10212743022896026, "moduleForcesX": [ - -114.44886671702382, - -114.63396863953965, - -111.19900874167607, - -111.1008014180239 + -114.724824422317, + -114.95598681748031, + -110.5061283467708, + -110.24775114592603 ], "moduleForcesY": [ - -14.690983770851986, - -13.086624955255907, - -30.80623117071299, - -31.123047275253498 + -12.365796823336515, + -9.84830935437339, + -33.2105013101652, + -34.015560796461884 ], - "timestamp": 1.1713351061104837 + "timestamp": 1.17813770588835 }, { "x": 4.083083190917968, "y": 6.506374835968018, "heading": 3.3877776803730213, - "angularVelocity": -3.105341690772561e-20, - "velocityX": -1.4124494217269478e-19, - "velocityY": 6.271250526786711e-19, + "angularVelocity": 4.829716369297222e-20, + "velocityX": -6.470993346981879e-19, + "velocityY": 3.317822838461728e-18, "moduleForcesX": [ - -114.47707589122757, - -114.66679939987269, - -111.1697067800063, - -111.065526656675 + -114.80814664741962, + -115.0502198256128, + -110.29067964070413, + -109.96652897988713 ], "moduleForcesY": [ - -14.56120001128053, - -12.910071305056444, - -30.955087024537587, - -31.296024837316292 + -11.686076549663122, + -8.850873959259824, + -33.960278185612424, + -34.95752048556571 ], - "timestamp": 1.2357315017277102 + "timestamp": 1.2429852180832037 }, { - "x": 4.14842233006486, - "y": 6.524834886416186, - "heading": 3.37925014191358, - "angularVelocity": -0.09327225382491805, - "velocityX": 0.7146644720743753, - "velocityY": 0.20191178488512537, + "x": 4.142327477746525, + "y": 6.523112878711347, + "heading": 3.379198429591823, + "angularVelocity": -0.09853884197083598, + "velocityX": 0.6804630807934998, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - 109.86538217101113, - 109.99598273674891, - 112.06663111203557, - 112.07438057028466 + 109.71928226568595, + 109.873434250603, + 112.16839647851953, + 112.1714231836321 ], "moduleForcesY": [ - 35.34716847772429, - 34.947790309423084, - 27.583683757251283, - 27.563877482273224 + 35.788801078214966, + 35.3232395177045, + 27.154535423780896, + 27.155842975944093 ], - "timestamp": 1.3271578167329041 + "timestamp": 1.3300498781665553 }, { - "x": 4.2790937475882345, - "y": 6.561752331915095, - "heading": 3.362280414592137, - "angularVelocity": -0.18561097338855564, - "velocityX": 1.42925390262039, - "velocityY": 0.4037945256440808, + "x": 4.260809898031729, + "y": 6.556586338886186, + "heading": 3.3621463296179686, + "angularVelocity": -0.1958555854640666, + "velocityX": 1.3608554857019415, + "velocityY": 0.38446667273258245, "moduleForcesX": [ - 109.85041536836742, - 110.00945422487305, - 112.03171567433651, - 112.06416998026944 + 109.70709462938454, + 109.89245539711602, + 112.12825792036838, + 112.15861944802991 ], "moduleForcesY": [ - 35.34795624249508, - 34.861185811795494, - 27.666287641216297, - 27.549045973918602 + 35.77869126173569, + 35.21826543338535, + 27.256949433753093, + 27.148840736400928 ], - "timestamp": 1.418584131738098 + "timestamp": 1.4171145382499069 }, { - "x": 4.4750859570933414, - "y": 6.617122892086999, - "heading": 3.337013895365562, - "angularVelocity": -0.27635937448796466, - "velocityX": 2.1437176976231873, - "velocityY": 0.605630448616008, + "x": 4.438520122396817, + "y": 6.606791013546223, + "heading": 3.336801806178079, + "angularVelocity": -0.2911000102179912, + "velocityX": 2.0411292503176015, + "velocityY": 0.576636658455609, "moduleForcesX": [ - 109.82922400996979, - 110.02889664351, - 111.97547028101597, - 112.04411023069696 + 109.69117162238662, + 109.92048751533748, + 112.06359871366229, + 112.13376889158263 ], "moduleForcesY": [ - 35.337678294007155, - 34.7258621306889, - 27.79538355148314, - 27.536465024579382 + 35.748453188226485, + 35.05402926782663, + 27.417403309854702, + 27.151367351771693 ], - "timestamp": 1.510010446743292 + "timestamp": 1.5041791983332584 }, { - "x": 4.7363756738996505, - "y": 6.690938650379312, - "heading": 3.3037368442226525, - "angularVelocity": -0.3639767296868421, - "velocityX": 2.8579268101472284, - "velocityY": 0.8073797821570229, + "x": 4.675437089885676, + "y": 6.6737192302015265, + "heading": 3.30352069263772, + "angularVelocity": -0.3822574338255884, + "velocityX": 2.7211611147628285, + "velocityY": 0.7687185201346813, "moduleForcesX": [ - 109.80240908300571, - 110.05001149729426, - 111.87607678799765, - 111.99097622261095 + 109.67704537348169, + 109.95591771814277, + 111.94887517290019, + 112.06937336812729 ], "moduleForcesY": [ - 35.26876905745412, - 34.51004456710348, - 27.999126804996703, - 27.563652818630974 + 35.633500837393704, + 34.78801753120004, + 27.676054770743455, + 27.21618805639235 ], - "timestamp": 1.601436761748486 + "timestamp": 1.59124385841661 }, { - "x": 5.062891365124138, - "y": 6.783177700282454, - "heading": 3.2632360654606747, - "angularVelocity": -0.44298820049432014, - "velocityX": 3.5713535124535785, - "velocityY": 1.0088895073360595, + "x": 4.971495381970558, + "y": 6.75734995310902, + "heading": 3.2632951732216937, + "angularVelocity": -0.4620189107442214, + "velocityX": 3.4004416005466473, + "velocityY": 0.9605587712331257, "moduleForcesX": [ - 109.76393441481733, - 110.04642262897143, - 111.62926676038799, - 111.79375874723351 + 109.68108201991289, + 109.98511497469858, + 111.66164166914167, + 111.8331752723527 ], "moduleForcesY": [ - 34.92992729055453, - 34.06895702532383, - 28.399362365285945, - 27.794484147904964 + 35.14208193111417, + 34.222358457681196, + 28.211854056678618, + 27.57984056765551 ], - "timestamp": 1.6928630767536799 + "timestamp": 1.6783085184999615 }, { - "x": 5.412207246810782, - "y": 6.881877306152213, - "heading": 3.263217434387312, - "angularVelocity": -0.00020378239417672257, - "velocityX": 3.8207367503196448, - "velocityY": 1.0795535821842126, + "x": 5.28750589994817, + "y": 6.846642506147694, + "heading": 3.263275324690442, + "angularVelocity": -0.0002279746022443869, + "velocityX": 3.629607210033074, + "velocityY": 1.0255889468033226, "moduleForcesX": [ - 48.347985418760395, - 33.09132615961223, - 44.47101375150101, - 29.02496895286671 + 47.983517882331824, + 31.02179127083995, + 43.820835110311776, + 26.680968018866302 ], "moduleForcesY": [ - -0.5892512769537052, - -3.0944630152590573, - 23.826002374584476, - 23.75945657977806 + -1.930997783243996, + -4.7563348860656625, + 24.644907375594624, + 24.467961055834824 ], - "timestamp": 1.7842893917588738 + "timestamp": 1.765373178583313 }, { - "x": 5.761523007820935, - "y": 6.980578519140531, - "heading": 3.263199195569124, - "angularVelocity": -0.00019949199731637702, - "velocityX": 3.8207354303879444, - "velocityY": 1.0795711604772795, + "x": 5.603516209092675, + "y": 6.935936936057916, + "heading": 3.2632558996184238, + "angularVelocity": -0.00022311086954457106, + "velocityX": 3.6296048114352195, + "velocityY": 1.025610504017777, "moduleForcesX": [ - -0.00011234051506570799, - -0.0002512833550827778, - -0.00015898547237657224, - -0.00029742975944157266 + -0.00024178774300411554, + -0.0005154689575938757, + -0.0002665381373160101, + -0.0005410448407523983 ], "moduleForcesY": [ - 0.0026141002465316916, - 0.002591336522088985, - 0.002857548674029559, - 0.0028579490702223286 + 0.003435084191229427, + 0.0033758874708626017, + 0.0036659957788613465, + 0.003586909286046499 ], - "timestamp": 1.8757157067640677 + "timestamp": 1.8524378386666647 }, { - "x": 6.110838775175139, - "y": 7.079279709676494, - "heading": 3.26318095679076, - "angularVelocity": -0.00019949156173420396, - "velocityX": 3.820735499777717, - "velocityY": 1.0795709148985817, + "x": 5.919526506202657, + "y": 7.025231408572308, + "heading": 3.2632364745964955, + "angularVelocity": -0.00022311029422913506, + "velocityX": 3.6296046732101, + "velocityY": 1.0256109933571818, "moduleForcesX": [ - 0.000010826836750374956, - 0.000010817181672845025, - 0.000010737845312528724, - 0.000010728190235499784 + -0.00002440175771108094, + -0.000024341211132133213, + -0.00002075585254078544, + -0.00002067892578492775 ], "moduleForcesY": [ - -0.00003811622956670729, - -0.00003818254367165634, - -0.000038103272794834774, - -0.00003816958689886402 + 0.00007797336491842891, + 0.00008082252173480401, + 0.0000786107894483785, + 0.00008183721701490111 ], - "timestamp": 1.9671420217692617 + "timestamp": 1.9395024987500162 }, { - "x": 6.460154925275615, - "y": 7.17797836765492, - "heading": 3.2631623325971826, - "angularVelocity": -0.000203707144671611, - "velocityX": 3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 6.235536823112694, + "y": 7.114525811000592, + "heading": 3.2632170496152866, + "angularVelocity": -0.00022310982654494968, + "velocityX": 3.6296049006279225, + "velocityY": 1.0256101883680162, "moduleForcesX": [ - 0.000582673079646135, - 0.0007246120932044848, - 0.0005764704290552151, - 0.0007171396015932555 + 0.000037175746031209955, + 0.00003675022279394528, + 0.00003744493411169005, + 0.00003699595688581122 ], "moduleForcesY": [ - -0.004164770580860626, - -0.004183092183695803, - -0.004410331364142836, - -0.004451422952545398 + -0.0001311900906737163, + -0.00013113310161074358, + -0.00013127818825782144, + -0.00013157168451710384 ], - "timestamp": 2.0585683367744556 + "timestamp": 2.026567158833368 }, { - "x": 6.7866810369969155, - "y": 7.270191836288494, - "heading": 3.2235227609386436, - "angularVelocity": -0.4335685153261054, - "velocityX": 3.571467489450394, - "velocityY": 1.0086097052947562, + "x": 6.551547647652277, + "y": 7.203817281479636, + "heading": 3.2631972085530423, + "angularVelocity": -0.00022788881533729912, + "velocityX": 3.6296107311169497, + "velocityY": 1.025576512830357, "moduleForcesX": [ - -47.82428831475678, - -32.71681627513296, - -44.74713985759357, - -29.578062869233722 + 0.0007539903240099345, + 0.0010130422482340737, + 0.0008876422954937467, + 0.001149122654947948 ], "moduleForcesY": [ - 0.711716625651444, - 2.410633102178794, - -23.286981568980845, - -23.904505269420362 + -0.005461742387567229, + -0.00532035763040487, + -0.0056743745997740415, + -0.005513368070625849 ], - "timestamp": 2.1499946517796493 + "timestamp": 2.1136318189167196 }, { - "x": 7.047980469601503, - "y": 7.343983789856553, - "heading": 3.1910396830919887, - "angularVelocity": -0.3552924324338102, - "velocityX": 2.858033079313581, - "velocityY": 0.80711941155965, + "x": 6.847617317047974, + "y": 7.2874193702981085, + "heading": 3.223811784245632, + "angularVelocity": -0.4523698165214764, + "velocityX": 3.400572277112838, + "velocityY": 0.9602298882053439, "moduleForcesX": [ - -109.72343096717086, - -110.11042093282525, - -111.57527328961994, - -111.82904603560887 + -47.41130841069759, + -30.62118618481451, + -44.110694296736526, + -27.280967448263624 ], "moduleForcesY": [ - -35.05919820242028, - -33.86318732230928, - -28.60858970792212, - -27.64968334765918 + 2.0544391321012583, + 4.023869539315489, + -24.077548013299843, + -24.63274704987536 ], - "timestamp": 2.241420966784843 + "timestamp": 2.2006964790000714 }, { - "x": 7.243980764451501, - "y": 7.399334406788997, - "heading": 3.16642038697477, - "angularVelocity": -0.2692801970178975, - "velocityX": 2.14380613326548, - "velocityY": 0.6054123140509308, + "x": 7.084544828508775, + "y": 7.354320907313611, + "heading": 3.1912974750964462, + "angularVelocity": -0.373450136003033, + "velocityX": 2.721282219834979, + "velocityY": 0.7684120853564979, "moduleForcesX": [ - -109.71676289801981, - -110.18532231271764, - -111.76405509082994, - -112.06441279220563 + -109.63993232178557, + -110.05417979801784, + -111.60403176355548, + -111.86911447326634 ], "moduleForcesY": [ - -35.536614610144824, - -34.07720649246483, - -28.440654067765472, - -27.260877933728896 + -35.27274549289263, + -34.00135979147859, + -28.436496439475064, + -27.430888103294052 ], - "timestamp": 2.3328472817900368 + "timestamp": 2.287761139083423 }, { - "x": 7.374657916862249, - "y": 7.436237482881837, - "heading": 3.1498977666289023, - "angularVelocity": -0.1807206201510903, - "velocityX": 1.4293166294991295, - "velocityY": 0.40363735638631854, + "x": 7.262263839170718, + "y": 7.404503175997865, + "heading": 3.1665778040536177, + "angularVelocity": -0.28392313275171893, + "velocityX": 2.0412301672320603, + "velocityY": 0.5763793097705945, "moduleForcesX": [ - -109.70681368656746, - -110.21880379377983, - -111.81972024066972, - -112.148335627715 + -109.58272113098357, + -110.10406488426497, + -111.8285077107539, + -112.14908861391909 ], "moduleForcesY": [ - -35.71803758428605, - -34.11985964537683, - -28.413265173608806, - -27.106350443857995 + -35.92513988883521, + -34.31811935636691, + -28.155739191192055, + -26.882739105963577 ], - "timestamp": 2.4242735967952305 + "timestamp": 2.374825799166775 + }, + { + "x": 7.380752503700571, + "y": 7.437960457197711, + "heading": 3.14995739111321, + "angularVelocity": -0.19089735059547805, + "velocityX": 1.3609272053255352, + "velocityY": 0.3842808456130792, + "moduleForcesX": [ + -109.55438775829161, + -110.13043304849128, + -111.89507958039748, + -112.24817460065188 + ], + "moduleForcesY": [ + -36.16792173997458, + -34.39052165205662, + -28.094624382025973, + -26.671524840113754 + ], + "timestamp": 2.4618904592501267 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": -0.09083941574848778, - "velocityX": 0.7146966727690924, - "velocityY": 0.20182916341250373, + "angularVelocity": -0.09607500351358098, + "velocityX": 0.6804999438659524, + "velocityY": 0.19215055040122933, "moduleForcesX": [ - -109.70058243131004, - -110.23546235943999, - -111.8476455542373, - -112.19103002395252 + -109.53867302844934, + -110.14366836151459, + -111.92834686125505, + -112.2984794768254 ], "moduleForcesY": [ - -35.81216376796426, - -34.141192280175495, - -28.399273440528713, - -27.02553158829393 + -36.293251007942786, + -34.426167314961475, + -28.06417924516179, + -26.561761552148816 ], - "timestamp": 2.515699911800424 + "timestamp": 2.5489551193334785 }, { "x": 7.44, "y": 7.454689979553223, "heading": 3.141592653589793, - "angularVelocity": 5.3474824222167004e-21, - "velocityX": -1.1027416520574535e-21, - "velocityY": 1.1229424922134134e-21, + "angularVelocity": 1.0070419894358123e-20, + "velocityX": -3.7291483580721005e-21, + "velocityY": 1.6507740380137376e-21, + "moduleForcesX": [ + -109.5307744441316, + -110.14478533871649, + -111.95408720798879, + -112.3269385706006 + ], + "moduleForcesY": [ + -36.36354115443014, + -34.46921393384205, + -28.022875739604935, + -26.502942730924968 + ], + "timestamp": 2.6360197794168303 + }, + { + "x": 7.374537199809908, + "y": 7.420246784454786, + "heading": 3.141592653589793, + "angularVelocity": 1.9044065108967837e-16, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - -109.69825354519149, - -110.23935489778839, - -111.8696576656152, - -112.21511593235195 + -102.137006668336, + -102.13700666833601, + -102.13700666833601, + -102.13700666833601 ], "moduleForcesY": [ - -35.86413648487148, - -34.173575075339286, - -28.370205373579967, - -26.98327252919034 + -53.739296779734275, + -53.73929677973427, + -53.73929677973426, + -53.739296779734254 ], - "timestamp": 2.607126226805618 + "timestamp": 2.731420771168844 }, { - "x": 7.368314145951493, - "y": 7.416972530106804, + "x": 7.243622128572477, + "y": 7.351365934157169, "heading": 3.141592653589793, - "angularVelocity": -5.95153116721842e-17, - "velocityX": -0.7180685701633659, - "velocityY": -0.3778111505217192, + "angularVelocity": 5.1129474419478e-16, + "velocityX": -1.3722611142002967, + "velocityY": -0.7220139857315833, "moduleForcesX": [ - -102.13925806744793, - -102.13925806744793, - -102.13925806744794, - -102.13925806744794 + -102.12057878684486, + -102.12057878684486, + -102.12057878684486, + -102.12057878684487 ], "moduleForcesY": [ - -53.740481351409, - -53.74048135140901, - -53.74048135140901, - -53.74048135140901 + -53.73065326424746, + -53.73065326424745, + -53.73065326424744, + -53.73065326424743 ], - "timestamp": 2.7069577150884125 + "timestamp": 2.8268217629208574 }, { - "x": 7.224953430741302, - "y": 7.341543415111761, + "x": 7.047275775912886, + "y": 7.2480584723333115, "heading": 3.141592653589793, - "angularVelocity": -1.0650520788048443e-16, - "velocityX": -1.4360270259027914, - "velocityY": -0.7555643644355341, + "angularVelocity": 8.440134370851153e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.0828761832203582, "moduleForcesX": [ - -102.12359521012328, - -102.12359521012328, - -102.12359521012328, - -102.12359521012328 + -102.08783014974713, + -102.08783014974715, + -102.08783014974715, + -102.08783014974716 ], "moduleForcesY": [ - -53.73224035271867, - -53.73224035271867, - -53.73224035271868, - -53.73224035271868 + -53.713422597464344, + -53.713422597464344, + -53.71342259746432, + -53.71342259746432 ], - "timestamp": 2.806789203371207 + "timestamp": 2.922222754672871 }, { - "x": 7.009939750663415, - "y": 7.228414155284034, + "x": 6.785560544972791, + "y": 7.11035723234165, "heading": 3.141592653589793, - "angularVelocity": -2.561037852315152e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246718, + "angularVelocity": 1.170740883731664e-15, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041789, "moduleForcesX": [ - -102.09239698765671, - -102.09239698765671, - -102.09239698765671, - -102.09239698765671 + -101.99046691326758, + -101.9904669132676, + -101.9904669132676, + -101.9904669132676 ], "moduleForcesY": [ - -53.715825435238514, - -53.715825435238514, - -53.715825435238514, - -53.715825435238514 + -53.66219501569665, + -53.66219501569664, + -53.662195015696625, + -53.662195015696625 ], - "timestamp": 2.906620691654002 + "timestamp": 3.0176237464248845 }, { - "x": 6.72333806652252, - "y": 7.077618929694229, + "x": 6.467102087337348, + "y": 6.942800593223961, "heading": 3.141592653589793, - "angularVelocity": -9.622527173380371e-17, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 7.597859985024076e-17, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - -101.99983969748536, - -101.99983969748537, - -101.99983969748536, - -101.99983969748537 + -88.53246892183462, + -88.5324689218346, + -88.53246892183459, + -88.53246892183458 ], "moduleForcesY": [ - -53.66712649791996, - -53.66712649791995, - -53.66712649791995, - -53.66712649791995 + -46.58128113625254, + -46.58128113625257, + -46.58128113625262, + -46.58128113625264 ], - "timestamp": 3.0064521799367965 + "timestamp": 3.113024738176898 }, { - "x": 6.372544082043546, - "y": 6.893048981392569, + "x": 6.1486418905328355, + "y": 6.7752430390439855, "heading": 3.141592653589793, - "angularVelocity": -6.334843659951388e-17, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 1.9368908161772864e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - -91.46231173778874, - -91.46231173778875, - -91.46231173778872, - -91.46231173778875 + -0.0027135032765820944, + -0.002713503276651509, + -0.002713503276474282, + -0.002713503276543846 ], "moduleForcesY": [ - -48.12281537286679, - -48.12281537286681, - -48.12281537286679, - -48.1228153728668 + -0.0014277073770261604, + -0.0014277073770890942, + -0.0014277073770684085, + -0.0014277073771313536 ], - "timestamp": 3.106283668219591 + "timestamp": 3.2084257299289116 }, { - "x": 6.021747838682743, - "y": 6.70847784458221, + "x": 5.830181693715209, + "y": 6.60768548485711, "heading": 3.141592653589793, - "angularVelocity": 2.581973087916566e-16, - "velocityX": -3.513883739437953, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.279411505105019e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - -0.0032184943191916355, - -0.003218494319210384, - -0.00321849431915981, - -0.0032184943191784733 + -2.0460998121842195e-8, + -2.0460997415959662e-8, + -2.0460987448503346e-8, + -2.0460986753393795e-8 ], "moduleForcesY": [ - -0.001693407972736863, - -0.0016934079727192893, - -0.0016934079727259645, - -0.0016934079727083226 + -1.076552819064326e-8, + -1.0765525074180139e-8, + -1.0765532984669192e-8, + -1.0765529879793362e-8 ], - "timestamp": 3.2061151565023858 + "timestamp": 3.303826721680925 }, { - "x": 5.670951595306396, - "y": 6.523906707763672, + "x": 5.511721496897583, + "y": 6.440127930670235, "heading": 3.141592653589793, - "angularVelocity": -1.7815140363007445e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720746, + "angularVelocity": -1.3368406118547953e-16, + "velocityX": -3.338122497147994, + "velocityY": -1.7563502339936574, "moduleForcesX": [ - -2.214847536392143e-8, - -2.2148460240928627e-8, - -2.2148453985353328e-8, - -2.214843887146829e-8 + -1.9163549088742217e-13, + -1.8137969156708226e-13, + -1.8770365584259915e-13, + -1.7745311999841893e-13 ], "moduleForcesY": [ - -1.1653376630868896e-8, - -1.1653364415082627e-8, - -1.1653399114124992e-8, - -1.1653386903612894e-8 + -1.1004122267769845e-13, + -1.0700562473759133e-13, + -1.2357784150329262e-13, + -1.2054149174476363e-13 ], - "timestamp": 3.3059466447851804 + "timestamp": 3.3992277134329387 }, { - "x": 5.320155351930048, - "y": 6.339335570945134, + "x": 5.193261300079957, + "y": 6.272570376483359, "heading": 3.141592653589793, - "angularVelocity": 2.4279685029555556e-16, - "velocityX": -3.513883739593663, - "velocityY": -1.8488268580720748, + "angularVelocity": 1.4138979074556637e-16, + "velocityX": -3.338122497147993, + "velocityY": -1.7563502339936568, "moduleForcesX": [ - -1.4908979526305142e-14, - -2.99029582883606e-14, - -5.16443761137644e-15, - -2.0160903125677875e-14 + 1.8774692991705095e-13, + 1.7710016242766854e-13, + 1.898187278749893e-13, + 1.7917566427067963e-13 ], "moduleForcesY": [ - -3.384941535047312e-14, - -2.5668639996370796e-14, - -1.2459999136873356e-14, - -4.2850979436921125e-15 + 1.0215120237248181e-13, + 1.0368953333983565e-13, + 1.1648186637867293e-13, + 1.1802465134529584e-13 ], - "timestamp": 3.405778133067975 + "timestamp": 3.4946287051849523 }, { - "x": 4.969359108569246, - "y": 6.1547644341347745, + "x": 4.874801103275445, + "y": 6.105012822303384, "heading": 3.141592653589793, - "angularVelocity": 1.199756216245544e-16, - "velocityX": -3.5138837394379534, - "velocityY": -1.8488268579901481, + "angularVelocity": 1.5438965808528657e-16, + "velocityX": -3.33812249701053, + "velocityY": -1.7563502339213308, "moduleForcesX": [ - 2.214841585830023e-8, - 2.2148419462891282e-8, - 2.2148422317548562e-8, - 2.2148425924364392e-8 + 2.0460996179979618e-8, + 2.0460996946386003e-8, + 2.0460995079952845e-8, + 2.0460995868086364e-8 ], "moduleForcesY": [ - 1.165340603921551e-8, - 1.165340847836435e-8, - 1.165339922976741e-8, - 1.165340166101585e-8 + 1.07655285883098e-8, + 1.076553064507586e-8, + 1.0765530220929285e-8, + 1.0765532275345751e-8 ], - "timestamp": 3.5056096213507697 + "timestamp": 3.590029696936966 }, { - "x": 4.618565124090272, - "y": 5.970194485833114, + "x": 4.556342645640002, + "y": 5.937456183185694, "heading": 3.141592653589793, - "angularVelocity": 1.3718004475518102e-16, - "velocityX": -3.513861112490611, - "velocityY": -1.8488149528415823, + "angularVelocity": 2.7082626511550756e-16, + "velocityX": -3.338104266916302, + "velocityY": -1.7563406421731875, "moduleForcesX": [ - 0.003218494319189819, - 0.003218494319178036, - 0.0032184943192075832, - 0.003218494319195734 + 0.0027135032765694357, + 0.002713503276628145, + 0.0027135032764733255, + 0.002713503276531934 ], "moduleForcesY": [ - 0.0016934079727341249, - 0.0016934079727223734, - 0.00169340797272666, - 0.0016934079727148898 + 0.0014277073770093693, + 0.001427707377080961, + 0.0014277073770625364, + 0.0014277073771340647 ], - "timestamp": 3.6054411096335643 + "timestamp": 3.6854306886889794 }, { - "x": 4.331963439949377, - "y": 5.819399260243309, + "x": 4.294627414699907, + "y": 5.799754943194032, "heading": 3.141592653589793, - "angularVelocity": 2.659867947557739e-16, - "velocityX": -2.8708545677395167, - "velocityY": -1.5104976213781864, + "angularVelocity": 2.4292126054795095e-16, + "velocityX": -2.743317717497124, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 91.46231173778882, - 91.46231173778881, - 91.46231173778884, - 91.46231173778882 + 88.53246892183459, + 88.53246892183459, + 88.53246892183459, + 88.5324689218346 ], "moduleForcesY": [ - 48.12281537286683, - 48.122815372866796, - 48.12281537286684, - 48.1228153728668 + 46.58128113625262, + 46.581281136252606, + 46.58128113625261, + 46.58128113625261 ], - "timestamp": 3.705272597916359 + "timestamp": 3.780831680440993 }, { - "x": 4.11694975987149, - "y": 5.706270000415583, + "x": 4.098281062040315, + "y": 5.696447481370175, "heading": 3.141592653589793, - "angularVelocity": 2.806875129049736e-16, - "velocityX": -2.153766149101311, - "velocityY": -1.1332021767246716, + "angularVelocity": 2.1490427279263705e-16, + "velocityX": -2.058116472939579, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 101.99983969748536, - 101.99983969748536, - 101.99983969748536, - 101.99983969748536 + 101.9904669132676, + 101.9904669132676, + 101.9904669132676, + 101.9904669132676 ], "moduleForcesY": [ - 53.667126497919966, - 53.667126497919966, - 53.66712649791996, - 53.66712649791996 + 53.66219501569664, + 53.66219501569664, + 53.66219501569663, + 53.66219501569663 ], - "timestamp": 3.8051040861991536 + "timestamp": 3.8762326721930065 }, { - "x": 3.973589044661299, - "y": 5.63084088542054, + "x": 3.967365990802884, + "y": 5.627566631072558, "heading": 3.141592653589793, - "angularVelocity": 1.561047756279207e-16, - "velocityX": -1.4360270259027916, - "velocityY": -0.7555643644355341, + "angularVelocity": 1.897239423212067e-16, + "velocityX": -1.372261114200297, + "velocityY": -0.722013985731583, "moduleForcesX": [ - 102.09239698765671, - 102.09239698765671, - 102.09239698765673, - 102.09239698765673 + 102.08783014974715, + 102.08783014974715, + 102.08783014974715, + 102.08783014974713 ], "moduleForcesY": [ - 53.715825435238514, - 53.71582543523851, - 53.7158254352385, - 53.71582543523849 + 53.71342259746434, + 53.71342259746434, + 53.713422597464344, + 53.71342259746434 ], - "timestamp": 3.9049355744819483 + "timestamp": 3.97163366394502 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -6.104345816877544e-18, - "velocityX": -0.718068570163366, - "velocityY": -0.37781115052171915, + "angularVelocity": 7.022330291742699e-17, + "velocityX": -0.6861857407128127, + "velocityY": -0.3610360276753584, "moduleForcesX": [ - 102.12359521012327, - 102.12359521012327, - 102.1235952101233, - 102.12359521012328 + 102.12057878684486, + 102.12057878684486, + 102.12057878684486, + 102.12057878684487 ], "moduleForcesY": [ - 53.732240352718684, - 53.732240352718684, - 53.73224035271866, - 53.732240352718655 + 53.730653264247444, + 53.730653264247444, + 53.730653264247444, + 53.730653264247444 ], - "timestamp": 4.004767062764743 + "timestamp": 4.067034655697033 }, { "x": 3.901903190612792, "y": 5.593123435974121, "heading": 3.141592653589793, - "angularVelocity": -5.9255248403380995e-19, - "velocityX": -4.845229805742944e-18, - "velocityY": -3.784645335362408e-18, + "angularVelocity": 1.9672491241209423e-19, + "velocityX": -4.977758209661926e-18, + "velocityY": 1.6190388601168746e-18, "moduleForcesX": [ - 102.13925806744794, - 102.13925806744793, - 102.13925806744794, - 102.13925806744794 + 102.13700666833601, + 102.13700666833601, + 102.137006668336, + 102.13700666833601 ], "moduleForcesY": [ - 53.74048135140901, - 53.74048135140901, - 53.740481351408995, - 53.740481351408995 + 53.73929677973426, + 53.73929677973426, + 53.73929677973426, + 53.73929677973426 ], - "timestamp": 4.104598551047538 + "timestamp": 4.162435647449047 }, { - "x": 3.9043982564040665, - "y": 5.59148869514806, - "heading": 3.1820618629141237, - "angularVelocity": 1.1653411306828567, - "velocityX": 0.07184728436450499, - "velocityY": -0.047073583952375805, + "x": 3.9042836995770926, + "y": 5.591477621529516, + "heading": 3.1821270543838818, + "angularVelocity": 1.1690740956944607, + "velocityX": 0.06865751831066487, + "velocityY": -0.04746780502029206, "moduleForcesX": [ - 74.23634164667679, - -6.715898232786087, - 111.49692422807223, - -61.502441740180224 + 73.9038184921626, + -8.096498399638158, + 111.13955678681799, + -64.4706603229986 ], "moduleForcesY": [ - -88.32054795571888, - -115.15629744618326, - 29.45095987899212, - 97.03134384991 + -88.59920326747556, + -115.06817413543592, + 30.77187267475827, + 95.13273018744661 ], - "timestamp": 4.139325901055871 + "timestamp": 4.19710787305337 }, { - "x": 3.909010846411328, - "y": 5.587957161161053, - "heading": 3.2630170824362428, - "angularVelocity": 2.3311660550745286, - "velocityX": 0.13282297688004016, - "velocityY": -0.10169316075544446, + "x": 3.9087131487207896, + "y": 5.587940767261187, + "heading": 3.2631546643514007, + "angularVelocity": 2.3369601620674736, + "velocityX": 0.12775208589853315, + "velocityY": -0.10200828492209969, "moduleForcesX": [ - 78.30596687432912, - -0.991357515334819, - 109.52641997223529, - -87.10790717980932 + 78.0409085702238, + -2.2065963343012998, + 109.08213048052961, + -88.10645679122378 ], "moduleForcesY": [ - -84.70847062161643, - -115.32872392835634, - 35.97383073298106, - 74.72643789734872 + -84.95264569095156, + -115.31231038297793, + 37.29784851028354, + 73.61772559552828 ], - "timestamp": 4.174053251064205 + "timestamp": 4.231780098657693 }, { - "x": 3.9154905781921414, - "y": 5.581995423382691, - "heading": 3.3836478937253207, - "angularVelocity": 3.473654375013657, - "velocityX": 0.1865887198205051, - "velocityY": -0.17167269535196633, + "x": 3.914971012728261, + "y": 5.582022220388997, + "heading": 3.3839066101537916, + "angularVelocity": 3.482670745754918, + "velocityX": 0.18048636620233685, + "velocityY": -0.170699941207466, "moduleForcesX": [ - 84.04565171589002, - 7.591385688892432, - 105.82402794571937, - -109.52068801280974 + 83.86452574104814, + 6.586730417859739, + 105.23692315427803, + -109.29775219994406 ], "moduleForcesY": [ - -78.97617075986777, - -115.05554501752253, - 45.56575373192798, - 34.00596685580122 + -79.167691364004, + -115.11732618046985, + 46.90225658105789, + 34.8506188459714 ], - "timestamp": 4.208780601072538 + "timestamp": 4.2664523242620165 }, { - "x": 3.923986661046908, - "y": 5.573089966082192, - "heading": 3.542510028867439, - "angularVelocity": 4.574553920872062, - "velocityX": 0.24465105609059282, - "velocityY": -0.25643929923708686, + "x": 3.9232012050087475, + "y": 5.573228753463622, + "heading": 3.543000568385735, + "angularVelocity": 4.588513008870894, + "velocityX": 0.23737132927112375, + "velocityY": -0.25361703127241003, "moduleForcesX": [ - 90.96637263149874, - 18.72557620908624, - 99.23256696755529, - -113.95654026368632 + 90.87202731423523, + 17.998694570452482, + 98.47791423253557, + -114.15847162608061 ], "moduleForcesY": [ - -70.81659924554174, - -113.7295099024976, - 58.29590985260526, - -12.395836704597288 + -70.93479429110407, + -113.84541579014095, + 59.553876514316784, + -10.610218755963183 ], - "timestamp": 4.243507951080872 + "timestamp": 4.30112454986634 }, { - "x": 3.9349178697914593, - "y": 5.561092759135591, - "heading": 3.7384895958061533, - "angularVelocity": 5.643378112400891, - "velocityX": 0.3147723261904048, - "velocityY": -0.3454685411850211, + "x": 3.93382849843504, + "y": 5.56138315819023, + "heading": 3.7392339798870817, + "angularVelocity": 5.659671627104292, + "velocityX": 0.3065073914657294, + "velocityY": -0.34164507951039014, "moduleForcesX": [ - 98.43585145612785, - 32.047708016397955, - 87.47440914610054, - -103.26614786570082 + 98.39402131426766, + 31.702182349064397, + 86.80709567335347, + -103.64312194333186 ], "moduleForcesY": [ - -59.81255295495207, - -110.62167229916591, - 74.32567001719525, - -49.50954102298324 + -59.87033716863679, + -110.71556436707851, + 75.08087531890547, + -48.70440721838266 ], - "timestamp": 4.278235301089206 + "timestamp": 4.335796775470663 }, { - "x": 3.9486707811612667, - "y": 5.546283772243214, - "heading": 3.971261588079422, - "angularVelocity": 6.702843499933376, - "velocityX": 0.3960253623298846, - "velocityY": -0.42643584635232096, + "x": 3.947348256782863, + "y": 5.546665747496577, + "heading": 3.9717655770283784, + "angularVelocity": 6.70656680061238, + "velocityX": 0.38993050235969523, + "velocityY": -0.42447262721486584, "moduleForcesX": [ - 105.6108108605353, - 47.31647496654562, - 65.36610720865541, - -85.39422216682203 + 105.47445484854477, + 47.63333934755148, + 67.38844623510965, + -83.8307139515503 ], "moduleForcesY": [ - -45.20977101765006, - -104.70081415221114, - 93.04952199937759, - -75.57076012474553 + -45.449760164769756, + -104.52423173953122, + 91.45753443308791, + -77.17340463952392 ], - "timestamp": 4.312962651097539 + "timestamp": 4.370469001074986 }, { - "x": 3.967957360606314, - "y": 5.534219720600956, - "heading": 4.2154072006344245, - "angularVelocity": 7.030355397011703, - "velocityX": 0.5553714706252912, - "velocityY": -0.34739338415867244, + "x": 3.967122969912724, + "y": 5.534422452953119, + "heading": 4.200687458299229, + "angularVelocity": 6.602457075680393, + "velocityX": 0.570332962052375, + "velocityY": -0.3531153345383026, "moduleForcesX": [ - 84.82446387399186, - 82.71377263232796, - 50.73806390817151, - 42.353537925270714 + 67.8872625454126, + 69.11423919448929, + 78.96383219942022, + 79.57383821480528 ], "moduleForcesY": [ - 29.67111027951777, - -3.37922189208429, - 65.43811151147439, - 37.553509838998245 + 30.388799241715233, + 41.078313608032914, + 17.15064921936294, + 28.28128265964005 ], - "timestamp": 4.347690001105873 + "timestamp": 4.4051412266793095 }, { - "x": 3.98001343373366, - "y": 5.526755385653602, - "heading": 4.472103074519516, - "angularVelocity": 7.391749552542666, - "velocityX": 0.3471636368583629, - "velocityY": -0.21494110393000895, + "x": 3.9797668128508845, + "y": 5.526847142047009, + "heading": 4.44206622644219, + "angularVelocity": 6.961732739558081, + "velocityX": 0.3646677626769925, + "velocityY": -0.21848354912542167, "moduleForcesX": [ - -37.456143843096456, - -105.72590475430376, - -87.22921676430555, - -110.13783644093463 + -36.646290938348635, + -105.1718880571878, + -85.71976737512396, + -109.38718684458635 ], "moduleForcesY": [ - 104.18797300994801, - 16.76204700591698, - 71.78839869306297, - 23.903310122835695 + 103.98341170708312, + 17.180702657672832, + 73.23873697676966, + 26.153822189075125 ], - "timestamp": 4.382417351114206 + "timestamp": 4.439813452283633 }, { - "x": 3.9851949998823097, - "y": 5.5258948814499, - "heading": 4.723311951922738, - "angularVelocity": 7.233747387662465, - "velocityX": 0.1492070701451729, - "velocityY": -0.024778861718348262, + "x": 3.9857338632021, + "y": 5.525513029563465, + "heading": 4.692744644264185, + "angularVelocity": 7.229948855395621, + "velocityX": 0.1720988557040211, + "velocityY": -0.03847784387335769, "moduleForcesX": [ - -98.91322895270021, - -85.10006434406276, - -79.17104780948137, - -60.59757319759481 + -41.96175012880925, + -79.29225853021597, + -86.89556166997009, + -107.32093626148128 ], "moduleForcesY": [ - 56.86109648752441, - 76.2892425523883, - 81.34314654485036, - 96.53986801350179 + 105.27165483765185, + 78.39773568551979, + 73.78278818931463, + 37.437021821922585 ], - "timestamp": 4.41714470112254 + "timestamp": 4.474485677887956 }, { - "x": 3.9863068884222828, - "y": 5.531340138988146, - "heading": 4.950666542673113, - "angularVelocity": 6.546845373914685, - "velocityX": 0.032017661575285794, - "velocityY": 0.1568002608013148, + "x": 3.9867659107369566, + "y": 5.530831985759421, + "heading": 4.92495896919637, + "angularVelocity": 6.697416184994794, + "velocityX": 0.029765828898150305, + "velocityY": 0.15340682933527577, "moduleForcesX": [ - -114.77127776967934, - -93.64139046455962, - 28.508230169348188, - -11.773017615919526 + -113.32252584700664, + -91.37221926721877, + -9.199917255344806, + -19.278349706082395 ], "moduleForcesY": [ - 5.619126084560698, - 66.9044442013547, - 110.10636482779911, - 114.3646878138949 + 18.159782597252036, + 69.79683643177074, + 113.1944780338604, + 113.19848312438968 ], - "timestamp": 4.451872051130874 + "timestamp": 4.509157903492279 }, { - "x": 3.9839495670536045, - "y": 5.542047325833863, - "heading": 5.14709915808565, - "angularVelocity": 5.656423981829894, - "velocityX": -0.06788083076055375, - "velocityY": 0.3083214481712091, + "x": 3.984220735671827, + "y": 5.54162936928793, + "heading": 5.12759603796946, + "angularVelocity": 5.844362893964999, + "velocityX": -0.07340674043179839, + "velocityY": 0.3114130500801563, "moduleForcesX": [ - -113.64668162060943, - -100.73960236681702, - 63.56308029673943, - -12.572866576733011 + -114.32669032012072, + -99.46991245107587, + 57.66223639535799, + -12.88514577898863 ], "moduleForcesY": [ - -18.155758880056467, - 55.952500248794294, - 95.52739610486213, - 114.50709600750847 + -12.760758459447903, + 58.11499274397251, + 99.06285660736755, + 114.43208308109199 ], - "timestamp": 4.486599401139207 + "timestamp": 4.5438301290966026 }, { - "x": 3.9779698922760582, - "y": 5.557428390445448, - "heading": 5.310648551650109, - "angularVelocity": 4.7095270305742165, - "velocityX": -0.17218920465026455, - "velocityY": 0.442909251869058, + "x": 3.9780819659675903, + "y": 5.557168661278035, + "heading": 5.297692621023495, + "angularVelocity": 4.905845531670375, + "velocityX": -0.17705150440275155, + "velocityY": 0.4481769404548229, "moduleForcesX": [ - -109.6422125783005, - -105.74765097197177, - 63.85460645823769, - -19.07370797889233 + -110.32756561762857, + -105.08894599974298, + 63.750085678570414, + -18.126645587310843 ], "moduleForcesY": [ - -35.22297007232857, - 45.94386760077495, - 95.7180784273194, - 113.69565987258625 + -32.91770130594482, + 47.39353190748665, + 95.7403714098111, + 113.83333151918829 ], - "timestamp": 4.521326751147541 + "timestamp": 4.578502354700926 }, { - "x": 3.968175115116889, - "y": 5.577061809180295, - "heading": 5.440438778329013, - "angularVelocity": 3.7374065872506352, - "velocityX": -0.2820479292781997, - "velocityY": 0.5653589672156164, + "x": 3.9681916256457823, + "y": 5.57695732044685, + "heading": 5.434040994519674, + "angularVelocity": 3.9324955672640276, + "velocityX": -0.28525253713666865, + "velocityY": 0.5707351871391523, "moduleForcesX": [ - -104.57283217896068, - -109.05462491040034, - 59.524853150361466, - -25.584631264202123 + -104.68508048822177, + -108.78605491561527, + 60.738952885980254, + -24.525066052248846 ], "moduleForcesY": [ - -48.32920001759757, - 37.52781331033054, - 98.62582006055165, - 112.45689047019665 + -48.04212290386368, + 38.27226802046422, + 97.86364839716221, + 112.68375035926049 ], - "timestamp": 4.556054101155874 + "timestamp": 4.613174580305249 }, { "x": 3.9544325256347648, "y": 5.600627422332764, "heading": 5.535936987290347, - "angularVelocity": 2.749942305946683, - "velocityX": -0.3957281358590918, - "velocityY": 0.6785894445390553, + "angularVelocity": 2.9388362297102493, + "velocityX": -0.39683348187783213, + "velocityY": 0.6826819297969259, "moduleForcesX": [ - -99.4686663112381, - -111.09605990584434, - 55.322267493338416, - -30.695272549126784 + -98.70912927254462, + -111.07132972844673, + 56.829637400778395, + -29.843471189118105 ], "moduleForcesY": [ - -58.16713625640862, - 31.04808747872548, - 101.12190774409488, - 111.19928569615166 + -59.42057702877141, + 31.1145608404754, + 100.2738938998647, + 111.42567305703182 ], - "timestamp": 4.590781451164208 + "timestamp": 4.647846805909572 }, { - "x": 3.9307248628182854, - "y": 5.6362066530252655, - "heading": 5.601194290632536, - "angularVelocity": 1.4907682092809864, - "velocityX": -0.5415888832830509, - "velocityY": 0.8127885050494256, + "x": 3.930473563980664, + "y": 5.636699135016749, + "heading": 5.6090237892657715, + "angularVelocity": 1.651944625216427, + "velocityX": -0.5415324909628186, + "velocityY": 0.8153109765385055, "moduleForcesX": [ - -95.02943454284728, - -112.32207187573187, - 52.31611898637743, - -34.23111294482164 + -93.16011868735104, + -112.47606598208196, + 53.652879177811734, + -33.78704517737121 ], "moduleForcesY": [ - -65.28675950904464, - 26.427771988717467, - 102.79243467120487, - 110.20104060720486 + -67.91573899096274, + 25.75384194792576, + 102.09996040314262, + 110.33638895218624 ], - "timestamp": 4.634555730046681 + "timestamp": 4.692089694478462 }, { - "x": 3.8996232433704536, - "y": 5.67868110060817, - "heading": 5.617199166752307, - "angularVelocity": 0.3656228389904951, - "velocityX": -0.7104998698284664, - "velocityY": 0.9703060488316098, + "x": 3.899231021868383, + "y": 5.679449457084365, + "heading": 5.629918846850788, + "angularVelocity": 0.4722805915459298, + "velocityX": -0.7061596365624855, + "velocityY": 0.966264261906209, "moduleForcesX": [ - -106.02647980753328, - -110.97907601877178, - 36.59336535164549, - -38.763920050536065 + -102.57136846110204, + -111.54325011561693, + 40.69497651884779, + -37.935243929793444 ], "moduleForcesY": [ - -45.18048489661737, - 31.540733116049065, - 109.35634824645626, - 108.67557062608951 + -52.52564969837368, + 29.4668681376155, + 107.89412812639264, + 108.96449307890926 ], - "timestamp": 4.678330008929153 + "timestamp": 4.736332583047351 }, { - "x": 3.860110843069242, - "y": 5.729664244872591, - "heading": 5.593224624125038, - "angularVelocity": -0.547685609890632, - "velocityX": -0.9026396621471824, - "velocityY": 1.1646826758997946, + "x": 3.859765676771108, + "y": 5.730326735350005, + "heading": 5.606450375138135, + "angularVelocity": -0.5304461908292993, + "velocityX": -0.8920155616834311, + "velocityY": 1.1499538097839181, "moduleForcesX": [ - -114.74365869825844, - -107.73349084432331, - 15.73401800943126, - -42.57429428279629 + -112.92169627828984, + -108.9219189691362, + 24.073517173913505, + -40.83914052431008 ], "moduleForcesY": [ - -10.4350588624452, - 41.23196001279347, - 114.20366129024507, - 107.21934325723129 + -22.74755439174561, + 37.95851016971545, + 112.7310149617651, + 107.8859864747371 ], - "timestamp": 4.722104287811626 + "timestamp": 4.78057547161624 }, { - "x": 3.8112844590593467, - "y": 5.790966829650067, - "heading": 5.542349985528334, - "angularVelocity": -1.1622039219262499, - "velocityX": -1.1154126408566776, - "velocityY": 1.4004247778030499, + "x": 3.8111389410743834, + "y": 5.79124568175385, + "heading": 5.550849308469565, + "angularVelocity": -1.2567232490255504, + "velocityX": -1.0990859157175008, + "velocityY": 1.3769206390986586, "moduleForcesX": [ - -110.66151469383081, - -101.36053530623528, - -15.613856789130313, - -48.454801412715774 + -113.54722733634918, + -103.43030407712321, + -3.5622560281797546, + -45.305379884050026 ], "moduleForcesY": [ - 32.04293220941277, - 55.00994604223042, - 114.18177265531851, - 104.66041275307676 + 19.201188048769797, + 50.979455462200974, + 115.16014318689234, + 106.04826799334447 ], - "timestamp": 4.765878566694099 + "timestamp": 4.824818360185129 }, { "x": 3.752480545043945, "y": 5.863831043243408, "heading": 5.480546717244263, - "angularVelocity": -1.4118626248533899, - "velocityX": -1.343343979995238, - "velocityY": 1.664544007428914, + "angularVelocity": -1.589014494743879, + "velocityX": -1.3258265436060674, + "velocityY": 1.6406108153751935, "moduleForcesX": [ - -91.58391515691349, - -89.00952621701097, - -54.28386759761697, - -60.88263773717588 + -96.27958972309919, + -91.90028015401168, + -46.0608746637012, + -56.857903750739794 ], "moduleForcesY": [ - 69.91797745860337, - 73.2606319317319, - 101.64123727775288, - 97.89690993994493 + 63.1774230585327, + 69.54780453922038, + 105.55736170661821, + 100.2533607662289 ], - "timestamp": 4.809652845576571 + "timestamp": 4.869061248754019 }, { - "x": 3.6247796796501865, - "y": 6.020393862485399, - "heading": 5.396597051454397, - "angularVelocity": -1.136139489771721, - "velocityX": -1.728249835026593, - "velocityY": 2.118855386703538, + "x": 3.625288293351891, + "y": 6.019663725891665, + "heading": 5.383968397246127, + "angularVelocity": -1.2998708875412803, + "velocityX": -1.7119111732168877, + "velocityY": 2.0973896367822467, "moduleForcesX": [ - -64.01795106750846, - -62.13975297663151, - -83.85792038265208, - -85.86840122940083 + -63.35958617648632, + -61.5016685281973, + -83.98957274568086, + -86.30910394415343 ], "moduleForcesY": [ - 95.94171307643556, - 97.13810717197784, - 79.19011036368579, - 76.96736480457619 + 96.32955114118715, + 97.48422295362182, + 78.99253694196872, + 76.39900626600716 ], - "timestamp": 4.883543126255692 + "timestamp": 4.943359643251347 }, { - "x": 3.4688025039143255, - "y": 6.210363644739983, - "heading": 5.3382811336269915, - "angularVelocity": -0.7892231196231553, - "velocityX": -2.1109295336583584, - "velocityY": 2.5709711819820655, + "x": 3.4694662818312585, + "y": 6.20933750397901, + "heading": 5.309907389719856, + "angularVelocity": -0.9968049515381256, + "velocityX": -2.0972460115034317, + "velocityY": 2.552865097161194, "moduleForcesX": [ - -60.82496922096849, - -58.993762084770374, - -85.23274796355844, - -89.12126008495763 + -62.09781410875213, + -61.44436515676163, + -83.73437350844854, + -87.31016658656043 ], "moduleForcesY": [ - 97.91898127763542, - 98.97383223128705, - 77.61460069122347, - 73.04209646880568 + 96.94974979682578, + 97.27543927473285, + 79.02989424706948, + 74.9538204464673 ], - "timestamp": 4.957433406934812 + "timestamp": 5.017658037748676 }, { - "x": 3.285330477453207, - "y": 6.432930917108337, - "heading": 5.323684758957203, - "angularVelocity": -0.1975411994058538, - "velocityX": -2.4830332863110067, - "velocityY": 3.0121319112981255, + "x": 3.289311241310323, + "y": 6.423961245560545, + "heading": 5.309962184347802, + "angularVelocity": 0.0007374941049159021, + "velocityX": -2.424750113912783, + "velocityY": 2.88867266962612, "moduleForcesX": [ - -52.259455121950104, - -45.29427572571881, - -90.15821094756608, - -98.33087843589153 + -40.74857935844332, + -18.853251410417336, + -92.2430106987836, + -98.53054513090648 ], "moduleForcesY": [ - 102.52257021365222, - 105.58458947811977, - 71.52845266276556, - 59.492542868834136 + 96.31459560680612, + 93.15672622123716, + 51.20564283421457, + 16.04638677086884 ], - "timestamp": 5.0313236876139324 + "timestamp": 5.091956432246005 }, { - "x": 3.1138424725109046, - "y": 6.635690019593371, - "heading": 5.379941397506073, - "angularVelocity": 0.7613536994557198, - "velocityX": -2.320846576385527, - "velocityY": 2.7440564661751154, + "x": 3.116823926921375, + "y": 6.629426011222936, + "heading": 5.346662180978036, + "angularVelocity": 0.49395410060379374, + "velocityX": -2.321548339717472, + "velocityY": 2.7653998051031645, "moduleForcesX": [ - 56.506940689491465, - 67.52985880231365, - -15.921759845031302, - 16.56078955508368 + 27.481431543061767, + 39.57127820766088, + -1.4918968027664112, + 13.336470847013707 ], "moduleForcesY": [ - -13.184564767374862, - -46.19772680767912, - -64.74034721944736, - -81.95175795924673 + -3.7073202435334416, + -22.657178376344635, + -25.44947588664071, + -42.42756593521844 ], - "timestamp": 5.105213968293053 + "timestamp": 5.166254826743334 }, { - "x": 2.9708595052799165, - "y": 6.804691723426312, - "heading": 5.427781973086904, - "angularVelocity": 0.6474542408166764, - "velocityX": -1.9350713776810924, - "velocityY": 2.2871980222521517, + "x": 2.9728273117834085, + "y": 6.8006505476140005, + "heading": 5.397761300974995, + "angularVelocity": 0.6877553726789595, + "velocityX": -1.9380851512631618, + "velocityY": 2.3045523062711557, "moduleForcesX": [ - 69.84626762723298, - 69.3664128115689, - 78.55973759609914, - 78.77988767551102 + 81.46564305418052, + 80.49825287187765, + 65.10081795178034, + 66.09113775652368 ], "moduleForcesY": [ - -91.46262829883237, - -91.7887283059373, - -84.09614329094023, - -83.84776974220942 + -81.15783169411748, + -82.19763092136209, + -94.78893254492608, + -94.17140740263652 ], - "timestamp": 5.179104248972173 + "timestamp": 5.2405532212406625 }, { - "x": 2.8564453157848377, - "y": 6.939904549706658, - "heading": 5.466403159501036, - "angularVelocity": 0.522682903071518, - "velocityX": -1.5484335482759797, - "velocityY": 1.8299135561215285, + "x": 2.857611110726288, + "y": 6.937545900604295, + "heading": 5.4452467331407535, + "angularVelocity": 0.6391178771361595, + "velocityX": -1.5507226210825067, + "velocityY": 1.842507552370001, "moduleForcesX": [ - 69.76232758546392, - 68.91646548695893, - 79.25899084878017, - 79.27764146129198 + 72.18570029563338, + 72.01424178451545, + 75.98943820596472, + 75.9475002423331 ], "moduleForcesY": [ - -91.77011872190114, - -92.3862498475594, - -83.70370167635726, - -83.66269029454818 + -89.86507715449565, + -89.99403758231846, + -86.67204720164703, + -86.6999366425214 ], - "timestamp": 5.252994529651294 + "timestamp": 5.314851615737991 }, { - "x": 2.7706218869821835, - "y": 7.041319186543625, - "heading": 5.495529703317597, - "angularVelocity": 0.3941864010917436, - "velocityX": -1.1614982107776188, - "velocityY": 1.3725030667751008, + "x": 2.771197873348752, + "y": 7.040166816408869, + "heading": 5.483776356564779, + "angularVelocity": 0.518579488624223, + "velocityX": -1.1630565904172114, + "velocityY": 1.3811996409728962, "moduleForcesX": [ - 69.80382238745547, - 68.69416422988506, - 79.5605145541954, - 79.38562401155933 + 69.78078581158707, + 68.83655705259315, + 78.94197823204128, + 78.80958416295582 ], "moduleForcesY": [ - -91.81935170246173, - -92.63831320438999, - -83.50590561929292, - -83.65606631768857 + -91.8382201142604, + -92.5349745458161, + -84.09261841954978, + -84.20197278112937 ], - "timestamp": 5.326884810330414 + "timestamp": 5.38915001023532 }, { - "x": 2.7134004949667867, - "y": 7.108931315252294, - "heading": 5.515026042601372, - "angularVelocity": 0.26385526086226124, - "velocityX": -0.7744102673515256, - "velocityY": 0.9150341301623254, + "x": 2.7135903319326986, + "y": 7.1085546328421145, + "heading": 5.510796163144548, + "angularVelocity": 0.36366608945689255, + "velocityX": -0.7753537853112552, + "velocityY": 0.9204481051835351, "moduleForcesX": [ - 69.84897377197261, - 68.56304647527213, - 79.73113036544808, - 79.41828548070994 + 68.76974485124715, + 67.15141087474308, + 80.36853069934784, + 80.1073327253284 ], "moduleForcesY": [ - -91.82527817186515, - -92.77867605554302, - -83.38745301845533, - -83.67315905858865 + -92.6404196148515, + -93.807979797021, + -82.77776530877948, + -83.01627453571585 ], - "timestamp": 5.4007750910095345 + "timestamp": 5.463448404732649 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 0.1323754049192017, - "velocityX": -0.38723234385763106, - "velocityY": 0.457530093567707, + "angularVelocity": 0.18857924691522118, + "velocityX": -0.38766037592671904, + "velocityY": 0.4600867848398824, "moduleForcesX": [ - 69.86757393943451, - 68.48839210839408, - 79.82897176170941, - 79.44566757381436 + 68.20517667619332, + 66.12682297577744, + 81.19705273807533, + 80.86078377461928 ], "moduleForcesY": [ - -91.83521466144708, - -92.85970357248195, - -83.32050872366182, - -83.67612133165673 + -93.08125167677963, + -94.5583649585031, + -81.99291564809009, + -82.31158905160967 ], - "timestamp": 5.474665371688655 + "timestamp": 5.537746799229978 }, { "x": 2.6847877883911124, "y": 7.142738342285156, "heading": 5.5248072984258645, - "angularVelocity": 4.3846854612017205e-20, - "velocityX": 4.0904407705530267e-19, - "velocityY": 2.676968555971792e-19, + "angularVelocity": -1.0805689415403086e-18, + "velocityX": -3.1368680539147086e-18, + "velocityY": -3.703947835290446e-18, "moduleForcesX": [ - 69.84827604991999, - 68.4571637796041, - 79.87431218531981, - 79.49268727695525 + 67.78484334953605, + 65.47502708227312, + 81.69905950491257, + 81.40565230070786 ], "moduleForcesY": [ - -91.86589702825101, - -92.89994179562993, - -83.29490255274604, - -83.6508373745975 + -93.40351824166066, + -95.02748219177536, + -81.51093377653565, + -81.79230598952022 ], - "timestamp": 5.548555652367775 + "timestamp": 5.612045193727306 }, { - "x": 2.6780400940867017, - "y": 7.132795995001895, - "heading": 5.484107626833603, - "angularVelocity": -0.8968101820215478, - "velocityX": -0.14868426993683037, - "velocityY": -0.21907789247415013, + "x": 2.6781927188978703, + "y": 7.133643639193119, + "heading": 5.477615257440236, + "angularVelocity": -1.026708496320766, + "velocityX": -0.14348211565165733, + "velocityY": -0.19786406226746447, "moduleForcesX": [ - -36.58138343688566, - -92.6089981202968, - 58.0881030195425, - -114.99026329766755 + -36.1387948710901, + -93.94614327648326, + 64.40510932897232, + -111.62905057926731 ], "moduleForcesY": [ - -109.44730735929383, - -68.83786410265968, - -99.62425206236014, - 3.712550595135027 + -109.59547970218897, + -67.00327298809147, + -95.66578127079119, + 27.752839981537313 ], - "timestamp": 5.5939383569893035 + "timestamp": 5.658009594679224 }, { - "x": 2.664180849275817, - "y": 7.112249186067297, - "heading": 5.407197367962043, - "angularVelocity": -1.694704172282317, - "velocityX": -0.30538604797719293, - "velocityY": -0.45274535984467007, + "x": 2.6643917095182355, + "y": 7.11474570789861, + "heading": 5.388434472140597, + "angularVelocity": -1.9402142408628402, + "velocityX": -0.3002543075470839, + "velocityY": -0.4111427736059914, "moduleForcesX": [ - -40.51832482476327, - -94.2857417287882, - 52.5262385664123, - -113.84938976113054 + -40.821633177857166, + -95.86727581221088, + 57.378637396381855, + -114.42189871533581 ], "moduleForcesY": [ - -108.04061737317625, - -66.49833461253947, - -102.65351736489686, - -15.26464777195355 + -107.92658105906054, + -64.19626033624714, + -100.02527276448117, + 8.587675737867313 ], - "timestamp": 5.639321061610832 + "timestamp": 5.7039739956311415 }, { - "x": 2.643283868876903, - "y": 7.0794637940045515, - "heading": 5.302434680689891, - "angularVelocity": -2.3084275859234884, - "velocityX": -0.4604613271330158, - "velocityY": -0.7224204096287653, + "x": 2.6434517089581098, + "y": 7.0833718283589775, + "heading": 5.27028703389283, + "angularVelocity": -2.5704117926253285, + "velocityX": -0.4555699655920882, + "velocityY": -0.6825690945575899, "moduleForcesX": [ - -45.62421822143242, - -96.06095182204425, - 44.41977169952854, - -96.82610095310366 + -46.630127487625636, + -97.68723324634861, + 47.369366627194026, + -94.98425581738753 ], "moduleForcesY": [ - -105.96943008095946, - -63.86894871055252, - -106.39784959154368, - -61.28781168659432 + -105.5285366257994, + -61.34509852502472, + -105.11852994950861, + -63.424528390959615 ], - "timestamp": 5.68470376623236 + "timestamp": 5.749938396583059 }, { - "x": 2.616567085666063, - "y": 7.032861637076852, - "heading": 5.174736847304393, - "angularVelocity": -2.813799539944645, - "velocityX": -0.5886996694808485, - "velocityY": -1.0268704193886582, + "x": 2.617319096568963, + "y": 7.037655137656524, + "heading": 5.127203663119358, + "angularVelocity": -3.112917123039361, + "velocityX": -0.5685402582856085, + "velocityY": -0.9946108239347264, "moduleForcesX": [ - -51.22850417511759, - -97.0841442839216, - 33.41911257960119, - -45.60897792645029 + -52.706804481691236, + -98.19933570612737, + 33.658035334020674, + -22.35560750968032 ], "moduleForcesY": [ - -103.35106272656323, - -62.239918850679175, - -110.32640894319718, - -105.13082797687231 + -102.59714478787957, + -60.44172525566534, + -110.24906301300808, + -112.31949341572266 ], - "timestamp": 5.730086470853888 + "timestamp": 5.795902797534977 }, { - "x": 2.5844362149595033, - "y": 6.972050456195828, - "heading": 5.024165042029765, - "angularVelocity": -3.3178235305791217, - "velocityX": -0.7079981454282469, - "velocityY": -1.3399637899098782, + "x": 2.585825641778137, + "y": 6.9772618766717605, + "heading": 4.960195755089189, + "angularVelocity": -3.6334185711431983, + "velocityX": -0.6851705698018459, + "velocityY": -1.3139138057719986, "moduleForcesX": [ - -56.462615374362144, - -95.89341392145514, - 18.906930129561147, - -15.864319365251827 + -57.48268084453163, + -94.58841581785144, + 15.096484175129069, + -7.151989945719544 ], "moduleForcesY": [ - -100.54214801306102, - -63.95307193517497, - -113.67892793538894, - -113.69206080698898 + -99.93840204825361, + -65.80975762610623, + -114.22968117284876, + -114.6027216210358 ], - "timestamp": 5.775469175475417 + "timestamp": 5.841867198486894 }, { - "x": 2.546380793638804, - "y": 6.896657883852084, - "heading": 4.854185291365359, - "angularVelocity": -3.7454742303695725, - "velocityX": -0.8385445873723301, - "velocityY": -1.661262213710842, + "x": 2.5482138782620107, + "y": 6.901429215857198, + "heading": 4.77842465135581, + "angularVelocity": -3.954606172797204, + "velocityX": -0.8182802938185039, + "velocityY": -1.6498128822322529, "moduleForcesX": [ - -59.08407639825137, - -88.01731264292732, - -0.36287524026541784, - -15.92705626141617 + -55.68470936791087, + -75.42364616036707, + -11.70140331659463, + -21.681375783030767 ], "moduleForcesY": [ - -98.93287625654581, - -74.24824099326665, - -115.16848981625489, - -113.78600820918646 + -100.80538075759425, + -86.90554310267157, + -114.51447272212816, + -112.86388870902134 ], - "timestamp": 5.820851880096945 + "timestamp": 5.887831599438812 }, { - "x": 2.5020913921866805, - "y": 6.80587456385112, - "heading": 4.678726225749676, - "angularVelocity": -3.8662099819509463, - "velocityX": -0.9759092548907747, - "velocityY": -2.0003946604341585, + "x": 2.5055730112747687, + "y": 6.809867684125596, + "heading": 4.612871171835818, + "angularVelocity": -3.601776072164528, + "velocityX": -0.9276933040386546, + "velocityY": -1.9920096821751843, "moduleForcesX": [ - -49.44678346076421, - -55.30372799636149, - -31.538725682495443, - -35.63574287157784 + -5.543216012523143, + -7.475609555022172, + -68.66969747543445, + -53.51925630689457 ], "moduleForcesY": [ - -103.84416234160267, - -100.77984511033993, - -110.5795972400698, - -109.25299086030626 + -114.51283157214844, + -114.67118987816475, + -91.95148315151832, + -101.73623001018109 ], - "timestamp": 5.866234584718473 + "timestamp": 5.933796000390729 }, { - "x": 2.452855464930423, - "y": 6.700360814437642, - "heading": 4.525703159278682, - "angularVelocity": -3.371836644535417, - "velocityX": -1.0849050903172024, - "velocityY": -2.324977109527025, + "x": 2.45762102453482, + "y": 6.703392433541864, + "heading": 4.471415520979255, + "angularVelocity": -3.0775045018978244, + "velocityX": -1.0432418512341903, + "velocityY": -2.316472060521667, "moduleForcesX": [ - 9.704067691996666, - -3.0133443991745454, - -81.36746218585021, - -61.74194260289828 + 11.029616583468297, + -4.968113790093944, + -83.96314322380599, + -64.888165297217 ], "moduleForcesY": [ - -113.97825197610887, - -114.78558445562433, - -80.6238523751475, - -96.85819727429818 + -113.78423953190172, + -114.67679488503815, + -77.77423908354406, + -94.7210439478332 ], - "timestamp": 5.911617289340001 + "timestamp": 5.979760401342647 }, { - "x": 2.3977314070031808, - "y": 6.580743460775094, - "heading": 4.397294971017319, - "angularVelocity": -2.8294520860365577, - "velocityX": -1.214649025150719, - "velocityY": -2.6357475752074513, + "x": 2.4031479414108436, + "y": 6.582925065175055, + "heading": 4.357309400228015, + "angularVelocity": -2.482489021680148, + "velocityX": -1.185114610347244, + "velocityY": -2.62088411622787, "moduleForcesX": [ - 8.23834187664013, - -10.480286821125317, - -89.23977661435593, - -70.90518481088789 + 8.675398306510978, + -13.212936622685156, + -94.93975692279795, + -75.84281222648211 ], "moduleForcesY": [ - -113.67173817318357, - -114.10634114609931, - -71.12492607945074, - -90.05586637958646 + -113.47578028497088, + -113.75794165587843, + -63.08562287254842, + -85.85966695631721 ], - "timestamp": 5.95699999396153 + "timestamp": 6.025724802294564 }, { - "x": 2.335164483598406, - "y": 6.448466508306411, - "heading": 4.297771128185117, - "angularVelocity": -2.1929905602186364, - "velocityX": -1.3786512709314238, - "velocityY": -2.914699632201637, + "x": 2.3403859643936706, + "y": 6.45036283582954, + "heading": 4.275647872255098, + "angularVelocity": -1.77662552500885, + "velocityX": -1.365447514106127, + "velocityY": -2.884019515106602, "moduleForcesX": [ - 2.8428493566441784, - -20.960314391026447, - -102.93252880524821, - -84.21445543262062 + 1.1305249251769165, + -25.146700133162, + -108.60135018229583, + -90.22993499759434 ], "moduleForcesY": [ - -112.7690144774048, - -112.09268001844593, - -47.256316578380776, - -77.01708814164583 + -112.36380391180697, + -111.12312763667339, + -31.894172458136484, + -69.79003312917786 ], - "timestamp": 6.002382698583058 + "timestamp": 6.071689203246482 }, { - "x": 2.2615747120568583, - "y": 6.308166137099232, - "heading": 4.229489174742873, - "angularVelocity": -1.504580963423973, - "velocityX": -1.6215378117116424, - "velocityY": -3.091494268074651, + "x": 2.266794803149496, + "y": 6.3096531054549185, + "heading": 4.22870618913707, + "angularVelocity": -1.021261718762126, + "velocityX": -1.6010468910746176, + "velocityY": -3.0612762803504263, "moduleForcesX": [ - -39.292159251187655, - -48.85965615161464, - -110.44414210433004, - -105.39970908610731 + -29.274189339164224, + -46.32646503632049, + -109.70707968061237, + -105.8355999224511 ], "moduleForcesY": [ - -96.55667751732372, - -100.53582202079686, - 15.711330603948774, - -39.894176375958565 + -98.80485347592223, + -101.68818116190897, + 20.15623938472312, + -38.70930863468574 ], - "timestamp": 6.047765403204586 + "timestamp": 6.1176536041983995 }, { - "x": 2.1831145159545553, - "y": 6.180875846162496, - "heading": 4.1380293777551325, - "angularVelocity": -2.0153007131345686, - "velocityX": -1.7288567694813948, - "velocityY": -2.8048194129962725, + "x": 2.1876531714787637, + "y": 6.181353766918992, + "heading": 4.158203959322547, + "angularVelocity": -1.5338442001729604, + "velocityX": -1.721802743682462, + "velocityY": -2.7912762024275843, "moduleForcesX": [ - -85.2628206812587, - -40.76242627735696, - -41.809404066636745, - 33.5147418178144 + -84.51752285390113, + -43.84922240056912, + -45.15305909136826, + 24.295039925634793 ], "moduleForcesY": [ - 69.629754055441, - 103.2872432820868, - 83.00028269477319, - 102.88363740482352 + 64.962436756562, + 98.75569699979742, + 69.59109448996358, + 100.3449769234843 ], - "timestamp": 6.0931481078261145 + "timestamp": 6.163618005150317 }, { - "x": 2.1114416599283863, - "y": 6.06661673762304, - "heading": 4.018463859189059, - "angularVelocity": -2.634605397875636, - "velocityX": -1.5792989118627885, - "velocityY": -2.5176795762246353, + "x": 2.113994274210826, + "y": 6.066518080053957, + "heading": 4.055835706233426, + "angularVelocity": -2.227120357691746, + "velocityX": -1.6025205537866314, + "velocityY": -2.4983614381304218, "moduleForcesX": [ - -15.49547878536738, - 23.02465023695272, - 94.40260108810763, - 85.2541475816078 + -35.21196936052455, + 10.689838775403791, + 91.16219383522305, + 80.76361369246891 ], "moduleForcesY": [ - 112.01377982791259, - 111.58942984648255, - 60.4635293809918, - 75.31614730987101 + 106.90487109103282, + 113.07820027059671, + 62.57889090145047, + 79.40920313784463 ], - "timestamp": 6.138530812447643 + "timestamp": 6.209582406102235 }, { - "x": 2.0485770415142293, - "y": 5.9648432002123934, - "heading": 3.8746850280973426, - "angularVelocity": -3.1681415263979926, - "velocityX": -1.3852109286658927, - "velocityY": -2.2425621888204583, + "x": 2.048858891665913, + "y": 5.964516870092409, + "heading": 3.9264057363583187, + "angularVelocity": -2.8158741807709244, + "velocityX": -1.4170832469469115, + "velocityY": -2.2191349794430835, "moduleForcesX": [ - 9.897010287228166, - 41.53032424596694, - 98.32290187749213, - 93.16938210809714 + 1.6252737092564529, + 36.1594566332213, + 99.39177635870605, + 91.97875020995595 ], "moduleForcesY": [ - 113.74543897439578, - 106.82441101026964, - 57.179734029047, - 66.5860605496559 + 113.90438381958636, + 108.60701730026715, + 54.58321208539396, + 67.9611469724518 ], - "timestamp": 6.183913517069171 + "timestamp": 6.255546807054152 }, { - "x": 1.9953768413307222, - "y": 5.87572493089785, - "heading": 3.7134081357201074, - "angularVelocity": -3.553708262260153, - "velocityX": -1.1722571545079572, - "velocityY": -1.9637055582683054, + "x": 1.993550029996154, + "y": 5.874850586766882, + "heading": 3.7728427578306443, + "angularVelocity": -3.340911125727801, + "velocityX": -1.2032977809852603, + "velocityY": -1.9507767199952386, "moduleForcesX": [ - 28.980375064219935, - 53.44415602897274, - 90.81965392427338, - 93.2877698645733 + 17.172798234973893, + 49.099531895619926, + 100.50042106684448, + 97.41391226965858 ], "moduleForcesY": [ - 110.93166649748387, - 101.6861880924278, - 69.51188559031758, - 66.88592374391413 + 113.20215773896902, + 103.78581109073643, + 54.03522331953967, + 60.60212605681651 ], - "timestamp": 6.229296221690699 + "timestamp": 6.30151120800607 }, { - "x": 1.9512668027592162, - "y": 5.800221418575717, - "heading": 3.563180043350926, - "angularVelocity": -3.3102498765117425, - "velocityX": -0.9719570250245071, - "velocityY": -1.6637067568317239, + "x": 1.9484012775868889, + "y": 5.798850919958476, + "heading": 3.614156733336716, + "angularVelocity": -3.452367945791928, + "velocityX": -0.9822547770500605, + "velocityY": -1.6534462591584242, "moduleForcesX": [ - 84.8275048007026, - 74.00444289575007, - 55.706127137344104, - 36.15663713104463 + 57.747161790833076, + 64.14132388711865, + 73.40481169626354, + 77.8619118899172 ], "moduleForcesY": [ - 77.70219291275828, - 87.85806255534838, - 100.72627828960442, - 109.19057307139687 + 99.29689982740135, + 95.36643063242519, + 88.28122283946998, + 84.48333541275828 ], - "timestamp": 6.274678926312228 + "timestamp": 6.347475608957987 }, { - "x": 1.9160288345180236, - "y": 5.737622434633646, - "heading": 3.4321839049608895, - "angularVelocity": -2.886477116833102, - "velocityX": -0.7764624989863842, - "velocityY": -1.3793577192923698, + "x": 1.9127337063673016, + "y": 5.736313352300109, + "heading": 3.471353806544456, + "angularVelocity": -3.106815792979521, + "velocityX": -0.7759825099624048, + "velocityY": -1.3605652714540262, "moduleForcesX": [ - 100.14721091439696, - 80.024676888727, - 53.76343662229833, - 10.744716582139088 + 94.4936874124405, + 79.08825052744707, + 56.365800767009816, + 24.954444482004966 ], "moduleForcesY": [ - 56.886724083533664, - 82.35913095559418, - 101.95066373478755, - 114.69341623133506 + 65.75374939597347, + 83.32375870199846, + 100.46638970549711, + 112.38552797167915 ], - "timestamp": 6.320061630933756 + "timestamp": 6.393440009909905 }, { - "x": 1.8895087950240261, - "y": 5.687579858551526, - "heading": 3.3226877484953126, - "angularVelocity": -2.412728756003591, - "velocityX": -0.5843644559125142, - "velocityY": -1.1026794568427385, + "x": 1.886359146217566, + "y": 5.686523155503287, + "heading": 3.3502697309729075, + "angularVelocity": -2.634301177953176, + "velocityX": -0.5738040658318472, + "velocityY": -1.083233888959123, "moduleForcesX": [ - 106.88461675230056, - 74.48364034847003, - 56.28645184223139, - 2.774309758119841 + 105.7514652727486, + 80.75753449736956, + 56.80029932667258, + 6.533917978602636 ], "moduleForcesY": [ - 43.08617697815873, - 87.30364939891349, - 100.65158178859284, - 115.24782035664735 + 45.74125215420102, + 81.56714001964295, + 100.33878741770911, + 115.0667288889628 ], - "timestamp": 6.365444335555284 + "timestamp": 6.4394044108618225 }, { - "x": 1.8711700652556698, - "y": 5.65013543062385, - "heading": 3.235787365853356, - "angularVelocity": -1.9148348113376807, - "velocityX": -0.4040907196098917, - "velocityY": -0.8250814542664743, + "x": 1.8688668154792478, + "y": 5.649330359328354, + "heading": 3.252581489320249, + "angularVelocity": -2.1253021823312412, + "velocityX": -0.38056257399321847, + "velocityY": -0.8091652540808636, "moduleForcesX": [ - 110.53141862820286, - 55.32796842006491, - 59.3280715917302, - 0.4423126125758939 + 110.75420648171638, + 67.41351148588903, + 59.644307139599306, + 0.9872999199197953 ], "moduleForcesY": [ - 32.74820446985415, - 100.43619981044304, - 98.9287079347535, - 115.32725877892798 + 31.95250489619978, + 92.68928093173696, + 98.72856624843796, + 115.31159659481125 ], - "timestamp": 6.410827040176812 + "timestamp": 6.48536881181374 }, { - "x": 1.8599680524378024, - "y": 5.625376428463603, - "heading": 3.1740593903204664, - "angularVelocity": -1.3601652005466363, - "velocityX": -0.24683440335448, - "velocityY": -0.5455603046739032, + "x": 1.858976873190861, + "y": 5.624953566198194, + "heading": 3.180831657251804, + "angularVelocity": -1.5609869939021082, + "velocityX": -0.21516526014844972, + "velocityY": -0.5303407120580114, "moduleForcesX": [ - 112.62711740856216, - 22.697802483968943, - 61.80059569568246, - -0.3042403849948985 + 113.26127376040452, + 29.537208536709745, + 62.36258258326864, + -0.7703487270785222 ], "moduleForcesY": [ - 24.716987102766762, - 112.34568644194815, - 97.42837626864956, - 115.35632305606234 + 21.60538546032672, + 110.53903877029852, + 97.06559527810428, + 115.34906975588957 ], - "timestamp": 6.456209744798341 + "timestamp": 6.531333212765658 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -0.7153988948307862, - "velocityX": -0.11473292914177677, - "velocityY": -0.2699509497396525, + "angularVelocity": -0.8536824770773792, + "velocityX": -0.09171687870080983, + "velocityY": -0.257334844008948, "moduleForcesX": [ - 113.77295041301618, - -10.465866206745924, - 63.178995978692946, - -1.1484884755134463 + 114.45714666054333, + -23.858287526830292, + 63.97932141399696, + -2.0261075694857094 ], "moduleForcesY": [ - 18.878658262354456, - 114.14538106924417, - 96.55763623804961, - 115.36971326990154 + 14.144281910437515, + 111.84032387600276, + 96.02804598950047, + 115.35597645325022 ], - "timestamp": 6.501592449419869 + "timestamp": 6.577297613717575 }, { "x": 1.8547611618041984, "y": 5.613125324249268, "heading": 3.141592653589793, - "angularVelocity": -6.131753633195435e-20, - "velocityX": -1.3186452681561465e-19, - "velocityY": -2.1826000885282386e-19, + "angularVelocity": 5.811736944519793e-19, + "velocityX": 9.954723650891276e-19, + "velocityY": 3.489112214048715e-18, "moduleForcesX": [ - 114.29048140187895, - -30.95658475229967, - 63.14866943306744, - -2.883364732869972 + 114.90954967400633, + -61.21552776428465, + 63.898589778474886, + -4.252932311068719 ], "moduleForcesY": [ - 15.576647850433439, - 110.35051173008702, - 96.59011418775707, - 115.35208140460223 + 10.052179512818215, + 96.54516819532166, + 96.0960223654032, + 115.30969681756605 ], - "timestamp": 6.546975154041397 + "timestamp": 6.623262014669493 }, { - "x": 1.8840837282716696, - "y": 5.612955136335095, + "x": 1.8840837431569961, + "y": 5.612955128559063, "heading": 3.141592653589793, - "angularVelocity": -3.444422296937106e-16, - "velocityX": 0.4881043332518617, - "velocityY": -0.0028329531955217676, + "angularVelocity": 2.5735470493073093e-16, + "velocityX": 0.4881044450227128, + "velocityY": -0.0028330818461293275, "moduleForcesX": [ - 115.37658317775369, - 115.37658317775369, - 115.37658317775369, - 115.37658317775369 + 115.37657744801193, + 115.37657744801193, + 115.37657744801193, + 115.37657744801193 ], "moduleForcesY": [ - -0.6696446594198311, - -0.6696446594198309, - -0.6696446594198873, - -0.669644659419887 + -0.6696748828445868, + -0.6696748828445869, + -0.6696748828445466, + -0.6696748828445467 ], - "timestamp": 6.607049536647504 + "timestamp": 6.683336414015381 }, { - "x": 1.9427243442502276, - "y": 5.612614333848124, + "x": 1.9427243878703746, + "y": 5.6126143107496995, "heading": 3.141592653589793, - "angularVelocity": -6.866000063375061e-16, - "velocityX": 0.9761334771103626, - "velocityY": -0.005673008563488317, + "angularVelocity": 6.514156180627557e-16, + "velocityX": 0.9761336834305282, + "velocityY": -0.005673262039647179, "moduleForcesX": [ - 115.35881014296135, - 115.35881014296135, - 115.35881014296135, - 115.35881014296135 + 115.35880034739998, + 115.35880034739998, + 115.35880034739998, + 115.35880034739998 ], "moduleForcesY": [ - -0.6713234488383947, - -0.6713234488383945, - -0.6713234488384501, - -0.67132344883845 + -0.6713527676407111, + -0.6713527676407113, + -0.6713527676406713, + -0.6713527676406714 ], - "timestamp": 6.667123919253611 + "timestamp": 6.743410813361269 }, { - "x": 2.0306762469301467, - "y": 5.6121022780031975, + "x": 2.0306763312754446, + "y": 5.612102232338162, "heading": 3.141592653589793, - "angularVelocity": -1.1640886651980952e-15, - "velocityX": 1.4640500470324853, - "velocityY": -0.008523697168624842, + "angularVelocity": 9.011876293987777e-16, + "velocityX": 1.4640503169856376, + "velocityY": -0.008524070437876532, "moduleForcesX": [ - 115.33220026624166, - 115.33220026624166, - 115.33220026624166, - 115.33220026624166 + 115.33218317019183, + 115.33218317019183, + 115.33218317019183, + 115.33218317019183 ], "moduleForcesY": [ - -0.6738369003470455, - -0.6738369003470452, - -0.6738369003471, - -0.6738369003470996 + -0.6738650288924455, + -0.6738650288924457, + -0.6738650288924058, + -0.6738650288924061 ], - "timestamp": 6.727198301859718 + "timestamp": 6.803485212707157 }, { - "x": 2.1479281990320023, - "y": 5.611417907491215, + "x": 2.1479283323125955, + "y": 5.611417832423418, "heading": 3.141592653589793, - "angularVelocity": -1.6338048670731272e-15, - "velocityX": 1.9517795608595263, - "velocityY": -0.01139205235732241, + "angularVelocity": 1.2870997598446557e-15, + "velocityX": 1.9517798315727328, + "velocityY": -0.011392538622051087, "moduleForcesX": [ - 115.28798452865676, - 115.28798452865676, - 115.28798452865676, - 115.28798452865676 + 115.28795258322376, + 115.28795258322376, + 115.28795258322376, + 115.28795258322376 ], "moduleForcesY": [ - -0.6780128723858879, - -0.6780128723858877, - -0.6780128723859408, - -0.6780128723859405 + -0.6780393929688204, + -0.6780393929688205, + -0.6780393929687812, + -0.6780393929687815 ], - "timestamp": 6.787272684465825 + "timestamp": 6.863559612053045 }, { - "x": 2.2944578552312023, - "y": 5.610559112618229, + "x": 2.2944580362400884, + "y": 5.6105590018551865, "heading": 3.141592653589793, - "angularVelocity": -1.9534731275862738e-15, - "velocityX": 2.4391371137337914, - "velocityY": -0.01429552557563469, + "angularVelocity": 1.5972843309153151e-15, + "velocityX": 2.4391372285526063, + "velocityY": -0.014296115776151204, "moduleForcesX": [ - 115.20006155628543, - 115.20006155628543, - 115.20006155628543, - 115.20006155628543 + 115.19999260587228, + 115.19999260587228, + 115.19999260587228, + 115.19999260587228 ], "moduleForcesY": [ - -0.6863139629291484, - -0.6863139629291481, - -0.686313962929199, - -0.6863139629291988 + -0.6863383396984449, + -0.6863383396984452, + -0.686338339698406, + -0.6863383396984062 ], - "timestamp": 6.847347067071932 + "timestamp": 6.923634011398933 }, { - "x": 2.4701992146114495, - "y": 5.609519669852626, + "x": 2.4701994064572736, + "y": 5.609519517509087, "heading": 3.141592653589793, - "angularVelocity": -2.2612491990593445e-15, - "velocityX": 2.9253960133479704, - "velocityY": -0.017302595890457132, + "angularVelocity": 1.9694342078085813e-15, + "velocityX": 2.925395378575903, + "velocityY": -0.01730328321909502, "moduleForcesX": [ - 114.94036531798054, - 114.94036531798054, - 114.94036531798054, - 114.94036531798054 + 114.94015610384217, + 114.94015610384217, + 114.94015610384217, + 114.94015610384217 ], "moduleForcesY": [ - -0.7108019221792697, - -0.7108019221792694, - -0.7108019221793155, - -0.7108019221793153 + -0.7108246829504119, + -0.7108246829504122, + -0.7108246829503729, + -0.7108246829503732 ], - "timestamp": 6.907421449678039 + "timestamp": 6.983708410744821 }, { "x": 2.6696577453613273, "y": 5.6078338623046875, "heading": 3.141592653589793, - "angularVelocity": -9.825480348601385e-17, - "velocityX": 3.3201927693152893, - "velocityY": -0.028062003716167083, + "angularVelocity": 3.395575597829539e-15, + "velocityX": 3.3201886506702922, + "velocityY": -0.028059459982184988, "moduleForcesX": [ - 93.32082845834267, - 93.32082845834263, - 93.32082845834269, - 93.32082845834263 + 93.31997894760582, + 93.3199789476058, + 93.31997894760583, + 93.3199789476058 ], "moduleForcesY": [ - -2.543275335574423, - -2.5432753355744233, - -2.543275335574176, - -2.543275335574176 + -2.5425108785752677, + -2.5425108785752832, + -2.5425108785751096, + -2.542510878575126 ], - "timestamp": 6.967495832284146 + "timestamp": 7.043782810090709 }, { - "x": 2.8583507333946185, - "y": 5.606118094653867, + "x": 2.8583506984832723, + "y": 5.606118099582229, "heading": 3.141592653589793, - "angularVelocity": 4.096438260386225e-16, - "velocityX": 2.7682638992943907, - "velocityY": -0.025171564120366276, + "angularVelocity": 3.1559531217018772e-15, + "velocityX": 2.7682631078990863, + "velocityY": -0.02517148927877366, "moduleForcesX": [ - -114.98181646144472, - -114.98181646144472, - -114.98181646144472, - -114.98181646144472 + -114.9811117071605, + -114.9811117071605, + -114.9811117071605, + -114.9811117071605 ], "moduleForcesY": [ - 0.6021572944438656, - 0.6021572944438652, - 0.6021572944439256, - 0.6021572944439254 + 0.6016428962295894, + 0.6016428962295897, + 0.6016428962295484, + 0.6016428962295487 ], - "timestamp": 7.035658765767976 + "timestamp": 7.111945750449782 }, { - "x": 3.0093359420039882, - "y": 5.604707049420854, + "x": 3.0093359108700892, + "y": 5.604707049037761, "heading": 3.141592653589793, - "angularVelocity": 6.231776078198638e-16, - "velocityX": 2.215063244676625, - "velocityY": -0.020701063773147482, + "angularVelocity": 2.487468041927929e-15, + "velocityX": 2.2150630766725925, + "velocityY": -0.020701139608050614, "moduleForcesX": [ - -115.24676383245284, - -115.24676383245284, - -115.24676383245284, - -115.24676383245284 + -115.24662233874156, + -115.24662233874156, + -115.24662233874156, + -115.24662233874156 ], "moduleForcesY": [ - 0.9313269849342551, - 0.9313269849342553, - 0.9313269849342641, - 0.9313269849342641 + 0.9312955009813111, + 0.9312955009813114, + 0.931295500981246, + 0.9312955009812464 ], - "timestamp": 7.103821699251806 + "timestamp": 7.180108690808854 }, { - "x": 3.1225883657277436, - "y": 5.603631896857166, + "x": 3.1225883471405993, + "y": 5.603631894326559, "heading": 3.141592653589793, - "angularVelocity": 5.340009815696904e-16, - "velocityX": 1.6614957416793361, - "velocityY": -0.015773273078730332, + "angularVelocity": 1.855880207091023e-15, + "velocityX": 1.6614957581629162, + "velocityY": -0.015773302993371468, "moduleForcesX": [ - -115.32318834172317, - -115.32318834172317, - -115.32318834172317, - -115.32318834172317 + -115.32313827588082, + -115.32313827588082, + -115.32313827588082, + -115.32313827588082 ], "moduleForcesY": [ - 1.026593019430992, - 1.026593019430992, - 1.0265930194309874, - 1.0265930194309874 + 1.0266024823242474, + 1.026602482324248, + 1.0266024823241775, + 1.0266024823241777 ], - "timestamp": 7.171984632735636 + "timestamp": 7.248271631167927 }, { - "x": 3.1980961248529582, - "y": 5.602907459655186, + "x": 3.198096117993605, + "y": 5.602907458005536, "heading": 3.141592653589793, - "angularVelocity": 4.544734050494986e-16, - "velocityX": 1.1077539546200297, - "velocityY": -0.010628022665021828, + "angularVelocity": 1.2470165578599126e-15, + "velocityX": 1.1077540149418748, + "velocityY": -0.01062800866874632, "moduleForcesX": [ - -115.35949645880048, - -115.35949645880048, - -115.35949645880048, - -115.35949645880048 + -115.35947569038294, + -115.35947569038294, + -115.35947569038294, + -115.35947569038294 ], "moduleForcesY": [ - 1.0718958018898446, - 1.0718958018898443, - 1.0718958018898337, - 1.0718958018898337 + 1.0719048416123194, + 1.07190484161232, + 1.0719048416122476, + 1.0719048416122483 ], - "timestamp": 7.240147566219465 + "timestamp": 7.316434571526999 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": 2.246957301459914e-16, - "velocityX": 0.5539103568522864, - "velocityY": -0.0053556863887757175, + "angularVelocity": 6.569586620037962e-16, + "velocityX": 0.5539104016139282, + "velocityY": -0.005355661647002772, "moduleForcesX": [ - -115.38070640237679, - -115.38070640237679, - -115.38070640237679, - -115.38070640237679 + -115.38069800613746, + -115.38069800613746, + -115.38069800613746, + -115.38069800613746 ], "moduleForcesY": [ - 1.0983712484824302, - 1.0983712484824302, - 1.0983712484824162, - 1.0983712484824162 + 1.098373376275015, + 1.0983733762750154, + 1.0983733762749426, + 1.098373376274943 ], - "timestamp": 7.308310499703295 + "timestamp": 7.384597511886072 }, { "x": 3.235852279663085, "y": 5.602542400360107, "heading": 3.141592653589793, - "angularVelocity": -3.1001175632732538e-25, - "velocityX": 2.125979487428218e-25, - "velocityY": -7.679223892443952e-26, + "angularVelocity": 2.1594191776071485e-25, + "velocityX": -1.0074564721924767e-23, + "velocityY": 1.0581704151351368e-23, "moduleForcesX": [ - -115.39461413799822, - -115.39461413799822, - -115.39461413799822, - -115.39461413799822 + -115.39461182381045, + -115.39461182381045, + -115.39461182381045, + -115.39461182381045 ], "moduleForcesY": [ - 1.1157353471217306, - 1.1157353471217306, - 1.1157353471217144, - 1.1157353471217144 + 1.1157300801986492, + 1.1157300801986496, + 1.1157300801985768, + 1.1157300801985772 ], - "timestamp": 7.376473433187125 + "timestamp": 7.452760452245144 }, { - "x": 3.2066986168460305, - "y": 5.573801506681172, - "heading": 3.125769419620629, - "angularVelocity": -0.22214471367149358, - "velocityX": -0.4092925688636585, - "velocityY": -0.4034976421009905, + "x": 3.2067040069092134, + "y": 5.573943438615316, + "heading": 3.1211551253930243, + "angularVelocity": -0.2866001693312032, + "velocityX": -0.4087529483282819, + "velocityY": -0.4010498334162292, "moduleForcesX": [ - -94.50501486045644, - -83.99858675745848, - -80.27135887466498, - -67.60907694190244 + -97.7982362461094, + -84.66730708312969, + -79.91393576166902, + -63.20469705289832 ], "moduleForcesY": [ - -66.22016115527009, - -79.10404420877457, - -82.91786973993526, - -93.52088748741936 + -61.25124940458032, + -78.37881724715737, + -83.2653681457004, + -96.55297564085089 ], - "timestamp": 7.4477028300413 + "timestamp": 7.524070696912693 }, { - "x": 3.148391338670253, - "y": 5.516308685460145, - "heading": 3.0946118348565337, - "angularVelocity": -0.4374259244098728, - "velocityX": -0.8185844714528088, - "velocityY": -0.807150190232956, + "x": 3.148394804389903, + "y": 5.516669588157704, + "heading": 3.0819512787773773, + "angularVelocity": -0.5497645786859534, + "velocityX": -0.8176833888475731, + "velocityY": -0.8031644082084749, "moduleForcesX": [ - -94.33138257713645, - -83.45340079540252, - -80.64801905590379, - -67.95070369572386 + -96.91343804537247, + -83.6117617704874, + -80.55330595264402, + -64.64704831280247 ], "moduleForcesY": [ - -66.44136479388739, - -79.65440454308316, - -82.53433216167745, - -93.2563885145976 + -62.61253176158479, + -79.47867664464056, + -82.62882568534246, + -95.57647529043373 ], - "timestamp": 7.518932226895475 + "timestamp": 7.595380941580242 }, { - "x": 3.0609306562816943, - "y": 5.430043615996792, - "heading": 3.048924160519714, - "angularVelocity": -0.6414159933202015, - "velocityX": -1.2278734097329609, - "velocityY": -1.2110880236703383, + "x": 3.060907848137827, + "y": 5.430610082205895, + "heading": 3.0265586342077184, + "angularVelocity": -0.7767838243705629, + "velocityX": -1.2268497557390838, + "velocityY": -1.2068322911107934, "moduleForcesX": [ - -93.96622463847802, - -82.66507902834802, - -81.1860792576855, - -68.56375935722876 + -95.32187408048668, + -82.31821309565629, + -81.35076884094318, + -66.92262060727167 ], "moduleForcesY": [ - -66.91762608001513, - -80.43604135450067, - -81.9787027695054, - -92.78161616974027 + -64.96637934957263, + -80.78194903679561, + -81.81464976514644, + -93.97078846223003 ], - "timestamp": 7.59016162374965 + "timestamp": 7.666691186247791 }, { - "x": 2.944318774935105, - "y": 5.314972807576324, - "heading": 2.9899555039449703, - "angularVelocity": -0.8278696602677583, - "velocityX": -1.637131388116669, - "velocityY": -1.6154960381883656, + "x": 2.9442234271309333, + "y": 5.3156098843885005, + "heading": 2.9591124503921264, + "angularVelocity": -0.9458133838977714, + "velocityX": -1.63629253483678, + "velocityY": -1.612674284789381, "moduleForcesX": [ - -93.23102514178399, - -81.699397941509, - -81.83020425409698, - -69.59582645311289 + -92.24877909794793, + -81.18961303807885, + -82.06283505268627, + -70.63242017886546 ], "moduleForcesY": [ - -67.87302901661609, - -81.3580027716078, - -81.29029357501479, - -91.9675996512419 + -69.19153030778277, + -81.86072044549816, + -81.04640774388061, + -91.16685358492028 ], - "timestamp": 7.661391020603825 + "timestamp": 7.7380014309153395 }, { - "x": 2.798563775989493, - "y": 5.171041089911012, - "heading": 2.9198390837009516, - "angularVelocity": -0.984374757343028, - "velocityX": -2.046275911110254, - "velocityY": -2.0206785965066842, + "x": 2.7983365943754688, + "y": 5.1714841013846, + "heading": 2.8875990684331025, + "angularVelocity": -1.0028486410672481, + "velocityX": -2.045804686768295, + "velocityY": -2.0211090801303704, "moduleForcesX": [ - -91.63008521058406, - -80.74282088024366, - -82.43567724433059, - -71.4573972068324 + -85.2775068960177, + -81.09664380826169, + -81.98861558632382, + -77.82613865257962 ], "moduleForcesY": [ - -69.89172174791939, - -82.19417166226101, - -80.58049754682132, - -90.4401820480368 + -77.49783429261997, + -81.85175642641804, + -80.991058485776, + -84.99010839197277 ], - "timestamp": 7.732620417458 + "timestamp": 7.809311675582888 }, { - "x": 2.6237060601772595, - "y": 4.998155595405218, - "heading": 2.8440225200690676, - "angularVelocity": -1.0643999104344437, - "velocityX": -2.454853242267534, - "velocityY": -2.427164936686651, + "x": 2.6236753281267338, + "y": 4.998926787820056, + "heading": 2.8387718219195595, + "angularVelocity": -0.684715733919828, + "velocityX": -2.449315200964648, + "velocityY": -2.4198109874536784, "moduleForcesX": [ - -86.70980354807344, - -80.52618577124305, - -82.32400313465457, - -76.2536897185496 + -60.98601461651415, + -84.03168175068872, + -75.69360315918169, + -100.69711811876627 ], "moduleForcesY": [ - -75.55570587121085, - -82.08532933524766, - -80.372578012564, - -86.13264049441499 + -97.49882069315503, + -78.57987315738362, + -86.20664997158062, + -55.29287195277558 ], - "timestamp": 7.8038498143121755 + "timestamp": 7.880621920250437 }, { - "x": 2.4491238027886877, - "y": 4.825248874693559, - "heading": 2.768573050774834, - "angularVelocity": -1.059246218926964, - "velocityX": -2.4509860408615487, - "velocityY": -2.4274629345190566, + "x": 2.4491288335424555, + "y": 4.825643663887782, + "heading": 2.7904774617241968, + "angularVelocity": -0.6772429462346313, + "velocityX": -2.447705731455862, + "velocityY": -2.429989193560148, "moduleForcesX": [ - 0.8313154124721739, - 0.5815156710986054, - 0.960410251787089, - 0.7105986961435966 + 0.4130056069714148, + 0.04889182806994197, + 0.5921306407032488, + 0.22796342105049527 ], "moduleForcesY": [ - -0.2750886779845719, - -0.17899030487484907, - 0.06010210260660461, - 0.15634311143689636 + -2.3376973989520304, + -2.204364974642423, + -1.8492859164341702, + -1.715902956353102 ], - "timestamp": 7.875079211166351 + "timestamp": 7.951932164917986 }, { - "x": 2.303614224295877, - "y": 4.681164504915296, - "heading": 2.7036831029300576, - "angularVelocity": -0.9109995410690177, - "velocityX": -2.0428304172040885, - "velocityY": -2.0228217020177746, + "x": 2.3035011250063397, + "y": 4.681149821933151, + "heading": 2.7264699100767897, + "angularVelocity": -0.8975926523014042, + "velocityX": -2.042170928104912, + "velocityY": -2.0262704556444535, "moduleForcesX": [ - 91.18252045297272, - 77.62580863219615, - 84.43073188208312, - 72.23833707289441 + 67.54599174060296, + 84.9037485490674, + 75.2752222728781, + 95.29586306490998 ], "moduleForcesY": [ - 70.08510741611299, - 84.80855065381793, - 78.21066685239548, - 89.57057617080244 + 93.07759399799777, + 77.61475836679602, + 86.7010154409663, + 64.1809063754542 ], - "timestamp": 7.946308608020526 + "timestamp": 8.023242409585535 }, { - "x": 2.1872057933221156, - "y": 4.565894974920919, - "heading": 2.6510971821891247, - "angularVelocity": -0.7382614912293802, - "velocityX": -1.6342751183486552, - "velocityY": -1.6182859196514365, + "x": 2.187069229591648, + "y": 4.565754778501453, + "heading": 2.668058906720778, + "angularVelocity": -0.819110965448604, + "velocityX": -1.6327513102430458, + "velocityY": -1.6182112958618466, "moduleForcesX": [ - 92.86354233827863, - 76.10788597003088, - 85.60378749942653, - 71.22089704597026 + 86.70173496470736, + 79.384018772138, + 83.43809887191118, + 76.59134612886838 ], "moduleForcesY": [ - 68.23029646989538, - 86.50055242381335, - 77.21719460477225, - 90.6427680132351 + 75.89707047860772, + 83.51024074907042, + 79.50816094167688, + 86.11608026131232 ], - "timestamp": 8.017538004874702 + "timestamp": 8.094552654253084 }, { - "x": 2.0999010385337513, - "y": 4.4794418527905195, - "heading": 2.6113303554720884, - "angularVelocity": -0.558292340990185, - "velocityX": -1.2256843191737148, - "velocityY": -1.213728122777609, + "x": 2.0998022646657093, + "y": 4.479318845326743, + "heading": 2.621053106423146, + "angularVelocity": -0.6591731737392705, + "velocityX": -1.2237647666584353, + "velocityY": -1.212111016834661, "moduleForcesX": [ - 93.27282582567618, - 75.14352562829308, - 86.26725520322118, - 71.1408153779973 + 91.96458850927135, + 76.0539395076334, + 85.67235755159176, + 72.07935631353604 ], "moduleForcesY": [ - 67.80015365809152, - 87.44982615530438, - 76.56915606002667, - 90.78923076727229 + 69.55656402670739, + 86.65433407137036, + 77.2235599704272, + 90.03678616248813 ], - "timestamp": 8.088767401728877 + "timestamp": 8.165862898920633 }, { - "x": 2.0416985533138226, - "y": 4.421807328352338, - "heading": 2.5846398593563444, - "angularVelocity": -0.374711808530201, - "velocityX": -0.817113267701592, - "velocityY": -0.8091395825823795, + "x": 2.0416569192005602, + "y": 4.421751377581397, + "heading": 2.588213851721259, + "angularVelocity": -0.4605124390609731, + "velocityX": -0.8153855836033795, + "velocityY": -0.8072818711214387, "moduleForcesX": [ - 93.42895814439328, - 74.50739015764167, - 86.68884220281498, - 71.18348402973328 + 94.28332054605062, + 73.78272693454588, + 86.89555919568178, + 70.32485404051467 ], "moduleForcesY": [ - 67.65058557937509, - 88.04747340766613, - 76.13800705299516, - 90.79681638747401 + 66.44804317305007, + 88.6490102789359, + 75.90013809981592, + 91.461556269102 ], - "timestamp": 8.159996798583052 + "timestamp": 8.237173143588182 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": -0.18854710036895178, - "velocityX": -0.40855928039119105, - "velocityY": -0.40454905992210366, + "angularVelocity": -0.2384522544000844, + "velocityX": -0.4075122325502672, + "velocityY": -0.40330579286768936, "moduleForcesX": [ - 93.54843405198021, - 74.14598545423124, - 86.92196903084317, - 71.17867844532283 + 95.62161114658021, + 72.28092066696597, + 87.6098954465452, + 69.37112285680641 ], "moduleForcesY": [ - 67.52515136113759, - 88.38488704635111, - 75.89955258668185, - 90.82487231947138 + 64.5500491439784, + 89.90999033784931, + 75.10570426878738, + 92.21350984982247 ], - "timestamp": 8.231226195437227 + "timestamp": 8.30848338825573 }, { "x": 2.012597122192382, "y": 4.392991542816162, "heading": 2.5712097631184605, - "angularVelocity": 3.1943459470198745e-23, - "velocityX": -5.469392050310526e-23, - "velocityY": -4.674764031709702e-23, + "angularVelocity": 4.422392455737567e-23, + "velocityX": -6.58083868918992e-23, + "velocityY": -7.421024279100438e-23, "moduleForcesX": [ - 93.70754772093763, - 74.0416335766594, - 86.98334831370248, - 71.06675825660123 + 96.59228734629687, + 71.44716369701295, + 87.94049500594602, + 68.61596217852527 ], "moduleForcesY": [ - 67.33114392906658, - 88.4940863558236, - 75.84771503471543, - 90.92845417388111 + 63.11798568308976, + 90.59549675575015, + 74.73839504419405, + 92.79347338693019 ], - "timestamp": 8.302455592291402 + "timestamp": 8.37979363292328 }, { - "x": 2.041953615742068, - "y": 4.378378905710642, - "heading": 2.6013063846651288, - "angularVelocity": 0.4668485846449045, - "velocityX": 0.4553679702074507, - "velocityY": -0.22666627016800736, + "x": 2.0419535184125355, + "y": 4.378378938668267, + "heading": 2.6013079982530756, + "angularVelocity": 0.46687359905252357, + "velocityX": 0.45536644581371355, + "velocityY": -0.22666575164772176, "moduleForcesX": [ - 90.31940844346734, - 86.19108550191558, - 111.0245802243277, - 113.67801849819759 + 90.31876641561897, + 86.18981380029929, + 111.02482428420288, + 113.67833215471809 ], "moduleForcesY": [ - -71.82796867166263, - -76.68979833900957, - -31.47718312544652, - -19.714913550991096 + -71.82877383631248, + -76.69122231911778, + -31.476317591030636, + -19.7130866601736 ], - "timestamp": 8.366923221703967 + "timestamp": 8.444261264410038 }, { - "x": 2.100686916805549, - "y": 4.34921431694764, - "heading": 2.661560971312702, - "angularVelocity": 0.9346487096953813, - "velocityX": 0.9110510437356681, - "velocityY": -0.45239120825061296, + "x": 2.1006867225178447, + "y": 4.349214387879551, + "heading": 2.66156424307939, + "angularVelocity": 0.934674400729164, + "velocityX": 0.9110495104411048, + "velocityY": -0.45239060465106323, "moduleForcesX": [ - 91.08357348554155, - 85.55141100459058, - 111.34346253684427, - 113.512275132038 + 91.08359939264427, + 85.55134610222815, + 111.34348432988189, + 113.51227157432788 ], "moduleForcesY": [ - -70.82047716964789, - -77.35792380941974, - -30.241251869986673, - -20.460827170514083 + -70.82043772341163, + -77.35798773989126, + -30.241157017363147, + -20.460816178917426 ], - "timestamp": 8.431390851116532 + "timestamp": 8.508728895896796 }, { - "x": 2.188828983459932, - "y": 4.30558804082172, - "heading": 2.7518665174157255, - "angularVelocity": 1.4007889994699134, - "velocityX": 1.367229840115771, - "velocityY": -0.6767159972135803, + "x": 2.1888288337503314, + "y": 4.305588083853979, + "heading": 2.751868994756181, + "angularVelocity": 1.400776631530792, + "velocityX": 1.36723048760664, + "velocityY": -0.6767164082107214, "moduleForcesX": [ - 92.22471205340607, - 84.73884598587084, - 111.77189701377915, - 113.1920358545827 + 92.22557626068495, + 84.74080845033583, + 111.77152136175108, + 113.19149333747797 ], "moduleForcesY": [ - -69.25533775826122, - -78.1610920385497, - -28.42581379359046, - -21.804600786698785 + -69.25416976459641, + -78.15894950714625, + -28.427248361937494, + -21.807364319503435 ], - "timestamp": 8.495858480529098 + "timestamp": 8.573196527383555 }, { - "x": 2.3064108263014638, - "y": 4.247619822740085, - "heading": 2.871624755946557, - "angularVelocity": 1.8576491740441008, - "velocityX": 1.8238896623460321, - "velocityY": -0.8991833360377534, + "x": 2.3064110851595947, + "y": 4.247619595905105, + "heading": 2.871619566972024, + "angularVelocity": 1.857530197001871, + "velocityX": 1.8238959412277145, + "velocityY": -0.899187493196176, "moduleForcesX": [ - 93.71262507711475, - 83.94734279206513, - 112.181194058843, - 112.51014857524359 + 93.71457960486228, + 83.95312347953696, + 112.18000941325678, + 112.50854673479259 ], "moduleForcesY": [ - -67.00490432643169, - -78.7595043102539, - -26.138048273425948, - -24.10783557177594 + -67.00210588095794, + -78.75329673294317, + -26.142969355852962, + -24.11521485261637 ], - "timestamp": 8.560326109941663 + "timestamp": 8.637664158870313 }, { - "x": 2.4249201960080744, - "y": 4.1906611165057175, - "heading": 2.9802037085519797, - "angularVelocity": 1.684239882787761, - "velocityX": 1.83827714445963, - "velocityY": -0.8835241306897914, + "x": 2.424920548824161, + "y": 4.190660759682163, + "heading": 2.9801962738348395, + "angularVelocity": 1.6842049934022552, + "velocityX": 1.838278542758427, + "velocityY": -0.8835261186017338, "moduleForcesX": [ - -0.6594868643756788, - 9.131886004968548, - -2.8295023873622442, - 7.033546413975622 + -0.6576525136461785, + 9.131767443761998, + -2.8279965006211887, + 7.026024173020117 ], "moduleForcesY": [ - 10.854211773799015, - 9.22236053293692, - -2.339354556360805, - -3.940291709407672 + 10.850457001056148, + 9.22031704495339, + -2.334560335904532, + -3.9373768454129094 ], - "timestamp": 8.624793739354228 + "timestamp": 8.702131790357072 }, { - "x": 2.5138781257306912, - "y": 4.147944154593341, - "heading": 3.06100032388245, - "angularVelocity": 1.2532896907594944, - "velocityX": 1.3798852312891103, - "velocityY": -0.6626110235728699, + "x": 2.5138783682560137, + "y": 4.147943895629665, + "heading": 3.0609951273200853, + "angularVelocity": 1.2533243679324737, + "velocityX": 1.3798834760995347, + "velocityY": -0.6626094842846958, "moduleForcesX": [ - -96.20030583423292, - -83.49735362781274, - -112.87287120033253, - -111.30688094678442 + -96.20123306665766, + -83.50128406439781, + -112.8719813672814, + -111.30567857439891 ], "moduleForcesY": [ - 63.39232613998012, - 79.26624964258414, - 22.910766035105024, - 29.07155678764673 + 63.390860409712616, + 79.26206350790233, + 22.914988055013122, + 29.076088096143998 ], - "timestamp": 8.689261368766793 + "timestamp": 8.76659942184383 }, { - "x": 2.5732044469161934, - "y": 4.119469408000457, - "heading": 3.1146935416419046, - "angularVelocity": 0.8328709811220385, - "velocityX": 0.9202497707157794, - "velocityY": -0.4416906105024887, + "x": 2.573204544665813, + "y": 4.119469300656433, + "heading": 3.1146914296651333, + "angularVelocity": 0.8329188013689777, + "velocityX": 0.9202474953959546, + "velocityY": -0.44168824441893817, "moduleForcesX": [ - -97.04105274434207, - -83.72178565794128, - -113.16925703452722, - -111.040974040282 + -97.04118666628617, + -83.7225268890319, + -113.16906929813969, + -111.0407318674197 ], "moduleForcesY": [ - 62.3384953090497, - 79.27865285910248, - 22.1639550486123, - 30.86623247761849 + 62.338271276948696, + 79.27785567094799, + 22.16486600754754, + 30.867064944590858 ], - "timestamp": 8.753728998179358 + "timestamp": 8.831067053330589 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": 0.41724990034526915, - "velocityX": 0.46014760143287403, - "velocityY": -0.22081995024741788, + "angularVelocity": 0.4172826471868358, + "velocityX": 0.46014607036910204, + "velocityY": -0.22081827805865795, "moduleForcesX": [ - -97.43168523301415, - -83.78966430984669, - -113.29850030582719, - -110.86442475699117 + -97.43147500123005, + -83.78876895559843, + -113.29868293583836, + -110.86467892511293 ], "moduleForcesY": [ - 61.806795260557664, - 79.28878914703319, - 21.754142326817426, - 31.75377302463092 + 61.807121644078244, + 79.2897292411926, + 21.753172555886724, + 31.752858683705533 ], - "timestamp": 8.818196627591924 + "timestamp": 8.895534684817347 }, { "x": 2.6028690719604484, "y": 4.105233669281006, "heading": 3.141592653589793, - "angularVelocity": -5.576115791345261e-23, - "velocityX": 4.832731708286524e-23, - "velocityY": 2.5949584810645407e-23, + "angularVelocity": -7.866247097183092e-23, + "velocityX": 6.78824268132765e-23, + "velocityY": 3.6098947052526804e-23, "moduleForcesX": [ - -97.43090964153063, - -83.72024176507091, - -113.3437528109882, - -110.92939949551028 + -97.43047601274746, + -83.71833110199685, + -113.34415942502996, + -110.92997514796726 ], "moduleForcesY": [ - 61.848085945116416, - 79.40203201217781, - 21.650429300155526, - 31.658273208510547 + 61.84876794751755, + 79.40404372307437, + 21.64829364292422, + 31.65623556989351 ], - "timestamp": 8.882664257004489 + "timestamp": 8.960002316304106 }, { - "x": 2.576440824052377, - "y": 4.117038967947073, - "heading": 3.1112264543640924, - "angularVelocity": -0.49847391634204, - "velocityX": -0.4338307912320184, - "velocityY": 0.19378893670305936, + "x": 2.576440932025781, + "y": 4.117038855996892, + "heading": 3.1112245997800225, + "angularVelocity": -0.49850434355138845, + "velocityX": -0.4338290043854107, + "velocityY": 0.19378709255352025, "moduleForcesX": [ - -96.78178208378979, - -79.65664846502794, - -114.54083675568862, - -113.52833812262094 + -96.78133854290625, + -79.65476731370306, + -114.54105043150145, + -113.52876962438683 ], "moduleForcesY": [ - 62.8559302580606, - 83.46877311897688, - 13.98107239638093, - 20.38471537731262 + 62.85661167452962, + 83.47056524407454, + 13.979310801185582, + 20.382277924872408 ], - "timestamp": 8.943582588395904 + "timestamp": 9.020920649720072 }, { - "x": 2.523633825869069, - "y": 4.140701386661653, - "heading": 3.049917147465986, - "angularVelocity": -1.00641802718103, - "velocityX": -0.8668490580283761, - "velocityY": 0.38842854316779524, + "x": 2.5236340884512134, + "y": 4.140701139163088, + "heading": 3.0499127384037488, + "angularVelocity": -1.006459926564636, + "velocityX": -0.86684649125229, + "velocityY": 0.3884263051752233, "moduleForcesX": [ - -95.85123578413562, - -79.75263731487098, - -114.32031499165952, - -113.82581248115163 + -95.85098527966763, + -79.75194362178674, + -114.32037290983277, + -113.8259581293425 ], "moduleForcesY": [ - 64.22511537248816, - 83.3321020697923, - 15.50409667268004, - 18.42234892504067 + 64.22548363003447, + 83.33275912303841, + 15.503643170599588, + 18.421403862263197 ], - "timestamp": 9.004500919787318 + "timestamp": 9.081838983136038 }, { - "x": 2.444538637133602, - "y": 4.176301641210184, - "heading": 2.956763746978034, - "angularVelocity": -1.5291522003355558, - "velocityX": -1.298380748928638, - "velocityY": 0.5843931331571143, + "x": 2.444538983723339, + "y": 4.176301351792292, + "heading": 2.956758090766189, + "angularVelocity": -1.5291726219999353, + "velocityX": -1.2983793267585322, + "velocityY": 0.5843924256121097, "moduleForcesX": [ - -94.376145734969, - -79.85703113409417, - -113.95978815112649, - -114.17093924825681 + -94.37638365733315, + -79.85830247504768, + -113.95958149721488, + -114.17069050727945 ], "moduleForcesY": [ - 66.29352669629847, - 83.13867501463098, - 17.657848513922975, - 15.629038984963607 + 66.2931720124336, + 83.13743831492843, + 17.659120262265198, + 15.630779550308647 ], - "timestamp": 9.065419251178733 + "timestamp": 9.142757316552004 }, { - "x": 2.339300712877381, - "y": 4.223965232327085, - "heading": 2.8309077343927975, - "angularVelocity": -2.065979315431076, - "velocityX": -1.7275247343865, - "velocityY": 0.7824178704214834, + "x": 2.3393008114476626, + "y": 4.223965142674428, + "heading": 2.8309060893015747, + "angularVelocity": -2.065913402542771, + "velocityX": -1.727528748317553, + "velocityY": 0.7824211236488453, "moduleForcesX": [ - -92.27983792176532, - -80.19605916572785, - -113.32380930105032, - -114.33788054491679 + -92.28142357461459, + -80.20103541951015, + -113.32310550893337, + -114.33707780014122 ], "moduleForcesY": [ - 68.94832064257966, - 82.52218385370321, - 20.593651711278582, - 12.575832251224798 + 68.94614202726282, + 82.51730402352771, + 20.59733382901846, + 12.582895501177047 ], - "timestamp": 9.126337582570148 + "timestamp": 9.20367564996797 }, { - "x": 2.235190395761607, - "y": 4.273756936630003, - "heading": 2.701317964138096, - "angularVelocity": -2.127270516030026, - "velocityX": -1.7090145894975588, - "velocityY": 0.8173517423350798, + "x": 2.235190073627775, + "y": 4.273756975831149, + "heading": 2.7013219935024604, + "angularVelocity": -2.127177296763512, + "velocityX": -1.7090214387349054, + "velocityY": 0.8173538303605644, "moduleForcesX": [ - 3.684421057917722, - 7.063912641861401, - 1.555725211536742, - 4.954961279186012 + 3.6851851769563395, + 7.061909627035633, + 1.557485144882814, + 4.951796003866703 ], "moduleForcesY": [ - 11.191987173441394, - 9.59755977851208, - 6.692902445124649, - 5.090196808915668 + 11.190702840872866, + 9.598090988387812, + 6.6913917907658425, + 5.091373059116531 ], - "timestamp": 9.187255913961563 + "timestamp": 9.264593983383936 }, { - "x": 2.157097583307559, - "y": 4.311211682575675, - "heading": 2.6044566357317396, - "angularVelocity": -1.5900193947204522, - "velocityX": -1.2819263211968914, - "velocityY": 0.6148353884648882, + "x": 2.1570972821207093, + "y": 4.3112117278174935, + "heading": 2.60446043332951, + "angularVelocity": -1.5900231464238217, + "velocityX": -1.2819259347399985, + "velocityY": 0.6148354671916831, "moduleForcesX": [ - 88.82178084722035, - 82.51336670219086, - 112.18902066417408, - 114.69665015134913 + 88.82438792099869, + 82.51888433729167, + 112.18828932823602, + 114.69599016804356 ], "moduleForcesY": [ - -73.33093047177124, - -80.15041574335498, - -26.12896176757338, - -9.217702890443773 + -73.32771655792331, + -80.14469842932267, + -26.131944406933393, + -9.225518690999772 ], - "timestamp": 9.248174245352978 + "timestamp": 9.325512316799902 }, { - "x": 2.10503433227216, - "y": 4.336216845215367, - "heading": 2.539998763051629, - "angularVelocity": -1.0581030571233867, - "velocityX": -0.854640136166579, - "velocityY": 0.41047024875037896, + "x": 2.105034195245937, + "y": 4.33621686660926, + "heading": 2.5400004915986667, + "angularVelocity": -1.0581369862943222, + "velocityX": -0.8546374129980211, + "velocityY": 0.4104698436351712, "moduleForcesX": [ - 87.93445802257567, - 83.61446769451473, - 111.92017771507034, - 114.93625421398835 + 87.93535535098103, + 83.61615888406604, + 111.91995391554177, + 114.93605502522537 ], "moduleForcesY": [ - -74.61104959107475, - -79.30871463146512, - -27.840746229308422, - -8.791324432745945 + -74.60997644793598, + -79.30691637646426, + -27.84160522062184, + -8.793781645274724 ], - "timestamp": 9.309092576744392 + "timestamp": 9.386430650215868 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -0.5296576683558465, - "velocityX": -0.4273247996047905, - "velocityY": 0.20526140282074246, + "angularVelocity": -0.5296860255780654, + "velocityX": -0.4273225360601924, + "velocityY": 0.20526104480936758, "moduleForcesX": [ - 87.47215406723147, - 84.19152726546542, - 111.75251144456588, - 115.01634601054388 + 87.47197704017128, + 84.19119924954728, + 111.75254715698382, + 115.01637354227935 ], "moduleForcesY": [ - -75.22571028375253, - -78.80193174691283, - -28.691908830480827, - -8.618963041311037 + -75.22591033857395, + -78.80227271136283, + -28.69175573980809, + -8.61852483376894 ], - "timestamp": 9.370010908135807 + "timestamp": 9.447348983631834 }, { "x": 2.0790024185180656, "y": 4.348721027374268, "heading": 2.507732901686724, - "angularVelocity": -1.1810659900072104e-23, - "velocityX": 1.1429735881849466e-23, - "velocityY": 2.3338539139201852e-23, + "angularVelocity": -1.5930760739242085e-23, + "velocityX": 1.5568104276022208e-23, + "velocityY": 3.205093369656377e-23, "moduleForcesX": [ - 87.45368989610174, - 84.1506642550139, - 111.7820465070688, - 115.05496155327525 + 87.45282015084237, + 84.14903985656558, + 111.7822513078171, + 115.05512710586952 ], "moduleForcesY": [ - -75.28457785684655, - -78.90065034494484, - -28.668166390935777, - -8.534123812406273 + -75.28558613417842, + -78.90237620597085, + -28.667363381920158, + -8.531852509603667 ], - "timestamp": 9.430929239527222 + "timestamp": 9.5082673170478 } ], "eventMarkers": [ { - "timestamp": 1.6357315017277103, + "timestamp": 1.6429852180832039, "command": { "type": "named", "data": { @@ -3141,7 +3183,7 @@ } }, { - "timestamp": 6.746975154041397, + "timestamp": 6.823262014669493, "command": { "type": "named", "data": { @@ -3150,7 +3192,7 @@ } }, { - "timestamp": 8.502455592291401, + "timestamp": 8.579793632923279, "command": { "type": "named", "data": { @@ -3159,7 +3201,7 @@ } }, { - "timestamp": 4.404598551047537, + "timestamp": 4.4624356474490465, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Blue OP.1.traj b/src/main/deploy/choreo/Blue OP.1.traj index 1207a64..fbf108f 100644 --- a/src/main/deploy/choreo/Blue OP.1.traj +++ b/src/main/deploy/choreo/Blue OP.1.traj @@ -4,9 +4,9 @@ "x": 0.7587480926513663, "y": 6.674294471740723, "heading": -2.1045042248017936, - "angularVelocity": 1.5246049853933737e-25, - "velocityX": -2.0272981672250602e-24, - "velocityY": -2.368851786462168e-25, + "angularVelocity": 1.974529983201505e-22, + "velocityX": 1.3949524343162162e-20, + "velocityY": 1.7216480334359217e-21, "moduleForcesX": [ 0, 0, @@ -22,214 +22,214 @@ "timestamp": 0 }, { - "x": 0.8024207657231025, - "y": 6.679677617673034, - "heading": -2.1177141826984873, - "angularVelocity": -0.17911083631788266, - "velocityX": 0.5921479129069698, - "velocityY": 0.0729888601839491, + "x": 0.8024205497601767, + "y": 6.679677689320791, + "heading": -2.117721058110864, + "angularVelocity": -0.1792040409939818, + "velocityX": 0.592144926929208, + "velocityY": 0.07298982451690292, "moduleForcesX": [ - 114.49845914960216, - 111.52415378273294, - 115.39645209570612, - 114.62304761463147 + 114.49839415532603, + 111.52193059132293, + 115.39636467253322, + 114.62307907253539 ], "moduleForcesY": [ - 14.302632979180666, - 29.647246899745284, - -1.1737539863505286, - 13.436170515363187 + 14.30298485898657, + 29.655557879336452, + -1.181353158922053, + 13.435844022960593 ], - "timestamp": 0.07375297982110329 + "timestamp": 0.07375298701838148 }, { - "x": 0.8897572775547896, - "y": 6.690442536464301, - "heading": -2.1442928098503233, - "angularVelocity": -0.3603736041080037, - "velocityX": 1.1841760433752269, - "velocityY": 0.14595910317628294, + "x": 0.8897567314254748, + "y": 6.690442727379406, + "heading": -2.144310167069316, + "angularVelocity": -0.3605156893757417, + "velocityX": 1.184171451164837, + "velocityY": 0.14596070605154757, "moduleForcesX": [ - 114.41456026220696, - 111.50844636902374, - 115.37690823700737, - 114.64994745113319 + 114.41445099721368, + 111.50730603264704, + 115.37684481502328, + 114.6499789417417 ], "moduleForcesY": [ - 14.788729002822109, - 29.631929160379446, - -1.281113395748738, - 13.05841362930543 + 14.789343949904026, + 29.636133156128125, + -1.2850231166131485, + 13.057990695853633 ], - "timestamp": 0.14750595964220659 + "timestamp": 0.14750597403676297 }, { - "x": 1.020739829952666, - "y": 6.706587085965137, - "heading": -2.184566868757912, - "angularVelocity": -0.5460668708610559, - "velocityX": 1.7759628521530972, - "velocityY": 0.21890030124879628, + "x": 1.0207390149953617, + "y": 6.706587400459137, + "heading": -2.184592527891774, + "angularVelocity": -0.5461793813506001, + "velocityX": 1.775959033865869, + "velocityY": 0.2189019554653092, "moduleForcesX": [ - 114.27773305577186, - 111.46040731354765, - 115.34136867400807, - 114.68449962172555 + 114.27765420928105, + 111.46108154508879, + 115.34135846330668, + 114.68446600714897 ], "moduleForcesY": [ - 15.525374011394451, - 29.68197180848282, - -1.5144551853010968, - 12.482698846734147 + 15.525601814683363, + 29.679266789583505, + -1.5118713708450173, + 12.482626306329042 ], - "timestamp": 0.22125893946330988 + "timestamp": 0.22125896105514445 }, { - "x": 1.1953286514334718, - "y": 6.7281056267189525, - "heading": -2.239127367508517, - "angularVelocity": -0.7397734828199135, - "velocityX": 2.3672104083698327, - "velocityY": 0.29176503520279534, + "x": 1.1953280076893775, + "y": 6.728105972585149, + "heading": -2.23914640818786, + "angularVelocity": -0.7396836725065663, + "velocityX": 2.3672124988036476, + "velocityY": 0.2917654320990209, "moduleForcesX": [ - 114.047317314268, - 111.33731276290986, - 115.26103974744757, - 114.70303402913382 + 114.04761304875296, + 111.34169862631441, + 115.26119474678515, + 114.70270359118508 ], "moduleForcesY": [ - 16.537440340405908, - 29.85222721217794, - -1.9511492781751685, - 11.678182443826518 + 16.534704753620296, + 29.835398318882216, + -1.9345387090443167, + 11.680162554712453 ], - "timestamp": 0.29501191928441317 + "timestamp": 0.29501194807352593 }, { - "x": 1.4133617748282827, - "y": 6.754973444774636, - "heading": -2.3095237263100015, - "angularVelocity": -0.95448833351872, - "velocityX": 2.956261888315244, - "velocityY": 0.3642946782740959, + "x": 1.4133630444925243, + "y": 6.754973345333406, + "heading": -2.309476126798875, + "angularVelocity": -0.9535846811666981, + "velocityX": 2.956287543293751, + "velocityY": 0.364288604901666, "moduleForcesX": [ - 113.4372446028584, - 110.7664793158522, - 114.9120784501825, - 114.5415955789105 + 113.43975897922057, + 110.78310373820221, + 114.91309615963543, + 114.53954300836372 ], "moduleForcesY": [ - 18.019343819168103, - 30.725491734044468, - -3.316928025724304, - 10.430723288375912 + 18.000125302132677, + 30.662429048736804, + -3.2520872885591716, + 10.443175232183405 ], - "timestamp": 0.36876489910551646 + "timestamp": 0.36876493509190744 }, { - "x": 1.5879369987940704, - "y": 6.77647174900219, - "heading": -2.368159117892291, - "angularVelocity": -0.795024034615507, - "velocityX": 2.367026042734014, - "velocityY": 0.2914906527126038, + "x": 1.5879382087995237, + "y": 6.776471593869833, + "heading": -2.368115423553959, + "angularVelocity": -0.7950769063830508, + "velocityX": 2.3670250028448327, + "velocityY": 0.2914898691638042, "moduleForcesX": [ - -113.21740142392868, - -111.67454146499207, - -114.66905825851462, - -114.23838580721045 + -113.2226233248531, + -111.69180132345564, + -114.66860726835483, + -114.23686977658001 ], "moduleForcesY": [ - -17.63441497120967, - -26.071917316634075, - -1.551746692059195, - -10.811867231610922 + -17.60948253721816, + -26.00046807992614, + -1.626211087567619, + -10.829705083256428 ], - "timestamp": 0.44251787892661976 + "timestamp": 0.44251792211028895 }, { - "x": 1.7188926416265469, - "y": 6.792594475814811, - "heading": -2.4126844087531345, - "angularVelocity": -0.6037083649887068, - "velocityX": 1.7755979914320064, - "velocityY": 0.21860441234684702, + "x": 1.7188933932708355, + "y": 6.7925943671930265, + "heading": -2.412657668211584, + "angularVelocity": -0.6039381787550379, + "velocityX": 1.77559160334311, + "velocityY": 0.21860502164033385, "moduleForcesX": [ - -113.62556481771135, - -111.7658115885291, - -115.24093186284539, - -114.85540369095075 + -113.62660597529599, + -111.76902146309568, + -115.24105907142824, + -114.85509991104112 ], "moduleForcesY": [ - -19.05291831548316, - -28.10437611160287, - 0.7546034880784179, - -9.730572920361043 + -19.047183440095544, + -28.09175703488534, + 0.7411160901554255, + -9.734361300742805 ], - "timestamp": 0.516270858747723 + "timestamp": 0.5162709091286705 }, { - "x": 1.8062052429501583, - "y": 6.8033423608281804, - "heading": -2.442538059640397, - "angularVelocity": -0.4047789114375592, - "velocityX": 1.1838518461952148, - "velocityY": 0.14572814602799694, + "x": 1.8062055290223964, + "y": 6.8033423167589095, + "heading": -2.442527969545906, + "angularVelocity": -0.40500463156668004, + "velocityX": 1.183845418081848, + "velocityY": 0.14572900705980607, "moduleForcesX": [ - -113.62956435917394, - -111.79320392724135, - -115.33065660328327, - -114.97926679056616 + -113.62959134846822, + -111.79313493848042, + -115.33066788879077, + -114.97928385607841 ], "moduleForcesY": [ - -19.66367922942835, - -28.377381938028666, - 1.1672848935603133, - -9.251806083394865 + -19.663623460013877, + -28.377715570036685, + 1.1677274772719308, + -9.251771451433386 ], - "timestamp": 0.5900238385688263 + "timestamp": 0.590023896147052 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": -0.2026753043980138, - "velocityX": 0.5919727585178589, - "velocityY": 0.07286398915017842, + "angularVelocity": -0.2028120939192107, + "velocityX": 0.591968821960951, + "velocityY": 0.07286457956489104, "moduleForcesX": [ - -113.62366087491984, - -111.8118673061885, - -115.36748176404835, - -115.03206722044585 + -113.62315026046187, + -111.81031262941312, + -115.36741290735165, + -115.03223801565095 ], "moduleForcesY": [ - -19.953358992688422, - -28.459057623857348, - 1.3182086277736604, - -9.022048294829789 + -19.956291338037666, + -28.465206698015184, + 1.3250680498487681, + -9.020029236683413 ], - "timestamp": 0.6637768183899296 + "timestamp": 0.6637768831654335 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": 1.6375349145968543e-23, - "velocityX": -8.416190090857964e-24, - "velocityY": -1.1457822086284433e-23, + "angularVelocity": 2.5664532387064434e-20, + "velocityX": 3.58109733081458e-20, + "velocityY": -1.9250395612999744e-19, "moduleForcesX": [ - -113.64454489492644, - -111.8226539019644, - -115.38802821587312, - -115.05199065534637 + -113.6437450585874, + -111.82024353932489, + -115.38791059104989, + -115.05224225386623 ], "moduleForcesY": [ - -19.97282399859899, - -28.500501780206434, - 1.3651700292396303, - -9.007971358764731 + -19.977376009298773, + -28.509989738927217, + 1.375687108873998, + -9.00489770006138 ], - "timestamp": 0.7375297982110329 + "timestamp": 0.737529870183815 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue OP.2.traj b/src/main/deploy/choreo/Blue OP.2.traj index cfd43ef..268ba75 100644 --- a/src/main/deploy/choreo/Blue OP.2.traj +++ b/src/main/deploy/choreo/Blue OP.2.traj @@ -4,400 +4,400 @@ "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": 1.6375349145968543e-23, - "velocityX": -8.416190090857964e-24, - "velocityY": -1.1457822086284433e-23, + "angularVelocity": 2.5664532387064434e-20, + "velocityX": 3.58109733081458e-20, + "velocityY": -1.9250395612999744e-19, "moduleForcesX": [ - -113.64454489492644, - -111.8226539019644, - -115.38802821587312, - -115.05199065534637 + -113.6437450585874, + -111.82024353932489, + -115.38791059104989, + -115.05224225386623 ], "moduleForcesY": [ - -19.97282399859899, - -28.500501780206434, - 1.3651700292396303, - -9.007971358764731 + -19.977376009298773, + -28.509989738927217, + 1.375687108873998, + -9.00489770006138 ], "timestamp": 0 }, { - "x": 1.8645573299347353, - "y": 6.813379455407895, - "heading": -2.4698373821559474, - "angularVelocity": -0.28012842601201615, - "velocityX": 0.33322011263133106, - "velocityY": 0.10575980127060347, + "x": 1.8645723712913458, + "y": 6.813251052040291, + "heading": -2.470362048205509, + "angularVelocity": -0.291937481479346, + "velocityX": 0.33345810585500346, + "velocityY": 0.10281582797868585, "moduleForcesX": [ - 101.74059915261986, - 98.66143888298554, - 115.33460700108112, - 113.5288649606166 + 101.77209540362661, + 98.56104344072968, + 115.34193264889893, + 113.76419860866353 ], "moduleForcesY": [ - 54.28404650214983, - 59.78500771311867, - 1.6254648649670587, - 20.548862722674198 + 54.21915011775309, + 59.95036989637321, + -0.9665078147579121, + 19.20688681592282 ], - "timestamp": 0.04409197258516573 + "timestamp": 0.04410561077790165 }, { - "x": 1.8940046755751128, - "y": 6.822611735205374, - "heading": -2.494018140417116, - "angularVelocity": -0.5484163407400852, - "velocityX": 0.6678618332055473, - "velocityY": 0.20938686241916526, + "x": 1.8940483404923603, + "y": 6.82225224455195, + "heading": -2.4955113925338255, + "angularVelocity": -0.5702073700998803, + "velocityX": 0.6683042969168801, + "velocityY": 0.20408270859191144, "moduleForcesX": [ - 102.42692626434818, - 99.75522587908064, - 115.3031246958328, - 113.61159697879017 + 102.41667407252245, + 99.67413943343911, + 115.33090537915734, + 113.80517697131701 ], "moduleForcesY": [ - 52.94923017342802, - 57.91883634702496, - 2.6054576839940773, - 20.022389058972593 + 52.96303310230837, + 58.05771513935198, + 0.5017832153094849, + 18.8925777650309 ], - "timestamp": 0.08818394517033146 + "timestamp": 0.0882112215558033 }, { - "x": 1.9382790700934251, - "y": 6.836296863592373, - "heading": -2.529422828329192, - "angularVelocity": -0.8029735536029945, - "velocityX": 1.0041373048754911, - "velocityY": 0.3103768687274161, + "x": 1.9383627444187277, + "y": 6.835636025102196, + "heading": -2.5322232607638195, + "angularVelocity": -0.8323627670606444, + "velocityX": 1.0047339362222991, + "velocityY": 0.3034484800049092, "moduleForcesX": [ - 103.17292508176737, - 101.05043111896798, - 115.25417706262766, - 113.72399441780098 + 103.11790484339456, + 100.9913251526931, + 115.29193191628325, + 113.86495520158225 ], "moduleForcesY": [ - 51.44579662555791, - 55.5992638735599, - 3.7639229891020305, - 19.289785821379215 + 51.549723350324314, + 55.70508515812473, + 2.2745321495904243, + 18.4374521698026 ], - "timestamp": 0.13227591775549719 + "timestamp": 0.13231683233370495 }, { - "x": 1.9974657259317126, - "y": 6.854289480670813, - "heading": -2.575283812457909, - "angularVelocity": -1.0401209435602916, - "velocityX": 1.3423453832546357, - "velocityY": 0.40807013212408666, + "x": 1.9975977513861578, + "y": 6.853299205917846, + "heading": -2.5795808332318555, + "angularVelocity": -1.0737312471764597, + "velocityX": 1.343026565615775, + "velocityY": 0.4004746902745723, "moduleForcesX": [ - 104.09282628417806, - 102.57468929953592, - 115.17640973922875, - 113.84725221188148 + 104.00399188740997, + 102.53916594922732, + 115.20317523209397, + 113.91900928393956 ], "moduleForcesY": [ - 49.51402786048951, - 52.6952744682404, - 5.208253519163967, - 18.43423684287415 + 49.69364802883043, + 52.761241240453266, + 4.521635796707419, + 17.977297280367612 ], - "timestamp": 0.17636789034066291 + "timestamp": 0.1764224431116066 }, { - "x": 2.0716675976705656, - "y": 6.876403676556319, - "heading": -2.6305587835600814, - "angularVelocity": -1.2536289002585739, - "velocityX": 1.6828884576558427, - "velocityY": 0.5015469843811484, + "x": 2.0718517640541934, + "y": 6.875112546792885, + "heading": -2.6363209715548055, + "angularVelocity": -1.2864607772619008, + "velocityX": 1.68355026397765, + "velocityY": 0.4945706564383518, "moduleForcesX": [ - 105.32254762054376, - 104.36995920291493, - 115.04927896233586, - 113.95741323469908 + 105.22540646754383, + 104.36005213468499, + 115.02101774687753, + 113.9321163834877 ], "moduleForcesY": [ - 46.78241555241346, - 48.987831626883, - 7.070518349276243, - 17.579302576575984 + 46.99284585116888, + 49.00253104776336, + 7.461228629108369, + 17.723543700297594 ], - "timestamp": 0.22045986292582864 + "timestamp": 0.22052805388950825 }, { - "x": 2.1610104299094206, - "y": 6.902392060853308, - "heading": -2.6937619082154276, - "angularVelocity": -1.4334383550943628, - "velocityX": 2.026283402637177, - "velocityY": 0.5894130557845074, + "x": 2.161242587426491, + "y": 6.900907275957239, + "heading": -2.7006222468278853, + "angularVelocity": -1.457893318763349, + "velocityX": 2.026744937791125, + "velocityY": 0.5848400851820307, "moduleForcesX": [ - 107.01525529263431, - 106.49908090238071, - 114.83695790685456, - 114.02178183246805 + 106.94884746449395, + 106.5218821791462, + 114.66217685453101, + 113.84546391040449 ], "moduleForcesY": [ - 42.68370625113585, - 44.08136979291938, - 9.506207591539834, - 16.920785278182457 + 42.83996232103603, + 44.012594395755336, + 11.3684923546982, + 18.031148465609068 ], - "timestamp": 0.26455183551099437 + "timestamp": 0.2646336646674098 }, { - "x": 2.2656466233828794, - "y": 6.9319034624003555, - "heading": -2.762683277508738, - "angularVelocity": -1.5631273733599858, - "velocityX": 2.373134775754236, - "velocityY": 0.669314612541883, + "x": 2.2659063963289214, + "y": 6.930444659197214, + "heading": -2.769745236736348, + "angularVelocity": -1.5672153426587598, + "velocityX": 2.3730270833222504, + "velocityY": 0.6696967283529638, "moduleForcesX": [ - 109.3097818040482, - 109.05079129956879, - 114.47840264239278, - 113.98678875725696 + 109.32029884870086, + 109.13072597484648, + 113.97055609730337, + 113.53294594518619 ], "moduleForcesY": [ - 36.26992503225889, - 37.16921771819769, - 12.695311902448834, - 16.797454949385287 + 36.22279873439688, + 36.90107882775041, + 16.5960539736341, + 19.561487229518903 ], - "timestamp": 0.3086438080961602 + "timestamp": 0.30873927544531143 }, { - "x": 2.3857485172054367, - "y": 6.964387520079728, - "heading": -2.833836246946023, - "angularVelocity": -1.6137397640772295, - "velocityX": 2.7238947767776653, - "velocityY": 0.7367340532707757, + "x": 2.385976040231636, + "y": 6.963340036530722, + "heading": -2.8392855150204563, + "angularVelocity": -1.5766764603779193, + "velocityX": 2.7223213052722013, + "velocityY": 0.745832032553765, "moduleForcesX": [ - 112.18021841591916, - 112.08031010757401, - 113.86796827837568, - 113.7324954323066 + 112.2912152633114, + 112.27314779878, + 112.64475573276908, + 112.62446776737102 ], "moduleForcesY": [ - 25.791337814688198, - 26.310541605673688, - 16.866370546912208, - 17.883772198148773 + 25.270849603483, + 25.368770069311715, + 23.647404391327054, + 23.76274258091671 ], - "timestamp": 0.35273578068132605 + "timestamp": 0.3528448862232131 }, { "x": 2.521431007385253, "y": 6.998851299285889, "heading": -2.9010585246753755, - "angularVelocity": -1.5245922055201655, - "velocityX": 3.0772606037922094, - "velocityY": 0.7816338708727879, + "angularVelocity": -1.4005703257570408, + "velocityX": 3.0711504673568135, + "velocityY": 0.8051416164258121, "moduleForcesX": [ - 114.74700757937691, - 114.82237403261927, - 112.7959826533612, - 112.85254185437864 + 114.82492813620281, + 114.88838435677178, + 110.01547367885281, + 109.50587966957572 ], "moduleForcesY": [ - 7.799925169065962, - 5.71704619443321, - 22.434461113364915, - 21.890043385783073 + 6.353046745851063, + 1.804812129477414, + 33.46666656638843, + 34.75647703160566 ], - "timestamp": 0.3968277532664919 + "timestamp": 0.39695049700111473 }, { - "x": 2.7542359720828538, - "y": 7.049557069939888, - "heading": -2.9616079641492825, - "angularVelocity": -0.9309010044100505, - "velocityX": 3.5791970553589567, - "velocityY": 0.7795621766496205, + "x": 2.7517129998548477, + "y": 7.053740973657355, + "heading": -2.9299259625172533, + "angularVelocity": -0.44310544982727984, + "velocityX": 3.534751037459037, + "velocityY": 0.8425380176261076, "moduleForcesX": [ - 112.55785468074943, - 105.9003453021406, - 110.9158025657128, - 108.95118327774631 + 112.165519313163, + 97.3293226757896, + 104.13823940579273, + 90.56768367714263 ], "moduleForcesY": [ - -23.892019604957188, - -44.548813535547104, - 30.50757452772647, - 36.124113744915036 + -25.633925874682376, + -60.862728439826846, + 48.85031849268756, + 70.25124390629986 ], - "timestamp": 0.4618716614662468 + "timestamp": 0.46209850602048064 }, { - "x": 2.991519490805528, - "y": 7.083413324629865, - "heading": -2.909884331471312, - "angularVelocity": 0.7952110214398992, - "velocityX": 3.64805137467998, - "velocityY": 0.5205138440636553, + "x": 2.9893225118438314, + "y": 7.084433906415846, + "heading": -2.911583132722001, + "angularVelocity": 0.28155626044994303, + "velocityX": 3.647225994555773, + "velocityY": 0.47112618206602574, "moduleForcesX": [ - 64.05615636732261, - -9.943360980696, - 108.07396127616549, - -102.05846309668742 + 50.32031969204731, + 2.9715371277548317, + 70.95695667054349, + -26.18494851299261 ], "moduleForcesY": [ - -93.25868171164622, - -112.65864909231036, - 15.439504342633711, - -35.740867487525705 + -89.36908292050751, + -102.27224679452215, + -51.59319249987694, + -80.58938519969574 ], - "timestamp": 0.5269155696660017 + "timestamp": 0.5272465150398465 }, { - "x": 3.195322835474054, - "y": 7.110151219170366, - "heading": -2.8543773726780923, - "angularVelocity": 0.853376747023774, - "velocityX": 3.1333194807825833, - "velocityY": 0.4110745384239114, + "x": 3.1939494569939986, + "y": 7.110014029553321, + "heading": -2.8635537159447884, + "angularVelocity": 0.7372353737308496, + "velocityX": 3.140954700385925, + "velocityY": 0.3926462761105286, "moduleForcesX": [ - -111.67573063214597, - -111.64039245061323, - -113.12917537886882, - -113.05374138509698 + -105.50415195458451, + -107.29038544493396, + -113.70906001277702, + -114.90061482209744 ], "moduleForcesY": [ - -27.135696145803198, - -27.380417914842752, - -20.25362840349164, - -20.80013262963885 + -44.920279415393765, + -41.12412783239419, + 15.269282404331058, + 2.3506230724880606 ], - "timestamp": 0.5919594778657566 + "timestamp": 0.5923945240592124 }, { - "x": 3.365241247233326, - "y": 7.131608923168945, - "heading": -2.8041832186816547, - "angularVelocity": 0.771696464521897, - "velocityX": 2.6123647311818834, - "velocityY": 0.3298956749751184, + "x": 3.364445667071558, + "y": 7.131108704498771, + "heading": -2.8137277276796153, + "angularVelocity": 0.7648121410795733, + "velocityX": 2.6170594104707225, + "velocityY": 0.3237961568276881, "moduleForcesX": [ - -114.39486717948931, - -114.5610194383314, - -112.89574776865837, - -113.08162800775546 + -114.00926980580653, + -113.95000686208216, + -114.43257923429907, + -114.37824029202251 ], "moduleForcesY": [ - -13.756071322380523, - -12.147523599218845, - -23.00273023368437, - -21.98460196366896 + -16.39731013290224, + -16.845089796422634, + -13.13574167848894, + -13.650410305482065 ], - "timestamp": 0.6570033860655116 + "timestamp": 0.6575425330785784 }, { - "x": 3.5012046297910944, - "y": 7.148379691490802, - "heading": -2.7621717710255616, - "angularVelocity": 0.6458936558220414, - "velocityX": 2.0903323050671294, - "velocityY": 0.2578376482291464, + "x": 3.500788039986836, + "y": 7.147889974863427, + "heading": -2.769405830231833, + "angularVelocity": 0.6803262005229909, + "velocityX": 2.09280951125836, + "velocityY": 0.25758684904197354, "moduleForcesX": [ - -114.86715102435959, - -115.09723127896024, - -112.75876113770701, - -113.1512196778291 + -114.81105309086456, + -114.97790928984212, + -113.51984327567992, + -113.7704647676614 ], "moduleForcesY": [ - -10.065224665337308, - -6.694150425031611, - -24.086273621516757, - -22.080340952979487 + -10.56866698989057, + -8.413922151143787, + -20.14217381557191, + -18.60133702632721 ], - "timestamp": 0.7220472942652665 + "timestamp": 0.7226905420979443 }, { - "x": 3.603189035556874, - "y": 7.1607529171336655, - "heading": -2.729703667472547, - "angularVelocity": 0.49917208931084384, - "velocityX": 1.5679317031900575, - "velocityY": 0.19022881596942023, + "x": 3.603006546144034, + "y": 7.16043119839742, + "heading": -2.733913758650608, + "angularVelocity": 0.5447913468955666, + "velocityX": 1.5690196476582279, + "velocityY": 0.19250355801766228, "moduleForcesX": [ - -115.03722833246768, - -115.27036043262517, - -112.665644218642, - -113.22264635282365 + -115.0419243067659, + -115.25718411477271, + -112.93907410546888, + -113.43999532206205 ], "moduleForcesY": [ - -8.482092446228055, - -3.8979414954172227, - -24.715945351408653, - -21.94466991910266 + -8.366260966557782, + -4.184211702175365, + -23.417109666661702, + -20.7767741687879 ], - "timestamp": 0.7870912024650214 + "timestamp": 0.7878385511173102 }, { - "x": 3.671183447453962, - "y": 7.168899399845526, - "heading": -2.7075665515768197, - "angularVelocity": 0.3403411096968915, - "velocityX": 1.0453617222426475, - "velocityY": 0.12524589830676436, + "x": 3.671130056542355, + "y": 7.168770766708615, + "heading": -2.709133399652067, + "angularVelocity": 0.3803701658967712, + "velocityX": 1.04567294417345, + "velocityY": 0.12800956524573953, "moduleForcesX": [ - -115.1220732972316, - -115.34180830581067, - -112.60054698627378, - -113.27936411804733 + -115.14281844208664, + -115.34930465283051, + -112.55115361335105, + -113.24852185391627 ], "moduleForcesY": [ - -7.623094959817519, - -2.2058871322717164, - -25.12574554620353, - -21.792793628817755 + -7.285612760344089, + -1.6624491289950194, + -25.340251738278866, + -21.942249710998937 ], - "timestamp": 0.8521351106647763 + "timestamp": 0.8529865601366761 }, { - "x": 3.70518211364746, + "x": 3.7051821136474588, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 0.17334260390221154, - "velocityX": 0.5227033112629946, - "velocityY": 0.062000397052170114, + "angularVelocity": 0.19711620790671266, + "velocityX": 0.5226876096087982, + "velocityY": 0.06387580117578412, "moduleForcesX": [ - -115.17526382073036, - -115.37550458711, - -112.55684919025829, - -113.31339825214359 + -115.20102163601169, + -115.37974072229976, + -112.28107877840189, + -113.11488966367791 ], "moduleForcesY": [ - -7.042007188765662, - -1.080500824591024, - -25.396097743199658, - -21.71168485805974 + -6.608776467019436, + -0.004287565573965457, + -26.587848089395084, + -22.715577580127167 ], - "timestamp": 0.9171790188645312 + "timestamp": 0.918134569156042 }, { "x": 3.70518211364746, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 3.993262685913717e-22, - "velocityX": -8.259434242676659e-22, - "velocityY": -8.025539423896893e-21, + "angularVelocity": 4.3308234278847845e-20, + "velocityX": 8.056096608901281e-20, + "velocityY": -2.6738378957205373e-19, "moduleForcesX": [ - -115.2157166646866, - -115.39271629885711, - -112.5314849425636, - -113.32030793770696 + -115.24383423254851, + -115.38688887330075, + -112.09250755639515, + -112.9939218228949 ], "moduleForcesY": [ - -6.549472740050475, - -0.2866941492311489, - -25.56167956840566, - -21.745134141493214 + -6.0471361581514245, + 1.155635277233433, + -27.42405623065836, + -23.37602173859363 ], - "timestamp": 0.9822229270642862 + "timestamp": 0.9832825781754079 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue OP.3.traj b/src/main/deploy/choreo/Blue OP.3.traj index 76b0a04..4ce6b51 100644 --- a/src/main/deploy/choreo/Blue OP.3.traj +++ b/src/main/deploy/choreo/Blue OP.3.traj @@ -4,484 +4,484 @@ "x": 3.70518211364746, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 3.993262685913717e-22, - "velocityX": -8.259434242676659e-22, - "velocityY": -8.025539423896893e-21, + "angularVelocity": 4.3308234278847845e-20, + "velocityX": 8.056096608901281e-20, + "velocityY": -2.6738378957205373e-19, "moduleForcesX": [ - -115.2157166646866, - -115.39271629885711, - -112.5314849425636, - -113.32030793770696 + -115.24383423254851, + -115.38688887330075, + -112.09250755639515, + -112.9939218228949 ], "moduleForcesY": [ - -6.549472740050475, - -0.2866941492311489, - -25.56167956840566, - -21.745134141493214 + -6.0471361581514245, + 1.155635277233433, + -27.42405623065836, + -23.37602173859363 ], "timestamp": 0 }, { - "x": 3.7327722712749694, - "y": 7.174709038499013, - "heading": -2.7134141974114816, - "angularVelocity": -0.2913880585511265, - "velocityX": 0.46952431836436115, - "velocityY": 0.03023880186314412, + "x": 3.733781754166325, + "y": 7.174820039076195, + "heading": -2.7170402757017182, + "angularVelocity": -0.3458966849026198, + "velocityX": 0.47678005649515276, + "velocityY": 0.03147273207971763, "moduleForcesX": [ - 113.03432284252689, - 111.63376359219197, - 113.87965459197578, - 115.30641606592077 + 112.32377906856806, + 110.78430493237788, + 113.12589486821226, + 115.23706895839639 ], "moduleForcesY": [ - 23.049027164974643, - 29.185604964347963, - -18.522278194463343, - -4.4827583754706755 + 26.289960305975715, + 32.271465274484434, + -22.685214004024196, + -6.074152668020877 ], - "timestamp": 0.058761935321311354 + "timestamp": 0.05998497657201396 }, { - "x": 3.78798662671582, - "y": 7.178230603874502, - "heading": -2.746994385755768, - "angularVelocity": -0.5714615790080665, - "velocityX": 0.9396279264618796, - "velocityY": 0.0599293633920152, + "x": 3.7910470948922277, + "y": 7.178545444277794, + "heading": -2.7574326569967935, + "angularVelocity": -0.6733749615886386, + "velocityX": 0.9546613835408172, + "velocityY": 0.06210563735280476, "moduleForcesX": [ - 113.08025540759344, - 111.9745660585701, - 114.07142344583939, - 115.2878683815402 + 112.46001862879739, + 111.34041034625368, + 113.49633756841048, + 115.21709287532448 ], "moduleForcesY": [ - 22.75020026715537, - 27.798664214369406, - -17.204952975290553, - -4.644259008501021 + 25.636303420097065, + 30.249349366921713, + -20.667196776630867, + -6.2116432185372705 ], - "timestamp": 0.11752387064262271 + "timestamp": 0.11996995314402792 }, { - "x": 3.8708665679135543, - "y": 7.183456533131369, - "heading": -2.7961591284850487, - "angularVelocity": -0.8366767101942216, - "velocityX": 1.4104358671058923, - "velocityY": 0.088933920033307, + "x": 3.8770597022586974, + "y": 7.184048443151815, + "heading": -2.8159476506282473, + "angularVelocity": -0.97549414829236, + "velocityX": 1.4339024916215242, + "velocityY": 0.09173961862625027, "moduleForcesX": [ - 113.13856392421164, - 112.39241209224183, - 114.30163807419474, - 115.26232496995145 + 112.65201576445827, + 112.01287501883925, + 113.94247486613867, + 115.19409328267592 ], "moduleForcesY": [ - 22.361639151859006, - 25.984522474314716, - -15.454500356764035, - -4.855118557125547 + 24.690234496665077, + 27.58289113859666, + -17.909106058656565, + -6.303104707024021 ], - "timestamp": 0.17628580596393406 + "timestamp": 0.17995492971604188 }, { - "x": 3.981466671816221, - "y": 7.1903382613240066, - "heading": -2.859580630572741, - "angularVelocity": -1.0792956654831463, - "velocityX": 1.8821725883925222, - "velocityY": 0.11711200720343934, + "x": 3.991926797311324, + "y": 7.191263389762513, + "heading": -2.8901833767362453, + "angularVelocity": -1.2375719780247907, + "velocityX": 1.914931064692922, + "velocityY": 0.12027922695006076, "moduleForcesX": [ - 113.27691583678147, - 112.89842492883132, - 114.5802390264178, - 115.23714227829124 + 113.02354769728046, + 112.81041180905633, + 114.47046500698897, + 115.18961505698348 ], "moduleForcesY": [ - 21.51009445696987, - 23.572724562516772, - -12.981065814635985, - -4.864096919796839 + 22.79359621013854, + 23.989273941713172, + -13.892228757886805, + -5.866006661430295 ], - "timestamp": 0.23504774128524542 + "timestamp": 0.23993990628805584 }, { - "x": 4.119861588330392, - "y": 7.198818881382969, - "heading": -2.935024943967934, - "angularVelocity": -1.2838976964026465, - "velocityX": 2.3551796883037346, - "velocityY": 0.14432166014599293, + "x": 4.135787380780922, + "y": 7.200124822376675, + "heading": -2.975989704811233, + "angularVelocity": -1.4304636423750967, + "velocityX": 2.3982768968308075, + "velocityY": 0.14772753313528372, "moduleForcesX": [ - 113.59238050873091, - 113.50883091034551, - 114.89486558850359, - 115.2246253766407 + 113.71654311369024, + 113.7421275367746, + 115.0022414818884, + 115.22737898976276 ], "moduleForcesY": [ - 19.545611913909962, - 20.215865610819638, - -9.292159419632293, - -4.1677749943057485 + 18.78236752442223, + 18.819926926426316, + -7.74740103881101, + -3.863631013963341 ], - "timestamp": 0.293809676606557 + "timestamp": 0.2999248828600696 }, { - "x": 4.2861478472017795, - "y": 7.20882879407445, - "heading": -3.0183525114528353, - "angularVelocity": -1.4180534903975592, - "velocityX": 2.829829513989471, - "velocityY": 0.1703468859006533, + "x": 4.308777368553381, + "y": 7.210562916135439, + "heading": -3.0653657545339787, + "angularVelocity": -1.4899739039732145, + "velocityX": 2.8838885610762834, + "velocityY": 0.17401180020855808, "moduleForcesX": [ - 114.20109143791724, - 114.24355796594509, - 115.14763181288494, - 115.21632171398483 + 114.74211551098469, + 114.76126852409652, + 115.16168855405087, + 115.1687730331768 ], "moduleForcesY": [ - 15.09888258206903, - 15.001571052472123, - -3.4085278625123507, - -1.5352801286814852 + 10.07031433544062, + 10.008825147658575, + 2.247411863424039, + 2.562462854663516 ], - "timestamp": 0.35257161192786857 + "timestamp": 0.35990985943208353 }, { - "x": 4.480372914613033, - "y": 7.22024637414857, - "heading": -3.100297234740481, - "angularVelocity": -1.394520497658391, - "velocityX": 3.305287110596799, - "velocityY": 0.19430231512437993, + "x": 4.510499605188572, + "y": 7.222385830186037, + "heading": -3.1376440847719658, + "angularVelocity": -1.2049405429243567, + "velocityX": 3.36287931017223, + "velocityY": 0.19709791894983528, "moduleForcesX": [ - 114.97889469256124, - 114.97100473665363, - 114.82552416001533, - 114.8139912747789 + 114.49070976762584, + 114.0438403664486, + 113.11098060490103, + 111.91885906316108 ], "moduleForcesY": [ - 4.253087696650956, - 4.242749140548247, - 7.3045456282466565, - 7.355545167868178 + -11.072443207695146, + -14.076136858622377, + 20.922368283411416, + 26.086845583350566 ], - "timestamp": 0.41133354724918014 + "timestamp": 0.4198948360040975 }, { - "x": 4.7002342564486375, - "y": 7.23241969553516, - "heading": -3.140917676775582, - "angularVelocity": -0.6912713445019829, - "velocityX": 3.741560597577289, - "velocityY": 0.2071633842559193, + "x": 4.735395377959576, + "y": 7.235252445190618, + "heading": -3.1407920089832335, + "angularVelocity": -0.05247854364815179, + "velocityX": 3.7492016438651055, + "velocityY": 0.21449729148653832, "moduleForcesX": [ - 110.70709433093435, - 102.78978326842808, - 109.17877166162005, - 99.03740787130127 + 107.40451669387667, + 81.544981345394, + 104.09396678970627, + 72.77164512682684 ], "moduleForcesY": [ - -29.86588290077606, - -49.60370655750762, - 35.07856026223783, - 56.82286597574377 + -39.74553876688157, + -79.06583770683346, + 47.816771425137595, + 87.47036330162247 ], - "timestamp": 0.4700954825704917 + "timestamp": 0.47987981257611145 }, { - "x": 4.933038375930493, - "y": 7.246562519511795, - "heading": -3.141057152136353, - "angularVelocity": -0.0023735664934791357, - "velocityX": 3.961818449458451, - "velocityY": 0.24068002354419252, + "x": 4.961162162053674, + "y": 7.248936972477581, + "heading": -3.140952349422652, + "angularVelocity": -0.002673009953180685, + "velocityX": 3.763722135042569, + "velocityY": 0.22813257700507475, "moduleForcesX": [ - 71.1304777106223, - 38.90533896850497, - 67.80168692280806, - 35.069342324157596 + 4.979358092075404, + 1.9050731077303618, + 4.966710791426737, + 1.8985551228853454 ], "moduleForcesY": [ - -20.881665076720296, - -29.24497694444195, - 35.52488241556476, - 46.99979625202289 + 1.1666845104073047, + 1.1660681916904998, + 5.286171901696504, + 5.292556395923459 ], - "timestamp": 0.5288574178918033 + "timestamp": 0.5398647891481254 }, { - "x": 5.165833894257274, - "y": 7.260879607361727, - "heading": -3.141191038423599, - "angularVelocity": -0.002278452649894059, - "velocityX": 3.961672076555177, - "velocityY": 0.2436456146593047, + "x": 5.186925676572244, + "y": 7.2626767601083335, + "heading": -3.1411124388880545, + "angularVelocity": -0.0026688260052964005, + "velocityX": 3.7636676284691513, + "velocityY": 0.22905381340371825, "moduleForcesX": [ - -0.03237574463563704, - -0.03836473213153268, - -0.03237915031178789, - -0.03836814690497055 + -0.012772921443373914, + -0.013031053606581546, + -0.012775534951914544, + -0.013033680355220673 ], "moduleForcesY": [ - 0.7126371600805075, - 0.7126345337878686, - 0.7206734674426194, - 0.7206706947523183 + 0.21791141098205738, + 0.21790945334762246, + 0.21825770061312894, + 0.21825566239436 ], - "timestamp": 0.5876193532131149 + "timestamp": 0.5998497657201394 }, { - "x": 5.398628438089113, - "y": 7.275212536833178, - "heading": -3.1413249213362655, - "angularVelocity": -0.002278395221917291, - "velocityX": 3.9616554927763006, - "velocityY": 0.243915204512543, + "x": 5.4126888786666845, + "y": 7.276421682496977, + "heading": -3.1412725251050655, + "angularVelocity": -0.0026687718518768853, + "velocityX": 3.763662420096203, + "velocityY": 0.22913941413551372, "moduleForcesX": [ - -0.004005764410808973, - -0.004009381578984551, - -0.0040057696957758555, - -0.004009387088534907 + -0.0012312846193631112, + -0.0012346248118715398, + -0.001231322018659915, + -0.0012346644220080894 ], "moduleForcesY": [ - 0.06514567997750087, - 0.06514567586816115, - 0.06515053178948277, - 0.06515052646691723 + 0.020261967908326156, + 0.02026193639375224, + 0.02026644973999854, + 0.020266417423147567 ], - "timestamp": 0.6463812885344264 + "timestamp": 0.6598347422921533 }, { - "x": 5.6314216777838535, - "y": 7.289566634568185, - "heading": -3.1414588009131665, - "angularVelocity": -0.002278338454468591, - "velocityX": 3.961633299206749, - "velocityY": 0.24427544219772612, + "x": 5.638451088737877, + "y": 7.290182893091729, + "heading": -3.141432606704436, + "angularVelocity": -0.002668694871926455, + "velocityX": 3.7636458822345045, + "velocityY": 0.22941095222787258, "moduleForcesX": [ - -0.005361429921287933, - -0.005365004147554494, - -0.005361430429341668, - -0.005365004730915963 + -0.003912617108109038, + -0.0039173635544157495, + -0.003912626035611627, + -0.003917372464927626 ], "moduleForcesY": [ - 0.0870513309884429, - 0.08705133042541374, - 0.08705612743999552, - 0.08705612689603413 + 0.06427781349805815, + 0.06427780505250308, + 0.06428418449503422, + 0.06428417983138202 ], - "timestamp": 0.705143223855738 + "timestamp": 0.7198197188641673 }, { "x": 5.864199676513671, "y": 7.304165840148926, "heading": -3.141592653589793, - "angularVelocity": -0.0022778806704472536, - "velocityX": 3.9613739312189615, - "velocityY": 0.24844664323787555, + "angularVelocity": -0.0026681161601349807, + "velocityX": 3.763418787115392, + "velocityY": 0.2331074855119802, "moduleForcesX": [ - -0.0626635111672248, - -0.06269233899543689, - -0.06266351034663582, - -0.06269233826749006 + -0.053742159378724355, + -0.053777950646836034, + -0.05374214026769295, + -0.05377793434801155 ], "moduleForcesY": [ - 1.0079779361307997, - 1.0079779356543, - 1.0080166124998338, - 1.0080166121174567 + 0.8750534628320942, + 0.8750534536432211, + 0.8751012884750247, + 0.8751012823498336 ], - "timestamp": 0.7639051591770496 + "timestamp": 0.7798046954361812 }, { - "x": 6.164003219259558, - "y": 7.329310693479935, - "heading": -3.1415926556850056, - "angularVelocity": -2.7648509089600506e-8, - "velocityX": 3.9562193564264954, - "velocityY": 0.33181247476772124, + "x": 6.152377573428224, + "y": 7.328344294067127, + "heading": -3.141592655915241, + "angularVelocity": -3.0327874962943025e-8, + "velocityX": 3.7583392584954223, + "velocityY": 0.3153289462634965, "moduleForcesX": [ - -0.9091406227520445, - -1.0229926855250666, - -0.9088211451962499, - -1.0226331700097273 + -0.8750670830636976, + -1.006710259521497, + -0.874725300925445, + -1.0063138780766954 ], "moduleForcesY": [ - 15.548099923086893, - 15.54784783460909, - 15.69538936246291, - 15.695135166722325 + 15.141847578839295, + 15.141564196521003, + 15.312470356020455, + 15.312185150395404 ], - "timestamp": 0.8396854725863365 + "timestamp": 0.8564816202941887 }, { - "x": 6.463785472279943, - "y": 7.354701655214318, - "heading": -3.141592655684723, - "angularVelocity": 3.725575931858838e-12, - "velocityX": 3.9559384163703637, - "velocityY": 0.33506013095045345, + "x": 6.440536481547124, + "y": 7.3527474199811484, + "heading": -3.141592655914663, + "angularVelocity": 7.537086047151853e-12, + "velocityX": 3.7580916116878904, + "velocityY": 0.31825905850049313, "moduleForcesX": [ - -0.05264365410489091, - -0.052645003824236244, - -0.052643654069719104, - -0.05264500378601198 + -0.04586225728278299, + -0.04586372569531469, + -0.045862256081547766, + -0.04586372442292428 ], "moduleForcesY": [ - 0.6085655004799432, - 0.6085655004355581, - 0.6085673124948521, - 0.6085673123929743 + 0.542641633938682, + 0.5426416315110623, + 0.5426435952886004, + 0.5426435918287228 ], - "timestamp": 0.9154657859956234 + "timestamp": 0.9331585451521962 }, { - "x": 6.7425936724152855, - "y": 7.378325085957683, - "heading": -3.141592655097165, - "angularVelocity": 7.753434822309273e-9, - "velocityX": 3.679163988534982, - "velocityY": 0.3117357223871029, + "x": 6.725982194416825, + "y": 7.376928795577381, + "heading": -3.1415926555365488, + "angularVelocity": 4.93126951023964e-9, + "velocityX": 3.7227068430078205, + "velocityY": 0.3153670500089981, "moduleForcesX": [ - -51.86374695379346, - -51.86374723989954, - -51.86374697013155, - -51.863747256237815 + -6.553087891990707, + -6.553088107734506, + -6.5530878943522115, + -6.553088110092406 ], "moduleForcesY": [ - -4.370675853259815, - -4.370675841289294, - -4.370675276765135, - -4.370675264792112 + -0.5355861508230734, + -0.5355861518431866, + -0.5355858160266412, + -0.5355858164480798 ], - "timestamp": 0.9912460994049104 + "timestamp": 1.0098354700102037 }, { - "x": 6.975022477587425, - "y": 7.398018834411509, - "heading": -3.141592654598946, - "angularVelocity": 6.574519885644753e-9, - "velocityX": 3.067139666166316, - "velocityY": 0.2598794801423144, + "x": 6.963947201115416, + "y": 7.397087900656233, + "heading": -3.141592654989632, + "angularVelocity": 7.132742196975805e-9, + "velocityX": 3.1034761388678844, + "velocityY": 0.26290967088448347, "moduleForcesX": [ - -114.68499791407866, - -114.6849979131527, - -114.68499790399139, - -114.68499790306542 + -114.67853113597924, + -114.67853113769716, + -114.6785311545907, + -114.6785311563086 ], "moduleForcesY": [ - -9.717151389543751, - -9.71715139706053, - -9.717151508985076, - -9.717151516501852 + -9.714852991136091, + -9.714852977267336, + -9.714852770709518, + -9.714852756840765 ], - "timestamp": 1.0670264128141973 + "timestamp": 1.0865123948682112 }, { - "x": 7.160997000105905, - "y": 7.413776516620945, - "heading": -3.1415926541970722, - "angularVelocity": 5.303144992506214e-9, - "velocityX": 2.4541271228853043, - "velocityY": 0.20793899497787205, + "x": 7.15435156281383, + "y": 7.413217936567628, + "heading": -3.1415926544715154, + "angularVelocity": 6.757134963127845e-9, + "velocityX": 2.483202893843366, + "velocityY": 0.21036362557919908, "moduleForcesX": [ - -114.8701770145637, - -114.87017701371919, - -114.87017700365773, - -114.87017700281322 + -114.8716046768432, + -114.87160467659702, + -114.87160467365942, + -114.87160467341322 ], "moduleForcesY": [ - -9.732937356902879, - -9.732937365029716, - -9.732937485826572, - -9.732937493953408 + -9.731273401774802, + -9.731273404147279, + -9.731273439418121, + -9.731273441790599 ], - "timestamp": 1.1428067262234842 + "timestamp": 1.1631893197262186 }, { - "x": 7.30049225587439, - "y": 7.425596002759894, - "heading": -3.141592653894118, - "angularVelocity": 3.997796008011645e-9, - "velocityX": 1.8407848884851754, - "velocityY": 0.1559704045444309, + "x": 7.297169459079101, + "y": 7.425316707330115, + "heading": -3.141592654046443, + "angularVelocity": 5.543681464619214e-9, + "velocityX": 1.862592905619844, + "velocityY": 0.1577889408696524, "moduleForcesX": [ - -114.93195662692112, - -114.93195662610682, - -114.93195661571428, - -114.9319566149 + -114.93396789225454, + -114.93396789150813, + -114.9339678819601, + -114.9339678812137 ], "moduleForcesY": [ - -9.738203898547772, - -9.73820390689881, - -9.73820403095595, - -9.738204039306991 + -9.736577236261422, + -9.736577243932565, + -9.736577357910134, + -9.736577365581278 ], - "timestamp": 1.2185870396327712 + "timestamp": 1.2398662445842261 }, { - "x": 7.393495753669216, - "y": 7.433476227985266, - "heading": -3.141592653691419, - "angularVelocity": 2.674823132984758e-9, - "velocityX": 1.2272778194056353, - "velocityY": 0.1039877623995868, + "x": 7.392388138056945, + "y": 7.433383128421548, + "heading": -3.141592653746211, + "angularVelocity": 3.915539345006351e-9, + "velocityX": 1.241816611114391, + "velocityY": 0.10520011211157265, "moduleForcesX": [ - -114.96284439431135, - -114.96284439351281, - -114.96284438294842, - -114.9628443821499 + -114.96476701310675, + -114.9647670121377, + -114.96476699928847, + -114.96476699831943 ], "moduleForcesY": [ - -9.740836996359766, - -9.740837004827121, - -9.740837130575558, - -9.740837139042911 + -9.739196623522735, + -9.739196633819752, + -9.739196786768158, + -9.739196797065174 ], - "timestamp": 1.294367353042058 + "timestamp": 1.3165431694422336 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": 1.3410596335989075e-9, - "velocityX": 0.6136718659319506, - "velocityY": 0.05199669062818514, + "angularVelocity": 2.0399643560339176e-9, + "velocityX": 0.6209412027311269, + "velocityY": 0.052602853899473424, "moduleForcesX": [ - -114.98137397908026, - -114.98137397829139, - -114.98137396762175, - -114.98137396683289 + -114.98312242497134, + -114.98312242387729, + -114.98312240904909, + -114.98312240795504 ], "moduleForcesY": [ - -9.742416592641025, - -9.742416601179595, - -9.742416727963565, - -9.742416736502134 + -9.740757704436696, + -9.740757716301538, + -9.740757892507524, + -9.740757904372366 ], - "timestamp": 1.370147666451345 + "timestamp": 1.393220094300241 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": -1.6449381377649227e-22, - "velocityX": 2.757023269600915e-22, - "velocityY": -1.2947040629614231e-21, + "angularVelocity": -8.844072307683423e-21, + "velocityX": 1.496452517068171e-20, + "velocityY": -4.199921037541719e-20, "moduleForcesX": [ - -114.99372507344016, - -114.99372507265782, - -114.99372506191705, - -114.9937250611347 + -114.99530722068296, + -114.99530721950912, + -114.99530720336229, + -114.99530720218844 ], "moduleForcesY": [ - -9.74346948925178, - -9.743469497838506, - -9.743469625322668, - -9.743469633909394 + -9.741793989902682, + -9.74179400280959, + -9.741794194469444, + -9.74179420737635 ], - "timestamp": 1.445927979860632 + "timestamp": 1.4698970191582486 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue OP.4.traj b/src/main/deploy/choreo/Blue OP.4.traj index fe612bc..376ecc3 100644 --- a/src/main/deploy/choreo/Blue OP.4.traj +++ b/src/main/deploy/choreo/Blue OP.4.traj @@ -4,358 +4,379 @@ "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": -1.6449381377649227e-22, - "velocityX": 2.757023269600915e-22, - "velocityY": -1.2947040629614231e-21, + "angularVelocity": -8.844072307683423e-21, + "velocityX": 1.496452517068171e-20, + "velocityY": -4.199921037541719e-20, "moduleForcesX": [ - -114.99372507344016, - -114.99372507265782, - -114.99372506191705, - -114.9937250611347 + -114.99530722068296, + -114.99530721950912, + -114.99530720336229, + -114.99530720218844 ], "moduleForcesY": [ - -9.74346948925178, - -9.743469497838506, - -9.743469625322668, - -9.743469633909394 + -9.741793989902682, + -9.74179400280959, + -9.741794194469444, + -9.74179420737635 ], "timestamp": 0 }, { - "x": 7.375924265922195, - "y": 7.4270458645926025, - "heading": -3.1303148603474185, - "angularVelocity": 0.12612545266839068, - "velocityX": -0.7165924034905256, - "velocityY": -0.11598083104372059, + "x": 7.381270997615318, + "y": 7.427913275125405, + "heading": -3.130247025713249, + "angularVelocity": 0.13251789743624745, + "velocityX": -0.6859597370222545, + "velocityY": -0.11099909871012287, "moduleForcesX": [ - -112.76737309465462, - -113.09738136430255, - -114.61964933108011, - -114.71860842032127 + -112.6313588950428, + -113.00915752320313, + -114.67559733618697, + -114.77561717238224 ], "moduleForcesY": [ - -24.554623770706147, - -23.006176875829965, - -13.473735738920116, - -12.640293814526906 + -25.159294856402493, + -23.425636698784512, + -12.964745355934465, + -12.091339079978015 ], - "timestamp": 0.0894172667274904 + "timestamp": 0.08561581564484388 }, { - "x": 7.247779988772691, - "y": 7.406304055209759, - "heading": -3.1078149681341087, - "angularVelocity": 0.2516280472079343, - "velocityX": -1.433104386203608, - "velocityY": -0.2319664885984147, + "x": 7.263819426067914, + "y": 7.4089059352509885, + "heading": -3.107637266054923, + "angularVelocity": 0.26408391356238425, + "velocityX": -1.3718443334654729, + "velocityY": -0.22200734445215997, "moduleForcesX": [ - -112.77796902785569, - -113.0694204236125, - -114.61288648897437, - -114.69165035279205 + -112.64778912905899, + -112.98106218312499, + -114.667110460898, + -114.74591804100633 ], "moduleForcesY": [ - -24.437169993980408, - -23.075208455820334, - -13.40583223060576, - -12.75968547774606 + -25.015409413102287, + -23.491323485597995, + -12.903529067142681, + -12.236822513481128 ], - "timestamp": 0.17883453345498035 + "timestamp": 0.17123163128968777 }, { - "x": 7.05557922298479, - "y": 7.375190745931852, - "heading": -3.0741851923253214, - "angularVelocity": 0.37609934903599834, - "velocityX": -2.1494815578925746, - "velocityY": -0.3479563893708391, + "x": 7.0876560923479435, + "y": 7.380393641960821, + "heading": -3.07389890037907, + "angularVelocity": 0.39406697724878387, + "velocityX": -2.0576027033456232, + "velocityY": -0.33302600781663494, "moduleForcesX": [ - -112.79182810566901, - -113.02648757078286, - -114.59937186585587, - -114.64860236410797 + -112.67062512533333, + -112.9386256400279, + -114.65047328808508, + -114.69841226670894 ], "moduleForcesY": [ - -24.25759265755613, - -23.171552214300533, - -13.311740761370507, - -12.93970595608385 + -24.794121720549438, + -23.578915171806123, + -12.823745620099007, + -12.457213413083549 ], - "timestamp": 0.2682518001824703 + "timestamp": 0.25684744693453165 }, { - "x": 6.799345859055017, - "y": 7.333706777922525, - "heading": -3.0296327580346913, - "angularVelocity": 0.49825314417638356, - "velocityX": -2.865591549679929, - "velocityY": -0.46393688297087876, + "x": 6.852802413616105, + "y": 7.342376469148145, + "heading": -3.0293262645324974, + "angularVelocity": 0.5206121732399505, + "velocityX": -2.743110918969357, + "velocityY": -0.44404380810177707, "moduleForcesX": [ - -112.8024310121022, - -112.96263341798881, - -114.55963723401477, - -114.57186680035291 + -112.69640034788526, + -112.87896079459627, + -114.6035247316006, + -114.61328861565241 ], "moduleForcesY": [ - -23.97488109311961, - -23.255558651397703, - -13.233026976268091, - -13.211149123897187 + -24.43715365857463, + -23.63189826179402, + -12.786890952496687, + -12.797480453077897 ], - "timestamp": 0.35766906690996025 + "timestamp": 0.34246326257937554 }, { - "x": 6.479151323028066, - "y": 7.281860220949749, - "heading": -2.9747972228158814, - "angularVelocity": 0.6132544331278652, - "velocityX": -3.5809027467008328, - "velocityY": -0.5798271281405277, + "x": 6.559322846846036, + "y": 7.294861028140364, + "heading": -2.974816276176582, + "angularVelocity": 0.6366812947509165, + "velocityX": -3.427866271665239, + "velocityY": -0.5549843875211936, "moduleForcesX": [ - -112.76864885600135, - -112.84129933826836, - -114.40191731519991, - -114.37728230406522 + -112.69725731706323, + -112.77901668126033, + -114.4213577102299, + -114.39506493358313 ], "moduleForcesY": [ - -23.425697611861317, - -23.163205809397667, - -13.333070778392436, - -13.69531288022576 + -23.701389141835676, + -23.40728121770181, + -13.046932352219999, + -13.446589360294276 ], - "timestamp": 0.4470863336374502 + "timestamp": 0.4280790782242194 }, { - "x": 6.128706156657079, - "y": 7.2250876773172195, - "heading": -2.9747714114603663, - "angularVelocity": 0.00028866187101872986, - "velocityX": -3.919211346942776, - "velocityY": -0.6349170099948519, + "x": 6.2405606027600165, + "y": 7.243222544857862, + "heading": -2.974789031988597, + "angularVelocity": 0.0003182144301258398, + "velocityX": -3.723170090539417, + "velocityY": -0.6031418715522296, "moduleForcesX": [ - -65.77795724959567, - -48.091726144075956, - -59.97030443873823, - -41.064737834052906 + -62.564521843593084, + -42.22319342938616, + -56.384078555955455, + -34.743970358822985 ], "moduleForcesY": [ - 7.145486045497711, - 13.930551075127115, - -27.77321467031953, - -28.29772337341099 + 8.771658729738927, + 16.21706404812779, + -28.32236622881111, + -28.615859678644675 ], - "timestamp": 0.5365036003649402 + "timestamp": 0.5136948938690633 }, { - "x": 5.778260590548221, - "y": 7.168314324053237, - "heading": -2.974746339793478, - "angularVelocity": 0.0002803895467417059, - "velocityX": -3.9192158174201577, - "velocityY": -0.6349260645262749, + "x": 5.921798032074226, + "y": 7.191583190738455, + "heading": -2.9747625298055844, + "angularVelocity": 0.0003095477490101981, + "velocityX": -3.7231739052524984, + "velocityY": -0.6031520430012703, "moduleForcesX": [ - -0.0009168544850962377, - -0.0005793240119023563, - -0.0008405728976593655, - -0.0005030425527797756 + -0.0008590684242739062, + -0.0004897050181045133, + -0.0007757061877252102, + -0.0004063458477452992 ], "moduleForcesY": [ - -0.0012398789774556854, - -0.0011830360654513062, - -0.00169283207105781, - -0.0016359884024284832 + -0.0014702823398333354, + -0.0014081667097866634, + -0.0019659052879860126, + -0.0019037710991057725 ], - "timestamp": 0.6259208670924301 + "timestamp": 0.5993107095139072 }, { - "x": 5.427815027732516, - "y": 7.111540950421515, - "heading": -2.9747212681368067, - "angularVelocity": 0.00028038943247385174, - "velocityX": -3.9192157805911356, - "velocityY": -0.6349262923093685, + "x": 5.603035464764593, + "y": 7.139943815739949, + "heading": -2.9747360276337456, + "angularVelocity": 0.0003095476185021631, + "velocityX": -3.7231738658186826, + "velocityY": -0.6031522868709134, "moduleForcesX": [ - 0.000005845897111063432, - 0.000005850554610347957, - 0.000005846946551636274, - 0.000005851605108021885 + 0.0000065373917647243475, + 0.000006542648884482532, + 0.000006538254086855334, + 0.000006543595363337553 ], "moduleForcesY": [ - -0.00003617108564124459, - -0.000036170301512162975, - -0.00003617734396736354, - -0.000036176565443598635 + -0.00004044463387706378, + -0.00004044379523524599, + -0.00004045215395335704, + -0.00004045179629948636 ], - "timestamp": 0.7153381338199201 + "timestamp": 0.6849265251587511 }, { - "x": 5.0773694777230824, - "y": 7.054767497780465, - "heading": -2.9746961964763616, - "angularVelocity": 0.00028038947468377387, - "velocityX": -3.9192156373718947, - "velocityY": -0.6349271759119333, + "x": 5.284272897910396, + "y": 7.088304437930092, + "heading": -2.974709525465553, + "angularVelocity": 0.0003095475759100391, + "velocityX": -3.723173860499151, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - 0.000022745436999206383, - 0.00002274371824161806, - 0.000022745063338164777, - 0.000022743343413843666 + 8.811818431713226e-7, + 8.829967624981082e-7, + 8.815928068387048e-7, + 8.834077261655809e-7 ], "moduleForcesY": [ - -0.00014032435530920788, - -0.00014032463600418613, - -0.00014032204063925755, - -0.00014032231580040383 + -0.000005445232314593307, + -0.000005444926075258032, + -0.0000054476678799056675, + -0.000005447361640570373 ], - "timestamp": 0.80475540054741 + "timestamp": 0.770542340803595 }, { - "x": 4.726924947134966, - "y": 6.997991026251115, - "heading": -2.974670388917575, - "angularVelocity": 0.0002886194102156865, - "velocityX": -3.9192042366508106, - "velocityY": -0.6349609377166889, + "x": 4.965510345085579, + "y": 7.036664973557431, + "heading": -2.974683023293425, + "angularVelocity": 0.0003095476218731829, + "velocityX": -3.723173696634823, + "velocityY": -0.6031533307686344, "moduleForcesX": [ - 0.0020163880860393237, - 0.0016805912309524622, - 0.001940464776109846, - 0.001604668094445397 + 0.000027179633968777115, + 0.000027178077676157867, + 0.00002717888025707332, + 0.00002717722449604533 ], "moduleForcesY": [ - -0.0055586767601032185, - -0.0056152526560838715, - -0.005108050168336257, - -0.005164626809257234 + -0.00016769506177041809, + -0.00016769583758608305, + -0.0001676924952224039, + -0.00016769279547100918 ], - "timestamp": 0.8941726672749 + "timestamp": 0.8561581564484384 }, { - "x": 4.406739852490161, - "y": 6.946071670476197, - "heading": -2.9201805701462793, - "angularVelocity": 0.609388105513896, - "velocityX": -3.5807971587926986, - "velocityY": -0.5806412751705897, + "x": 4.6467487843294215, + "y": 6.985022268597529, + "heading": -2.9746557832079867, + "angularVelocity": 0.00031816651203726035, + "velocityX": -3.723162109188588, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - 66.16678250893183, - 48.98536673051217, - 59.2354585777396, - 40.57967406296072 + 0.0021470284617356463, + 0.001779708578470208, + 0.0020640650999688786, + 0.001696749591254383 ], "moduleForcesY": [ - -6.321049067077154, - -14.492266055813312, - 28.180912866909814, - 27.13803459703222 + -0.006493363422829359, + -0.006555181388139426, + -0.0060004838430769165, + -0.006062320034445239 ], - "timestamp": 0.9835899340023899 + "timestamp": 0.9417739720932823 }, { - "x": 4.150515319264335, - "y": 6.904520503456371, - "heading": -2.875923572113572, - "angularVelocity": 0.49494912618595177, - "velocityX": -2.8654927913050745, - "velocityY": -0.46468840460599303, + "x": 4.35327994736575, + "y": 6.937424176402155, + "heading": -2.9205003335250557, + "angularVelocity": 0.6325402529315557, + "velocityX": -3.4277409466149935, + "velocityY": -0.5559497604136834, "moduleForcesX": [ - 112.84469963183767, - 112.76947878161748, - 114.44010878513953, - 114.33052227126576 + 63.0067589023219, + 43.25347247652169, + 55.56509439641217, + 34.16828867746466 ], "moduleForcesY": [ - 23.05021971834789, - 23.504795933148507, - 13.013238741851021, - 14.088814392674271 + -7.91265828309172, + -16.812254107815967, + 28.71804550358443, + 27.34861881904853 ], - "timestamp": 1.0730072007298799 + "timestamp": 1.0273897877381262 }, { - "x": 3.9583220436464823, - "y": 6.873351406790412, - "heading": -2.842507887558043, - "angularVelocity": 0.3737050547224577, - "velocityX": -2.1493977914085045, - "velocityY": -0.3485802888713979, + "x": 4.118436291181741, + "y": 6.899331547752736, + "heading": -2.8762208718989513, + "angularVelocity": 0.5171878734390213, + "velocityX": -2.742993854759276, + "velocityY": -0.44492513868510164, "moduleForcesX": [ - 112.95645164652021, - 112.81581362288203, - 114.63477612228742, - 114.4800037317309 + 112.77868429037682, + 112.7033673063995, + 114.45941943627882, + 114.34574505410619 ], "moduleForcesY": [ - 23.231980648685717, - 23.95223626895713, - 12.578015209156026, - 13.993453486124878 + 23.303963933906324, + 23.762739676331677, + 12.722298748930815, + 13.86894657131769 ], - "timestamp": 1.1624244674573698 + "timestamp": 1.11300560338297 }, { - "x": 3.830183254358929, - "y": 6.85256977540764, - "heading": -2.8201340277644222, - "angularVelocity": 0.2502185608268224, - "velocityX": -1.4330430125768843, - "velocityY": -0.23241183882421498, + "x": 3.9422814599590574, + "y": 6.8707567698528536, + "heading": -2.8426922514156217, + "angularVelocity": 0.391617135581763, + "velocityX": -2.0575033934549967, + "velocityY": -0.3337558333663218, "moduleForcesX": [ - 113.00394710188138, - 112.82068889216025, - 114.70406075329403, - 114.52336848119276 + 112.86515330511082, + 112.7174908430355, + 114.6811022921368, + 114.51664915991034 ], "moduleForcesY": [ - 23.2434343413162, - 24.148746420326283, - 12.388975239916281, - 14.012855946804578 + 23.63834794762169, + 24.384475231601378, + 12.086104233396183, + 13.645010104290401 ], - "timestamp": 1.2518417341848598 + "timestamp": 1.198621419027814 + }, + { + "x": 3.8248361212608604, + "y": 6.851704848123817, + "heading": -2.8202044428854083, + "angularVelocity": 0.26265951402598714, + "velocityX": -1.3717715332572546, + "velocityY": -0.22252806430143837, + "moduleForcesX": [ + 112.90541799785672, + 112.70949942311833, + 114.75934724991006, + 114.56628411956218 + ], + "moduleForcesY": [ + 23.695274487547174, + 24.64547404232939, + 11.823839632394282, + 13.62813642328838 + ], + "timestamp": 1.2842372346726578 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 0.1255595686363405, - "velocityX": -0.7165595452629517, - "velocityY": -0.11621279716307126, + "angularVelocity": 0.1319570277388407, + "velocityX": -0.6859207314037196, + "velocityY": -0.1112703689791775, "moduleForcesX": [ - 113.02767779062647, - 112.82218278499239, - 114.73896316536627, - 114.54498863487578 + 112.925655713762, + 112.70422548752346, + 114.79867455728485, + 114.5909034417634 ], "moduleForcesY": [ - 23.249516784409284, - 24.250854636389032, - 12.290549417164629, - 14.022523907560238 + 23.723484974899822, + 24.780696781270088, + 11.687912648139877, + 13.620484396497119 ], - "timestamp": 1.3412590009123497 + "timestamp": 1.3698530503175017 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 6.39634760318955e-21, - "velocityX": -2.288259399396069e-20, - "velocityY": -2.4594644423852028e-20, + "angularVelocity": 1.048098737702012e-19, + "velocityX": -5.399569524753348e-19, + "velocityY": -9.802475742246663e-19, "moduleForcesX": [ - 113.0347603386625, - 112.82700125465155, - 114.75821199877026, - 114.5621659937604 + 112.92977017260735, + 112.70546235157893, + 114.82048834955188, + 114.6101322449539 ], "moduleForcesY": [ - 23.2880943793102, - 24.293809761632872, - 12.246633407284676, - 13.993645143555243 + 23.77874423290317, + 24.84159448258278, + 11.622750779734075, + 13.577897490720876 ], - "timestamp": 1.4306762676398397 + "timestamp": 1.4554688659623456 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue OP.5.traj b/src/main/deploy/choreo/Blue OP.5.traj index d737928..bda2f68 100644 --- a/src/main/deploy/choreo/Blue OP.5.traj +++ b/src/main/deploy/choreo/Blue OP.5.traj @@ -4,631 +4,631 @@ "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 6.39634760318955e-21, - "velocityX": -2.288259399396069e-20, - "velocityY": -2.4594644423852028e-20, + "angularVelocity": 1.048098737702012e-19, + "velocityX": -5.399569524753348e-19, + "velocityY": -9.802475742246663e-19, "moduleForcesX": [ - 113.0347603386625, - 112.82700125465155, - 114.75821199877026, - 114.5621659937604 + 112.92977017260735, + 112.70546235157893, + 114.82048834955188, + 114.6101322449539 ], "moduleForcesY": [ - 23.2880943793102, - 24.293809761632872, - 12.246633407284676, - 13.993645143555243 + 23.77874423290317, + 24.84159448258278, + 11.622750779734075, + 13.577897490720876 ], "timestamp": 0 }, { - "x": 3.78600549650478, - "y": 6.841766146112416, - "heading": -2.8358265954492667, - "angularVelocity": -0.5268296966780072, - "velocityX": 0.3893532656410478, - "velocityY": -0.00806687956342702, + "x": 3.7866144129842945, + "y": 6.8417821274774475, + "heading": -2.8401706467737573, + "angularVelocity": -0.5981564744361981, + "velocityX": 0.392292949619254, + "velocityY": -0.0075806465777589985, "moduleForcesX": [ - 109.42063742828591, - 109.7288300984058, - 101.12162507107449, - 112.53880632418141 + 107.42080956929517, + 108.8413082444939, + 98.01523216314052, + 112.04459817860722 ], "moduleForcesY": [ - 36.38707466668986, - 35.669533302226604, - -55.51926033598735, - -25.504590588279555 + 41.904654146837636, + 38.29718260293834, + -60.83697376382957, + -27.603083990033998 ], - "timestamp": 0.0510976531762255 + "timestamp": 0.052266946500491684 }, { - "x": 3.825938343537949, - "y": 6.840779251207409, - "heading": -2.8882950545967137, - "angularVelocity": -1.026827180623991, - "velocityX": 0.7815006081678173, - "velocityY": -0.019313898851738894, + "x": 3.8278180486268427, + "y": 6.840743713694053, + "heading": -2.901006370545353, + "angularVelocity": -1.163942564944422, + "velocityX": 0.7883306449166008, + "velocityY": -0.019867504281804747, "moduleForcesX": [ - 110.09506612110931, - 110.81993188505729, - 102.6353312163985, - 112.36550007471496 + 108.49838326382826, + 110.25146907706204, + 99.86657679489441, + 111.77509833383628 ], "moduleForcesY": [ - 34.2533713879541, - 32.07800706429278, - -52.62999688238643, - -26.203707120752828 + 38.99254840535189, + 33.98129300971088, + -57.706808413427034, + -28.619699977125915 ], - "timestamp": 0.102195306352451 + "timestamp": 0.10453389300098337 }, { - "x": 3.8860741349913512, - "y": 6.839035138240057, - "heading": -2.964541076190401, - "angularVelocity": -1.4921628852646063, - "velocityX": 1.176879713947022, - "velocityY": -0.03413293681682487, + "x": 3.889955785107897, + "y": 6.8387849883626, + "heading": -2.9890898968624993, + "angularVelocity": -1.6852625266011574, + "velocityX": 1.1888533890238777, + "velocityY": -0.0374754115663657, "moduleForcesX": [ - 110.82018043359403, - 112.01913727447982, - 104.5309227969057, - 112.13805673866038 + 109.70138251498284, + 111.79514898339698, + 102.32802663455422, + 111.44106852220102 ], "moduleForcesY": [ - 31.778806331042382, - 27.53721520438967, - -48.700214418067816, - -27.088832746748313 + 35.415890676664304, + 28.42375744706581, + -53.15724933762509, + -29.817683638360904 ], - "timestamp": 0.1532929595286765 + "timestamp": 0.15680083950147505 }, { - "x": 3.9666241731173164, - "y": 6.836347748309206, - "heading": -3.061856445753252, - "angularVelocity": -1.9044978294253445, - "velocityX": 1.5763940830739307, - "velocityY": -0.05259321639650871, + "x": 3.9733415003112857, + "y": 6.835624849307072, + "heading": -3.1005912250342016, + "angularVelocity": -2.1333048061388666, + "velocityX": 1.5953814176348051, + "velocityY": -0.0604615204663511, "moduleForcesX": [ - 111.82728548746546, - 113.23819484894514, - 107.03013912743913, - 112.00948759102612 + 111.36765197462086, + 113.3330629489433, + 105.79188446547697, + 111.29923323362245 ], "moduleForcesY": [ - 27.9535071577465, - 21.882075353027073, - -42.84285393246154, - -27.51340335883333 + 29.67677517374216, + 21.344964061000997, + -45.774893406210126, + -30.226858179680654 ], - "timestamp": 0.204390612704902 + "timestamp": 0.20906778600196674 }, { - "x": 4.067857576516546, - "y": 6.832556869927305, - "heading": -3.175915491721135, - "angularVelocity": -2.232177778782037, - "velocityX": 1.9811752029020762, - "velocityY": -0.07418889413231283, + "x": 4.078379902808959, + "y": 6.831026292095147, + "heading": -3.229015108449569, + "angularVelocity": -2.45707645106375, + "velocityX": 2.0096525534871077, + "velocityY": -0.0879821286649223, "moduleForcesX": [ - 113.22575760455814, - 114.34728768901107, - 110.11846813519523, - 112.26817875434021 + 113.53832730848663, + 114.64478257919814, + 110.14647037122349, + 111.87702649396591 ], "moduleForcesY": [ - 21.45752343424573, - 14.794035336095424, - -33.98499618387022, - -26.27258468210002 + 19.599153766423715, + 12.088459054315411, + -33.795989909102516, + -27.799474462441705 ], - "timestamp": 0.2554882658811275 + "timestamp": 0.2613347325024584 }, { - "x": 4.190070365050169, - "y": 6.827548067939446, - "heading": -3.2998572362261696, - "angularVelocity": -2.425585849854656, - "velocityX": 2.3917495410628007, - "velocityY": -0.09802411023818243, + "x": 4.2054556679364925, + "y": 6.824790196070038, + "heading": -3.3632917229427637, + "angularVelocity": -2.5690541247120953, + "velocityX": 2.431283509671254, + "velocityY": -0.11931242291081591, "moduleForcesX": [ - 114.7457474192497, - 115.11333345954517, - 113.19559803887138, - 113.34482631497848 + 115.1489195315103, + 115.1727965430496, + 113.9941351274335, + 113.88899499156405 ], "moduleForcesY": [ - 10.194849320269086, - 5.448077962340892, - -21.339190325625143, - -20.799257564932734 + 1.0232280605874524, + -1.635500797450544, + -16.245965323391406, + -17.189766351140616 ], - "timestamp": 0.306585919057353 + "timestamp": 0.3136016790029501 }, { - "x": 4.333402838200007, - "y": 6.821199257095827, - "heading": -3.422162582125266, - "angularVelocity": -2.3935609229897317, - "velocityX": 2.8050695920517015, - "velocityY": -0.12424857990491066, + "x": 4.354051044308127, + "y": 6.816459874974004, + "heading": -3.4803991855766943, + "angularVelocity": -2.240564457555005, + "velocityX": 2.8430085612566733, + "velocityY": -0.15938029010258697, "moduleForcesX": [ - 114.68412050490778, - 114.73378991745246, - 115.00391113761037, - 115.02985196430272 + 109.54277500123293, + 109.76726168084907, + 114.94525226928009, + 113.18437639744356 ], "moduleForcesY": [ - -10.050186347462116, - -9.331880356810323, - -5.31591098605362, - -4.453466685132969 + -35.138512118490674, + -33.87003877484381, + 5.393963684062317, + 20.071079184944495 ], - "timestamp": 0.3576835722335785 + "timestamp": 0.3658686255034418 }, { - "x": 4.496449804863985, - "y": 6.812872270792408, - "heading": -3.517273176899785, - "angularVelocity": -1.8613495701358547, - "velocityX": 3.190889532669179, - "velocityY": -0.16296220639921205, + "x": 4.52101074667456, + "y": 6.80513903332009, + "heading": -3.552003118857375, + "angularVelocity": -1.369965878531029, + "velocityX": 3.194364958069012, + "velocityY": -0.2165965760749598, "moduleForcesX": [ - 104.86344163188946, - 102.79608932766192, - 114.33175651351914, - 106.890923713185 + 96.13389774106393, + 78.1016913248519, + 113.46555797863142, + 94.13325434178371 ], "moduleForcesY": [ - -47.21609558159705, - -50.77985160422085, - 12.895732740628704, - 42.06566908876741 + -62.80652414189361, + -83.01049814576045, + 18.254472024247136, + 65.38310369002122 ], - "timestamp": 0.408781225409804 + "timestamp": 0.4181355720039335 }, { - "x": 4.6771281726390805, - "y": 6.802007556416455, - "heading": -3.5695575194646283, - "angularVelocity": -1.0232239509028986, - "velocityX": 3.5359425833505953, - "velocityY": -0.2126264847914251, + "x": 4.706342119523084, + "y": 6.791413745525305, + "heading": -3.5793791336242253, + "angularVelocity": -0.5237729884716399, + "velocityX": 3.5458618736562415, + "velocityY": -0.26259976359377335, "moduleForcesX": [ - 96.67728867515599, - 80.87009063485003, - 113.21907877847823, - 92.79877473998543 + 96.52600367181356, + 81.50657246245366, + 112.58926465292838, + 91.36526851275515 ], "moduleForcesY": [ - -61.82807121867156, - -79.97059189776539, - 19.430238076987123, - 67.16099978368732 + -60.91221738822322, + -77.0385216215409, + 20.114545224135323, + 67.84251293202189 ], - "timestamp": 0.4598788785860295 + "timestamp": 0.47040251850442516 }, { - "x": 4.875366934287349, - "y": 6.7891315300219, - "heading": -3.579804057853285, - "angularVelocity": -0.20052855173833614, - "velocityX": 3.879605996083274, - "velocityY": -0.25198860601577133, + "x": 4.903114088638074, + "y": 6.781657287742634, + "heading": -3.5797122193352346, + "angularVelocity": -0.006372779228765348, + "velocityX": 3.7647496609188598, + "velocityY": -0.18666592245959082, "moduleForcesX": [ - 97.03131746492353, - 82.80990999914111, - 112.19644097022719, - 89.98282568718108 + 70.97743787502137, + 39.57182354200292, + 76.9970632005936, + 50.328630779424536 ], "moduleForcesY": [ - -59.77588710656038, - -74.87714839288478, - 21.5263485084751, - 69.37126688318331 + -15.965745753786843, + 6.6647535433357925, + 33.49165128418184, + 58.32997535183497 ], - "timestamp": 0.510976531762255 + "timestamp": 0.5226694650049168 }, { - "x": 5.077915979474368, - "y": 6.780072353267369, - "heading": -3.58010809138146, - "angularVelocity": -0.005950048764981118, - "velocityX": 3.9639598415305963, - "velocityY": -0.1772914447418665, + "x": 5.099931542658043, + "y": 6.772736369563246, + "heading": -3.5800300838454637, + "angularVelocity": -0.0060815588342526235, + "velocityX": 3.76561990316587, + "velocityY": -0.17067991870003177, "moduleForcesX": [ - 26.977283498941954, - 13.088021988666144, - 33.20236522268229, - 20.50110572882093 + 0.24002269616514235, + 0.22117703170230035, + 0.25167644223991104, + 0.23285423486863352 ], "moduleForcesY": [ - 8.723342744724212, - 15.885560108858511, - 25.74087269547646, - 32.68451149483199 + 4.326391928783615, + 4.334916585403937, + 4.351428081011753, + 4.359954585237189 ], - "timestamp": 0.5620741849384805 + "timestamp": 0.5749364115054085 }, { - "x": 5.280471017904145, - "y": 6.771117377305431, - "heading": -3.580408705243314, - "angularVelocity": -0.005883124628397359, - "velocityX": 3.9640771315113867, - "velocityY": -0.17525219663325547, + "x": 5.296743731326859, + "y": 6.7637007017205635, + "heading": -3.5803480873484106, + "angularVelocity": -0.00608421811945572, + "velocityX": 3.765519163568818, + "velocityY": -0.17287537244202097, "moduleForcesX": [ - 0.0334118938803721, - 0.02901319412251914, - 0.03617632271370437, - 0.031779580558092844 + -0.02738786810423168, + -0.027246197183243195, + -0.02749366052226753, + -0.027350411162396112 ], "moduleForcesY": [ - 0.5627467701499977, - 0.564801110950385, - 0.5686255765232819, - 0.5706799263117553 + -0.5963054368442775, + -0.5963956352307891, + -0.5965517839514543, + -0.5966429834962301 ], - "timestamp": 0.613171838114706 + "timestamp": 0.6272033580059002 }, { - "x": 5.482843801346731, - "y": 6.758726217540709, - "heading": -3.580715022162749, - "angularVelocity": -0.005994735577754661, - "velocityX": 3.960510333902072, - "velocityY": -0.2424995864680392, + "x": 5.493454369555724, + "y": 6.7526864720057285, + "heading": -3.580669800620504, + "angularVelocity": -0.006155195465466283, + "velocityX": 3.7635762446351886, + "velocityY": -0.2107303076283394, "moduleForcesX": [ - -0.9926378040047893, - -0.9850808010019008, - -0.9973672418757675, - -0.9898104285367338 + -0.5287852184727379, + -0.5239825347058187, + -0.5317492184247837, + -0.5269382194651111 ], "moduleForcesY": [ - -18.68176620232677, - -18.68515075606664, - -18.691363885724435, - -18.694748257197876 + -10.28066289440765, + -10.282769065093767, + -10.28654220890871, + -10.28864362116857 ], - "timestamp": 0.6642694912909315 + "timestamp": 0.6794703045063919 }, { - "x": 5.6837294618748615, - "y": 6.731334695007788, - "heading": -3.5810537179070154, - "angularVelocity": -0.00662840117330224, - "velocityX": 3.9314067876134344, - "velocityY": -0.5360622422022736, + "x": 5.688997682168798, + "y": 6.728677589687009, + "heading": -3.5810228607970975, + "angularVelocity": -0.0067549417027819286, + "velocityX": 3.741242328193694, + "velocityY": -0.4593511564422302, "moduleForcesX": [ - -8.105065986269624, - -8.032996251394055, - -8.142908653909107, - -8.070890615781863 + -6.080411522594813, + -6.02353002387444, + -6.11207802550282, + -6.055226639620323 ], "moduleForcesY": [ - -81.5596902417295, - -81.57543466978598, - -81.58850238971299, - -81.60424655492301 + -67.52145044144014, + -67.53691218233755, + -67.55667901029105, + -67.57213537559683 ], - "timestamp": 0.715367144467157 + "timestamp": 0.7317372510068836 }, { "x": 5.880957641601562, "y": 6.684422969818115, "heading": -3.5814353254496796, - "angularVelocity": -0.007468200963131239, - "velocityX": 3.859828533543356, - "velocityY": -0.9180798387723068, + "angularVelocity": -0.007891500847064156, + "velocityX": 3.6726836420596607, + "velocityY": -0.8467037550871748, "moduleForcesX": [ - -19.93563366954746, - -19.797209295771946, - -19.98631567124326, - -19.848112638467743 + -18.681818838527086, + -18.502266587342042, + -18.750414129600102, + -18.5712305730302 ], "moduleForcesY": [ - -106.14800306857413, - -106.17640495788532, - -106.1513286826346, - -106.17974187192411 + -105.21692402603168, + -105.25254288064605, + -105.22397106219577, + -105.25961417672018 ], - "timestamp": 0.7664647976433825 + "timestamp": 0.7840041975073753 }, { - "x": 5.995980176257607, - "y": 6.6497418165304945, - "heading": -3.579249576658118, - "angularVelocity": 0.07178828851457016, - "velocityX": 3.7777767213885776, - "velocityY": -1.1390607410336038, + "x": 5.995964950369022, + "y": 6.649793265437975, + "heading": -3.579262118741216, + "angularVelocity": 0.0678279216427609, + "velocityX": 3.589491370997937, + "velocityY": -1.0808271785951162, "moduleForcesX": [ - -29.960020675030847, - -49.61097001099723, - -23.69035732915975, - -49.81068398032844 + -29.33376530988018, + -47.53506576754961, + -23.5075658910571, + -47.10755646578757 ], "moduleForcesY": [ - -107.24025708495026, - -99.62262552981605, - -107.4372074994835, - -97.95156957525988 + -107.40841370415603, + -100.61864430852758, + -107.60905700250362, + -99.41984691304988 ], - "timestamp": 0.7969119476839932 + "timestamp": 0.8160441989673899 }, { - "x": 6.1082569266261295, - "y": 6.608629575449157, - "heading": -3.575149016065102, - "angularVelocity": 0.13467797766117506, - "velocityX": 3.6875947410107215, - "velocityY": -1.3502820798170554, + "x": 6.107956693664685, + "y": 6.608067008873313, + "heading": -3.5750708302871326, + "angularVelocity": 0.1308142404211006, + "velocityX": 3.4953726027567464, + "velocityY": -1.302317561270707, "moduleForcesX": [ - -35.09011732252264, - -50.4723868097775, - -31.778861111114438, - -50.897929213341364 + -35.10646123915215, + -49.75636775982228, + -31.99592734180901, + -49.99578261363511 ], "moduleForcesY": [ - -102.59136541098559, - -95.93088215086516, - -101.83371240771552, - -93.68871350341732 + -102.06974562300634, + -95.75188215467672, + -101.23810381235252, + -93.60026996744395 ], - "timestamp": 0.8273590977246039 + "timestamp": 0.8480842004274045 }, { - "x": 6.217542082845669, - "y": 6.561748076363306, - "heading": -3.568627120879471, - "angularVelocity": 0.21420379828430375, - "velocityX": 3.5893394315649645, - "velocityY": -1.5397664156848434, + "x": 6.21661606136549, + "y": 6.560219585431066, + "heading": -3.56796945086452, + "angularVelocity": 0.22164104553723224, + "velocityX": 3.3913658785702108, + "velocityY": -1.4933652079240145, "moduleForcesX": [ - -37.80311413224733, - -54.54451585503094, - -34.88451901813677, - -56.068371436952425 + -37.865335431574195, + -55.05567925095188, + -34.8057574496384, + -56.6572177627318 ], "moduleForcesY": [ - -94.79851130258078, - -86.38037479041088, - -91.61886969958682, - -80.69537934854469 + -91.9696806578777, + -83.04388847970704, + -87.7072282477682, + -75.97006732056381 ], - "timestamp": 0.8578062477652146 + "timestamp": 0.8801242018874191 }, { - "x": 6.324576207665626, - "y": 6.510355295341809, - "heading": -3.5615466703297547, - "angularVelocity": 0.23254887699743812, - "velocityX": 3.515407014357414, - "velocityY": -1.6879340415424884, + "x": 6.3234543638897875, + "y": 6.508277508435261, + "heading": -3.5612398503705793, + "angularVelocity": 0.21003745902883333, + "velocityX": 3.3345286409433434, + "velocityY": -1.6211633779357917, "moduleForcesX": [ - -33.17492791427454, - -36.44246857537978, - -32.454651631287796, - -35.85281953404848 + -25.772720719503052, + -24.038621985626055, + -26.326511299596437, + -24.623675888804087 ], "moduleForcesY": [ - -70.77919539967775, - -69.2166880739434, - -69.02352334329501, - -67.39520207920545 + -55.617544175097784, + -56.3901225503694, + -56.897671134657024, + -57.65632603556039 ], - "timestamp": 0.8882533978058254 + "timestamp": 0.9121642033474338 }, { - "x": 6.430734331505576, - "y": 6.456274689185194, - "heading": -3.55597279273681, - "angularVelocity": 0.18306730138979413, - "velocityX": 3.486635816434521, - "velocityY": -1.776212423313204, + "x": 6.429785051718747, + "y": 6.454517230975465, + "heading": -3.555783203705424, + "angularVelocity": 0.17030731637027208, + "velocityX": 3.3186854863804274, + "velocityY": -1.6779112050568066, "moduleForcesX": [ - -15.238669327364391, - -8.471205328474737, - -18.190714448045004, - -11.773615198816776 + -8.059917813217185, + -3.5123356736370575, + -10.479446367245371, + -6.03517696733037 ], "moduleForcesY": [ - -36.510563952243956, - -39.29991840660133, - -43.12295459661239, - -45.75459276689898 + -21.48474062356099, + -23.417268008535252, + -26.91275592119492, + -28.788257648118933 ], - "timestamp": 0.9187005478464361 + "timestamp": 0.9442042048074484 }, { - "x": 6.536475682611372, - "y": 6.400874064288047, - "heading": -3.5512294389855783, - "angularVelocity": 0.1557897453425012, - "velocityX": 3.4729474175663744, - "velocityY": -1.8195668502061235, + "x": 6.535890878159139, + "y": 6.3999345000370695, + "heading": -3.5509405063489323, + "angularVelocity": 0.15114535380203434, + "velocityX": 3.3116673409890054, + "velocityY": -1.7035807881108644, "moduleForcesX": [ - -7.105966453517452, - -3.904238249156235, - -8.842262844227525, - -5.683970643638691 + -3.551592855801476, + -1.4878949974649047, + -4.727965710468891, + -2.6743732417422237 ], "moduleForcesY": [ - -17.55122761626494, - -18.91819232417745, - -21.53331764786734, - -22.877258187795352 + -9.581718408852653, + -10.470814274008577, + -12.285842350891826, + -13.168876343162887 ], - "timestamp": 0.9491476978870468 + "timestamp": 0.976244206267463 }, { "x": 6.641601600646972, "y": 6.344369888305664, "heading": -3.546484656651337, - "angularVelocity": 0.1558366654321555, - "velocityX": 3.4527342590482366, - "velocityY": -1.8558116574791523, + "angularVelocity": 0.1390714573829294, + "velocityX": 3.2993357575144002, + "velocityY": -1.7342262546633984, "moduleForcesX": [ - -9.425930347001255, - -9.431345346606202, - -9.423018174875864, - -9.428431462071117 + -5.7560829719013995, + -4.444919794975055, + -6.483173213952547, + -5.177358266631704 ], "moduleForcesY": [ - -16.908789517759143, - -16.906432080261197, - -16.901878110852078, - -16.89952145852833 + -12.451995720494438, + -13.01289673408783, + -14.152581305031367, + -14.711065470349547 ], - "timestamp": 0.9795948479276575 + "timestamp": 1.0082842077274776 }, { - "x": 6.869753469015524, - "y": 6.195179516897854, - "heading": -3.542866425141456, - "angularVelocity": 0.048373286754126776, - "velocityX": 3.050234823819821, - "velocityY": -1.994573480816792, + "x": 6.869731347457535, + "y": 6.195147686170208, + "heading": -3.5430658553910614, + "angularVelocity": 0.045706968702274815, + "velocityX": 3.0499342909124034, + "velocityY": -1.9949959074662678, "moduleForcesX": [ - -78.31714320835097, - -74.77834883929404, - -78.09040380788947, - -74.46722774433756 + -49.847910667256336, + -44.35336751958273, + -50.2065788649508, + -44.98425405325641 ], "moduleForcesY": [ - -20.140082076449396, - -24.405157664502912, - -28.259698256336822, - -32.56908498859212 + -45.107327355027664, + -48.75639459683009, + -50.366048913041745, + -53.79518756599839 ], - "timestamp": 1.0543929803818788 + "timestamp": 1.083082457476758 }, { - "x": 7.0598495747309, - "y": 6.070649750515125, - "heading": -3.539878174269547, - "angularVelocity": 0.0399508754277714, - "velocityX": 2.5414552406334554, - "velocityY": -1.66487801629198, + "x": 7.059826728122221, + "y": 6.070616528520401, + "heading": -3.5400838676463033, + "angularVelocity": 0.03986707917302543, + "velocityX": 2.5414415618262263, + "velocityY": -1.66489400577198, "moduleForcesX": [ - -96.38792598998765, - -96.32186712116838, - -96.85697827552185, - -96.7941901796475 + -96.39508860152831, + -96.3494121391401, + -96.72106180217853, + -96.67696001450193 ], "moduleForcesY": [ - 62.906638901351315, - 63.00396831226178, - 62.18110701001113, - 62.27496892844536 + 62.88707197355026, + 62.95438072017819, + 62.38391822498686, + 62.44956252680856 ], - "timestamp": 1.1291911128361 + "timestamp": 1.1578807072260382 }, { - "x": 7.211915508257611, - "y": 5.970953271268857, - "heading": -3.537495873597022, - "angularVelocity": 0.031849734670626455, - "velocityX": 2.0330177844985795, - "velocityY": -1.332873909750178, + "x": 7.211898448481457, + "y": 5.970928319469068, + "heading": -3.537649300785395, + "angularVelocity": 0.032548446909771406, + "velocityX": 2.0330919622983044, + "velocityY": -1.332761252910166, "moduleForcesX": [ - -96.32997314585461, - -96.2648765880098, - -96.78416991240438, - -96.72213484257243 + -96.33189190207509, + -96.27315885630252, + -96.74250734840605, + -96.68627379381498 ], "moduleForcesY": [ - 63.33059042831494, - 63.42768790672798, - 62.633819804313376, - 62.72773938264774 + 63.32587402991062, + 63.413486925786316, + 62.696376607221254, + 62.7813968776455 ], - "timestamp": 1.2039892452903214 + "timestamp": 1.2326789569753185 }, { - "x": 7.325959940528807, - "y": 5.8961477456875455, - "heading": -3.5357126824424197, - "angularVelocity": 0.02384004915756235, - "velocityX": 1.5246962528241605, - "velocityY": -1.0000988410652476, + "x": 7.325950138897687, + "y": 5.896133355137769, + "heading": -3.535800762021587, + "angularVelocity": 0.02471366335447362, + "velocityX": 1.5247908981630418, + "velocityY": -0.9999560762718304, "moduleForcesX": [ - -96.31011450913448, - -96.24488535024157, - -96.76017259475934, - -96.69795042437518 + -96.31025854518855, + -96.24648866204707, + -96.7505601347192, + -96.68966743585159 ], "moduleForcesY": [ - 63.472522054727726, - 63.57019718383225, - 62.78399745101653, - 62.87858000727262 + 63.47168328918775, + 63.567173224815086, + 62.79818822526497, + 62.89071925102441 ], - "timestamp": 1.2787873777445427 + "timestamp": 1.3074772067245988 }, { - "x": 7.401987230405639, - "y": 5.846262014344345, - "heading": -3.5345254341500323, - "angularVelocity": 0.01587269967086741, - "velocityX": 1.0164329961495133, - "velocityY": -0.6669381935937067, + "x": 7.401983623718805, + "y": 5.846256704612968, + "heading": -3.5345578251238092, + "angularVelocity": 0.016617192273138574, + "velocityX": 1.0165142242764782, + "velocityY": -0.6668157435766066, "moduleForcesX": [ - -96.30009844719447, - -96.2346774667713, - -96.7482657606124, - -96.68582788542037 + -96.29939278470033, + -96.2329159415438, + -96.75477051723158, + -96.69137390831803 ], "moduleForcesY": [ - 63.543559427570486, - 63.64170695487276, - 62.858869191683326, - 62.95396491375012 + 63.54438360092045, + 63.644109963436094, + 62.84860449412121, + 62.94517892257007 ], - "timestamp": 1.353585510198764 + "timestamp": 1.382275456473879 }, { - "x": 7.44, + "x": 7.439999999999993, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": 0.007929116431986636, - "velocityX": 0.5082047953219507, - "velocityY": -0.3335462040385299, + "angularVelocity": 0.008362148539556004, + "velocityX": 0.5082522172460263, + "velocityY": -0.33347469361261795, "moduleForcesX": [ - -96.29401110747638, - -96.22850451077451, - -96.74113494181451, - -96.67859802056265 + -96.29281019096716, + -96.22472066349776, + -96.75733376592433, + -96.69245071862353 ], "moduleForcesY": [ - 63.58627600774885, - 63.68466012516549, - 62.90374389419573, - 62.99909879542881 + 63.588004757645685, + 63.6902592409911, + 62.87872632391144, + 62.97770864616691 ], - "timestamp": 1.4283836426529852 + "timestamp": 1.4570737062231593 }, { "x": 7.44, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": -9.243044313287906e-21, - "velocityX": 5.393146768307059e-21, - "velocityY": -4.66608405771598e-20, + "angularVelocity": -1.4293252202182307e-19, + "velocityX": 9.48790104088937e-19, + "velocityY": 6.222110897117571e-19, "moduleForcesX": [ - -96.28984267330934, - -96.22440473642784, - -96.73635227532326, - -96.67387504230592 + -96.28830838426238, + -96.21927713511505, + -96.75901741443018, + -96.6932781749062 ], "moduleForcesY": [ - 63.61490939882352, - 63.713260147549455, - 62.93369197756516, - 63.029025881658725 + 63.61721617293362, + 63.720955818602505, + 62.898815476061394, + 62.99919868599484 ], - "timestamp": 1.5031817751072065 + "timestamp": 1.5318719559724396 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue OP.6.traj b/src/main/deploy/choreo/Blue OP.6.traj index 57135e4..3d7d3e8 100644 --- a/src/main/deploy/choreo/Blue OP.6.traj +++ b/src/main/deploy/choreo/Blue OP.6.traj @@ -4,505 +4,505 @@ "x": 7.44, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": -9.243044313287906e-21, - "velocityX": 5.393146768307059e-21, - "velocityY": -4.66608405771598e-20, + "angularVelocity": -1.4293252202182307e-19, + "velocityX": 9.48790104088937e-19, + "velocityY": 6.222110897117571e-19, "moduleForcesX": [ - -96.28984267330934, - -96.22440473642784, - -96.73635227532326, - -96.67387504230592 + -96.28830838426238, + -96.21927713511505, + -96.75901741443018, + -96.6932781749062 ], "moduleForcesY": [ - 63.61490939882352, - 63.713260147549455, - 62.93369197756516, - 63.029025881658725 + 63.61721617293362, + 63.720955818602505, + 62.898815476061394, + 62.99919868599484 ], "timestamp": 0 }, { - "x": 7.415573591734402, - "y": 5.838158154369932, - "heading": -3.5159963993345684, - "angularVelocity": 0.29481900273694317, - "velocityX": -0.40150472302798135, - "velocityY": 0.2768829503913695, + "x": 7.413934915732111, + "y": 5.837758514843543, + "heading": -3.513073580944635, + "angularVelocity": 0.33588030587629836, + "velocityX": -0.41971546897661216, + "velocityY": 0.26480931006070224, "moduleForcesX": [ - -103.79621548715679, - -104.66906472150548, - -79.65583433191968, - -86.74486016660069 + -106.89549145493714, + -107.06597038486555, + -81.32645261923486, + -88.6006152825964 ], "moduleForcesY": [ - 50.36433011206954, - 48.57600621993662, - 83.4697607403451, - 76.10242127485562 + 43.394757591016855, + 43.037242158674616, + 81.83966143502107, + 73.93350925841955 ], - "timestamp": 0.060837162963822244 + "timestamp": 0.06210179560796991 }, { - "x": 7.366683178068024, - "y": 5.871875693217713, - "heading": -3.4813530745022363, - "angularVelocity": 0.5694434642347287, - "velocityX": -0.8036274422502431, - "velocityY": 0.5542260224697102, + "x": 7.361748288757007, + "y": 5.870675766257217, + "heading": -3.472825051451228, + "angularVelocity": 0.6481057286569312, + "velocityX": -0.8403400652783898, + "velocityY": 0.5300531343967616, "moduleForcesX": [ - -102.97011057048296, - -104.36224405802562, - -80.57222592370957, - -87.538387979563 + -106.04093622896603, + -106.8176617255131, + -82.330045707325, + -89.53141023846203 ], "moduleForcesY": [ - 52.000569893921764, - 49.2024689993104, - 82.56810699384464, - 75.1709663223631 + 45.39917215492418, + 43.61156874588938, + 80.80897526070487, + 72.78287839067804 ], - "timestamp": 0.12167432592764449 + "timestamp": 0.12420359121593982 }, { - "x": 7.293282825426951, - "y": 5.9225047085781934, - "heading": -3.431709567684295, - "angularVelocity": 0.8160062764179649, - "velocityX": -1.2065051863894705, - "velocityY": 0.8322053970627743, + "x": 7.283368614850293, + "y": 5.920106690428392, + "heading": -3.415321669414071, + "angularVelocity": 0.9259536133247971, + "velocityX": -1.2621160650732042, + "velocityY": 0.7959661019017853, "moduleForcesX": [ - -101.81794700730566, - -103.86961088775284, - -81.86390049299231, - -88.59644120728534 + -104.78762461695497, + -106.36127377314644, + -83.82992057249801, + -90.79435455500895 ], "moduleForcesY": [ - 54.181240687854725, - 50.19424330306314, - 81.26407249712193, - 73.89664129178023 + 48.16400312768637, + 44.6582268703331, + 79.22203469459356, + 71.17035492491334 ], - "timestamp": 0.18251148889146673 + "timestamp": 0.18630538682390974 }, { - "x": 7.1953203397420005, - "y": 5.990100130181784, - "heading": -3.3694632408334324, - "angularVelocity": 1.0231628797003296, - "velocityX": -1.6102408612184471, - "velocityY": 1.1110876692883858, + "x": 7.178710465092463, + "y": 5.986116860930105, + "heading": -3.3437461630239302, + "angularVelocity": 1.1525513181933658, + "velocityX": -1.6852676920729752, + "velocityY": 1.0629349740289333, "moduleForcesX": [ - -100.2816827855571, - -102.97098993160482, - -83.78116306119979, - -89.91507313466994 + -103.01244546536581, + -105.38356550288951, + -86.22789009675718, + -92.4074760314894 ], "moduleForcesY": [ - 56.92156160204695, - 51.95654416018795, - 79.25162011086157, - 72.24946473264367 + 51.77437024681341, + 46.836336225769195, + 76.55773487195223, + 69.011950809141 ], - "timestamp": 0.24334865185528898 + "timestamp": 0.24840718243187965 }, { - "x": 7.0727413911385675, - "y": 6.0747360510060515, - "heading": -3.2981290809283044, - "angularVelocity": 1.1725425123381896, - "velocityX": -2.0148695736572453, - "velocityY": 1.391187831598893, + "x": 7.0476789147390875, + "y": 6.068797966265863, + "heading": -3.263241334420409, + "angularVelocity": 1.2963365682970727, + "velocityX": -2.1099478536907417, + "velocityY": 1.3313802689008434, "moduleForcesX": [ - -98.2967857325556, - -101.19960247774685, - -86.76685073104727, - -91.51945696061503 + -100.53419705098847, + -103.06905054921911, + -90.34073398334222, + -94.4854543183429 ], "moduleForcesY": [ - 60.21289489893422, - 55.24442779855469, - 75.91533220936326, - 70.14362208312181 + 56.32421606606602, + 51.598469531492704, + 71.56970538755402, + 66.03839637354763 ], - "timestamp": 0.3041858148191112 + "timestamp": 0.31050897803984956 }, { - "x": 6.925504994542901, - "y": 6.1764899452128645, - "heading": -3.2234493803323416, - "angularVelocity": 1.2275342398916893, - "velocityX": -2.420171970925455, - "velocityY": 1.6725614616073183, + "x": 6.890219706001051, + "y": 6.168188552754541, + "heading": -3.184089698328757, + "angularVelocity": 1.274546658703927, + "velocityX": -2.5355017064568197, + "velocityY": 1.6004462594946758, "moduleForcesX": [ - -95.75953255949935, - -97.31237310212741, - -91.76671164693617, - -93.57306626338037 + -96.91797721607088, + -96.29166873701149, + -98.30376883932875, + -97.7151339255793 ], "moduleForcesY": [ - 64.06733787812749, - 61.704100587843456, - 69.68084586415333, - 67.25296923337032 + 62.16157487034742, + 63.11727303496232, + 59.937833099468605, + 60.88181944934315 ], - "timestamp": 0.36502297778293347 + "timestamp": 0.37261077364781947 }, { - "x": 6.7536964435204645, - "y": 6.295259954535899, - "heading": -3.1573307264826953, - "angularVelocity": 1.086813563100644, - "velocityX": -2.8240723704457587, - "velocityY": 1.9522608145561011, + "x": 6.707396761735225, + "y": 6.282083749845621, + "heading": -3.1426185384704066, + "angularVelocity": 0.667793249009192, + "velocityX": -2.943923641434326, + "velocityY": 1.8340081148388676, "moduleForcesX": [ - -92.25427081535649, - -86.53217011804067, - -101.20179764226755, - -97.11446599263788 + -89.39704823104165, + -59.974779639430686, + -113.80694315967615, + -110.38024149575088 ], "moduleForcesY": [ - 68.84873167392043, - 75.85885179568066, - 54.786384608235366, - 61.64809216339915 + 72.20506885999238, + 97.79151184647154, + 14.788993764846895, + 28.839425985382416 ], - "timestamp": 0.4258601407467557 + "timestamp": 0.4347125692557894 }, { - "x": 6.5590064200801805, - "y": 6.426527001243398, - "heading": -3.142643870470458, - "angularVelocity": 0.24141257245955464, - "velocityX": -3.200182486419688, - "velocityY": 2.157678634448467, + "x": 6.5096539372796265, + "y": 6.407528929196308, + "heading": -3.1425069776210126, + "angularVelocity": 0.0017964190616627644, + "velocityX": -3.1841724143354817, + "velocityY": 2.0199927896220715, "moduleForcesX": [ - -84.74996163721526, - -38.815685267763385, - -114.64908329430031, - -112.94150068763071 + -63.73430047048059, + -27.910051624661733, + -81.07343060013055, + -47.0233396086935 ], "moduleForcesY": [ - 77.54282904121575, - 107.86535624618253, - 1.6603151606166382, - 4.720404786880023 + 63.59254149911791, + 78.23128798690023, + 10.792434877490132, + 17.49274670317357 ], - "timestamp": 0.48669730371057796 + "timestamp": 0.4968143648637593 }, { - "x": 6.359357039655459, - "y": 6.562363363203817, - "heading": -3.142536760064485, - "angularVelocity": 0.0017606081670331869, - "velocityX": -3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 6.311987970636452, + "y": 6.533099878628413, + "heading": -3.1424005830387, + "angularVelocity": 0.001713228760479499, + "velocityX": -3.182934804187995, + "velocityY": 2.0220180141778825, "moduleForcesX": [ - -25.631275124724667, - -11.445573252590584, - -26.924267849020588, - -12.108894286779364 + 0.28044804636635795, + 0.2854585156252423, + 0.2805164694315654, + 0.28554463484010184 ], "moduleForcesY": [ - 26.818501650047196, - 27.856532036432693, - 7.559585000412651, - 7.889518984351467 + 0.4664832664910793, + 0.46629629597971395, + 0.45988069254081865, + 0.45969100338396346 ], - "timestamp": 0.5475344666744002 + "timestamp": 0.5589161604717292 }, { - "x": 6.150813575777984, - "y": 6.684102379422477, - "heading": -3.142424203474444, - "angularVelocity": 0.001850128844891342, - "velocityX": -3.4278959392220183, - "velocityY": 2.001063335104134, + "x": 6.112886530666606, + "y": 6.656381795149372, + "heading": -3.1422932741509393, + "angularVelocity": 0.001727951449866915, + "velocityX": -3.206049648334116, + "velocityY": 1.9851586466067415, "moduleForcesX": [ - -34.11956696981292, - -34.125974092877726, - -34.12166225634603, - -34.128069599930605 + -5.284961607212092, + -5.285867690384544, + -5.2850120640368585, + -5.28591821205513 ], "moduleForcesY": [ - -54.09118913684165, - -54.08961846611762, - -54.08460010575841, - -54.083029392944155 + -8.428859802481485, + -8.428820483404417, + -8.427704094995518, + -8.427665220538435 ], - "timestamp": 0.6083716296382224 + "timestamp": 0.6210179560796991 }, { - "x": 5.92948393312288, - "y": 6.78064499032236, - "heading": -3.1422944875374577, - "angularVelocity": 0.0021321825454533767, - "velocityX": -3.6380664691205715, - "velocityY": 1.586901923044861, + "x": 5.903153552433724, + "y": 6.76054779134001, + "heading": -3.1421763428195106, + "angularVelocity": 0.001882897753344962, + "velocityX": -3.377244992348762, + "velocityY": 1.6773427430054257, "moduleForcesX": [ - -49.03163546387958, - -49.062291976877944, - -49.05084786401326, - -49.08151053061538 + -39.13650558561692, + -39.149028631143274, + -39.14202011232457, + -39.15454418789349 ], "moduleForcesY": [ - -96.68438290730587, - -96.67004058315028, - -96.6714276505825, - -96.65707564207314 + -70.39220856869584, + -70.38808653661687, + -70.38227306623791, + -70.37815024115646 ], - "timestamp": 0.6692087926020447 + "timestamp": 0.683119751687669 }, { - "x": 5.698043840852722, - "y": 6.849459835142262, - "heading": -3.142133803067373, - "angularVelocity": 0.0026412222769214106, - "velocityX": -3.80425517882526, - "velocityY": 1.1311317206034748, + "x": 5.681800942539791, + "y": 6.836948493802415, + "heading": -3.142036982527429, + "angularVelocity": 0.002244062200092101, + "velocityX": -3.5643512031643763, + "velocityY": 1.2302494914108861, "moduleForcesX": [ - -38.74033390445188, - -38.80840694131451, - -38.772841951602906, - -38.84095720701171 + -42.75035515553822, + -42.79383002375121, + -42.77356853041684, + -42.81705900203794 ], "moduleForcesY": [ - -106.40184229774029, - -106.37757896352488, - -106.38798347831748, - -106.36368214821303 + -102.24725073962186, + -102.22993200522637, + -102.23474808291238, + -102.21741225918257 ], - "timestamp": 0.7300459555658669 + "timestamp": 0.7452215472956389 }, { - "x": 5.459913340003193, - "y": 6.889216371961373, - "heading": -3.1419171816291134, - "angularVelocity": 0.003560676200305988, - "velocityX": -3.9142275748646917, - "velocityY": 0.653490972988881, + "x": 5.452329247860557, + "y": 6.883506999197636, + "heading": -3.141856084971286, + "angularVelocity": 0.002912919898230047, + "velocityX": -3.6950895289376384, + "velocityY": 0.7497127086168015, "moduleForcesX": [ - -25.577114001754065, - -25.717865755187383, - -25.620041504490064, - -25.761004866741906 + -29.82914130574372, + -29.925476931514535, + -29.863722347706368, + -29.960153351309717 ], "moduleForcesY": [ - -111.50955109747034, - -111.47748761628132, - -111.49785520760967, - -111.46568684412037 + -109.89810991838907, + -109.87230666320609, + -109.88678831438045, + -109.86092743160704 ], - "timestamp": 0.7908831185296892 + "timestamp": 0.8073233429036089 }, { "x": 5.218749084472655, "y": 6.899192810058594, "heading": -3.141592653589793, - "angularVelocity": 0.005334371681882162, - "velocityX": -3.964094375570246, - "velocityY": 0.16398591931634418, + "angularVelocity": 0.004241928577334819, + "velocityX": -3.7612465324259428, + "velocityY": 0.2525822435148049, "moduleForcesX": [ - -11.472950024585305, - -11.766242291584785, - -11.512400965901131, - -11.806680580908067 + -15.002575278462157, + -15.2146838817836, + -15.03997983187976, + -15.25259845361454 ], "moduleForcesY": [ - -114.27486879290602, - -114.2452044120995, - -114.2687583678, - -114.2388907542841 + -113.69134460089438, + -113.66335076467918, + -113.68440690030413, + -113.65627458813692 ], - "timestamp": 0.8517202814935114 + "timestamp": 0.8694251385115788 }, { - "x": 4.916924325700423, - "y": 6.864260942419369, - "heading": -3.1415950035328826, - "angularVelocity": -0.00003069941458382123, - "velocityX": -3.943007574588477, - "velocityY": -0.4563463224696035, + "x": 4.928181972145996, + "y": 6.87015777266571, + "heading": -3.141599360558739, + "angularVelocity": -0.0000866124738088435, + "velocityX": -3.7523263652724554, + "velocityY": -0.3749527448361419, "moduleForcesX": [ - 3.5661256761579754, - 4.290300452597265, - 3.5363367506884513, - 4.254477917247712 + 1.3524659590982626, + 1.9300173473620212, + 1.3434416674907999, + 1.9171433879503503 ], "moduleForcesY": [ - -115.08817444708899, - -115.06352371966176, - -115.091807306801, - -115.06756634659668 + -115.0791940311929, + -115.07098399891115, + -115.08184184287786, + -115.0737409512458 ], - "timestamp": 0.9282671186635447 + "timestamp": 0.946861662961008 }, { - "x": 4.624233759004072, - "y": 6.782789828791696, - "heading": -3.141613203556746, - "angularVelocity": -0.0002377632379964541, - "velocityX": -3.823679429709109, - "velocityY": -1.0643302406695383, + "x": 4.646396057477393, + "y": 6.793457496928237, + "heading": -3.141606663617506, + "angularVelocity": -0.00009431026016780606, + "velocityX": -3.6389277110781113, + "velocityY": -0.9904922293815314, "moduleForcesX": [ - 22.126953133722363, - 22.152969056839062, - 22.120137478707928, - 22.146146005278467 + 20.7945154399426, + 20.79547645165578, + 20.794279315526616, + 20.795240317066792 ], "moduleForcesY": [ - -112.78882065085001, - -112.783738070124, - -112.7903239244963, - -112.78524441350454 + -112.87678463656185, + -112.87660869109382, + -112.87683614320373, + -112.87666020166296 ], - "timestamp": 1.004813955833578 + "timestamp": 1.0242981874104373 }, { - "x": 4.364815135242433, - "y": 6.667702152711534, - "heading": -3.1445463260067914, - "angularVelocity": -0.03831800971122916, - "velocityX": -3.389018192683674, - "velocityY": -1.5034935515953176, + "x": 4.381846370817898, + "y": 6.67179475203828, + "heading": -3.1420798505720358, + "angularVelocity": -0.00611064298009589, + "velocityX": -3.4163424629454022, + "velocityY": -1.5711286857845959, "moduleForcesX": [ - 80.9419265471949, - 82.77126323116903, - 78.469916779085, - 80.35273216958149 + 40.66256347127909, + 41.289770106870066, + 40.34665877997078, + 40.970425111678864 ], "moduleForcesY": [ - -81.16083698479932, - -79.32224282560593, - -83.58853211441301, - -81.80494379688997 + -106.52838528799592, + -106.29034131292164, + -106.66047133973122, + -106.42582853323142 ], - "timestamp": 1.0813607930036113 + "timestamp": 1.1017347118598666 }, { - "x": 4.152022632610264, - "y": 6.561745619437614, - "heading": -3.1479056109157355, - "angularVelocity": -0.04388535219922793, - "velocityX": -2.7798993465855872, - "velocityY": -1.3842052420605961, + "x": 4.164221462692653, + "y": 6.562682372433733, + "heading": -3.14551504003902, + "angularVelocity": -0.04436135907968595, + "velocityX": -2.810365130312185, + "velocityY": -1.4090557444349736, "moduleForcesX": [ - 112.9351029547452, - 112.95285116511826, - 113.04267855576263, - 113.05965579629232 + 110.51967200781795, + 110.75149967016266, + 111.51809488586062, + 111.7036498757053 ], "moduleForcesY": [ - 22.445395936831837, - 22.361919228925984, - 21.895492780162357, - 21.813838326495294 + 31.93883577086322, + 31.16312570353636, + 28.240069272526224, + 27.540756606496988 ], - "timestamp": 1.1579076301736446 + "timestamp": 1.1791712363092959 }, { - "x": 3.9834975897286435, - "y": 6.473209425403713, - "heading": -3.150924095180105, - "angularVelocity": -0.03943316766524029, - "velocityX": -2.2015938099085024, - "velocityY": -1.15662772371947, + "x": 3.9912382536008786, + "y": 6.472975043297138, + "heading": -3.1492007720912656, + "angularVelocity": -0.047596816598514495, + "velocityX": -2.2338710359443223, + "velocityY": -1.1584627509358232, "moduleForcesX": [ - 107.38700511167124, - 107.33800844105599, - 107.22522115524383, - 107.17535879811417 + 105.63214461850299, + 105.67464605947447, + 105.75886325172861, + 105.80089159312243 ], "moduleForcesY": [ - 41.949490847006764, - 42.073301202563364, - 42.36206037528205, - 42.486672112027655 + 46.14736365416799, + 46.050955922132644, + 45.85560825753269, + 45.759565710113016 ], - "timestamp": 1.234454467343678 + "timestamp": 1.2566077607587252 }, { - "x": 3.8579746529951326, - "y": 6.405071382147857, - "heading": -3.153336798543532, - "angularVelocity": -0.03151930834278344, - "velocityX": -1.6398187224207155, - "velocityY": -0.8901483820226407, + "x": 3.8620199488900053, + "y": 6.40464261213393, + "heading": -3.1523691394326896, + "angularVelocity": -0.04091567078908538, + "velocityX": -1.6686996947449793, + "velocityY": -0.8824315353645945, "moduleForcesX": [ - 104.4433579329168, - 104.3219357419469, - 104.10925807795152, - 103.98479429515396 + 103.83684095617444, + 103.73019304787823, + 103.55145256185551, + 103.44265988179228 ], "moduleForcesY": [ - 48.95192669669994, - 49.20870816840664, - 49.6594512669405, - 49.91813079706965 + 50.21517063638313, + 50.43388218964512, + 50.80188828293292, + 51.02184694806683 ], - "timestamp": 1.3110013045137112 + "timestamp": 1.3340442852081544 }, { - "x": 3.774719039814072, - "y": 6.358839505806994, - "heading": -3.1550135157289017, - "angularVelocity": -0.021904460685229093, - "velocityX": -1.087642759113939, - "velocityY": -0.6039684727687442, + "x": 3.7761167781122684, + "y": 6.358611977323752, + "heading": -3.1546632201056606, + "angularVelocity": -0.029625305232664833, + "velocityX": -1.1093366003769725, + "velocityY": -0.5944305369779248, "moduleForcesX": [ - 102.73833096424609, - 102.56600686278176, - 102.3045321462237, - 102.12754606615566 + 102.92566676985241, + 102.72849667186833, + 102.42499394558602, + 102.22155812605034 ], "moduleForcesY": [ - 52.50070663442109, - 52.83532642023229, - 53.34195778156506, - 53.67882683102995 + 52.13043037442421, + 52.516439019906585, + 53.108410856562514, + 53.49751224898036 ], - "timestamp": 1.3875481416837445 + "timestamp": 1.4114808096575837 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -0.01128475152706064, - "velocityX": -0.5416639429287429, - "velocityY": -0.305935833734179, + "angularVelocity": -0.01567874681256553, + "velocityX": -0.5534907492707787, + "velocityY": -0.29948260373218166, "moduleForcesX": [ - 101.63866464193978, - 101.43052677926975, - 101.14130973054236, - 100.92738648366812 + 102.37649295640064, + 102.12022129821456, + 101.74499661591258, + 101.47905712486347 ], "moduleForcesY": [ - 54.637212756137814, - 55.0215850566622, - 55.55326636709894, - 55.939948032818286 + 53.242773443897086, + 53.731262222189436, + 54.44082769369383, + 54.93360379578886 ], - "timestamp": 1.4640949788537778 + "timestamp": 1.488917334107013 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -5.114527347233404e-23, - "velocityX": 8.88120104270887e-21, - "velocityY": -1.1112992505795778e-20, + "angularVelocity": 1.2481966357163992e-21, + "velocityX": 6.111631210383028e-20, + "velocityY": -8.886773491570175e-20, "moduleForcesX": [ - 100.87338423663934, - 100.63924602824056, - 100.33208991745956, - 100.09136074426307 + 102.00973407493207, + 101.71254310622048, + 101.29023818682474, + 100.98075222935965 ], "moduleForcesY": [ - 56.06251668808282, - 56.480829327320826, - 57.02628087598985, - 57.44686854165232 + 53.969295684402134, + 54.526035754852536, + 55.3087820339606, + 55.870598413077936 ], - "timestamp": 1.5406418160238111 + "timestamp": 1.5663538585564423 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue OP.traj b/src/main/deploy/choreo/Blue OP.traj index 65a9e9e..1e93d79 100644 --- a/src/main/deploy/choreo/Blue OP.traj +++ b/src/main/deploy/choreo/Blue OP.traj @@ -4,9 +4,9 @@ "x": 0.7587480926513663, "y": 6.674294471740723, "heading": -2.1045042248017936, - "angularVelocity": 1.5246049853933737e-25, - "velocityX": -2.0272981672250602e-24, - "velocityY": -2.368851786462168e-25, + "angularVelocity": 1.974529983201505e-22, + "velocityX": 1.3949524343162162e-20, + "velocityY": 1.7216480334359217e-21, "moduleForcesX": [ 0, 0, @@ -22,2487 +22,2508 @@ "timestamp": 0 }, { - "x": 0.8024207657231025, - "y": 6.679677617673034, - "heading": -2.1177141826984873, - "angularVelocity": -0.17911083631788266, - "velocityX": 0.5921479129069698, - "velocityY": 0.0729888601839491, + "x": 0.8024205497601767, + "y": 6.679677689320791, + "heading": -2.117721058110864, + "angularVelocity": -0.1792040409939818, + "velocityX": 0.592144926929208, + "velocityY": 0.07298982451690292, "moduleForcesX": [ - 114.49845914960216, - 111.52415378273294, - 115.39645209570612, - 114.62304761463147 + 114.49839415532603, + 111.52193059132293, + 115.39636467253322, + 114.62307907253539 ], "moduleForcesY": [ - 14.302632979180666, - 29.647246899745284, - -1.1737539863505286, - 13.436170515363187 + 14.30298485898657, + 29.655557879336452, + -1.181353158922053, + 13.435844022960593 ], - "timestamp": 0.07375297982110329 + "timestamp": 0.07375298701838148 }, { - "x": 0.8897572775547896, - "y": 6.690442536464301, - "heading": -2.1442928098503233, - "angularVelocity": -0.3603736041080037, - "velocityX": 1.1841760433752269, - "velocityY": 0.14595910317628294, + "x": 0.8897567314254748, + "y": 6.690442727379406, + "heading": -2.144310167069316, + "angularVelocity": -0.3605156893757417, + "velocityX": 1.184171451164837, + "velocityY": 0.14596070605154757, "moduleForcesX": [ - 114.41456026220696, - 111.50844636902374, - 115.37690823700737, - 114.64994745113319 + 114.41445099721368, + 111.50730603264704, + 115.37684481502328, + 114.6499789417417 ], "moduleForcesY": [ - 14.788729002822109, - 29.631929160379446, - -1.281113395748738, - 13.05841362930543 + 14.789343949904026, + 29.636133156128125, + -1.2850231166131485, + 13.057990695853633 ], - "timestamp": 0.14750595964220659 + "timestamp": 0.14750597403676297 }, { - "x": 1.020739829952666, - "y": 6.706587085965137, - "heading": -2.184566868757912, - "angularVelocity": -0.5460668708610559, - "velocityX": 1.7759628521530972, - "velocityY": 0.21890030124879628, + "x": 1.0207390149953617, + "y": 6.706587400459137, + "heading": -2.184592527891774, + "angularVelocity": -0.5461793813506001, + "velocityX": 1.775959033865869, + "velocityY": 0.2189019554653092, "moduleForcesX": [ - 114.27773305577186, - 111.46040731354765, - 115.34136867400807, - 114.68449962172555 + 114.27765420928105, + 111.46108154508879, + 115.34135846330668, + 114.68446600714897 ], "moduleForcesY": [ - 15.525374011394451, - 29.68197180848282, - -1.5144551853010968, - 12.482698846734147 + 15.525601814683363, + 29.679266789583505, + -1.5118713708450173, + 12.482626306329042 ], - "timestamp": 0.22125893946330988 + "timestamp": 0.22125896105514445 }, { - "x": 1.1953286514334718, - "y": 6.7281056267189525, - "heading": -2.239127367508517, - "angularVelocity": -0.7397734828199135, - "velocityX": 2.3672104083698327, - "velocityY": 0.29176503520279534, + "x": 1.1953280076893775, + "y": 6.728105972585149, + "heading": -2.23914640818786, + "angularVelocity": -0.7396836725065663, + "velocityX": 2.3672124988036476, + "velocityY": 0.2917654320990209, "moduleForcesX": [ - 114.047317314268, - 111.33731276290986, - 115.26103974744757, - 114.70303402913382 + 114.04761304875296, + 111.34169862631441, + 115.26119474678515, + 114.70270359118508 ], "moduleForcesY": [ - 16.537440340405908, - 29.85222721217794, - -1.9511492781751685, - 11.678182443826518 + 16.534704753620296, + 29.835398318882216, + -1.9345387090443167, + 11.680162554712453 ], - "timestamp": 0.29501191928441317 + "timestamp": 0.29501194807352593 }, { - "x": 1.4133617748282827, - "y": 6.754973444774636, - "heading": -2.3095237263100015, - "angularVelocity": -0.95448833351872, - "velocityX": 2.956261888315244, - "velocityY": 0.3642946782740959, + "x": 1.4133630444925243, + "y": 6.754973345333406, + "heading": -2.309476126798875, + "angularVelocity": -0.9535846811666981, + "velocityX": 2.956287543293751, + "velocityY": 0.364288604901666, "moduleForcesX": [ - 113.4372446028584, - 110.7664793158522, - 114.9120784501825, - 114.5415955789105 + 113.43975897922057, + 110.78310373820221, + 114.91309615963543, + 114.53954300836372 ], "moduleForcesY": [ - 18.019343819168103, - 30.725491734044468, - -3.316928025724304, - 10.430723288375912 + 18.000125302132677, + 30.662429048736804, + -3.2520872885591716, + 10.443175232183405 ], - "timestamp": 0.36876489910551646 + "timestamp": 0.36876493509190744 }, { - "x": 1.5879369987940704, - "y": 6.77647174900219, - "heading": -2.368159117892291, - "angularVelocity": -0.795024034615507, - "velocityX": 2.367026042734014, - "velocityY": 0.2914906527126038, + "x": 1.5879382087995237, + "y": 6.776471593869833, + "heading": -2.368115423553959, + "angularVelocity": -0.7950769063830508, + "velocityX": 2.3670250028448327, + "velocityY": 0.2914898691638042, "moduleForcesX": [ - -113.21740142392868, - -111.67454146499207, - -114.66905825851462, - -114.23838580721045 + -113.2226233248531, + -111.69180132345564, + -114.66860726835483, + -114.23686977658001 ], "moduleForcesY": [ - -17.63441497120967, - -26.071917316634075, - -1.551746692059195, - -10.811867231610922 + -17.60948253721816, + -26.00046807992614, + -1.626211087567619, + -10.829705083256428 ], - "timestamp": 0.44251787892661976 + "timestamp": 0.44251792211028895 }, { - "x": 1.7188926416265469, - "y": 6.792594475814811, - "heading": -2.4126844087531345, - "angularVelocity": -0.6037083649887068, - "velocityX": 1.7755979914320064, - "velocityY": 0.21860441234684702, + "x": 1.7188933932708355, + "y": 6.7925943671930265, + "heading": -2.412657668211584, + "angularVelocity": -0.6039381787550379, + "velocityX": 1.77559160334311, + "velocityY": 0.21860502164033385, "moduleForcesX": [ - -113.62556481771135, - -111.7658115885291, - -115.24093186284539, - -114.85540369095075 + -113.62660597529599, + -111.76902146309568, + -115.24105907142824, + -114.85509991104112 ], "moduleForcesY": [ - -19.05291831548316, - -28.10437611160287, - 0.7546034880784179, - -9.730572920361043 + -19.047183440095544, + -28.09175703488534, + 0.7411160901554255, + -9.734361300742805 ], - "timestamp": 0.516270858747723 + "timestamp": 0.5162709091286705 }, { - "x": 1.8062052429501583, - "y": 6.8033423608281804, - "heading": -2.442538059640397, - "angularVelocity": -0.4047789114375592, - "velocityX": 1.1838518461952148, - "velocityY": 0.14572814602799694, + "x": 1.8062055290223964, + "y": 6.8033423167589095, + "heading": -2.442527969545906, + "angularVelocity": -0.40500463156668004, + "velocityX": 1.183845418081848, + "velocityY": 0.14572900705980607, "moduleForcesX": [ - -113.62956435917394, - -111.79320392724135, - -115.33065660328327, - -114.97926679056616 + -113.62959134846822, + -111.79313493848042, + -115.33066788879077, + -114.97928385607841 ], "moduleForcesY": [ - -19.66367922942835, - -28.377381938028666, - 1.1672848935603133, - -9.251806083394865 + -19.663623460013877, + -28.377715570036685, + 1.1677274772719308, + -9.251771451433386 ], - "timestamp": 0.5900238385688263 + "timestamp": 0.590023896147052 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": -0.2026753043980138, - "velocityX": 0.5919727585178589, - "velocityY": 0.07286398915017842, + "angularVelocity": -0.2028120939192107, + "velocityX": 0.591968821960951, + "velocityY": 0.07286457956489104, "moduleForcesX": [ - -113.62366087491984, - -111.8118673061885, - -115.36748176404835, - -115.03206722044585 + -113.62315026046187, + -111.81031262941312, + -115.36741290735165, + -115.03223801565095 ], "moduleForcesY": [ - -19.953358992688422, - -28.459057623857348, - 1.3182086277736604, - -9.022048294829789 + -19.956291338037666, + -28.465206698015184, + 1.3250680498487681, + -9.020029236683413 ], - "timestamp": 0.6637768183899296 + "timestamp": 0.6637768831654335 }, { "x": 1.849864997863769, "y": 6.808716297149658, "heading": -2.4574859672759, - "angularVelocity": 1.6375349145968543e-23, - "velocityX": -8.416190090857964e-24, - "velocityY": -1.1457822086284433e-23, + "angularVelocity": 2.5664532387064434e-20, + "velocityX": 3.58109733081458e-20, + "velocityY": -1.9250395612999744e-19, "moduleForcesX": [ - -113.64454489492644, - -111.8226539019644, - -115.38802821587312, - -115.05199065534637 + -113.6437450585874, + -111.82024353932489, + -115.38791059104989, + -115.05224225386623 ], "moduleForcesY": [ - -19.97282399859899, - -28.500501780206434, - 1.3651700292396303, - -9.007971358764731 + -19.977376009298773, + -28.509989738927217, + 1.375687108873998, + -9.00489770006138 ], - "timestamp": 0.7375297982110329 + "timestamp": 0.737529870183815 }, { - "x": 1.8645573299347353, - "y": 6.813379455407895, - "heading": -2.4698373821559474, - "angularVelocity": -0.28012842601201615, - "velocityX": 0.33322011263133106, - "velocityY": 0.10575980127060347, + "x": 1.8645723712913458, + "y": 6.813251052040291, + "heading": -2.470362048205509, + "angularVelocity": -0.291937481479346, + "velocityX": 0.33345810585500346, + "velocityY": 0.10281582797868585, "moduleForcesX": [ - 101.74059915261986, - 98.66143888298554, - 115.33460700108112, - 113.5288649606166 + 101.77209540362661, + 98.56104344072968, + 115.34193264889893, + 113.76419860866353 ], "moduleForcesY": [ - 54.28404650214983, - 59.78500771311867, - 1.6254648649670587, - 20.548862722674198 + 54.21915011775309, + 59.95036989637321, + -0.9665078147579121, + 19.20688681592282 ], - "timestamp": 0.7816217707961987 + "timestamp": 0.7816354809617166 }, { - "x": 1.8940046755751128, - "y": 6.822611735205374, - "heading": -2.494018140417116, - "angularVelocity": -0.5484163407400852, - "velocityX": 0.6678618332055473, - "velocityY": 0.20938686241916526, + "x": 1.8940483404923603, + "y": 6.82225224455195, + "heading": -2.4955113925338255, + "angularVelocity": -0.5702073700998803, + "velocityX": 0.6683042969168801, + "velocityY": 0.20408270859191144, "moduleForcesX": [ - 102.42692626434818, - 99.75522587908064, - 115.3031246958328, - 113.61159697879017 + 102.41667407252245, + 99.67413943343911, + 115.33090537915734, + 113.80517697131701 ], "moduleForcesY": [ - 52.94923017342802, - 57.91883634702496, - 2.6054576839940773, - 20.022389058972593 + 52.96303310230837, + 58.05771513935198, + 0.5017832153094849, + 18.8925777650309 ], - "timestamp": 0.8257137433813644 + "timestamp": 0.8257410917396183 }, { - "x": 1.9382790700934251, - "y": 6.836296863592373, - "heading": -2.529422828329192, - "angularVelocity": -0.8029735536029945, - "velocityX": 1.0041373048754911, - "velocityY": 0.3103768687274161, + "x": 1.9383627444187277, + "y": 6.835636025102196, + "heading": -2.5322232607638195, + "angularVelocity": -0.8323627670606444, + "velocityX": 1.0047339362222991, + "velocityY": 0.3034484800049092, "moduleForcesX": [ - 103.17292508176737, - 101.05043111896798, - 115.25417706262766, - 113.72399441780098 + 103.11790484339456, + 100.9913251526931, + 115.29193191628325, + 113.86495520158225 ], "moduleForcesY": [ - 51.44579662555791, - 55.5992638735599, - 3.7639229891020305, - 19.289785821379215 + 51.549723350324314, + 55.70508515812473, + 2.2745321495904243, + 18.4374521698026 ], - "timestamp": 0.8698057159665301 + "timestamp": 0.8698467025175199 }, { - "x": 1.9974657259317126, - "y": 6.854289480670813, - "heading": -2.575283812457909, - "angularVelocity": -1.0401209435602916, - "velocityX": 1.3423453832546357, - "velocityY": 0.40807013212408666, + "x": 1.9975977513861578, + "y": 6.853299205917846, + "heading": -2.5795808332318555, + "angularVelocity": -1.0737312471764597, + "velocityX": 1.343026565615775, + "velocityY": 0.4004746902745723, "moduleForcesX": [ - 104.09282628417806, - 102.57468929953592, - 115.17640973922875, - 113.84725221188148 + 104.00399188740997, + 102.53916594922732, + 115.20317523209397, + 113.91900928393956 ], "moduleForcesY": [ - 49.51402786048951, - 52.6952744682404, - 5.208253519163967, - 18.43423684287415 + 49.69364802883043, + 52.761241240453266, + 4.521635796707419, + 17.977297280367612 ], - "timestamp": 0.9138976885516958 + "timestamp": 0.9139523132954216 }, { - "x": 2.0716675976705656, - "y": 6.876403676556319, - "heading": -2.6305587835600814, - "angularVelocity": -1.2536289002585739, - "velocityX": 1.6828884576558427, - "velocityY": 0.5015469843811484, + "x": 2.0718517640541934, + "y": 6.875112546792885, + "heading": -2.6363209715548055, + "angularVelocity": -1.2864607772619008, + "velocityX": 1.68355026397765, + "velocityY": 0.4945706564383518, "moduleForcesX": [ - 105.32254762054376, - 104.36995920291493, - 115.04927896233586, - 113.95741323469908 + 105.22540646754383, + 104.36005213468499, + 115.02101774687753, + 113.9321163834877 ], "moduleForcesY": [ - 46.78241555241346, - 48.987831626883, - 7.070518349276243, - 17.579302576575984 + 46.99284585116888, + 49.00253104776336, + 7.461228629108369, + 17.723543700297594 ], - "timestamp": 0.9579896611368616 + "timestamp": 0.9580579240733232 }, { - "x": 2.1610104299094206, - "y": 6.902392060853308, - "heading": -2.6937619082154276, - "angularVelocity": -1.4334383550943628, - "velocityX": 2.026283402637177, - "velocityY": 0.5894130557845074, + "x": 2.161242587426491, + "y": 6.900907275957239, + "heading": -2.7006222468278853, + "angularVelocity": -1.457893318763349, + "velocityX": 2.026744937791125, + "velocityY": 0.5848400851820307, "moduleForcesX": [ - 107.01525529263431, - 106.49908090238071, - 114.83695790685456, - 114.02178183246805 + 106.94884746449395, + 106.5218821791462, + 114.66217685453101, + 113.84546391040449 ], "moduleForcesY": [ - 42.68370625113585, - 44.08136979291938, - 9.506207591539834, - 16.920785278182457 + 42.83996232103603, + 44.012594395755336, + 11.3684923546982, + 18.031148465609068 ], - "timestamp": 1.0020816337220273 + "timestamp": 1.0021635348512248 }, { - "x": 2.2656466233828794, - "y": 6.9319034624003555, - "heading": -2.762683277508738, - "angularVelocity": -1.5631273733599858, - "velocityX": 2.373134775754236, - "velocityY": 0.669314612541883, + "x": 2.2659063963289214, + "y": 6.930444659197214, + "heading": -2.769745236736348, + "angularVelocity": -1.5672153426587598, + "velocityX": 2.3730270833222504, + "velocityY": 0.6696967283529638, "moduleForcesX": [ - 109.3097818040482, - 109.05079129956879, - 114.47840264239278, - 113.98678875725696 + 109.32029884870086, + 109.13072597484648, + 113.97055609730337, + 113.53294594518619 ], "moduleForcesY": [ - 36.26992503225889, - 37.16921771819769, - 12.695311902448834, - 16.797454949385287 + 36.22279873439688, + 36.90107882775041, + 16.5960539736341, + 19.561487229518903 ], - "timestamp": 1.0461736063071931 + "timestamp": 1.0462691456291264 }, { - "x": 2.3857485172054367, - "y": 6.964387520079728, - "heading": -2.833836246946023, - "angularVelocity": -1.6137397640772295, - "velocityX": 2.7238947767776653, - "velocityY": 0.7367340532707757, + "x": 2.385976040231636, + "y": 6.963340036530722, + "heading": -2.8392855150204563, + "angularVelocity": -1.5766764603779193, + "velocityX": 2.7223213052722013, + "velocityY": 0.745832032553765, "moduleForcesX": [ - 112.18021841591916, - 112.08031010757401, - 113.86796827837568, - 113.7324954323066 + 112.2912152633114, + 112.27314779878, + 112.64475573276908, + 112.62446776737102 ], "moduleForcesY": [ - 25.791337814688198, - 26.310541605673688, - 16.866370546912208, - 17.883772198148773 + 25.270849603483, + 25.368770069311715, + 23.647404391327054, + 23.76274258091671 ], - "timestamp": 1.090265578892359 + "timestamp": 1.090374756407028 }, { "x": 2.521431007385253, "y": 6.998851299285889, "heading": -2.9010585246753755, - "angularVelocity": -1.5245922055201655, - "velocityX": 3.0772606037922094, - "velocityY": 0.7816338708727879, + "angularVelocity": -1.4005703257570408, + "velocityX": 3.0711504673568135, + "velocityY": 0.8051416164258121, "moduleForcesX": [ - 114.74700757937691, - 114.82237403261927, - 112.7959826533612, - 112.85254185437864 + 114.82492813620281, + 114.88838435677178, + 110.01547367885281, + 109.50587966957572 ], "moduleForcesY": [ - 7.799925169065962, - 5.71704619443321, - 22.434461113364915, - 21.890043385783073 + 6.353046745851063, + 1.804812129477414, + 33.46666656638843, + 34.75647703160566 ], - "timestamp": 1.1343575514775248 + "timestamp": 1.1344803671849297 }, { - "x": 2.7542359720828538, - "y": 7.049557069939888, - "heading": -2.9616079641492825, - "angularVelocity": -0.9309010044100505, - "velocityX": 3.5791970553589567, - "velocityY": 0.7795621766496205, + "x": 2.7517129998548477, + "y": 7.053740973657355, + "heading": -2.9299259625172533, + "angularVelocity": -0.44310544982727984, + "velocityX": 3.534751037459037, + "velocityY": 0.8425380176261076, "moduleForcesX": [ - 112.55785468074943, - 105.9003453021406, - 110.9158025657128, - 108.95118327774631 + 112.165519313163, + 97.3293226757896, + 104.13823940579273, + 90.56768367714263 ], "moduleForcesY": [ - -23.892019604957188, - -44.548813535547104, - 30.50757452772647, - 36.124113744915036 + -25.633925874682376, + -60.862728439826846, + 48.85031849268756, + 70.25124390629986 ], - "timestamp": 1.1994014596772797 + "timestamp": 1.1996283762042956 }, { - "x": 2.991519490805528, - "y": 7.083413324629865, - "heading": -2.909884331471312, - "angularVelocity": 0.7952110214398992, - "velocityX": 3.64805137467998, - "velocityY": 0.5205138440636553, + "x": 2.9893225118438314, + "y": 7.084433906415846, + "heading": -2.911583132722001, + "angularVelocity": 0.28155626044994303, + "velocityX": 3.647225994555773, + "velocityY": 0.47112618206602574, "moduleForcesX": [ - 64.05615636732261, - -9.943360980696, - 108.07396127616549, - -102.05846309668742 + 50.32031969204731, + 2.9715371277548317, + 70.95695667054349, + -26.18494851299261 ], "moduleForcesY": [ - -93.25868171164622, - -112.65864909231036, - 15.439504342633711, - -35.740867487525705 + -89.36908292050751, + -102.27224679452215, + -51.59319249987694, + -80.58938519969574 ], - "timestamp": 1.2644453678770347 + "timestamp": 1.2647763852236615 }, { - "x": 3.195322835474054, - "y": 7.110151219170366, - "heading": -2.8543773726780923, - "angularVelocity": 0.853376747023774, - "velocityX": 3.1333194807825833, - "velocityY": 0.4110745384239114, + "x": 3.1939494569939986, + "y": 7.110014029553321, + "heading": -2.8635537159447884, + "angularVelocity": 0.7372353737308496, + "velocityX": 3.140954700385925, + "velocityY": 0.3926462761105286, "moduleForcesX": [ - -111.67573063214597, - -111.64039245061323, - -113.12917537886882, - -113.05374138509698 + -105.50415195458451, + -107.29038544493396, + -113.70906001277702, + -114.90061482209744 ], "moduleForcesY": [ - -27.135696145803198, - -27.380417914842752, - -20.25362840349164, - -20.80013262963885 + -44.920279415393765, + -41.12412783239419, + 15.269282404331058, + 2.3506230724880606 ], - "timestamp": 1.3294892760767896 + "timestamp": 1.3299243942430274 }, { - "x": 3.365241247233326, - "y": 7.131608923168945, - "heading": -2.8041832186816547, - "angularVelocity": 0.771696464521897, - "velocityX": 2.6123647311818834, - "velocityY": 0.3298956749751184, + "x": 3.364445667071558, + "y": 7.131108704498771, + "heading": -2.8137277276796153, + "angularVelocity": 0.7648121410795733, + "velocityX": 2.6170594104707225, + "velocityY": 0.3237961568276881, "moduleForcesX": [ - -114.39486717948931, - -114.5610194383314, - -112.89574776865837, - -113.08162800775546 + -114.00926980580653, + -113.95000686208216, + -114.43257923429907, + -114.37824029202251 ], "moduleForcesY": [ - -13.756071322380523, - -12.147523599218845, - -23.00273023368437, - -21.98460196366896 + -16.39731013290224, + -16.845089796422634, + -13.13574167848894, + -13.650410305482065 ], - "timestamp": 1.3945331842765445 + "timestamp": 1.3950724032623933 }, { - "x": 3.5012046297910944, - "y": 7.148379691490802, - "heading": -2.7621717710255616, - "angularVelocity": 0.6458936558220414, - "velocityX": 2.0903323050671294, - "velocityY": 0.2578376482291464, + "x": 3.500788039986836, + "y": 7.147889974863427, + "heading": -2.769405830231833, + "angularVelocity": 0.6803262005229909, + "velocityX": 2.09280951125836, + "velocityY": 0.25758684904197354, "moduleForcesX": [ - -114.86715102435959, - -115.09723127896024, - -112.75876113770701, - -113.1512196778291 + -114.81105309086456, + -114.97790928984212, + -113.51984327567992, + -113.7704647676614 ], "moduleForcesY": [ - -10.065224665337308, - -6.694150425031611, - -24.086273621516757, - -22.080340952979487 + -10.56866698989057, + -8.413922151143787, + -20.14217381557191, + -18.60133702632721 ], - "timestamp": 1.4595770924762994 + "timestamp": 1.4602204122817593 }, { - "x": 3.603189035556874, - "y": 7.1607529171336655, - "heading": -2.729703667472547, - "angularVelocity": 0.49917208931084384, - "velocityX": 1.5679317031900575, - "velocityY": 0.19022881596942023, + "x": 3.603006546144034, + "y": 7.16043119839742, + "heading": -2.733913758650608, + "angularVelocity": 0.5447913468955666, + "velocityX": 1.5690196476582279, + "velocityY": 0.19250355801766228, "moduleForcesX": [ - -115.03722833246768, - -115.27036043262517, - -112.665644218642, - -113.22264635282365 + -115.0419243067659, + -115.25718411477271, + -112.93907410546888, + -113.43999532206205 ], "moduleForcesY": [ - -8.482092446228055, - -3.8979414954172227, - -24.715945351408653, - -21.94466991910266 + -8.366260966557782, + -4.184211702175365, + -23.417109666661702, + -20.7767741687879 ], - "timestamp": 1.5246210006760543 + "timestamp": 1.5253684213011252 }, { - "x": 3.671183447453962, - "y": 7.168899399845526, - "heading": -2.7075665515768197, - "angularVelocity": 0.3403411096968915, - "velocityX": 1.0453617222426475, - "velocityY": 0.12524589830676436, + "x": 3.671130056542355, + "y": 7.168770766708615, + "heading": -2.709133399652067, + "angularVelocity": 0.3803701658967712, + "velocityX": 1.04567294417345, + "velocityY": 0.12800956524573953, "moduleForcesX": [ - -115.1220732972316, - -115.34180830581067, - -112.60054698627378, - -113.27936411804733 + -115.14281844208664, + -115.34930465283051, + -112.55115361335105, + -113.24852185391627 ], "moduleForcesY": [ - -7.623094959817519, - -2.2058871322717164, - -25.12574554620353, - -21.792793628817755 + -7.285612760344089, + -1.6624491289950194, + -25.340251738278866, + -21.942249710998937 ], - "timestamp": 1.5896649088758092 + "timestamp": 1.590516430320491 }, { - "x": 3.70518211364746, + "x": 3.7051821136474588, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 0.17334260390221154, - "velocityX": 0.5227033112629946, - "velocityY": 0.062000397052170114, + "angularVelocity": 0.19711620790671266, + "velocityX": 0.5226876096087982, + "velocityY": 0.06387580117578412, "moduleForcesX": [ - -115.17526382073036, - -115.37550458711, - -112.55684919025829, - -113.31339825214359 + -115.20102163601169, + -115.37974072229976, + -112.28107877840189, + -113.11488966367791 ], "moduleForcesY": [ - -7.042007188765662, - -1.080500824591024, - -25.396097743199658, - -21.71168485805974 + -6.608776467019436, + -0.004287565573965457, + -26.587848089395084, + -22.715577580127167 ], - "timestamp": 1.6547088170755642 + "timestamp": 1.655664439339857 }, { "x": 3.70518211364746, "y": 7.172932147979736, "heading": -2.6962916711614975, - "angularVelocity": 3.993262685913717e-22, - "velocityX": -8.259434242676659e-22, - "velocityY": -8.025539423896893e-21, + "angularVelocity": 4.3308234278847845e-20, + "velocityX": 8.056096608901281e-20, + "velocityY": -2.6738378957205373e-19, "moduleForcesX": [ - -115.2157166646866, - -115.39271629885711, - -112.5314849425636, - -113.32030793770696 + -115.24383423254851, + -115.38688887330075, + -112.09250755639515, + -112.9939218228949 ], "moduleForcesY": [ - -6.549472740050475, - -0.2866941492311489, - -25.56167956840566, - -21.745134141493214 + -6.0471361581514245, + 1.155635277233433, + -27.42405623065836, + -23.37602173859363 ], - "timestamp": 1.719752725275319 + "timestamp": 1.7208124483592229 }, { - "x": 3.7327722712749694, - "y": 7.174709038499013, - "heading": -2.7134141974114816, - "angularVelocity": -0.2913880585511265, - "velocityX": 0.46952431836436115, - "velocityY": 0.03023880186314412, + "x": 3.733781754166325, + "y": 7.174820039076195, + "heading": -2.7170402757017182, + "angularVelocity": -0.3458966849026198, + "velocityX": 0.47678005649515276, + "velocityY": 0.03147273207971763, "moduleForcesX": [ - 113.03432284252689, - 111.63376359219197, - 113.87965459197578, - 115.30641606592077 + 112.32377906856806, + 110.78430493237788, + 113.12589486821226, + 115.23706895839639 ], "moduleForcesY": [ - 23.049027164974643, - 29.185604964347963, - -18.522278194463343, - -4.4827583754706755 + 26.289960305975715, + 32.271465274484434, + -22.685214004024196, + -6.074152668020877 ], - "timestamp": 1.7785146605966304 + "timestamp": 1.7807974249312368 }, { - "x": 3.78798662671582, - "y": 7.178230603874502, - "heading": -2.746994385755768, - "angularVelocity": -0.5714615790080665, - "velocityX": 0.9396279264618796, - "velocityY": 0.0599293633920152, + "x": 3.7910470948922277, + "y": 7.178545444277794, + "heading": -2.7574326569967935, + "angularVelocity": -0.6733749615886386, + "velocityX": 0.9546613835408172, + "velocityY": 0.06210563735280476, "moduleForcesX": [ - 113.08025540759344, - 111.9745660585701, - 114.07142344583939, - 115.2878683815402 + 112.46001862879739, + 111.34041034625368, + 113.49633756841048, + 115.21709287532448 ], "moduleForcesY": [ - 22.75020026715537, - 27.798664214369406, - -17.204952975290553, - -4.644259008501021 + 25.636303420097065, + 30.249349366921713, + -20.667196776630867, + -6.2116432185372705 ], - "timestamp": 1.8372765959179418 + "timestamp": 1.8407824015032508 }, { - "x": 3.8708665679135543, - "y": 7.183456533131369, - "heading": -2.7961591284850487, - "angularVelocity": -0.8366767101942216, - "velocityX": 1.4104358671058923, - "velocityY": 0.088933920033307, + "x": 3.8770597022586974, + "y": 7.184048443151815, + "heading": -2.8159476506282473, + "angularVelocity": -0.97549414829236, + "velocityX": 1.4339024916215242, + "velocityY": 0.09173961862625027, "moduleForcesX": [ - 113.13856392421164, - 112.39241209224183, - 114.30163807419474, - 115.26232496995145 + 112.65201576445827, + 112.01287501883925, + 113.94247486613867, + 115.19409328267592 ], "moduleForcesY": [ - 22.361639151859006, - 25.984522474314716, - -15.454500356764035, - -4.855118557125547 + 24.690234496665077, + 27.58289113859666, + -17.909106058656565, + -6.303104707024021 ], - "timestamp": 1.8960385312392531 + "timestamp": 1.9007673780752647 }, { - "x": 3.981466671816221, - "y": 7.1903382613240066, - "heading": -2.859580630572741, - "angularVelocity": -1.0792956654831463, - "velocityX": 1.8821725883925222, - "velocityY": 0.11711200720343934, + "x": 3.991926797311324, + "y": 7.191263389762513, + "heading": -2.8901833767362453, + "angularVelocity": -1.2375719780247907, + "velocityX": 1.914931064692922, + "velocityY": 0.12027922695006076, "moduleForcesX": [ - 113.27691583678147, - 112.89842492883132, - 114.5802390264178, - 115.23714227829124 + 113.02354769728046, + 112.81041180905633, + 114.47046500698897, + 115.18961505698348 ], "moduleForcesY": [ - 21.51009445696987, - 23.572724562516772, - -12.981065814635985, - -4.864096919796839 + 22.79359621013854, + 23.989273941713172, + -13.892228757886805, + -5.866006661430295 ], - "timestamp": 1.9548004665605645 + "timestamp": 1.9607523546472787 }, { - "x": 4.119861588330392, - "y": 7.198818881382969, - "heading": -2.935024943967934, - "angularVelocity": -1.2838976964026465, - "velocityX": 2.3551796883037346, - "velocityY": 0.14432166014599293, + "x": 4.135787380780922, + "y": 7.200124822376675, + "heading": -2.975989704811233, + "angularVelocity": -1.4304636423750967, + "velocityX": 2.3982768968308075, + "velocityY": 0.14772753313528372, "moduleForcesX": [ - 113.59238050873091, - 113.50883091034551, - 114.89486558850359, - 115.2246253766407 + 113.71654311369024, + 113.7421275367746, + 115.0022414818884, + 115.22737898976276 ], "moduleForcesY": [ - 19.545611913909962, - 20.215865610819638, - -9.292159419632293, - -4.1677749943057485 + 18.78236752442223, + 18.819926926426316, + -7.74740103881101, + -3.863631013963341 ], - "timestamp": 2.013562401881876 + "timestamp": 2.0207373312192924 }, { - "x": 4.2861478472017795, - "y": 7.20882879407445, - "heading": -3.0183525114528353, - "angularVelocity": -1.4180534903975592, - "velocityX": 2.829829513989471, - "velocityY": 0.1703468859006533, + "x": 4.308777368553381, + "y": 7.210562916135439, + "heading": -3.0653657545339787, + "angularVelocity": -1.4899739039732145, + "velocityX": 2.8838885610762834, + "velocityY": 0.17401180020855808, "moduleForcesX": [ - 114.20109143791724, - 114.24355796594509, - 115.14763181288494, - 115.21632171398483 + 114.74211551098469, + 114.76126852409652, + 115.16168855405087, + 115.1687730331768 ], "moduleForcesY": [ - 15.09888258206903, - 15.001571052472123, - -3.4085278625123507, - -1.5352801286814852 + 10.07031433544062, + 10.008825147658575, + 2.247411863424039, + 2.562462854663516 ], - "timestamp": 2.0723243372031876 + "timestamp": 2.0807223077913064 }, { - "x": 4.480372914613033, - "y": 7.22024637414857, - "heading": -3.100297234740481, - "angularVelocity": -1.394520497658391, - "velocityX": 3.305287110596799, - "velocityY": 0.19430231512437993, + "x": 4.510499605188572, + "y": 7.222385830186037, + "heading": -3.1376440847719658, + "angularVelocity": -1.2049405429243567, + "velocityX": 3.36287931017223, + "velocityY": 0.19709791894983528, "moduleForcesX": [ - 114.97889469256124, - 114.97100473665363, - 114.82552416001533, - 114.8139912747789 + 114.49070976762584, + 114.0438403664486, + 113.11098060490103, + 111.91885906316108 ], "moduleForcesY": [ - 4.253087696650956, - 4.242749140548247, - 7.3045456282466565, - 7.355545167868178 + -11.072443207695146, + -14.076136858622377, + 20.922368283411416, + 26.086845583350566 ], - "timestamp": 2.1310862725244992 + "timestamp": 2.1407072843633204 }, { - "x": 4.7002342564486375, - "y": 7.23241969553516, - "heading": -3.140917676775582, - "angularVelocity": -0.6912713445019829, - "velocityX": 3.741560597577289, - "velocityY": 0.2071633842559193, + "x": 4.735395377959576, + "y": 7.235252445190618, + "heading": -3.1407920089832335, + "angularVelocity": -0.05247854364815179, + "velocityX": 3.7492016438651055, + "velocityY": 0.21449729148653832, "moduleForcesX": [ - 110.70709433093435, - 102.78978326842808, - 109.17877166162005, - 99.03740787130127 + 107.40451669387667, + 81.544981345394, + 104.09396678970627, + 72.77164512682684 ], "moduleForcesY": [ - -29.86588290077606, - -49.60370655750762, - 35.07856026223783, - 56.82286597574377 + -39.74553876688157, + -79.06583770683346, + 47.816771425137595, + 87.47036330162247 ], - "timestamp": 2.189848207845811 + "timestamp": 2.2006922609353343 }, { - "x": 4.933038375930493, - "y": 7.246562519511795, - "heading": -3.141057152136353, - "angularVelocity": -0.0023735664934791357, - "velocityX": 3.961818449458451, - "velocityY": 0.24068002354419252, + "x": 4.961162162053674, + "y": 7.248936972477581, + "heading": -3.140952349422652, + "angularVelocity": -0.002673009953180685, + "velocityX": 3.763722135042569, + "velocityY": 0.22813257700507475, "moduleForcesX": [ - 71.1304777106223, - 38.90533896850497, - 67.80168692280806, - 35.069342324157596 + 4.979358092075404, + 1.9050731077303618, + 4.966710791426737, + 1.8985551228853454 ], "moduleForcesY": [ - -20.881665076720296, - -29.24497694444195, - 35.52488241556476, - 46.99979625202289 + 1.1666845104073047, + 1.1660681916904998, + 5.286171901696504, + 5.292556395923459 ], - "timestamp": 2.2486101431671224 + "timestamp": 2.2606772375073483 }, { - "x": 5.165833894257274, - "y": 7.260879607361727, - "heading": -3.141191038423599, - "angularVelocity": -0.002278452649894059, - "velocityX": 3.961672076555177, - "velocityY": 0.2436456146593047, + "x": 5.186925676572244, + "y": 7.2626767601083335, + "heading": -3.1411124388880545, + "angularVelocity": -0.0026688260052964005, + "velocityX": 3.7636676284691513, + "velocityY": 0.22905381340371825, "moduleForcesX": [ - -0.03237574463563704, - -0.03836473213153268, - -0.03237915031178789, - -0.03836814690497055 + -0.012772921443373914, + -0.013031053606581546, + -0.012775534951914544, + -0.013033680355220673 ], "moduleForcesY": [ - 0.7126371600805075, - 0.7126345337878686, - 0.7206734674426194, - 0.7206706947523183 + 0.21791141098205738, + 0.21790945334762246, + 0.21825770061312894, + 0.21825566239436 ], - "timestamp": 2.307372078488434 + "timestamp": 2.3206622140793622 }, { - "x": 5.398628438089113, - "y": 7.275212536833178, - "heading": -3.1413249213362655, - "angularVelocity": -0.002278395221917291, - "velocityX": 3.9616554927763006, - "velocityY": 0.243915204512543, + "x": 5.4126888786666845, + "y": 7.276421682496977, + "heading": -3.1412725251050655, + "angularVelocity": -0.0026687718518768853, + "velocityX": 3.763662420096203, + "velocityY": 0.22913941413551372, "moduleForcesX": [ - -0.004005764410808973, - -0.004009381578984551, - -0.0040057696957758555, - -0.004009387088534907 + -0.0012312846193631112, + -0.0012346248118715398, + -0.001231322018659915, + -0.0012346644220080894 ], "moduleForcesY": [ - 0.06514567997750087, - 0.06514567586816115, - 0.06515053178948277, - 0.06515052646691723 + 0.020261967908326156, + 0.02026193639375224, + 0.02026644973999854, + 0.020266417423147567 ], - "timestamp": 2.3661340138097455 + "timestamp": 2.380647190651376 }, { - "x": 5.6314216777838535, - "y": 7.289566634568185, - "heading": -3.1414588009131665, - "angularVelocity": -0.002278338454468591, - "velocityX": 3.961633299206749, - "velocityY": 0.24427544219772612, + "x": 5.638451088737877, + "y": 7.290182893091729, + "heading": -3.141432606704436, + "angularVelocity": -0.002668694871926455, + "velocityX": 3.7636458822345045, + "velocityY": 0.22941095222787258, "moduleForcesX": [ - -0.005361429921287933, - -0.005365004147554494, - -0.005361430429341668, - -0.005365004730915963 + -0.003912617108109038, + -0.0039173635544157495, + -0.003912626035611627, + -0.003917372464927626 ], "moduleForcesY": [ - 0.0870513309884429, - 0.08705133042541374, - 0.08705612743999552, - 0.08705612689603413 + 0.06427781349805815, + 0.06427780505250308, + 0.06428418449503422, + 0.06428417983138202 ], - "timestamp": 2.424895949131057 + "timestamp": 2.44063216722339 }, { "x": 5.864199676513671, "y": 7.304165840148926, "heading": -3.141592653589793, - "angularVelocity": -0.0022778806704472536, - "velocityX": 3.9613739312189615, - "velocityY": 0.24844664323787555, + "angularVelocity": -0.0026681161601349807, + "velocityX": 3.763418787115392, + "velocityY": 0.2331074855119802, "moduleForcesX": [ - -0.0626635111672248, - -0.06269233899543689, - -0.06266351034663582, - -0.06269233826749006 + -0.053742159378724355, + -0.053777950646836034, + -0.05374214026769295, + -0.05377793434801155 ], "moduleForcesY": [ - 1.0079779361307997, - 1.0079779356543, - 1.0080166124998338, - 1.0080166121174567 + 0.8750534628320942, + 0.8750534536432211, + 0.8751012884750247, + 0.8751012823498336 ], - "timestamp": 2.4836578844523687 + "timestamp": 2.500617143795404 }, { - "x": 6.164003219259558, - "y": 7.329310693479935, - "heading": -3.1415926556850056, - "angularVelocity": -2.7648509089600506e-8, - "velocityX": 3.9562193564264954, - "velocityY": 0.33181247476772124, + "x": 6.152377573428224, + "y": 7.328344294067127, + "heading": -3.141592655915241, + "angularVelocity": -3.0327874962943025e-8, + "velocityX": 3.7583392584954223, + "velocityY": 0.3153289462634965, "moduleForcesX": [ - -0.9091406227520445, - -1.0229926855250666, - -0.9088211451962499, - -1.0226331700097273 + -0.8750670830636976, + -1.006710259521497, + -0.874725300925445, + -1.0063138780766954 ], "moduleForcesY": [ - 15.548099923086893, - 15.54784783460909, - 15.69538936246291, - 15.695135166722325 + 15.141847578839295, + 15.141564196521003, + 15.312470356020455, + 15.312185150395404 ], - "timestamp": 2.5594381978616556 + "timestamp": 2.5772940686534116 }, { - "x": 6.463785472279943, - "y": 7.354701655214318, - "heading": -3.141592655684723, - "angularVelocity": 3.725575931858838e-12, - "velocityX": 3.9559384163703637, - "velocityY": 0.33506013095045345, + "x": 6.440536481547124, + "y": 7.3527474199811484, + "heading": -3.141592655914663, + "angularVelocity": 7.537086047151853e-12, + "velocityX": 3.7580916116878904, + "velocityY": 0.31825905850049313, "moduleForcesX": [ - -0.05264365410489091, - -0.052645003824236244, - -0.052643654069719104, - -0.05264500378601198 + -0.04586225728278299, + -0.04586372569531469, + -0.045862256081547766, + -0.04586372442292428 ], "moduleForcesY": [ - 0.6085655004799432, - 0.6085655004355581, - 0.6085673124948521, - 0.6085673123929743 + 0.542641633938682, + 0.5426416315110623, + 0.5426435952886004, + 0.5426435918287228 ], - "timestamp": 2.6352185112709425 + "timestamp": 2.653970993511419 }, { - "x": 6.7425936724152855, - "y": 7.378325085957683, - "heading": -3.141592655097165, - "angularVelocity": 7.753434822309273e-9, - "velocityX": 3.679163988534982, - "velocityY": 0.3117357223871029, + "x": 6.725982194416825, + "y": 7.376928795577381, + "heading": -3.1415926555365488, + "angularVelocity": 4.93126951023964e-9, + "velocityX": 3.7227068430078205, + "velocityY": 0.3153670500089981, "moduleForcesX": [ - -51.86374695379346, - -51.86374723989954, - -51.86374697013155, - -51.863747256237815 + -6.553087891990707, + -6.553088107734506, + -6.5530878943522115, + -6.553088110092406 ], "moduleForcesY": [ - -4.370675853259815, - -4.370675841289294, - -4.370675276765135, - -4.370675264792112 + -0.5355861508230734, + -0.5355861518431866, + -0.5355858160266412, + -0.5355858164480798 ], - "timestamp": 2.7109988246802295 + "timestamp": 2.7306479183694266 }, { - "x": 6.975022477587425, - "y": 7.398018834411509, - "heading": -3.141592654598946, - "angularVelocity": 6.574519885644753e-9, - "velocityX": 3.067139666166316, - "velocityY": 0.2598794801423144, + "x": 6.963947201115416, + "y": 7.397087900656233, + "heading": -3.141592654989632, + "angularVelocity": 7.132742196975805e-9, + "velocityX": 3.1034761388678844, + "velocityY": 0.26290967088448347, "moduleForcesX": [ - -114.68499791407866, - -114.6849979131527, - -114.68499790399139, - -114.68499790306542 + -114.67853113597924, + -114.67853113769716, + -114.6785311545907, + -114.6785311563086 ], "moduleForcesY": [ - -9.717151389543751, - -9.71715139706053, - -9.717151508985076, - -9.717151516501852 + -9.714852991136091, + -9.714852977267336, + -9.714852770709518, + -9.714852756840765 ], - "timestamp": 2.7867791380895164 + "timestamp": 2.807324843227434 }, { - "x": 7.160997000105905, - "y": 7.413776516620945, - "heading": -3.1415926541970722, - "angularVelocity": 5.303144992506214e-9, - "velocityX": 2.4541271228853043, - "velocityY": 0.20793899497787205, + "x": 7.15435156281383, + "y": 7.413217936567628, + "heading": -3.1415926544715154, + "angularVelocity": 6.757134963127845e-9, + "velocityX": 2.483202893843366, + "velocityY": 0.21036362557919908, "moduleForcesX": [ - -114.8701770145637, - -114.87017701371919, - -114.87017700365773, - -114.87017700281322 + -114.8716046768432, + -114.87160467659702, + -114.87160467365942, + -114.87160467341322 ], "moduleForcesY": [ - -9.732937356902879, - -9.732937365029716, - -9.732937485826572, - -9.732937493953408 + -9.731273401774802, + -9.731273404147279, + -9.731273439418121, + -9.731273441790599 ], - "timestamp": 2.8625594514988033 + "timestamp": 2.8840017680854415 }, { - "x": 7.30049225587439, - "y": 7.425596002759894, - "heading": -3.141592653894118, - "angularVelocity": 3.997796008011645e-9, - "velocityX": 1.8407848884851754, - "velocityY": 0.1559704045444309, + "x": 7.297169459079101, + "y": 7.425316707330115, + "heading": -3.141592654046443, + "angularVelocity": 5.543681464619214e-9, + "velocityX": 1.862592905619844, + "velocityY": 0.1577889408696524, "moduleForcesX": [ - -114.93195662692112, - -114.93195662610682, - -114.93195661571428, - -114.9319566149 + -114.93396789225454, + -114.93396789150813, + -114.9339678819601, + -114.9339678812137 ], "moduleForcesY": [ - -9.738203898547772, - -9.73820390689881, - -9.73820403095595, - -9.738204039306991 + -9.736577236261422, + -9.736577243932565, + -9.736577357910134, + -9.736577365581278 ], - "timestamp": 2.9383397649080902 + "timestamp": 2.960678692943449 }, { - "x": 7.393495753669216, - "y": 7.433476227985266, - "heading": -3.141592653691419, - "angularVelocity": 2.674823132984758e-9, - "velocityX": 1.2272778194056353, - "velocityY": 0.1039877623995868, + "x": 7.392388138056945, + "y": 7.433383128421548, + "heading": -3.141592653746211, + "angularVelocity": 3.915539345006351e-9, + "velocityX": 1.241816611114391, + "velocityY": 0.10520011211157265, "moduleForcesX": [ - -114.96284439431135, - -114.96284439351281, - -114.96284438294842, - -114.9628443821499 + -114.96476701310675, + -114.9647670121377, + -114.96476699928847, + -114.96476699831943 ], "moduleForcesY": [ - -9.740836996359766, - -9.740837004827121, - -9.740837130575558, - -9.740837139042911 + -9.739196623522735, + -9.739196633819752, + -9.739196786768158, + -9.739196797065174 ], - "timestamp": 3.014120078317377 + "timestamp": 3.0373556178014565 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": 1.3410596335989075e-9, - "velocityX": 0.6136718659319506, - "velocityY": 0.05199669062818514, + "angularVelocity": 2.0399643560339176e-9, + "velocityX": 0.6209412027311269, + "velocityY": 0.052602853899473424, "moduleForcesX": [ - -114.98137397908026, - -114.98137397829139, - -114.98137396762175, - -114.98137396683289 + -114.98312242497134, + -114.98312242387729, + -114.98312240904909, + -114.98312240795504 ], "moduleForcesY": [ - -9.742416592641025, - -9.742416601179595, - -9.742416727963565, - -9.742416736502134 + -9.740757704436696, + -9.740757716301538, + -9.740757892507524, + -9.740757904372366 ], - "timestamp": 3.089900391726664 + "timestamp": 3.114032542659464 }, { "x": 7.44, "y": 7.437416553497315, "heading": -3.141592653589793, - "angularVelocity": -1.6449381377649227e-22, - "velocityX": 2.757023269600915e-22, - "velocityY": -1.2947040629614231e-21, + "angularVelocity": -8.844072307683423e-21, + "velocityX": 1.496452517068171e-20, + "velocityY": -4.199921037541719e-20, + "moduleForcesX": [ + -114.99530722068296, + -114.99530721950912, + -114.99530720336229, + -114.99530720218844 + ], + "moduleForcesY": [ + -9.741793989902682, + -9.74179400280959, + -9.741794194469444, + -9.74179420737635 + ], + "timestamp": 3.1907094675174714 + }, + { + "x": 7.381270997615318, + "y": 7.427913275125405, + "heading": -3.130247025713249, + "angularVelocity": 0.13251789743624745, + "velocityX": -0.6859597370222545, + "velocityY": -0.11099909871012287, "moduleForcesX": [ - -114.99372507344016, - -114.99372507265782, - -114.99372506191705, - -114.9937250611347 + -112.6313588950428, + -113.00915752320313, + -114.67559733618697, + -114.77561717238224 ], "moduleForcesY": [ - -9.74346948925178, - -9.743469497838506, - -9.743469625322668, - -9.743469633909394 + -25.159294856402493, + -23.425636698784512, + -12.964745355934465, + -12.091339079978015 ], - "timestamp": 3.165680705135951 + "timestamp": 3.2763252831623153 }, { - "x": 7.375924265922195, - "y": 7.4270458645926025, - "heading": -3.1303148603474185, - "angularVelocity": 0.12612545266839068, - "velocityX": -0.7165924034905256, - "velocityY": -0.11598083104372059, + "x": 7.263819426067914, + "y": 7.4089059352509885, + "heading": -3.107637266054923, + "angularVelocity": 0.26408391356238425, + "velocityX": -1.3718443334654729, + "velocityY": -0.22200734445215997, "moduleForcesX": [ - -112.76737309465462, - -113.09738136430255, - -114.61964933108011, - -114.71860842032127 + -112.64778912905899, + -112.98106218312499, + -114.667110460898, + -114.74591804100633 ], "moduleForcesY": [ - -24.554623770706147, - -23.006176875829965, - -13.473735738920116, - -12.640293814526906 + -25.015409413102287, + -23.491323485597995, + -12.903529067142681, + -12.236822513481128 ], - "timestamp": 3.2550979718634414 + "timestamp": 3.361941098807159 }, { - "x": 7.247779988772691, - "y": 7.406304055209759, - "heading": -3.1078149681341087, - "angularVelocity": 0.2516280472079343, - "velocityX": -1.433104386203608, - "velocityY": -0.2319664885984147, + "x": 7.0876560923479435, + "y": 7.380393641960821, + "heading": -3.07389890037907, + "angularVelocity": 0.39406697724878387, + "velocityX": -2.0576027033456232, + "velocityY": -0.33302600781663494, "moduleForcesX": [ - -112.77796902785569, - -113.0694204236125, - -114.61288648897437, - -114.69165035279205 + -112.67062512533333, + -112.9386256400279, + -114.65047328808508, + -114.69841226670894 ], "moduleForcesY": [ - -24.437169993980408, - -23.075208455820334, - -13.40583223060576, - -12.75968547774606 + -24.794121720549438, + -23.578915171806123, + -12.823745620099007, + -12.457213413083549 ], - "timestamp": 3.3445152385909314 + "timestamp": 3.447556914452003 }, { - "x": 7.05557922298479, - "y": 7.375190745931852, - "heading": -3.0741851923253214, - "angularVelocity": 0.37609934903599834, - "velocityX": -2.1494815578925746, - "velocityY": -0.3479563893708391, + "x": 6.852802413616105, + "y": 7.342376469148145, + "heading": -3.0293262645324974, + "angularVelocity": 0.5206121732399505, + "velocityX": -2.743110918969357, + "velocityY": -0.44404380810177707, "moduleForcesX": [ - -112.79182810566901, - -113.02648757078286, - -114.59937186585587, - -114.64860236410797 + -112.69640034788526, + -112.87896079459627, + -114.6035247316006, + -114.61328861565241 ], "moduleForcesY": [ - -24.25759265755613, - -23.171552214300533, - -13.311740761370507, - -12.93970595608385 + -24.43715365857463, + -23.63189826179402, + -12.786890952496687, + -12.797480453077897 ], - "timestamp": 3.4339325053184213 + "timestamp": 3.533172730096847 }, { - "x": 6.799345859055017, - "y": 7.333706777922525, - "heading": -3.0296327580346913, - "angularVelocity": 0.49825314417638356, - "velocityX": -2.865591549679929, - "velocityY": -0.46393688297087876, + "x": 6.559322846846036, + "y": 7.294861028140364, + "heading": -2.974816276176582, + "angularVelocity": 0.6366812947509165, + "velocityX": -3.427866271665239, + "velocityY": -0.5549843875211936, "moduleForcesX": [ - -112.8024310121022, - -112.96263341798881, - -114.55963723401477, - -114.57186680035291 + -112.69725731706323, + -112.77901668126033, + -114.4213577102299, + -114.39506493358313 ], "moduleForcesY": [ - -23.97488109311961, - -23.255558651397703, - -13.233026976268091, - -13.211149123897187 + -23.701389141835676, + -23.40728121770181, + -13.046932352219999, + -13.446589360294276 ], - "timestamp": 3.5233497720459113 + "timestamp": 3.618788545741691 }, { - "x": 6.479151323028066, - "y": 7.281860220949749, - "heading": -2.9747972228158814, - "angularVelocity": 0.6132544331278652, - "velocityX": -3.5809027467008328, - "velocityY": -0.5798271281405277, + "x": 6.2405606027600165, + "y": 7.243222544857862, + "heading": -2.974789031988597, + "angularVelocity": 0.0003182144301258398, + "velocityX": -3.723170090539417, + "velocityY": -0.6031418715522296, "moduleForcesX": [ - -112.76864885600135, - -112.84129933826836, - -114.40191731519991, - -114.37728230406522 + -62.564521843593084, + -42.22319342938616, + -56.384078555955455, + -34.743970358822985 ], "moduleForcesY": [ - -23.425697611861317, - -23.163205809397667, - -13.333070778392436, - -13.69531288022576 + 8.771658729738927, + 16.21706404812779, + -28.32236622881111, + -28.615859678644675 ], - "timestamp": 3.612767038773401 + "timestamp": 3.7044043613865347 }, { - "x": 6.128706156657079, - "y": 7.2250876773172195, - "heading": -2.9747714114603663, - "angularVelocity": 0.00028866187101872986, - "velocityX": -3.919211346942776, - "velocityY": -0.6349170099948519, + "x": 5.921798032074226, + "y": 7.191583190738455, + "heading": -2.9747625298055844, + "angularVelocity": 0.0003095477490101981, + "velocityX": -3.7231739052524984, + "velocityY": -0.6031520430012703, "moduleForcesX": [ - -65.77795724959567, - -48.091726144075956, - -59.97030443873823, - -41.064737834052906 + -0.0008590684242739062, + -0.0004897050181045133, + -0.0007757061877252102, + -0.0004063458477452992 ], "moduleForcesY": [ - 7.145486045497711, - 13.930551075127115, - -27.77321467031953, - -28.29772337341099 + -0.0014702823398333354, + -0.0014081667097866634, + -0.0019659052879860126, + -0.0019037710991057725 ], - "timestamp": 3.702184305500891 + "timestamp": 3.7900201770313786 }, { - "x": 5.778260590548221, - "y": 7.168314324053237, - "heading": -2.974746339793478, - "angularVelocity": 0.0002803895467417059, - "velocityX": -3.9192158174201577, - "velocityY": -0.6349260645262749, + "x": 5.603035464764593, + "y": 7.139943815739949, + "heading": -2.9747360276337456, + "angularVelocity": 0.0003095476185021631, + "velocityX": -3.7231738658186826, + "velocityY": -0.6031522868709134, "moduleForcesX": [ - -0.0009168544850962377, - -0.0005793240119023563, - -0.0008405728976593655, - -0.0005030425527797756 + 0.0000065373917647243475, + 0.000006542648884482532, + 0.000006538254086855334, + 0.000006543595363337553 ], "moduleForcesY": [ - -0.0012398789774556854, - -0.0011830360654513062, - -0.00169283207105781, - -0.0016359884024284832 + -0.00004044463387706378, + -0.00004044379523524599, + -0.00004045215395335704, + -0.00004045179629948636 ], - "timestamp": 3.791601572228381 + "timestamp": 3.8756359926762225 }, { - "x": 5.427815027732516, - "y": 7.111540950421515, - "heading": -2.9747212681368067, - "angularVelocity": 0.00028038943247385174, - "velocityX": -3.9192157805911356, - "velocityY": -0.6349262923093685, + "x": 5.284272897910396, + "y": 7.088304437930092, + "heading": -2.974709525465553, + "angularVelocity": 0.0003095475759100391, + "velocityX": -3.723173860499151, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - 0.000005845897111063432, - 0.000005850554610347957, - 0.000005846946551636274, - 0.000005851605108021885 + 8.811818431713226e-7, + 8.829967624981082e-7, + 8.815928068387048e-7, + 8.834077261655809e-7 ], "moduleForcesY": [ - -0.00003617108564124459, - -0.000036170301512162975, - -0.00003617734396736354, - -0.000036176565443598635 + -0.000005445232314593307, + -0.000005444926075258032, + -0.0000054476678799056675, + -0.000005447361640570373 ], - "timestamp": 3.881018838955871 + "timestamp": 3.9612518083210664 }, { - "x": 5.0773694777230824, - "y": 7.054767497780465, - "heading": -2.9746961964763616, - "angularVelocity": 0.00028038947468377387, - "velocityX": -3.9192156373718947, - "velocityY": -0.6349271759119333, + "x": 4.965510345085579, + "y": 7.036664973557431, + "heading": -2.974683023293425, + "angularVelocity": 0.0003095476218731829, + "velocityX": -3.723173696634823, + "velocityY": -0.6031533307686344, "moduleForcesX": [ - 0.000022745436999206383, - 0.00002274371824161806, - 0.000022745063338164777, - 0.000022743343413843666 + 0.000027179633968777115, + 0.000027178077676157867, + 0.00002717888025707332, + 0.00002717722449604533 ], "moduleForcesY": [ - -0.00014032435530920788, - -0.00014032463600418613, - -0.00014032204063925755, - -0.00014032231580040383 + -0.00016769506177041809, + -0.00016769583758608305, + -0.0001676924952224039, + -0.00016769279547100918 ], - "timestamp": 3.970436105683361 + "timestamp": 4.04686762396591 }, { - "x": 4.726924947134966, - "y": 6.997991026251115, - "heading": -2.974670388917575, - "angularVelocity": 0.0002886194102156865, - "velocityX": -3.9192042366508106, - "velocityY": -0.6349609377166889, + "x": 4.6467487843294215, + "y": 6.985022268597529, + "heading": -2.9746557832079867, + "angularVelocity": 0.00031816651203726035, + "velocityX": -3.723162109188588, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - 0.0020163880860393237, - 0.0016805912309524622, - 0.001940464776109846, - 0.001604668094445397 + 0.0021470284617356463, + 0.001779708578470208, + 0.0020640650999688786, + 0.001696749591254383 ], "moduleForcesY": [ - -0.0055586767601032185, - -0.0056152526560838715, - -0.005108050168336257, - -0.005164626809257234 + -0.006493363422829359, + -0.006555181388139426, + -0.0060004838430769165, + -0.006062320034445239 ], - "timestamp": 4.059853372410851 + "timestamp": 4.132483439610754 }, { - "x": 4.406739852490161, - "y": 6.946071670476197, - "heading": -2.9201805701462793, - "angularVelocity": 0.609388105513896, - "velocityX": -3.5807971587926986, - "velocityY": -0.5806412751705897, + "x": 4.35327994736575, + "y": 6.937424176402155, + "heading": -2.9205003335250557, + "angularVelocity": 0.6325402529315557, + "velocityX": -3.4277409466149935, + "velocityY": -0.5559497604136834, "moduleForcesX": [ - 66.16678250893183, - 48.98536673051217, - 59.2354585777396, - 40.57967406296072 + 63.0067589023219, + 43.25347247652169, + 55.56509439641217, + 34.16828867746466 ], "moduleForcesY": [ - -6.321049067077154, - -14.492266055813312, - 28.180912866909814, - 27.13803459703222 + -7.91265828309172, + -16.812254107815967, + 28.71804550358443, + 27.34861881904853 ], - "timestamp": 4.149270639138341 + "timestamp": 4.218099255255598 }, { - "x": 4.150515319264335, - "y": 6.904520503456371, - "heading": -2.875923572113572, - "angularVelocity": 0.49494912618595177, - "velocityX": -2.8654927913050745, - "velocityY": -0.46468840460599303, + "x": 4.118436291181741, + "y": 6.899331547752736, + "heading": -2.8762208718989513, + "angularVelocity": 0.5171878734390213, + "velocityX": -2.742993854759276, + "velocityY": -0.44492513868510164, "moduleForcesX": [ - 112.84469963183767, - 112.76947878161748, - 114.44010878513953, - 114.33052227126576 + 112.77868429037682, + 112.7033673063995, + 114.45941943627882, + 114.34574505410619 ], "moduleForcesY": [ - 23.05021971834789, - 23.504795933148507, - 13.013238741851021, - 14.088814392674271 + 23.303963933906324, + 23.762739676331677, + 12.722298748930815, + 13.86894657131769 ], - "timestamp": 4.238687905865831 + "timestamp": 4.3037150709004415 }, { - "x": 3.9583220436464823, - "y": 6.873351406790412, - "heading": -2.842507887558043, - "angularVelocity": 0.3737050547224577, - "velocityX": -2.1493977914085045, - "velocityY": -0.3485802888713979, + "x": 3.9422814599590574, + "y": 6.8707567698528536, + "heading": -2.8426922514156217, + "angularVelocity": 0.391617135581763, + "velocityX": -2.0575033934549967, + "velocityY": -0.3337558333663218, "moduleForcesX": [ - 112.95645164652021, - 112.81581362288203, - 114.63477612228742, - 114.4800037317309 + 112.86515330511082, + 112.7174908430355, + 114.6811022921368, + 114.51664915991034 ], "moduleForcesY": [ - 23.231980648685717, - 23.95223626895713, - 12.578015209156026, - 13.993453486124878 + 23.63834794762169, + 24.384475231601378, + 12.086104233396183, + 13.645010104290401 ], - "timestamp": 4.328105172593321 + "timestamp": 4.389330886545285 }, { - "x": 3.830183254358929, - "y": 6.85256977540764, - "heading": -2.8201340277644222, - "angularVelocity": 0.2502185608268224, - "velocityX": -1.4330430125768843, - "velocityY": -0.23241183882421498, + "x": 3.8248361212608604, + "y": 6.851704848123817, + "heading": -2.8202044428854083, + "angularVelocity": 0.26265951402598714, + "velocityX": -1.3717715332572546, + "velocityY": -0.22252806430143837, "moduleForcesX": [ - 113.00394710188138, - 112.82068889216025, - 114.70406075329403, - 114.52336848119276 + 112.90541799785672, + 112.70949942311833, + 114.75934724991006, + 114.56628411956218 ], "moduleForcesY": [ - 23.2434343413162, - 24.148746420326283, - 12.388975239916281, - 14.012855946804578 + 23.695274487547174, + 24.64547404232939, + 11.823839632394282, + 13.62813642328838 ], - "timestamp": 4.417522439320811 + "timestamp": 4.474946702190129 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 0.1255595686363405, - "velocityX": -0.7165595452629517, - "velocityY": -0.11621279716307126, + "angularVelocity": 0.1319570277388407, + "velocityX": -0.6859207314037196, + "velocityY": -0.1112703689791775, "moduleForcesX": [ - 113.02767779062647, - 112.82218278499239, - 114.73896316536627, - 114.54498863487578 + 112.925655713762, + 112.70422548752346, + 114.79867455728485, + 114.5909034417634 ], "moduleForcesY": [ - 23.249516784409284, - 24.250854636389032, - 12.290549417164629, - 14.022523907560238 + 23.723484974899822, + 24.780696781270088, + 11.687912648139877, + 13.620484396497119 ], - "timestamp": 4.506939706048301 + "timestamp": 4.560562517834973 }, { "x": 3.7661104583740226, "y": 6.8421783447265625, "heading": -2.808906834325478, - "angularVelocity": 6.39634760318955e-21, - "velocityX": -2.288259399396069e-20, - "velocityY": -2.4594644423852028e-20, + "angularVelocity": 1.048098737702012e-19, + "velocityX": -5.399569524753348e-19, + "velocityY": -9.802475742246663e-19, "moduleForcesX": [ - 113.0347603386625, - 112.82700125465155, - 114.75821199877026, - 114.5621659937604 + 112.92977017260735, + 112.70546235157893, + 114.82048834955188, + 114.6101322449539 ], "moduleForcesY": [ - 23.2880943793102, - 24.293809761632872, - 12.246633407284676, - 13.993645143555243 + 23.77874423290317, + 24.84159448258278, + 11.622750779734075, + 13.577897490720876 ], - "timestamp": 4.596356972775791 + "timestamp": 4.646178333479817 }, { - "x": 3.78600549650478, - "y": 6.841766146112416, - "heading": -2.8358265954492667, - "angularVelocity": -0.5268296966780072, - "velocityX": 0.3893532656410478, - "velocityY": -0.00806687956342702, + "x": 3.7866144129842945, + "y": 6.8417821274774475, + "heading": -2.8401706467737573, + "angularVelocity": -0.5981564744361981, + "velocityX": 0.392292949619254, + "velocityY": -0.0075806465777589985, "moduleForcesX": [ - 109.42063742828591, - 109.7288300984058, - 101.12162507107449, - 112.53880632418141 + 107.42080956929517, + 108.8413082444939, + 98.01523216314052, + 112.04459817860722 ], "moduleForcesY": [ - 36.38707466668986, - 35.669533302226604, - -55.51926033598735, - -25.504590588279555 + 41.904654146837636, + 38.29718260293834, + -60.83697376382957, + -27.603083990033998 ], - "timestamp": 4.647454625952016 + "timestamp": 4.698445279980309 }, { - "x": 3.825938343537949, - "y": 6.840779251207409, - "heading": -2.8882950545967137, - "angularVelocity": -1.026827180623991, - "velocityX": 0.7815006081678173, - "velocityY": -0.019313898851738894, + "x": 3.8278180486268427, + "y": 6.840743713694053, + "heading": -2.901006370545353, + "angularVelocity": -1.163942564944422, + "velocityX": 0.7883306449166008, + "velocityY": -0.019867504281804747, "moduleForcesX": [ - 110.09506612110931, - 110.81993188505729, - 102.6353312163985, - 112.36550007471496 + 108.49838326382826, + 110.25146907706204, + 99.86657679489441, + 111.77509833383628 ], "moduleForcesY": [ - 34.2533713879541, - 32.07800706429278, - -52.62999688238643, - -26.203707120752828 + 38.99254840535189, + 33.98129300971088, + -57.706808413427034, + -28.619699977125915 ], - "timestamp": 4.698552279128242 + "timestamp": 4.7507122264808 }, { - "x": 3.8860741349913512, - "y": 6.839035138240057, - "heading": -2.964541076190401, - "angularVelocity": -1.4921628852646063, - "velocityX": 1.176879713947022, - "velocityY": -0.03413293681682487, + "x": 3.889955785107897, + "y": 6.8387849883626, + "heading": -2.9890898968624993, + "angularVelocity": -1.6852625266011574, + "velocityX": 1.1888533890238777, + "velocityY": -0.0374754115663657, "moduleForcesX": [ - 110.82018043359403, - 112.01913727447982, - 104.5309227969057, - 112.13805673866038 + 109.70138251498284, + 111.79514898339698, + 102.32802663455422, + 111.44106852220102 ], "moduleForcesY": [ - 31.778806331042382, - 27.53721520438967, - -48.700214418067816, - -27.088832746748313 + 35.415890676664304, + 28.42375744706581, + -53.15724933762509, + -29.817683638360904 ], - "timestamp": 4.749649932304467 + "timestamp": 4.802979172981292 }, { - "x": 3.9666241731173164, - "y": 6.836347748309206, - "heading": -3.061856445753252, - "angularVelocity": -1.9044978294253445, - "velocityX": 1.5763940830739307, - "velocityY": -0.05259321639650871, + "x": 3.9733415003112857, + "y": 6.835624849307072, + "heading": -3.1005912250342016, + "angularVelocity": -2.1333048061388666, + "velocityX": 1.5953814176348051, + "velocityY": -0.0604615204663511, "moduleForcesX": [ - 111.82728548746546, - 113.23819484894514, - 107.03013912743913, - 112.00948759102612 + 111.36765197462086, + 113.3330629489433, + 105.79188446547697, + 111.29923323362245 ], "moduleForcesY": [ - 27.9535071577465, - 21.882075353027073, - -42.84285393246154, - -27.51340335883333 + 29.67677517374216, + 21.344964061000997, + -45.774893406210126, + -30.226858179680654 ], - "timestamp": 4.800747585480693 + "timestamp": 4.855246119481784 }, { - "x": 4.067857576516546, - "y": 6.832556869927305, - "heading": -3.175915491721135, - "angularVelocity": -2.232177778782037, - "velocityX": 1.9811752029020762, - "velocityY": -0.07418889413231283, + "x": 4.078379902808959, + "y": 6.831026292095147, + "heading": -3.229015108449569, + "angularVelocity": -2.45707645106375, + "velocityX": 2.0096525534871077, + "velocityY": -0.0879821286649223, "moduleForcesX": [ - 113.22575760455814, - 114.34728768901107, - 110.11846813519523, - 112.26817875434021 + 113.53832730848663, + 114.64478257919814, + 110.14647037122349, + 111.87702649396591 ], "moduleForcesY": [ - 21.45752343424573, - 14.794035336095424, - -33.98499618387022, - -26.27258468210002 + 19.599153766423715, + 12.088459054315411, + -33.795989909102516, + -27.799474462441705 ], - "timestamp": 4.851845238656918 + "timestamp": 4.907513065982275 }, { - "x": 4.190070365050169, - "y": 6.827548067939446, - "heading": -3.2998572362261696, - "angularVelocity": -2.425585849854656, - "velocityX": 2.3917495410628007, - "velocityY": -0.09802411023818243, + "x": 4.2054556679364925, + "y": 6.824790196070038, + "heading": -3.3632917229427637, + "angularVelocity": -2.5690541247120953, + "velocityX": 2.431283509671254, + "velocityY": -0.11931242291081591, "moduleForcesX": [ - 114.7457474192497, - 115.11333345954517, - 113.19559803887138, - 113.34482631497848 + 115.1489195315103, + 115.1727965430496, + 113.9941351274335, + 113.88899499156405 ], "moduleForcesY": [ - 10.194849320269086, - 5.448077962340892, - -21.339190325625143, - -20.799257564932734 + 1.0232280605874524, + -1.635500797450544, + -16.245965323391406, + -17.189766351140616 ], - "timestamp": 4.902942891833144 + "timestamp": 4.959780012482767 }, { - "x": 4.333402838200007, - "y": 6.821199257095827, - "heading": -3.422162582125266, - "angularVelocity": -2.3935609229897317, - "velocityX": 2.8050695920517015, - "velocityY": -0.12424857990491066, + "x": 4.354051044308127, + "y": 6.816459874974004, + "heading": -3.4803991855766943, + "angularVelocity": -2.240564457555005, + "velocityX": 2.8430085612566733, + "velocityY": -0.15938029010258697, "moduleForcesX": [ - 114.68412050490778, - 114.73378991745246, - 115.00391113761037, - 115.02985196430272 + 109.54277500123293, + 109.76726168084907, + 114.94525226928009, + 113.18437639744356 ], "moduleForcesY": [ - -10.050186347462116, - -9.331880356810323, - -5.31591098605362, - -4.453466685132969 + -35.138512118490674, + -33.87003877484381, + 5.393963684062317, + 20.071079184944495 ], - "timestamp": 4.954040545009369 + "timestamp": 5.012046958983259 }, { - "x": 4.496449804863985, - "y": 6.812872270792408, - "heading": -3.517273176899785, - "angularVelocity": -1.8613495701358547, - "velocityX": 3.190889532669179, - "velocityY": -0.16296220639921205, + "x": 4.52101074667456, + "y": 6.80513903332009, + "heading": -3.552003118857375, + "angularVelocity": -1.369965878531029, + "velocityX": 3.194364958069012, + "velocityY": -0.2165965760749598, "moduleForcesX": [ - 104.86344163188946, - 102.79608932766192, - 114.33175651351914, - 106.890923713185 + 96.13389774106393, + 78.1016913248519, + 113.46555797863142, + 94.13325434178371 ], "moduleForcesY": [ - -47.21609558159705, - -50.77985160422085, - 12.895732740628704, - 42.06566908876741 + -62.80652414189361, + -83.01049814576045, + 18.254472024247136, + 65.38310369002122 ], - "timestamp": 5.005138198185595 + "timestamp": 5.0643139054837505 }, { - "x": 4.6771281726390805, - "y": 6.802007556416455, - "heading": -3.5695575194646283, - "angularVelocity": -1.0232239509028986, - "velocityX": 3.5359425833505953, - "velocityY": -0.2126264847914251, + "x": 4.706342119523084, + "y": 6.791413745525305, + "heading": -3.5793791336242253, + "angularVelocity": -0.5237729884716399, + "velocityX": 3.5458618736562415, + "velocityY": -0.26259976359377335, "moduleForcesX": [ - 96.67728867515599, - 80.87009063485003, - 113.21907877847823, - 92.79877473998543 + 96.52600367181356, + 81.50657246245366, + 112.58926465292838, + 91.36526851275515 ], "moduleForcesY": [ - -61.82807121867156, - -79.97059189776539, - 19.430238076987123, - 67.16099978368732 + -60.91221738822322, + -77.0385216215409, + 20.114545224135323, + 67.84251293202189 ], - "timestamp": 5.05623585136182 + "timestamp": 5.116580851984242 }, { - "x": 4.875366934287349, - "y": 6.7891315300219, - "heading": -3.579804057853285, - "angularVelocity": -0.20052855173833614, - "velocityX": 3.879605996083274, - "velocityY": -0.25198860601577133, + "x": 4.903114088638074, + "y": 6.781657287742634, + "heading": -3.5797122193352346, + "angularVelocity": -0.006372779228765348, + "velocityX": 3.7647496609188598, + "velocityY": -0.18666592245959082, "moduleForcesX": [ - 97.03131746492353, - 82.80990999914111, - 112.19644097022719, - 89.98282568718108 + 70.97743787502137, + 39.57182354200292, + 76.9970632005936, + 50.328630779424536 ], "moduleForcesY": [ - -59.77588710656038, - -74.87714839288478, - 21.5263485084751, - 69.37126688318331 + -15.965745753786843, + 6.6647535433357925, + 33.49165128418184, + 58.32997535183497 ], - "timestamp": 5.107333504538046 + "timestamp": 5.168847798484734 }, { - "x": 5.077915979474368, - "y": 6.780072353267369, - "heading": -3.58010809138146, - "angularVelocity": -0.005950048764981118, - "velocityX": 3.9639598415305963, - "velocityY": -0.1772914447418665, + "x": 5.099931542658043, + "y": 6.772736369563246, + "heading": -3.5800300838454637, + "angularVelocity": -0.0060815588342526235, + "velocityX": 3.76561990316587, + "velocityY": -0.17067991870003177, "moduleForcesX": [ - 26.977283498941954, - 13.088021988666144, - 33.20236522268229, - 20.50110572882093 + 0.24002269616514235, + 0.22117703170230035, + 0.25167644223991104, + 0.23285423486863352 ], "moduleForcesY": [ - 8.723342744724212, - 15.885560108858511, - 25.74087269547646, - 32.68451149483199 + 4.326391928783615, + 4.334916585403937, + 4.351428081011753, + 4.359954585237189 ], - "timestamp": 5.158431157714271 + "timestamp": 5.2211147449852255 }, { - "x": 5.280471017904145, - "y": 6.771117377305431, - "heading": -3.580408705243314, - "angularVelocity": -0.005883124628397359, - "velocityX": 3.9640771315113867, - "velocityY": -0.17525219663325547, + "x": 5.296743731326859, + "y": 6.7637007017205635, + "heading": -3.5803480873484106, + "angularVelocity": -0.00608421811945572, + "velocityX": 3.765519163568818, + "velocityY": -0.17287537244202097, "moduleForcesX": [ - 0.0334118938803721, - 0.02901319412251914, - 0.03617632271370437, - 0.031779580558092844 + -0.02738786810423168, + -0.027246197183243195, + -0.02749366052226753, + -0.027350411162396112 ], "moduleForcesY": [ - 0.5627467701499977, - 0.564801110950385, - 0.5686255765232819, - 0.5706799263117553 + -0.5963054368442775, + -0.5963956352307891, + -0.5965517839514543, + -0.5966429834962301 ], - "timestamp": 5.209528810890497 + "timestamp": 5.273381691485717 }, { - "x": 5.482843801346731, - "y": 6.758726217540709, - "heading": -3.580715022162749, - "angularVelocity": -0.005994735577754661, - "velocityX": 3.960510333902072, - "velocityY": -0.2424995864680392, + "x": 5.493454369555724, + "y": 6.7526864720057285, + "heading": -3.580669800620504, + "angularVelocity": -0.006155195465466283, + "velocityX": 3.7635762446351886, + "velocityY": -0.2107303076283394, "moduleForcesX": [ - -0.9926378040047893, - -0.9850808010019008, - -0.9973672418757675, - -0.9898104285367338 + -0.5287852184727379, + -0.5239825347058187, + -0.5317492184247837, + -0.5269382194651111 ], "moduleForcesY": [ - -18.68176620232677, - -18.68515075606664, - -18.691363885724435, - -18.694748257197876 + -10.28066289440765, + -10.282769065093767, + -10.28654220890871, + -10.28864362116857 ], - "timestamp": 5.260626464066722 + "timestamp": 5.325648637986209 }, { - "x": 5.6837294618748615, - "y": 6.731334695007788, - "heading": -3.5810537179070154, - "angularVelocity": -0.00662840117330224, - "velocityX": 3.9314067876134344, - "velocityY": -0.5360622422022736, + "x": 5.688997682168798, + "y": 6.728677589687009, + "heading": -3.5810228607970975, + "angularVelocity": -0.0067549417027819286, + "velocityX": 3.741242328193694, + "velocityY": -0.4593511564422302, "moduleForcesX": [ - -8.105065986269624, - -8.032996251394055, - -8.142908653909107, - -8.070890615781863 + -6.080411522594813, + -6.02353002387444, + -6.11207802550282, + -6.055226639620323 ], "moduleForcesY": [ - -81.5596902417295, - -81.57543466978598, - -81.58850238971299, - -81.60424655492301 + -67.52145044144014, + -67.53691218233755, + -67.55667901029105, + -67.57213537559683 ], - "timestamp": 5.311724117242948 + "timestamp": 5.377915584486701 }, { "x": 5.880957641601562, "y": 6.684422969818115, "heading": -3.5814353254496796, - "angularVelocity": -0.007468200963131239, - "velocityX": 3.859828533543356, - "velocityY": -0.9180798387723068, + "angularVelocity": -0.007891500847064156, + "velocityX": 3.6726836420596607, + "velocityY": -0.8467037550871748, "moduleForcesX": [ - -19.93563366954746, - -19.797209295771946, - -19.98631567124326, - -19.848112638467743 + -18.681818838527086, + -18.502266587342042, + -18.750414129600102, + -18.5712305730302 ], "moduleForcesY": [ - -106.14800306857413, - -106.17640495788532, - -106.1513286826346, - -106.17974187192411 + -105.21692402603168, + -105.25254288064605, + -105.22397106219577, + -105.25961417672018 ], - "timestamp": 5.362821770419173 + "timestamp": 5.430182530987192 }, { - "x": 5.995980176257607, - "y": 6.6497418165304945, - "heading": -3.579249576658118, - "angularVelocity": 0.07178828851457016, - "velocityX": 3.7777767213885776, - "velocityY": -1.1390607410336038, + "x": 5.995964950369022, + "y": 6.649793265437975, + "heading": -3.579262118741216, + "angularVelocity": 0.0678279216427609, + "velocityX": 3.589491370997937, + "velocityY": -1.0808271785951162, "moduleForcesX": [ - -29.960020675030847, - -49.61097001099723, - -23.69035732915975, - -49.81068398032844 + -29.33376530988018, + -47.53506576754961, + -23.5075658910571, + -47.10755646578757 ], "moduleForcesY": [ - -107.24025708495026, - -99.62262552981605, - -107.4372074994835, - -97.95156957525988 + -107.40841370415603, + -100.61864430852758, + -107.60905700250362, + -99.41984691304988 ], - "timestamp": 5.393268920459784 + "timestamp": 5.462222532447207 }, { - "x": 6.1082569266261295, - "y": 6.608629575449157, - "heading": -3.575149016065102, - "angularVelocity": 0.13467797766117506, - "velocityX": 3.6875947410107215, - "velocityY": -1.3502820798170554, + "x": 6.107956693664685, + "y": 6.608067008873313, + "heading": -3.5750708302871326, + "angularVelocity": 0.1308142404211006, + "velocityX": 3.4953726027567464, + "velocityY": -1.302317561270707, "moduleForcesX": [ - -35.09011732252264, - -50.4723868097775, - -31.778861111114438, - -50.897929213341364 + -35.10646123915215, + -49.75636775982228, + -31.99592734180901, + -49.99578261363511 ], "moduleForcesY": [ - -102.59136541098559, - -95.93088215086516, - -101.83371240771552, - -93.68871350341732 + -102.06974562300634, + -95.75188215467672, + -101.23810381235252, + -93.60026996744395 ], - "timestamp": 5.423716070500395 + "timestamp": 5.4942625339072215 }, { - "x": 6.217542082845669, - "y": 6.561748076363306, - "heading": -3.568627120879471, - "angularVelocity": 0.21420379828430375, - "velocityX": 3.5893394315649645, - "velocityY": -1.5397664156848434, + "x": 6.21661606136549, + "y": 6.560219585431066, + "heading": -3.56796945086452, + "angularVelocity": 0.22164104553723224, + "velocityX": 3.3913658785702108, + "velocityY": -1.4933652079240145, "moduleForcesX": [ - -37.80311413224733, - -54.54451585503094, - -34.88451901813677, - -56.068371436952425 + -37.865335431574195, + -55.05567925095188, + -34.8057574496384, + -56.6572177627318 ], "moduleForcesY": [ - -94.79851130258078, - -86.38037479041088, - -91.61886969958682, - -80.69537934854469 + -91.9696806578777, + -83.04388847970704, + -87.7072282477682, + -75.97006732056381 ], - "timestamp": 5.454163220541005 + "timestamp": 5.526302535367236 }, { - "x": 6.324576207665626, - "y": 6.510355295341809, - "heading": -3.5615466703297547, - "angularVelocity": 0.23254887699743812, - "velocityX": 3.515407014357414, - "velocityY": -1.6879340415424884, + "x": 6.3234543638897875, + "y": 6.508277508435261, + "heading": -3.5612398503705793, + "angularVelocity": 0.21003745902883333, + "velocityX": 3.3345286409433434, + "velocityY": -1.6211633779357917, "moduleForcesX": [ - -33.17492791427454, - -36.44246857537978, - -32.454651631287796, - -35.85281953404848 + -25.772720719503052, + -24.038621985626055, + -26.326511299596437, + -24.623675888804087 ], "moduleForcesY": [ - -70.77919539967775, - -69.2166880739434, - -69.02352334329501, - -67.39520207920545 + -55.617544175097784, + -56.3901225503694, + -56.897671134657024, + -57.65632603556039 ], - "timestamp": 5.484610370581616 + "timestamp": 5.558342536827251 }, { - "x": 6.430734331505576, - "y": 6.456274689185194, - "heading": -3.55597279273681, - "angularVelocity": 0.18306730138979413, - "velocityX": 3.486635816434521, - "velocityY": -1.776212423313204, + "x": 6.429785051718747, + "y": 6.454517230975465, + "heading": -3.555783203705424, + "angularVelocity": 0.17030731637027208, + "velocityX": 3.3186854863804274, + "velocityY": -1.6779112050568066, "moduleForcesX": [ - -15.238669327364391, - -8.471205328474737, - -18.190714448045004, - -11.773615198816776 + -8.059917813217185, + -3.5123356736370575, + -10.479446367245371, + -6.03517696733037 ], "moduleForcesY": [ - -36.510563952243956, - -39.29991840660133, - -43.12295459661239, - -45.75459276689898 + -21.48474062356099, + -23.417268008535252, + -26.91275592119492, + -28.788257648118933 ], - "timestamp": 5.515057520622227 + "timestamp": 5.590382538287265 }, { - "x": 6.536475682611372, - "y": 6.400874064288047, - "heading": -3.5512294389855783, - "angularVelocity": 0.1557897453425012, - "velocityX": 3.4729474175663744, - "velocityY": -1.8195668502061235, + "x": 6.535890878159139, + "y": 6.3999345000370695, + "heading": -3.5509405063489323, + "angularVelocity": 0.15114535380203434, + "velocityX": 3.3116673409890054, + "velocityY": -1.7035807881108644, "moduleForcesX": [ - -7.105966453517452, - -3.904238249156235, - -8.842262844227525, - -5.683970643638691 + -3.551592855801476, + -1.4878949974649047, + -4.727965710468891, + -2.6743732417422237 ], "moduleForcesY": [ - -17.55122761626494, - -18.91819232417745, - -21.53331764786734, - -22.877258187795352 + -9.581718408852653, + -10.470814274008577, + -12.285842350891826, + -13.168876343162887 ], - "timestamp": 5.5455046706628375 + "timestamp": 5.62242253974728 }, { "x": 6.641601600646972, "y": 6.344369888305664, "heading": -3.546484656651337, - "angularVelocity": 0.1558366654321555, - "velocityX": 3.4527342590482366, - "velocityY": -1.8558116574791523, + "angularVelocity": 0.1390714573829294, + "velocityX": 3.2993357575144002, + "velocityY": -1.7342262546633984, "moduleForcesX": [ - -9.425930347001255, - -9.431345346606202, - -9.423018174875864, - -9.428431462071117 + -5.7560829719013995, + -4.444919794975055, + -6.483173213952547, + -5.177358266631704 ], "moduleForcesY": [ - -16.908789517759143, - -16.906432080261197, - -16.901878110852078, - -16.89952145852833 + -12.451995720494438, + -13.01289673408783, + -14.152581305031367, + -14.711065470349547 ], - "timestamp": 5.575951820703448 + "timestamp": 5.654462541207295 }, { - "x": 6.869753469015524, - "y": 6.195179516897854, - "heading": -3.542866425141456, - "angularVelocity": 0.048373286754126776, - "velocityX": 3.050234823819821, - "velocityY": -1.994573480816792, + "x": 6.869731347457535, + "y": 6.195147686170208, + "heading": -3.5430658553910614, + "angularVelocity": 0.045706968702274815, + "velocityX": 3.0499342909124034, + "velocityY": -1.9949959074662678, "moduleForcesX": [ - -78.31714320835097, - -74.77834883929404, - -78.09040380788947, - -74.46722774433756 + -49.847910667256336, + -44.35336751958273, + -50.2065788649508, + -44.98425405325641 ], "moduleForcesY": [ - -20.140082076449396, - -24.405157664502912, - -28.259698256336822, - -32.56908498859212 + -45.107327355027664, + -48.75639459683009, + -50.366048913041745, + -53.79518756599839 ], - "timestamp": 5.6507499531576695 + "timestamp": 5.729260790956575 }, { - "x": 7.0598495747309, - "y": 6.070649750515125, - "heading": -3.539878174269547, - "angularVelocity": 0.0399508754277714, - "velocityX": 2.5414552406334554, - "velocityY": -1.66487801629198, + "x": 7.059826728122221, + "y": 6.070616528520401, + "heading": -3.5400838676463033, + "angularVelocity": 0.03986707917302543, + "velocityX": 2.5414415618262263, + "velocityY": -1.66489400577198, "moduleForcesX": [ - -96.38792598998765, - -96.32186712116838, - -96.85697827552185, - -96.7941901796475 + -96.39508860152831, + -96.3494121391401, + -96.72106180217853, + -96.67696001450193 ], "moduleForcesY": [ - 62.906638901351315, - 63.00396831226178, - 62.18110701001113, - 62.27496892844536 + 62.88707197355026, + 62.95438072017819, + 62.38391822498686, + 62.44956252680856 ], - "timestamp": 5.725548085611891 + "timestamp": 5.804059040705855 }, { - "x": 7.211915508257611, - "y": 5.970953271268857, - "heading": -3.537495873597022, - "angularVelocity": 0.031849734670626455, - "velocityX": 2.0330177844985795, - "velocityY": -1.332873909750178, + "x": 7.211898448481457, + "y": 5.970928319469068, + "heading": -3.537649300785395, + "angularVelocity": 0.032548446909771406, + "velocityX": 2.0330919622983044, + "velocityY": -1.332761252910166, "moduleForcesX": [ - -96.32997314585461, - -96.2648765880098, - -96.78416991240438, - -96.72213484257243 + -96.33189190207509, + -96.27315885630252, + -96.74250734840605, + -96.68627379381498 ], "moduleForcesY": [ - 63.33059042831494, - 63.42768790672798, - 62.633819804313376, - 62.72773938264774 + 63.32587402991062, + 63.413486925786316, + 62.696376607221254, + 62.7813968776455 ], - "timestamp": 5.800346218066112 + "timestamp": 5.8788572904551355 }, { - "x": 7.325959940528807, - "y": 5.8961477456875455, - "heading": -3.5357126824424197, - "angularVelocity": 0.02384004915756235, - "velocityX": 1.5246962528241605, - "velocityY": -1.0000988410652476, + "x": 7.325950138897687, + "y": 5.896133355137769, + "heading": -3.535800762021587, + "angularVelocity": 0.02471366335447362, + "velocityX": 1.5247908981630418, + "velocityY": -0.9999560762718304, "moduleForcesX": [ - -96.31011450913448, - -96.24488535024157, - -96.76017259475934, - -96.69795042437518 + -96.31025854518855, + -96.24648866204707, + -96.7505601347192, + -96.68966743585159 ], "moduleForcesY": [ - 63.472522054727726, - 63.57019718383225, - 62.78399745101653, - 62.87858000727262 + 63.47168328918775, + 63.567173224815086, + 62.79818822526497, + 62.89071925102441 ], - "timestamp": 5.875144350520333 + "timestamp": 5.953655540204416 }, { - "x": 7.401987230405639, - "y": 5.846262014344345, - "heading": -3.5345254341500323, - "angularVelocity": 0.01587269967086741, - "velocityX": 1.0164329961495133, - "velocityY": -0.6669381935937067, + "x": 7.401983623718805, + "y": 5.846256704612968, + "heading": -3.5345578251238092, + "angularVelocity": 0.016617192273138574, + "velocityX": 1.0165142242764782, + "velocityY": -0.6668157435766066, "moduleForcesX": [ - -96.30009844719447, - -96.2346774667713, - -96.7482657606124, - -96.68582788542037 + -96.29939278470033, + -96.2329159415438, + -96.75477051723158, + -96.69137390831803 ], "moduleForcesY": [ - 63.543559427570486, - 63.64170695487276, - 62.858869191683326, - 62.95396491375012 + 63.54438360092045, + 63.644109963436094, + 62.84860449412121, + 62.94517892257007 ], - "timestamp": 5.949942482974555 + "timestamp": 6.028453789953696 }, { - "x": 7.44, + "x": 7.439999999999993, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": 0.007929116431986636, - "velocityX": 0.5082047953219507, - "velocityY": -0.3335462040385299, + "angularVelocity": 0.008362148539556004, + "velocityX": 0.5082522172460263, + "velocityY": -0.33347469361261795, "moduleForcesX": [ - -96.29401110747638, - -96.22850451077451, - -96.74113494181451, - -96.67859802056265 + -96.29281019096716, + -96.22472066349776, + -96.75733376592433, + -96.69245071862353 ], "moduleForcesY": [ - 63.58627600774885, - 63.68466012516549, - 62.90374389419573, - 62.99909879542881 + 63.588004757645685, + 63.6902592409911, + 62.87872632391144, + 62.97770864616691 ], - "timestamp": 6.024740615428776 + "timestamp": 6.103252039702976 }, { "x": 7.44, "y": 5.821313381195068, "heading": -3.5339323510489073, - "angularVelocity": -9.243044313287906e-21, - "velocityX": 5.393146768307059e-21, - "velocityY": -4.66608405771598e-20, + "angularVelocity": -1.4293252202182307e-19, + "velocityX": 9.48790104088937e-19, + "velocityY": 6.222110897117571e-19, "moduleForcesX": [ - -96.28984267330934, - -96.22440473642784, - -96.73635227532326, - -96.67387504230592 + -96.28830838426238, + -96.21927713511505, + -96.75901741443018, + -96.6932781749062 ], "moduleForcesY": [ - 63.61490939882352, - 63.713260147549455, - 62.93369197756516, - 63.029025881658725 + 63.61721617293362, + 63.720955818602505, + 62.898815476061394, + 62.99919868599484 ], - "timestamp": 6.099538747882997 + "timestamp": 6.178050289452257 }, { - "x": 7.415573591734402, - "y": 5.838158154369932, - "heading": -3.5159963993345684, - "angularVelocity": 0.29481900273694317, - "velocityX": -0.40150472302798135, - "velocityY": 0.2768829503913695, + "x": 7.413934915732111, + "y": 5.837758514843543, + "heading": -3.513073580944635, + "angularVelocity": 0.33588030587629836, + "velocityX": -0.41971546897661216, + "velocityY": 0.26480931006070224, "moduleForcesX": [ - -103.79621548715679, - -104.66906472150548, - -79.65583433191968, - -86.74486016660069 + -106.89549145493714, + -107.06597038486555, + -81.32645261923486, + -88.6006152825964 ], "moduleForcesY": [ - 50.36433011206954, - 48.57600621993662, - 83.4697607403451, - 76.10242127485562 + 43.394757591016855, + 43.037242158674616, + 81.83966143502107, + 73.93350925841955 ], - "timestamp": 6.1603759108468195 + "timestamp": 6.240152085060227 }, { - "x": 7.366683178068024, - "y": 5.871875693217713, - "heading": -3.4813530745022363, - "angularVelocity": 0.5694434642347287, - "velocityX": -0.8036274422502431, - "velocityY": 0.5542260224697102, + "x": 7.361748288757007, + "y": 5.870675766257217, + "heading": -3.472825051451228, + "angularVelocity": 0.6481057286569312, + "velocityX": -0.8403400652783898, + "velocityY": 0.5300531343967616, "moduleForcesX": [ - -102.97011057048296, - -104.36224405802562, - -80.57222592370957, - -87.538387979563 + -106.04093622896603, + -106.8176617255131, + -82.330045707325, + -89.53141023846203 ], "moduleForcesY": [ - 52.000569893921764, - 49.2024689993104, - 82.56810699384464, - 75.1709663223631 + 45.39917215492418, + 43.61156874588938, + 80.80897526070487, + 72.78287839067804 ], - "timestamp": 6.221213073810642 + "timestamp": 6.3022538806681965 }, { - "x": 7.293282825426951, - "y": 5.9225047085781934, - "heading": -3.431709567684295, - "angularVelocity": 0.8160062764179649, - "velocityX": -1.2065051863894705, - "velocityY": 0.8322053970627743, + "x": 7.283368614850293, + "y": 5.920106690428392, + "heading": -3.415321669414071, + "angularVelocity": 0.9259536133247971, + "velocityX": -1.2621160650732042, + "velocityY": 0.7959661019017853, "moduleForcesX": [ - -101.81794700730566, - -103.86961088775284, - -81.86390049299231, - -88.59644120728534 + -104.78762461695497, + -106.36127377314644, + -83.82992057249801, + -90.79435455500895 ], "moduleForcesY": [ - 54.181240687854725, - 50.19424330306314, - 81.26407249712193, - 73.89664129178023 + 48.16400312768637, + 44.6582268703331, + 79.22203469459356, + 71.17035492491334 ], - "timestamp": 6.282050236774464 + "timestamp": 6.364355676276166 }, { - "x": 7.1953203397420005, - "y": 5.990100130181784, - "heading": -3.3694632408334324, - "angularVelocity": 1.0231628797003296, - "velocityX": -1.6102408612184471, - "velocityY": 1.1110876692883858, + "x": 7.178710465092463, + "y": 5.986116860930105, + "heading": -3.3437461630239302, + "angularVelocity": 1.1525513181933658, + "velocityX": -1.6852676920729752, + "velocityY": 1.0629349740289333, "moduleForcesX": [ - -100.2816827855571, - -102.97098993160482, - -83.78116306119979, - -89.91507313466994 + -103.01244546536581, + -105.38356550288951, + -86.22789009675718, + -92.4074760314894 ], "moduleForcesY": [ - 56.92156160204695, - 51.95654416018795, - 79.25162011086157, - 72.24946473264367 + 51.77437024681341, + 46.836336225769195, + 76.55773487195223, + 69.011950809141 ], - "timestamp": 6.342887399738286 + "timestamp": 6.426457471884136 }, { - "x": 7.0727413911385675, - "y": 6.0747360510060515, - "heading": -3.2981290809283044, - "angularVelocity": 1.1725425123381896, - "velocityX": -2.0148695736572453, - "velocityY": 1.391187831598893, + "x": 7.0476789147390875, + "y": 6.068797966265863, + "heading": -3.263241334420409, + "angularVelocity": 1.2963365682970727, + "velocityX": -2.1099478536907417, + "velocityY": 1.3313802689008434, "moduleForcesX": [ - -98.2967857325556, - -101.19960247774685, - -86.76685073104727, - -91.51945696061503 + -100.53419705098847, + -103.06905054921911, + -90.34073398334222, + -94.4854543183429 ], "moduleForcesY": [ - 60.21289489893422, - 55.24442779855469, - 75.91533220936326, - 70.14362208312181 + 56.32421606606602, + 51.598469531492704, + 71.56970538755402, + 66.03839637354763 ], - "timestamp": 6.403724562702108 + "timestamp": 6.488559267492106 }, { - "x": 6.925504994542901, - "y": 6.1764899452128645, - "heading": -3.2234493803323416, - "angularVelocity": 1.2275342398916893, - "velocityX": -2.420171970925455, - "velocityY": 1.6725614616073183, + "x": 6.890219706001051, + "y": 6.168188552754541, + "heading": -3.184089698328757, + "angularVelocity": 1.274546658703927, + "velocityX": -2.5355017064568197, + "velocityY": 1.6004462594946758, "moduleForcesX": [ - -95.75953255949935, - -97.31237310212741, - -91.76671164693617, - -93.57306626338037 + -96.91797721607088, + -96.29166873701149, + -98.30376883932875, + -97.7151339255793 ], "moduleForcesY": [ - 64.06733787812749, - 61.704100587843456, - 69.68084586415333, - 67.25296923337032 + 62.16157487034742, + 63.11727303496232, + 59.937833099468605, + 60.88181944934315 ], - "timestamp": 6.464561725665931 + "timestamp": 6.550661063100076 }, { - "x": 6.7536964435204645, - "y": 6.295259954535899, - "heading": -3.1573307264826953, - "angularVelocity": 1.086813563100644, - "velocityX": -2.8240723704457587, - "velocityY": 1.9522608145561011, + "x": 6.707396761735225, + "y": 6.282083749845621, + "heading": -3.1426185384704066, + "angularVelocity": 0.667793249009192, + "velocityX": -2.943923641434326, + "velocityY": 1.8340081148388676, "moduleForcesX": [ - -92.25427081535649, - -86.53217011804067, - -101.20179764226755, - -97.11446599263788 + -89.39704823104165, + -59.974779639430686, + -113.80694315967615, + -110.38024149575088 ], "moduleForcesY": [ - 68.84873167392043, - 75.85885179568066, - 54.786384608235366, - 61.64809216339915 + 72.20506885999238, + 97.79151184647154, + 14.788993764846895, + 28.839425985382416 ], - "timestamp": 6.525398888629753 + "timestamp": 6.612762858708046 }, { - "x": 6.5590064200801805, - "y": 6.426527001243398, - "heading": -3.142643870470458, - "angularVelocity": 0.24141257245955464, - "velocityX": -3.200182486419688, - "velocityY": 2.157678634448467, + "x": 6.5096539372796265, + "y": 6.407528929196308, + "heading": -3.1425069776210126, + "angularVelocity": 0.0017964190616627644, + "velocityX": -3.1841724143354817, + "velocityY": 2.0199927896220715, "moduleForcesX": [ - -84.74996163721526, - -38.815685267763385, - -114.64908329430031, - -112.94150068763071 + -63.73430047048059, + -27.910051624661733, + -81.07343060013055, + -47.0233396086935 ], "moduleForcesY": [ - 77.54282904121575, - 107.86535624618253, - 1.6603151606166382, - 4.720404786880023 + 63.59254149911791, + 78.23128798690023, + 10.792434877490132, + 17.49274670317357 ], - "timestamp": 6.586236051593575 + "timestamp": 6.674864654316016 }, { - "x": 6.359357039655459, - "y": 6.562363363203817, - "heading": -3.142536760064485, - "angularVelocity": 0.0017606081670331869, - "velocityX": -3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 6.311987970636452, + "y": 6.533099878628413, + "heading": -3.1424005830387, + "angularVelocity": 0.001713228760479499, + "velocityX": -3.182934804187995, + "velocityY": 2.0220180141778825, "moduleForcesX": [ - -25.631275124724667, - -11.445573252590584, - -26.924267849020588, - -12.108894286779364 + 0.28044804636635795, + 0.2854585156252423, + 0.2805164694315654, + 0.28554463484010184 ], "moduleForcesY": [ - 26.818501650047196, - 27.856532036432693, - 7.559585000412651, - 7.889518984351467 + 0.4664832664910793, + 0.46629629597971395, + 0.45988069254081865, + 0.45969100338396346 ], - "timestamp": 6.647073214557397 + "timestamp": 6.736966449923986 }, { - "x": 6.150813575777984, - "y": 6.684102379422477, - "heading": -3.142424203474444, - "angularVelocity": 0.001850128844891342, - "velocityX": -3.4278959392220183, - "velocityY": 2.001063335104134, + "x": 6.112886530666606, + "y": 6.656381795149372, + "heading": -3.1422932741509393, + "angularVelocity": 0.001727951449866915, + "velocityX": -3.206049648334116, + "velocityY": 1.9851586466067415, "moduleForcesX": [ - -34.11956696981292, - -34.125974092877726, - -34.12166225634603, - -34.128069599930605 + -5.284961607212092, + -5.285867690384544, + -5.2850120640368585, + -5.28591821205513 ], "moduleForcesY": [ - -54.09118913684165, - -54.08961846611762, - -54.08460010575841, - -54.083029392944155 + -8.428859802481485, + -8.428820483404417, + -8.427704094995518, + -8.427665220538435 ], - "timestamp": 6.70791037752122 + "timestamp": 6.799068245531956 }, { - "x": 5.92948393312288, - "y": 6.78064499032236, - "heading": -3.1422944875374577, - "angularVelocity": 0.0021321825454533767, - "velocityX": -3.6380664691205715, - "velocityY": 1.586901923044861, + "x": 5.903153552433724, + "y": 6.76054779134001, + "heading": -3.1421763428195106, + "angularVelocity": 0.001882897753344962, + "velocityX": -3.377244992348762, + "velocityY": 1.6773427430054257, "moduleForcesX": [ - -49.03163546387958, - -49.062291976877944, - -49.05084786401326, - -49.08151053061538 + -39.13650558561692, + -39.149028631143274, + -39.14202011232457, + -39.15454418789349 ], "moduleForcesY": [ - -96.68438290730587, - -96.67004058315028, - -96.6714276505825, - -96.65707564207314 + -70.39220856869584, + -70.38808653661687, + -70.38227306623791, + -70.37815024115646 ], - "timestamp": 6.768747540485042 + "timestamp": 6.861170041139926 }, { - "x": 5.698043840852722, - "y": 6.849459835142262, - "heading": -3.142133803067373, - "angularVelocity": 0.0026412222769214106, - "velocityX": -3.80425517882526, - "velocityY": 1.1311317206034748, + "x": 5.681800942539791, + "y": 6.836948493802415, + "heading": -3.142036982527429, + "angularVelocity": 0.002244062200092101, + "velocityX": -3.5643512031643763, + "velocityY": 1.2302494914108861, "moduleForcesX": [ - -38.74033390445188, - -38.80840694131451, - -38.772841951602906, - -38.84095720701171 + -42.75035515553822, + -42.79383002375121, + -42.77356853041684, + -42.81705900203794 ], "moduleForcesY": [ - -106.40184229774029, - -106.37757896352488, - -106.38798347831748, - -106.36368214821303 + -102.24725073962186, + -102.22993200522637, + -102.23474808291238, + -102.21741225918257 ], - "timestamp": 6.829584703448864 + "timestamp": 6.923271836747896 }, { - "x": 5.459913340003193, - "y": 6.889216371961373, - "heading": -3.1419171816291134, - "angularVelocity": 0.003560676200305988, - "velocityX": -3.9142275748646917, - "velocityY": 0.653490972988881, + "x": 5.452329247860557, + "y": 6.883506999197636, + "heading": -3.141856084971286, + "angularVelocity": 0.002912919898230047, + "velocityX": -3.6950895289376384, + "velocityY": 0.7497127086168015, "moduleForcesX": [ - -25.577114001754065, - -25.717865755187383, - -25.620041504490064, - -25.761004866741906 + -29.82914130574372, + -29.925476931514535, + -29.863722347706368, + -29.960153351309717 ], "moduleForcesY": [ - -111.50955109747034, - -111.47748761628132, - -111.49785520760967, - -111.46568684412037 + -109.89810991838907, + -109.87230666320609, + -109.88678831438045, + -109.86092743160704 ], - "timestamp": 6.890421866412686 + "timestamp": 6.9853736323558655 }, { "x": 5.218749084472655, "y": 6.899192810058594, "heading": -3.141592653589793, - "angularVelocity": 0.005334371681882162, - "velocityX": -3.964094375570246, - "velocityY": 0.16398591931634418, + "angularVelocity": 0.004241928577334819, + "velocityX": -3.7612465324259428, + "velocityY": 0.2525822435148049, "moduleForcesX": [ - -11.472950024585305, - -11.766242291584785, - -11.512400965901131, - -11.806680580908067 + -15.002575278462157, + -15.2146838817836, + -15.03997983187976, + -15.25259845361454 ], "moduleForcesY": [ - -114.27486879290602, - -114.2452044120995, - -114.2687583678, - -114.2388907542841 + -113.69134460089438, + -113.66335076467918, + -113.68440690030413, + -113.65627458813692 ], - "timestamp": 6.951259029376509 + "timestamp": 7.047475427963835 }, { - "x": 4.916924325700423, - "y": 6.864260942419369, - "heading": -3.1415950035328826, - "angularVelocity": -0.00003069941458382123, - "velocityX": -3.943007574588477, - "velocityY": -0.4563463224696035, + "x": 4.928181972145996, + "y": 6.87015777266571, + "heading": -3.141599360558739, + "angularVelocity": -0.0000866124738088435, + "velocityX": -3.7523263652724554, + "velocityY": -0.3749527448361419, "moduleForcesX": [ - 3.5661256761579754, - 4.290300452597265, - 3.5363367506884513, - 4.254477917247712 + 1.3524659590982626, + 1.9300173473620212, + 1.3434416674907999, + 1.9171433879503503 ], "moduleForcesY": [ - -115.08817444708899, - -115.06352371966176, - -115.091807306801, - -115.06756634659668 + -115.0791940311929, + -115.07098399891115, + -115.08184184287786, + -115.0737409512458 ], - "timestamp": 7.027805866546542 + "timestamp": 7.124911952413265 }, { - "x": 4.624233759004072, - "y": 6.782789828791696, - "heading": -3.141613203556746, - "angularVelocity": -0.0002377632379964541, - "velocityX": -3.823679429709109, - "velocityY": -1.0643302406695383, + "x": 4.646396057477393, + "y": 6.793457496928237, + "heading": -3.141606663617506, + "angularVelocity": -0.00009431026016780606, + "velocityX": -3.6389277110781113, + "velocityY": -0.9904922293815314, "moduleForcesX": [ - 22.126953133722363, - 22.152969056839062, - 22.120137478707928, - 22.146146005278467 + 20.7945154399426, + 20.79547645165578, + 20.794279315526616, + 20.795240317066792 ], "moduleForcesY": [ - -112.78882065085001, - -112.783738070124, - -112.7903239244963, - -112.78524441350454 + -112.87678463656185, + -112.87660869109382, + -112.87683614320373, + -112.87666020166296 ], - "timestamp": 7.104352703716575 + "timestamp": 7.202348476862694 }, { - "x": 4.364815135242433, - "y": 6.667702152711534, - "heading": -3.1445463260067914, - "angularVelocity": -0.03831800971122916, - "velocityX": -3.389018192683674, - "velocityY": -1.5034935515953176, + "x": 4.381846370817898, + "y": 6.67179475203828, + "heading": -3.1420798505720358, + "angularVelocity": -0.00611064298009589, + "velocityX": -3.4163424629454022, + "velocityY": -1.5711286857845959, "moduleForcesX": [ - 80.9419265471949, - 82.77126323116903, - 78.469916779085, - 80.35273216958149 + 40.66256347127909, + 41.289770106870066, + 40.34665877997078, + 40.970425111678864 ], "moduleForcesY": [ - -81.16083698479932, - -79.32224282560593, - -83.58853211441301, - -81.80494379688997 + -106.52838528799592, + -106.29034131292164, + -106.66047133973122, + -106.42582853323142 ], - "timestamp": 7.1808995408866085 + "timestamp": 7.279785001312123 }, { - "x": 4.152022632610264, - "y": 6.561745619437614, - "heading": -3.1479056109157355, - "angularVelocity": -0.04388535219922793, - "velocityX": -2.7798993465855872, - "velocityY": -1.3842052420605961, + "x": 4.164221462692653, + "y": 6.562682372433733, + "heading": -3.14551504003902, + "angularVelocity": -0.04436135907968595, + "velocityX": -2.810365130312185, + "velocityY": -1.4090557444349736, "moduleForcesX": [ - 112.9351029547452, - 112.95285116511826, - 113.04267855576263, - 113.05965579629232 + 110.51967200781795, + 110.75149967016266, + 111.51809488586062, + 111.7036498757053 ], "moduleForcesY": [ - 22.445395936831837, - 22.361919228925984, - 21.895492780162357, - 21.813838326495294 + 31.93883577086322, + 31.16312570353636, + 28.240069272526224, + 27.540756606496988 ], - "timestamp": 7.257446378056642 + "timestamp": 7.3572215257615525 }, { - "x": 3.9834975897286435, - "y": 6.473209425403713, - "heading": -3.150924095180105, - "angularVelocity": -0.03943316766524029, - "velocityX": -2.2015938099085024, - "velocityY": -1.15662772371947, + "x": 3.9912382536008786, + "y": 6.472975043297138, + "heading": -3.1492007720912656, + "angularVelocity": -0.047596816598514495, + "velocityX": -2.2338710359443223, + "velocityY": -1.1584627509358232, "moduleForcesX": [ - 107.38700511167124, - 107.33800844105599, - 107.22522115524383, - 107.17535879811417 + 105.63214461850299, + 105.67464605947447, + 105.75886325172861, + 105.80089159312243 ], "moduleForcesY": [ - 41.949490847006764, - 42.073301202563364, - 42.36206037528205, - 42.486672112027655 + 46.14736365416799, + 46.050955922132644, + 45.85560825753269, + 45.759565710113016 ], - "timestamp": 7.333993215226675 + "timestamp": 7.434658050210982 }, { - "x": 3.8579746529951326, - "y": 6.405071382147857, - "heading": -3.153336798543532, - "angularVelocity": -0.03151930834278344, - "velocityX": -1.6398187224207155, - "velocityY": -0.8901483820226407, + "x": 3.8620199488900053, + "y": 6.40464261213393, + "heading": -3.1523691394326896, + "angularVelocity": -0.04091567078908538, + "velocityX": -1.6686996947449793, + "velocityY": -0.8824315353645945, "moduleForcesX": [ - 104.4433579329168, - 104.3219357419469, - 104.10925807795152, - 103.98479429515396 + 103.83684095617444, + 103.73019304787823, + 103.55145256185551, + 103.44265988179228 ], "moduleForcesY": [ - 48.95192669669994, - 49.20870816840664, - 49.6594512669405, - 49.91813079706965 + 50.21517063638313, + 50.43388218964512, + 50.80188828293292, + 51.02184694806683 ], - "timestamp": 7.410540052396708 + "timestamp": 7.512094574660411 }, { - "x": 3.774719039814072, - "y": 6.358839505806994, - "heading": -3.1550135157289017, - "angularVelocity": -0.021904460685229093, - "velocityX": -1.087642759113939, - "velocityY": -0.6039684727687442, + "x": 3.7761167781122684, + "y": 6.358611977323752, + "heading": -3.1546632201056606, + "angularVelocity": -0.029625305232664833, + "velocityX": -1.1093366003769725, + "velocityY": -0.5944305369779248, "moduleForcesX": [ - 102.73833096424609, - 102.56600686278176, - 102.3045321462237, - 102.12754606615566 + 102.92566676985241, + 102.72849667186833, + 102.42499394558602, + 102.22155812605034 ], "moduleForcesY": [ - 52.50070663442109, - 52.83532642023229, - 53.34195778156506, - 53.67882683102995 + 52.13043037442421, + 52.516439019906585, + 53.108410856562514, + 53.49751224898036 ], - "timestamp": 7.487086889566742 + "timestamp": 7.58953109910984 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -0.01128475152706064, - "velocityX": -0.5416639429287429, - "velocityY": -0.305935833734179, + "angularVelocity": -0.01567874681256553, + "velocityX": -0.5534907492707787, + "velocityY": -0.29948260373218166, "moduleForcesX": [ - 101.63866464193978, - 101.43052677926975, - 101.14130973054236, - 100.92738648366812 + 102.37649295640064, + 102.12022129821456, + 101.74499661591258, + 101.47905712486347 ], "moduleForcesY": [ - 54.637212756137814, - 55.0215850566622, - 55.55326636709894, - 55.939948032818286 + 53.242773443897086, + 53.731262222189436, + 54.44082769369383, + 54.93360379578886 ], - "timestamp": 7.563633726736775 + "timestamp": 7.66696762355927 }, { "x": 3.7332563781738273, "y": 6.335421085357666, "heading": -3.155877327766548, - "angularVelocity": -5.114527347233404e-23, - "velocityX": 8.88120104270887e-21, - "velocityY": -1.1112992505795778e-20, + "angularVelocity": 1.2481966357163992e-21, + "velocityX": 6.111631210383028e-20, + "velocityY": -8.886773491570175e-20, "moduleForcesX": [ - 100.87338423663934, - 100.63924602824056, - 100.33208991745956, - 100.09136074426307 + 102.00973407493207, + 101.71254310622048, + 101.29023818682474, + 100.98075222935965 ], "moduleForcesY": [ - 56.06251668808282, - 56.480829327320826, - 57.02628087598985, - 57.44686854165232 + 53.969295684402134, + 54.526035754852536, + 55.3087820339606, + 55.870598413077936 ], - "timestamp": 7.640180563906808 + "timestamp": 7.744404148008699 } ], "eventMarkers": [ { - "timestamp": 0.8375297982110329, + "timestamp": 0.837529870183815, "command": { "type": "named", "data": { @@ -2511,7 +2532,7 @@ } }, { - "timestamp": 1.919752725275319, + "timestamp": 1.9208124483592228, "command": { "type": "named", "data": { @@ -2520,7 +2541,7 @@ } }, { - "timestamp": 4.796356972775791, + "timestamp": 4.846178333479817, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.1.traj b/src/main/deploy/choreo/Blue Source 4 Piece.1.traj index 8507811..359434a 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.1.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.1.traj @@ -4,9 +4,9 @@ "x": 0.4266119384765617, "y": 2.058690309524536, "heading": 3.141592653589793, - "angularVelocity": -1.0052674025899142e-27, - "velocityX": 1.6142788826895295e-27, - "velocityY": 1.3181347462088108e-26, + "angularVelocity": -2.636030265121926e-29, + "velocityX": 8.6332357029436e-27, + "velocityY": -6.3927224094377434e-27, "moduleForcesX": [ 0, 0, @@ -22,508 +22,529 @@ "timestamp": 0 }, { - "x": 0.5057561905034981, - "y": 2.0445076102417237, + "x": 0.5044048891758348, + "y": 2.0447497642817187, "heading": 3.141592653589793, - "angularVelocity": 2.542506773731786e-17, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 2.5937711703524665e-17, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277733, - 113.60325815277733 + 113.60407786230424, + 113.60407786230424, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.35777465406064, - -20.357774654060623, - -20.357774654060627 + -20.35792154651868, + -20.357921546518682, + -20.35792154651867, + -20.35792154651867 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.0986098561129038 }, { - "x": 0.6640322521639479, - "y": 2.016144441360754, + "x": 0.6599786811244505, + "y": 2.016870843817058, "heading": 3.141592653589793, - "angularVelocity": 1.83628749749613e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.2851630766748123, + "angularVelocity": 1.5389337606196853e-16, + "velocityX": 1.577669799766169, + "velocityY": -0.28271941125987365, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060845, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - -20.354574176009805, - -20.354574176009812, - -20.354574176009788, - -20.354574176009795 + -20.354752580314884, + -20.354752580314884, + -20.354752580314873, + -20.354752580314873 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.1972197122258076 }, { - "x": 0.9014153662648319, - "y": 1.9736052393860541, - "heading": 3.1415926535897927, - "angularVelocity": 4.3044410493591116e-16, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156397, + "x": 0.8933091226599791, + "y": 1.975057883291536, + "heading": 3.141592653589793, + "angularVelocity": 2.681654742601167e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.42402415107114716, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.55106593310009, + 113.55106593310009, + 113.5510659331001, + 113.5510659331001 ], "moduleForcesY": [ - -20.348206040044563, - -20.348206040044566, - -20.348206040044545, - -20.34820604004455 + -20.34842177577035, + -20.34842177577035, + -20.348421775770344, + -20.348421775770344 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.2958295683387114 }, { - "x": 1.217832290103284, - "y": 1.9169031294556198, - "heading": 3.1415926535897927, - "angularVelocity": 6.223805757251702e-16, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223711, + "x": 1.2043238856378824, + "y": 1.9193238439537263, + "heading": 3.141592653589793, + "angularVelocity": 3.119234538163159e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959204, "moduleForcesX": [ - 113.44472985048415, - 113.44472985048415, - 113.44472985048417, - 113.44472985048417 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - -20.329366283501095, - -20.3293662835011, - -20.32936628350108, - -20.329366283501084 + -20.32949395931806, + -20.32949395931806, + -20.32949395931805, + -20.329493959318054 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.3944394244516152 }, { - "x": 1.6065593117988135, - "y": 1.8472430049283879, - "heading": 3.1415926535897927, - "angularVelocity": -5.941810710402389e-17, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 1.5704459663887822, + "y": 1.8537145389302825, + "heading": 3.141592653589793, + "angularVelocity": 2.834733594304735e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - 103.79354790180253, - 103.79354790180253, - 103.79354790180251, - 103.79354790180253 + 80.47536393454654, + 80.47536393454654, + 80.47536393454652, + 80.47536393454654 ], "moduleForcesY": [ - -18.599868464060304, - -18.5998684640603, - -18.59986846406034, - -18.59986846406034 + -14.42123536615277, + -14.42123536615277, + -14.421235366152768, + -14.421235366152768 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.49304928056451897 }, { - "x": 1.9952895667696153, - "y": 1.7775823009962126, - "heading": 3.1415926535897927, - "angularVelocity": 9.709734106788374e-17, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151492, + "x": 1.9365688239340553, + "y": 1.7881050947048027, + "heading": 3.141592653589793, + "angularVelocity": -8.681093170147199e-17, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046883, "moduleForcesX": [ - 0.004641026935483716, - 0.004641026935477894, - 0.004641026935483716, - 0.004641026935477894 + 0.0011343830985909456, + 0.0011343830986048384, + 0.0011343830985909456, + 0.0011343830986048384 ], "moduleForcesY": [ - -0.0008316749189463459, - -0.0008316749189463459, - -0.0008316749189385331, - -0.0008316749189385331 + -0.00020328215814713693, + -0.00020328215814713693, + -0.00020328215816578076, + -0.00020328215816578076 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.5916591366774228 }, { - "x": 2.384019821763918, - "y": 1.7079215970598256, - "heading": 3.1415926535897927, - "angularVelocity": -2.3094137904516824e-16, - "velocityX": 3.9082909239078325, - "velocityY": -0.7003681690574906, + "x": 2.3026916814847596, + "y": 1.7224956504783495, + "heading": 3.141592653589793, + "angularVelocity": 4.734074192918141e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 3.373320326366702e-8, - 3.3733215465968396e-8, - 3.373320326366702e-8, - 3.3733215465968396e-8 + 7.931400211976679e-9, + 7.931379192828927e-9, + 7.931400211976679e-9, + 7.931379192828927e-9 ], "moduleForcesY": [ - -6.0450200846646806e-9, - -6.0450200846646806e-9, - -6.045036459773772e-9, - -6.045036459773772e-9 + -1.421325763882383e-9, + -1.421325763882383e-9, + -1.4212975568395444e-9, + -1.4212975568395444e-9 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.6902689927903265 }, { - "x": 2.772750076758221, - "y": 1.6382608931234386, - "heading": 3.1415926535897927, - "angularVelocity": 2.6440232206689406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 2.668814539035464, + "y": 1.6568862062518965, + "heading": 3.141592653589793, + "angularVelocity": -3.989113893494158e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 2.7260590797900104e-13, - 2.5418023822544317e-13, - 2.726059079790011e-13, - 2.5418023822544317e-13 + 1.0621117148556482e-13, + 1.389401920423077e-13, + 1.0621117148556477e-13, + 1.389401920423077e-13 ], "moduleForcesY": [ - -2.389781832125078e-14, - -2.3897818321250773e-14, - 8.288576692751096e-16, - 8.288576692751175e-16 + 3.264252305613286e-14, + 3.264252305613286e-14, + -1.1278805048511687e-14, + -1.12788050485117e-14 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.7888788489032303 }, { - "x": 3.1614803317525237, - "y": 1.5686001891870518, - "heading": 3.1415926535897927, - "angularVelocity": 3.64658642558291e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.0349373965861686, + "y": 1.5912767620254435, + "heading": 3.141592653589793, + "angularVelocity": 3.8177893619679035e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - -2.1187937111675137e-15, - -5.848102972462486e-15, - -2.1187937111675106e-15, - -5.848102972462483e-15 + -1.0065015410704733e-14, + -3.93561753170835e-14, + -1.0065015410704727e-14, + -3.935617531708349e-14 ], "moduleForcesY": [ - -3.79352555329438e-15, - -3.793525553294378e-15, - 1.2110915382879926e-15, - 1.2110915382879942e-15 + -3.845752753351914e-14, + -3.845752753351914e-14, + 8.502984548337096e-16, + 8.502984548337159e-16 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.8874887050161342 }, { - "x": 3.5502105867468265, - "y": 1.4989394852506648, - "heading": 3.1415926535897927, - "angularVelocity": 3.0984512311067555e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.401060254136873, + "y": 1.5256673177989906, + "heading": 3.141592653589793, + "angularVelocity": 2.8475078392542003e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - -1.1805625548476553e-14, - -9.766686110860697e-15, - -1.1805625548476553e-14, - -9.766686110860699e-15 + 2.702347393042644e-14, + 3.066392780900211e-14, + 2.7023473930426435e-14, + 3.0663927809002107e-14 ], "moduleForcesY": [ - 2.2856139854462812e-15, - 2.2856139854462805e-15, - -4.505793531159297e-16, - -4.505793531159307e-16 + 7.65129265833603e-15, + 7.65129265833603e-15, + 2.7659167280194507e-15, + 2.76591672801945e-15 ], - "timestamp": 0.9946297820777839 + "timestamp": 0.986098561129038 }, { - "x": 3.9389408417411294, - "y": 1.4292787813142778, - "heading": 3.1415926535897927, - "angularVelocity": 2.6938201259937605e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.7671831116875776, + "y": 1.4600578735725376, + "heading": 3.141592653589793, + "angularVelocity": -6.625521634806447e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.3582614867510558e-15, - -8.531249324574269e-16, - -2.3582614867510566e-15, - -8.531249324574281e-16 + -2.7558380308157566e-14, + 7.984012372117386e-15, + -2.755838030815758e-14, + 7.984012372117377e-15 ], "moduleForcesY": [ - -3.0992634216346065e-15, - -3.0992634216346073e-15, - -5.1191098856866794e-15, - -5.119109885686679e-15 + 3.433627959014811e-14, + 3.4336279590148096e-14, + -1.3360506441930727e-14, + -1.3360506441930734e-14 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.084708417241942 }, { - "x": 4.327671096735433, - "y": 1.359618077377891, - "heading": 3.1415926535897927, - "angularVelocity": -1.238903049402388e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 4.1333059692382825, + "y": 1.3944484293460846, + "heading": 3.141592653589793, + "angularVelocity": 2.626196468380025e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.639857812880446e-14, - 3.102742236349073e-14, - 1.6398578128804444e-14, - 3.102742236349072e-14 + 5.218701888727073e-14, + 1.7474976800726986e-14, + 5.2187018887270745e-14, + 1.7474976800726996e-14 ], "moduleForcesY": [ - -1.6461928460837335e-15, - -1.6461928460837406e-15, - -2.1277647026310398e-14, - -2.1277647026310404e-14 + -1.3519320045963935e-14, + -1.3519320045963913e-14, + 3.3063161303335716e-14, + 3.306316130333573e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.1833182733548457 }, { - "x": 4.716401351729735, - "y": 1.289957373441504, - "heading": 3.1415926535897927, - "angularVelocity": -1.136445427284406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 4.499428826788987, + "y": 1.3288389851196316, + "heading": 3.141592653589793, + "angularVelocity": -3.612388438354753e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 1.0678916244800482e-14, - 1.029779697253711e-14, - 1.0678916244800482e-14, - 1.0297796972537104e-14 + -3.317589814336674e-14, + -9.769000156659927e-15, + -3.3175898143366745e-14, + -9.769000156659935e-15 ], "moduleForcesY": [ - -1.2590263470365182e-14, - -1.2590263470365181e-14, - -1.2078813255255259e-14, - -1.2078813255255259e-14 + 4.3145001853369944e-15, + 4.3145001853369944e-15, + -2.7096829237238478e-14, + -2.7096829237238475e-14 ], - "timestamp": 1.293018716701119 + "timestamp": 1.2819281294677496 }, { - "x": 5.105131606724038, - "y": 1.2202966695051172, - "heading": 3.1415926535897927, - "angularVelocity": 2.9818590278219814e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 4.865551684339691, + "y": 1.2632295408931786, + "heading": 3.141592653589793, + "angularVelocity": 6.373929698977975e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 2.769886946545534e-14, - 1.2379704678654201e-14, - 2.769886946545535e-14, - 1.2379704678654214e-14 + 1.7589203863345612e-14, + -1.9879025454332904e-14, + 1.758920386334562e-14, + -1.9879025454332894e-14 ], "moduleForcesY": [ - 9.496370048803752e-15, - 9.49637004880376e-15, - 3.005421294922601e-14, - 3.005421294922601e-14 + -1.6636808224988317e-14, + -1.663680822498831e-14, + 3.3644390703917045e-14, + 3.364439070391706e-14 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.3805379855806534 }, { - "x": 5.493861861718341, - "y": 1.1506359655687302, - "heading": 3.1415926535897927, - "angularVelocity": 3.7716775113186575e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.231674541890395, + "y": 1.1976200966667256, + "heading": 3.141592653589793, + "angularVelocity": -2.0111488524479928e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.875775797486784e-14, - 1.5819811149361853e-14, - 1.8757757974867845e-14, - 1.5819811149361856e-14 + 6.3838812836279954e-15, + 3.784432963816933e-14, + 6.383881283627987e-15, + 3.7844329638169315e-14 ], "moduleForcesY": [ - 5.14793052073305e-15, - 5.147930520733051e-15, - 9.090563825427617e-15, - 9.090563825427614e-15 + 4.030686794000322e-14, + 4.0306867940003206e-14, + -1.9120757067646953e-15, + -1.9120757067647064e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.4791478416935573 }, { - "x": 5.882592116712644, - "y": 1.0809752616323431, - "heading": 3.1415926535897927, - "angularVelocity": 4.0491763613005573e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.597797399441099, + "y": 1.1320106524402727, + "heading": 3.141592653589793, + "angularVelocity": 4.608632320582683e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, + "moduleForcesX": [ + 3.918114304682504e-14, + 1.4344013324637785e-14, + 3.9181143046825054e-14, + 1.434401332463779e-14 + ], + "moduleForcesY": [ + -2.8224321170465307e-14, + -2.8224321170465303e-14, + 5.106334777962157e-15, + 5.106334777962165e-15 + ], + "timestamp": 1.5777576978064611 + }, + { + "x": 5.963920256991803, + "y": 1.0664012082138197, + "heading": 3.141592653589793, + "angularVelocity": -2.9208162371439364e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.1753860824189263e-14, - -2.2786094030199463e-14, - -2.1753860824189263e-14, - -2.278609403019946e-14 + 1.2013443615486301e-14, + 4.02636056188286e-14, + 1.2013443615486301e-14, + 4.02636056188286e-14 ], "moduleForcesY": [ - -6.901925353374897e-15, - -6.901925353374896e-15, - -5.516700481060696e-15, - -5.516700481060695e-15 + 1.289444461580083e-14, + 1.2894444615800824e-14, + -2.501639454930619e-14, + -2.50163945493062e-14 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.676367553919365 }, { - "x": 6.271322371706947, - "y": 1.0113145576959566, - "heading": 3.1415926535897927, - "angularVelocity": 4.793115078142994e-16, - "velocityX": 3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 6.330043114542507, + "y": 1.0007917639873667, + "heading": 3.141592653589793, + "angularVelocity": -1.2364755766957827e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -2.3335563331205926e-13, - -2.3612291774158497e-13, - -2.3335563331205926e-13, - -2.3612291774158497e-13 + -1.0552174459678842e-13, + -1.1184131716065804e-13, + -1.0552174459678844e-13, + -1.1184131716065804e-13 ], "moduleForcesY": [ - 2.5534936481984513e-14, - 2.5534936481984522e-14, - 2.924854615684032e-14, - 2.9248546156840326e-14 + 2.5387864477856727e-14, + 2.538786447785674e-14, + 3.386853439517406e-14, + 3.3868534395174075e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.7749774100322688 }, { - "x": 6.660052626677748, - "y": 0.9416538537637811, - "heading": 3.1415926535897927, - "angularVelocity": -3.3113004994684937e-16, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151491, + "x": 6.69616597208778, + "y": 0.9351823197618869, + "heading": 3.141592653589793, + "angularVelocity": -3.2114621171744805e-16, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046882, "moduleForcesX": [ - -3.37332422685154e-8, - -3.373321212191524e-8, - -3.37332422685154e-8, - -3.373321212191524e-8 + -7.93135794252456e-9, + -7.931350532461352e-9, + -7.93135794252456e-9, + -7.931350532461352e-9 ], "moduleForcesY": [ - 6.045047048260069e-9, - 6.045047048260069e-9, - 6.045006592459861e-9, - 6.045006592459861e-9 + 1.4213044027536005e-9, + 1.4213044027536005e-9, + 1.4212944586791418e-9, + 1.4212944586791416e-9 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.8735872661451727 }, { - "x": 7.048779648373277, - "y": 0.8719937292365493, - "heading": 3.1415926535897927, - "angularVelocity": -2.927541680761118e-16, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824061, + "x": 7.06228805283868, + "y": 0.8695730147384431, + "heading": 3.141592653589793, + "angularVelocity": -5.032939008461686e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - -0.004641026935458204, - -0.004641026935459632, - -0.004641026935458204, - -0.004641026935459632 + -0.0011343830986322845, + -0.0011343830986254506, + -0.0011343830986322845, + -0.0011343830986254506 ], "moduleForcesY": [ - 0.0008316749189556608, - 0.0008316749189556608, - 0.0008316749189575763, - 0.0008316749189575763 + 0.00020328215814718062, + 0.00020328215814718062, + 0.0002032821581380095, + 0.0002032821581380095 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.9721971222580765 }, { - "x": 7.36519657221173, - "y": 0.8152916193061152, - "heading": 3.1415926535897927, - "angularVelocity": 1.34800275257632e-15, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 7.373302815816583, + "y": 0.8138389754006333, + "heading": 3.141592653589793, + "angularVelocity": 7.522639458662454e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959202, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180247, - -103.79354790180248 + -80.47536393454648, + -80.47536393454651, + -80.47536393454646, + -80.4753639345465 ], "moduleForcesY": [ - 18.599868464060222, - 18.599868464060204, - 18.599868464060343, - 18.599868464060325 + 14.421235366152747, + 14.421235366152738, + 14.421235366152821, + 14.421235366152812 ], - "timestamp": 1.9892595641555668 + "timestamp": 2.0708069783709804 }, { - "x": 7.602579686312613, - "y": 0.7727524173314154, + "x": 7.606633257352112, + "y": 0.7720260148751114, "heading": 3.141592653589793, - "angularVelocity": 1.0489291061445997e-15, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156398, + "angularVelocity": 6.995668606739556e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.4240241510711471, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048415 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - 20.329366283501095, - 20.329366283501102, - 20.329366283501077, - 20.329366283501084 + 20.329493959318064, + 20.329493959318064, + 20.329493959318047, + 20.32949395931805 ], - "timestamp": 2.088722542363345 + "timestamp": 2.1694168344838842 }, { - "x": 7.760855747973063, - "y": 0.7443892484504455, + "x": 7.762207049300727, + "y": 0.7441470944104503, "heading": 3.141592653589793, - "angularVelocity": 6.60732824682179e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.28516307667481233, + "angularVelocity": 4.3371547132759497e-16, + "velocityX": 1.5776697997661688, + "velocityY": -0.28271941125987354, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.5510659331001, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - 20.348206040044566, - 20.348206040044573, - 20.348206040044545, - 20.34820604004455 + 20.34842177577035, + 20.348421775770355, + 20.34842177577033, + 20.348421775770333 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.268026690596788 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 3.6252603672857176e-16, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 1.5788584640316286e-16, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - 20.354574176009816, - 20.354574176009823, - 20.354574176009788, - 20.354574176009795 + 20.354752580314884, + 20.354752580314884, + 20.354752580314862, + 20.354752580314862 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.366636546709692 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 6.745149212805757e-24, - "velocityX": -2.3977049906460955e-24, - "velocityY": 5.457735537774418e-24, + "angularVelocity": -2.881387559058349e-22, + "velocityX": -2.0695827234177623e-22, + "velocityY": 3.9145962895148407e-22, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230424, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - 20.357774654060638, - 20.357774654060645, - 20.357774654060613, - 20.357774654060623 + 20.35792154651868, + 20.35792154651868, + 20.35792154651866, + 20.357921546518664 ], - "timestamp": 2.38711147698668 + "timestamp": 2.4652464028225958 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.2.traj b/src/main/deploy/choreo/Blue Source 4 Piece.2.traj index 50732a4..71e6ee6 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.2.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.2.traj @@ -4,442 +4,463 @@ "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 6.745149212805757e-24, - "velocityX": -2.3977049906460955e-24, - "velocityY": 5.457735537774418e-24, + "angularVelocity": -2.881387559058349e-22, + "velocityX": -2.0695827234177623e-22, + "velocityY": 3.9145962895148407e-22, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230424, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - 20.357774654060638, - 20.357774654060645, - 20.357774654060613, - 20.357774654060623 + 20.35792154651868, + 20.35792154651868, + 20.35792154651866, + 20.357921546518664 ], "timestamp": 0 }, { - "x": 7.790302474791704, - "y": 0.7486471398847376, - "heading": 3.113139944846083, - "angularVelocity": -0.35037941350634544, - "velocityX": -0.6119976095087556, - "velocityY": 0.227085702748705, + "x": 7.793078256290604, + "y": 0.747575876847021, + "heading": 3.1112179449580726, + "angularVelocity": -0.38443223901861173, + "velocityX": -0.5938569225985211, + "velocityY": 0.2198318874756783, "moduleForcesX": [ - -103.90543853086191, - -98.59916886502413, - -113.31145977613869, - -112.25808633757457 + -103.38540370202267, + -97.08636346934234, + -113.70612876978298, + -112.73947029508176 ], "moduleForcesY": [ - 50.24070001601602, - 59.96747683817382, - 21.908340031011765, - 26.7231884795195 + 51.30130417295831, + 62.38345613408081, + 19.75281146697054, + 24.597212101539153 ], - "timestamp": 0.0812054237404416 + "timestamp": 0.07901186619848044 }, { - "x": 7.6908434229658935, - "y": 0.7856168809153167, - "heading": 3.0585136722324213, - "angularVelocity": -0.6726924150813451, - "velocityX": -1.2247833610685241, - "velocityY": 0.45526196807673963, + "x": 7.699157584042874, + "y": 0.7824201103535565, + "heading": 3.0528530427476355, + "angularVelocity": -0.7386852762573926, + "velocityX": -1.1886907216164007, + "velocityY": 0.44100000649276744, "moduleForcesX": [ - -103.9180654585984, - -99.75724138640885, - -112.86307129194968, - -112.08705733206625 + -103.36634328078968, + -98.44357768722068, + -113.2458848815574, + -112.56382635716881 ], "moduleForcesY": [ - 50.18528756830429, - 57.99159008453135, - 24.052005242751903, - 27.373638607207237 + 51.30995429297126, + 60.18928815483856, + 22.172889474101435, + 25.32325446348918 ], - "timestamp": 0.1624108474808832 + "timestamp": 0.15802373239696088 }, { - "x": 7.541531337145835, - "y": 0.8412229963489037, - "heading": 2.981391936731005, - "angularVelocity": -0.9497116319215562, - "velocityX": -1.8386959754967525, - "velocityY": 0.6847586389219771, + "x": 7.558124904051805, + "y": 0.8348658019205454, + "heading": 2.970415200366219, + "angularVelocity": -1.0433602741938681, + "velocityX": -1.7849556880075408, + "velocityY": 0.6637698119323439, "moduleForcesX": [ - -104.11265608433906, - -101.42006410641169, - -112.15378683051924, - -111.72713556007261 + -103.55489402764358, + -100.41233501810488, + -112.50081664731479, + -112.18043737384707 ], "moduleForcesY": [ - 49.732813229817744, - 54.984671240448414, - 27.084035745760126, - 28.72458573429547 + 50.87947133813933, + 56.79519440863833, + 25.59433833117188, + 26.8778174814867 ], - "timestamp": 0.2436162712213248 + "timestamp": 0.23703559859544132 }, { - "x": 7.3422298869395055, - "y": 0.9155841520343788, - "heading": 2.888707762091219, - "angularVelocity": -1.1413544855825648, - "velocityX": -2.4542874235021577, - "velocityY": 0.9157166142394264, + "x": 7.369806193764596, + "y": 0.905047849903824, + "heading": 2.8714456053511004, + "angularVelocity": -1.2525915381685058, + "velocityX": -2.383423140698201, + "velocityY": 0.8882469350487018, "moduleForcesX": [ - -104.98869457390775, - -103.9286155458672, - -110.8945520614623, - -110.77607463143485 + -104.5638907933371, + -103.40298640344945, + -111.14222972427874, + -111.12271990152317 ], "moduleForcesY": [ - 47.76428477391485, - 49.99408871314553, - 31.717824320202514, - 32.072047225373296 + 48.67580615971352, + 51.05561071064651, + 30.82098267886581, + 30.82179435894176 ], - "timestamp": 0.3248216949617664 + "timestamp": 0.31604746479392176 }, { - "x": 7.092835207414608, - "y": 1.0087906432972025, - "heading": 2.7963823652584026, - "angularVelocity": -1.13693633479357, - "velocityX": -3.071157910856337, - "velocityY": 1.1477865266825216, + "x": 7.134064263774228, + "y": 0.9930498413232173, + "heading": 2.7737381050807945, + "angularVelocity": -1.2366180546205667, + "velocityX": -2.983626907358137, + "velocityY": 1.1137819628045385, "moduleForcesX": [ - -107.94355502791352, - -107.94550564100822, - -107.79557995601229, - -107.79794622888959 + -108.14622857930792, + -108.14231842669959, + -107.59500574441715, + -107.59649154427582 ], "moduleForcesY": [ - 40.38686661660537, - 40.3833232466669, - 40.78021169994761, - 40.77561046788363 + 39.79515762619855, + 39.812512633287064, + 41.26220935675609, + 41.264830579989365 ], - "timestamp": 0.406027118702208 + "timestamp": 0.3950593309924022 }, { - "x": 6.796745453055094, - "y": 1.1197154475688882, - "heading": 2.775510588841466, - "angularVelocity": -0.25702441358657924, - "velocityX": -3.6461820001815646, - "velocityY": 1.365977777866621, + "x": 6.8566127289684236, + "y": 1.0968882632669579, + "heading": 2.7677976122574344, + "angularVelocity": -0.0751848185491247, + "velocityX": -3.5115172967670025, + "velocityY": 1.3142130029291403, "moduleForcesX": [ - -114.48153022441872, - -114.50263359045594, - -80.3287014204199, - -92.8994088994194 + -111.16467067641464, + -114.92109699391807, + -65.016543313601, + -88.39242273361802 ], "moduleForcesY": [ - -8.214078066637384, - 11.01893061920677, - 81.97674297463203, - 67.8367051044082 + -28.016980604792003, + 4.148148544540663, + 94.40251274978314, + 73.55404230537421 ], - "timestamp": 0.4872325424426496 + "timestamp": 0.47407119719088264 }, { - "x": 6.494829735223949, - "y": 1.232766445355973, - "heading": 2.7753947312647114, - "angularVelocity": -0.0014267221500469003, - "velocityX": -3.7179255267008355, - "velocityY": 1.3921606781885885, + "x": 6.577593993203279, + "y": 1.201509394881753, + "heading": 2.7676745616395704, + "angularVelocity": -0.0015573688331172865, + "velocityX": -3.5313523042759076, + "velocityY": 1.3241192323186386, "moduleForcesX": [ - -10.058722820162451, - -20.67537666401696, - -4.347871917595185, - -15.100494848677254 + -2.8091694596169208, + -6.012702465623992, + -1.1155418972111872, + -4.321760134676918 ], "moduleForcesY": [ - -4.924229823728783, - -0.6516753204634617, - 9.978553002629143, - 13.911513369658744 + -1.0053994170960971, + 0.255916053918154, + 3.3094001138142786, + 4.561565207999692 ], - "timestamp": 0.5684379661830912 + "timestamp": 0.5530830633893631 }, { - "x": 6.192913236776813, - "y": 1.34581580615927, - "heading": 2.7752792922983844, - "angularVelocity": -0.0014215671935348026, - "velocityX": -3.7179351395561624, - "velocityY": 1.3921405196362102, + "x": 6.298577354601419, + "y": 1.3061362496498794, + "heading": 2.7675516355023344, + "angularVelocity": -0.0015557933656047968, + "velocityX": -3.5313257618920133, + "velocityY": 1.324191666417548, "moduleForcesX": [ - -0.0016277805976752818, - -0.001847063161268062, - -0.0015148902541237436, - -0.001734172817758108 + 0.004786508231746084, + 0.004717836359581643, + 0.004822681056873213, + 0.004754009184721306 ], "moduleForcesY": [ - -0.0037142738377341908, - -0.0036301509173889052, - -0.003420003455069923, - -0.0033358805347123346 + 0.01295846874279039, + 0.01298542378305762, + 0.013050624257642878, + 0.013077579297906624 ], - "timestamp": 0.6496433899235328 + "timestamp": 0.6320949295878435 }, { - "x": 5.8909967172285675, - "y": 1.458865110625056, - "heading": 2.775163853477906, - "angularVelocity": -0.0014215653974960305, - "velocityX": -3.7179353994046904, - "velocityY": 1.3921398258708426, + "x": 6.019560787537094, + "y": 1.4107632952116882, + "heading": 2.7674287096824344, + "angularVelocity": -0.0015557893493045325, + "velocityX": -3.531324856489611, + "velocityY": 1.3241940811647472, "moduleForcesX": [ - -0.00004542055571195788, - -0.00004549695258179801, - -0.00004538121174383447, - -0.00004545760861367461 + 0.00016276242258108617, + 0.00016258736752973322, + 0.00016285466593947583, + 0.0001626796108881199 ], "moduleForcesY": [ - -0.00012138298819942749, - -0.00012135367010735092, - -0.00012128046597513451, - -0.00012125114788305795 + 0.0004338321315768353, + 0.0004339008689056902, + 0.00043406705001357217, + 0.0004341357873424245 ], - "timestamp": 0.7308488136639744 + "timestamp": 0.711106795786324 }, { - "x": 5.589080197992595, - "y": 1.5719144159306049, - "heading": 2.775048414795757, - "angularVelocity": -0.0014215636940543507, - "velocityX": -3.7179353955592296, - "velocityY": 1.3921398362120572, + "x": 5.740544223186777, + "y": 1.5153903480276578, + "heading": 2.767305784182522, + "angularVelocity": -0.0015557852994348927, + "velocityX": -3.5313248221402196, + "velocityY": 1.3241941729757745, "moduleForcesX": [ - 6.900104711158049e-7, - 6.175555507382957e-7, - 7.273372348999605e-7, - 6.548823145224512e-7 + 0.000006215085286239505, + 0.000006038575601884941, + 0.0000063081287765344795, + 0.000006131619092180273 ], "moduleForcesY": [ - 0.0000017458195351588234, - 0.000001773634459523078, - 0.0000018430517858208699, - 0.0000018708667101851245 + 0.000016347388393537852, + 0.00001641672195966612, + 0.00001658425890258734, + 0.000016653592468716595 ], - "timestamp": 0.812054237404416 + "timestamp": 0.7901186619848044 }, { - "x": 5.2871637020932685, - "y": 1.6849637835662303, - "heading": 2.774932976253418, - "angularVelocity": -0.0014215619723587569, - "velocityX": -3.717935108181291, - "velocityY": 1.3921406037725665, + "x": 5.461527659771718, + "y": 1.6200174033544015, + "heading": 2.7671828590052048, + "angularVelocity": -0.001555781216559394, + "velocityX": -3.5313248103033033, + "velocityY": 1.3241942047529485, "moduleForcesX": [ - 0.0000502708285116954, - 0.00005019760041729749, - 0.00005030856660980123, - 0.000050235338515403327 + 0.0000021694123254773052, + 0.0000019914727065847287, + 0.0000022632434626927816, + 0.000002085303843800205 ], "moduleForcesY": [ - 0.00013415824992900224, - 0.0001341863713689036, - 0.00013425651975516287, - 0.00013428464119506422 + 0.0000055567123093686425, + 0.000005626632809301405, + 0.000005795501746120869, + 0.0000058654222460536335 ], - "timestamp": 0.8932596611448576 + "timestamp": 0.8691305281832848 }, { - "x": 4.985247891548803, - "y": 1.7980149815274176, - "heading": 2.7748175378300544, - "angularVelocity": -0.0014215605072442536, - "velocityX": -3.7179266684142243, - "velocityY": 1.3921631432222419, + "x": 5.1825111126116505, + "y": 1.7246445020461594, + "heading": 2.7670599341523174, + "angularVelocity": -0.0015557771104789896, + "velocityX": -3.531324604574814, + "velocityY": 1.3241947535947438, "moduleForcesX": [ - 0.001475856701570743, - 0.0014757943892858075, - 0.0014758888252835915, - 0.0014758265129986559 + 0.000037016274754465266, + 0.000036837332466608477, + 0.00003711066869943973, + 0.00003693172641158219 ], "moduleForcesY": [ - 0.003941365145401281, - 0.003941389083148754, - 0.003941448766550271, - 0.003941472704297744 + 0.00009848388119271718, + 0.00009855422108221447, + 0.0000987240161800544, + 0.00009879435606955096 ], - "timestamp": 0.9744650848852991 + "timestamp": 0.9481423943817653 }, { - "x": 4.683352553327882, - "y": 1.911120366719257, - "heading": 2.77470166124187, - "angularVelocity": -0.0014269562653176273, - "velocityX": -3.7176745630424253, - "velocityY": 1.392830429077746, + "x": 4.903495044321948, + "y": 1.8292728777764504, + "heading": 2.766937009602399, + "angularVelocity": -0.0015557732759970146, + "velocityX": -3.5313185438349777, + "velocityY": 1.3242109162117603, "moduleForcesX": [ - 0.04402948835625871, - 0.04425896362882348, - 0.0439111468017011, - 0.04414062207567931 + 0.0010892896607136175, + 0.0010891225627036043, + 0.0010893778384575773, + 0.0010892107404475615 ], "moduleForcesY": [ - 0.11688472651519642, - 0.11679654129683462, - 0.11657677855451694, - 0.11648859333560278 + 0.002904637990345418, + 0.0029047036980851936, + 0.0029048622306798427, + 0.0029049279384196244 ], - "timestamp": 1.0556705086257407 + "timestamp": 1.0271542605802457 }, { - "x": 4.388149882175546, - "y": 2.023490901110545, - "heading": 2.7531166048918894, - "angularVelocity": -0.2658080625128395, - "velocityX": -3.6352580598051922, - "velocityY": 1.3837811468167465, + "x": 4.6244933985494985, + "y": 1.933939583482744, + "heading": 2.7668139676158936, + "angularVelocity": -0.0015572595918266297, + "velocityX": -3.531136007743285, + "velocityY": 1.3246960329144357, "moduleForcesX": [ - 12.043870771869061, - 22.83840056240313, - 5.860331369774312, - 16.90529380786774 + 0.032790520589515496, + 0.03285528776957622, + 0.032756330570521824, + 0.0328210977506596 ], "moduleForcesY": [ - 8.365079303422721, - 3.623159020545799, - -6.955883377496195, - -11.362059153742544 + 0.08724249386313424, + 0.08721701632801891, + 0.08715557843540787, + 0.08713010090026041 ], - "timestamp": 1.1368759323661823 + "timestamp": 1.1061661267787262 }, { - "x": 4.139244616295801, - "y": 2.117659437341253, - "heading": 2.6582966359163365, - "angularVelocity": -1.1676556147115003, - "velocityX": -3.065131051779582, - "velocityY": 1.159633579792663, + "x": 4.347461759415901, + "y": 2.039177693852194, + "heading": 2.7612196194953933, + "angularVelocity": -0.07080389806825951, + "velocityX": -3.5062029599159743, + "velocityY": 1.331927917068659, "moduleForcesX": [ - 114.3035613459115, - 114.17872059898714, - 80.10523084516268, - 90.1993984029834 + 3.7842699416281302, + 6.787368546566622, + 2.1704396914350492, + 5.18202223179837 ], "moduleForcesY": [ - 10.797887995941974, - -14.08163508293908, - -82.12682115917214, - -71.37399843226972 + 3.927000047117058, + 2.7165308525255325, + -0.11954942939422283, + -1.3250575905080704 ], - "timestamp": 1.218081356106624 + "timestamp": 1.1851779929772066 }, { - "x": 3.94041859179872, - "y": 2.1929455154015076, - "heading": 2.5635212544140145, - "angularVelocity": -1.1671065445733562, - "velocityX": -2.4484328181402284, - "velocityY": 0.9271065230925025, + "x": 4.112021737626803, + "y": 2.1280236238213828, + "heading": 2.6649584476590715, + "angularVelocity": -1.2183128492941773, + "velocityX": -2.9798058584980724, + "velocityY": 1.1244631248932273, "moduleForcesX": [ - 107.82986538656019, - 107.83281776344131, - 107.84823135382315, - 107.85118599185446 + 111.18079581607803, + 114.73981520594828, + 66.3526187121827, + 86.14799527800557 ], "moduleForcesY": [ - -40.68978365444929, - -40.681753184811356, - -40.64114069086622, - -40.63309333309364 + 28.1775493785711, + -7.795647023550137, + -93.37826671539518, + -76.14784747221287 ], - "timestamp": 1.2992867798470655 + "timestamp": 1.264189859175687 }, { - "x": 3.7915340474498773, - "y": 2.2493986724180166, - "heading": 2.4848150038175776, - "angularVelocity": -0.9692240612893903, - "velocityX": -1.833431038112992, - "velocityY": 0.6951894887828133, + "x": 3.924034265973, + "y": 2.199126658591582, + "heading": 2.567804226434134, + "angularVelocity": -1.2296155742086001, + "velocityX": -2.379230876303722, + "velocityY": 0.8999032448061102, "moduleForcesX": [ - 103.58820516720523, - 104.92855177072477, - 110.11774866337021, - 111.54097597186704 + 108.16057441934431, + 108.09863736885157, + 107.77431358980552, + 107.71338177916209 ], "moduleForcesY": [ - -50.72193464209301, - -47.84626346354833, - -34.33041579719783, - -29.320464413930928 + -39.756848729907496, + -39.92967545115846, + -40.79094897344794, + -40.956213851485444 ], - "timestamp": 1.3804922035875071 + "timestamp": 1.3432017253741675 }, { - "x": 3.6924057837846056, - "y": 2.287032791210217, - "heading": 2.428974326530829, - "angularVelocity": -0.6876471387580406, - "velocityX": -1.2207098873360598, - "velocityY": 0.4634434137366357, + "x": 3.783322108255196, + "y": 2.252475144339107, + "heading": 2.487030748526135, + "angularVelocity": -1.0222955334973765, + "velocityX": -1.7808990533691496, + "velocityY": 0.6751958701179381, "moduleForcesX": [ - 101.33099886518957, - 103.65261141150002, - 110.70643780421159, - 112.89020105896144 + 103.30559580568975, + 104.71639898474407, + 110.30262425390252, + 111.80970500266959 ], "moduleForcesY": [ - -55.169911771348715, - -50.63164845334588, - -32.514911041205714, - -23.78302612297838 + -51.28282431794387, + -48.29042179755711, + -33.715070554259036, + -28.25140262149227 ], - "timestamp": 1.4616976273279487 + "timestamp": 1.422213591572648 + }, + { + "x": 3.6896630853349937, + "y": 2.288054717515041, + "heading": 2.4297305576238934, + "angularVelocity": -0.7252099419889863, + "velocityX": -1.185379202219164, + "velocityY": 0.45030670566059755, + "moduleForcesX": [ + 100.76683441661493, + 103.22725405324366, + 110.9081905642704, + 113.21054868518621 + ], + "moduleForcesY": [ + -56.18800584688867, + -51.48157539975731, + -31.812049876456324, + -22.18877488158011 + ], + "timestamp": 1.5012254577711284 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -0.3599432148672905, - "velocityX": -0.6097006638724116, - "velocityY": 0.23169454365301467, + "angularVelocity": -0.3795072034311282, + "velocityX": -0.5919149181654807, + "velocityY": 0.22519310259260125, "moduleForcesX": [ - 99.95294038557154, - 102.93131489378752, - 110.96142635507852, - 113.53712518846511 + 99.2333325232405, + 102.38974249930051, + 111.1591753938583, + 113.85285218516327 ], "moduleForcesY": [ - -57.66959867695029, - -52.12981175149356, - -31.706597373135576, - -20.595444632987434 + -58.89587684714718, + -53.17708736580895, + -31.00181733914535, + -18.756970960294648 ], - "timestamp": 1.5429030510683903 + "timestamp": 1.5802373239696093 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -8.79545003714153e-24, - "velocityX": 4.316544263240465e-24, - "velocityY": -5.434912078864282e-24, + "angularVelocity": -2.40180265717108e-22, + "velocityX": -4.286083557700099e-21, + "velocityY": -4.01439908756407e-21, "moduleForcesX": [ - 99.09462528312669, - 102.27730985577772, - 111.18836910911212, - 113.90720400078715 + 98.28908180907341, + 101.63548974867733, + 111.386618425042, + 114.21009011513806 ], "moduleForcesY": [ - -59.15782976040057, - -53.43303751633107, - -30.94741332746105, - -18.52517210548361 + -60.484600758107796, + -54.63738777077898, + -30.223370855342147, + -16.543544482929317 ], - "timestamp": 1.6241084748088315 + "timestamp": 1.6592491901680897 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.3.traj b/src/main/deploy/choreo/Blue Source 4 Piece.3.traj index bea6e2b..65a8bb6 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.3.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.3.traj @@ -4,589 +4,589 @@ "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -8.79545003714153e-24, - "velocityX": 4.316544263240465e-24, - "velocityY": -5.434912078864282e-24, + "angularVelocity": -2.40180265717108e-22, + "velocityX": -4.286083557700099e-21, + "velocityY": -4.01439908756407e-21, "moduleForcesX": [ - 99.09462528312669, - 102.27730985577772, - 111.18836910911212, - 113.90720400078715 + 98.28908180907341, + 101.63548974867733, + 111.386618425042, + 114.21009011513806 ], "moduleForcesY": [ - -59.15782976040057, - -53.43303751633107, - -30.94741332746105, - -18.52517210548361 + -60.484600758107796, + -54.63738777077898, + -30.223370855342147, + -16.543544482929317 ], "timestamp": 0 }, { - "x": 3.6616731557377156, - "y": 2.2989594406099587, - "heading": 2.4410880866235765, - "angularVelocity": 0.7787767050645694, - "velocityX": 0.3537267099935761, - "velocityY": -0.12975255335628544, + "x": 3.662000323031767, + "y": 2.29858470070828, + "heading": 2.4486274500127516, + "angularVelocity": 0.8951923925432088, + "velocityX": 0.34988280879900624, + "velocityY": -0.1330074564480108, "moduleForcesX": [ - 82.3066869172237, - 72.94619674814246, - 115.0598645177216, - 108.15778531261908 + 80.10356434853756, + 63.35936817512299, + 115.2316867824649, + 105.25411125517041 ], "moduleForcesY": [ - -80.865849592635, - -89.24912908119805, - -8.857475561829947, - 40.14347495933029 + -83.05086248624924, + -96.27483320533042, + -6.26802981925732, + 47.23912873712468 ], - "timestamp": 0.05308723426070472 + "timestamp": 0.054605540859038015 }, { - "x": 3.6997800232665217, - "y": 2.285572424541842, - "heading": 2.5213675068235353, - "angularVelocity": 1.5122170389535854, - "velocityX": 0.7178160260085905, - "velocityY": -0.2521701545492991, + "x": 3.7010345624145904, + "y": 2.284649401499804, + "heading": 2.5430898851953367, + "angularVelocity": 1.7299056780050255, + "velocityX": 0.7148402665507606, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - 86.98787858056687, - 77.9377516249161, - 115.19177113993021, - 109.44062121610627 + 85.95725612054815, + 71.53272845126975, + 115.3379810170131, + 106.80144207930023 ], "moduleForcesY": [ - -75.788435232065, - -84.91967760133532, - -6.703058984175722, - 36.43023788237517 + -76.95483823713558, + -90.36459624820597, + -3.342055562829985, + 43.55724850599804 ], - "timestamp": 0.10617446852140944 + "timestamp": 0.10921108171807603 }, { - "x": 3.757822755958072, - "y": 2.266103908321777, - "heading": 2.6373918445703044, - "angularVelocity": 2.1855412014306013, - "velocityX": 1.0933463289217327, - "velocityY": -0.36672688813391646, + "x": 3.7609128945257986, + "y": 2.2646755465629314, + "heading": 2.6785263195998334, + "angularVelocity": 2.4802690766147815, + "velocityX": 1.0965614692066081, + "velocityY": -0.3657843988476258, "moduleForcesX": [ - 92.33620304947925, - 83.00336971918547, - 115.29369779681878, - 111.16605663240459 + 92.6408907817173, + 79.8109340460071, + 115.36188623484176, + 109.25337437613233 ], "moduleForcesY": [ - -69.1441009465064, - -79.96612718536689, - -4.100219448058572, - 30.640263168121162 + -68.72829018973381, + -83.13387654195829, + -0.01588573486371081, + 36.84729749065968 ], - "timestamp": 0.15926170278211416 + "timestamp": 0.16381662257711405 }, { - "x": 3.8365376380625946, - "y": 2.240892161139712, - "heading": 2.7835277232467326, - "angularVelocity": 2.75274989762646, - "velocityX": 1.4827459595646495, - "velocityY": -0.4749116719521142, + "x": 3.8427641734312834, + "y": 2.239145023664725, + "heading": 2.8462122994823584, + "angularVelocity": 3.070860158960799, + "velocityX": 1.4989555568505595, + "velocityY": -0.46754454761490494, "moduleForcesX": [ - 98.13983385768609, - 89.6537987560601, - 115.30493503306579, - 113.54027185482593 + 99.85169207378267, + 90.33198646116189, + 115.31328266124063, + 113.07409659910392 ], "moduleForcesY": [ - -60.57623674894674, - -72.40887140224785, - -2.6215553765170494, - 19.854158299778444 + -57.683472950501404, + -71.52890617387136, + 1.148298109984689, + 22.21299020856557 ], - "timestamp": 0.21234893704281887 + "timestamp": 0.21842216343615206 }, { - "x": 3.936752649120614, - "y": 2.2100571586229654, - "heading": 2.9498502589606272, - "angularVelocity": 3.1330043470922764, - "velocityX": 1.8877421748112806, - "velocityY": -0.5808364844421804, + "x": 3.9477930443039067, + "y": 2.2082229653738414, + "heading": 3.029985195135523, + "angularVelocity": 3.3654624194194365, + "velocityX": 1.9234105041419012, + "velocityY": -0.5662805972512616, "moduleForcesX": [ - 104.20314131415655, - 98.79018954476513, - 115.13565568271744, - 115.19744688183164 + 107.44888382024823, + 103.975334938706, + 115.03616740781044, + 115.0584177361961 ], "moduleForcesY": [ - -49.313671267244956, - -59.28296150266422, - -5.743342962263197, - 1.0055309166363822 + -41.650556611005165, + -49.54196790951779, + -6.70703170713735, + -4.805861192354321 ], - "timestamp": 0.2654361713035236 + "timestamp": 0.2730277042951901 }, { - "x": 4.059100997611248, - "y": 2.173622833296401, - "heading": 3.1200647667331736, - "angularVelocity": 3.2063171145183946, - "velocityX": 2.304666087703798, - "velocityY": -0.686310481869143, + "x": 4.076161986406392, + "y": 2.1725870949498374, + "heading": 3.1988525982358644, + "angularVelocity": 3.0924957512327635, + "velocityX": 2.3508409601484432, + "velocityY": -0.6526053924820007, "moduleForcesX": [ - 110.54551793687573, - 109.90169912281651, - 112.97822127254379, - 112.66305677296599 + 114.85560912614943, + 115.06107533407756, + 105.27999779546317, + 109.41725119475669 ], "moduleForcesY": [ - -32.324872357465075, - -34.3824182667869, - -22.35582603859909, - -23.788977760078865 + -5.214634192772637, + -2.4841907717448946, + -46.33549153296675, + -35.76089164102011 ], - "timestamp": 0.3185234055642283 + "timestamp": 0.3276332451542281 }, { - "x": 4.2024312304797915, - "y": 2.132928127562045, - "heading": 3.261251480451447, - "angularVelocity": 2.6595228718249397, - "velocityX": 2.699900171191161, - "velocityY": -0.766562928000904, + "x": 4.2246947832316, + "y": 2.134500210018156, + "heading": 3.318391686056822, + "angularVelocity": 2.1891384269875385, + "velocityX": 2.720104855451194, + "velocityY": -0.6974912130254503, "moduleForcesX": [ - 113.57345993390184, - 114.04991592545962, - 89.38373476732211, - 105.87431225446016 + 99.09147098340235, + 109.45603084784327, + 71.24101923486774, + 104.32045073180943 ], "moduleForcesY": [ - 16.388126000917513, - 15.248423187591555, - -72.30427165301604, - -45.19852750676215 + 56.72721933126937, + 35.13049278248973, + -90.04553565784443, + -48.50248817218731 ], - "timestamp": 0.37161063982493303 + "timestamp": 0.3822387860132661 }, { - "x": 4.364807109525649, - "y": 2.0894373328590015, - "heading": 3.3570269479832517, - "angularVelocity": 1.8041148472994926, - "velocityX": 3.0586614900382436, - "velocityY": -0.8192326330180512, + "x": 4.393347194762179, + "y": 2.093252415972482, + "heading": 3.3910237215163614, + "angularVelocity": 1.3301220776667309, + "velocityX": 3.088558576243185, + "velocityY": -0.7553774469912, "moduleForcesX": [ - 101.90531447708315, - 109.62064454997088, - 68.59046833424642, - 103.74089498833104 + 102.8702924113868, + 109.18925395485235, + 67.57717450786018, + 103.62950593233244 ], "moduleForcesY": [ - 50.944118168520156, - 34.455539676082644, - -92.07044431884987, - -49.68325972504405 + 46.811129640319855, + 34.90205221921152, + -92.47525829145376, + -49.45128884065186 ], - "timestamp": 0.42469787408563775 + "timestamp": 0.4368443268723041 }, { - "x": 4.546172796843396, - "y": 2.042600207999433, - "heading": 3.409334723238229, - "angularVelocity": 0.985317392842509, - "velocityX": 3.416370994711852, - "velocityY": -0.8822671874288422, + "x": 4.581769294393391, + "y": 2.047917121127897, + "heading": 3.41840428762759, + "angularVelocity": 0.5014246847570052, + "velocityX": 3.450604035176878, + "velocityY": -0.8302325026249093, "moduleForcesX": [ - 104.44398071027045, - 109.28660232154968, - 65.84867153585355, - 103.15267730358437 + 103.51069866239682, + 108.8300334396521, + 62.58815342260189, + 101.67145570587108 ], "moduleForcesY": [ - 42.21513175186775, - 34.370980784960636, - -93.67244040685424, - -50.35760769522869 + 36.02257862078937, + 32.94109351617987, + -94.87769053752216, + -51.95034586329381 ], - "timestamp": 0.47778510834634247 + "timestamp": 0.49144986773134214 }, { - "x": 4.746163412022853, - "y": 1.9916718961789543, - "heading": 3.419257741737168, - "angularVelocity": 0.18691910846604462, - "velocityX": 3.7672072761848523, - "velocityY": -0.9593325500887032, + "x": 4.779931030558261, + "y": 1.9924964021643286, + "heading": 3.41891011940239, + "angularVelocity": 0.009263378163504843, + "velocityX": 3.628967556175626, + "velocityY": -1.0149284869576565, "moduleForcesX": [ - 103.69547133936663, - 108.88611511085561, - 61.605286218644885, - 101.19104160044986 + 24.817065640960916, + 68.62335338934336, + 29.726644848301333, + 62.36699327831083 ], "moduleForcesY": [ - 33.35515323370187, - 32.17777064720978, - -95.34817206799453, - -52.64097605577242 + -40.262984429708354, + -16.137970502976035, + -76.60001892131636, + -59.12012311674933 ], - "timestamp": 0.5308723426070472 + "timestamp": 0.5460554085903802 }, { - "x": 4.948548056720655, - "y": 1.9334264581702532, - "heading": 3.419700898757884, - "angularVelocity": 0.00834771347363082, - "velocityX": 3.8123034193854215, - "velocityY": -1.0971646728225626, + "x": 4.977773623848627, + "y": 1.9359085884076386, + "heading": 3.419390968552955, + "angularVelocity": 0.00880586737170981, + "velocityX": 3.6231230416907465, + "velocityY": -1.0363016804973941, "moduleForcesX": [ - 2.812586615495257, - 17.25271454920937, - 7.564782178529809, - 20.62061668455904 + -1.5405489498138385, + -1.510675380723342, + -1.5290615087928063, + -1.4991886990742376 ], "moduleForcesY": [ - -31.60789016315328, - -27.37914757437569, - -46.16688797563849, - -42.31980344027108 + -5.542359638354407, + -5.533911414001032, + -5.5823054708698105, + -5.5738580554539885 ], - "timestamp": 0.5839595768677519 + "timestamp": 0.6006609494494182 }, { - "x": 5.150726101198334, - "y": 1.8744592854650957, - "heading": 3.4201379344296425, - "angularVelocity": 0.008232406111274728, - "velocityX": 3.8084117075078177, - "velocityY": -1.1107599317677133, + "x": 5.175588208613072, + "y": 1.879222681311638, + "heading": 3.4198714630845712, + "angularVelocity": 0.008799373178195607, + "velocityX": 3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - -1.0463397310112488, - -1.0386065335580354, - -1.043365533090219, - -1.0356323686011837 + -0.13367893133837125, + -0.13325583842743188, + -0.13351671673397217, + -0.1330936238433616 ], "moduleForcesY": [ - -3.632488642177522, - -3.6302851430130465, - -3.6428507946426043, - -3.6406473318268646 + -0.4669309252934178, + -0.46681005875097636, + -0.4674986887694729, + -0.467377822245837 ], - "timestamp": 0.6370468111284566 + "timestamp": 0.6552664903084562 }, { - "x": 5.352939271336686, - "y": 1.8156128822911926, - "heading": 3.420575141677368, - "angularVelocity": 0.008235638074089262, - "velocityX": 3.8090733667778998, - "velocityY": -1.1084850057344409, + "x": 5.373420765486743, + "y": 1.8225996642524482, + "heading": 3.4203520212322216, + "angularVelocity": 0.008800538188806615, + "velocityX": 3.622939243187224, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - 0.17713577681591305, - 0.17691923574920496, - 0.17705253096230064, - 0.1768359898999078 + 0.08564191211003895, + 0.08556602339215008, + 0.08561276387479577, + 0.08553687515723264 ], "moduleForcesY": [ - 0.6084010281485345, - 0.608339005673639, - 0.6086916074370062, - 0.6086295849669343 + 0.299464024459614, + 0.29944230488278817, + 0.2995658636364578, + 0.299544144060668 ], - "timestamp": 0.6901340453891613 + "timestamp": 0.7098720311674942 }, { - "x": 5.555686581701234, - "y": 1.758638103797458, - "heading": 3.4210165739729597, - "angularVelocity": 0.008315224963949961, - "velocityX": 3.8191349236406045, - "velocityY": -1.0732293608278416, + "x": 5.5714815297149025, + "y": 1.7667822918576632, + "heading": 3.4208346701386514, + "angularVelocity": 0.008838826588608227, + "velocityX": 3.6271184409553947, + "velocityY": -1.0221924646598644, "moduleForcesX": [ - 2.6950741764387947, - 2.6897109379860757, - 2.692979528513537, - 2.687616330679195 + 1.0885317610039127, + 1.0860355533928958, + 1.0875689835908162, + 1.0850727795645088 ], "moduleForcesY": [ - 9.427648428799428, - 9.426146941870284, - 9.434773571052796, - 9.433272128119771 + 3.8354425637576255, + 3.8347296996098477, + 3.8387867944504532, + 3.8380739343659793 ], - "timestamp": 0.7432212796498661 + "timestamp": 0.7644775720265322 }, { - "x": 5.761511331352785, - "y": 1.7140924382303229, - "heading": 3.4214952082673102, - "angularVelocity": 0.009015996049068666, - "velocityX": 3.877104402176408, - "velocityY": -0.8391031513975044, + "x": 5.771617683669556, + "y": 1.7189715185814523, + "heading": 3.4213444792775793, + "angularVelocity": 0.009336216268676605, + "velocityX": 3.665125384826737, + "velocityY": -0.8755663349188748, "moduleForcesX": [ - 15.553365313685392, - 15.492703910893727, - 15.519558726536253, - 15.458920515444706 + 9.90983117572121, + 9.8740945473826, + 9.893348215058872, + 9.85761782165404 ], "moduleForcesY": [ - 62.60222625959512, - 62.59915932231855, - 62.65272108090147, - 62.64965481461626 + 38.11330911683303, + 38.106672803056995, + 38.15370784735131, + 38.147075598526285 ], - "timestamp": 0.7963085139105708 + "timestamp": 0.8190831128855702 }, { - "x": 5.970718661187601, - "y": 1.6902969703482533, - "heading": 3.42208259465482, - "angularVelocity": 0.011064550558905548, - "velocityX": 3.9408217954513325, - "velocityY": -0.4482333316746726, + "x": 5.975591068141504, + "y": 1.6921473086815817, + "heading": 3.4219745074492076, + "angularVelocity": 0.011537806634941703, + "velocityX": 3.7353972007803753, + "velocityY": -0.4912360445090396, "moduleForcesX": [ - 17.268411937350706, - 16.98946609878052, - 17.097483761569833, - 16.819178445964624 + 18.49602168404423, + 18.223496328433463, + 18.32464726681692, + 18.05270477943307 ], "moduleForcesY": [ - 104.50562642972609, - 104.53971564488901, - 104.56645125313041, - 104.60007764054373 + 99.88968062550072, + 99.92208309280707, + 99.96866077815221, + 100.00063874310942 ], - "timestamp": 0.8493957481712755 + "timestamp": 0.8736886537446082 }, { "x": 6.181192436218261, "y": 1.6887441873550415, "heading": 3.422910026358796, - "angularVelocity": 0.015586265050321107, - "velocityX": 3.9646777226526373, - "velocityY": -0.02924964946537556, + "angularVelocity": 0.017132307360596073, + "velocityX": 3.7652107248147186, + "velocityY": -0.06232190493864833, "moduleForcesX": [ - 6.920274693383353, - 6.185721571576322, - 6.573955564662514, - 5.844740651408007 + 8.398980799856114, + 7.52927101550806, + 7.973097440144859, + 7.110732370059712 ], "moduleForcesY": [ - 112.03161900342096, - 112.06720187117624, - 112.08016014025495, - 112.11336799839647 + 111.47999858137477, + 111.53171815583704, + 111.54866670440515, + 111.59688033555022 ], - "timestamp": 0.9024829824319802 + "timestamp": 0.9282941946036463 }, { - "x": 6.465968895774687, - "y": 1.7288019189642057, - "heading": 3.422924487082232, - "angularVelocity": 0.00019962394982911663, - "velocityX": 3.9312142249265274, - "velocityY": 0.5529794301309958, + "x": 6.456062631790769, + "y": 1.727703498460738, + "heading": 3.422924495572841, + "angularVelocity": 0.00019656089199281753, + "velocityX": 3.734047381979395, + "velocityY": 0.5292531383220516, "moduleForcesX": [ - -7.872028825010754, - -5.868356427204452, - -7.274148654405582, - -5.224526232357825 + -7.435057509899166, + -5.273262788820908, + -6.776645494666261, + -4.561459737278193 ], "moduleForcesY": [ - 114.06618405796583, - 114.19123917565138, - 114.07858878844016, - 114.19557828660732 + 114.0531263361637, + 114.17857048927304, + 114.06354518890139, + 114.17906174500054 ], - "timestamp": 0.9749228046504577 + "timestamp": 1.0019060606177304 }, { - "x": 6.742077877622993, - "y": 1.8092440058536328, - "heading": 3.4229355818017693, - "angularVelocity": 0.00015315774111255494, - "velocityX": 3.8115634935652754, - "velocityY": 1.110467756903315, + "x": 6.7217978144093875, + "y": 1.808082946654349, + "heading": 3.42293562945149, + "angularVelocity": 0.00015125113996228022, + "velocityX": 3.609950365444831, + "velocityY": 1.0919360226275563, "moduleForcesX": [ - -23.458196144337897, - -23.45209662796528, - -23.457565603079534, - -23.451465640201203 + -23.942282612665448, + -23.936485990546096, + -23.941716534513144, + -23.93591950874849 ], "moduleForcesY": [ - 109.28244000142513, - 109.28376366394924, - 109.28229674147879, - 109.2836204695592 + 108.54454153578949, + 108.54583486390915, + 108.54435575416598, + 108.54564914640099 ], - "timestamp": 1.047362626868935 + "timestamp": 1.0755179266318144 }, { - "x": 7.009582372988793, - "y": 1.914830245749957, - "heading": 3.422947466162008, - "angularVelocity": 0.00016405838494088897, - "velocityX": 3.6927823284686, - "velocityY": 1.4575717700946087, + "x": 6.980422996045719, + "y": 1.9090269564051716, + "heading": 3.4229468108149086, + "angularVelocity": 0.0001518962094530346, + "velocityX": 3.513362663389737, + "velocityY": 1.371300786363831, "moduleForcesX": [ - -23.28390223274763, - -23.28472907960402, - -23.284015169836888, - -23.284842009273003 + -18.632354987403158, + -18.632396331688668, + -18.63236369292651, + -18.632405037196442 ], "moduleForcesY": [ - 68.04180366771824, - 68.04154028777829, - 68.04230771680372, - 68.0420443393723 + 53.89122312286404, + 53.8912102638437, + 53.89125746714164, + 53.891244608126165 ], - "timestamp": 1.1198024490874126 + "timestamp": 1.1491297926458985 }, { - "x": 7.246754939031006, - "y": 2.0101276114817614, - "heading": 3.4430257322940507, - "angularVelocity": 0.2771716649370985, - "velocityX": 3.2740633366949092, - "velocityY": 1.3155383712067839, + "x": 7.22592193699581, + "y": 2.005996792188081, + "heading": 3.442580254906685, + "angularVelocity": 0.2667157505288677, + "velocityX": 3.3350457506826596, + "velocityY": 1.3173125615964607, "moduleForcesX": [ - -75.11544611300371, - -81.01560658870949, - -83.80155867415714, - -88.38909893685336 + -25.84642277568509, + -37.283285847412664, + -31.7140815077526, + -42.75006123891945 ], "moduleForcesY": [ - -40.252101440111836, - -39.65492799695394, - -14.151996507909777, - -17.310769456098647 + -18.150014214403896, + -21.015362736520334, + 0.8264239519393268, + -3.3197301936858925 ], - "timestamp": 1.19224227130589 + "timestamp": 1.2227416586599826 }, { - "x": 7.4444707246169886, - "y": 2.0895893588177756, - "heading": 3.460038359656544, - "angularVelocity": 0.234851865196239, - "velocityX": 2.729379773871829, - "velocityY": 1.0969345989883763, + "x": 7.430580643705318, + "y": 2.086840876505934, + "heading": 3.459576924522074, + "angularVelocity": 0.23089578536342303, + "velocityX": 2.7802407110607725, + "velocityY": 1.0982479958107094, "moduleForcesX": [ - -107.64208344195724, - -107.57930657167886, - -105.9946310345107, - -105.87575754009714 + -107.73855282640099, + -107.68858293139232, + -106.38126830053612, + -106.2932325280658 ], "moduleForcesY": [ - -40.69712755938141, - -40.83034886509647, - -44.8154800993999, - -45.06642730066164 + -40.462053452478244, + -40.56825627605823, + -43.908556302844424, + -44.096907679115205 ], - "timestamp": 1.2646820935243674 + "timestamp": 1.2963535246740667 }, { - "x": 7.602668988189531, - "y": 2.153175677565822, - "heading": 3.4737553313586, - "angularVelocity": 0.1893567830783131, - "velocityX": 2.1838577004705892, - "velocityY": 0.8777812645132035, + "x": 7.594334409844189, + "y": 2.151528839125374, + "heading": 3.4734104153440932, + "angularVelocity": 0.1879247405489274, + "velocityX": 2.2245566510641077, + "velocityY": 0.878770857500916, "moduleForcesX": [ - -107.86118930596339, - -107.81855559484973, - -106.08769609512694, - -105.98182204499227 + -108.03895547091055, + -108.00459288569081, + -106.41201988616295, + -106.3243427538483 ], "moduleForcesY": [ - -40.665271439336365, - -40.760587867167544, - -45.090936163588374, - -45.32350556529579 + -40.20672149366401, + -40.28289239333363, + -44.33454527838811, + -44.52996596613114 ], - "timestamp": 1.337121915742845 + "timestamp": 1.3699653906881508 }, { - "x": 7.721329395383598, - "y": 2.2008731582030556, - "heading": 3.4840930136480566, - "angularVelocity": 0.14270717366310565, - "velocityX": 1.6380549200713095, - "velocityY": 0.6584428174516908, + "x": 7.717161916361577, + "y": 2.2000505965479666, + "heading": 3.4838947388725474, + "angularVelocity": 0.14242708541647775, + "velocityX": 1.6685829767430076, + "velocityY": 0.659156737220999, "moduleForcesX": [ - -107.93229359869254, - -107.9046739344928, - -106.11256348212791, - -106.01983716415766 + -108.13673727352719, + -108.11666519143746, + -106.4142454273333, + -106.33573686070703 ], "moduleForcesY": [ - -40.66091896254582, - -40.722104405422826, - -45.19805154468384, - -45.40437473586649 + -40.12609997700318, + -40.168809305270365, + -44.49388432552946, + -44.671030285269225 ], - "timestamp": 1.4095617379613223 + "timestamp": 1.443577256702235 }, { - "x": 7.800441770095721, - "y": 2.232675064823596, - "heading": 3.4910081314465584, - "angularVelocity": 0.09546017075588673, - "velocityX": 1.0921116630231624, - "velocityY": 0.4390113841614085, + "x": 7.799052561632761, + "y": 2.2324011072432888, + "heading": 3.490935144512255, + "angularVelocity": 0.09564226558745835, + "velocityX": 1.1124652818272118, + "velocityY": 0.43947412892824594, "moduleForcesX": [ - -107.96697591893106, - -107.94946633207202, - -106.12319819766431, - -106.03987686308871 + -108.18447910649813, + -108.17448806116079, + -106.4131822395508, + -106.34236528854645 ], "moduleForcesY": [ - -40.66122527870853, - -40.69852018667486, - -45.25595136469539, - -45.442664241769286 + -40.08848562489677, + -40.10668496598445, + -44.57832391748555, + -44.739176472038416 ], - "timestamp": 1.4820015601797998 + "timestamp": 1.517189122716319 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 0.047850528600588006, - "velocityX": 0.5460840279946026, - "velocityY": 0.21952416540924652, + "angularVelocity": 0.048080165750899, + "velocityX": 0.5562613826336666, + "velocityY": 0.21975056429240558, "moduleForcesX": [ - -107.98827537545758, - -107.9760433148081, - -106.1299618840012, - -106.05139834798729 + -108.21348472478886, + -108.20892496086536, + -106.41277222504723, + -106.34585019162039 ], "moduleForcesY": [ - -40.660146907176276, - -40.685223309784156, - -45.289831908193264, - -45.466900880102635 + -40.0647979154683, + -40.06999069497862, + -44.62830082076768, + -44.78118450203363 ], - "timestamp": 1.5544413823982772 + "timestamp": 1.590800988730403 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 9.96657849481802e-27, - "velocityX": -3.894219970851099e-27, - "velocityY": 3.742285984085537e-25, + "angularVelocity": -7.217019249839112e-23, + "velocityX": -2.800882773502241e-22, + "velocityY": -6.277947352339611e-22, "moduleForcesX": [ - -108.00400169154827, - -107.99223491780998, - -106.13622374630016, - -106.05743685003775 + -108.23430457634592, + -108.23038445425982, + -106.41417815468228, + -106.34652059702091 ], "moduleForcesY": [ - -40.65537952997924, - -40.680427924066414, - -45.308334241937345, - -45.48693154917803 + -40.04492733440483, + -40.0495210669214, + -44.65756272827853, + -44.813096423270885 ], - "timestamp": 1.6268812046167547 + "timestamp": 1.6644128547444872 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.4.traj b/src/main/deploy/choreo/Blue Source 4 Piece.4.traj index f341658..2b99dce 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.4.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.4.traj @@ -4,589 +4,589 @@ "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 9.96657849481802e-27, - "velocityX": -3.894219970851099e-27, - "velocityY": 3.742285984085537e-25, + "angularVelocity": -7.217019249839112e-23, + "velocityX": -2.800882773502241e-22, + "velocityY": -6.277947352339611e-22, "moduleForcesX": [ - -108.00400169154827, - -107.99223491780998, - -106.13622374630016, - -106.05743685003775 + -108.23430457634592, + -108.23038445425982, + -106.41417815468228, + -106.34652059702091 ], "moduleForcesY": [ - -40.65537952997924, - -40.680427924066414, - -45.308334241937345, - -45.48693154917803 + -40.04492733440483, + -40.0495210669214, + -44.65756272827853, + -44.813096423270885 ], "timestamp": 0 }, { - "x": 7.806073186138322, - "y": 2.235358433045618, - "heading": 3.4918613466756465, - "angularVelocity": -0.03903296429686534, - "velocityX": -0.5067850635723453, - "velocityY": -0.19745894526536698, + "x": 7.804839503996671, + "y": 2.2353073040625637, + "heading": 3.4910960657051917, + "angularVelocity": -0.049669524785278085, + "velocityX": -0.5169403325880029, + "velocityY": -0.19510035456649585, "moduleForcesX": [ - -108.31646484929273, - -108.31232931165214, - -106.70790819705411, - -106.65379169981476 + -108.91169498268742, + -108.92708748634632, + -106.9592142409582, + -106.900126446355 ], "moduleForcesY": [ - -39.785622400235304, - -39.79042134746788, - -43.91797659035705, - -44.043414234869665 + -38.12247627099087, + -38.06986059379512, + -43.29915093821448, + -43.43729059553137 ], - "timestamp": 0.066945173211157 + "timestamp": 0.06801654617913311 }, { - "x": 7.738222310236991, - "y": 2.208924184045344, - "heading": 3.4866679317973803, - "angularVelocity": -0.07757713706835251, - "velocityX": -1.0135290215370247, - "velocityY": -0.3948641512494979, + "x": 7.734523027865804, + "y": 2.20876912539207, + "heading": 3.4843646424620003, + "angularVelocity": -0.0989674369154671, + "velocityX": -1.0338142713932752, + "velocityY": -0.3901723942377354, "moduleForcesX": [ - -108.3005337940833, - -108.28996331730454, - -106.71250484198275, - -106.65261534540024 + -108.89535610590072, + -108.90060339205658, + -106.95804032881327, + -106.88867772089174 ], "moduleForcesY": [ - -39.79230383732628, - -39.813620832555635, - -43.87361916590637, - -44.01229472070399 + -38.122799476396125, + -38.09756002614687, + -43.26132213447986, + -43.42345092393562 ], - "timestamp": 0.133890346422314 + "timestamp": 0.13603309235826622 }, { - "x": 7.636451231880714, - "y": 2.1692796518761055, - "heading": 3.478939983461497, - "angularVelocity": -0.11543697573994834, - "velocityX": -1.520215326581841, - "velocityY": -0.5921940338281333, + "x": 7.629057338850315, + "y": 2.1689657018270334, + "heading": 3.4743178967030715, + "angularVelocity": -0.14771031937536128, + "velocityX": -1.5505887161298457, + "velocityY": -0.5852020692172022, "moduleForcesX": [ - -108.27833136732967, - -108.25850057581364, - -106.7190574300644, - -106.65081131519337 + -108.87073710864843, + -108.86109478467073, + -106.95606713413832, + -106.8716907825758 ], "moduleForcesY": [ - -39.80130085429092, - -39.846439015801195, - -43.811116584954355, - -43.969072663952105 + -38.12366762772549, + -38.138546420957574, + -43.20515744662121, + -43.40238220899802 ], - "timestamp": 0.20083551963347102 + "timestamp": 0.20404963853739932 }, { - "x": 7.500765760992354, - "y": 2.1164324000873393, - "heading": 3.468746003766396, - "angularVelocity": -0.15227355769096984, - "velocityX": -2.0268148453419133, - "velocityY": -0.7894109351554932, + "x": 7.4884537084291525, + "y": 2.1159017878510578, + "heading": 3.4610179809667345, + "angularVelocity": -0.19553941626658541, + "velocityX": -2.067197444146294, + "velocityY": -0.7801618423291158, "moduleForcesX": [ - -108.24396960661254, - -108.21238741016384, - -106.72757461099188, - -106.64913374630179 + -108.8272916619506, + -108.79813451721276, + -106.94957215478411, + -106.8462010419442 ], "moduleForcesY": [ - -39.81751467144124, - -39.892602068069195, - -43.72029844384378, - -43.90165305191429 + -38.13223147648961, + -38.19884241523941, + -43.11962308400627, + -43.36068150975459 ], - "timestamp": 0.267780692844628 + "timestamp": 0.27206618471653243 }, { - "x": 7.331175634844102, - "y": 2.0503950328281664, - "heading": 3.456199114656939, - "angularVelocity": -0.18742036964907863, - "velocityX": -2.53326891265683, - "velocityY": -0.9864395607862418, + "x": 7.312734633849349, + "y": 2.049586749721688, + "heading": 3.4445854242099734, + "angularVelocity": -0.24159645968325458, + "velocityX": -2.583475410777514, + "velocityY": -0.9749839098668387, "moduleForcesX": [ - -108.183855436982, - -108.13878069799289, - -106.73793532144539, - -106.64908314006512 + -108.73406931364026, + -108.68110503738541, + -106.92705418988612, + -106.8027512014663 ], "moduleForcesY": [ - -39.8518780520238, - -39.96046705876725, - -43.57763984939865, - -43.78233752560017 + -38.1683694994336, + -38.295224115541835, + -42.972793664038555, + -43.259992948110714 ], - "timestamp": 0.334725866055785 + "timestamp": 0.34008273089566554 }, { - "x": 7.12770050187281, - "y": 1.971192793059601, - "heading": 3.441520842474186, - "angularVelocity": -0.21925811046084745, - "velocityX": -3.0394294795458086, - "velocityY": -1.1830911172452596, + "x": 7.101966942274532, + "y": 1.9700480655932946, + "heading": 3.4253557769380705, + "angularVelocity": -0.28272013726275863, + "velocityX": -3.0987708640736242, + "velocityY": -1.1694019852009814, "moduleForcesX": [ - -108.05776232379694, - -107.9996841375153, - -106.74909898164714, - -106.65408367462611 + -108.4418328543596, + -108.3626740241462, + -106.82910549783024, + -106.6908681014183 ], "moduleForcesY": [ - -39.935162352718365, - -40.07355997651351, - -43.31352925259889, - -43.53014008693061 + -38.32060078212658, + -38.50231437653497, + -42.61405148852435, + -42.92203871274227 ], - "timestamp": 0.40167103926694203 + "timestamp": 0.40809927707479865 }, { - "x": 6.890400374818258, - "y": 1.8789019078745433, - "heading": 3.4253383104250084, - "angularVelocity": -0.24172813771256388, - "velocityX": -3.5446936003297003, - "velocityY": -1.3786040241311397, + "x": 6.861923440131751, + "y": 1.879644856366164, + "heading": 3.4253408600655706, + "angularVelocity": -0.00021931240760809082, + "velocityX": -3.5291927571650676, + "velocityY": -1.3291355457691012, "moduleForcesX": [ - -107.67012594458991, - -107.61137555141406, - -106.74805702593524, - -106.67046549630615 + -82.29673746119303, + -87.67092010469727, + -93.06437688109203, + -96.4143304414556 ], "moduleForcesY": [ - -40.20094963502285, - -40.332102839966765, - -42.591758575557066, - -42.761473825206814 + -48.18808428690188, + -45.81494056023967, + -18.475969737183824, + -20.9148885300259 ], - "timestamp": 0.46861621247809904 + "timestamp": 0.47611582325393176 }, { - "x": 6.63970170536198, - "y": 1.790758792782665, - "heading": 3.4253261856713713, - "angularVelocity": -0.0001811146802023973, - "velocityX": -3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 6.620578526901708, + "y": 1.7927653335156666, + "heading": 3.4253282976312676, + "angularVelocity": -0.00018469673937319495, + "velocityX": -3.5483264997669806, + "velocityY": -1.2773292342966776, "moduleForcesX": [ - -35.13969892694759, - -46.833559794249325, - -38.37727275192584, - -49.463406566005396 + -3.99339422319668, + -3.9952241861108564, + -3.9940931809806606, + -3.9959231756424614 ], "moduleForcesY": [ - 6.193009340047558, - 1.5254319217031, - 25.2151393395331, - 19.635508817953465 + 10.814957408993067, + 10.814421040029472, + 10.817367033783066, + 10.816830640829638 ], - "timestamp": 0.535561385689256 + "timestamp": 0.5441323694330649 }, { - "x": 6.380206858974069, - "y": 1.7334916000286844, - "heading": 3.425314102432994, - "angularVelocity": -0.00018049454199152838, - "velocityX": -3.8762293671183365, - "velocityY": -0.855434230834672, + "x": 6.37089300513868, + "y": 1.734019661048189, + "heading": 3.42531523506019, + "angularVelocity": -0.0001920499027328796, + "velocityX": -3.6709526694495414, + "velocityY": -0.863696788025089, "moduleForcesX": [ - -27.870780083632145, - -27.87085530338658, - -27.870784334164817, - -27.87085955385131 + -25.601760187553467, + -25.60101320769075, + -25.601692373604028, + -25.60094538718925 ], "moduleForcesY": [ - 97.83083198961785, - 97.83081049698788, - 97.83084453922437, - 97.83082304661343 + 86.35637664311925, + 86.35659720719453, + 86.35613139442144, + 86.35635196045367 ], - "timestamp": 0.602506558900413 + "timestamp": 0.612148915612198 }, { "x": 6.11539939880371, "y": 1.7113943099975586, "heading": 3.4252974360856103, - "angularVelocity": -0.00024895517606207744, - "velocityX": -3.9555870493471943, - "velocityY": -0.3300804071628426, + "angularVelocity": -0.0002616859511262737, + "velocityX": -3.756344899696669, + "velocityY": -0.3326448095591715, "moduleForcesX": [ - -16.83891510224018, - -16.829101110309182, - -16.83709390658153, - -16.82727878028723 + -17.83355423810439, + -17.823774151167132, + -17.8318555128472, + -17.822074295255884 ], "moduleForcesY": [ - 111.43563757699793, - 111.43715289160197, - 111.43558589017643, - 111.43710122782548 + 110.86994540179053, + 110.87155302236657, + 110.8698433501265, + 110.87145101626253 ], - "timestamp": 0.66945173211157 + "timestamp": 0.6801654617913311 }, { - "x": 5.890352759731499, - "y": 1.7185557092564774, - "heading": 3.4246409084154172, - "angularVelocity": -0.011565209036453538, - "velocityX": -3.9643590696733866, - "velocityY": 0.12615321970899335, + "x": 5.89558522537437, + "y": 1.7193809732535483, + "heading": 3.4243945816435364, + "angularVelocity": -0.015459837026566448, + "velocityX": -3.7639414937610223, + "velocityY": 0.1367579385665902, "moduleForcesX": [ - -3.4491974421125313, - -1.6124094350280327, - -2.7948238151606937, - -0.9207370674714969 + -3.4838005876379103, + -1.0971386415787967, + -2.628739965754029, + -0.17889110374308226 ], "moduleForcesY": [ - 114.11007946252991, - 114.15637546330666, - 114.09921998413924, - 114.13567048098221 + 114.12110918273105, + 114.1762136610545, + 114.10669848112909, + 114.14468636650177 ], - "timestamp": 0.726219203250543 + "timestamp": 0.7385654591860025 }, { - "x": 5.66751347319984, - "y": 1.7511786253728163, - "heading": 3.4241561999672547, - "angularVelocity": -0.008538489357326316, - "velocityX": -3.925474960583039, - "velocityY": 0.5746762267509569, + "x": 5.678306514433747, + "y": 1.7542341672793909, + "heading": 3.4237856933580315, + "angularVelocity": -0.01042616973747129, + "velocityX": -3.7205260382502785, + "velocityY": 0.596801294190177, "moduleForcesX": [ - 10.066815271135868, - 9.617734238949494, - 9.834772017122992, - 9.387604811781081 + 11.105143341598554, + 10.385540743401508, + 10.725324626777631, + 10.010565773367157 ], "moduleForcesY": [ - 112.16146590109982, - 112.19647225066659, - 112.19714365211975, - 112.23111915488865 + 111.7997329387048, + 111.86098322186378, + 111.86317871279545, + 111.92171623690527 ], - "timestamp": 0.782986674389516 + "timestamp": 0.7969654565806739 }, { - "x": 5.449395923621346, - "y": 1.8073745478916146, - "heading": 3.423755208658891, - "angularVelocity": -0.0070637514815886995, - "velocityX": -3.8422981542460732, - "velocityY": 0.989931758299116, + "x": 5.466218716119367, + "y": 1.8130618187216272, + "heading": 3.4232962295807683, + "angularVelocity": -0.008381229436627441, + "velocityX": -3.631640544109531, + "velocityY": 1.0073228436069053, "moduleForcesX": [ - 20.95690176428424, - 20.776539685058307, - 20.836146342062943, - 20.656026809805113 + 21.80574823449787, + 21.575934691647497, + 21.64961202366041, + 21.42017480511521 ], "moduleForcesY": [ - 103.83805579833934, - 103.86595800234623, - 103.88375203666156, - 103.91143822729342 + 99.76654159220674, + 99.80080758549977, + 99.83931034438031, + 99.87324161618062 ], - "timestamp": 0.8397541455284889 + "timestamp": 0.8553654539753452 }, { - "x": 5.234668489636406, - "y": 1.8754073625880365, - "heading": 3.423378777118868, - "angularVelocity": -0.006631113425878504, - "velocityX": -3.7825788198185224, - "velocityY": 1.198447162281897, + "x": 5.256412364228166, + "y": 1.879591648117002, + "heading": 3.422829130798028, + "angularVelocity": -0.007998267184563366, + "velocityX": -3.5925746789561237, + "velocityY": 1.139209458277213, "moduleForcesX": [ - 14.963264037670479, - 14.931138360423935, - 14.946047731779307, - 14.91392768517457 + 9.51707651150292, + 9.492184048188738, + 9.505860938347789, + 9.48097102985699 ], "moduleForcesY": [ - 52.14527104247343, - 52.14197332650841, - 52.17690623845456, - 52.17361050090606 + 32.05649277460031, + 32.05124416889293, + 32.08628241846569, + 32.081035971532025 ], - "timestamp": 0.8965216166674619 + "timestamp": 0.9137654513700166 }, { - "x": 5.020347307549028, - "y": 1.9447110026462533, - "heading": 3.4230043454794967, - "angularVelocity": -0.006595883731627919, - "velocityX": -3.77542239925918, - "velocityY": 1.2208336687846049, + "x": 5.046797341362997, + "y": 1.9467231127720641, + "heading": 3.4223633386981755, + "angularVelocity": -0.007975892476580843, + "velocityX": -3.589298496857378, + "velocityY": 1.149511432361598, "moduleForcesX": [ - 1.791691136022014, - 1.789481049225279, - 1.7908289271509987, - 1.7886188443613316 + 0.7975621457668832, + 0.796199616592488, + 0.7970342417583864, + 0.7956717132450739 ], "moduleForcesY": [ - 5.598749349977525, - 5.598116183228942, - 5.601705282144552, - 5.6010721201319225 + 2.5042491658536608, + 2.5038569339270924, + 2.506076405059156, + 2.5056841739899895 ], - "timestamp": 0.9532890878064348 + "timestamp": 0.972165448764688 }, { - "x": 4.8060405689194825, - "y": 2.0140593339308377, - "heading": 3.4226299265716884, - "angularVelocity": -0.006595659455954859, - "velocityX": -3.7751679673187892, - "velocityY": 1.2216209370118332, + "x": 4.83718667234252, + "y": 2.013868189318054, + "heading": 3.4218974960600224, + "angularVelocity": -0.007976757858485664, + "velocityX": -3.5892239447188996, + "velocityY": 1.1497445126961008, "moduleForcesX": [ - 0.06365505243475648, - 0.06364100877132398, - 0.06364961193025265, - 0.06363556826682583 + 0.018091134855906132, + 0.01814381941382445, + 0.018111488649072027, + 0.018164173207109984 ], "moduleForcesY": [ - 0.19692515330903454, - 0.19692109926184684, - 0.19694399939103238, - 0.1969399453438515 + 0.05670219309874917, + 0.05671736020610039, + 0.056631492064510326, + 0.05664665917205125 ], - "timestamp": 1.0100565589454078 + "timestamp": 1.0305654461593594 }, { - "x": 4.591500986434119, - "y": 2.082663911446821, - "heading": 3.4222414623759345, - "angularVelocity": -0.006843077346227929, - "velocityX": -3.7792696799923613, - "velocityY": 1.2085191772596529, + "x": 4.627444883786628, + "y": 2.0806013070151304, + "heading": 3.4214303705469638, + "angularVelocity": -0.007998724895503174, + "velocityX": -3.5914691423433216, + "velocityY": 1.1426904225027372, "moduleForcesX": [ - -1.036787029486011, - -1.0212819494693623, - -1.0307777743363744, - -1.0152728109135725 + -0.5468558718662196, + -0.5455180884885984, + -0.5463396795091894, + -0.5450018966009532 ], "moduleForcesY": [ - -3.2691983489948386, - -3.264742509836368, - -3.2899813633807438, - -3.285525660593021 + -1.714525278299725, + -1.7141411533773045, + -1.7163199744295032, + -1.7159358500537125 ], - "timestamp": 1.0668240300843808 + "timestamp": 1.0889654435540308 }, { - "x": 4.38796292724594, - "y": 2.1423225294075587, - "heading": 3.392610747831683, - "angularVelocity": -0.5219664351739753, - "velocityX": -3.5854699021186707, - "velocityY": 1.0509296391711191, + "x": 4.416417909538516, + "y": 2.1416951287760204, + "heading": 3.420047169772428, + "angularVelocity": -0.02368494582607703, + "velocityX": -3.6134757476438963, + "velocityY": 1.0461271316163543, "moduleForcesX": [ - 30.062890973818472, - 67.96426240208197, - 32.537435642261514, - 63.348910831469794 + -6.0529764567849105, + -5.056830451597798, + -5.643439292990528, + -4.650734177456534 ], "moduleForcesY": [ - -27.016971831599164, - -8.235178803765258, - -69.73669104087492, - -52.69317016977578 + -22.9799246770692, + -22.73239458103274, + -24.22567299694829, + -23.981026840246923 ], - "timestamp": 1.1235915012233537 + "timestamp": 1.1473654409487022 }, { - "x": 4.205851179698999, - "y": 2.197165482111936, - "heading": 3.3127396856742903, - "angularVelocity": -1.406986440559581, - "velocityX": -3.208029949072623, - "velocityY": 0.9660982179409718, + "x": 4.227154500888805, + "y": 2.196008775433373, + "heading": 3.3675654380202875, + "angularVelocity": -0.8986598303672014, + "velocityX": -3.240811936525528, + "velocityY": 0.9300282376777734, "moduleForcesX": [ - 104.51767942702163, - 110.90141886725938, - 62.29725541431908, - 99.94508162050462 + 103.48471382580142, + 110.09390991333008, + 52.428343365864905, + 96.4518852319005 ], "moduleForcesY": [ - 39.31182600807883, - 26.855999637561276, - -95.37547475461713, - -55.6735513157081 + 22.285822454061403, + 24.891189153478663, + -100.03845095304497, + -60.05822336141424 ], - "timestamp": 1.1803589723623267 + "timestamp": 1.2057654383433736 }, { - "x": 4.045155999455634, - "y": 2.247628220403907, - "heading": 3.1785027166359323, - "angularVelocity": -2.3646811518119346, - "velocityX": -2.8307616495715378, - "velocityY": 0.8889375777975367, + "x": 4.060470218367385, + "y": 2.2449867624612265, + "heading": 3.260092297576448, + "angularVelocity": -1.840293582849461, + "velocityX": -2.85418304721754, + "velocityY": 0.8386641988501563, "moduleForcesX": [ - 101.86899395570421, - 112.18575793402451, - 64.1327587652835, - 99.30217040259392 + 104.84618511277098, + 111.9090944895469, + 60.51536896101153, + 98.77086477361023 ], "moduleForcesY": [ - 51.1125109928503, - 24.489794047684235, - -94.97028505916239, - -57.83793809446354 + 42.12552095732997, + 24.43643622108832, + -97.04975471639123, + -58.374344881869824 ], - "timestamp": 1.2371264435012996 + "timestamp": 1.264165435738045 }, { - "x": 3.9062696172726583, - "y": 2.2936459171983983, - "heading": 2.9909056327184347, - "angularVelocity": -3.3046581105971597, - "velocityX": -2.4465839220310834, - "velocityY": 0.8106349617342454, + "x": 3.9161905386019207, + "y": 2.2894941451617035, + "heading": 3.0920455097304274, + "angularVelocity": -2.8775136188850934, + "velocityX": -2.470542571952716, + "velocityY": 0.762112751473137, "moduleForcesX": [ - 101.72159587923049, - 113.52781849420327, - 70.87580416849237, - 98.27794501691677 + 98.88615121430338, + 112.5392336152905, + 63.49372991199003, + 98.21581874489458 ], "moduleForcesY": [ - 53.03473995293723, - 18.795877029064727, - -90.29587475253834, - -59.88330637545011 + 57.43559858001414, + 23.427197480933113, + -95.49784743209882, + -59.82012493838729 ], - "timestamp": 1.2938939146402726 + "timestamp": 1.3225654331327164 }, { - "x": 3.792626772488035, - "y": 2.33297655165956, - "heading": 2.8069419778508737, - "angularVelocity": -3.2406526339212274, - "velocityX": -2.001900780579305, - "velocityY": 0.6928375295224226, + "x": 3.7974323632374913, + "y": 2.329195026608959, + "heading": 2.8883508135329774, + "angularVelocity": -3.4879230356958066, + "velocityX": -2.0335304907952847, + "velocityY": 0.6798096441503758, "moduleForcesX": [ - 110.09590584370159, - 110.15119273382382, - 112.27667812755305, - 112.42030542510648 + 111.51397335746604, + 114.89005050626218, + 95.50645628303386, + 103.13454077524403 ], "moduleForcesY": [ - -33.78436386293684, - -33.54304188428511, - -25.62844767832441, - -24.91070248135434 + 27.766723898869564, + 7.125263794319992, + -63.839976213971326, + -51.101345312959225 ], - "timestamp": 1.3506613857792455 + "timestamp": 1.3809654305273877 }, { - "x": 3.7033158802608868, - "y": 2.3652177680520627, - "heading": 2.646863089051661, - "angularVelocity": -2.819905230714294, - "velocityX": -1.5732758644207585, - "velocityY": 0.5679523104626665, + "x": 3.705201564787477, + "y": 2.36242075004535, + "heading": 2.7010475242691676, + "angularVelocity": -3.2072482469134465, + "velocityX": -1.5792945644622496, + "velocityY": 0.5689336458673064, "moduleForcesX": [ - 99.97859392638921, - 99.19069955359782, - 114.54734457522899, - 115.15979579307127 + 105.95228683396371, + 106.34982483559641, + 114.4004939951579, + 115.09460575424761 ], "moduleForcesY": [ - -57.39726866081913, - -58.57964610086177, - -13.118869737078962, - 4.137282620864764 + -45.29021140358274, + -44.17247603120534, + -13.870897843783036, + -4.506204608148711 ], - "timestamp": 1.4074288569182185 + "timestamp": 1.4393654279220591 }, { - "x": 3.637351288782728, - "y": 2.3899438580710273, - "heading": 2.5203397651129293, - "angularVelocity": -2.2287997228023126, - "velocityX": -1.1620139166789638, - "velocityY": 0.4355679321777759, + "x": 3.6378462140543926, + "y": 2.3883393111775315, + "heading": 2.5495404830125357, + "angularVelocity": -2.594298767390968, + "velocityX": -1.1533450982521831, + "velocityY": 0.443810998089987, "moduleForcesX": [ - 92.24578923617231, - 90.92322148643724, - 114.71711750544789, - 113.61714858975364 + 93.92589046885861, + 92.38930111082504, + 114.99151586069087, + 112.97863519241554 ], "moduleForcesY": [ - -69.22716039877031, - -70.7835079678775, - -12.071174524868779, - 19.61978127154983 + -66.89886987254614, + -68.8039200125939, + -8.89032055915772, + 22.896798750871643 ], - "timestamp": 1.4641963280571915 + "timestamp": 1.4977654253167305 }, { - "x": 3.5939780893678623, - "y": 2.4067236714663482, - "heading": 2.432378164371663, - "angularVelocity": -1.5495071204762023, - "velocityX": -0.764050230609765, - "velocityY": 0.29558853087258563, + "x": 3.5940010146710293, + "y": 2.4061455217676833, + "heading": 2.442794052924954, + "angularVelocity": -1.8278499118104665, + "velocityX": -0.7507739955372641, + "velocityY": 0.3049008798719044, "moduleForcesX": [ - 86.41137299899842, - 85.10523672353465, - 114.61890071891574, - 112.0617012655451 + 85.27321950996415, + 81.25618436721727, + 114.93039749975732, + 110.08736666214386 ], "moduleForcesY": [ - -76.42757490922749, - -77.71146885299508, - -13.222540301247415, - 27.30004265325952 + -77.68627318980846, + -81.68368062704864, + -10.1185634426013, + 34.38228873619394 ], - "timestamp": 1.5209637991961644 + "timestamp": 1.556165422711402 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": -0.808382599061801, - "velocityX": -0.37681858196384876, - "velocityY": 0.1495853557192894, + "angularVelocity": -0.9641391597034187, + "velocityX": -0.3666774697730115, + "velocityY": 0.15530363813167142, "moduleForcesX": [ - 82.24535135891628, - 79.8120626088092, - 114.54956911255539, - 110.85189362912443 + 79.3416840765363, + 71.24184841573963, + 114.8417411977197, + 108.15322189105376 ], "moduleForcesY": [ - -80.92027537570917, - -83.1630963954796, - -13.95497542675499, - 31.949497180856433 + -83.76752129096906, + -90.57520191146979, + -11.302736000119857, + 40.14476142563526 ], - "timestamp": 1.5777312703351374 + "timestamp": 1.6145654201060733 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": 1.3320780406337021e-20, - "velocityX": -7.91420075044239e-20, - "velocityY": -8.454931019375793e-20, + "angularVelocity": -9.0989818312144e-21, + "velocityX": 3.9183156510716546e-20, + "velocityY": 8.026400730264575e-20, "moduleForcesX": [ - 79.74797430779523, - 73.04670295538676, - 114.65423863578631, - 109.59078372653275 + 76.01822070188068, + 59.44757680524343, + 114.93156102990737, + 106.23908134928891 ], "moduleForcesY": [ - -83.4021017998724, - -89.19074412625787, - -13.169435415720322, - 36.089148730291996 + -86.8169640545679, + -98.75016323489919, + -10.497822934908383, + 45.01411898852261 ], - "timestamp": 1.6344987414741103 + "timestamp": 1.6729654175007447 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.5.traj b/src/main/deploy/choreo/Blue Source 4 Piece.5.traj index d94b4be..7718e45 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.5.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.5.traj @@ -4,631 +4,631 @@ "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": 1.3320780406337021e-20, - "velocityX": -7.91420075044239e-20, - "velocityY": -8.454931019375793e-20, + "angularVelocity": -9.0989818312144e-21, + "velocityX": 3.9183156510716546e-20, + "velocityY": 8.026400730264575e-20, "moduleForcesX": [ - 79.74797430779523, - 73.04670295538676, - 114.65423863578631, - 109.59078372653275 + 76.01822070188068, + 59.44757680524343, + 114.93156102990737, + 106.23908134928891 ], "moduleForcesY": [ - -83.4021017998724, - -89.19074412625787, - -13.169435415720322, - 36.089148730291996 + -86.8169640545679, + -98.75016323489919, + -10.497822934908383, + 45.01411898852261 ], "timestamp": 0 }, { - "x": 3.5699516392525266, - "y": 2.4137790529276644, - "heading": 2.3478802631089017, - "angularVelocity": -1.127940834097408, - "velocityX": -0.07699398909111405, - "velocityY": -0.04195884012456622, + "x": 3.570016562928905, + "y": 2.414002895867037, + "heading": 2.3443806141589976, + "angularVelocity": -1.1925305688726726, + "velocityX": -0.07279868109514546, + "velocityY": -0.034335132017282326, "moduleForcesX": [ - -63.3144545947333, - 108.01660145288706, - -111.8751367506926, - -60.59422206639 + -56.92485396981133, + 111.21616724439636, + -112.20973399379473, + -59.18934120988699 ], "moduleForcesY": [ - 96.33566340014389, - -39.61846623202172, - -28.183152137146912, - -98.16238982815337 + 100.25021857445346, + -29.64734387785221, + -26.8203043673127, + -99.01585760311711 ], - "timestamp": 0.034228803705087074 + "timestamp": 0.035309547151467946 }, { - "x": 3.564378233003473, - "y": 2.4106424063814575, - "heading": 2.2718151756419913, - "angularVelocity": -2.222253752198952, - "velocityX": -0.16282795908031492, - "velocityY": -0.09163763283184874, + "x": 3.5646173348355323, + "y": 2.4113128910817276, + "heading": 2.26113341401117, + "angularVelocity": -2.3576399830539163, + "velocityX": -0.152911281195873, + "velocityY": -0.07618349716500973, "moduleForcesX": [ - -60.25722824108982, - 96.6501538541861, - -112.89494643133519, - -65.93464425581752 + -52.4117542511686, + 102.02820257962003, + -113.30290747157052, + -65.18685502936177 ], "moduleForcesY": [ - 98.21955261781348, - -62.32975378769388, - -23.68993888315466, - -94.63903361003736 + 102.6213053904586, + -53.1486977357208, + -21.639970807289966, + -95.15210347949885 ], - "timestamp": 0.06845760741017415 + "timestamp": 0.07061909430293589 }, { - "x": 3.5553617379589757, - "y": 2.4056031463027416, - "heading": 2.159987950024481, - "angularVelocity": -3.267050364395044, - "velocityX": -0.2634183514613645, - "velocityY": -0.14722279288698742, + "x": 3.555904326933192, + "y": 2.4069105734197564, + "heading": 2.1383294220214664, + "angularVelocity": -3.4779259972638497, + "velocityX": -0.2467606810408336, + "velocityY": -0.12467782843824318, "moduleForcesX": [ - -55.647722774813495, - 75.73920484802964, - -114.0316025405405, - -72.98400096210639 + -45.66288067392498, + 82.28667122957205, + -114.43740382724414, + -73.15743467730793 ], "moduleForcesY": [ - 100.80472826924587, - -86.50130488193642, - -17.255130186537396, - -89.28875262327956 + 105.688056546013, + -80.31445254430263, + -14.248499805306832, + -89.13561917035238 ], - "timestamp": 0.10268641111526122 + "timestamp": 0.10592864145440384 }, { - "x": 3.542210147208017, - "y": 2.3986325839335767, - "heading": 2.0146174838328887, - "angularVelocity": -4.247021527369034, - "velocityX": -0.38422583693780954, - "velocityY": -0.20364609962244665, + "x": 3.5431228593186614, + "y": 2.400727296021074, + "heading": 1.9783355498230653, + "angularVelocity": -4.531178820053225, + "velocityX": -0.3619833344137748, + "velocityY": -0.17511630415825824, "moduleForcesX": [ - -51.5565732083985, - 47.05283368026791, - -114.89682349470701, - -81.07269190656022 + -39.35983727831561, + 51.41808681441776, + -115.13501591899248, + -82.27641388148437 ], "moduleForcesY": [ - 102.76487920670458, - -104.87988948985232, - -9.544434426513986, - -81.9718721787508 + 107.95631863586092, + -102.77876201791744, + -5.581529823014008, + -80.73399410186649 ], - "timestamp": 0.1369152148203483 + "timestamp": 0.14123818860587178 }, { - "x": 3.5239509110903704, - "y": 2.389814553511627, - "heading": 1.8392865279803854, - "angularVelocity": -5.122322046751736, - "velocityX": -0.5334465170026451, - "velocityY": -0.25762017562547423, + "x": 3.5249509357501743, + "y": 2.3927861943346422, + "heading": 1.7860937401531451, + "angularVelocity": -5.444471118399184, + "velocityX": -0.514646180267788, + "velocityY": -0.2248995619337351, "moduleForcesX": [ - -56.897120992564666, - 13.831328653792013, - -115.20928290206547, - -89.34828449880852 + -49.96209987038422, + 10.940950643937366, + -115.15655922442268, + -91.40372157976795 ], "moduleForcesY": [ - 99.40316122357176, - -114.07904848518908, - -2.1067431308290923, - -72.78432529295594 + 102.6827935808, + -114.29555191993956, + 1.6280187943338387, + -70.09920994331443 ], - "timestamp": 0.17114401852543537 + "timestamp": 0.17654773575733973 }, { - "x": 3.498669227691315, - "y": 2.3782677142113307, - "heading": 1.6450275698811467, - "angularVelocity": -5.675306673670566, - "velocityX": -0.7386084426695263, - "velocityY": -0.3373427654562614, + "x": 3.4986636063204344, + "y": 2.3808215422611085, + "heading": 1.5804277096948873, + "angularVelocity": -5.824657834777944, + "velocityX": -0.7444822024189094, + "velocityY": -0.3388503404538074, "moduleForcesX": [ - -105.17566327178112, - -23.62733870294902, - -115.09802567519542, - -96.55369553063619 + -112.32060939232774, + -44.01860178950653, + -114.80288651764441, + -98.58413579678934 ], "moduleForcesY": [ - 42.375604431971254, - -112.36357969798489, - 0.4252157545061834, - -62.73241252810446 + -13.981211872806785, + -105.7654815086491, + -4.41159995138123, + -59.14888259144925 ], - "timestamp": 0.20537282223052244 + "timestamp": 0.21185728290880768 }, { - "x": 3.4654282510227628, - "y": 2.3622293034748987, - "heading": 1.4432142418231406, - "angularVelocity": -5.896008805823804, - "velocityX": -0.9711404744073245, - "velocityY": -0.468564746661713, + "x": 3.464431329562427, + "y": 2.3636059779555727, + "heading": 1.3846008757527926, + "angularVelocity": -5.546002419743707, + "velocityX": -0.9694906765912646, + "velocityY": -0.48756117521604403, "moduleForcesX": [ - -100.91027402459957, - -71.1255356669369, - -113.08371748677206, - -100.75435384797646 + -99.15399456797527, + -112.77483449910136, + -59.73325270721248, + -90.29830581798875 ], "moduleForcesY": [ - -53.21727890658225, - -89.84770615754992, - -19.528589252979987, - -55.16195289043296 + -57.092373513786754, + -17.758976569181463, + -97.05254853411765, + -67.32011989022973 ], - "timestamp": 0.23960162593560952 + "timestamp": 0.24716683006027562 }, { - "x": 3.4254907189328243, - "y": 2.3409579999268493, - "heading": 1.2552368047325984, - "angularVelocity": -5.491791028110254, - "velocityX": -1.1667814170203163, - "velocityY": -0.6214445509474886, + "x": 3.4235746716849746, + "y": 2.340405903244497, + "heading": 1.2048128445517017, + "angularVelocity": -5.091768252644312, + "velocityX": -1.1570994581774947, + "velocityY": -0.6570482088472442, "moduleForcesX": [ - -101.51984502491118, - -114.25525292589644, - -46.05237264124134, - -62.82771454322337 + -99.77808458384018, + -113.58831274277311, + -42.9977808046872, + -45.43310994172789 ], "moduleForcesY": [ - -53.16497191667841, - -3.066262088111863, - -104.56967598650562, - -92.89456142147945 + -55.91347232549474, + -8.813998457096558, + -105.63471515912464, + -102.28351156220445 ], - "timestamp": 0.2738304296406966 + "timestamp": 0.28247637721174357 }, { - "x": 3.378727497206346, - "y": 2.3144796562214807, - "heading": 1.0811416380559544, - "angularVelocity": -5.086218267417026, - "velocityX": -1.3661950364785587, - "velocityY": -0.7735690657912138, + "x": 3.375651121627886, + "y": 2.3112861636787048, + "heading": 1.0391515004273537, + "angularVelocity": -4.691687022031433, + "velocityX": -1.3572405743836062, + "velocityY": -0.824698754726991, "moduleForcesX": [ - -103.59778354435822, - -113.857000551391, - -55.858639098030196, - -57.60230783383814 + -101.3199117359912, + -112.23361382448618, + -55.56993463789227, + -52.83399612224958 ], "moduleForcesY": [ - -48.73192117995345, - -7.0383536447927435, - -99.65856579041078, - -97.01327027724552 + -52.730238002466315, + -17.94256872974015, + -99.53598557359503, + -99.48263504998475 ], - "timestamp": 0.30805923334578367 + "timestamp": 0.3177859243632115 }, { - "x": 3.3246281814333827, - "y": 2.2831821293897963, - "heading": 0.9193928781957939, - "angularVelocity": -4.7255160084990955, - "velocityX": -1.580520202782186, - "velocityY": -0.9143622751583245, + "x": 3.3201483223528383, + "y": 2.2766875060838894, + "heading": 0.8863627179565744, + "angularVelocity": -4.327123817684768, + "velocityX": -1.5718921298242126, + "velocityY": -0.9798669307882836, "moduleForcesX": [ - -106.32220430919398, - -113.45047145453957, - -68.54608055150727, - -67.34185140885786 + -104.49259355735687, + -111.99240207753651, + -66.73912886868585, + -62.075582497913004 ], "moduleForcesY": [ - -42.05389338701554, - -9.493241665913557, - -91.27582657149124, - -90.81548257020026 + -45.65536628701796, + -17.664987423299614, + -92.24565830688351, + -94.04562308108589 ], - "timestamp": 0.34228803705087074 + "timestamp": 0.35309547151467946 }, { - "x": 3.2626525500968637, - "y": 2.2478394917560407, - "heading": 0.7691200400273281, - "angularVelocity": -4.390245112368141, - "velocityX": -1.8106280275084217, - "velocityY": -1.0325408371953264, + "x": 3.2564602958964812, + "y": 2.237542281220726, + "heading": 0.7461015385201132, + "angularVelocity": -3.9723301699333993, + "velocityX": -1.8037055582489439, + "velocityY": -1.108630045444232, "moduleForcesX": [ - -109.86203798468615, - -113.56537677119788, - -80.19548638705977, - -78.22814414337074 + -108.91840198905898, + -112.87425186361108, + -77.98189938274184, + -73.13263930631419 ], "moduleForcesY": [ - -31.018267527500402, - -2.651547534152617, - -80.99523654285528, - -81.44565214035984 + -32.979908594379154, + -6.223365306851065, + -82.63610290053708, + -85.29569693218967 ], - "timestamp": 0.3765168407559578 + "timestamp": 0.3884050186661474 }, { - "x": 3.1922610767987623, - "y": 2.2097982307128565, - "heading": 0.6301855969917186, - "angularVelocity": -4.058992076750915, - "velocityX": -2.056498202642201, - "velocityY": -1.1113815537007243, + "x": 3.1839722741315835, + "y": 2.195492918557526, + "heading": 0.6188659770305921, + "angularVelocity": -3.6034322656055986, + "velocityX": -2.052929805470177, + "velocityY": -1.1908779935020866, "moduleForcesX": [ - -113.16894691538705, - -112.19207649662077, - -91.84103538444018, - -90.80572403866798 + -112.86988205346567, + -111.12012886761111, + -90.03734763330685, + -86.88778676806119 ], "moduleForcesY": [ - -13.308928426825096, - 15.928502193313712, - -67.0733667207797, - -66.37795970134016 + -12.348284390719446, + 18.73827221812754, + -68.72148386204621, + -69.97685042740027 ], - "timestamp": 0.4107456444610449 + "timestamp": 0.42371456581761535 }, { - "x": 3.1131298064145425, - "y": 2.171263792990809, - "heading": 0.5028079946614243, - "angularVelocity": -3.7213571186352805, - "velocityX": -2.3118327787911217, - "velocityY": -1.1257897896174542, + "x": 3.1023875492734194, + "y": 2.153210765788329, + "heading": 0.5052130558756492, + "angularVelocity": -3.2187589568171084, + "velocityX": -2.3105570997041225, + "velocityY": -1.1974708309852726, "moduleForcesX": [ - -112.95185304826352, - -102.63355880151158, - -103.39609116937459, - -104.73192313748356 + -111.86974536596428, + -97.20248405702162, + -102.32583288761865, + -103.03466347126516 ], "moduleForcesY": [ - 13.428590930971126, - 47.503243007308896, - -46.479255255102, - -38.36223908729842 + 18.095398070095523, + 56.63338441320622, + -47.363739496310544, + -37.97062581903604 ], - "timestamp": 0.44497444816613196 + "timestamp": 0.4590241129690833 }, { - "x": 3.02578800710757, - "y": 2.1355999035659368, - "heading": 0.3862879845211218, - "angularVelocity": -3.404150818247454, - "velocityX": -2.551704700506004, - "velocityY": -1.041926259889298, + "x": 3.01257887441982, + "y": 2.114825451689115, + "heading": 0.4034135111362285, + "angularVelocity": -2.8830600489643863, + "velocityX": -2.5434671951001233, + "velocityY": -1.087108648960283, "moduleForcesX": [ - -102.96113998905054, - -75.57886955728041, - -111.88275135917057, - -107.63125638242771 + -99.43709283642428, + -65.89792156241508, + -111.45218049666224, + -97.88415343386902 ], "moduleForcesY": [ - 48.12217109568619, - 84.19790217808439, - -15.043250131164976, - 21.89000669551637 + 54.220121086403616, + 91.46142231462018, + -11.821171765224456, + 43.674000472763154 ], - "timestamp": 0.47920325187121904 + "timestamp": 0.49433366012055124 }, { - "x": 2.9316171268882734, - "y": 2.1040278827992327, - "heading": 0.28432561299758846, - "angularVelocity": -2.97884706699173, - "velocityX": -2.7512173966310405, - "velocityY": -0.922381659572107, + "x": 2.9158909866984235, + "y": 2.0821667981242555, + "heading": 0.3132429551119237, + "angularVelocity": -2.553716014467678, + "velocityX": -2.738293054471397, + "velocityY": -0.9249241692269979, "moduleForcesX": [ - -91.61131397646075, - -43.05897579116841, - -110.38138714948137, - -86.02846628911873 + -87.45802427935932, + -47.53439495990343, + -109.56743396568875, + -68.84720326443009 ], "moduleForcesY": [ - 66.29758480169242, - 103.90780630948875, - -16.716151028622146, - 44.888327667528124 + 70.39136956871182, + 101.06114313793599, + 11.616666431402345, + 77.82924862847288 ], - "timestamp": 0.5134320555763061 + "timestamp": 0.5296432072720192 }, { - "x": 2.8306074922176707, - "y": 2.075651949037232, - "heading": 0.19841183467951823, - "angularVelocity": -2.5099848378663183, - "velocityX": -2.951012706750948, - "velocityY": -0.8290074641980628, + "x": 2.813130962272225, + "y": 2.055368279752934, + "heading": 0.23418363443483467, + "angularVelocity": -2.2390352483974785, + "velocityX": -2.9102617483421525, + "velocityY": -0.7589595600407787, "moduleForcesX": [ - -89.70386834247377, - -44.52299290536978, - -107.42487523747174, - -89.89738881434096 + -78.40481006980207, + -40.22780438179953, + -100.43252391685763, + -57.57268745634338 ], "moduleForcesY": [ - 64.70732173234461, - 99.54624373858115, - -14.542075390297216, - 5.237756642149965 + 73.82616586327488, + 98.43131065637236, + 23.180882849082177, + 71.54098213655774 ], - "timestamp": 0.5476608592813932 + "timestamp": 0.5649527544234871 }, { - "x": 2.7231266517941735, - "y": 2.0493588330157047, - "heading": 0.12883121858131338, - "angularVelocity": -2.0328088792616628, - "velocityX": -3.1400700225912583, - "velocityY": -0.768157609248157, + "x": 2.706553457092742, + "y": 2.0337946936747824, + "heading": 0.1627246194647116, + "angularVelocity": -2.023787353136663, + "velocityX": -3.018376438595981, + "velocityY": -0.6109845018860041, "moduleForcesX": [ - -87.9046551599776, - -51.259757063971065, - -98.52235017226083, - -76.04326290186813 + -53.32161734417227, + -27.711335290285316, + -62.288742887942306, + -30.59724389816153 ], "moduleForcesY": [ - 54.18397152509916, - 83.80305982182196, - -17.328081982863527, - -19.68202367373811 + 67.01241376252486, + 77.76542044514504, + 39.181093379247706, + 54.08148222744581 ], - "timestamp": 0.5818896629864803 + "timestamp": 0.6002623015749542 }, { - "x": 2.6102927983385573, - "y": 2.024099226519776, - "heading": 0.07355180792033715, - "angularVelocity": -1.6149968645489394, - "velocityX": -3.2964591584264182, - "velocityY": -0.7379634623966059, + "x": 2.598917102909892, + "y": 2.0145528118758143, + "heading": 0.09531658576945162, + "angularVelocity": -1.9090597057532068, + "velocityX": -3.0483640506948286, + "velocityY": -0.5449484162573617, "moduleForcesX": [ - -78.04506650685977, - -47.29571711822892, - -81.43393391647491, - -52.744292996762205 + -18.63096055061113, + -6.33841193513332, + -18.206732192882292, + -5.0635349091313255 ], "moduleForcesY": [ - 39.432934911244786, - 57.97282153083376, - -20.57597862315234, - -26.724282490767077 + 33.453819907756156, + 35.18716748764008, + 17.975782973252848, + 19.612327167077936 ], - "timestamp": 0.6161184666915673 + "timestamp": 0.6355718487264213 }, { - "x": 2.4921154225710165, - "y": 2.001809725638736, - "heading": 0.03059095186954446, - "angularVelocity": -1.2551083123132423, - "velocityX": -3.4525710213465097, - "velocityY": -0.6511913496333991, + "x": 2.486855159750872, + "y": 1.9975368200862922, + "heading": 0.03970689745149529, + "angularVelocity": -1.5749193293079313, + "velocityX": -3.1737009449118583, + "velocityY": -0.48190909151338635, "moduleForcesX": [ - -72.26596436397355, - -40.418509412740924, - -86.20843132854587, - -60.16598656238315 + -61.42943838905159, + -32.38825659624322, + -68.59433110233935, + -39.21145043822103 ], "moduleForcesY": [ - 57.346191538492576, - 74.57460703230042, - 3.6372831123236704, - 8.435378772879556 + 45.459912121097865, + 56.69472636631261, + -1.2312044805624582, + 0.48491739775957093 ], - "timestamp": 0.6503472703966544 + "timestamp": 0.6708813958778883 }, { "x": 2.368211784362792, "y": 1.984554409980774, - "heading": 8.034662982186301e-20, - "angularVelocity": -0.8937195741082333, - "velocityX": -3.619864698625451, - "velocityY": -0.5041168194664591, + "heading": -1.4675807226889294e-19, + "angularVelocity": -1.1245371480173394, + "velocityX": -3.360093373022665, + "velocityY": -0.3676742171129455, "moduleForcesX": [ - -72.02828625966096, - -31.013647911650974, - -100.81064597402042, - -73.76190608413815 + -77.99345741141066, + -36.55913016224614, + -102.6300363207676, + -82.65797442710468 ], "moduleForcesY": [ - 78.69145966069489, - 99.5091808063195, - 20.91580851628405, - 44.94549522070697 + 71.69774957942901, + 95.80128612213636, + 4.935080412204652, + 11.330071286860962 ], - "timestamp": 0.6845760741017415 + "timestamp": 0.7061909430293554 }, { - "x": 2.0740883254919082, - "y": 1.9753101696961048, - "heading": -0.00004639980947503465, - "angularVelocity": -0.0006259678214478826, - "velocityX": -3.967943465052028, - "velocityY": -0.12471165328920732, + "x": 2.0854065230581886, + "y": 1.9779644877217577, + "heading": -0.00005033208333207429, + "angularVelocity": -0.0006710133266615486, + "velocityX": -3.770281033935705, + "velocityY": -0.08785500946361233, "moduleForcesX": [ - -69.66097734031177, - -12.487145015519467, - -111.66054849173405, - -72.91874659974125 + -76.09798989325385, + -18.90105163423638, + -113.03447520897639, + -102.58200087250829 ], "moduleForcesY": [ - 89.98445533687095, - 112.68237698463479, - 15.840843626758858, - 72.2246809246762 + 84.68950673878201, + 111.74911699583157, + 2.6591962220241836, + 12.79589675698398 ], - "timestamp": 0.758700985774853 + "timestamp": 0.781200009663678 }, { - "x": 1.7803191322924656, - "y": 1.9926744865605654, - "heading": -0.00004639408517515487, - "angularVelocity": 7.72250482405318e-8, - "velocityX": -3.9631641585618773, - "velocityY": 0.23425750496730705, + "x": 1.8029757687698704, + "y": 1.9942197501048913, + "heading": -0.00005032500445291454, + "angularVelocity": 9.43736467786952e-8, + "velocityX": -3.7652882106265917, + "velocityY": 0.2167106339607911, "moduleForcesX": [ - 0.8918110984523644, - 0.9389057010061419, - 0.892237576007421, - 0.939354849523593 + 0.9227533462325225, + 0.9672719038047999, + 0.9231321771109395, + 0.9676691170690845 ], "moduleForcesY": [ - 68.78336233513667, - 68.78303298559312, - 68.75324593515143, - 68.7529163377468 + 57.67635291233299, + 57.67606024665079, + 57.64044491345691, + 57.64015211515086 ], - "timestamp": 0.8328258974479645 + "timestamp": 0.8562090762980006 }, { - "x": 1.5131720290302764, - "y": 2.0099691813791325, - "heading": -0.00003333596655810217, - "angularVelocity": 0.0001761636988471363, - "velocityX": -3.604012432963096, - "velocityY": 0.23331825196411896, + "x": 1.5293571956388503, + "y": 2.0110799320442485, + "heading": -0.00003697534828095201, + "angularVelocity": 0.00017797390063582162, + "velocityX": -3.647806664025621, + "velocityY": 0.22477525312446503, "moduleForcesX": [ - 68.8005510890561, - 68.80569709908875, - 68.80053097288106, - 68.80567698548711 + 22.23658027365265, + 22.24494188533207, + 22.23663920902371, + 22.245000823990633 ], "moduleForcesY": [ - -0.17268609942219681, - -0.1726722397415803, - -0.1871959394376103, - -0.18718088491320875 + 1.5328008081498175, + 1.5327560088702128, + 1.5207191865207947, + 1.5206747766653563 ], - "timestamp": 0.9069508091210761 + "timestamp": 0.9312181429323232 }, { - "x": 1.2904630248834932, - "y": 2.02439703559534, - "heading": -0.000022300432809716404, - "angularVelocity": 0.00014887752982495307, - "velocityX": -3.004509538290201, - "velocityY": 0.19464244733035105, + "x": 1.3012535504265574, + "y": 2.025140105667011, + "heading": -0.00002503020492197509, + "angularVelocity": 0.00015924932671420783, + "velocityX": -3.041014312634039, + "velocityY": 0.18744632154013477, "moduleForcesX": [ - 114.84738407657306, - 114.84736831647434, - 114.84756609099593, - 114.84755033754627 + 114.8736602533315, + 114.87365016225685, + 114.87377798798217, + 114.87376789982471 ], "moduleForcesY": [ - -7.410516501125932, - -7.410652114275096, - -7.407685716920552, - -7.40782127867839 + -7.0677703063324575, + -7.067858015952402, + -7.065850186961006, + -7.065937872922886 ], - "timestamp": 0.9810757207941876 + "timestamp": 1.0062272095666458 }, { - "x": 1.1122650673551955, - "y": 2.0359448751096245, - "heading": -0.000013412613719255738, - "angularVelocity": 0.00011990326719923239, - "velocityX": -2.404022527731901, - "velocityY": 0.15578891432912884, + "x": 1.1187395149624608, + "y": 2.0363917821596864, + "heading": -0.000015175728129877333, + "angularVelocity": 0.0001313771419145834, + "velocityX": -2.43322632387727, + "velocityY": 0.1500042194569254, "moduleForcesX": [ - 115.03590480898393, - 115.03589170672048, - 115.03609915116972, - 115.03608605645235 + 115.06211903061896, + 115.06210747733799, + 115.06229497459297, + 115.06228342780778 ], "moduleForcesY": [ - -7.444648447596588, - -7.444793267880781, - -7.44163982701386, - -7.441784589248835 + -7.089643580069927, + -7.089774685050805, + -7.086782838153691, + -7.086913890620375 ], - "timestamp": 1.0552006324672991 + "timestamp": 1.0812362762009684 }, { - "x": 0.9786025548038448, - "y": 2.0446082921325717, - "heading": -0.0000067187424189621245, - "angularVelocity": 0.00009030528535147962, - "velocityX": -1.8032063652338362, - "velocityY": 0.11687591698101128, + "x": 0.9818398208294886, + "y": 2.0448321500588227, + "heading": -0.00000764773394984441, + "angularVelocity": 0.00010036112323237913, + "velocityX": -1.8251086205401545, + "velocityY": 0.11252463572546331, "moduleForcesX": [ - 115.09895807541444, - 115.09894593189205, - 115.09915696612956, - 115.0991448304989 + 115.12452826743665, + 115.1245166883893, + 115.1247243120354, + 115.12471274104529 ], "moduleForcesY": [ - -7.456071244645336, - -7.456219470556505, - -7.452996933892072, - -7.453145099192222 + -7.0968936617396485, + -7.097039766327108, + -7.093709293863361, + -7.09385533338332 ], - "timestamp": 1.1293255441404106 + "timestamp": 1.156245342835291 }, { - "x": 0.8894876979156582, - "y": 2.050385080566063, - "heading": -0.00000224293120630737, - "angularVelocity": 0.000060382010738750023, - "velocityX": -1.202225471528075, - "velocityY": 0.07793315773480675, + "x": 0.8905667965047449, + "y": 2.0504598078795286, + "heading": -0.0000025652413529172724, + "angularVelocity": 0.00006775837675337155, + "velocityX": -1.2168265573775296, + "velocityY": 0.07502636778758441, "moduleForcesX": [ - 115.13051439212589, - 115.13050274279996, - 115.13071565345948, - 115.13070401220862 + 115.15563860808672, + 115.15562710583616, + 115.15584481568848, + 115.15583332234814 ], "moduleForcesY": [ - -7.461789005484244, - -7.461939008917187, - -7.458680439114321, - -7.458830380578413 + -7.100508735512452, + -7.10066242885229, + -7.0971609631741455, + -7.097314584597493 ], - "timestamp": 1.2034504558135222 + "timestamp": 1.2312544094696136 }, { - "x": 0.8449278259277327, - "y": 2.053273916244506, - "heading": 1.1657882349600636e-23, - "angularVelocity": 0.00003025880443808967, - "velocityX": -0.6011457009815157, - "velocityY": 0.0389725345128547, + "x": 0.8449278259277329, + "y": 2.053273916244507, + "heading": -4.943196764260765e-17, + "angularVelocity": 0.00003419908376374945, + "velocityX": -0.6084460535885156, + "velocityY": 0.037516909505028215, "moduleForcesX": [ - 115.14945546462411, - 115.14944411679562, - 115.14965818232656, - 115.14964684268682 + 115.17427159991368, + 115.17426017282052, + 115.1744839399641, + 115.17447252231639 ], "moduleForcesY": [ - -7.465221209099063, - -7.4653723034649175, - -7.462091590233946, - -7.462242621788996 + -7.102674189928534, + -7.102832461784182, + -7.099227889075101, + -7.099386084718906 ], - "timestamp": 1.2775753674866337 + "timestamp": 1.3062634761039362 }, { "x": 0.8449278259277335, "y": 2.053273916244507, - "heading": 1.8876778820126578e-23, - "angularVelocity": 9.40052478351043e-24, - "velocityX": 1.7951476472942267e-21, - "velocityY": 6.283263153886402e-21, + "heading": -4.998402134118911e-17, + "angularVelocity": -7.358356992609877e-18, + "velocityX": 3.54800413086263e-17, + "velocityY": 1.645945977459796e-17, "moduleForcesX": [ - 115.16208523948659, - 115.1620740948824, - 115.16228894450373, - 115.16227780816573 + 115.18667894938693, + 115.1866675847214, + 115.18689539353758, + 115.18688403868421 ], "moduleForcesY": [ - -7.467509839682914, - -7.467661670085734, - -7.464365943620278, - -7.464517710638055 + -7.104116229492631, + -7.104277561224099, + -7.10060401849292, + -7.100765271069628 ], - "timestamp": 1.3517002791597452 + "timestamp": 1.3812725427382588 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.6.traj b/src/main/deploy/choreo/Blue Source 4 Piece.6.traj index 56d69cd..f3271c6 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.6.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.6.traj @@ -3,506 +3,506 @@ { "x": 0.8449278259277335, "y": 2.053273916244507, - "heading": 1.8876778820126578e-23, - "angularVelocity": 9.40052478351043e-24, - "velocityX": 1.7951476472942267e-21, - "velocityY": 6.283263153886402e-21, + "heading": -4.998402134118911e-17, + "angularVelocity": -7.358356992609877e-18, + "velocityX": 3.54800413086263e-17, + "velocityY": 1.645945977459796e-17, "moduleForcesX": [ - 115.16208523948659, - 115.1620740948824, - 115.16228894450373, - 115.16227780816573 + 115.18667894938693, + 115.1866675847214, + 115.18689539353758, + 115.18688403868421 ], "moduleForcesY": [ - -7.467509839682914, - -7.467661670085734, - -7.464365943620278, - -7.464517710638055 + -7.104116229492631, + -7.104277561224099, + -7.10060401849292, + -7.100765271069628 ], "timestamp": 0 }, { - "x": 0.8569672656897795, - "y": 2.065243087486579, - "heading": 0.026477656081364466, - "angularVelocity": 0.5490817512048349, - "velocityX": 0.24966849964948779, - "velocityY": 0.24821130261198687, + "x": 0.8574965729428564, + "y": 2.0646337327234905, + "heading": 0.03107052400011723, + "angularVelocity": 0.6347005774884072, + "velocityX": 0.2567510927355298, + "velocityY": 0.2320553744470217, "moduleForcesX": [ - 16.351962141394313, - 71.19396438514677, - 92.80128040966142, - 113.73960028992643 + 10.01880185007666, + 70.51132465323059, + 102.56695754062756, + 114.81418680623135 ], "moduleForcesY": [ - 114.21971244136823, - 90.82485498148876, - 68.01973967114503, - 19.30605442568154 + 114.950324597259, + 91.35804066457668, + 51.6570361197242, + 11.291141103086447 ], - "timestamp": 0.04822170109144075 + "timestamp": 0.048953041957307875 }, { - "x": 0.8810748266084533, - "y": 2.0892962989602575, - "heading": 0.07923424971643432, - "angularVelocity": 1.0940425667487266, - "velocityX": 0.49993178119037013, - "velocityY": 0.49880470678682487, + "x": 0.8825796369390675, + "y": 2.087613119693452, + "heading": 0.09306766699787188, + "angularVelocity": 1.2664615010405897, + "velocityX": 0.5123903028885677, + "velocityY": 0.4694169360387412, "moduleForcesX": [ - 16.952727334297226, - 69.20082557973143, - 96.11819363500824, - 112.515659702126 + 10.47765662313607, + 67.98037553526417, + 104.41762909212838, + 113.74547934290659 ], "moduleForcesY": [ - 114.11666490770641, - 92.33900074478456, - 63.28910350060908, - 25.431491565283945 + 114.89176486956586, + 93.24160102494326, + 48.08504143345789, + 19.19496564492602 ], - "timestamp": 0.0964434021828815 + "timestamp": 0.09790608391461575 }, { - "x": 0.9172027316907112, - "y": 2.1256086815595694, - "heading": 0.1583120039487254, - "angularVelocity": 1.6398789848234328, - "velocityX": 0.7492042848872142, - "velocityY": 0.7530298968602241, + "x": 0.9200156351341261, + "y": 2.122583149166543, + "heading": 0.18602557591039684, + "angularVelocity": 1.8989199689284813, + "velocityX": 0.7647328275983716, + "velocityY": 0.7143586604314295, "moduleForcesX": [ - 17.450975110192726, - 66.36796972826151, - 99.18005096251873, - 110.62136417389704 + 10.835990162849878, + 64.39521228962572, + 105.82062633961313, + 111.7441294446777 ], "moduleForcesY": [ - 114.0195685641478, - 94.37769509418555, - 58.40834177103907, - 32.64856908645179 + 114.83217133083784, + 95.73186682917266, + 45.08688416711994, + 28.55780146288301 ], - "timestamp": 0.14466510327432225 + "timestamp": 0.14685912587192362 }, { - "x": 0.9652072071826819, - "y": 2.1745030635707607, - "heading": 0.2634944034451186, - "angularVelocity": 2.181225405071049, - "velocityX": 0.9954952729880217, - "velocityY": 1.0139497550796635, + "x": 0.9695320661427651, + "y": 2.1701686644794913, + "heading": 0.30917272793451045, + "angularVelocity": 2.515617969798724, + "velocityX": 1.0115087648976933, + "velocityY": 0.9720645215891337, "moduleForcesX": [ - 18.76552093219475, - 62.90451804858331, - 100.67752020321791, - 107.76084632499483 + 12.632263455497991, + 60.105084170150185, + 105.28692632368393, + 108.31270835051731 ], "moduleForcesY": [ - 113.77796058506851, - 96.69530558377411, - 55.80693345276955, - 41.05968567979955 + 114.60669150952644, + 98.45078742534218, + 46.40569830649411, + 39.5559224830126 ], - "timestamp": 0.192886804365763 + "timestamp": 0.1958121678292315 }, { - "x": 1.024884581648233, - "y": 2.236511376699377, - "heading": 0.3933543401994364, - "angularVelocity": 2.6929770998345655, - "velocityX": 1.2375626142343528, - "velocityY": 1.2859005743292329, + "x": 1.0308267645231524, + "y": 2.231318730759998, + "heading": 0.45926600651888, + "angularVelocity": 3.066066429850625, + "velocityX": 1.2521121452256427, + "velocityY": 1.2491576383652396, "moduleForcesX": [ - 22.65425748350341, - 59.32922192701658, - 99.73769034374716, - 103.41216352884265 + 19.193520071956605, + 56.10759630193776, + 101.40533999072578, + 102.46843648842588 ], "moduleForcesY": [ - 113.01690644978095, - 98.89044870030656, - 57.46401329173098, - 50.96198665871151 + 113.62114180064377, + 100.72951118396574, + 54.37613435033577, + 52.78756994817754 ], - "timestamp": 0.24110850545720375 + "timestamp": 0.24476520978653937 }, { - "x": 1.0960548796882106, - "y": 2.312397535168875, - "heading": 0.5435432001069115, - "angularVelocity": 3.114549186530728, - "velocityX": 1.475897706408573, - "velocityY": 1.5736931039740263, + "x": 1.1037024313475479, + "y": 2.307290579447881, + "heading": 0.6271959399792888, + "angularVelocity": 3.430428973277341, + "velocityX": 1.4886851543970687, + "velocityY": 1.5519331516196186, "moduleForcesX": [ - 32.460220381339624, - 57.02616538718768, - 94.82880396936191, - 96.42189325761602 + 37.36459510931641, + 55.56603305352279, + 90.23982224732244, + 91.32795604337164 ], "moduleForcesY": [ - 110.51663143062805, - 100.16824143861544, - 65.2081472861442, - 63.10043038238427 + 108.87903315382371, + 100.91772809940203, + 71.34020881103348, + 70.17696973203493 ], - "timestamp": 0.2893302065486445 + "timestamp": 0.29371825174384725 }, { - "x": 1.1786024294028, - "y": 2.403062734591481, - "heading": 0.7036429510395898, - "angularVelocity": 3.320076797562315, - "velocityX": 1.7118340466268027, - "velocityY": 1.8801742238557946, + "x": 1.187707501106803, + "y": 2.399089644687687, + "heading": 0.7901423770708541, + "angularVelocity": 3.328627406518933, + "velocityX": 1.7160337008812905, + "velocityY": 1.8752474120592397, "moduleForcesX": [ - 52.9976189734206, - 60.19075395749276, - 81.71816250502049, - 83.00503571063987 + 72.95352245157491, + 71.99046256490783, + 60.63508035638164, + 58.216090033997624 ], "moduleForcesY": [ - 102.13208160331293, - 98.14890485863742, - 80.96099716076793, - 79.76492813288964 + 88.84114045026165, + 89.5505221979616, + 97.67708800823013, + 99.07653571926552 ], - "timestamp": 0.33755190764008525 + "timestamp": 0.3426712937011551 }, { - "x": 1.2717031857076855, - "y": 2.5087575451409125, - "heading": 0.8486594006388647, - "angularVelocity": 3.007286062436618, - "velocityX": 1.9306817096382076, - "velocityY": 2.191851555568453, + "x": 1.2794923725931218, + "y": 2.5054213017641063, + "heading": 0.9137721346902739, + "angularVelocity": 2.525476511290922, + "velocityX": 1.874957465686411, + "velocityY": 2.1721154155194395, "moduleForcesX": [ - 83.21974573343562, - 85.65094183317885, - 49.621826400399556, - 39.29014814005943 + 88.63793057003053, + 103.9640948222794, + 18.832032863293776, + -27.032970661587502 ], "moduleForcesY": [ - 79.26870386093087, - 76.33230295247044, - 103.68667351103069, - 107.83989683014447 + 72.95986689469186, + 46.946807871504056, + 113.3127603108155, + 111.23995258635053 ], - "timestamp": 0.385773608731526 + "timestamp": 0.391624335658463 }, { - "x": 1.3727268361355833, - "y": 2.6272614661882607, - "heading": 0.9491088124473993, - "angularVelocity": 2.0830748301072264, - "velocityX": 2.0949831329328408, - "velocityY": 2.457481141584661, + "x": 1.3793855062107108, + "y": 2.6252569658957277, + "heading": 0.993407142079515, + "angularVelocity": 1.6267632041884466, + "velocityX": 2.0405909341728408, + "velocityY": 2.4479717570665778, "moduleForcesX": [ - 93.77065830212727, - 111.5099038574192, - 19.72183059871037, - -31.4702448610942 + 91.60388970964502, + 109.76906836890673, + 18.87138570722908, + -28.05790918727498 ], "moduleForcesY": [ - 66.15966523066282, - 23.807930537003287, - 113.08653442297255, - 109.83338652042379 + 68.56174974089363, + 28.56360796309666, + 112.87874340003955, + 110.07521153608074 ], - "timestamp": 0.43399530982296675 + "timestamp": 0.44057737761577087 }, { - "x": 1.4822864000255587, - "y": 2.7584095182646564, - "heading": 1.0069014705840629, - "angularVelocity": 1.1984782126842373, - "velocityX": 2.2719970762172372, - "velocityY": 2.7196894574022776, + "x": 1.4883720535567364, + "y": 2.757792536136217, + "heading": 1.0302422866644179, + "angularVelocity": 0.7524587464253547, + "velocityX": 2.226348823035134, + "velocityY": 2.7074021334802443, "moduleForcesX": [ - 94.29329121436436, - 111.33690202203805, - 23.524890313414957, - -20.64874218877574 + 94.42592705513906, + 110.18950347508573, + 25.62143662023805, + -14.69983417505771 ], "moduleForcesY": [ - 64.60956935693747, - 21.14398791701532, - 111.83418988380892, - 111.26982412256342 + 62.64193597383056, + 18.18445445993043, + 110.26196922217056, + 109.93171512187207 ], - "timestamp": 0.4822170109144075 + "timestamp": 0.48953041957307875 }, { - "x": 1.6008769781145331, - "y": 2.9015305147589388, - "heading": 1.0230775694802563, - "angularVelocity": 0.3354526806410118, - "velocityX": 2.4592781964306085, - "velocityY": 2.967979006441265, + "x": 1.6073319975777907, + "y": 2.898457418435302, + "heading": 1.0315234097906527, + "angularVelocity": 0.02617044978244855, + "velocityX": 2.430082774526686, + "velocityY": 2.8734656045848084, "moduleForcesX": [ - 95.44964108875462, - 109.9073464646586, - 27.566804981908373, - -12.323649647427327 + 91.86525254968076, + 92.36401864504138, + 38.39021742136879, + 13.775378324910177 ], "moduleForcesY": [ - 60.09889909493574, - 14.224846797408755, - 109.19219744802835, - 108.94658536069632 + 39.180203480228606, + -7.300594234141006, + 88.73734094363414, + 72.068421433988 ], - "timestamp": 0.5304387120058482 + "timestamp": 0.5384834615303866 }, { - "x": 1.7085853910767748, - "y": 3.042823929898296, - "heading": 1.062138319509375, - "angularVelocity": 0.810024307418135, - "velocityX": 2.233608738895347, - "velocityY": 2.930079444344529, + "x": 1.7162575662900155, + "y": 3.0397405651243345, + "heading": 1.0497080350999417, + "angularVelocity": 0.37147079287016466, + "velocityX": 2.225103167380434, + "velocityY": 2.8860953484648526, "moduleForcesX": [ - -86.9590857830949, - -78.5889566184507, - -55.780064272243294, - -44.49000954099238 + -75.77307716623498, + -66.09588436894305, + -54.266078380096815, + -41.705175729701644 ], "moduleForcesY": [ - -12.094864031659382, - 25.4856045183075, - -50.988845663446746, - -7.044135345915785 + 0.7831305875666112, + 27.97723607278229, + -24.048273245185072, + 9.94234489604884 ], - "timestamp": 0.578660413097289 + "timestamp": 0.5874365034876945 }, { - "x": 1.806206643264022, - "y": 3.1721894754099607, - "heading": 1.1384146361794218, - "angularVelocity": 1.581784029671771, - "velocityX": 2.024425724885398, - "velocityY": 2.682724636079387, + "x": 1.8140080456118037, + "y": 3.170234255344365, + "heading": 1.1079057402275676, + "angularVelocity": 1.1888475731166737, + "velocityX": 1.996821349878699, + "velocityY": 2.6656911400507988, "moduleForcesX": [ - -95.99744403653119, - -111.3725567730494, - -31.38288895815133, - -7.645693964257284 + -101.22591211460183, + -111.27282203858992, + -38.06118753259128, + -14.318118907330136 ], "moduleForcesY": [ - -60.243116496949554, - -13.253824008375362, - -108.5069453108687, - -109.35760318563328 + -49.58576299702025, + 4.478519885777167, + -105.37871989885554, + -105.25159638947153 ], - "timestamp": 0.6268821141887297 + "timestamp": 0.6363895454450024 }, { - "x": 1.894121759346281, - "y": 3.288248837696075, - "heading": 1.2476017343094008, - "angularVelocity": 2.264273048413032, - "velocityX": 1.8231442295150255, - "velocityY": 2.4067869788756653, + "x": 1.9012518038388722, + "y": 3.287882996112528, + "heading": 1.2021912169050675, + "angularVelocity": 1.9260391777026817, + "velocityX": 1.7821927859701392, + "velocityY": 2.4032978556520344, "moduleForcesX": [ - -89.71754326673906, - -109.70942329970309, - -25.64471250802308, - -12.01963364731208 + -94.27122591184543, + -111.9395692297356, + -29.7277424462474, + -13.09747450271598 ], "moduleForcesY": [ - -71.02373862357867, - -30.590752966210808, - -111.31663378024956, - -112.0983625887034 + -64.43873357807499, + -18.973143563435727, + -109.98053661317853, + -111.0655575237677 ], - "timestamp": 0.6751038152801705 + "timestamp": 0.6853425874023102 }, { - "x": 1.9727722110540435, - "y": 3.3902029354711782, - "heading": 1.3865475571211665, - "angularVelocity": 2.8813961280272613, - "velocityX": 1.6310177768017946, - "velocityY": 2.1142783325244228, + "x": 1.9786102964253314, + "y": 3.391445072486045, + "heading": 1.3285417326754196, + "angularVelocity": 2.5810554506610948, + "velocityX": 1.5802591522928626, + "velocityY": 2.115539141830753, "moduleForcesX": [ - -83.56953629253536, - -107.14229823866022, - -19.083654622703264, - -16.5120151625824 + -86.9404428642643, + -108.8981374272585, + -22.521649868470654, + -15.945707139978866 ], "moduleForcesY": [ - -78.71040904165848, - -40.388808530169634, - -113.04273071952846, - -112.4066592111603 + -74.77427758993828, + -34.72614750627809, + -112.25694545994725, + -112.13240268430516 ], - "timestamp": 0.7233255163716112 + "timestamp": 0.7342956293596181 }, { - "x": 2.042803808199141, - "y": 3.477607450988946, - "heading": 1.5541659107318062, - "angularVelocity": 3.4759942062763747, - "velocityX": 1.4522838381893517, - "velocityY": 1.8125556241167515, + "x": 2.0467978535870746, + "y": 3.4801843218746016, + "heading": 1.484784100975893, + "angularVelocity": 3.1916784341355413, + "velocityX": 1.3929176704103385, + "velocityY": 1.8127422902839905, "moduleForcesX": [ - -77.64221219396589, - -106.14720313378757, - -8.338017165682224, - -18.404907081955013 + -80.10960219579854, + -106.45822211547039, + -13.149875930332756, + -17.65679408261992 ], "moduleForcesY": [ - -84.81783816234807, - -43.73643202943646, - -114.52616360787027, - -112.32150159790285 + -82.37686544038085, + -42.631112459868845, + -113.98755478586436, + -112.34316617833551 ], - "timestamp": 0.771547217463052 + "timestamp": 0.783248671316926 }, { - "x": 2.1033826262076065, - "y": 3.550155624544787, - "heading": 1.7432921394058938, - "angularVelocity": 3.9220148686885787, - "velocityX": 1.2562563459466602, - "velocityY": 1.5044714705993274, + "x": 2.1067771502269776, + "y": 3.5537494938021474, + "heading": 1.670997490742332, + "angularVelocity": 3.8039186600259614, + "velocityX": 1.225241460809306, + "velocityY": 1.5027701851378008, "moduleForcesX": [ - -70.91594042910828, - -101.15910205833582, - -9.707383087632953, - -49.1201488511403 + -73.34437651796223, + -106.15263304185436, + 2.413642008170467, + -17.473283255047654 ], "moduleForcesY": [ - -90.63705631390823, - -54.64864966949406, - -114.5024627557604, - -103.10697098452272 + -88.6335893943357, + -43.97011401265027, + -114.84297204098115, + -112.21755339067951 ], - "timestamp": 0.8197689185544927 + "timestamp": 0.8322017132742339 }, { - "x": 2.152607740204923, - "y": 3.607801077995203, - "heading": 1.9261463477817098, - "angularVelocity": 3.7919485260189596, - "velocityX": 1.0208083266074068, - "velocityY": 1.195425547952053, + "x": 2.1557185257205664, + "y": 3.611706742126399, + "heading": 1.8675660562205407, + "angularVelocity": 4.015451494304166, + "velocityX": 0.9997616805266244, + "velocityY": 1.1839355841054042, "moduleForcesX": [ - -71.44382936842356, - -54.31445565209966, - -82.52029843395653, - -69.05779006643566 + -67.41409192098914, + -86.37446768247753, + -41.076314753076424, + -66.76192995165273 ], "moduleForcesY": [ - -90.14981383751513, - -101.45774094468433, - -80.2741248199996, - -92.14633676825402 + -93.25513893490984, + -75.94459361264344, + -107.35908537802607, + -93.3886676822394 ], - "timestamp": 0.8679906196459335 + "timestamp": 0.8811547552315417 }, { - "x": 2.190788381486093, - "y": 3.651400600452789, - "heading": 2.090948780206684, - "angularVelocity": 3.4175988962410573, - "velocityX": 0.7917730071108338, - "velocityY": 0.9041473334777186, + "x": 2.1932474586006316, + "y": 3.65462041068866, + "heading": 2.050511149008698, + "angularVelocity": 3.7371547399996508, + "velocityX": 0.7666312731477015, + "velocityY": 0.8766292521689998, "moduleForcesX": [ - -90.79606858393824, - -18.55584251040676, - -96.57736445012134, - -63.853520232036104 + -80.55920555192586, + -32.49392465665238, + -92.09950834240892, + -65.3512771134131 ], "moduleForcesY": [ - -70.53849669010287, - -113.64992224377944, - -62.92180680397964, - -95.98904481306892 + -82.02909062643297, + -110.42446436352448, + -69.20864919881635, + -94.9088970753719 ], - "timestamp": 0.9162123207373742 + "timestamp": 0.9301077971888496 }, { - "x": 2.2183045677010402, - "y": 3.682483763115444, - "heading": 2.2264269947581963, - "angularVelocity": 2.80948642385323, - "velocityX": 0.570618323123221, - "velocityY": 0.6445886801818393, + "x": 2.219811592242873, + "y": 3.684386183378235, + "heading": 2.2045411597277322, + "angularVelocity": 3.1464849692765178, + "velocityX": 0.5426452081477267, + "velocityY": 0.608047457341234, "moduleForcesX": [ - -110.71850311742375, - 6.332456186499907, - -98.8317602170274, - -57.28231604872353 + -108.75425048256633, + 5.385270544240483, + -98.73724209101452, + -57.787407111346226 ], "moduleForcesY": [ - -31.162381403627016, - -115.02092054012306, - -59.44262986998008, - -100.1105777694302 + -37.23491686496145, + -115.04201778008925, + -59.561331885625044, + -99.80030517652003 ], - "timestamp": 0.964434021828815 + "timestamp": 0.9790608391461575 }, { - "x": 2.2359647168279775, - "y": 3.7023940350495996, - "heading": 2.322570970138052, - "angularVelocity": 1.9937906213126328, - "velocityX": 0.3662282484280048, - "velocityY": 0.41289028556666507, + "x": 2.236530898648883, + "y": 3.703097894493539, + "heading": 2.3149477414372774, + "angularVelocity": 2.2553569154258097, + "velocityX": 0.341537639684345, + "velocityY": 0.38223796456182474, "moduleForcesX": [ - -115.10010865685537, - 24.884078394615532, - -98.81097200345764, - -51.72593444923844 + -114.57748285843158, + 31.6917140634627, + -99.3989192581002, + -51.062756198042344 ], "moduleForcesY": [ - 2.2494262109699688, - -112.50306629791393, - -59.54291982558333, - -103.12309638155047 + 10.74305716556114, + -110.76286660417196, + -58.543037707713566, + -103.44652639602133 ], - "timestamp": 1.0126557229202557 + "timestamp": 1.0280138811034654 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": 1.041427943793603, - "velocityX": 0.17807293718407943, - "velocityY": 0.199266250731892, + "angularVelocity": 1.1815947161180913, + "velocityX": 0.163846776586212, + "velocityY": 0.18191102692862865, "moduleForcesX": [ - -113.18697740525452, - 38.58269845532561, - -98.77375749286766, - -48.251824048408885 + -109.59554076157117, + 49.71533486232882, + -99.47986509601193, + -46.81669841993476 ], "moduleForcesY": [ - 21.426140041828702, - -108.59855539761742, - -59.643832900298754, - -104.81345448783512 + 35.44227192984209, + -103.9680438489712, + -58.45523278702017, + -105.46066453849079 ], - "timestamp": 1.0608774240116965 + "timestamp": 1.0769669230607732 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": -5.850639937158215e-24, - "velocityX": -1.5909300119313646e-23, - "velocityY": -7.26803393218573e-24, + "angularVelocity": 5.839447282391598e-18, + "velocityX": -3.299113784734962e-17, + "velocityY": -5.057039344587014e-17, "moduleForcesX": [ - -110.17194913173422, - 47.48175193227342, - -99.60618042375734, - -47.457362329423724 + -103.80869333848717, + 60.02004315909284, + -100.4607086019751, + -45.86395648223105 ], "moduleForcesY": [ - 33.78870027617767, - -105.04769902960695, - -58.26901613919847, - -105.18952275403072 + 50.030394045050265, + -98.4252138448354, + -56.78405771282525, + -105.89459694302894 ], - "timestamp": 1.1090991251031372 + "timestamp": 1.1259199650180811 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Blue Source 4 Piece.traj b/src/main/deploy/choreo/Blue Source 4 Piece.traj index 4229645..d6e9880 100644 --- a/src/main/deploy/choreo/Blue Source 4 Piece.traj +++ b/src/main/deploy/choreo/Blue Source 4 Piece.traj @@ -4,9 +4,9 @@ "x": 0.4266119384765617, "y": 2.058690309524536, "heading": 3.141592653589793, - "angularVelocity": -1.0052674025899142e-27, - "velocityX": 1.6142788826895295e-27, - "velocityY": 1.3181347462088108e-26, + "angularVelocity": -2.636030265121926e-29, + "velocityX": 8.6332357029436e-27, + "velocityY": -6.3927224094377434e-27, "moduleForcesX": [ 0, 0, @@ -22,3154 +22,3196 @@ "timestamp": 0 }, { - "x": 0.5057561905034981, - "y": 2.0445076102417237, + "x": 0.5044048891758348, + "y": 2.0447497642817187, "heading": 3.141592653589793, - "angularVelocity": 2.542506773731786e-17, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 2.5937711703524665e-17, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277733, - 113.60325815277733 + 113.60407786230424, + 113.60407786230424, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.35777465406064, - -20.357774654060623, - -20.357774654060627 + -20.35792154651868, + -20.357921546518682, + -20.35792154651867, + -20.35792154651867 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.0986098561129038 }, { - "x": 0.6640322521639479, - "y": 2.016144441360754, + "x": 0.6599786811244505, + "y": 2.016870843817058, "heading": 3.141592653589793, - "angularVelocity": 1.83628749749613e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.2851630766748123, + "angularVelocity": 1.5389337606196853e-16, + "velocityX": 1.577669799766169, + "velocityY": -0.28271941125987365, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060845, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - -20.354574176009805, - -20.354574176009812, - -20.354574176009788, - -20.354574176009795 + -20.354752580314884, + -20.354752580314884, + -20.354752580314873, + -20.354752580314873 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.1972197122258076 }, { - "x": 0.9014153662648319, - "y": 1.9736052393860541, - "heading": 3.1415926535897927, - "angularVelocity": 4.3044410493591116e-16, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156397, + "x": 0.8933091226599791, + "y": 1.975057883291536, + "heading": 3.141592653589793, + "angularVelocity": 2.681654742601167e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.42402415107114716, + "moduleForcesX": [ + 113.55106593310009, + 113.55106593310009, + 113.5510659331001, + 113.5510659331001 + ], + "moduleForcesY": [ + -20.34842177577035, + -20.34842177577035, + -20.348421775770344, + -20.348421775770344 + ], + "timestamp": 0.2958295683387114 + }, + { + "x": 1.2043238856378824, + "y": 1.9193238439537263, + "heading": 3.141592653589793, + "angularVelocity": 3.119234538163159e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959204, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - -20.348206040044563, - -20.348206040044566, - -20.348206040044545, - -20.34820604004455 + -20.32949395931806, + -20.32949395931806, + -20.32949395931805, + -20.329493959318054 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.3944394244516152 }, { - "x": 1.217832290103284, - "y": 1.9169031294556198, - "heading": 3.1415926535897927, - "angularVelocity": 6.223805757251702e-16, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223711, + "x": 1.5704459663887822, + "y": 1.8537145389302825, + "heading": 3.141592653589793, + "angularVelocity": 2.834733594304735e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - 113.44472985048415, - 113.44472985048415, - 113.44472985048417, - 113.44472985048417 + 80.47536393454654, + 80.47536393454654, + 80.47536393454652, + 80.47536393454654 ], "moduleForcesY": [ - -20.329366283501095, - -20.3293662835011, - -20.32936628350108, - -20.329366283501084 + -14.42123536615277, + -14.42123536615277, + -14.421235366152768, + -14.421235366152768 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.49304928056451897 }, { - "x": 1.6065593117988135, - "y": 1.8472430049283879, - "heading": 3.1415926535897927, - "angularVelocity": -5.941810710402389e-17, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 1.9365688239340553, + "y": 1.7881050947048027, + "heading": 3.141592653589793, + "angularVelocity": -8.681093170147199e-17, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046883, "moduleForcesX": [ - 103.79354790180253, - 103.79354790180253, - 103.79354790180251, - 103.79354790180253 + 0.0011343830985909456, + 0.0011343830986048384, + 0.0011343830985909456, + 0.0011343830986048384 ], "moduleForcesY": [ - -18.599868464060304, - -18.5998684640603, - -18.59986846406034, - -18.59986846406034 + -0.00020328215814713693, + -0.00020328215814713693, + -0.00020328215816578076, + -0.00020328215816578076 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.5916591366774228 }, { - "x": 1.9952895667696153, - "y": 1.7775823009962126, - "heading": 3.1415926535897927, - "angularVelocity": 9.709734106788374e-17, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151492, + "x": 2.3026916814847596, + "y": 1.7224956504783495, + "heading": 3.141592653589793, + "angularVelocity": 4.734074192918141e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 0.004641026935483716, - 0.004641026935477894, - 0.004641026935483716, - 0.004641026935477894 + 7.931400211976679e-9, + 7.931379192828927e-9, + 7.931400211976679e-9, + 7.931379192828927e-9 ], "moduleForcesY": [ - -0.0008316749189463459, - -0.0008316749189463459, - -0.0008316749189385331, - -0.0008316749189385331 + -1.421325763882383e-9, + -1.421325763882383e-9, + -1.4212975568395444e-9, + -1.4212975568395444e-9 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.6902689927903265 }, { - "x": 2.384019821763918, - "y": 1.7079215970598256, - "heading": 3.1415926535897927, - "angularVelocity": -2.3094137904516824e-16, - "velocityX": 3.9082909239078325, - "velocityY": -0.7003681690574906, + "x": 2.668814539035464, + "y": 1.6568862062518965, + "heading": 3.141592653589793, + "angularVelocity": -3.989113893494158e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 3.373320326366702e-8, - 3.3733215465968396e-8, - 3.373320326366702e-8, - 3.3733215465968396e-8 + 1.0621117148556482e-13, + 1.389401920423077e-13, + 1.0621117148556477e-13, + 1.389401920423077e-13 ], "moduleForcesY": [ - -6.0450200846646806e-9, - -6.0450200846646806e-9, - -6.045036459773772e-9, - -6.045036459773772e-9 + 3.264252305613286e-14, + 3.264252305613286e-14, + -1.1278805048511687e-14, + -1.12788050485117e-14 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.7888788489032303 }, { - "x": 2.772750076758221, - "y": 1.6382608931234386, - "heading": 3.1415926535897927, - "angularVelocity": 2.6440232206689406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.0349373965861686, + "y": 1.5912767620254435, + "heading": 3.141592653589793, + "angularVelocity": 3.8177893619679035e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 2.7260590797900104e-13, - 2.5418023822544317e-13, - 2.726059079790011e-13, - 2.5418023822544317e-13 + -1.0065015410704733e-14, + -3.93561753170835e-14, + -1.0065015410704727e-14, + -3.935617531708349e-14 ], "moduleForcesY": [ - -2.389781832125078e-14, - -2.3897818321250773e-14, - 8.288576692751096e-16, - 8.288576692751175e-16 + -3.845752753351914e-14, + -3.845752753351914e-14, + 8.502984548337096e-16, + 8.502984548337159e-16 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.8874887050161342 }, { - "x": 3.1614803317525237, - "y": 1.5686001891870518, - "heading": 3.1415926535897927, - "angularVelocity": 3.64658642558291e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.401060254136873, + "y": 1.5256673177989906, + "heading": 3.141592653589793, + "angularVelocity": 2.8475078392542003e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - -2.1187937111675137e-15, - -5.848102972462486e-15, - -2.1187937111675106e-15, - -5.848102972462483e-15 + 2.702347393042644e-14, + 3.066392780900211e-14, + 2.7023473930426435e-14, + 3.0663927809002107e-14 ], "moduleForcesY": [ - -3.79352555329438e-15, - -3.793525553294378e-15, - 1.2110915382879926e-15, - 1.2110915382879942e-15 + 7.65129265833603e-15, + 7.65129265833603e-15, + 2.7659167280194507e-15, + 2.76591672801945e-15 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.986098561129038 }, { - "x": 3.5502105867468265, - "y": 1.4989394852506648, - "heading": 3.1415926535897927, - "angularVelocity": 3.0984512311067555e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 3.7671831116875776, + "y": 1.4600578735725376, + "heading": 3.141592653589793, + "angularVelocity": -6.625521634806447e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -1.1805625548476553e-14, - -9.766686110860697e-15, - -1.1805625548476553e-14, - -9.766686110860699e-15 + -2.7558380308157566e-14, + 7.984012372117386e-15, + -2.755838030815758e-14, + 7.984012372117377e-15 ], "moduleForcesY": [ - 2.2856139854462812e-15, - 2.2856139854462805e-15, - -4.505793531159297e-16, - -4.505793531159307e-16 + 3.433627959014811e-14, + 3.4336279590148096e-14, + -1.3360506441930727e-14, + -1.3360506441930734e-14 ], - "timestamp": 0.9946297820777839 + "timestamp": 1.084708417241942 }, { - "x": 3.9389408417411294, - "y": 1.4292787813142778, - "heading": 3.1415926535897927, - "angularVelocity": 2.6938201259937605e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 4.1333059692382825, + "y": 1.3944484293460846, + "heading": 3.141592653589793, + "angularVelocity": 2.626196468380025e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.3582614867510558e-15, - -8.531249324574269e-16, - -2.3582614867510566e-15, - -8.531249324574281e-16 + 5.218701888727073e-14, + 1.7474976800726986e-14, + 5.2187018887270745e-14, + 1.7474976800726996e-14 ], "moduleForcesY": [ - -3.0992634216346065e-15, - -3.0992634216346073e-15, - -5.1191098856866794e-15, - -5.119109885686679e-15 + -1.3519320045963935e-14, + -1.3519320045963913e-14, + 3.3063161303335716e-14, + 3.306316130333573e-14 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.1833182733548457 }, { - "x": 4.327671096735433, - "y": 1.359618077377891, - "heading": 3.1415926535897927, - "angularVelocity": -1.238903049402388e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 4.499428826788987, + "y": 1.3288389851196316, + "heading": 3.141592653589793, + "angularVelocity": -3.612388438354753e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145583, "moduleForcesX": [ - 1.639857812880446e-14, - 3.102742236349073e-14, - 1.6398578128804444e-14, - 3.102742236349072e-14 + -3.317589814336674e-14, + -9.769000156659927e-15, + -3.3175898143366745e-14, + -9.769000156659935e-15 ], "moduleForcesY": [ - -1.6461928460837335e-15, - -1.6461928460837406e-15, - -2.1277647026310398e-14, - -2.1277647026310404e-14 + 4.3145001853369944e-15, + 4.3145001853369944e-15, + -2.7096829237238478e-14, + -2.7096829237238475e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.2819281294677496 }, { - "x": 4.716401351729735, - "y": 1.289957373441504, - "heading": 3.1415926535897927, - "angularVelocity": -1.136445427284406e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 4.865551684339691, + "y": 1.2632295408931786, + "heading": 3.141592653589793, + "angularVelocity": 6.373929698977975e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.0678916244800482e-14, - 1.029779697253711e-14, - 1.0678916244800482e-14, - 1.0297796972537104e-14 + 1.7589203863345612e-14, + -1.9879025454332904e-14, + 1.758920386334562e-14, + -1.9879025454332894e-14 ], "moduleForcesY": [ - -1.2590263470365182e-14, - -1.2590263470365181e-14, - -1.2078813255255259e-14, - -1.2078813255255259e-14 + -1.6636808224988317e-14, + -1.663680822498831e-14, + 3.3644390703917045e-14, + 3.364439070391706e-14 ], - "timestamp": 1.293018716701119 + "timestamp": 1.3805379855806534 }, { - "x": 5.105131606724038, - "y": 1.2202966695051172, - "heading": 3.1415926535897927, - "angularVelocity": 2.9818590278219814e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.231674541890395, + "y": 1.1976200966667256, + "heading": 3.141592653589793, + "angularVelocity": -2.0111488524479928e-16, + "velocityX": 3.71284242755116, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 2.769886946545534e-14, - 1.2379704678654201e-14, - 2.769886946545535e-14, - 1.2379704678654214e-14 + 6.3838812836279954e-15, + 3.784432963816933e-14, + 6.383881283627987e-15, + 3.7844329638169315e-14 ], "moduleForcesY": [ - 9.496370048803752e-15, - 9.49637004880376e-15, - 3.005421294922601e-14, - 3.005421294922601e-14 + 4.030686794000322e-14, + 4.0306867940003206e-14, + -1.9120757067646953e-15, + -1.9120757067647064e-15 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.4791478416935573 }, { - "x": 5.493861861718341, - "y": 1.1506359655687302, - "heading": 3.1415926535897927, - "angularVelocity": 3.7716775113186575e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.597797399441099, + "y": 1.1320106524402727, + "heading": 3.141592653589793, + "angularVelocity": 4.608632320582683e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - 1.875775797486784e-14, - 1.5819811149361853e-14, - 1.8757757974867845e-14, - 1.5819811149361856e-14 + 3.918114304682504e-14, + 1.4344013324637785e-14, + 3.9181143046825054e-14, + 1.434401332463779e-14 ], "moduleForcesY": [ - 5.14793052073305e-15, - 5.147930520733051e-15, - 9.090563825427617e-15, - 9.090563825427614e-15 + -2.8224321170465307e-14, + -2.8224321170465303e-14, + 5.106334777962157e-15, + 5.106334777962165e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.5777576978064611 }, { - "x": 5.882592116712644, - "y": 1.0809752616323431, - "heading": 3.1415926535897927, - "angularVelocity": 4.0491763613005573e-16, - "velocityX": 3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 5.963920256991803, + "y": 1.0664012082138197, + "heading": 3.141592653589793, + "angularVelocity": -2.9208162371439364e-16, + "velocityX": 3.7128424275511605, + "velocityY": -0.6653436767145582, "moduleForcesX": [ - -2.1753860824189263e-14, - -2.2786094030199463e-14, - -2.1753860824189263e-14, - -2.278609403019946e-14 + 1.2013443615486301e-14, + 4.02636056188286e-14, + 1.2013443615486301e-14, + 4.02636056188286e-14 ], "moduleForcesY": [ - -6.901925353374897e-15, - -6.901925353374896e-15, - -5.516700481060696e-15, - -5.516700481060695e-15 + 1.289444461580083e-14, + 1.2894444615800824e-14, + -2.501639454930619e-14, + -2.50163945493062e-14 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.676367553919365 }, { - "x": 6.271322371706947, - "y": 1.0113145576959566, - "heading": 3.1415926535897927, - "angularVelocity": 4.793115078142994e-16, - "velocityX": 3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 6.330043114542507, + "y": 1.0007917639873667, + "heading": 3.141592653589793, + "angularVelocity": -1.2364755766957827e-16, + "velocityX": 3.7128424275511596, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -2.3335563331205926e-13, - -2.3612291774158497e-13, - -2.3335563331205926e-13, - -2.3612291774158497e-13 + -1.0552174459678842e-13, + -1.1184131716065804e-13, + -1.0552174459678844e-13, + -1.1184131716065804e-13 ], "moduleForcesY": [ - 2.5534936481984513e-14, - 2.5534936481984522e-14, - 2.924854615684032e-14, - 2.9248546156840326e-14 + 2.5387864477856727e-14, + 2.538786447785674e-14, + 3.386853439517406e-14, + 3.3868534395174075e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.7749774100322688 }, { - "x": 6.660052626677748, - "y": 0.9416538537637811, - "heading": 3.1415926535897927, - "angularVelocity": -3.3113004994684937e-16, - "velocityX": 3.908290923671554, - "velocityY": -0.7003681690151491, + "x": 6.69616597208778, + "y": 0.9351823197618869, + "heading": 3.141592653589793, + "angularVelocity": -3.2114621171744805e-16, + "velocityX": 3.7128424274960823, + "velocityY": -0.6653436767046882, "moduleForcesX": [ - -3.37332422685154e-8, - -3.373321212191524e-8, - -3.37332422685154e-8, - -3.373321212191524e-8 + -7.93135794252456e-9, + -7.931350532461352e-9, + -7.93135794252456e-9, + -7.931350532461352e-9 ], "moduleForcesY": [ - 6.045047048260069e-9, - 6.045047048260069e-9, - 6.045006592459861e-9, - 6.045006592459861e-9 + 1.4213044027536005e-9, + 1.4213044027536005e-9, + 1.4212944586791418e-9, + 1.4212944586791416e-9 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.8735872661451727 }, { - "x": 7.048779648373277, - "y": 0.8719937292365493, - "heading": 3.1415926535897927, - "angularVelocity": -2.927541680761118e-16, - "velocityX": 3.9082584163474157, - "velocityY": -0.7003623436824061, + "x": 7.06228805283868, + "y": 0.8695730147384431, + "heading": 3.141592653589793, + "angularVelocity": -5.032939008461686e-16, + "velocityX": 3.7128345500444366, + "velocityY": -0.6653422650604446, "moduleForcesX": [ - -0.004641026935458204, - -0.004641026935459632, - -0.004641026935458204, - -0.004641026935459632 + -0.0011343830986322845, + -0.0011343830986254506, + -0.0011343830986322845, + -0.0011343830986254506 ], "moduleForcesY": [ - 0.0008316749189556608, - 0.0008316749189556608, - 0.0008316749189575763, - 0.0008316749189575763 + 0.00020328215814718062, + 0.00020328215814718062, + 0.0002032821581380095, + 0.0002032821581380095 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.9721971222580765 }, { - "x": 7.36519657221173, - "y": 0.8152916193061152, - "heading": 3.1415926535897927, - "angularVelocity": 1.34800275257632e-15, - "velocityX": 3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 7.373302815816583, + "y": 0.8138389754006333, + "heading": 3.141592653589793, + "angularVelocity": 7.522639458662454e-16, + "velocityX": 3.1539926660252453, + "velocityY": -0.5651974511959202, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180247, - -103.79354790180248 + -80.47536393454648, + -80.47536393454651, + -80.47536393454646, + -80.4753639345465 ], "moduleForcesY": [ - 18.599868464060222, - 18.599868464060204, - 18.599868464060343, - 18.599868464060325 + 14.421235366152747, + 14.421235366152738, + 14.421235366152821, + 14.421235366152812 ], - "timestamp": 1.9892595641555668 + "timestamp": 2.0708069783709804 }, { - "x": 7.602579686312613, - "y": 0.7727524173314154, + "x": 7.606633257352112, + "y": 0.7720260148751114, "heading": 3.141592653589793, - "angularVelocity": 1.0489291061445997e-15, - "velocityX": 2.3866479606612034, - "velocityY": -0.4276888018156398, + "angularVelocity": 6.995668606739556e-16, + "velocityX": 2.3661979718170962, + "velocityY": -0.4240241510711471, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048415 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - 20.329366283501095, - 20.329366283501102, - 20.329366283501077, - 20.329366283501084 + 20.329493959318064, + 20.329493959318064, + 20.329493959318047, + 20.32949395931805 ], - "timestamp": 2.088722542363345 + "timestamp": 2.1694168344838842 }, { - "x": 7.760855747973063, - "y": 0.7443892484504455, + "x": 7.762207049300727, + "y": 0.7441470944104503, "heading": 3.141592653589793, - "angularVelocity": 6.60732824682179e-16, - "velocityX": 1.59130627809888, - "velocityY": -0.28516307667481233, + "angularVelocity": 4.3371547132759497e-16, + "velocityX": 1.5776697997661688, + "velocityY": -0.28271941125987354, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.5510659331001, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - 20.348206040044566, - 20.348206040044573, - 20.348206040044545, - 20.34820604004455 + 20.34842177577035, + 20.348421775770355, + 20.34842177577033, + 20.348421775770333 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.268026690596788 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 3.6252603672857176e-16, - "velocityX": 0.7957156869122083, - "velocityY": -0.1425927469533916, + "angularVelocity": 1.5788584640316286e-16, + "velocityX": 0.7888963006923342, + "velocityY": -0.14137070869321688, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - 20.354574176009816, - 20.354574176009823, - 20.354574176009788, - 20.354574176009795 + 20.354752580314884, + 20.354752580314884, + 20.354752580314862, + 20.354752580314862 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.366636546709692 }, { "x": 7.84, "y": 0.7302065491676331, "heading": 3.141592653589793, - "angularVelocity": 6.745149212805757e-24, - "velocityX": -2.3977049906460955e-24, - "velocityY": 5.457735537774418e-24, + "angularVelocity": -2.881387559058349e-22, + "velocityX": -2.0695827234177623e-22, + "velocityY": 3.9145962895148407e-22, + "moduleForcesX": [ + -113.60407786230425, + -113.60407786230424, + -113.60407786230425, + -113.60407786230425 + ], + "moduleForcesY": [ + 20.35792154651868, + 20.35792154651868, + 20.35792154651866, + 20.357921546518664 + ], + "timestamp": 2.4652464028225958 + }, + { + "x": 7.793078256290604, + "y": 0.747575876847021, + "heading": 3.1112179449580726, + "angularVelocity": -0.38443223901861173, + "velocityX": -0.5938569225985211, + "velocityY": 0.2198318874756783, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -103.38540370202267, + -97.08636346934234, + -113.70612876978298, + -112.73947029508176 ], "moduleForcesY": [ - 20.357774654060638, - 20.357774654060645, - 20.357774654060613, - 20.357774654060623 + 51.30130417295831, + 62.38345613408081, + 19.75281146697054, + 24.597212101539153 ], - "timestamp": 2.38711147698668 + "timestamp": 2.544258269021076 }, { - "x": 7.790302474791704, - "y": 0.7486471398847376, - "heading": 3.113139944846083, - "angularVelocity": -0.35037941350634544, - "velocityX": -0.6119976095087556, - "velocityY": 0.227085702748705, + "x": 7.699157584042874, + "y": 0.7824201103535565, + "heading": 3.0528530427476355, + "angularVelocity": -0.7386852762573926, + "velocityX": -1.1886907216164007, + "velocityY": 0.44100000649276744, "moduleForcesX": [ - -103.90543853086191, - -98.59916886502413, - -113.31145977613869, - -112.25808633757457 + -103.36634328078968, + -98.44357768722068, + -113.2458848815574, + -112.56382635716881 ], "moduleForcesY": [ - 50.24070001601602, - 59.96747683817382, - 21.908340031011765, - 26.7231884795195 + 51.30995429297126, + 60.18928815483856, + 22.172889474101435, + 25.32325446348918 ], - "timestamp": 2.4683169007271215 + "timestamp": 2.6232701352195567 }, { - "x": 7.6908434229658935, - "y": 0.7856168809153167, - "heading": 3.0585136722324213, - "angularVelocity": -0.6726924150813451, - "velocityX": -1.2247833610685241, - "velocityY": 0.45526196807673963, + "x": 7.558124904051805, + "y": 0.8348658019205454, + "heading": 2.970415200366219, + "angularVelocity": -1.0433602741938681, + "velocityX": -1.7849556880075408, + "velocityY": 0.6637698119323439, "moduleForcesX": [ - -103.9180654585984, - -99.75724138640885, - -112.86307129194968, - -112.08705733206625 + -103.55489402764358, + -100.41233501810488, + -112.50081664731479, + -112.18043737384707 ], "moduleForcesY": [ - 50.18528756830429, - 57.99159008453135, - 24.052005242751903, - 27.373638607207237 + 50.87947133813933, + 56.79519440863833, + 25.59433833117188, + 26.8778174814867 ], - "timestamp": 2.549522324467563 + "timestamp": 2.702282001418037 }, { - "x": 7.541531337145835, - "y": 0.8412229963489037, - "heading": 2.981391936731005, - "angularVelocity": -0.9497116319215562, - "velocityX": -1.8386959754967525, - "velocityY": 0.6847586389219771, + "x": 7.369806193764596, + "y": 0.905047849903824, + "heading": 2.8714456053511004, + "angularVelocity": -1.2525915381685058, + "velocityX": -2.383423140698201, + "velocityY": 0.8882469350487018, "moduleForcesX": [ - -104.11265608433906, - -101.42006410641169, - -112.15378683051924, - -111.72713556007261 + -104.5638907933371, + -103.40298640344945, + -111.14222972427874, + -111.12271990152317 ], "moduleForcesY": [ - 49.732813229817744, - 54.984671240448414, - 27.084035745760126, - 28.72458573429547 + 48.67580615971352, + 51.05561071064651, + 30.82098267886581, + 30.82179435894176 ], - "timestamp": 2.6307277482080047 + "timestamp": 2.7812938676165175 }, { - "x": 7.3422298869395055, - "y": 0.9155841520343788, - "heading": 2.888707762091219, - "angularVelocity": -1.1413544855825648, - "velocityX": -2.4542874235021577, - "velocityY": 0.9157166142394264, + "x": 7.134064263774228, + "y": 0.9930498413232173, + "heading": 2.7737381050807945, + "angularVelocity": -1.2366180546205667, + "velocityX": -2.983626907358137, + "velocityY": 1.1137819628045385, "moduleForcesX": [ - -104.98869457390775, - -103.9286155458672, - -110.8945520614623, - -110.77607463143485 + -108.14622857930792, + -108.14231842669959, + -107.59500574441715, + -107.59649154427582 ], "moduleForcesY": [ - 47.76428477391485, - 49.99408871314553, - 31.717824320202514, - 32.072047225373296 + 39.79515762619855, + 39.812512633287064, + 41.26220935675609, + 41.264830579989365 ], - "timestamp": 2.7119331719484463 + "timestamp": 2.860305733814998 }, { - "x": 7.092835207414608, - "y": 1.0087906432972025, - "heading": 2.7963823652584026, - "angularVelocity": -1.13693633479357, - "velocityX": -3.071157910856337, - "velocityY": 1.1477865266825216, + "x": 6.8566127289684236, + "y": 1.0968882632669579, + "heading": 2.7677976122574344, + "angularVelocity": -0.0751848185491247, + "velocityX": -3.5115172967670025, + "velocityY": 1.3142130029291403, "moduleForcesX": [ - -107.94355502791352, - -107.94550564100822, - -107.79557995601229, - -107.79794622888959 + -111.16467067641464, + -114.92109699391807, + -65.016543313601, + -88.39242273361802 ], "moduleForcesY": [ - 40.38686661660537, - 40.3833232466669, - 40.78021169994761, - 40.77561046788363 + -28.016980604792003, + 4.148148544540663, + 94.40251274978314, + 73.55404230537421 ], - "timestamp": 2.793138595688888 + "timestamp": 2.9393176000134784 }, { - "x": 6.796745453055094, - "y": 1.1197154475688882, - "heading": 2.775510588841466, - "angularVelocity": -0.25702441358657924, - "velocityX": -3.6461820001815646, - "velocityY": 1.365977777866621, + "x": 6.577593993203279, + "y": 1.201509394881753, + "heading": 2.7676745616395704, + "angularVelocity": -0.0015573688331172865, + "velocityX": -3.5313523042759076, + "velocityY": 1.3241192323186386, "moduleForcesX": [ - -114.48153022441872, - -114.50263359045594, - -80.3287014204199, - -92.8994088994194 + -2.8091694596169208, + -6.012702465623992, + -1.1155418972111872, + -4.321760134676918 ], "moduleForcesY": [ - -8.214078066637384, - 11.01893061920677, - 81.97674297463203, - 67.8367051044082 + -1.0053994170960971, + 0.255916053918154, + 3.3094001138142786, + 4.561565207999692 ], - "timestamp": 2.8743440194293295 + "timestamp": 3.018329466211959 }, { - "x": 6.494829735223949, - "y": 1.232766445355973, - "heading": 2.7753947312647114, - "angularVelocity": -0.0014267221500469003, - "velocityX": -3.7179255267008355, - "velocityY": 1.3921606781885885, + "x": 6.298577354601419, + "y": 1.3061362496498794, + "heading": 2.7675516355023344, + "angularVelocity": -0.0015557933656047968, + "velocityX": -3.5313257618920133, + "velocityY": 1.324191666417548, "moduleForcesX": [ - -10.058722820162451, - -20.67537666401696, - -4.347871917595185, - -15.100494848677254 + 0.004786508231746084, + 0.004717836359581643, + 0.004822681056873213, + 0.004754009184721306 ], "moduleForcesY": [ - -4.924229823728783, - -0.6516753204634617, - 9.978553002629143, - 13.911513369658744 + 0.01295846874279039, + 0.01298542378305762, + 0.013050624257642878, + 0.013077579297906624 ], - "timestamp": 2.955549443169771 + "timestamp": 3.0973413324104393 }, { - "x": 6.192913236776813, - "y": 1.34581580615927, - "heading": 2.7752792922983844, - "angularVelocity": -0.0014215671935348026, - "velocityX": -3.7179351395561624, - "velocityY": 1.3921405196362102, + "x": 6.019560787537094, + "y": 1.4107632952116882, + "heading": 2.7674287096824344, + "angularVelocity": -0.0015557893493045325, + "velocityX": -3.531324856489611, + "velocityY": 1.3241940811647472, "moduleForcesX": [ - -0.0016277805976752818, - -0.001847063161268062, - -0.0015148902541237436, - -0.001734172817758108 + 0.00016276242258108617, + 0.00016258736752973322, + 0.00016285466593947583, + 0.0001626796108881199 ], "moduleForcesY": [ - -0.0037142738377341908, - -0.0036301509173889052, - -0.003420003455069923, - -0.0033358805347123346 + 0.0004338321315768353, + 0.0004339008689056902, + 0.00043406705001357217, + 0.0004341357873424245 ], - "timestamp": 3.0367548669102127 + "timestamp": 3.1763531986089197 }, { - "x": 5.8909967172285675, - "y": 1.458865110625056, - "heading": 2.775163853477906, - "angularVelocity": -0.0014215653974960305, - "velocityX": -3.7179353994046904, - "velocityY": 1.3921398258708426, + "x": 5.740544223186777, + "y": 1.5153903480276578, + "heading": 2.767305784182522, + "angularVelocity": -0.0015557852994348927, + "velocityX": -3.5313248221402196, + "velocityY": 1.3241941729757745, "moduleForcesX": [ - -0.00004542055571195788, - -0.00004549695258179801, - -0.00004538121174383447, - -0.00004545760861367461 + 0.000006215085286239505, + 0.000006038575601884941, + 0.0000063081287765344795, + 0.000006131619092180273 ], "moduleForcesY": [ - -0.00012138298819942749, - -0.00012135367010735092, - -0.00012128046597513451, - -0.00012125114788305795 + 0.000016347388393537852, + 0.00001641672195966612, + 0.00001658425890258734, + 0.000016653592468716595 ], - "timestamp": 3.1179602906506543 + "timestamp": 3.2553650648074 }, { - "x": 5.589080197992595, - "y": 1.5719144159306049, - "heading": 2.775048414795757, - "angularVelocity": -0.0014215636940543507, - "velocityX": -3.7179353955592296, - "velocityY": 1.3921398362120572, + "x": 5.461527659771718, + "y": 1.6200174033544015, + "heading": 2.7671828590052048, + "angularVelocity": -0.001555781216559394, + "velocityX": -3.5313248103033033, + "velocityY": 1.3241942047529485, "moduleForcesX": [ - 6.900104711158049e-7, - 6.175555507382957e-7, - 7.273372348999605e-7, - 6.548823145224512e-7 + 0.0000021694123254773052, + 0.0000019914727065847287, + 0.0000022632434626927816, + 0.000002085303843800205 ], "moduleForcesY": [ - 0.0000017458195351588234, - 0.000001773634459523078, - 0.0000018430517858208699, - 0.0000018708667101851245 + 0.0000055567123093686425, + 0.000005626632809301405, + 0.000005795501746120869, + 0.0000058654222460536335 ], - "timestamp": 3.199165714391096 + "timestamp": 3.3343769310058806 }, { - "x": 5.2871637020932685, - "y": 1.6849637835662303, - "heading": 2.774932976253418, - "angularVelocity": -0.0014215619723587569, - "velocityX": -3.717935108181291, - "velocityY": 1.3921406037725665, + "x": 5.1825111126116505, + "y": 1.7246445020461594, + "heading": 2.7670599341523174, + "angularVelocity": -0.0015557771104789896, + "velocityX": -3.531324604574814, + "velocityY": 1.3241947535947438, "moduleForcesX": [ - 0.0000502708285116954, - 0.00005019760041729749, - 0.00005030856660980123, - 0.000050235338515403327 + 0.000037016274754465266, + 0.000036837332466608477, + 0.00003711066869943973, + 0.00003693172641158219 ], "moduleForcesY": [ - 0.00013415824992900224, - 0.0001341863713689036, - 0.00013425651975516287, - 0.00013428464119506422 + 0.00009848388119271718, + 0.00009855422108221447, + 0.0000987240161800544, + 0.00009879435606955096 ], - "timestamp": 3.2803711381315375 + "timestamp": 3.413388797204361 }, { - "x": 4.985247891548803, - "y": 1.7980149815274176, - "heading": 2.7748175378300544, - "angularVelocity": -0.0014215605072442536, - "velocityX": -3.7179266684142243, - "velocityY": 1.3921631432222419, + "x": 4.903495044321948, + "y": 1.8292728777764504, + "heading": 2.766937009602399, + "angularVelocity": -0.0015557732759970146, + "velocityX": -3.5313185438349777, + "velocityY": 1.3242109162117603, "moduleForcesX": [ - 0.001475856701570743, - 0.0014757943892858075, - 0.0014758888252835915, - 0.0014758265129986559 + 0.0010892896607136175, + 0.0010891225627036043, + 0.0010893778384575773, + 0.0010892107404475615 ], "moduleForcesY": [ - 0.003941365145401281, - 0.003941389083148754, - 0.003941448766550271, - 0.003941472704297744 + 0.002904637990345418, + 0.0029047036980851936, + 0.0029048622306798427, + 0.0029049279384196244 ], - "timestamp": 3.361576561871979 + "timestamp": 3.4924006634028415 }, { - "x": 4.683352553327882, - "y": 1.911120366719257, - "heading": 2.77470166124187, - "angularVelocity": -0.0014269562653176273, - "velocityX": -3.7176745630424253, - "velocityY": 1.392830429077746, + "x": 4.6244933985494985, + "y": 1.933939583482744, + "heading": 2.7668139676158936, + "angularVelocity": -0.0015572595918266297, + "velocityX": -3.531136007743285, + "velocityY": 1.3246960329144357, "moduleForcesX": [ - 0.04402948835625871, - 0.04425896362882348, - 0.0439111468017011, - 0.04414062207567931 + 0.032790520589515496, + 0.03285528776957622, + 0.032756330570521824, + 0.0328210977506596 ], "moduleForcesY": [ - 0.11688472651519642, - 0.11679654129683462, - 0.11657677855451694, - 0.11648859333560278 + 0.08724249386313424, + 0.08721701632801891, + 0.08715557843540787, + 0.08713010090026041 ], - "timestamp": 3.4427819856124207 + "timestamp": 3.571412529601322 }, { - "x": 4.388149882175546, - "y": 2.023490901110545, - "heading": 2.7531166048918894, - "angularVelocity": -0.2658080625128395, - "velocityX": -3.6352580598051922, - "velocityY": 1.3837811468167465, + "x": 4.347461759415901, + "y": 2.039177693852194, + "heading": 2.7612196194953933, + "angularVelocity": -0.07080389806825951, + "velocityX": -3.5062029599159743, + "velocityY": 1.331927917068659, "moduleForcesX": [ - 12.043870771869061, - 22.83840056240313, - 5.860331369774312, - 16.90529380786774 + 3.7842699416281302, + 6.787368546566622, + 2.1704396914350492, + 5.18202223179837 ], "moduleForcesY": [ - 8.365079303422721, - 3.623159020545799, - -6.955883377496195, - -11.362059153742544 + 3.927000047117058, + 2.7165308525255325, + -0.11954942939422283, + -1.3250575905080704 ], - "timestamp": 3.5239874093528623 + "timestamp": 3.6504243957998024 }, { - "x": 4.139244616295801, - "y": 2.117659437341253, - "heading": 2.6582966359163365, - "angularVelocity": -1.1676556147115003, - "velocityX": -3.065131051779582, - "velocityY": 1.159633579792663, + "x": 4.112021737626803, + "y": 2.1280236238213828, + "heading": 2.6649584476590715, + "angularVelocity": -1.2183128492941773, + "velocityX": -2.9798058584980724, + "velocityY": 1.1244631248932273, "moduleForcesX": [ - 114.3035613459115, - 114.17872059898714, - 80.10523084516268, - 90.1993984029834 + 111.18079581607803, + 114.73981520594828, + 66.3526187121827, + 86.14799527800557 ], "moduleForcesY": [ - 10.797887995941974, - -14.08163508293908, - -82.12682115917214, - -71.37399843226972 + 28.1775493785711, + -7.795647023550137, + -93.37826671539518, + -76.14784747221287 ], - "timestamp": 3.605192833093304 + "timestamp": 3.729436261998283 }, { - "x": 3.94041859179872, - "y": 2.1929455154015076, - "heading": 2.5635212544140145, - "angularVelocity": -1.1671065445733562, - "velocityX": -2.4484328181402284, - "velocityY": 0.9271065230925025, + "x": 3.924034265973, + "y": 2.199126658591582, + "heading": 2.567804226434134, + "angularVelocity": -1.2296155742086001, + "velocityX": -2.379230876303722, + "velocityY": 0.8999032448061102, "moduleForcesX": [ - 107.82986538656019, - 107.83281776344131, - 107.84823135382315, - 107.85118599185446 + 108.16057441934431, + 108.09863736885157, + 107.77431358980552, + 107.71338177916209 ], "moduleForcesY": [ - -40.68978365444929, - -40.681753184811356, - -40.64114069086622, - -40.63309333309364 + -39.756848729907496, + -39.92967545115846, + -40.79094897344794, + -40.956213851485444 ], - "timestamp": 3.6863982568337454 + "timestamp": 3.8084481281967633 }, { - "x": 3.7915340474498773, - "y": 2.2493986724180166, - "heading": 2.4848150038175776, - "angularVelocity": -0.9692240612893903, - "velocityX": -1.833431038112992, - "velocityY": 0.6951894887828133, + "x": 3.783322108255196, + "y": 2.252475144339107, + "heading": 2.487030748526135, + "angularVelocity": -1.0222955334973765, + "velocityX": -1.7808990533691496, + "velocityY": 0.6751958701179381, "moduleForcesX": [ - 103.58820516720523, - 104.92855177072477, - 110.11774866337021, - 111.54097597186704 + 103.30559580568975, + 104.71639898474407, + 110.30262425390252, + 111.80970500266959 ], "moduleForcesY": [ - -50.72193464209301, - -47.84626346354833, - -34.33041579719783, - -29.320464413930928 + -51.28282431794387, + -48.29042179755711, + -33.715070554259036, + -28.25140262149227 ], - "timestamp": 3.767603680574187 + "timestamp": 3.8874599943952437 }, { - "x": 3.6924057837846056, - "y": 2.287032791210217, - "heading": 2.428974326530829, - "angularVelocity": -0.6876471387580406, - "velocityX": -1.2207098873360598, - "velocityY": 0.4634434137366357, + "x": 3.6896630853349937, + "y": 2.288054717515041, + "heading": 2.4297305576238934, + "angularVelocity": -0.7252099419889863, + "velocityX": -1.185379202219164, + "velocityY": 0.45030670566059755, "moduleForcesX": [ - 101.33099886518957, - 103.65261141150002, - 110.70643780421159, - 112.89020105896144 + 100.76683441661493, + 103.22725405324366, + 110.9081905642704, + 113.21054868518621 ], "moduleForcesY": [ - -55.169911771348715, - -50.63164845334588, - -32.514911041205714, - -23.78302612297838 + -56.18800584688867, + -51.48157539975731, + -31.812049876456324, + -22.18877488158011 ], - "timestamp": 3.8488091043146286 + "timestamp": 3.966471860593724 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -0.3599432148672905, - "velocityX": -0.6097006638724116, - "velocityY": 0.23169454365301467, + "angularVelocity": -0.3795072034311282, + "velocityX": -0.5919149181654807, + "velocityY": 0.22519310259260125, "moduleForcesX": [ - 99.95294038557154, - 102.93131489378752, - 110.96142635507852, - 113.53712518846511 + 99.2333325232405, + 102.38974249930051, + 111.1591753938583, + 113.85285218516327 ], "moduleForcesY": [ - -57.66959867695029, - -52.12981175149356, - -31.706597373135576, - -20.595444632987434 + -58.89587684714718, + -53.17708736580895, + -31.00181733914535, + -18.756970960294648 ], - "timestamp": 3.9300145280550702 + "timestamp": 4.045483726792205 }, { "x": 3.6428947830200182, "y": 2.305847644805908, "heading": 2.3997449852450337, - "angularVelocity": -8.79545003714153e-24, - "velocityX": 4.316544263240465e-24, - "velocityY": -5.434912078864282e-24, + "angularVelocity": -2.40180265717108e-22, + "velocityX": -4.286083557700099e-21, + "velocityY": -4.01439908756407e-21, "moduleForcesX": [ - 99.09462528312669, - 102.27730985577772, - 111.18836910911212, - 113.90720400078715 + 98.28908180907341, + 101.63548974867733, + 111.386618425042, + 114.21009011513806 ], "moduleForcesY": [ - -59.15782976040057, - -53.43303751633107, - -30.94741332746105, - -18.52517210548361 + -60.484600758107796, + -54.63738777077898, + -30.223370855342147, + -16.543544482929317 ], - "timestamp": 4.011219951795511 + "timestamp": 4.1244955929906855 }, { - "x": 3.6616731557377156, - "y": 2.2989594406099587, - "heading": 2.4410880866235765, - "angularVelocity": 0.7787767050645694, - "velocityX": 0.3537267099935761, - "velocityY": -0.12975255335628544, + "x": 3.662000323031767, + "y": 2.29858470070828, + "heading": 2.4486274500127516, + "angularVelocity": 0.8951923925432088, + "velocityX": 0.34988280879900624, + "velocityY": -0.1330074564480108, "moduleForcesX": [ - 82.3066869172237, - 72.94619674814246, - 115.0598645177216, - 108.15778531261908 + 80.10356434853756, + 63.35936817512299, + 115.2316867824649, + 105.25411125517041 ], "moduleForcesY": [ - -80.865849592635, - -89.24912908119805, - -8.857475561829947, - 40.14347495933029 + -83.05086248624924, + -96.27483320533042, + -6.26802981925732, + 47.23912873712468 ], - "timestamp": 4.064307186056216 + "timestamp": 4.1791011338497235 }, { - "x": 3.6997800232665217, - "y": 2.285572424541842, - "heading": 2.5213675068235353, - "angularVelocity": 1.5122170389535854, - "velocityX": 0.7178160260085905, - "velocityY": -0.2521701545492991, + "x": 3.7010345624145904, + "y": 2.284649401499804, + "heading": 2.5430898851953367, + "angularVelocity": 1.7299056780050255, + "velocityX": 0.7148402665507606, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - 86.98787858056687, - 77.9377516249161, - 115.19177113993021, - 109.44062121610627 + 85.95725612054815, + 71.53272845126975, + 115.3379810170131, + 106.80144207930023 ], "moduleForcesY": [ - -75.788435232065, - -84.91967760133532, - -6.703058984175722, - 36.43023788237517 + -76.95483823713558, + -90.36459624820597, + -3.342055562829985, + 43.55724850599804 ], - "timestamp": 4.117394420316921 + "timestamp": 4.2337066747087615 }, { - "x": 3.757822755958072, - "y": 2.266103908321777, - "heading": 2.6373918445703044, - "angularVelocity": 2.1855412014306013, - "velocityX": 1.0933463289217327, - "velocityY": -0.36672688813391646, + "x": 3.7609128945257986, + "y": 2.2646755465629314, + "heading": 2.6785263195998334, + "angularVelocity": 2.4802690766147815, + "velocityX": 1.0965614692066081, + "velocityY": -0.3657843988476258, "moduleForcesX": [ - 92.33620304947925, - 83.00336971918547, - 115.29369779681878, - 111.16605663240459 + 92.6408907817173, + 79.8109340460071, + 115.36188623484176, + 109.25337437613233 ], "moduleForcesY": [ - -69.1441009465064, - -79.96612718536689, - -4.100219448058572, - 30.640263168121162 + -68.72829018973381, + -83.13387654195829, + -0.01588573486371081, + 36.84729749065968 ], - "timestamp": 4.1704816545776255 + "timestamp": 4.2883122155677995 }, { - "x": 3.8365376380625946, - "y": 2.240892161139712, - "heading": 2.7835277232467326, - "angularVelocity": 2.75274989762646, - "velocityX": 1.4827459595646495, - "velocityY": -0.4749116719521142, + "x": 3.8427641734312834, + "y": 2.239145023664725, + "heading": 2.8462122994823584, + "angularVelocity": 3.070860158960799, + "velocityX": 1.4989555568505595, + "velocityY": -0.46754454761490494, "moduleForcesX": [ - 98.13983385768609, - 89.6537987560601, - 115.30493503306579, - 113.54027185482593 + 99.85169207378267, + 90.33198646116189, + 115.31328266124063, + 113.07409659910392 ], "moduleForcesY": [ - -60.57623674894674, - -72.40887140224785, - -2.6215553765170494, - 19.854158299778444 + -57.683472950501404, + -71.52890617387136, + 1.148298109984689, + 22.21299020856557 ], - "timestamp": 4.22356888883833 + "timestamp": 4.3429177564268375 }, { - "x": 3.936752649120614, - "y": 2.2100571586229654, - "heading": 2.9498502589606272, - "angularVelocity": 3.1330043470922764, - "velocityX": 1.8877421748112806, - "velocityY": -0.5808364844421804, + "x": 3.9477930443039067, + "y": 2.2082229653738414, + "heading": 3.029985195135523, + "angularVelocity": 3.3654624194194365, + "velocityX": 1.9234105041419012, + "velocityY": -0.5662805972512616, "moduleForcesX": [ - 104.20314131415655, - 98.79018954476513, - 115.13565568271744, - 115.19744688183164 + 107.44888382024823, + 103.975334938706, + 115.03616740781044, + 115.0584177361961 ], "moduleForcesY": [ - -49.313671267244956, - -59.28296150266422, - -5.743342962263197, - 1.0055309166363822 + -41.650556611005165, + -49.54196790951779, + -6.70703170713735, + -4.805861192354321 ], - "timestamp": 4.276656123099035 + "timestamp": 4.3975232972858755 }, { - "x": 4.059100997611248, - "y": 2.173622833296401, - "heading": 3.1200647667331736, - "angularVelocity": 3.2063171145183946, - "velocityX": 2.304666087703798, - "velocityY": -0.686310481869143, + "x": 4.076161986406392, + "y": 2.1725870949498374, + "heading": 3.1988525982358644, + "angularVelocity": 3.0924957512327635, + "velocityX": 2.3508409601484432, + "velocityY": -0.6526053924820007, "moduleForcesX": [ - 110.54551793687573, - 109.90169912281651, - 112.97822127254379, - 112.66305677296599 + 114.85560912614943, + 115.06107533407756, + 105.27999779546317, + 109.41725119475669 ], "moduleForcesY": [ - -32.324872357465075, - -34.3824182667869, - -22.35582603859909, - -23.788977760078865 + -5.214634192772637, + -2.4841907717448946, + -46.33549153296675, + -35.76089164102011 ], - "timestamp": 4.32974335735974 + "timestamp": 4.452128838144914 }, { - "x": 4.2024312304797915, - "y": 2.132928127562045, - "heading": 3.261251480451447, - "angularVelocity": 2.6595228718249397, - "velocityX": 2.699900171191161, - "velocityY": -0.766562928000904, + "x": 4.2246947832316, + "y": 2.134500210018156, + "heading": 3.318391686056822, + "angularVelocity": 2.1891384269875385, + "velocityX": 2.720104855451194, + "velocityY": -0.6974912130254503, "moduleForcesX": [ - 113.57345993390184, - 114.04991592545962, - 89.38373476732211, - 105.87431225446016 + 99.09147098340235, + 109.45603084784327, + 71.24101923486774, + 104.32045073180943 ], "moduleForcesY": [ - 16.388126000917513, - 15.248423187591555, - -72.30427165301604, - -45.19852750676215 + 56.72721933126937, + 35.13049278248973, + -90.04553565784443, + -48.50248817218731 ], - "timestamp": 4.382830591620444 + "timestamp": 4.506734379003952 }, { - "x": 4.364807109525649, - "y": 2.0894373328590015, - "heading": 3.3570269479832517, - "angularVelocity": 1.8041148472994926, - "velocityX": 3.0586614900382436, - "velocityY": -0.8192326330180512, + "x": 4.393347194762179, + "y": 2.093252415972482, + "heading": 3.3910237215163614, + "angularVelocity": 1.3301220776667309, + "velocityX": 3.088558576243185, + "velocityY": -0.7553774469912, "moduleForcesX": [ - 101.90531447708315, - 109.62064454997088, - 68.59046833424642, - 103.74089498833104 + 102.8702924113868, + 109.18925395485235, + 67.57717450786018, + 103.62950593233244 ], "moduleForcesY": [ - 50.944118168520156, - 34.455539676082644, - -92.07044431884987, - -49.68325972504405 + 46.811129640319855, + 34.90205221921152, + -92.47525829145376, + -49.45128884065186 ], - "timestamp": 4.435917825881149 + "timestamp": 4.56133991986299 }, { - "x": 4.546172796843396, - "y": 2.042600207999433, - "heading": 3.409334723238229, - "angularVelocity": 0.985317392842509, - "velocityX": 3.416370994711852, - "velocityY": -0.8822671874288422, + "x": 4.581769294393391, + "y": 2.047917121127897, + "heading": 3.41840428762759, + "angularVelocity": 0.5014246847570052, + "velocityX": 3.450604035176878, + "velocityY": -0.8302325026249093, "moduleForcesX": [ - 104.44398071027045, - 109.28660232154968, - 65.84867153585355, - 103.15267730358437 + 103.51069866239682, + 108.8300334396521, + 62.58815342260189, + 101.67145570587108 ], "moduleForcesY": [ - 42.21513175186775, - 34.370980784960636, - -93.67244040685424, - -50.35760769522869 + 36.02257862078937, + 32.94109351617987, + -94.87769053752216, + -51.95034586329381 ], - "timestamp": 4.489005060141854 + "timestamp": 4.615945460722028 }, { - "x": 4.746163412022853, - "y": 1.9916718961789543, - "heading": 3.419257741737168, - "angularVelocity": 0.18691910846604462, - "velocityX": 3.7672072761848523, - "velocityY": -0.9593325500887032, + "x": 4.779931030558261, + "y": 1.9924964021643286, + "heading": 3.41891011940239, + "angularVelocity": 0.009263378163504843, + "velocityX": 3.628967556175626, + "velocityY": -1.0149284869576565, "moduleForcesX": [ - 103.69547133936663, - 108.88611511085561, - 61.605286218644885, - 101.19104160044986 + 24.817065640960916, + 68.62335338934336, + 29.726644848301333, + 62.36699327831083 ], "moduleForcesY": [ - 33.35515323370187, - 32.17777064720978, - -95.34817206799453, - -52.64097605577242 + -40.262984429708354, + -16.137970502976035, + -76.60001892131636, + -59.12012311674933 ], - "timestamp": 4.542092294402559 + "timestamp": 4.670551001581066 }, { - "x": 4.948548056720655, - "y": 1.9334264581702532, - "heading": 3.419700898757884, - "angularVelocity": 0.00834771347363082, - "velocityX": 3.8123034193854215, - "velocityY": -1.0971646728225626, + "x": 4.977773623848627, + "y": 1.9359085884076386, + "heading": 3.419390968552955, + "angularVelocity": 0.00880586737170981, + "velocityX": 3.6231230416907465, + "velocityY": -1.0363016804973941, "moduleForcesX": [ - 2.812586615495257, - 17.25271454920937, - 7.564782178529809, - 20.62061668455904 + -1.5405489498138385, + -1.510675380723342, + -1.5290615087928063, + -1.4991886990742376 ], "moduleForcesY": [ - -31.60789016315328, - -27.37914757437569, - -46.16688797563849, - -42.31980344027108 + -5.542359638354407, + -5.533911414001032, + -5.5823054708698105, + -5.5738580554539885 ], - "timestamp": 4.595179528663263 + "timestamp": 4.725156542440104 }, { - "x": 5.150726101198334, - "y": 1.8744592854650957, - "heading": 3.4201379344296425, - "angularVelocity": 0.008232406111274728, - "velocityX": 3.8084117075078177, - "velocityY": -1.1107599317677133, + "x": 5.175588208613072, + "y": 1.879222681311638, + "heading": 3.4198714630845712, + "angularVelocity": 0.008799373178195607, + "velocityX": 3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - -1.0463397310112488, - -1.0386065335580354, - -1.043365533090219, - -1.0356323686011837 + -0.13367893133837125, + -0.13325583842743188, + -0.13351671673397217, + -0.1330936238433616 ], "moduleForcesY": [ - -3.632488642177522, - -3.6302851430130465, - -3.6428507946426043, - -3.6406473318268646 + -0.4669309252934178, + -0.46681005875097636, + -0.4674986887694729, + -0.467377822245837 ], - "timestamp": 4.648266762923968 + "timestamp": 4.779762083299142 }, { - "x": 5.352939271336686, - "y": 1.8156128822911926, - "heading": 3.420575141677368, - "angularVelocity": 0.008235638074089262, - "velocityX": 3.8090733667778998, - "velocityY": -1.1084850057344409, + "x": 5.373420765486743, + "y": 1.8225996642524482, + "heading": 3.4203520212322216, + "angularVelocity": 0.008800538188806615, + "velocityX": 3.622939243187224, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - 0.17713577681591305, - 0.17691923574920496, - 0.17705253096230064, - 0.1768359898999078 + 0.08564191211003895, + 0.08556602339215008, + 0.08561276387479577, + 0.08553687515723264 ], "moduleForcesY": [ - 0.6084010281485345, - 0.608339005673639, - 0.6086916074370062, - 0.6086295849669343 + 0.299464024459614, + 0.29944230488278817, + 0.2995658636364578, + 0.299544144060668 ], - "timestamp": 4.701353997184673 + "timestamp": 4.83436762415818 }, { - "x": 5.555686581701234, - "y": 1.758638103797458, - "heading": 3.4210165739729597, - "angularVelocity": 0.008315224963949961, - "velocityX": 3.8191349236406045, - "velocityY": -1.0732293608278416, + "x": 5.5714815297149025, + "y": 1.7667822918576632, + "heading": 3.4208346701386514, + "angularVelocity": 0.008838826588608227, + "velocityX": 3.6271184409553947, + "velocityY": -1.0221924646598644, "moduleForcesX": [ - 2.6950741764387947, - 2.6897109379860757, - 2.692979528513537, - 2.687616330679195 + 1.0885317610039127, + 1.0860355533928958, + 1.0875689835908162, + 1.0850727795645088 ], "moduleForcesY": [ - 9.427648428799428, - 9.426146941870284, - 9.434773571052796, - 9.433272128119771 + 3.8354425637576255, + 3.8347296996098477, + 3.8387867944504532, + 3.8380739343659793 ], - "timestamp": 4.7544412314453774 + "timestamp": 4.888973165017218 }, { - "x": 5.761511331352785, - "y": 1.7140924382303229, - "heading": 3.4214952082673102, - "angularVelocity": 0.009015996049068666, - "velocityX": 3.877104402176408, - "velocityY": -0.8391031513975044, + "x": 5.771617683669556, + "y": 1.7189715185814523, + "heading": 3.4213444792775793, + "angularVelocity": 0.009336216268676605, + "velocityX": 3.665125384826737, + "velocityY": -0.8755663349188748, "moduleForcesX": [ - 15.553365313685392, - 15.492703910893727, - 15.519558726536253, - 15.458920515444706 + 9.90983117572121, + 9.8740945473826, + 9.893348215058872, + 9.85761782165404 ], "moduleForcesY": [ - 62.60222625959512, - 62.59915932231855, - 62.65272108090147, - 62.64965481461626 + 38.11330911683303, + 38.106672803056995, + 38.15370784735131, + 38.147075598526285 ], - "timestamp": 4.807528465706082 + "timestamp": 4.943578705876256 }, { - "x": 5.970718661187601, - "y": 1.6902969703482533, - "heading": 3.42208259465482, - "angularVelocity": 0.011064550558905548, - "velocityX": 3.9408217954513325, - "velocityY": -0.4482333316746726, + "x": 5.975591068141504, + "y": 1.6921473086815817, + "heading": 3.4219745074492076, + "angularVelocity": 0.011537806634941703, + "velocityX": 3.7353972007803753, + "velocityY": -0.4912360445090396, "moduleForcesX": [ - 17.268411937350706, - 16.98946609878052, - 17.097483761569833, - 16.819178445964624 + 18.49602168404423, + 18.223496328433463, + 18.32464726681692, + 18.05270477943307 ], "moduleForcesY": [ - 104.50562642972609, - 104.53971564488901, - 104.56645125313041, - 104.60007764054373 + 99.88968062550072, + 99.92208309280707, + 99.96866077815221, + 100.00063874310942 ], - "timestamp": 4.860615699966787 + "timestamp": 4.998184246735294 }, { "x": 6.181192436218261, "y": 1.6887441873550415, "heading": 3.422910026358796, - "angularVelocity": 0.015586265050321107, - "velocityX": 3.9646777226526373, - "velocityY": -0.02924964946537556, + "angularVelocity": 0.017132307360596073, + "velocityX": 3.7652107248147186, + "velocityY": -0.06232190493864833, "moduleForcesX": [ - 6.920274693383353, - 6.185721571576322, - 6.573955564662514, - 5.844740651408007 + 8.398980799856114, + 7.52927101550806, + 7.973097440144859, + 7.110732370059712 ], "moduleForcesY": [ - 112.03161900342096, - 112.06720187117624, - 112.08016014025495, - 112.11336799839647 + 111.47999858137477, + 111.53171815583704, + 111.54866670440515, + 111.59688033555022 ], - "timestamp": 4.913702934227492 + "timestamp": 5.052789787594332 }, { - "x": 6.465968895774687, - "y": 1.7288019189642057, - "heading": 3.422924487082232, - "angularVelocity": 0.00019962394982911663, - "velocityX": 3.9312142249265274, - "velocityY": 0.5529794301309958, + "x": 6.456062631790769, + "y": 1.727703498460738, + "heading": 3.422924495572841, + "angularVelocity": 0.00019656089199281753, + "velocityX": 3.734047381979395, + "velocityY": 0.5292531383220516, "moduleForcesX": [ - -7.872028825010754, - -5.868356427204452, - -7.274148654405582, - -5.224526232357825 + -7.435057509899166, + -5.273262788820908, + -6.776645494666261, + -4.561459737278193 ], "moduleForcesY": [ - 114.06618405796583, - 114.19123917565138, - 114.07858878844016, - 114.19557828660732 + 114.0531263361637, + 114.17857048927304, + 114.06354518890139, + 114.17906174500054 ], - "timestamp": 4.986142756445969 + "timestamp": 5.126401653608416 }, { - "x": 6.742077877622993, - "y": 1.8092440058536328, - "heading": 3.4229355818017693, - "angularVelocity": 0.00015315774111255494, - "velocityX": 3.8115634935652754, - "velocityY": 1.110467756903315, + "x": 6.7217978144093875, + "y": 1.808082946654349, + "heading": 3.42293562945149, + "angularVelocity": 0.00015125113996228022, + "velocityX": 3.609950365444831, + "velocityY": 1.0919360226275563, "moduleForcesX": [ - -23.458196144337897, - -23.45209662796528, - -23.457565603079534, - -23.451465640201203 + -23.942282612665448, + -23.936485990546096, + -23.941716534513144, + -23.93591950874849 ], "moduleForcesY": [ - 109.28244000142513, - 109.28376366394924, - 109.28229674147879, - 109.2836204695592 + 108.54454153578949, + 108.54583486390915, + 108.54435575416598, + 108.54564914640099 ], - "timestamp": 5.0585825786644465 + "timestamp": 5.2000135196225 }, { - "x": 7.009582372988793, - "y": 1.914830245749957, - "heading": 3.422947466162008, - "angularVelocity": 0.00016405838494088897, - "velocityX": 3.6927823284686, - "velocityY": 1.4575717700946087, + "x": 6.980422996045719, + "y": 1.9090269564051716, + "heading": 3.4229468108149086, + "angularVelocity": 0.0001518962094530346, + "velocityX": 3.513362663389737, + "velocityY": 1.371300786363831, "moduleForcesX": [ - -23.28390223274763, - -23.28472907960402, - -23.284015169836888, - -23.284842009273003 + -18.632354987403158, + -18.632396331688668, + -18.63236369292651, + -18.632405037196442 ], "moduleForcesY": [ - 68.04180366771824, - 68.04154028777829, - 68.04230771680372, - 68.0420443393723 + 53.89122312286404, + 53.8912102638437, + 53.89125746714164, + 53.891244608126165 ], - "timestamp": 5.131022400882924 + "timestamp": 5.273625385636584 }, { - "x": 7.246754939031006, - "y": 2.0101276114817614, - "heading": 3.4430257322940507, - "angularVelocity": 0.2771716649370985, - "velocityX": 3.2740633366949092, - "velocityY": 1.3155383712067839, + "x": 7.22592193699581, + "y": 2.005996792188081, + "heading": 3.442580254906685, + "angularVelocity": 0.2667157505288677, + "velocityX": 3.3350457506826596, + "velocityY": 1.3173125615964607, "moduleForcesX": [ - -75.11544611300371, - -81.01560658870949, - -83.80155867415714, - -88.38909893685336 + -25.84642277568509, + -37.283285847412664, + -31.7140815077526, + -42.75006123891945 ], "moduleForcesY": [ - -40.252101440111836, - -39.65492799695394, - -14.151996507909777, - -17.310769456098647 + -18.150014214403896, + -21.015362736520334, + 0.8264239519393268, + -3.3197301936858925 ], - "timestamp": 5.203462223101401 + "timestamp": 5.347237251650668 }, { - "x": 7.4444707246169886, - "y": 2.0895893588177756, - "heading": 3.460038359656544, - "angularVelocity": 0.234851865196239, - "velocityX": 2.729379773871829, - "velocityY": 1.0969345989883763, + "x": 7.430580643705318, + "y": 2.086840876505934, + "heading": 3.459576924522074, + "angularVelocity": 0.23089578536342303, + "velocityX": 2.7802407110607725, + "velocityY": 1.0982479958107094, "moduleForcesX": [ - -107.64208344195724, - -107.57930657167886, - -105.9946310345107, - -105.87575754009714 + -107.73855282640099, + -107.68858293139232, + -106.38126830053612, + -106.2932325280658 ], "moduleForcesY": [ - -40.69712755938141, - -40.83034886509647, - -44.8154800993999, - -45.06642730066164 + -40.462053452478244, + -40.56825627605823, + -43.908556302844424, + -44.096907679115205 ], - "timestamp": 5.275902045319879 + "timestamp": 5.420849117664752 }, { - "x": 7.602668988189531, - "y": 2.153175677565822, - "heading": 3.4737553313586, - "angularVelocity": 0.1893567830783131, - "velocityX": 2.1838577004705892, - "velocityY": 0.8777812645132035, + "x": 7.594334409844189, + "y": 2.151528839125374, + "heading": 3.4734104153440932, + "angularVelocity": 0.1879247405489274, + "velocityX": 2.2245566510641077, + "velocityY": 0.878770857500916, "moduleForcesX": [ - -107.86118930596339, - -107.81855559484973, - -106.08769609512694, - -105.98182204499227 + -108.03895547091055, + -108.00459288569081, + -106.41201988616295, + -106.3243427538483 ], "moduleForcesY": [ - -40.665271439336365, - -40.760587867167544, - -45.090936163588374, - -45.32350556529579 + -40.20672149366401, + -40.28289239333363, + -44.33454527838811, + -44.52996596613114 ], - "timestamp": 5.348341867538356 + "timestamp": 5.494460983678836 }, { - "x": 7.721329395383598, - "y": 2.2008731582030556, - "heading": 3.4840930136480566, - "angularVelocity": 0.14270717366310565, - "velocityX": 1.6380549200713095, - "velocityY": 0.6584428174516908, + "x": 7.717161916361577, + "y": 2.2000505965479666, + "heading": 3.4838947388725474, + "angularVelocity": 0.14242708541647775, + "velocityX": 1.6685829767430076, + "velocityY": 0.659156737220999, "moduleForcesX": [ - -107.93229359869254, - -107.9046739344928, - -106.11256348212791, - -106.01983716415766 + -108.13673727352719, + -108.11666519143746, + -106.4142454273333, + -106.33573686070703 ], "moduleForcesY": [ - -40.66091896254582, - -40.722104405422826, - -45.19805154468384, - -45.40437473586649 + -40.12609997700318, + -40.168809305270365, + -44.49388432552946, + -44.671030285269225 ], - "timestamp": 5.420781689756834 + "timestamp": 5.56807284969292 }, { - "x": 7.800441770095721, - "y": 2.232675064823596, - "heading": 3.4910081314465584, - "angularVelocity": 0.09546017075588673, - "velocityX": 1.0921116630231624, - "velocityY": 0.4390113841614085, + "x": 7.799052561632761, + "y": 2.2324011072432888, + "heading": 3.490935144512255, + "angularVelocity": 0.09564226558745835, + "velocityX": 1.1124652818272118, + "velocityY": 0.43947412892824594, "moduleForcesX": [ - -107.96697591893106, - -107.94946633207202, - -106.12319819766431, - -106.03987686308871 + -108.18447910649813, + -108.17448806116079, + -106.4131822395508, + -106.34236528854645 ], "moduleForcesY": [ - -40.66122527870853, - -40.69852018667486, - -45.25595136469539, - -45.442664241769286 + -40.08848562489677, + -40.10668496598445, + -44.57832391748555, + -44.739176472038416 ], - "timestamp": 5.493221511975311 + "timestamp": 5.6416847157070045 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 0.047850528600588006, - "velocityX": 0.5460840279946026, - "velocityY": 0.21952416540924652, + "angularVelocity": 0.048080165750899, + "velocityX": 0.5562613826336666, + "velocityY": 0.21975056429240558, "moduleForcesX": [ - -107.98827537545758, - -107.9760433148081, - -106.1299618840012, - -106.05139834798729 + -108.21348472478886, + -108.20892496086536, + -106.41277222504723, + -106.34585019162039 ], "moduleForcesY": [ - -40.660146907176276, - -40.685223309784156, - -45.289831908193264, - -45.466900880102635 + -40.0647979154683, + -40.06999069497862, + -44.62830082076768, + -44.78118450203363 ], - "timestamp": 5.565661334193789 + "timestamp": 5.715296581721089 }, { "x": 7.84, "y": 2.248577356338501, "heading": 3.494474415231445, - "angularVelocity": 9.96657849481802e-27, - "velocityX": -3.894219970851099e-27, - "velocityY": 3.742285984085537e-25, + "angularVelocity": -7.217019249839112e-23, + "velocityX": -2.800882773502241e-22, + "velocityY": -6.277947352339611e-22, "moduleForcesX": [ - -108.00400169154827, - -107.99223491780998, - -106.13622374630016, - -106.05743685003775 + -108.23430457634592, + -108.23038445425982, + -106.41417815468228, + -106.34652059702091 ], "moduleForcesY": [ - -40.65537952997924, - -40.680427924066414, - -45.308334241937345, - -45.48693154917803 + -40.04492733440483, + -40.0495210669214, + -44.65756272827853, + -44.813096423270885 ], - "timestamp": 5.638101156412266 + "timestamp": 5.788908447735173 }, { - "x": 7.806073186138322, - "y": 2.235358433045618, - "heading": 3.4918613466756465, - "angularVelocity": -0.03903296429686534, - "velocityX": -0.5067850635723453, - "velocityY": -0.19745894526536698, + "x": 7.804839503996671, + "y": 2.2353073040625637, + "heading": 3.4910960657051917, + "angularVelocity": -0.049669524785278085, + "velocityX": -0.5169403325880029, + "velocityY": -0.19510035456649585, "moduleForcesX": [ - -108.31646484929273, - -108.31232931165214, - -106.70790819705411, - -106.65379169981476 + -108.91169498268742, + -108.92708748634632, + -106.9592142409582, + -106.900126446355 ], "moduleForcesY": [ - -39.785622400235304, - -39.79042134746788, - -43.91797659035705, - -44.043414234869665 + -38.12247627099087, + -38.06986059379512, + -43.29915093821448, + -43.43729059553137 ], - "timestamp": 5.705046329623423 + "timestamp": 5.856924993914306 }, { - "x": 7.738222310236991, - "y": 2.208924184045344, - "heading": 3.4866679317973803, - "angularVelocity": -0.07757713706835251, - "velocityX": -1.0135290215370247, - "velocityY": -0.3948641512494979, + "x": 7.734523027865804, + "y": 2.20876912539207, + "heading": 3.4843646424620003, + "angularVelocity": -0.0989674369154671, + "velocityX": -1.0338142713932752, + "velocityY": -0.3901723942377354, "moduleForcesX": [ - -108.3005337940833, - -108.28996331730454, - -106.71250484198275, - -106.65261534540024 + -108.89535610590072, + -108.90060339205658, + -106.95804032881327, + -106.88867772089174 ], "moduleForcesY": [ - -39.79230383732628, - -39.813620832555635, - -43.87361916590637, - -44.01229472070399 + -38.122799476396125, + -38.09756002614687, + -43.26132213447986, + -43.42345092393562 ], - "timestamp": 5.77199150283458 + "timestamp": 5.924941540093439 }, { - "x": 7.636451231880714, - "y": 2.1692796518761055, - "heading": 3.478939983461497, - "angularVelocity": -0.11543697573994834, - "velocityX": -1.520215326581841, - "velocityY": -0.5921940338281333, + "x": 7.629057338850315, + "y": 2.1689657018270334, + "heading": 3.4743178967030715, + "angularVelocity": -0.14771031937536128, + "velocityX": -1.5505887161298457, + "velocityY": -0.5852020692172022, "moduleForcesX": [ - -108.27833136732967, - -108.25850057581364, - -106.7190574300644, - -106.65081131519337 + -108.87073710864843, + -108.86109478467073, + -106.95606713413832, + -106.8716907825758 ], "moduleForcesY": [ - -39.80130085429092, - -39.846439015801195, - -43.811116584954355, - -43.969072663952105 + -38.12366762772549, + -38.138546420957574, + -43.20515744662121, + -43.40238220899802 ], - "timestamp": 5.838936676045737 + "timestamp": 5.992958086272572 }, { - "x": 7.500765760992354, - "y": 2.1164324000873393, - "heading": 3.468746003766396, - "angularVelocity": -0.15227355769096984, - "velocityX": -2.0268148453419133, - "velocityY": -0.7894109351554932, + "x": 7.4884537084291525, + "y": 2.1159017878510578, + "heading": 3.4610179809667345, + "angularVelocity": -0.19553941626658541, + "velocityX": -2.067197444146294, + "velocityY": -0.7801618423291158, "moduleForcesX": [ - -108.24396960661254, - -108.21238741016384, - -106.72757461099188, - -106.64913374630179 + -108.8272916619506, + -108.79813451721276, + -106.94957215478411, + -106.8462010419442 ], "moduleForcesY": [ - -39.81751467144124, - -39.892602068069195, - -43.72029844384378, - -43.90165305191429 + -38.13223147648961, + -38.19884241523941, + -43.11962308400627, + -43.36068150975459 ], - "timestamp": 5.905881849256894 + "timestamp": 6.060974632451705 }, { - "x": 7.331175634844102, - "y": 2.0503950328281664, - "heading": 3.456199114656939, - "angularVelocity": -0.18742036964907863, - "velocityX": -2.53326891265683, - "velocityY": -0.9864395607862418, + "x": 7.312734633849349, + "y": 2.049586749721688, + "heading": 3.4445854242099734, + "angularVelocity": -0.24159645968325458, + "velocityX": -2.583475410777514, + "velocityY": -0.9749839098668387, "moduleForcesX": [ - -108.183855436982, - -108.13878069799289, - -106.73793532144539, - -106.64908314006512 + -108.73406931364026, + -108.68110503738541, + -106.92705418988612, + -106.8027512014663 ], "moduleForcesY": [ - -39.8518780520238, - -39.96046705876725, - -43.57763984939865, - -43.78233752560017 + -38.1683694994336, + -38.295224115541835, + -42.972793664038555, + -43.259992948110714 ], - "timestamp": 5.972827022468051 + "timestamp": 6.128991178630838 }, { - "x": 7.12770050187281, - "y": 1.971192793059601, - "heading": 3.441520842474186, - "angularVelocity": -0.21925811046084745, - "velocityX": -3.0394294795458086, - "velocityY": -1.1830911172452596, + "x": 7.101966942274532, + "y": 1.9700480655932946, + "heading": 3.4253557769380705, + "angularVelocity": -0.28272013726275863, + "velocityX": -3.0987708640736242, + "velocityY": -1.1694019852009814, "moduleForcesX": [ - -108.05776232379694, - -107.9996841375153, - -106.74909898164714, - -106.65408367462611 + -108.4418328543596, + -108.3626740241462, + -106.82910549783024, + -106.6908681014183 ], "moduleForcesY": [ - -39.935162352718365, - -40.07355997651351, - -43.31352925259889, - -43.53014008693061 + -38.32060078212658, + -38.50231437653497, + -42.61405148852435, + -42.92203871274227 ], - "timestamp": 6.039772195679208 + "timestamp": 6.197007724809971 }, { - "x": 6.890400374818258, - "y": 1.8789019078745433, - "heading": 3.4253383104250084, - "angularVelocity": -0.24172813771256388, - "velocityX": -3.5446936003297003, - "velocityY": -1.3786040241311397, + "x": 6.861923440131751, + "y": 1.879644856366164, + "heading": 3.4253408600655706, + "angularVelocity": -0.00021931240760809082, + "velocityX": -3.5291927571650676, + "velocityY": -1.3291355457691012, "moduleForcesX": [ - -107.67012594458991, - -107.61137555141406, - -106.74805702593524, - -106.67046549630615 + -82.29673746119303, + -87.67092010469727, + -93.06437688109203, + -96.4143304414556 ], "moduleForcesY": [ - -40.20094963502285, - -40.332102839966765, - -42.591758575557066, - -42.761473825206814 + -48.18808428690188, + -45.81494056023967, + -18.475969737183824, + -20.9148885300259 ], - "timestamp": 6.106717368890365 + "timestamp": 6.265024270989104 }, { - "x": 6.63970170536198, - "y": 1.790758792782665, - "heading": 3.4253261856713713, - "angularVelocity": -0.0001811146802023973, - "velocityX": -3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 6.620578526901708, + "y": 1.7927653335156666, + "heading": 3.4253282976312676, + "angularVelocity": -0.00018469673937319495, + "velocityX": -3.5483264997669806, + "velocityY": -1.2773292342966776, "moduleForcesX": [ - -35.13969892694759, - -46.833559794249325, - -38.37727275192584, - -49.463406566005396 + -3.99339422319668, + -3.9952241861108564, + -3.9940931809806606, + -3.9959231756424614 ], "moduleForcesY": [ - 6.193009340047558, - 1.5254319217031, - 25.2151393395331, - 19.635508817953465 + 10.814957408993067, + 10.814421040029472, + 10.817367033783066, + 10.816830640829638 ], - "timestamp": 6.173662542101522 + "timestamp": 6.3330408171682375 }, { - "x": 6.380206858974069, - "y": 1.7334916000286844, - "heading": 3.425314102432994, - "angularVelocity": -0.00018049454199152838, - "velocityX": -3.8762293671183365, - "velocityY": -0.855434230834672, + "x": 6.37089300513868, + "y": 1.734019661048189, + "heading": 3.42531523506019, + "angularVelocity": -0.0001920499027328796, + "velocityX": -3.6709526694495414, + "velocityY": -0.863696788025089, "moduleForcesX": [ - -27.870780083632145, - -27.87085530338658, - -27.870784334164817, - -27.87085955385131 + -25.601760187553467, + -25.60101320769075, + -25.601692373604028, + -25.60094538718925 ], "moduleForcesY": [ - 97.83083198961785, - 97.83081049698788, - 97.83084453922437, - 97.83082304661343 + 86.35637664311925, + 86.35659720719453, + 86.35613139442144, + 86.35635196045367 ], - "timestamp": 6.240607715312679 + "timestamp": 6.401057363347371 }, { "x": 6.11539939880371, "y": 1.7113943099975586, "heading": 3.4252974360856103, - "angularVelocity": -0.00024895517606207744, - "velocityX": -3.9555870493471943, - "velocityY": -0.3300804071628426, + "angularVelocity": -0.0002616859511262737, + "velocityX": -3.756344899696669, + "velocityY": -0.3326448095591715, "moduleForcesX": [ - -16.83891510224018, - -16.829101110309182, - -16.83709390658153, - -16.82727878028723 + -17.83355423810439, + -17.823774151167132, + -17.8318555128472, + -17.822074295255884 ], "moduleForcesY": [ - 111.43563757699793, - 111.43715289160197, - 111.43558589017643, - 111.43710122782548 + 110.86994540179053, + 110.87155302236657, + 110.8698433501265, + 110.87145101626253 ], - "timestamp": 6.307552888523836 + "timestamp": 6.469073909526504 }, { - "x": 5.890352759731499, - "y": 1.7185557092564774, - "heading": 3.4246409084154172, - "angularVelocity": -0.011565209036453538, - "velocityX": -3.9643590696733866, - "velocityY": 0.12615321970899335, + "x": 5.89558522537437, + "y": 1.7193809732535483, + "heading": 3.4243945816435364, + "angularVelocity": -0.015459837026566448, + "velocityX": -3.7639414937610223, + "velocityY": 0.1367579385665902, "moduleForcesX": [ - -3.4491974421125313, - -1.6124094350280327, - -2.7948238151606937, - -0.9207370674714969 + -3.4838005876379103, + -1.0971386415787967, + -2.628739965754029, + -0.17889110374308226 ], "moduleForcesY": [ - 114.11007946252991, - 114.15637546330666, - 114.09921998413924, - 114.13567048098221 + 114.12110918273105, + 114.1762136610545, + 114.10669848112909, + 114.14468636650177 ], - "timestamp": 6.364320359662809 + "timestamp": 6.527473906921175 }, { - "x": 5.66751347319984, - "y": 1.7511786253728163, - "heading": 3.4241561999672547, - "angularVelocity": -0.008538489357326316, - "velocityX": -3.925474960583039, - "velocityY": 0.5746762267509569, + "x": 5.678306514433747, + "y": 1.7542341672793909, + "heading": 3.4237856933580315, + "angularVelocity": -0.01042616973747129, + "velocityX": -3.7205260382502785, + "velocityY": 0.596801294190177, "moduleForcesX": [ - 10.066815271135868, - 9.617734238949494, - 9.834772017122992, - 9.387604811781081 + 11.105143341598554, + 10.385540743401508, + 10.725324626777631, + 10.010565773367157 ], "moduleForcesY": [ - 112.16146590109982, - 112.19647225066659, - 112.19714365211975, - 112.23111915488865 + 111.7997329387048, + 111.86098322186378, + 111.86317871279545, + 111.92171623690527 ], - "timestamp": 6.421087830801782 + "timestamp": 6.5858739043158465 }, { - "x": 5.449395923621346, - "y": 1.8073745478916146, - "heading": 3.423755208658891, - "angularVelocity": -0.0070637514815886995, - "velocityX": -3.8422981542460732, - "velocityY": 0.989931758299116, + "x": 5.466218716119367, + "y": 1.8130618187216272, + "heading": 3.4232962295807683, + "angularVelocity": -0.008381229436627441, + "velocityX": -3.631640544109531, + "velocityY": 1.0073228436069053, "moduleForcesX": [ - 20.95690176428424, - 20.776539685058307, - 20.836146342062943, - 20.656026809805113 + 21.80574823449787, + 21.575934691647497, + 21.64961202366041, + 21.42017480511521 ], "moduleForcesY": [ - 103.83805579833934, - 103.86595800234623, - 103.88375203666156, - 103.91143822729342 + 99.76654159220674, + 99.80080758549977, + 99.83931034438031, + 99.87324161618062 ], - "timestamp": 6.477855301940755 + "timestamp": 6.644273901710518 }, { - "x": 5.234668489636406, - "y": 1.8754073625880365, - "heading": 3.423378777118868, - "angularVelocity": -0.006631113425878504, - "velocityX": -3.7825788198185224, - "velocityY": 1.198447162281897, + "x": 5.256412364228166, + "y": 1.879591648117002, + "heading": 3.422829130798028, + "angularVelocity": -0.007998267184563366, + "velocityX": -3.5925746789561237, + "velocityY": 1.139209458277213, "moduleForcesX": [ - 14.963264037670479, - 14.931138360423935, - 14.946047731779307, - 14.91392768517457 + 9.51707651150292, + 9.492184048188738, + 9.505860938347789, + 9.48097102985699 ], "moduleForcesY": [ - 52.14527104247343, - 52.14197332650841, - 52.17690623845456, - 52.17361050090606 + 32.05649277460031, + 32.05124416889293, + 32.08628241846569, + 32.081035971532025 ], - "timestamp": 6.534622773079728 + "timestamp": 6.702673899105189 }, { - "x": 5.020347307549028, - "y": 1.9447110026462533, - "heading": 3.4230043454794967, - "angularVelocity": -0.006595883731627919, - "velocityX": -3.77542239925918, - "velocityY": 1.2208336687846049, + "x": 5.046797341362997, + "y": 1.9467231127720641, + "heading": 3.4223633386981755, + "angularVelocity": -0.007975892476580843, + "velocityX": -3.589298496857378, + "velocityY": 1.149511432361598, "moduleForcesX": [ - 1.791691136022014, - 1.789481049225279, - 1.7908289271509987, - 1.7886188443613316 + 0.7975621457668832, + 0.796199616592488, + 0.7970342417583864, + 0.7956717132450739 ], "moduleForcesY": [ - 5.598749349977525, - 5.598116183228942, - 5.601705282144552, - 5.6010721201319225 + 2.5042491658536608, + 2.5038569339270924, + 2.506076405059156, + 2.5056841739899895 ], - "timestamp": 6.591390244218701 + "timestamp": 6.761073896499861 }, { - "x": 4.8060405689194825, - "y": 2.0140593339308377, - "heading": 3.4226299265716884, - "angularVelocity": -0.006595659455954859, - "velocityX": -3.7751679673187892, - "velocityY": 1.2216209370118332, + "x": 4.83718667234252, + "y": 2.013868189318054, + "heading": 3.4218974960600224, + "angularVelocity": -0.007976757858485664, + "velocityX": -3.5892239447188996, + "velocityY": 1.1497445126961008, "moduleForcesX": [ - 0.06365505243475648, - 0.06364100877132398, - 0.06364961193025265, - 0.06363556826682583 + 0.018091134855906132, + 0.01814381941382445, + 0.018111488649072027, + 0.018164173207109984 ], "moduleForcesY": [ - 0.19692515330903454, - 0.19692109926184684, - 0.19694399939103238, - 0.1969399453438515 + 0.05670219309874917, + 0.05671736020610039, + 0.056631492064510326, + 0.05664665917205125 ], - "timestamp": 6.648157715357674 + "timestamp": 6.819473893894532 }, { - "x": 4.591500986434119, - "y": 2.082663911446821, - "heading": 3.4222414623759345, - "angularVelocity": -0.006843077346227929, - "velocityX": -3.7792696799923613, - "velocityY": 1.2085191772596529, + "x": 4.627444883786628, + "y": 2.0806013070151304, + "heading": 3.4214303705469638, + "angularVelocity": -0.007998724895503174, + "velocityX": -3.5914691423433216, + "velocityY": 1.1426904225027372, "moduleForcesX": [ - -1.036787029486011, - -1.0212819494693623, - -1.0307777743363744, - -1.0152728109135725 + -0.5468558718662196, + -0.5455180884885984, + -0.5463396795091894, + -0.5450018966009532 ], "moduleForcesY": [ - -3.2691983489948386, - -3.264742509836368, - -3.2899813633807438, - -3.285525660593021 + -1.714525278299725, + -1.7141411533773045, + -1.7163199744295032, + -1.7159358500537125 ], - "timestamp": 6.704925186496647 + "timestamp": 6.8778738912892035 }, { - "x": 4.38796292724594, - "y": 2.1423225294075587, - "heading": 3.392610747831683, - "angularVelocity": -0.5219664351739753, - "velocityX": -3.5854699021186707, - "velocityY": 1.0509296391711191, + "x": 4.416417909538516, + "y": 2.1416951287760204, + "heading": 3.420047169772428, + "angularVelocity": -0.02368494582607703, + "velocityX": -3.6134757476438963, + "velocityY": 1.0461271316163543, "moduleForcesX": [ - 30.062890973818472, - 67.96426240208197, - 32.537435642261514, - 63.348910831469794 + -6.0529764567849105, + -5.056830451597798, + -5.643439292990528, + -4.650734177456534 ], "moduleForcesY": [ - -27.016971831599164, - -8.235178803765258, - -69.73669104087492, - -52.69317016977578 + -22.9799246770692, + -22.73239458103274, + -24.22567299694829, + -23.981026840246923 ], - "timestamp": 6.76169265763562 + "timestamp": 6.936273888683875 }, { - "x": 4.205851179698999, - "y": 2.197165482111936, - "heading": 3.3127396856742903, - "angularVelocity": -1.406986440559581, - "velocityX": -3.208029949072623, - "velocityY": 0.9660982179409718, + "x": 4.227154500888805, + "y": 2.196008775433373, + "heading": 3.3675654380202875, + "angularVelocity": -0.8986598303672014, + "velocityX": -3.240811936525528, + "velocityY": 0.9300282376777734, "moduleForcesX": [ - 104.51767942702163, - 110.90141886725938, - 62.29725541431908, - 99.94508162050462 + 103.48471382580142, + 110.09390991333008, + 52.428343365864905, + 96.4518852319005 ], "moduleForcesY": [ - 39.31182600807883, - 26.855999637561276, - -95.37547475461713, - -55.6735513157081 + 22.285822454061403, + 24.891189153478663, + -100.03845095304497, + -60.05822336141424 ], - "timestamp": 6.818460128774593 + "timestamp": 6.994673886078546 }, { - "x": 4.045155999455634, - "y": 2.247628220403907, - "heading": 3.1785027166359323, - "angularVelocity": -2.3646811518119346, - "velocityX": -2.8307616495715378, - "velocityY": 0.8889375777975367, + "x": 4.060470218367385, + "y": 2.2449867624612265, + "heading": 3.260092297576448, + "angularVelocity": -1.840293582849461, + "velocityX": -2.85418304721754, + "velocityY": 0.8386641988501563, "moduleForcesX": [ - 101.86899395570421, - 112.18575793402451, - 64.1327587652835, - 99.30217040259392 + 104.84618511277098, + 111.9090944895469, + 60.51536896101153, + 98.77086477361023 ], "moduleForcesY": [ - 51.1125109928503, - 24.489794047684235, - -94.97028505916239, - -57.83793809446354 + 42.12552095732997, + 24.43643622108832, + -97.04975471639123, + -58.374344881869824 ], - "timestamp": 6.875227599913566 + "timestamp": 7.053073883473218 }, { - "x": 3.9062696172726583, - "y": 2.2936459171983983, - "heading": 2.9909056327184347, - "angularVelocity": -3.3046581105971597, - "velocityX": -2.4465839220310834, - "velocityY": 0.8106349617342454, + "x": 3.9161905386019207, + "y": 2.2894941451617035, + "heading": 3.0920455097304274, + "angularVelocity": -2.8775136188850934, + "velocityX": -2.470542571952716, + "velocityY": 0.762112751473137, "moduleForcesX": [ - 101.72159587923049, - 113.52781849420327, - 70.87580416849237, - 98.27794501691677 + 98.88615121430338, + 112.5392336152905, + 63.49372991199003, + 98.21581874489458 ], "moduleForcesY": [ - 53.03473995293723, - 18.795877029064727, - -90.29587475253834, - -59.88330637545011 + 57.43559858001414, + 23.427197480933113, + -95.49784743209882, + -59.82012493838729 ], - "timestamp": 6.931995071052539 + "timestamp": 7.111473880867889 }, { - "x": 3.792626772488035, - "y": 2.33297655165956, - "heading": 2.8069419778508737, - "angularVelocity": -3.2406526339212274, - "velocityX": -2.001900780579305, - "velocityY": 0.6928375295224226, + "x": 3.7974323632374913, + "y": 2.329195026608959, + "heading": 2.8883508135329774, + "angularVelocity": -3.4879230356958066, + "velocityX": -2.0335304907952847, + "velocityY": 0.6798096441503758, "moduleForcesX": [ - 110.09590584370159, - 110.15119273382382, - 112.27667812755305, - 112.42030542510648 + 111.51397335746604, + 114.89005050626218, + 95.50645628303386, + 103.13454077524403 ], "moduleForcesY": [ - -33.78436386293684, - -33.54304188428511, - -25.62844767832441, - -24.91070248135434 + 27.766723898869564, + 7.125263794319992, + -63.839976213971326, + -51.101345312959225 ], - "timestamp": 6.988762542191512 + "timestamp": 7.16987387826256 }, { - "x": 3.7033158802608868, - "y": 2.3652177680520627, - "heading": 2.646863089051661, - "angularVelocity": -2.819905230714294, - "velocityX": -1.5732758644207585, - "velocityY": 0.5679523104626665, + "x": 3.705201564787477, + "y": 2.36242075004535, + "heading": 2.7010475242691676, + "angularVelocity": -3.2072482469134465, + "velocityX": -1.5792945644622496, + "velocityY": 0.5689336458673064, "moduleForcesX": [ - 99.97859392638921, - 99.19069955359782, - 114.54734457522899, - 115.15979579307127 + 105.95228683396371, + 106.34982483559641, + 114.4004939951579, + 115.09460575424761 ], "moduleForcesY": [ - -57.39726866081913, - -58.57964610086177, - -13.118869737078962, - 4.137282620864764 + -45.29021140358274, + -44.17247603120534, + -13.870897843783036, + -4.506204608148711 ], - "timestamp": 7.045530013330485 + "timestamp": 7.228273875657232 }, { - "x": 3.637351288782728, - "y": 2.3899438580710273, - "heading": 2.5203397651129293, - "angularVelocity": -2.2287997228023126, - "velocityX": -1.1620139166789638, - "velocityY": 0.4355679321777759, + "x": 3.6378462140543926, + "y": 2.3883393111775315, + "heading": 2.5495404830125357, + "angularVelocity": -2.594298767390968, + "velocityX": -1.1533450982521831, + "velocityY": 0.443810998089987, "moduleForcesX": [ - 92.24578923617231, - 90.92322148643724, - 114.71711750544789, - 113.61714858975364 + 93.92589046885861, + 92.38930111082504, + 114.99151586069087, + 112.97863519241554 ], "moduleForcesY": [ - -69.22716039877031, - -70.7835079678775, - -12.071174524868779, - 19.61978127154983 + -66.89886987254614, + -68.8039200125939, + -8.89032055915772, + 22.896798750871643 ], - "timestamp": 7.1022974844694575 + "timestamp": 7.286673873051903 }, { - "x": 3.5939780893678623, - "y": 2.4067236714663482, - "heading": 2.432378164371663, - "angularVelocity": -1.5495071204762023, - "velocityX": -0.764050230609765, - "velocityY": 0.29558853087258563, + "x": 3.5940010146710293, + "y": 2.4061455217676833, + "heading": 2.442794052924954, + "angularVelocity": -1.8278499118104665, + "velocityX": -0.7507739955372641, + "velocityY": 0.3049008798719044, "moduleForcesX": [ - 86.41137299899842, - 85.10523672353465, - 114.61890071891574, - 112.0617012655451 + 85.27321950996415, + 81.25618436721727, + 114.93039749975732, + 110.08736666214386 ], "moduleForcesY": [ - -76.42757490922749, - -77.71146885299508, - -13.222540301247415, - 27.30004265325952 + -77.68627318980846, + -81.68368062704864, + -10.1185634426013, + 34.38228873619394 ], - "timestamp": 7.1590649556084305 + "timestamp": 7.345073870446575 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": -0.808382599061801, - "velocityX": -0.37681858196384876, - "velocityY": 0.1495853557192894, + "angularVelocity": -0.9641391597034187, + "velocityX": -0.3666774697730115, + "velocityY": 0.15530363813167142, "moduleForcesX": [ - 82.24535135891628, - 79.8120626088092, - 114.54956911255539, - 110.85189362912443 + 79.3416840765363, + 71.24184841573963, + 114.8417411977197, + 108.15322189105376 ], "moduleForcesY": [ - -80.92027537570917, - -83.1630963954796, - -13.95497542675499, - 31.949497180856433 + -83.76752129096906, + -90.57520191146979, + -11.302736000119857, + 40.14476142563526 ], - "timestamp": 7.215832426747403 + "timestamp": 7.403473867841246 }, { "x": 3.5725870513916007, "y": 2.415215253829956, "heading": 2.3864883285101737, - "angularVelocity": 1.3320780406337021e-20, - "velocityX": -7.91420075044239e-20, - "velocityY": -8.454931019375793e-20, + "angularVelocity": -9.0989818312144e-21, + "velocityX": 3.9183156510716546e-20, + "velocityY": 8.026400730264575e-20, "moduleForcesX": [ - 79.74797430779523, - 73.04670295538676, - 114.65423863578631, - 109.59078372653275 + 76.01822070188068, + 59.44757680524343, + 114.93156102990737, + 106.23908134928891 ], "moduleForcesY": [ - -83.4021017998724, - -89.19074412625787, - -13.169435415720322, - 36.089148730291996 + -86.8169640545679, + -98.75016323489919, + -10.497822934908383, + 45.01411898852261 ], - "timestamp": 7.272599897886376 + "timestamp": 7.461873865235917 }, { - "x": 3.5699516392525266, - "y": 2.4137790529276644, - "heading": 2.3478802631089017, - "angularVelocity": -1.127940834097408, - "velocityX": -0.07699398909111405, - "velocityY": -0.04195884012456622, + "x": 3.570016562928905, + "y": 2.414002895867037, + "heading": 2.3443806141589976, + "angularVelocity": -1.1925305688726726, + "velocityX": -0.07279868109514546, + "velocityY": -0.034335132017282326, "moduleForcesX": [ - -63.3144545947333, - 108.01660145288706, - -111.8751367506926, - -60.59422206639 + -56.92485396981133, + 111.21616724439636, + -112.20973399379473, + -59.18934120988699 ], "moduleForcesY": [ - 96.33566340014389, - -39.61846623202172, - -28.183152137146912, - -98.16238982815337 + 100.25021857445346, + -29.64734387785221, + -26.8203043673127, + -99.01585760311711 ], - "timestamp": 7.3068287015914635 + "timestamp": 7.497183412387385 }, { - "x": 3.564378233003473, - "y": 2.4106424063814575, - "heading": 2.2718151756419913, - "angularVelocity": -2.222253752198952, - "velocityX": -0.16282795908031492, - "velocityY": -0.09163763283184874, + "x": 3.5646173348355323, + "y": 2.4113128910817276, + "heading": 2.26113341401117, + "angularVelocity": -2.3576399830539163, + "velocityX": -0.152911281195873, + "velocityY": -0.07618349716500973, "moduleForcesX": [ - -60.25722824108982, - 96.6501538541861, - -112.89494643133519, - -65.93464425581752 + -52.4117542511686, + 102.02820257962003, + -113.30290747157052, + -65.18685502936177 ], "moduleForcesY": [ - 98.21955261781348, - -62.32975378769388, - -23.68993888315466, - -94.63903361003736 + 102.6213053904586, + -53.1486977357208, + -21.639970807289966, + -95.15210347949885 ], - "timestamp": 7.3410575052965505 + "timestamp": 7.532492959538853 }, { - "x": 3.5553617379589757, - "y": 2.4056031463027416, - "heading": 2.159987950024481, - "angularVelocity": -3.267050364395044, - "velocityX": -0.2634183514613645, - "velocityY": -0.14722279288698742, + "x": 3.555904326933192, + "y": 2.4069105734197564, + "heading": 2.1383294220214664, + "angularVelocity": -3.4779259972638497, + "velocityX": -0.2467606810408336, + "velocityY": -0.12467782843824318, "moduleForcesX": [ - -55.647722774813495, - 75.73920484802964, - -114.0316025405405, - -72.98400096210639 + -45.66288067392498, + 82.28667122957205, + -114.43740382724414, + -73.15743467730793 ], "moduleForcesY": [ - 100.80472826924587, - -86.50130488193642, - -17.255130186537396, - -89.28875262327956 + 105.688056546013, + -80.31445254430263, + -14.248499805306832, + -89.13561917035238 ], - "timestamp": 7.375286309001638 + "timestamp": 7.567802506690321 }, { - "x": 3.542210147208017, - "y": 2.3986325839335767, - "heading": 2.0146174838328887, - "angularVelocity": -4.247021527369034, - "velocityX": -0.38422583693780954, - "velocityY": -0.20364609962244665, + "x": 3.5431228593186614, + "y": 2.400727296021074, + "heading": 1.9783355498230653, + "angularVelocity": -4.531178820053225, + "velocityX": -0.3619833344137748, + "velocityY": -0.17511630415825824, "moduleForcesX": [ - -51.5565732083985, - 47.05283368026791, - -114.89682349470701, - -81.07269190656022 + -39.35983727831561, + 51.41808681441776, + -115.13501591899248, + -82.27641388148437 ], "moduleForcesY": [ - 102.76487920670458, - -104.87988948985232, - -9.544434426513986, - -81.9718721787508 + 107.95631863586092, + -102.77876201791744, + -5.581529823014008, + -80.73399410186649 ], - "timestamp": 7.409515112706725 + "timestamp": 7.603112053841789 }, { - "x": 3.5239509110903704, - "y": 2.389814553511627, - "heading": 1.8392865279803854, - "angularVelocity": -5.122322046751736, - "velocityX": -0.5334465170026451, - "velocityY": -0.25762017562547423, + "x": 3.5249509357501743, + "y": 2.3927861943346422, + "heading": 1.7860937401531451, + "angularVelocity": -5.444471118399184, + "velocityX": -0.514646180267788, + "velocityY": -0.2248995619337351, "moduleForcesX": [ - -56.897120992564666, - 13.831328653792013, - -115.20928290206547, - -89.34828449880852 + -49.96209987038422, + 10.940950643937366, + -115.15655922442268, + -91.40372157976795 ], "moduleForcesY": [ - 99.40316122357176, - -114.07904848518908, - -2.1067431308290923, - -72.78432529295594 + 102.6827935808, + -114.29555191993956, + 1.6280187943338387, + -70.09920994331443 ], - "timestamp": 7.443743916411812 + "timestamp": 7.638421600993257 }, { - "x": 3.498669227691315, - "y": 2.3782677142113307, - "heading": 1.6450275698811467, - "angularVelocity": -5.675306673670566, - "velocityX": -0.7386084426695263, - "velocityY": -0.3373427654562614, + "x": 3.4986636063204344, + "y": 2.3808215422611085, + "heading": 1.5804277096948873, + "angularVelocity": -5.824657834777944, + "velocityX": -0.7444822024189094, + "velocityY": -0.3388503404538074, "moduleForcesX": [ - -105.17566327178112, - -23.62733870294902, - -115.09802567519542, - -96.55369553063619 + -112.32060939232774, + -44.01860178950653, + -114.80288651764441, + -98.58413579678934 ], "moduleForcesY": [ - 42.375604431971254, - -112.36357969798489, - 0.4252157545061834, - -62.73241252810446 + -13.981211872806785, + -105.7654815086491, + -4.41159995138123, + -59.14888259144925 ], - "timestamp": 7.477972720116899 + "timestamp": 7.673731148144725 }, { - "x": 3.4654282510227628, - "y": 2.3622293034748987, - "heading": 1.4432142418231406, - "angularVelocity": -5.896008805823804, - "velocityX": -0.9711404744073245, - "velocityY": -0.468564746661713, + "x": 3.464431329562427, + "y": 2.3636059779555727, + "heading": 1.3846008757527926, + "angularVelocity": -5.546002419743707, + "velocityX": -0.9694906765912646, + "velocityY": -0.48756117521604403, "moduleForcesX": [ - -100.91027402459957, - -71.1255356669369, - -113.08371748677206, - -100.75435384797646 + -99.15399456797527, + -112.77483449910136, + -59.73325270721248, + -90.29830581798875 ], "moduleForcesY": [ - -53.21727890658225, - -89.84770615754992, - -19.528589252979987, - -55.16195289043296 + -57.092373513786754, + -17.758976569181463, + -97.05254853411765, + -67.32011989022973 ], - "timestamp": 7.512201523821986 + "timestamp": 7.709040695296193 }, { - "x": 3.4254907189328243, - "y": 2.3409579999268493, - "heading": 1.2552368047325984, - "angularVelocity": -5.491791028110254, - "velocityX": -1.1667814170203163, - "velocityY": -0.6214445509474886, + "x": 3.4235746716849746, + "y": 2.340405903244497, + "heading": 1.2048128445517017, + "angularVelocity": -5.091768252644312, + "velocityX": -1.1570994581774947, + "velocityY": -0.6570482088472442, "moduleForcesX": [ - -101.51984502491118, - -114.25525292589644, - -46.05237264124134, - -62.82771454322337 + -99.77808458384018, + -113.58831274277311, + -42.9977808046872, + -45.43310994172789 ], "moduleForcesY": [ - -53.16497191667841, - -3.066262088111863, - -104.56967598650562, - -92.89456142147945 + -55.91347232549474, + -8.813998457096558, + -105.63471515912464, + -102.28351156220445 ], - "timestamp": 7.546430327527073 + "timestamp": 7.744350242447661 }, { - "x": 3.378727497206346, - "y": 2.3144796562214807, - "heading": 1.0811416380559544, - "angularVelocity": -5.086218267417026, - "velocityX": -1.3661950364785587, - "velocityY": -0.7735690657912138, + "x": 3.375651121627886, + "y": 2.3112861636787048, + "heading": 1.0391515004273537, + "angularVelocity": -4.691687022031433, + "velocityX": -1.3572405743836062, + "velocityY": -0.824698754726991, "moduleForcesX": [ - -103.59778354435822, - -113.857000551391, - -55.858639098030196, - -57.60230783383814 + -101.3199117359912, + -112.23361382448618, + -55.56993463789227, + -52.83399612224958 ], "moduleForcesY": [ - -48.73192117995345, - -7.0383536447927435, - -99.65856579041078, - -97.01327027724552 + -52.730238002466315, + -17.94256872974015, + -99.53598557359503, + -99.48263504998475 ], - "timestamp": 7.58065913123216 + "timestamp": 7.779659789599129 }, { - "x": 3.3246281814333827, - "y": 2.2831821293897963, - "heading": 0.9193928781957939, - "angularVelocity": -4.7255160084990955, - "velocityX": -1.580520202782186, - "velocityY": -0.9143622751583245, + "x": 3.3201483223528383, + "y": 2.2766875060838894, + "heading": 0.8863627179565744, + "angularVelocity": -4.327123817684768, + "velocityX": -1.5718921298242126, + "velocityY": -0.9798669307882836, "moduleForcesX": [ - -106.32220430919398, - -113.45047145453957, - -68.54608055150727, - -67.34185140885786 + -104.49259355735687, + -111.99240207753651, + -66.73912886868585, + -62.075582497913004 ], "moduleForcesY": [ - -42.05389338701554, - -9.493241665913557, - -91.27582657149124, - -90.81548257020026 + -45.65536628701796, + -17.664987423299614, + -92.24565830688351, + -94.04562308108589 ], - "timestamp": 7.614887934937247 + "timestamp": 7.814969336750597 }, { - "x": 3.2626525500968637, - "y": 2.2478394917560407, - "heading": 0.7691200400273281, - "angularVelocity": -4.390245112368141, - "velocityX": -1.8106280275084217, - "velocityY": -1.0325408371953264, + "x": 3.2564602958964812, + "y": 2.237542281220726, + "heading": 0.7461015385201132, + "angularVelocity": -3.9723301699333993, + "velocityX": -1.8037055582489439, + "velocityY": -1.108630045444232, "moduleForcesX": [ - -109.86203798468615, - -113.56537677119788, - -80.19548638705977, - -78.22814414337074 + -108.91840198905898, + -112.87425186361108, + -77.98189938274184, + -73.13263930631419 ], "moduleForcesY": [ - -31.018267527500402, - -2.651547534152617, - -80.99523654285528, - -81.44565214035984 + -32.979908594379154, + -6.223365306851065, + -82.63610290053708, + -85.29569693218967 ], - "timestamp": 7.649116738642334 + "timestamp": 7.850278883902065 }, { - "x": 3.1922610767987623, - "y": 2.2097982307128565, - "heading": 0.6301855969917186, - "angularVelocity": -4.058992076750915, - "velocityX": -2.056498202642201, - "velocityY": -1.1113815537007243, + "x": 3.1839722741315835, + "y": 2.195492918557526, + "heading": 0.6188659770305921, + "angularVelocity": -3.6034322656055986, + "velocityX": -2.052929805470177, + "velocityY": -1.1908779935020866, "moduleForcesX": [ - -113.16894691538705, - -112.19207649662077, - -91.84103538444018, - -90.80572403866798 + -112.86988205346567, + -111.12012886761111, + -90.03734763330685, + -86.88778676806119 ], "moduleForcesY": [ - -13.308928426825096, - 15.928502193313712, - -67.0733667207797, - -66.37795970134016 + -12.348284390719446, + 18.73827221812754, + -68.72148386204621, + -69.97685042740027 ], - "timestamp": 7.683345542347421 + "timestamp": 7.885588431053533 }, { - "x": 3.1131298064145425, - "y": 2.171263792990809, - "heading": 0.5028079946614243, - "angularVelocity": -3.7213571186352805, - "velocityX": -2.3118327787911217, - "velocityY": -1.1257897896174542, + "x": 3.1023875492734194, + "y": 2.153210765788329, + "heading": 0.5052130558756492, + "angularVelocity": -3.2187589568171084, + "velocityX": -2.3105570997041225, + "velocityY": -1.1974708309852726, "moduleForcesX": [ - -112.95185304826352, - -102.63355880151158, - -103.39609116937459, - -104.73192313748356 + -111.86974536596428, + -97.20248405702162, + -102.32583288761865, + -103.03466347126516 ], "moduleForcesY": [ - 13.428590930971126, - 47.503243007308896, - -46.479255255102, - -38.36223908729842 + 18.095398070095523, + 56.63338441320622, + -47.363739496310544, + -37.97062581903604 ], - "timestamp": 7.717574346052508 + "timestamp": 7.920897978205001 }, { - "x": 3.02578800710757, - "y": 2.1355999035659368, - "heading": 0.3862879845211218, - "angularVelocity": -3.404150818247454, - "velocityX": -2.551704700506004, - "velocityY": -1.041926259889298, + "x": 3.01257887441982, + "y": 2.114825451689115, + "heading": 0.4034135111362285, + "angularVelocity": -2.8830600489643863, + "velocityX": -2.5434671951001233, + "velocityY": -1.087108648960283, "moduleForcesX": [ - -102.96113998905054, - -75.57886955728041, - -111.88275135917057, - -107.63125638242771 + -99.43709283642428, + -65.89792156241508, + -111.45218049666224, + -97.88415343386902 ], "moduleForcesY": [ - 48.12217109568619, - 84.19790217808439, - -15.043250131164976, - 21.89000669551637 + 54.220121086403616, + 91.46142231462018, + -11.821171765224456, + 43.674000472763154 ], - "timestamp": 7.751803149757595 + "timestamp": 7.956207525356469 }, { - "x": 2.9316171268882734, - "y": 2.1040278827992327, - "heading": 0.28432561299758846, - "angularVelocity": -2.97884706699173, - "velocityX": -2.7512173966310405, - "velocityY": -0.922381659572107, + "x": 2.9158909866984235, + "y": 2.0821667981242555, + "heading": 0.3132429551119237, + "angularVelocity": -2.553716014467678, + "velocityX": -2.738293054471397, + "velocityY": -0.9249241692269979, "moduleForcesX": [ - -91.61131397646075, - -43.05897579116841, - -110.38138714948137, - -86.02846628911873 + -87.45802427935932, + -47.53439495990343, + -109.56743396568875, + -68.84720326443009 ], "moduleForcesY": [ - 66.29758480169242, - 103.90780630948875, - -16.716151028622146, - 44.888327667528124 + 70.39136956871182, + 101.06114313793599, + 11.616666431402345, + 77.82924862847288 ], - "timestamp": 7.7860319534626825 + "timestamp": 7.9915170725079365 }, { - "x": 2.8306074922176707, - "y": 2.075651949037232, - "heading": 0.19841183467951823, - "angularVelocity": -2.5099848378663183, - "velocityX": -2.951012706750948, - "velocityY": -0.8290074641980628, + "x": 2.813130962272225, + "y": 2.055368279752934, + "heading": 0.23418363443483467, + "angularVelocity": -2.2390352483974785, + "velocityX": -2.9102617483421525, + "velocityY": -0.7589595600407787, "moduleForcesX": [ - -89.70386834247377, - -44.52299290536978, - -107.42487523747174, - -89.89738881434096 + -78.40481006980207, + -40.22780438179953, + -100.43252391685763, + -57.57268745634338 ], "moduleForcesY": [ - 64.70732173234461, - 99.54624373858115, - -14.542075390297216, - 5.237756642149965 + 73.82616586327488, + 98.43131065637236, + 23.180882849082177, + 71.54098213655774 ], - "timestamp": 7.82026075716777 + "timestamp": 8.026826619659404 }, { - "x": 2.7231266517941735, - "y": 2.0493588330157047, - "heading": 0.12883121858131338, - "angularVelocity": -2.0328088792616628, - "velocityX": -3.1400700225912583, - "velocityY": -0.768157609248157, + "x": 2.706553457092742, + "y": 2.0337946936747824, + "heading": 0.1627246194647116, + "angularVelocity": -2.023787353136663, + "velocityX": -3.018376438595981, + "velocityY": -0.6109845018860041, "moduleForcesX": [ - -87.9046551599776, - -51.259757063971065, - -98.52235017226083, - -76.04326290186813 + -53.32161734417227, + -27.711335290285316, + -62.288742887942306, + -30.59724389816153 ], "moduleForcesY": [ - 54.18397152509916, - 83.80305982182196, - -17.328081982863527, - -19.68202367373811 + 67.01241376252486, + 77.76542044514504, + 39.181093379247706, + 54.08148222744581 ], - "timestamp": 7.854489560872857 + "timestamp": 8.062136166810872 }, { - "x": 2.6102927983385573, - "y": 2.024099226519776, - "heading": 0.07355180792033715, - "angularVelocity": -1.6149968645489394, - "velocityX": -3.2964591584264182, - "velocityY": -0.7379634623966059, + "x": 2.598917102909892, + "y": 2.0145528118758143, + "heading": 0.09531658576945162, + "angularVelocity": -1.9090597057532068, + "velocityX": -3.0483640506948286, + "velocityY": -0.5449484162573617, "moduleForcesX": [ - -78.04506650685977, - -47.29571711822892, - -81.43393391647491, - -52.744292996762205 + -18.63096055061113, + -6.33841193513332, + -18.206732192882292, + -5.0635349091313255 ], "moduleForcesY": [ - 39.432934911244786, - 57.97282153083376, - -20.57597862315234, - -26.724282490767077 + 33.453819907756156, + 35.18716748764008, + 17.975782973252848, + 19.612327167077936 ], - "timestamp": 7.888718364577944 + "timestamp": 8.097445713962339 }, { - "x": 2.4921154225710165, - "y": 2.001809725638736, - "heading": 0.03059095186954446, - "angularVelocity": -1.2551083123132423, - "velocityX": -3.4525710213465097, - "velocityY": -0.6511913496333991, + "x": 2.486855159750872, + "y": 1.9975368200862922, + "heading": 0.03970689745149529, + "angularVelocity": -1.5749193293079313, + "velocityX": -3.1737009449118583, + "velocityY": -0.48190909151338635, "moduleForcesX": [ - -72.26596436397355, - -40.418509412740924, - -86.20843132854587, - -60.16598656238315 + -61.42943838905159, + -32.38825659624322, + -68.59433110233935, + -39.21145043822103 ], "moduleForcesY": [ - 57.346191538492576, - 74.57460703230042, - 3.6372831123236704, - 8.435378772879556 + 45.459912121097865, + 56.69472636631261, + -1.2312044805624582, + 0.48491739775957093 ], - "timestamp": 7.922947168283031 + "timestamp": 8.132755261113806 }, { "x": 2.368211784362792, "y": 1.984554409980774, - "heading": 8.034662982186301e-20, - "angularVelocity": -0.8937195741082333, - "velocityX": -3.619864698625451, - "velocityY": -0.5041168194664591, + "heading": -1.4675807226889294e-19, + "angularVelocity": -1.1245371480173394, + "velocityX": -3.360093373022665, + "velocityY": -0.3676742171129455, "moduleForcesX": [ - -72.02828625966096, - -31.013647911650974, - -100.81064597402042, - -73.76190608413815 + -77.99345741141066, + -36.55913016224614, + -102.6300363207676, + -82.65797442710468 ], "moduleForcesY": [ - 78.69145966069489, - 99.5091808063195, - 20.91580851628405, - 44.94549522070697 + 71.69774957942901, + 95.80128612213636, + 4.935080412204652, + 11.330071286860962 ], - "timestamp": 7.957175971988118 + "timestamp": 8.168064808265273 }, { - "x": 2.0740883254919082, - "y": 1.9753101696961048, - "heading": -0.00004639980947503465, - "angularVelocity": -0.0006259678214478826, - "velocityX": -3.967943465052028, - "velocityY": -0.12471165328920732, + "x": 2.0854065230581886, + "y": 1.9779644877217577, + "heading": -0.00005033208333207429, + "angularVelocity": -0.0006710133266615486, + "velocityX": -3.770281033935705, + "velocityY": -0.08785500946361233, "moduleForcesX": [ - -69.66097734031177, - -12.487145015519467, - -111.66054849173405, - -72.91874659974125 + -76.09798989325385, + -18.90105163423638, + -113.03447520897639, + -102.58200087250829 ], "moduleForcesY": [ - 89.98445533687095, - 112.68237698463479, - 15.840843626758858, - 72.2246809246762 + 84.68950673878201, + 111.74911699583157, + 2.6591962220241836, + 12.79589675698398 ], - "timestamp": 8.03130088366123 + "timestamp": 8.243073874899595 }, { - "x": 1.7803191322924656, - "y": 1.9926744865605654, - "heading": -0.00004639408517515487, - "angularVelocity": 7.72250482405318e-8, - "velocityX": -3.9631641585618773, - "velocityY": 0.23425750496730705, + "x": 1.8029757687698704, + "y": 1.9942197501048913, + "heading": -0.00005032500445291454, + "angularVelocity": 9.43736467786952e-8, + "velocityX": -3.7652882106265917, + "velocityY": 0.2167106339607911, "moduleForcesX": [ - 0.8918110984523644, - 0.9389057010061419, - 0.892237576007421, - 0.939354849523593 + 0.9227533462325225, + 0.9672719038047999, + 0.9231321771109395, + 0.9676691170690845 ], "moduleForcesY": [ - 68.78336233513667, - 68.78303298559312, - 68.75324593515143, - 68.7529163377468 + 57.67635291233299, + 57.67606024665079, + 57.64044491345691, + 57.64015211515086 ], - "timestamp": 8.105425795334341 + "timestamp": 8.318082941533918 }, { - "x": 1.5131720290302764, - "y": 2.0099691813791325, - "heading": -0.00003333596655810217, - "angularVelocity": 0.0001761636988471363, - "velocityX": -3.604012432963096, - "velocityY": 0.23331825196411896, + "x": 1.5293571956388503, + "y": 2.0110799320442485, + "heading": -0.00003697534828095201, + "angularVelocity": 0.00017797390063582162, + "velocityX": -3.647806664025621, + "velocityY": 0.22477525312446503, "moduleForcesX": [ - 68.8005510890561, - 68.80569709908875, - 68.80053097288106, - 68.80567698548711 + 22.23658027365265, + 22.24494188533207, + 22.23663920902371, + 22.245000823990633 ], "moduleForcesY": [ - -0.17268609942219681, - -0.1726722397415803, - -0.1871959394376103, - -0.18718088491320875 + 1.5328008081498175, + 1.5327560088702128, + 1.5207191865207947, + 1.5206747766653563 ], - "timestamp": 8.179550707007452 + "timestamp": 8.39309200816824 }, { - "x": 1.2904630248834932, - "y": 2.02439703559534, - "heading": -0.000022300432809716404, - "angularVelocity": 0.00014887752982495307, - "velocityX": -3.004509538290201, - "velocityY": 0.19464244733035105, + "x": 1.3012535504265574, + "y": 2.025140105667011, + "heading": -0.00002503020492197509, + "angularVelocity": 0.00015924932671420783, + "velocityX": -3.041014312634039, + "velocityY": 0.18744632154013477, "moduleForcesX": [ - 114.84738407657306, - 114.84736831647434, - 114.84756609099593, - 114.84755033754627 + 114.8736602533315, + 114.87365016225685, + 114.87377798798217, + 114.87376789982471 ], "moduleForcesY": [ - -7.410516501125932, - -7.410652114275096, - -7.407685716920552, - -7.40782127867839 + -7.0677703063324575, + -7.067858015952402, + -7.065850186961006, + -7.065937872922886 ], - "timestamp": 8.253675618680564 + "timestamp": 8.468101074802563 }, { - "x": 1.1122650673551955, - "y": 2.0359448751096245, - "heading": -0.000013412613719255738, - "angularVelocity": 0.00011990326719923239, - "velocityX": -2.404022527731901, - "velocityY": 0.15578891432912884, + "x": 1.1187395149624608, + "y": 2.0363917821596864, + "heading": -0.000015175728129877333, + "angularVelocity": 0.0001313771419145834, + "velocityX": -2.43322632387727, + "velocityY": 0.1500042194569254, "moduleForcesX": [ - 115.03590480898393, - 115.03589170672048, - 115.03609915116972, - 115.03608605645235 + 115.06211903061896, + 115.06210747733799, + 115.06229497459297, + 115.06228342780778 ], "moduleForcesY": [ - -7.444648447596588, - -7.444793267880781, - -7.44163982701386, - -7.441784589248835 + -7.089643580069927, + -7.089774685050805, + -7.086782838153691, + -7.086913890620375 ], - "timestamp": 8.327800530353676 + "timestamp": 8.543110141436886 }, { - "x": 0.9786025548038448, - "y": 2.0446082921325717, - "heading": -0.0000067187424189621245, - "angularVelocity": 0.00009030528535147962, - "velocityX": -1.8032063652338362, - "velocityY": 0.11687591698101128, + "x": 0.9818398208294886, + "y": 2.0448321500588227, + "heading": -0.00000764773394984441, + "angularVelocity": 0.00010036112323237913, + "velocityX": -1.8251086205401545, + "velocityY": 0.11252463572546331, "moduleForcesX": [ - 115.09895807541444, - 115.09894593189205, - 115.09915696612956, - 115.0991448304989 + 115.12452826743665, + 115.1245166883893, + 115.1247243120354, + 115.12471274104529 ], "moduleForcesY": [ - -7.456071244645336, - -7.456219470556505, - -7.452996933892072, - -7.453145099192222 + -7.0968936617396485, + -7.097039766327108, + -7.093709293863361, + -7.09385533338332 ], - "timestamp": 8.401925442026787 + "timestamp": 8.618119208071208 }, { - "x": 0.8894876979156582, - "y": 2.050385080566063, - "heading": -0.00000224293120630737, - "angularVelocity": 0.000060382010738750023, - "velocityX": -1.202225471528075, - "velocityY": 0.07793315773480675, + "x": 0.8905667965047449, + "y": 2.0504598078795286, + "heading": -0.0000025652413529172724, + "angularVelocity": 0.00006775837675337155, + "velocityX": -1.2168265573775296, + "velocityY": 0.07502636778758441, "moduleForcesX": [ - 115.13051439212589, - 115.13050274279996, - 115.13071565345948, - 115.13070401220862 + 115.15563860808672, + 115.15562710583616, + 115.15584481568848, + 115.15583332234814 ], "moduleForcesY": [ - -7.461789005484244, - -7.461939008917187, - -7.458680439114321, - -7.458830380578413 + -7.100508735512452, + -7.10066242885229, + -7.0971609631741455, + -7.097314584597493 ], - "timestamp": 8.476050353699899 + "timestamp": 8.693128274705531 }, { - "x": 0.8449278259277327, - "y": 2.053273916244506, - "heading": 1.1657882349600636e-23, - "angularVelocity": 0.00003025880443808967, - "velocityX": -0.6011457009815157, - "velocityY": 0.0389725345128547, + "x": 0.8449278259277329, + "y": 2.053273916244507, + "heading": -4.943196764260765e-17, + "angularVelocity": 0.00003419908376374945, + "velocityX": -0.6084460535885156, + "velocityY": 0.037516909505028215, "moduleForcesX": [ - 115.14945546462411, - 115.14944411679562, - 115.14965818232656, - 115.14964684268682 + 115.17427159991368, + 115.17426017282052, + 115.1744839399641, + 115.17447252231639 ], "moduleForcesY": [ - -7.465221209099063, - -7.4653723034649175, - -7.462091590233946, - -7.462242621788996 + -7.102674189928534, + -7.102832461784182, + -7.099227889075101, + -7.099386084718906 ], - "timestamp": 8.55017526537301 + "timestamp": 8.768137341339854 }, { "x": 0.8449278259277335, "y": 2.053273916244507, - "heading": 1.8876778820126578e-23, - "angularVelocity": 9.40052478351043e-24, - "velocityX": 1.7951476472942267e-21, - "velocityY": 6.283263153886402e-21, + "heading": -4.998402134118911e-17, + "angularVelocity": -7.358356992609877e-18, + "velocityX": 3.54800413086263e-17, + "velocityY": 1.645945977459796e-17, "moduleForcesX": [ - 115.16208523948659, - 115.1620740948824, - 115.16228894450373, - 115.16227780816573 + 115.18667894938693, + 115.1866675847214, + 115.18689539353758, + 115.18688403868421 ], "moduleForcesY": [ - -7.467509839682914, - -7.467661670085734, - -7.464365943620278, - -7.464517710638055 + -7.104116229492631, + -7.104277561224099, + -7.10060401849292, + -7.100765271069628 ], - "timestamp": 8.624300177046122 + "timestamp": 8.843146407974176 }, { - "x": 0.8569672656897795, - "y": 2.065243087486579, - "heading": 0.026477656081364466, - "angularVelocity": 0.5490817512048349, - "velocityX": 0.24966849964948779, - "velocityY": 0.24821130261198687, + "x": 0.8574965729428564, + "y": 2.0646337327234905, + "heading": 0.03107052400011723, + "angularVelocity": 0.6347005774884072, + "velocityX": 0.2567510927355298, + "velocityY": 0.2320553744470217, "moduleForcesX": [ - 16.351962141394313, - 71.19396438514677, - 92.80128040966142, - 113.73960028992643 + 10.01880185007666, + 70.51132465323059, + 102.56695754062756, + 114.81418680623135 ], "moduleForcesY": [ - 114.21971244136823, - 90.82485498148876, - 68.01973967114503, - 19.30605442568154 + 114.950324597259, + 91.35804066457668, + 51.6570361197242, + 11.291141103086447 ], - "timestamp": 8.672521878137562 + "timestamp": 8.892099449931484 }, { - "x": 0.8810748266084533, - "y": 2.0892962989602575, - "heading": 0.07923424971643432, - "angularVelocity": 1.0940425667487266, - "velocityX": 0.49993178119037013, - "velocityY": 0.49880470678682487, + "x": 0.8825796369390675, + "y": 2.087613119693452, + "heading": 0.09306766699787188, + "angularVelocity": 1.2664615010405897, + "velocityX": 0.5123903028885677, + "velocityY": 0.4694169360387412, "moduleForcesX": [ - 16.952727334297226, - 69.20082557973143, - 96.11819363500824, - 112.515659702126 + 10.47765662313607, + 67.98037553526417, + 104.41762909212838, + 113.74547934290659 ], "moduleForcesY": [ - 114.11666490770641, - 92.33900074478456, - 63.28910350060908, - 25.431491565283945 + 114.89176486956586, + 93.24160102494326, + 48.08504143345789, + 19.19496564492602 ], - "timestamp": 8.720743579229003 + "timestamp": 8.941052491888792 }, { - "x": 0.9172027316907112, - "y": 2.1256086815595694, - "heading": 0.1583120039487254, - "angularVelocity": 1.6398789848234328, - "velocityX": 0.7492042848872142, - "velocityY": 0.7530298968602241, + "x": 0.9200156351341261, + "y": 2.122583149166543, + "heading": 0.18602557591039684, + "angularVelocity": 1.8989199689284813, + "velocityX": 0.7647328275983716, + "velocityY": 0.7143586604314295, "moduleForcesX": [ - 17.450975110192726, - 66.36796972826151, - 99.18005096251873, - 110.62136417389704 + 10.835990162849878, + 64.39521228962572, + 105.82062633961313, + 111.7441294446777 ], "moduleForcesY": [ - 114.0195685641478, - 94.37769509418555, - 58.40834177103907, - 32.64856908645179 + 114.83217133083784, + 95.73186682917266, + 45.08688416711994, + 28.55780146288301 ], - "timestamp": 8.768965280320444 + "timestamp": 8.9900055338461 }, { - "x": 0.9652072071826819, - "y": 2.1745030635707607, - "heading": 0.2634944034451186, - "angularVelocity": 2.181225405071049, - "velocityX": 0.9954952729880217, - "velocityY": 1.0139497550796635, + "x": 0.9695320661427651, + "y": 2.1701686644794913, + "heading": 0.30917272793451045, + "angularVelocity": 2.515617969798724, + "velocityX": 1.0115087648976933, + "velocityY": 0.9720645215891337, "moduleForcesX": [ - 18.76552093219475, - 62.90451804858331, - 100.67752020321791, - 107.76084632499483 + 12.632263455497991, + 60.105084170150185, + 105.28692632368393, + 108.31270835051731 ], "moduleForcesY": [ - 113.77796058506851, - 96.69530558377411, - 55.80693345276955, - 41.05968567979955 + 114.60669150952644, + 98.45078742534218, + 46.40569830649411, + 39.5559224830126 ], - "timestamp": 8.817186981411885 + "timestamp": 9.038958575803408 }, { - "x": 1.024884581648233, - "y": 2.236511376699377, - "heading": 0.3933543401994364, - "angularVelocity": 2.6929770998345655, - "velocityX": 1.2375626142343528, - "velocityY": 1.2859005743292329, + "x": 1.0308267645231524, + "y": 2.231318730759998, + "heading": 0.45926600651888, + "angularVelocity": 3.066066429850625, + "velocityX": 1.2521121452256427, + "velocityY": 1.2491576383652396, "moduleForcesX": [ - 22.65425748350341, - 59.32922192701658, - 99.73769034374716, - 103.41216352884265 + 19.193520071956605, + 56.10759630193776, + 101.40533999072578, + 102.46843648842588 ], "moduleForcesY": [ - 113.01690644978095, - 98.89044870030656, - 57.46401329173098, - 50.96198665871151 + 113.62114180064377, + 100.72951118396574, + 54.37613435033577, + 52.78756994817754 ], - "timestamp": 8.865408682503325 + "timestamp": 9.087911617760716 }, { - "x": 1.0960548796882106, - "y": 2.312397535168875, - "heading": 0.5435432001069115, - "angularVelocity": 3.114549186530728, - "velocityX": 1.475897706408573, - "velocityY": 1.5736931039740263, + "x": 1.1037024313475479, + "y": 2.307290579447881, + "heading": 0.6271959399792888, + "angularVelocity": 3.430428973277341, + "velocityX": 1.4886851543970687, + "velocityY": 1.5519331516196186, "moduleForcesX": [ - 32.460220381339624, - 57.02616538718768, - 94.82880396936191, - 96.42189325761602 + 37.36459510931641, + 55.56603305352279, + 90.23982224732244, + 91.32795604337164 ], "moduleForcesY": [ - 110.51663143062805, - 100.16824143861544, - 65.2081472861442, - 63.10043038238427 + 108.87903315382371, + 100.91772809940203, + 71.34020881103348, + 70.17696973203493 ], - "timestamp": 8.913630383594766 + "timestamp": 9.136864659718023 }, { - "x": 1.1786024294028, - "y": 2.403062734591481, - "heading": 0.7036429510395898, - "angularVelocity": 3.320076797562315, - "velocityX": 1.7118340466268027, - "velocityY": 1.8801742238557946, + "x": 1.187707501106803, + "y": 2.399089644687687, + "heading": 0.7901423770708541, + "angularVelocity": 3.328627406518933, + "velocityX": 1.7160337008812905, + "velocityY": 1.8752474120592397, "moduleForcesX": [ - 52.9976189734206, - 60.19075395749276, - 81.71816250502049, - 83.00503571063987 + 72.95352245157491, + 71.99046256490783, + 60.63508035638164, + 58.216090033997624 ], "moduleForcesY": [ - 102.13208160331293, - 98.14890485863742, - 80.96099716076793, - 79.76492813288964 + 88.84114045026165, + 89.5505221979616, + 97.67708800823013, + 99.07653571926552 ], - "timestamp": 8.961852084686207 + "timestamp": 9.185817701675331 }, { - "x": 1.2717031857076855, - "y": 2.5087575451409125, - "heading": 0.8486594006388647, - "angularVelocity": 3.007286062436618, - "velocityX": 1.9306817096382076, - "velocityY": 2.191851555568453, + "x": 1.2794923725931218, + "y": 2.5054213017641063, + "heading": 0.9137721346902739, + "angularVelocity": 2.525476511290922, + "velocityX": 1.874957465686411, + "velocityY": 2.1721154155194395, "moduleForcesX": [ - 83.21974573343562, - 85.65094183317885, - 49.621826400399556, - 39.29014814005943 + 88.63793057003053, + 103.9640948222794, + 18.832032863293776, + -27.032970661587502 ], "moduleForcesY": [ - 79.26870386093087, - 76.33230295247044, - 103.68667351103069, - 107.83989683014447 + 72.95986689469186, + 46.946807871504056, + 113.3127603108155, + 111.23995258635053 ], - "timestamp": 9.010073785777648 + "timestamp": 9.23477074363264 }, { - "x": 1.3727268361355833, - "y": 2.6272614661882607, - "heading": 0.9491088124473993, - "angularVelocity": 2.0830748301072264, - "velocityX": 2.0949831329328408, - "velocityY": 2.457481141584661, + "x": 1.3793855062107108, + "y": 2.6252569658957277, + "heading": 0.993407142079515, + "angularVelocity": 1.6267632041884466, + "velocityX": 2.0405909341728408, + "velocityY": 2.4479717570665778, "moduleForcesX": [ - 93.77065830212727, - 111.5099038574192, - 19.72183059871037, - -31.4702448610942 + 91.60388970964502, + 109.76906836890673, + 18.87138570722908, + -28.05790918727498 ], "moduleForcesY": [ - 66.15966523066282, - 23.807930537003287, - 113.08653442297255, - 109.83338652042379 + 68.56174974089363, + 28.56360796309666, + 112.87874340003955, + 110.07521153608074 ], - "timestamp": 9.058295486869088 + "timestamp": 9.283723785589947 }, { - "x": 1.4822864000255587, - "y": 2.7584095182646564, - "heading": 1.0069014705840629, - "angularVelocity": 1.1984782126842373, - "velocityX": 2.2719970762172372, - "velocityY": 2.7196894574022776, + "x": 1.4883720535567364, + "y": 2.757792536136217, + "heading": 1.0302422866644179, + "angularVelocity": 0.7524587464253547, + "velocityX": 2.226348823035134, + "velocityY": 2.7074021334802443, "moduleForcesX": [ - 94.29329121436436, - 111.33690202203805, - 23.524890313414957, - -20.64874218877574 + 94.42592705513906, + 110.18950347508573, + 25.62143662023805, + -14.69983417505771 ], "moduleForcesY": [ - 64.60956935693747, - 21.14398791701532, - 111.83418988380892, - 111.26982412256342 + 62.64193597383056, + 18.18445445993043, + 110.26196922217056, + 109.93171512187207 ], - "timestamp": 9.10651718796053 + "timestamp": 9.332676827547255 }, { - "x": 1.6008769781145331, - "y": 2.9015305147589388, - "heading": 1.0230775694802563, - "angularVelocity": 0.3354526806410118, - "velocityX": 2.4592781964306085, - "velocityY": 2.967979006441265, + "x": 1.6073319975777907, + "y": 2.898457418435302, + "heading": 1.0315234097906527, + "angularVelocity": 0.02617044978244855, + "velocityX": 2.430082774526686, + "velocityY": 2.8734656045848084, "moduleForcesX": [ - 95.44964108875462, - 109.9073464646586, - 27.566804981908373, - -12.323649647427327 + 91.86525254968076, + 92.36401864504138, + 38.39021742136879, + 13.775378324910177 ], "moduleForcesY": [ - 60.09889909493574, - 14.224846797408755, - 109.19219744802835, - 108.94658536069632 + 39.180203480228606, + -7.300594234141006, + 88.73734094363414, + 72.068421433988 ], - "timestamp": 9.15473888905197 + "timestamp": 9.381629869504563 }, { - "x": 1.7085853910767748, - "y": 3.042823929898296, - "heading": 1.062138319509375, - "angularVelocity": 0.810024307418135, - "velocityX": 2.233608738895347, - "velocityY": 2.930079444344529, + "x": 1.7162575662900155, + "y": 3.0397405651243345, + "heading": 1.0497080350999417, + "angularVelocity": 0.37147079287016466, + "velocityX": 2.225103167380434, + "velocityY": 2.8860953484648526, "moduleForcesX": [ - -86.9590857830949, - -78.5889566184507, - -55.780064272243294, - -44.49000954099238 + -75.77307716623498, + -66.09588436894305, + -54.266078380096815, + -41.705175729701644 ], "moduleForcesY": [ - -12.094864031659382, - 25.4856045183075, - -50.988845663446746, - -7.044135345915785 + 0.7831305875666112, + 27.97723607278229, + -24.048273245185072, + 9.94234489604884 ], - "timestamp": 9.20296059014341 + "timestamp": 9.43058291146187 }, { - "x": 1.806206643264022, - "y": 3.1721894754099607, - "heading": 1.1384146361794218, - "angularVelocity": 1.581784029671771, - "velocityX": 2.024425724885398, - "velocityY": 2.682724636079387, + "x": 1.8140080456118037, + "y": 3.170234255344365, + "heading": 1.1079057402275676, + "angularVelocity": 1.1888475731166737, + "velocityX": 1.996821349878699, + "velocityY": 2.6656911400507988, "moduleForcesX": [ - -95.99744403653119, - -111.3725567730494, - -31.38288895815133, - -7.645693964257284 + -101.22591211460183, + -111.27282203858992, + -38.06118753259128, + -14.318118907330136 ], "moduleForcesY": [ - -60.243116496949554, - -13.253824008375362, - -108.5069453108687, - -109.35760318563328 + -49.58576299702025, + 4.478519885777167, + -105.37871989885554, + -105.25159638947153 ], - "timestamp": 9.251182291234851 + "timestamp": 9.479535953419179 }, { - "x": 1.894121759346281, - "y": 3.288248837696075, - "heading": 1.2476017343094008, - "angularVelocity": 2.264273048413032, - "velocityX": 1.8231442295150255, - "velocityY": 2.4067869788756653, + "x": 1.9012518038388722, + "y": 3.287882996112528, + "heading": 1.2021912169050675, + "angularVelocity": 1.9260391777026817, + "velocityX": 1.7821927859701392, + "velocityY": 2.4032978556520344, "moduleForcesX": [ - -89.71754326673906, - -109.70942329970309, - -25.64471250802308, - -12.01963364731208 + -94.27122591184543, + -111.9395692297356, + -29.7277424462474, + -13.09747450271598 ], "moduleForcesY": [ - -71.02373862357867, - -30.590752966210808, - -111.31663378024956, - -112.0983625887034 + -64.43873357807499, + -18.973143563435727, + -109.98053661317853, + -111.0655575237677 ], - "timestamp": 9.299403992326292 + "timestamp": 9.528488995376486 }, { - "x": 1.9727722110540435, - "y": 3.3902029354711782, - "heading": 1.3865475571211665, - "angularVelocity": 2.8813961280272613, - "velocityX": 1.6310177768017946, - "velocityY": 2.1142783325244228, + "x": 1.9786102964253314, + "y": 3.391445072486045, + "heading": 1.3285417326754196, + "angularVelocity": 2.5810554506610948, + "velocityX": 1.5802591522928626, + "velocityY": 2.115539141830753, "moduleForcesX": [ - -83.56953629253536, - -107.14229823866022, - -19.083654622703264, - -16.5120151625824 + -86.9404428642643, + -108.8981374272585, + -22.521649868470654, + -15.945707139978866 ], "moduleForcesY": [ - -78.71040904165848, - -40.388808530169634, - -113.04273071952846, - -112.4066592111603 + -74.77427758993828, + -34.72614750627809, + -112.25694545994725, + -112.13240268430516 ], - "timestamp": 9.347625693417733 + "timestamp": 9.577442037333794 }, { - "x": 2.042803808199141, - "y": 3.477607450988946, - "heading": 1.5541659107318062, - "angularVelocity": 3.4759942062763747, - "velocityX": 1.4522838381893517, - "velocityY": 1.8125556241167515, + "x": 2.0467978535870746, + "y": 3.4801843218746016, + "heading": 1.484784100975893, + "angularVelocity": 3.1916784341355413, + "velocityX": 1.3929176704103385, + "velocityY": 1.8127422902839905, "moduleForcesX": [ - -77.64221219396589, - -106.14720313378757, - -8.338017165682224, - -18.404907081955013 + -80.10960219579854, + -106.45822211547039, + -13.149875930332756, + -17.65679408261992 ], "moduleForcesY": [ - -84.81783816234807, - -43.73643202943646, - -114.52616360787027, - -112.32150159790285 + -82.37686544038085, + -42.631112459868845, + -113.98755478586436, + -112.34316617833551 ], - "timestamp": 9.395847394509174 + "timestamp": 9.626395079291102 }, { - "x": 2.1033826262076065, - "y": 3.550155624544787, - "heading": 1.7432921394058938, - "angularVelocity": 3.9220148686885787, - "velocityX": 1.2562563459466602, - "velocityY": 1.5044714705993274, + "x": 2.1067771502269776, + "y": 3.5537494938021474, + "heading": 1.670997490742332, + "angularVelocity": 3.8039186600259614, + "velocityX": 1.225241460809306, + "velocityY": 1.5027701851378008, "moduleForcesX": [ - -70.91594042910828, - -101.15910205833582, - -9.707383087632953, - -49.1201488511403 + -73.34437651796223, + -106.15263304185436, + 2.413642008170467, + -17.473283255047654 ], "moduleForcesY": [ - -90.63705631390823, - -54.64864966949406, - -114.5024627557604, - -103.10697098452272 + -88.6335893943357, + -43.97011401265027, + -114.84297204098115, + -112.21755339067951 ], - "timestamp": 9.444069095600614 + "timestamp": 9.67534812124841 }, { - "x": 2.152607740204923, - "y": 3.607801077995203, - "heading": 1.9261463477817098, - "angularVelocity": 3.7919485260189596, - "velocityX": 1.0208083266074068, - "velocityY": 1.195425547952053, + "x": 2.1557185257205664, + "y": 3.611706742126399, + "heading": 1.8675660562205407, + "angularVelocity": 4.015451494304166, + "velocityX": 0.9997616805266244, + "velocityY": 1.1839355841054042, "moduleForcesX": [ - -71.44382936842356, - -54.31445565209966, - -82.52029843395653, - -69.05779006643566 + -67.41409192098914, + -86.37446768247753, + -41.076314753076424, + -66.76192995165273 ], "moduleForcesY": [ - -90.14981383751513, - -101.45774094468433, - -80.2741248199996, - -92.14633676825402 + -93.25513893490984, + -75.94459361264344, + -107.35908537802607, + -93.3886676822394 ], - "timestamp": 9.492290796692055 + "timestamp": 9.724301163205718 }, { - "x": 2.190788381486093, - "y": 3.651400600452789, - "heading": 2.090948780206684, - "angularVelocity": 3.4175988962410573, - "velocityX": 0.7917730071108338, - "velocityY": 0.9041473334777186, + "x": 2.1932474586006316, + "y": 3.65462041068866, + "heading": 2.050511149008698, + "angularVelocity": 3.7371547399996508, + "velocityX": 0.7666312731477015, + "velocityY": 0.8766292521689998, "moduleForcesX": [ - -90.79606858393824, - -18.55584251040676, - -96.57736445012134, - -63.853520232036104 + -80.55920555192586, + -32.49392465665238, + -92.09950834240892, + -65.3512771134131 ], "moduleForcesY": [ - -70.53849669010287, - -113.64992224377944, - -62.92180680397964, - -95.98904481306892 + -82.02909062643297, + -110.42446436352448, + -69.20864919881635, + -94.9088970753719 ], - "timestamp": 9.540512497783496 + "timestamp": 9.773254205163026 }, { - "x": 2.2183045677010402, - "y": 3.682483763115444, - "heading": 2.2264269947581963, - "angularVelocity": 2.80948642385323, - "velocityX": 0.570618323123221, - "velocityY": 0.6445886801818393, + "x": 2.219811592242873, + "y": 3.684386183378235, + "heading": 2.2045411597277322, + "angularVelocity": 3.1464849692765178, + "velocityX": 0.5426452081477267, + "velocityY": 0.608047457341234, "moduleForcesX": [ - -110.71850311742375, - 6.332456186499907, - -98.8317602170274, - -57.28231604872353 + -108.75425048256633, + 5.385270544240483, + -98.73724209101452, + -57.787407111346226 ], "moduleForcesY": [ - -31.162381403627016, - -115.02092054012306, - -59.44262986998008, - -100.1105777694302 + -37.23491686496145, + -115.04201778008925, + -59.561331885625044, + -99.80030517652003 ], - "timestamp": 9.588734198874937 + "timestamp": 9.822207247120334 }, { - "x": 2.2359647168279775, - "y": 3.7023940350495996, - "heading": 2.322570970138052, - "angularVelocity": 1.9937906213126328, - "velocityX": 0.3662282484280048, - "velocityY": 0.41289028556666507, + "x": 2.236530898648883, + "y": 3.703097894493539, + "heading": 2.3149477414372774, + "angularVelocity": 2.2553569154258097, + "velocityX": 0.341537639684345, + "velocityY": 0.38223796456182474, "moduleForcesX": [ - -115.10010865685537, - 24.884078394615532, - -98.81097200345764, - -51.72593444923844 + -114.57748285843158, + 31.6917140634627, + -99.3989192581002, + -51.062756198042344 ], "moduleForcesY": [ - 2.2494262109699688, - -112.50306629791393, - -59.54291982558333, - -103.12309638155047 + 10.74305716556114, + -110.76286660417196, + -58.543037707713566, + -103.44652639602133 ], - "timestamp": 9.636955899966377 + "timestamp": 9.871160289077642 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": 1.041427943793603, - "velocityX": 0.17807293718407943, - "velocityY": 0.199266250731892, + "angularVelocity": 1.1815947161180913, + "velocityX": 0.163846776586212, + "velocityY": 0.18191102692862865, "moduleForcesX": [ - -113.18697740525452, - 38.58269845532561, - -98.77375749286766, - -48.251824048408885 + -109.59554076157117, + 49.71533486232882, + -99.47986509601193, + -46.81669841993476 ], "moduleForcesY": [ - 21.426140041828702, - -108.59855539761742, - -59.643832900298754, - -104.81345448783512 + 35.44227192984209, + -103.9680438489712, + -58.45523278702017, + -105.46066453849079 ], - "timestamp": 9.685177601057818 + "timestamp": 9.92011333103495 }, { "x": 2.244551696777343, "y": 3.712002992630005, "heading": 2.372790397151941, - "angularVelocity": -5.850639937158215e-24, - "velocityX": -1.5909300119313646e-23, - "velocityY": -7.26803393218573e-24, + "angularVelocity": 5.839447282391598e-18, + "velocityX": -3.299113784734962e-17, + "velocityY": -5.057039344587014e-17, "moduleForcesX": [ - -110.17194913173422, - 47.48175193227342, - -99.60618042375734, - -47.457362329423724 + -103.80869333848717, + 60.02004315909284, + -100.4607086019751, + -45.86395648223105 ], "moduleForcesY": [ - 33.78870027617767, - -105.04769902960695, - -58.26901613919847, - -105.18952275403072 + 50.030394045050265, + -98.4252138448354, + -56.78405771282525, + -105.89459694302894 ], - "timestamp": 9.733399302149259 + "timestamp": 9.969066372992257 } ], "eventMarkers": [ @@ -3183,7 +3225,7 @@ } }, { - "timestamp": 4.411219951795512, + "timestamp": 4.524495592990686, "command": { "type": "named", "data": { @@ -3192,7 +3234,7 @@ } }, { - "timestamp": 7.772599897886376, + "timestamp": 7.961873865235917, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Red 4 to 5.1.traj b/src/main/deploy/choreo/Red 4 to 5.1.traj index cc22902..76e6019 100644 --- a/src/main/deploy/choreo/Red 4 to 5.1.traj +++ b/src/main/deploy/choreo/Red 4 to 5.1.traj @@ -2,11 +2,11 @@ "samples": [ { "x": 8.7, - "y": 7.477, - "heading": 4.817296379376439e-28, - "angularVelocity": 3.9893086811900706e-30, - "velocityX": 1.8654024236197165e-16, - "velocityY": 9.408879013592363e-17, + "y": 7.4769999999999985, + "heading": 4.3445481775720005e-28, + "angularVelocity": 3.5230479750879457e-28, + "velocityX": 6.245095163654619e-16, + "velocityY": -4.529551491696468e-16, "moduleForcesX": [ 0, 0, @@ -22,361 +22,361 @@ "timestamp": 0 }, { - "x": 8.751182179440617, - "y": 7.409711416685271, - "heading": 1.4146197750101355e-17, - "angularVelocity": 1.3870313406812334e-16, - "velocityX": 0.5018399951667601, - "velocityY": -0.6597628841614331, + "x": 8.750951934610828, + "y": 7.409336319308562, + "heading": 3.992684876067889e-18, + "angularVelocity": 3.9111388009155387e-17, + "velocityX": 0.49911336409082935, + "velocityY": -0.6628177625545835, "moduleForcesX": [ - 69.87246936993738, - 69.87246936993738, - 69.87246936993738, - 69.87246936993738 + 69.4275827769465, + 69.4275827769465, + 69.4275827769465, + 69.4275827769465 ], "moduleForcesY": [ - -91.8604781582405, - -91.8604781582405, - -91.8604781582405, - -91.8604781582405 + -92.19916433110537, + -92.19916433110537, + -92.19916433110537, + -92.19916433110537 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654462 }, { - "x": 8.853503148481877, - "y": 7.2751175571346485, - "heading": 2.7113703429716686e-17, - "angularVelocity": 1.2714607404735355e-16, - "velocityX": 1.0032545540329008, - "velocityY": -1.3196894419992256, + "x": 8.852823910850104, + "y": 7.274000743571707, + "heading": 2.053277549929798e-17, + "angularVelocity": 1.6202290689901917e-16, + "velocityX": 0.9979143119049112, + "velocityY": -1.3257159910201253, "moduleForcesX": [ - 69.81323478288947, - 69.81323478288947, - 69.81323478288947, - 69.81323478288947 + 69.38412510090774, + 69.38412510090774, + 69.38412510090775, + 69.38412510090774 ], "moduleForcesY": [ - -91.883266863891, - -91.88326686389098, - -91.883266863891, - -91.883266863891 + -92.21035728659838, + -92.21035728659838, + -92.2103572865984, + -92.21035728659838 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308924 }, { - "x": 9.006876144344536, - "y": 7.073185098303806, - "heading": 3.842376648398692e-17, - "angularVelocity": 1.1089488283065315e-16, - "velocityX": 1.5038184060088147, - "velocityY": -1.979942731456863, + "x": 9.005552097282301, + "y": 7.070976830585038, + "heading": 4.215359286305146e-17, + "angularVelocity": 2.1179252545200335e-16, + "velocityX": 1.496089981744527, + "velocityY": -1.9887752835153973, "moduleForcesX": [ - 69.69478868116428, - 69.69478868116428, - 69.69478868116428, - 69.69478868116428 + 69.29714778996834, + 69.29714778996835, + 69.29714778996834, + 69.29714778996834 ], "moduleForcesY": [ - -91.92875854512398, - -91.928758545124, - -91.92875854512398, - -91.92875854512398 + -92.23276158792527, + -92.23276158792527, + -92.23276158792528, + -92.23276158792527 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596339 }, { - "x": 9.21104108323236, - "y": 6.803814589003354, - "heading": 4.611053735098279e-17, - "angularVelocity": 7.536857333985494e-17, - "velocityX": 2.0018321428384445, - "velocityY": -2.6411711373500313, + "x": 9.20894459843012, + "y": 6.8002150738261875, + "heading": 5.2284316721184506e-17, + "angularVelocity": 9.923817704056193e-17, + "velocityX": 1.992385887885889, + "velocityY": -2.652319530447977, "moduleForcesX": [ - 69.33972961030769, - 69.33972961030767, - 69.33972961030767, - 69.33972961030767 + 69.03566921838615, + 69.03566921838615, + 69.03566921838615, + 69.03566921838615 ], "moduleForcesY": [ - -92.06452650681611, - -92.06452650681611, - -92.06452650681611, - -92.06452650681611 + -92.3002196376723, + -92.3002196376723, + -92.3002196376723, + -92.3002196376723 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461785 }, { - "x": 9.400539962274733, - "y": 6.468344823148687, - "heading": 2.790579728570887e-17, - "angularVelocity": -1.7849703184325878e-16, - "velocityX": 1.858031791180241, - "velocityY": -3.2892727022381854, + "x": 9.40209604536311, + "y": 6.467543964285724, + "heading": 4.733122003509853e-17, + "angularVelocity": -4.851939120316224e-17, + "velocityX": 1.8920668899735733, + "velocityY": -3.2587692280322194, "moduleForcesX": [ - -20.021691701970234, - -20.021691701970177, - -20.02169170197022, - -20.021691701970177 + -13.954556287036088, + -13.954556287036109, + -13.95455628703609, + -13.95455628703611 ], "moduleForcesY": [ - -90.2368427738075, - -90.23684277380752, - -90.23684277380742, - -90.23684277380745 + -84.3582632906046, + -84.35826329060458, + -84.3582632906046, + -84.35826329060458 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327231 }, { - "x": 9.53831969085793, - "y": 6.199601477600119, - "heading": 2.1172734583229143e-17, - "angularVelocity": -6.601751582322013e-17, - "velocityX": 1.350926808546524, - "velocityY": -2.6350218123795117, + "x": 9.540809314016872, + "y": 6.199538718872531, + "heading": 4.158863630900275e-17, + "angularVelocity": -5.625297151552388e-17, + "velocityX": 1.358803089426544, + "velocityY": -2.625317383015389, "moduleForcesX": [ - -70.60552707551035, - -70.60552707551035, - -70.60552707551035, - -70.60552707551035 + -74.1779710140498, + -74.17797101404982, + -74.1779710140498, + -74.1779710140498 ], "moduleForcesY": [ - 91.09302905748787, - 91.09302905748787, - 91.09302905748787, - 91.09302905748787 + 88.11431143550172, + 88.11431143550172, + 88.11431143550173, + 88.11431143550172 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192677 }, { - "x": 9.624576863197959, - "y": 5.997836583842571, - "heading": 9.14804300397557e-18, - "angularVelocity": -1.1790181597877335e-16, - "velocityX": 0.845749427305614, - "velocityY": -1.9782997600863548, + "x": 9.627027003037252, + "y": 5.997942442570264, + "heading": 3.560709033457718e-17, + "angularVelocity": -5.859383146830961e-17, + "velocityX": 0.8445685358078194, + "velocityY": -1.9747904848335078, "moduleForcesX": [ - -70.33714219082879, - -70.3371421908288, - -70.33714219082879, - -70.3371421908288 + -71.53096792553181, + -71.53096792553181, + -71.53096792553181, + -71.53096792553181 ], "moduleForcesY": [ - 91.43709533984783, - 91.43709533984782, - 91.43709533984783, - 91.43709533984783 + 90.48948259361192, + 90.48948259361192, + 90.48948259361192, + 90.48948259361192 ], - "timestamp": 0.713923281394681 + "timestamp": 0.7145942544058123 }, { - "x": 9.659378524344477, - "y": 5.863134773678262, - "heading": -1.5665362979803489e-18, - "angularVelocity": -1.050561836527775e-16, - "velocityX": 0.3412294211072674, - "velocityY": -1.3207478950795897, + "x": 9.661274942863438, + "y": 5.863208583334526, + "heading": 2.4497234711099608e-17, + "angularVelocity": -1.088295682681964e-16, + "velocityX": 0.3354848955240913, + "velocityY": -1.3198217153806622, "moduleForcesX": [ - -70.24561417800408, - -70.24561417800409, - -70.24561417800408, - -70.24561417800408 + -70.81446644981119, + -70.81446644981119, + -70.81446644981118, + -70.81446644981119 ], "moduleForcesY": [ - 91.55263229179096, - 91.55263229179096, - 91.55263229179096, - 91.55263229179096 + 91.10735502004113, + 91.10735502004113, + 91.10735502004111, + 91.10735502004113 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923568 }, { - "x": 9.64275859736688, - "y": 5.79553856220569, - "heading": 1.2470484727373151e-18, - "angularVelocity": 2.7587148464171453e-17, - "velocityX": -0.162957970240335, - "velocityY": -0.6627791705906012, + "x": 9.643797948064972, + "y": 5.795545668140687, + "heading": 1.2659446947028772e-17, + "angularVelocity": -1.159602211971219e-16, + "velocityX": -0.17120059787259703, + "velocityY": -0.6628102639184235, "moduleForcesX": [ - -70.19930335943926, - -70.19930335943927, - -70.19930335943926, - -70.19930335943926 + -70.48087982705175, + -70.48087982705175, + -70.48087982705175, + -70.48087982705175 ], "moduleForcesY": [ - 91.61067270642354, - 91.61067270642354, - 91.61067270642354, - 91.61067270642354 + 91.39149582749977, + 91.39149582749977, + 91.39149582749977, + 91.39149582749977 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789014 }, { "x": 9.574737548828123, - "y": 5.795073509216309, - "heading": -1.5905884047918351e-27, - "angularVelocity": -1.2227265519428621e-17, - "velocityX": -0.6669446874477082, - "velocityY": -0.004559832982767996, + "y": 5.79507350921631, + "heading": 1.9381509071890707e-28, + "angularVelocity": -1.2400901378310827e-16, + "velocityX": -0.6764996943067104, + "velocityY": -0.004625159592674334, "moduleForcesX": [ - -70.1713629843234, - -70.1713629843234, - -70.1713629843234, - -70.1713629843234 + -70.28802947120099, + -70.28802947120099, + -70.28802947120099, + -70.28802947120099 ], "moduleForcesY": [ - 91.64556621358959, - 91.64556621358957, - 91.64556621358959, - 91.64556621358959 + 91.55475308965782, + 91.55475308965782, + 91.55475308965782, + 91.55475308965782 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654461 }, { - "x": 9.459299035454817, - "y": 5.7942842678434205, - "heading": -6.253986271630234e-18, - "angularVelocity": -7.356104585269783e-17, - "velocityX": -1.3578183260610612, - "velocityY": -0.009283265770469775, + "x": 9.458756473332102, + "y": 5.794280558401382, + "heading": -1.1520815948839546e-17, + "angularVelocity": -1.3571969972482983e-16, + "velocityX": -1.3663025836623566, + "velocityY": -0.009341271776624095, "moduleForcesX": [ - -115.39417560593395, - -115.39417560593395, - -115.39417560593395, - -115.39417560593395 + -115.39290145122217, + -115.39290145122217, + -115.39290145122217, + -115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823164, - -0.7889382400823163, - -0.7889382400823175, - -0.7889382400823175 + -0.7889295288162256, + -0.7889295288162256, + -0.7889295288162312, + -0.7889295288162312 ], - "timestamp": 1.1049080447488957 + "timestamp": 1.1057357504820584 }, { - "x": 9.285142559246436, - "y": 5.793093577731747, - "heading": -1.1414667665309964e-18, - "angularVelocity": 6.0134776000088e-17, - "velocityX": -2.0484745349524145, - "velocityY": -0.014005212013280458, + "x": 9.284239365862444, + "y": 5.7930874026904595, + "heading": -2.5150521647142958e-17, + "angularVelocity": -1.6056320382009621e-16, + "velocityX": -2.0558800115403746, + "velocityY": -0.014055842503386191, "moduleForcesX": [ - -115.35785908997497, - -115.35785908997497, - -115.35785908997497, - -115.35785908997497 + -115.35518538121136, + -115.35518538121136, + -115.35518538121136, + -115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570318, - -0.7886899477570318, - -0.7886899477570327, - -0.7886899477570326 + -0.7886716678821973, + -0.7886716678821973, + -0.7886716678822024, + -0.7886716678822024 ], - "timestamp": 1.18992568750539 + "timestamp": 1.1906225660986707 }, { - "x": 9.052325497079263, - "y": 5.791501831161153, - "heading": -2.2437742110440265e-18, - "angularVelocity": -1.2965642586103366e-17, - "velocityX": -2.7384558618495793, - "velocityY": -0.018722544156549614, + "x": 9.051247330249543, + "y": 5.791494459844215, + "heading": -2.5937310124731176e-17, + "angularVelocity": -9.268656092420328e-18, + "velocityX": -2.7447376123174685, + "velocityY": -0.018765491845484074, "moduleForcesX": [ - -115.24513594206775, - -115.24513594206775, - -115.24513594206775, - -115.24513594206775 + -115.23476991325884, + -115.23476991325884, + -115.23476991325884, + -115.23476991325884 ], "moduleForcesY": [ - -0.7879192710616144, - -0.7879192710616143, - -0.7879192710616153, - -0.7879192710616153 + -0.7878483995771357, + -0.7878483995771357, + -0.7878483995771398, + -0.7878483995771398 ], - "timestamp": 1.2749433302618844 + "timestamp": 1.275509381715283 }, { - "x": 8.87619592152223, - "y": 5.790297651169946, - "heading": 6.551099092183217e-19, - "angularVelocity": 3.409743994418627e-17, - "velocityX": -2.0716826513469324, - "velocityY": -0.014163883544211484, + "x": 8.875655323306212, + "y": 5.790293955154937, + "heading": -1.1972201714753373e-17, + "angularVelocity": 1.645143773982178e-16, + "velocityX": -2.06854274916434, + "velocityY": -0.014142416352397356, "moduleForcesX": [ - 111.36876650332536, - 111.36876650332536, - 111.36876650332536, - 111.36876650332536 + 113.11649807418004, + 113.11649807418004, + 113.11649807418004, + 113.11649807418004 ], "moduleForcesY": [ - 0.761416927534731, - 0.7614169275347311, - 0.7614169275347248, - 0.7614169275347247 + 0.7733659904957185, + 0.7733659904957183, + 0.77336599049571, + 0.7733659904957098 ], - "timestamp": 1.3599609730183788 + "timestamp": 1.3603961973318952 }, { - "x": 8.758737639980005, - "y": 5.78949460084755, - "heading": 6.774136913302295e-19, - "angularVelocity": 2.6237471918863595e-19, - "velocityX": -1.3815753734627951, - "velocityY": -0.009445690286856828, + "x": 8.758557276336354, + "y": 5.7894933677196665, + "heading": -3.7706027032273264e-18, + "angularVelocity": 9.66180165445428e-17, + "velocityX": -1.379460945958553, + "velocityY": -0.009431234161101608, "moduleForcesX": [ - 115.26617308908851, - 115.26617308908851, - 115.26617308908851, - 115.26617308908851 + 115.2722753646769, + 115.2722753646769, + 115.2722753646769, + 115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957773, - 0.7880630998957774, - 0.7880630998957836, - 0.7880630998957835 + 0.7881048205332163, + 0.7881048205332163, + 0.7881048205332253, + 0.7881048205332253 ], - "timestamp": 1.4449786157748732 + "timestamp": 1.4452830129485075 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 2.2434091657543482e-27, - "angularVelocity": -7.967902100915187e-18, - "velocityX": -0.6908876566743292, - "velocityY": -0.004723528627758741, + "heading": -8.769503931077745e-28, + "angularVelocity": 4.441916565205765e-17, + "velocityX": -0.6898276948077539, + "velocityY": -0.004716281776302161, "moduleForcesX": [ - 115.36312174237496, - 115.36312174237496, - 115.36312174237496, - 115.36312174237496 + 115.3645237146873, + 115.3645237146873, + 115.3645237146873, + 115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761424, - 0.7887259279761424, - 0.788725927976148, - 0.788725927976148 + 0.7887355131182234, + 0.7887355131182234, + 0.7887355131182325, + 0.7887355131182325 ], - "timestamp": 1.5299962585313676 + "timestamp": 1.5301698285651197 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 1.1144018963854978e-27, - "angularVelocity": -1.7179212145719729e-28, - "velocityX": -2.4191591991076064e-17, - "velocityY": -1.609731132934757e-18, + "heading": -4.232324308621776e-28, + "angularVelocity": 3.5913140303197327e-28, + "velocityX": -3.294645149439053e-16, + "velocityY": -1.8487293250685584e-18, "moduleForcesX": [ - 115.3965169929829, - 115.3965169929829, - 115.3965169929829, - 115.3965169929829 + 115.39705100341173, + 115.39705100341173, + 115.39705100341173, + 115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073995, - 0.7889542479073995, - 0.7889542479074042, - 0.7889542479074043 + 0.7889578988823763, + 0.7889578988823763, + 0.7889578988823851, + 0.7889578988823851 ], - "timestamp": 1.615013901287862 + "timestamp": 1.615056644181732 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red 4 to 5.traj b/src/main/deploy/choreo/Red 4 to 5.traj index cc22902..76e6019 100644 --- a/src/main/deploy/choreo/Red 4 to 5.traj +++ b/src/main/deploy/choreo/Red 4 to 5.traj @@ -2,11 +2,11 @@ "samples": [ { "x": 8.7, - "y": 7.477, - "heading": 4.817296379376439e-28, - "angularVelocity": 3.9893086811900706e-30, - "velocityX": 1.8654024236197165e-16, - "velocityY": 9.408879013592363e-17, + "y": 7.4769999999999985, + "heading": 4.3445481775720005e-28, + "angularVelocity": 3.5230479750879457e-28, + "velocityX": 6.245095163654619e-16, + "velocityY": -4.529551491696468e-16, "moduleForcesX": [ 0, 0, @@ -22,361 +22,361 @@ "timestamp": 0 }, { - "x": 8.751182179440617, - "y": 7.409711416685271, - "heading": 1.4146197750101355e-17, - "angularVelocity": 1.3870313406812334e-16, - "velocityX": 0.5018399951667601, - "velocityY": -0.6597628841614331, + "x": 8.750951934610828, + "y": 7.409336319308562, + "heading": 3.992684876067889e-18, + "angularVelocity": 3.9111388009155387e-17, + "velocityX": 0.49911336409082935, + "velocityY": -0.6628177625545835, "moduleForcesX": [ - 69.87246936993738, - 69.87246936993738, - 69.87246936993738, - 69.87246936993738 + 69.4275827769465, + 69.4275827769465, + 69.4275827769465, + 69.4275827769465 ], "moduleForcesY": [ - -91.8604781582405, - -91.8604781582405, - -91.8604781582405, - -91.8604781582405 + -92.19916433110537, + -92.19916433110537, + -92.19916433110537, + -92.19916433110537 ], - "timestamp": 0.10198904019924014 + "timestamp": 0.10208489348654462 }, { - "x": 8.853503148481877, - "y": 7.2751175571346485, - "heading": 2.7113703429716686e-17, - "angularVelocity": 1.2714607404735355e-16, - "velocityX": 1.0032545540329008, - "velocityY": -1.3196894419992256, + "x": 8.852823910850104, + "y": 7.274000743571707, + "heading": 2.053277549929798e-17, + "angularVelocity": 1.6202290689901917e-16, + "velocityX": 0.9979143119049112, + "velocityY": -1.3257159910201253, "moduleForcesX": [ - 69.81323478288947, - 69.81323478288947, - 69.81323478288947, - 69.81323478288947 + 69.38412510090774, + 69.38412510090774, + 69.38412510090775, + 69.38412510090774 ], "moduleForcesY": [ - -91.883266863891, - -91.88326686389098, - -91.883266863891, - -91.883266863891 + -92.21035728659838, + -92.21035728659838, + -92.2103572865984, + -92.21035728659838 ], - "timestamp": 0.20397808039848028 + "timestamp": 0.20416978697308924 }, { - "x": 9.006876144344536, - "y": 7.073185098303806, - "heading": 3.842376648398692e-17, - "angularVelocity": 1.1089488283065315e-16, - "velocityX": 1.5038184060088147, - "velocityY": -1.979942731456863, + "x": 9.005552097282301, + "y": 7.070976830585038, + "heading": 4.215359286305146e-17, + "angularVelocity": 2.1179252545200335e-16, + "velocityX": 1.496089981744527, + "velocityY": -1.9887752835153973, "moduleForcesX": [ - 69.69478868116428, - 69.69478868116428, - 69.69478868116428, - 69.69478868116428 + 69.29714778996834, + 69.29714778996835, + 69.29714778996834, + 69.29714778996834 ], "moduleForcesY": [ - -91.92875854512398, - -91.928758545124, - -91.92875854512398, - -91.92875854512398 + -92.23276158792527, + -92.23276158792527, + -92.23276158792528, + -92.23276158792527 ], - "timestamp": 0.3059671205977204 + "timestamp": 0.3062546804596339 }, { - "x": 9.21104108323236, - "y": 6.803814589003354, - "heading": 4.611053735098279e-17, - "angularVelocity": 7.536857333985494e-17, - "velocityX": 2.0018321428384445, - "velocityY": -2.6411711373500313, + "x": 9.20894459843012, + "y": 6.8002150738261875, + "heading": 5.2284316721184506e-17, + "angularVelocity": 9.923817704056193e-17, + "velocityX": 1.992385887885889, + "velocityY": -2.652319530447977, "moduleForcesX": [ - 69.33972961030769, - 69.33972961030767, - 69.33972961030767, - 69.33972961030767 + 69.03566921838615, + 69.03566921838615, + 69.03566921838615, + 69.03566921838615 ], "moduleForcesY": [ - -92.06452650681611, - -92.06452650681611, - -92.06452650681611, - -92.06452650681611 + -92.3002196376723, + -92.3002196376723, + -92.3002196376723, + -92.3002196376723 ], - "timestamp": 0.40795616079696057 + "timestamp": 0.4083395739461785 }, { - "x": 9.400539962274733, - "y": 6.468344823148687, - "heading": 2.790579728570887e-17, - "angularVelocity": -1.7849703184325878e-16, - "velocityX": 1.858031791180241, - "velocityY": -3.2892727022381854, + "x": 9.40209604536311, + "y": 6.467543964285724, + "heading": 4.733122003509853e-17, + "angularVelocity": -4.851939120316224e-17, + "velocityX": 1.8920668899735733, + "velocityY": -3.2587692280322194, "moduleForcesX": [ - -20.021691701970234, - -20.021691701970177, - -20.02169170197022, - -20.021691701970177 + -13.954556287036088, + -13.954556287036109, + -13.95455628703609, + -13.95455628703611 ], "moduleForcesY": [ - -90.2368427738075, - -90.23684277380752, - -90.23684277380742, - -90.23684277380745 + -84.3582632906046, + -84.35826329060458, + -84.3582632906046, + -84.35826329060458 ], - "timestamp": 0.5099452009962007 + "timestamp": 0.5104244674327231 }, { - "x": 9.53831969085793, - "y": 6.199601477600119, - "heading": 2.1172734583229143e-17, - "angularVelocity": -6.601751582322013e-17, - "velocityX": 1.350926808546524, - "velocityY": -2.6350218123795117, + "x": 9.540809314016872, + "y": 6.199538718872531, + "heading": 4.158863630900275e-17, + "angularVelocity": -5.625297151552388e-17, + "velocityX": 1.358803089426544, + "velocityY": -2.625317383015389, "moduleForcesX": [ - -70.60552707551035, - -70.60552707551035, - -70.60552707551035, - -70.60552707551035 + -74.1779710140498, + -74.17797101404982, + -74.1779710140498, + -74.1779710140498 ], "moduleForcesY": [ - 91.09302905748787, - 91.09302905748787, - 91.09302905748787, - 91.09302905748787 + 88.11431143550172, + 88.11431143550172, + 88.11431143550173, + 88.11431143550172 ], - "timestamp": 0.6119342411954408 + "timestamp": 0.6125093609192677 }, { - "x": 9.624576863197959, - "y": 5.997836583842571, - "heading": 9.14804300397557e-18, - "angularVelocity": -1.1790181597877335e-16, - "velocityX": 0.845749427305614, - "velocityY": -1.9782997600863548, + "x": 9.627027003037252, + "y": 5.997942442570264, + "heading": 3.560709033457718e-17, + "angularVelocity": -5.859383146830961e-17, + "velocityX": 0.8445685358078194, + "velocityY": -1.9747904848335078, "moduleForcesX": [ - -70.33714219082879, - -70.3371421908288, - -70.33714219082879, - -70.3371421908288 + -71.53096792553181, + -71.53096792553181, + -71.53096792553181, + -71.53096792553181 ], "moduleForcesY": [ - 91.43709533984783, - 91.43709533984782, - 91.43709533984783, - 91.43709533984783 + 90.48948259361192, + 90.48948259361192, + 90.48948259361192, + 90.48948259361192 ], - "timestamp": 0.713923281394681 + "timestamp": 0.7145942544058123 }, { - "x": 9.659378524344477, - "y": 5.863134773678262, - "heading": -1.5665362979803489e-18, - "angularVelocity": -1.050561836527775e-16, - "velocityX": 0.3412294211072674, - "velocityY": -1.3207478950795897, + "x": 9.661274942863438, + "y": 5.863208583334526, + "heading": 2.4497234711099608e-17, + "angularVelocity": -1.088295682681964e-16, + "velocityX": 0.3354848955240913, + "velocityY": -1.3198217153806622, "moduleForcesX": [ - -70.24561417800408, - -70.24561417800409, - -70.24561417800408, - -70.24561417800408 + -70.81446644981119, + -70.81446644981119, + -70.81446644981118, + -70.81446644981119 ], "moduleForcesY": [ - 91.55263229179096, - 91.55263229179096, - 91.55263229179096, - 91.55263229179096 + 91.10735502004113, + 91.10735502004113, + 91.10735502004111, + 91.10735502004113 ], - "timestamp": 0.8159123215939211 + "timestamp": 0.8166791478923568 }, { - "x": 9.64275859736688, - "y": 5.79553856220569, - "heading": 1.2470484727373151e-18, - "angularVelocity": 2.7587148464171453e-17, - "velocityX": -0.162957970240335, - "velocityY": -0.6627791705906012, + "x": 9.643797948064972, + "y": 5.795545668140687, + "heading": 1.2659446947028772e-17, + "angularVelocity": -1.159602211971219e-16, + "velocityX": -0.17120059787259703, + "velocityY": -0.6628102639184235, "moduleForcesX": [ - -70.19930335943926, - -70.19930335943927, - -70.19930335943926, - -70.19930335943926 + -70.48087982705175, + -70.48087982705175, + -70.48087982705175, + -70.48087982705175 ], "moduleForcesY": [ - 91.61067270642354, - 91.61067270642354, - 91.61067270642354, - 91.61067270642354 + 91.39149582749977, + 91.39149582749977, + 91.39149582749977, + 91.39149582749977 ], - "timestamp": 0.9179013617931613 + "timestamp": 0.9187640413789014 }, { "x": 9.574737548828123, - "y": 5.795073509216309, - "heading": -1.5905884047918351e-27, - "angularVelocity": -1.2227265519428621e-17, - "velocityX": -0.6669446874477082, - "velocityY": -0.004559832982767996, + "y": 5.79507350921631, + "heading": 1.9381509071890707e-28, + "angularVelocity": -1.2400901378310827e-16, + "velocityX": -0.6764996943067104, + "velocityY": -0.004625159592674334, "moduleForcesX": [ - -70.1713629843234, - -70.1713629843234, - -70.1713629843234, - -70.1713629843234 + -70.28802947120099, + -70.28802947120099, + -70.28802947120099, + -70.28802947120099 ], "moduleForcesY": [ - 91.64556621358959, - 91.64556621358957, - 91.64556621358959, - 91.64556621358959 + 91.55475308965782, + 91.55475308965782, + 91.55475308965782, + 91.55475308965782 ], - "timestamp": 1.0198904019924013 + "timestamp": 1.0208489348654461 }, { - "x": 9.459299035454817, - "y": 5.7942842678434205, - "heading": -6.253986271630234e-18, - "angularVelocity": -7.356104585269783e-17, - "velocityX": -1.3578183260610612, - "velocityY": -0.009283265770469775, + "x": 9.458756473332102, + "y": 5.794280558401382, + "heading": -1.1520815948839546e-17, + "angularVelocity": -1.3571969972482983e-16, + "velocityX": -1.3663025836623566, + "velocityY": -0.009341271776624095, "moduleForcesX": [ - -115.39417560593395, - -115.39417560593395, - -115.39417560593395, - -115.39417560593395 + -115.39290145122217, + -115.39290145122217, + -115.39290145122217, + -115.39290145122217 ], "moduleForcesY": [ - -0.7889382400823164, - -0.7889382400823163, - -0.7889382400823175, - -0.7889382400823175 + -0.7889295288162256, + -0.7889295288162256, + -0.7889295288162312, + -0.7889295288162312 ], - "timestamp": 1.1049080447488957 + "timestamp": 1.1057357504820584 }, { - "x": 9.285142559246436, - "y": 5.793093577731747, - "heading": -1.1414667665309964e-18, - "angularVelocity": 6.0134776000088e-17, - "velocityX": -2.0484745349524145, - "velocityY": -0.014005212013280458, + "x": 9.284239365862444, + "y": 5.7930874026904595, + "heading": -2.5150521647142958e-17, + "angularVelocity": -1.6056320382009621e-16, + "velocityX": -2.0558800115403746, + "velocityY": -0.014055842503386191, "moduleForcesX": [ - -115.35785908997497, - -115.35785908997497, - -115.35785908997497, - -115.35785908997497 + -115.35518538121136, + -115.35518538121136, + -115.35518538121136, + -115.35518538121136 ], "moduleForcesY": [ - -0.7886899477570318, - -0.7886899477570318, - -0.7886899477570327, - -0.7886899477570326 + -0.7886716678821973, + -0.7886716678821973, + -0.7886716678822024, + -0.7886716678822024 ], - "timestamp": 1.18992568750539 + "timestamp": 1.1906225660986707 }, { - "x": 9.052325497079263, - "y": 5.791501831161153, - "heading": -2.2437742110440265e-18, - "angularVelocity": -1.2965642586103366e-17, - "velocityX": -2.7384558618495793, - "velocityY": -0.018722544156549614, + "x": 9.051247330249543, + "y": 5.791494459844215, + "heading": -2.5937310124731176e-17, + "angularVelocity": -9.268656092420328e-18, + "velocityX": -2.7447376123174685, + "velocityY": -0.018765491845484074, "moduleForcesX": [ - -115.24513594206775, - -115.24513594206775, - -115.24513594206775, - -115.24513594206775 + -115.23476991325884, + -115.23476991325884, + -115.23476991325884, + -115.23476991325884 ], "moduleForcesY": [ - -0.7879192710616144, - -0.7879192710616143, - -0.7879192710616153, - -0.7879192710616153 + -0.7878483995771357, + -0.7878483995771357, + -0.7878483995771398, + -0.7878483995771398 ], - "timestamp": 1.2749433302618844 + "timestamp": 1.275509381715283 }, { - "x": 8.87619592152223, - "y": 5.790297651169946, - "heading": 6.551099092183217e-19, - "angularVelocity": 3.409743994418627e-17, - "velocityX": -2.0716826513469324, - "velocityY": -0.014163883544211484, + "x": 8.875655323306212, + "y": 5.790293955154937, + "heading": -1.1972201714753373e-17, + "angularVelocity": 1.645143773982178e-16, + "velocityX": -2.06854274916434, + "velocityY": -0.014142416352397356, "moduleForcesX": [ - 111.36876650332536, - 111.36876650332536, - 111.36876650332536, - 111.36876650332536 + 113.11649807418004, + 113.11649807418004, + 113.11649807418004, + 113.11649807418004 ], "moduleForcesY": [ - 0.761416927534731, - 0.7614169275347311, - 0.7614169275347248, - 0.7614169275347247 + 0.7733659904957185, + 0.7733659904957183, + 0.77336599049571, + 0.7733659904957098 ], - "timestamp": 1.3599609730183788 + "timestamp": 1.3603961973318952 }, { - "x": 8.758737639980005, - "y": 5.78949460084755, - "heading": 6.774136913302295e-19, - "angularVelocity": 2.6237471918863595e-19, - "velocityX": -1.3815753734627951, - "velocityY": -0.009445690286856828, + "x": 8.758557276336354, + "y": 5.7894933677196665, + "heading": -3.7706027032273264e-18, + "angularVelocity": 9.66180165445428e-17, + "velocityX": -1.379460945958553, + "velocityY": -0.009431234161101608, "moduleForcesX": [ - 115.26617308908851, - 115.26617308908851, - 115.26617308908851, - 115.26617308908851 + 115.2722753646769, + 115.2722753646769, + 115.2722753646769, + 115.2722753646769 ], "moduleForcesY": [ - 0.7880630998957773, - 0.7880630998957774, - 0.7880630998957836, - 0.7880630998957835 + 0.7881048205332163, + 0.7881048205332163, + 0.7881048205332253, + 0.7881048205332253 ], - "timestamp": 1.4449786157748732 + "timestamp": 1.4452830129485075 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 2.2434091657543482e-27, - "angularVelocity": -7.967902100915187e-18, - "velocityX": -0.6908876566743292, - "velocityY": -0.004723528627758741, + "heading": -8.769503931077745e-28, + "angularVelocity": 4.441916565205765e-17, + "velocityX": -0.6898276948077539, + "velocityY": -0.004716281776302161, "moduleForcesX": [ - 115.36312174237496, - 115.36312174237496, - 115.36312174237496, - 115.36312174237496 + 115.3645237146873, + 115.3645237146873, + 115.3645237146873, + 115.3645237146873 ], "moduleForcesY": [ - 0.7887259279761424, - 0.7887259279761424, - 0.788725927976148, - 0.788725927976148 + 0.7887355131182234, + 0.7887355131182234, + 0.7887355131182325, + 0.7887355131182325 ], - "timestamp": 1.5299962585313676 + "timestamp": 1.5301698285651197 }, { "x": 8.7, "y": 5.789093017578125, - "heading": 1.1144018963854978e-27, - "angularVelocity": -1.7179212145719729e-28, - "velocityX": -2.4191591991076064e-17, - "velocityY": -1.609731132934757e-18, + "heading": -4.232324308621776e-28, + "angularVelocity": 3.5913140303197327e-28, + "velocityX": -3.294645149439053e-16, + "velocityY": -1.8487293250685584e-18, "moduleForcesX": [ - 115.3965169929829, - 115.3965169929829, - 115.3965169929829, - 115.3965169929829 + 115.39705100341173, + 115.39705100341173, + 115.39705100341173, + 115.39705100341173 ], "moduleForcesY": [ - 0.7889542479073995, - 0.7889542479073995, - 0.7889542479074042, - 0.7889542479074043 + 0.7889578988823763, + 0.7889578988823763, + 0.7889578988823851, + 0.7889578988823851 ], - "timestamp": 1.615013901287862 + "timestamp": 1.615056644181732 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red 5 to Amp.1.traj b/src/main/deploy/choreo/Red 5 to Amp.1.traj index 57e734a..be7b6f9 100644 --- a/src/main/deploy/choreo/Red 5 to Amp.1.traj +++ b/src/main/deploy/choreo/Red 5 to Amp.1.traj @@ -3,10 +3,10 @@ { "x": 8.7, "y": 5.789093017578125, - "heading": -2.0455733052614176e-22, - "angularVelocity": -3.8646051503558115e-23, - "velocityX": -1.6361619392483338e-21, - "velocityY": 8.474609168336952e-22, + "heading": 7.247326847218455e-23, + "angularVelocity": 1.03987844992159e-23, + "velocityX": -2.83848661247132e-21, + "velocityY": 1.754450024355998e-22, "moduleForcesX": [ 0, 0, @@ -22,760 +22,760 @@ "timestamp": 0 }, { - "x": 8.735613015250742, - "y": 5.818963407451602, - "heading": -1.0502454961256607e-9, - "angularVelocity": -1.3886948104035371e-8, - "velocityX": 0.47089570623239124, - "velocityY": 0.39496342098173537, + "x": 8.738084296106212, + "y": 5.8198955678928925, + "heading": -7.933185096139342e-10, + "angularVelocity": -1.0218405471537252e-8, + "velocityX": 0.4905479640210178, + "velocityY": 0.3967548278015508, "moduleForcesX": [ - 88.41685134026662, - 88.41685080559071, - 88.41685048601633, - 88.41684995134041 + 89.72456276282517, + 89.72456239926017, + 89.72456216050942, + 89.72456179694441 ], "moduleForcesY": [ - 74.15956644197404, - 74.15956707853893, - 74.15956746147184, - 74.15956809803674 + 72.56915852264277, + 72.56915897147265, + 72.5691592680868, + 72.56915971691669 ], - "timestamp": 0.07562824374781552 + "timestamp": 0.07763623315044796 }, { - "x": 8.806834869518331, - "y": 5.87870068413291, - "heading": -3.1448393381201233e-9, - "angularVelocity": -2.769592070627396e-8, - "velocityX": 0.9417361919057632, - "velocityY": 0.7898805224209977, + "x": 8.814247376335548, + "y": 5.881496210421434, + "heading": -2.349086353373507e-9, + "angularVelocity": -2.0039197944402956e-8, + "velocityX": 0.9810249304824148, + "velocityY": 0.7934522326600846, "moduleForcesX": [ - 88.40648295141082, - 88.406482419705, - 88.40648210214698, - 88.40648157044113 + 89.71157680696294, + 89.71157645751236, + 89.71157622824228, + 89.71157587879172 ], "moduleForcesY": [ - 74.1508693445355, - 74.15086997738463, - 74.15087035828485, - 74.15087099113398 + 72.55865549873482, + 72.55865592998228, + 72.55865621514842, + 72.55865664639586 ], - "timestamp": 0.15125648749563103 + "timestamp": 0.15527246630089592 }, { - "x": 8.913659297587033, - "y": 5.968299592298079, - "heading": -6.275037709731855e-9, - "angularVelocity": -4.138927755679822e-8, - "velocityX": 1.4124938353045782, - "velocityY": 1.1847281349536443, + "x": 8.92848023335885, + "y": 5.973887660021115, + "heading": -4.616950885211499e-9, + "angularVelocity": -2.9211418944595953e-8, + "velocityX": 1.471385877286665, + "velocityY": 1.1900558006290538, "moduleForcesX": [ - 88.39092822093185, - 88.39092769362992, - 88.39092737906077, - 88.39092685175883 + 89.69035599106219, + 89.69035566464014, + 89.6903554508019, + 89.69035512437986 ], "moduleForcesY": [ - 74.13782189710152, - 74.13782252444176, - 74.13782290232763, - 74.13782352966786 + 72.54149213079447, + 72.54149253338225, + 72.54149279985882, + 72.54149320244659 ], - "timestamp": 0.22688473124344655 + "timestamp": 0.23290869945134388 }, { - "x": 9.056075856119596, - "y": 6.087751371974113, - "heading": -1.0426526669284518e-8, - "angularVelocity": -5.489336726363388e-8, - "velocityX": 1.8831133909106106, - "velocityY": 1.5794599181008273, + "x": 9.080765498452484, + "y": 6.097055868839682, + "heading": -7.500088755521719e-9, + "angularVelocity": -3.713649868513303e-8, + "velocityX": 1.961523104792119, + "velocityY": 1.5864784240611538, "moduleForcesX": [ - 88.36500041540005, - 88.36499989530782, - 88.36499958562914, - 88.3649990655369 + 89.64943614914598, + 89.649435867025, + 89.64943568274646, + 89.64943540062548 ], "moduleForcesY": [ - 74.11607342088632, - 74.11607403920983, - 74.11607441215982, - 74.11607503048332 + 72.50839621616343, + 72.50839656371213, + 72.50839679419414, + 72.50839714174283 ], - "timestamp": 0.30251297499126206 + "timestamp": 0.31054493260179183 }, { - "x": 9.234063659046555, - "y": 6.237038503722603, - "heading": -1.557166499309143e-8, - "angularVelocity": -6.803196886289352e-8, - "velocityX": 2.3534567789312155, - "velocityY": 1.9739600491886733, + "x": 9.271055736819628, + "y": 6.250962471535493, + "heading": -1.073549075609472e-8, + "angularVelocity": -4.1673866302906887e-8, + "velocityX": 2.4510493444264494, + "velocityY": 1.9824068794986782, "moduleForcesX": [ - 88.31314630713548, - 88.31314580096671, - 88.31314550072481, - 88.31314499455604 + 89.53768214766602, + 89.53768198601387, + 89.53768188126499, + 89.53768171961285 ], "moduleForcesY": [ - 74.07257772785073, - 74.07257832876682, - 74.07257869218154, - 74.07257929309762 + 72.4180097237592, + 72.41800992227425, + 72.41801005460485, + 72.4180102531199 ], - "timestamp": 0.3781412187390776 + "timestamp": 0.3881811657522398 }, { - "x": 9.4475601226603, - "y": 6.4161084917221185, - "heading": -2.1635301021301765e-8, - "angularVelocity": -8.017687212768675e-8, - "velocityX": 2.8229726492877023, - "velocityY": 2.367766050427255, + "x": 9.49869809900886, + "y": 6.435079442411687, + "heading": -1.0740486365273446e-8, + "angularVelocity": -6.43463622084617e-11, + "velocityX": 2.9321665020518726, + "velocityY": 2.371534055746901, "moduleForcesX": [ - 88.1577689515793, - 88.15776848327017, - 88.15776820865642, - 88.1577677403473 + 87.99960165358361, + 87.9996031521215, + 87.99960401789896, + 87.99960551643677 ], "moduleForcesY": [ - 73.94224579656823, - 73.94224635017488, - 73.94224668764966, - 73.94224724125631 + 71.17401211337125, + 71.17401035154614, + 71.1740090913944, + 71.17400732956926 ], - "timestamp": 0.4537694624868931 + "timestamp": 0.4658173989026878 }, { - "x": 9.677596141882916, - "y": 6.609050171403947, - "heading": -2.1638498516596324e-8, - "angularVelocity": -4.2279116053726436e-11, - "velocityX": 3.0416681364395535, - "velocityY": 2.5511855111325596, + "x": 9.726362042155634, + "y": 6.6192137679384295, + "heading": -1.0742801140563784e-8, + "angularVelocity": -2.9815656897269894e-11, + "velocityX": 2.9324444773820186, + "velocityY": 2.3717575937760413, "moduleForcesX": [ - 41.062946226400335, - 41.06294995986298, - 41.06294742447513, - 41.06295115821872 + 0.05084357930085423, + 0.050843583739799025, + 0.050843576958301495, + 0.0508435813824658 ], "moduleForcesY": [ - 34.43941479451628, - 34.43941386958167, - 34.4394093949046, - 34.439408469304034 + 0.040886627539706996, + 0.04088662735487392, + 0.04088662742758808, + 0.040886627202427216 ], - "timestamp": 0.5293977062347086 + "timestamp": 0.5434536320531358 }, { - "x": 9.907642600238958, - "y": 6.801980462733904, - "heading": -2.1641572661594514e-8, - "angularVelocity": -4.064810771272049e-11, - "velocityX": 3.041806168646975, - "velocityY": 2.5510349278146474, + "x": 9.95402738918908, + "y": 6.8033463585260785, + "heading": -1.0745115871317797e-8, + "angularVelocity": -2.981508324339283e-11, + "velocityX": 2.9324625602618077, + "velocityY": 2.3717352467478166, "moduleForcesX": [ - 0.025917397774308324, - 0.025917328301697018, - 0.025917389351188914, - 0.025917320555020107 + 0.0033074817859168504, + 0.0033074817230494984, + 0.0033074819206924118, + 0.0033074818584953513 ], "moduleForcesY": [ - -0.028274266786933316, - -0.0282736710454231, - -0.028274315413410724, - -0.028273725786296774 + -0.004087423593544569, + -0.004087423562385858, + -0.004087423640464884, + -0.004087423608774378 ], - "timestamp": 0.6050259499825241 + "timestamp": 0.6210898652035838 }, { - "x": 10.137927088417136, - "y": 6.9946265705453845, - "heading": -2.1644649186102807e-8, - "angularVelocity": -4.0679570959587807e-11, - "velocityX": 3.0449535354287685, - "velocityY": 2.5472772903978096, + "x": 10.181733463521837, + "y": 6.9874285814533925, + "heading": -1.074743088800836e-8, + "angularVelocity": -2.981876627307324e-11, + "velocityX": 2.9329871516498844, + "velocityY": 2.371086481882621, "moduleForcesX": [ - 0.5909594800381901, - 0.5909595067609218, - 0.5909593553878006, - 0.5909593823053156 + 0.09595133636687113, + 0.09595133639419236, + 0.09595133622165525, + 0.09595133624918448 ], "moduleForcesY": [ - -0.7055458142174947, - -0.7055457144361905, - -0.7055457941638286, - -0.7055456945121257 + -0.11866351070670934, + -0.11866351061126129, + -0.11866351068580717, + -0.11866351059055767 ], - "timestamp": 0.6806541937303396 + "timestamp": 0.6987260983540318 }, { - "x": 10.373636403489725, - "y": 7.1805951955577285, - "heading": -2.1647795040480304e-8, - "angularVelocity": -4.1596290240205244e-11, - "velocityX": 3.116683706930552, - "velocityY": 2.4589837843182147, + "x": 10.410614966666717, + "y": 7.170047155234762, + "heading": -1.0749756659513525e-8, + "angularVelocity": -2.995729456285404e-11, + "velocityX": 2.948127360859176, + "velocityY": 2.352233826536657, "moduleForcesX": [ - 13.468281333716506, - 13.468281354040442, - 13.468281356188696, - 13.468281376663946 + 2.769247338429343, + 2.7692473379301106, + 2.769247340528678, + 2.7692473400289686 ], "moduleForcesY": [ - -16.57826487435633, - -16.578264863811775, - -16.578264859051377, - -16.578264848527045 + -3.448279011124121, + -3.4482790125873186, + -3.4482790114829, + -3.4482790129453678 ], - "timestamp": 0.7562824374781552 + "timestamp": 0.7763623315044798 }, { - "x": 10.632781435401837, - "y": 7.332200360310185, - "heading": -2.165141717454329e-8, - "angularVelocity": -4.7893933314891495e-11, - "velocityX": 3.426564191761982, - "velocityY": 2.0046104106025284, + "x": 10.65790363132542, + "y": 7.326837161822198, + "heading": -1.0752321554540082e-8, + "angularVelocity": -3.303734509707765e-11, + "velocityX": 3.185222345595928, + "velocityY": 2.0195468046936043, "moduleForcesX": [ - 58.184129060385196, - 58.18412905996343, - 58.1841290607348, - 58.18412906031326 + 43.36628685589712, + 43.36628685569246, + 43.36628685589522, + 43.36628685569056 ], "moduleForcesY": [ - -85.31456581480035, - -85.3145658150421, - -85.31456581447162, - -85.31456581471322 + -60.8507212350991, + -60.8507212351631, + -60.850721234945254, + -60.85072123500925 ], - "timestamp": 0.8319106812259707 + "timestamp": 0.8539985646549277 }, { - "x": 10.911920703178911, - "y": 7.442713249379176, - "heading": -2.1655494793679222e-8, - "angularVelocity": -5.39166181000609e-11, - "velocityX": 3.6909394419877284, - "velocityY": 1.461264781415528, + "x": 10.927391884645788, + "y": 7.44131210061748, + "heading": -1.0755422598178304e-8, + "angularVelocity": -3.994325217049011e-11, + "velocityX": 3.4711660056733877, + "velocityY": 1.4745040318152272, "moduleForcesX": [ - 49.63992388193298, - 49.63992388136623, - 49.63992388229504, - 49.63992388172828 + 52.3010421384724, + 52.3010421378729, + 52.301042138880945, + 52.301042138281446 ], "moduleForcesY": [ - -102.02027478490183, - -102.02027478517164, - -102.02027478470922, - -102.02027478497902 + -99.69203382162233, + -99.69203382192677, + -99.69203382138218, + -99.6920338216866 ], - "timestamp": 0.9075389249737862 + "timestamp": 0.9316347978053757 }, { - "x": 11.204682504640854, - "y": 7.509086944055442, - "heading": -2.1480921256388777e-8, - "angularVelocity": 2.3083114011317104e-9, - "velocityX": 3.8710643927970487, - "velocityY": 0.8776310461153859, + "x": 11.212087760685238, + "y": 7.509594379711241, + "heading": -1.0696752381793351e-8, + "angularVelocity": 7.557066334115547e-10, + "velocityX": 3.6670490631320467, + "velocityY": 0.8795156117561665, "moduleForcesX": [ - 33.82082406908605, - 33.82082434253934, - 33.82082395667349, - 33.82082423012678 + 35.828344760314494, + 35.82834484815565, + 35.82834472183995, + 35.8283448096811 ], "moduleForcesY": [ - -109.58489562300169, - -109.58489553923481, - -109.58489566042633, - -109.58489557665945 + -108.82743272946999, + -108.82743270079978, + -108.82743274315156, + -108.82743271448133 ], - "timestamp": 0.9831671687216017 + "timestamp": 1.0092710309558237 }, { "x": 11.504159927368164, "y": 7.529608249664307, - "heading": -1.1466343403767482e-20, - "angularVelocity": 2.840330568564602e-7, - "velocityX": 3.9598621875436577, - "velocityY": 0.2713444685730626, + "heading": 8.515600651837373e-19, + "angularVelocity": 1.3778041448657172e-7, + "velocityX": 3.7620599922323836, + "velocityY": 0.25779032728548, "moduleForcesX": [ - 16.672936827269105, - 16.672973763417115, - 16.672929594277882, - 16.672966530410555 + 17.37813883051844, + 17.378156269782195, + 17.37813526776897, + 17.378152707029315 ], "moduleForcesY": [ - -113.8382661857452, - -113.838260795902, - -113.83826742735344, - -113.8382620375149 + -113.71778825853883, + -113.71778560366965, + -113.71778889227907, + -113.71778623741098 ], - "timestamp": 1.0587954124694172 + "timestamp": 1.0869072641062716 }, { - "x": 11.723814169865044, - "y": 7.544659774408682, - "heading": 0.0003316437637817544, - "angularVelocity": 0.005977710911031631, - "velocityX": 3.959156496885198, - "velocityY": 0.2712961120273982, + "x": 11.721265473032522, + "y": 7.544485128232928, + "heading": 0.0002306514166804671, + "angularVelocity": 0.003996340436793718, + "velocityX": 3.7616403301464163, + "velocityY": 0.2577615704802419, "moduleForcesX": [ - -0.3800231783618881, - 0.018593166861936215, - -0.37983792514906145, - 0.01877807173599767 + -0.23137972399546738, + 0.02479211763118681, + -0.23129698239156646, + 0.024874744187044034 ], "moduleForcesY": [ - 0.25501866357188097, - 0.25515896497349183, - -0.27991031601977506, - -0.2797750022277884 + 0.1647812621759443, + 0.164843620265754, + -0.17899328061080347, + -0.17893257077430022 ], - "timestamp": 1.1142754731009408 + "timestamp": 1.1446229218007191 }, { - "x": 11.943468396861592, - "y": 7.559711298090919, - "heading": 0.0006633655059358208, - "angularVelocity": 0.005979116431707425, - "velocityX": 3.9591562174995163, - "velocityY": 0.27129609288285333, + "x": 11.938371013459317, + "y": 7.559362006442649, + "heading": 0.0004613303187952159, + "angularVelocity": 0.0039968166582452355, + "velocityX": 3.761640239398693, + "velocityY": 0.25776156426187075, "moduleForcesX": [ - -0.00011941564535959291, - -0.0000256129901485413, - -0.00011740546109203538, - -0.00002360245636695837 + -0.00003773149786372426, + -0.000007204180268209206, + -0.000037450447676189646, + -0.000006923116742158263 ], "moduleForcesY": [ - 0.00005720676973222099, - 0.00005871943011131621, - -0.00006851882637692969, - -0.00006700766069155643 + 0.000018849052548043464, + 0.000019058256258897704, + -0.000022118345812749114, + -0.000021908764086262358 ], - "timestamp": 1.1697555337324643 + "timestamp": 1.2023385794951666 }, { - "x": 12.163122621271087, - "y": 7.574762821595881, - "heading": 0.0009951193580978455, - "angularVelocity": 0.0059796951983416505, - "velocityX": 3.959156170869261, - "velocityY": 0.271296089687575, + "x": 12.155476553334907, + "y": 7.574238884614604, + "heading": 0.000692019206656741, + "angularVelocity": 0.0039969896744972404, + "velocityX": 3.7616402298483314, + "velocityY": 0.2577615636074444, "moduleForcesX": [ - -0.00003182466177350351, - 0.000006771270614396005, - -0.00003064136974812045, - 0.00000795445679541281 + -0.000007911344412282606, + 0.0000031796340398333965, + -0.000007879121829168663, + 0.0000032118573271210495 ], "moduleForcesY": [ - 0.000024637758118900774, - 0.000025519938305896045, - -0.000027155298678241116, - -0.00002627374076892752 + 0.000007268884671306007, + 0.000007292887095077557, + -0.000007614918696669374, + -0.000007590905782512107 ], - "timestamp": 1.2252355943639879 + "timestamp": 1.2600542371896142 }, { - "x": 12.382776843106626, - "y": 7.5898143449244655, - "heading": 0.0013269051795884396, - "angularVelocity": 0.005980271429301126, - "velocityX": 3.959156124474958, - "velocityY": 0.271296086508465, + "x": 12.372582092661531, + "y": 7.589115762748938, + "heading": 0.0009227180479962139, + "angularVelocity": 0.003997162131649172, + "velocityX": 3.7616402203368033, + "velocityY": 0.25776156295567915, "moduleForcesX": [ - -0.000031597095571567786, - 0.000006828726915437893, - -0.00003057810958084459, - 0.000007847742744020969 + -0.000007879578286144631, + 0.0000031755910350543595, + -0.00000785596949064241, + 0.000003199199714775384 ], "moduleForcesY": [ - 0.00002458955536444505, - 0.000025349959143754557, - -0.000026976250714836496, - -0.000026218053664441575 + 0.000007248684803897002, + 0.000007266281577818796, + -0.000007586995098265933, + -0.000007569405129248863 ], - "timestamp": 1.2807156549955114 + "timestamp": 1.3177698948840617 }, { - "x": 12.602431062378338, - "y": 7.604865868077367, - "heading": 0.0016587228388953486, - "angularVelocity": 0.005980845289818807, - "velocityX": 3.9591560782633017, - "velocityY": 0.2712960833418706, + "x": 12.58968763144081, + "y": 7.603992640845768, + "heading": 0.0011534268124538383, + "angularVelocity": 0.00399733406277753, + "velocityX": 3.7616402108533076, + "velocityY": 0.2577615623058348, "moduleForcesX": [ - -0.00003137643765755024, - 0.000007003898149552019, - -0.000030655866990225, - 0.00000771666589842292 + -0.000007856426270151256, + 0.0000031650199598336882, + -0.00000783160436860314, + 0.0000031898417770067777 ], "moduleForcesY": [ - 0.000024566199961317356, - 0.00002508688171878728, - -0.000026734376621624633, - -0.000026160681239715125 + 0.000007226080948355998, + 0.000007244576259354271, + -0.00000756434992770978, + -0.000007545850659556913 ], - "timestamp": 1.336195715627035 + "timestamp": 1.3754855525785092 }, { - "x": 12.822085279034965, - "y": 7.619917391051073, - "heading": 0.0019905723973486535, - "angularVelocity": 0.0059814202557801404, - "velocityX": 3.9591560311277263, - "velocityY": 0.2712960801119659, + "x": 12.806793169674307, + "y": 7.618869518905198, + "heading": 0.0013841454697995558, + "angularVelocity": 0.003997505470130205, + "velocityX": 3.7616402013969266, + "velocityY": 0.25776156165784847, "moduleForcesX": [ - -0.000030180275122252033, - 0.000009319628859125455, - -0.0000334276534927207, - 0.000006030646349786755 + -0.000007849474374256643, + 0.000003139441686262953, + -0.00000779264425404203, + 0.0000031961928870877972 ], "moduleForcesY": [ - 0.00002563136670115969, - 0.00002333338017690202, - -0.000024944009939658092, - -0.000027327530705045235 + 0.00000719180863449233, + 0.000007233883614424872, + -0.000007553109769633687, + -0.0000075102973316054884 ], - "timestamp": 1.3916757762585585 + "timestamp": 1.4332012102729568 }, { - "x": 13.041739217817087, - "y": 7.634968894983787, - "heading": 0.0023233217250107695, - "angularVelocity": 0.005997638140161826, - "velocityX": 3.959151022580424, - "velocityY": 0.2712957369076972, + "x": 13.023898706922797, + "y": 7.633746396897134, + "heading": 0.0016148753076260633, + "angularVelocity": 0.003997699186726992, + "velocityX": 3.7616401843303224, + "velocityY": 0.25776156048838134, "moduleForcesX": [ - -0.001811076616468709, - -0.0007285537490287964, - -0.0018353036207771887, - -0.0007528434903345994 + -0.000011019746567382785, + 0.0000014116140586023405, + -0.000009809503136558279, + 0.000002621561543044522 ], "moduleForcesY": [ - 0.0006476415636713516, - 0.0006274114604783823, - -0.0008052877098447759, - -0.0008211396774428359 + 0.000007586054788733624, + 0.000008490175069037687, + -0.00000906467566976256, + -0.000008162483612596876 ], - "timestamp": 1.447155836890082 + "timestamp": 1.4909168679674043 }, { - "x": 13.260174320772844, - "y": 7.649936879757519, - "heading": 0.006574946131355052, - "angularVelocity": 0.07663337707184353, - "velocityX": 3.9371821239799427, - "velocityY": 0.2697903463578355, + "x": 13.24100074826179, + "y": 7.648623035336362, + "heading": 0.0018561069459867565, + "angularVelocity": 0.004179656751687672, + "velocityX": 3.761579613080985, + "velocityY": 0.25775740992134544, "moduleForcesX": [ - -7.99310631283451, - -3.2965571422513857, - -7.948703890086734, - -3.253508368178124 + -0.020760270003833053, + -0.009094518538519383, + -0.020710863092040826, + -0.009045457185681977 ], "moduleForcesY": [ - 2.759504254840201, - 2.801876303080084, - -3.5597663854085146, - -3.5428410570857647 + 0.006786622699577082, + 0.006822833851212185, + -0.008865931591266973, + -0.008828299600102445 ], - "timestamp": 1.5026358975216056 + "timestamp": 1.5486325256618518 }, { - "x": 13.45491022910445, - "y": 7.663280907669538, - "heading": 0.03547098491568591, - "angularVelocity": 0.5208364672895163, - "velocityX": 3.5100161412036357, - "velocityY": 0.24051934623224105, + "x": 13.443353616594075, + "y": 7.662489005645776, + "heading": 0.04225938920162335, + "angularVelocity": 0.7000402294562001, + "velocityX": 3.506030710133503, + "velocityY": 0.24024624968884079, "moduleForcesX": [ - -112.65722835544774, - -110.08477802292602, - -109.61792794131873, - -104.97488015141087 + -79.0685909618201, + -50.58995823940847, + -75.86574911891587, + -45.97379077401321 ], "moduleForcesY": [ - 17.266378646952028, - 26.808134666937164, - -31.268524352599332, - -42.773795213348265 + 24.57350746925242, + 38.053994012355105, + -34.0608976536489, + -45.8001872458519 ], - "timestamp": 1.5581159581531292 + "timestamp": 1.6063481833562994 }, { - "x": 13.625911868933855, - "y": 7.674998575327416, - "heading": 0.036437057187586885, - "angularVelocity": 0.017412963520664588, - "velocityX": 3.0822179695355967, - "velocityY": 0.2112050261751085, + "x": 13.620987292267783, + "y": 7.674661125038714, + "heading": 0.04217975934168366, + "angularVelocity": -0.0013796924980265383, + "velocityX": 3.0777380483840022, + "velocityY": 0.21089804533422155, "moduleForcesX": [ - -104.3550095871483, - -109.9895441753885, - -110.29427213876139, - -113.34322693340162 + -96.77847026846838, + -107.9030731985583, + -104.77822606455094, + -112.04384390865172 ], "moduleForcesY": [ - -47.97784316156552, - -33.766005815685666, - 31.984331361894537, - 19.74736018603692 + -61.53659629054846, + -39.742791431053234, + 46.56311157639095, + 25.833282603076576 ], - "timestamp": 1.6135960187846528 + "timestamp": 1.664063841050747 }, { "x": 13.774003028869627, "y": 7.685146331787109, - "heading": -1.0216757134766161e-20, - "angularVelocity": -0.656759505538167, - "velocityX": 2.6692681704033068, - "velocityY": 0.18290817176805882, + "heading": -1.007498877189806e-18, + "angularVelocity": -0.7308200413306815, + "velocityX": 2.6511997387593604, + "velocityY": 0.1816700557048792, "moduleForcesX": [ - -96.61655453478754, - -108.47344443180624, - -105.62360385351926, - -112.06660691389176 + -95.19524925336464, + -108.15585163442557, + -104.58809520721027, + -111.83787419864792 ], "moduleForcesY": [ - -62.57662299104666, - -38.92519570430598, - 45.679141765122075, - 26.852206267299998 + -64.67933399592916, + -39.76761501132085, + 47.94032248604527, + 27.74194212984135 ], - "timestamp": 1.6690760794161763 + "timestamp": 1.7217794987451944 }, { - "x": 13.936101730471314, - "y": 7.6649237183136245, - "heading": -0.05404788012796307, - "angularVelocity": -0.8367505818789226, - "velocityX": 2.509556018957628, - "velocityY": -0.3130795056344143, + "x": 13.935035958999284, + "y": 7.664782649008714, + "heading": -0.05780109053495526, + "angularVelocity": -0.8964222673734035, + "velocityX": 2.497418353401382, + "velocityY": -0.31581512596622585, "moduleForcesX": [ - -20.093926933349476, - -41.83422551523411, - -25.248051251260648, - -53.269880817247596 + -19.9714407549644, + -40.44308656666267, + -24.49636920750514, + -50.556470643095416 ], "moduleForcesY": [ - -113.64526973932998, - -107.56161028308789, - -112.58952761642209, - -102.3603069840681 + -113.66567125217688, + -108.09087389552265, + -112.75580340484727, + -103.7266984641109 ], - "timestamp": 1.7336686608836414 + "timestamp": 1.786259256375845 }, { - "x": 14.086544019767228, - "y": 7.613116434507106, - "heading": -0.11934484607806041, - "angularVelocity": -1.010905036873114, - "velocityX": 2.3290954762613043, - "velocityY": -0.8020624447811118, + "x": 14.084799871677337, + "y": 7.612780905683724, + "heading": -0.12587786054142183, + "angularVelocity": -1.0557851410735792, + "velocityX": 2.322650056098518, + "velocityY": -0.8064816810085409, "moduleForcesX": [ - -25.536274706249685, - -46.56911838452923, - -29.770241346526483, - -56.81596418002521 + -25.499150978953384, + -45.22637504187557, + -29.09597042008306, + -54.133424993041125 ], "moduleForcesY": [ - -112.5342845020268, - -105.58420453918785, - -111.46183761296862, - -100.41663085453071 + -112.54112536251206, + -106.16430182617324, + -111.64007832404387, + -101.88695367808475 ], - "timestamp": 1.7982612423511064 + "timestamp": 1.8507390140064957 }, { - "x": 14.223301675262098, - "y": 7.530531275179706, - "heading": -0.19531452901541774, - "angularVelocity": -1.1761363489648249, - "velocityX": 2.1172347100534177, - "velocityY": -1.27855486576267, + "x": 14.221239414597168, + "y": 7.529933622115767, + "heading": -0.20362445988353564, + "angularVelocity": -1.205752040624248, + "velocityX": 2.1160058277727787, + "velocityY": -1.2848572422141997, "moduleForcesX": [ - -33.520931651827894, - -53.22911230390822, - -37.27033259543515, - -62.28363856197366 + -33.61193018096122, + -51.96652105002978, + -36.73910240668662, + -59.717154187720176 ], "moduleForcesY": [ - -110.39863935620404, - -102.36662249013638, - -109.15657312819253, - -97.09133480103486 + -110.36868341598847, + -103.01044274754193, + -109.33674686043942, + -98.68934221201837 ], - "timestamp": 1.8628538238185715 + "timestamp": 1.9152187716371463 }, { - "x": 14.343025710960973, - "y": 7.418854878805072, - "heading": -0.2809594489484934, - "angularVelocity": -1.325925020913038, - "velocityX": 1.8535261012780369, - "velocityY": -1.728935333400246, + "x": 14.340943734877591, + "y": 7.417920323946956, + "heading": -0.28999690085220237, + "angularVelocity": -1.3395280029342027, + "velocityX": 1.8564635581620241, + "velocityY": -1.7371854716086177, "moduleForcesX": [ - -46.39707082363187, - -63.43366418473748, - -50.63883300977956, - -71.42788762753942 + -46.751588789826286, + -62.37320446686807, + -50.35015435786008, + -69.15810736949086 ], "moduleForcesY": [ - -105.59817168074842, - -96.33740524696931, - -103.58836930621422, - -90.52715351089934 + -105.43790145029115, + -97.02260752007686, + -103.72888519276779, + -92.27049869774005 ], - "timestamp": 1.9274464052860365 + "timestamp": 1.9796985292677969 }, { - "x": 14.439640325423767, - "y": 7.282561627306501, - "heading": -0.3741539927257661, - "angularVelocity": -1.4428056854209232, - "velocityX": 1.4957540365755364, - "velocityY": -2.1100449680466906, + "x": 14.437683961642778, + "y": 7.281280072098083, + "heading": -0.38276450479544777, + "angularVelocity": -1.438708942962096, + "velocityX": 1.5003193299721982, + "velocityY": -2.1191185710028404, "moduleForcesX": [ - -70.2431689631601, - -81.12995040952687, - -75.69379680678863, - -87.54712653568923 + -71.23628387541437, + -80.66473849864646, + -75.82283658408791, + -86.00670611740921 ], "moduleForcesY": [ - -91.39966744732322, - -81.90176576678061, - -86.88518138121627, - -74.94978844811001 + -90.61976741253616, + -82.34976809206417, + -86.77144470833049, + -76.70722702894544 ], - "timestamp": 1.9920389867535016 + "timestamp": 2.0441782868984473 }, { - "x": 14.50377014296591, - "y": 7.136817952344609, - "heading": -0.46758899852853547, - "angularVelocity": -1.446528435310054, - "velocityX": 0.9928356490047452, - "velocityY": -2.256353154662236, + "x": 14.501936386050707, + "y": 7.1356478733639035, + "heading": -0.47425263991314337, + "angularVelocity": -1.4188659895676565, + "velocityX": 0.9964743474374752, + "velocityY": -2.2585723657396755, "moduleForcesX": [ - -110.46580054393864, - -110.54658737476862, - -110.57960043427867, - -110.65938530025993 + -111.44531662002107, + -111.05416659333267, + -110.88084813088581, + -110.46111986931393 ], "moduleForcesY": [ - -32.49781898234192, - -32.22495698602894, - -32.10463531819626, - -31.831627846959343 + -28.930831010677075, + -30.379702096445232, + -31.044847165146514, + -32.49068702774292 ], - "timestamp": 2.0566315682209666 + "timestamp": 2.108658044529098 }, { - "x": 14.53996714646827, - "y": 7.00954832171531, - "heading": -0.5431710549769495, - "angularVelocity": -1.1701352497652444, - "velocityX": 0.5603894856035541, - "velocityY": -1.9703443915367327, + "x": 14.538645426348966, + "y": 7.008815909604144, + "heading": -0.5473253251672447, + "angularVelocity": -1.1332655074895337, + "velocityX": 0.5693110775715775, + "velocityY": -1.9670043502066366, "moduleForcesX": [ - -87.53770821277456, - -84.5907695917968, - -103.58271444424955, - -104.56901726794133 + -86.23137198290863, + -82.87186793378041, + -103.10238518870169, + -104.08623484052193 ], "moduleForcesY": [ - 74.87353802308711, - 78.09476192896813, - 50.38760823256533, - 48.15163557428627 + 76.37745701415473, + 79.91712175914675, + 51.366193333691044, + 49.18404252351033 ], - "timestamp": 2.1212241496884316 + "timestamp": 2.1731378021597485 }, { - "x": 14.560150155522226, - "y": 6.911539256829025, - "heading": -0.598147081877329, - "angularVelocity": -0.8511198291102623, - "velocityX": 0.31246636371270964, - "velocityY": -1.517342435611623, + "x": 14.559418537812661, + "y": 6.911177269143886, + "heading": -0.6002567765952495, + "angularVelocity": -0.820900285190336, + "velocityX": 0.3221648502881852, + "velocityY": -1.5142525972189051, "moduleForcesX": [ - -46.109164119120734, - -30.063756225968806, - -74.99270372130417, - -66.85054699912216 + -46.145857817831676, + -30.484801894737284, + -74.56500704734023, + -66.5176061352037 ], "moduleForcesY": [ - 105.68256490842477, - 111.2770803271555, - 87.55367623297964, - 93.84303659418195 + 105.66705745601725, + 111.16368416399354, + 87.9194683312, + 94.0827685467072 ], - "timestamp": 2.1858167311558967 + "timestamp": 2.237617559790399 }, { - "x": 14.570650392409606, - "y": 6.845493549123404, - "heading": -0.6338212894662737, - "angularVelocity": -0.5522957401371792, - "velocityX": 0.16256103485613507, - "velocityY": -1.0224967976994013, + "x": 14.570390149911358, + "y": 6.84537565225515, + "heading": -0.6345291644881725, + "angularVelocity": -0.5315216612512779, + "velocityX": 0.1701559140706136, + "velocityY": -1.020500375724994, "moduleForcesX": [ - -26.678062716919186, - -6.490482928094056, - -57.014388668296064, - -41.63932401569198 + -27.295991115954983, + -7.911741357015105, + -56.732341958223465, + -41.96592679327208 ], "moduleForcesY": [ - 112.22997904008606, - 115.15324971354988, - 100.25774640780512, - 107.51146412413148 + 112.08099626886072, + 115.06446151670661, + 100.41815919051002, + 107.38703277594337 ], - "timestamp": 2.2504093126233617 + "timestamp": 2.3020973174210497 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -0.2696598841914466, - "velocityX": 0.065342965506683, - "velocityY": -0.514035511223207, + "angularVelocity": -0.2591534712639973, + "velocityX": 0.06949333381079491, + "velocityY": -0.5131065156466121, "moduleForcesX": [ - -16.65484746801905, - 4.857070171723746, - -46.43149894465741, - -27.26138342927001 + -17.497246051703055, + 3.059767167772353, + -46.22660111522497, + -28.01046724085712 ], "moduleForcesY": [ - 114.17712362294917, - 115.26897371338562, - 105.61087783646228, - 112.06865783448852 + 114.05057698106343, + 115.33044468651329, + 105.70098429664752, + 111.88568251229185 ], - "timestamp": 2.315001894090827 + "timestamp": 2.3665770750517003 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -5.645946234609016e-22, - "velocityX": -3.1761678507214283e-21, - "velocityY": 7.19219703597375e-23, + "angularVelocity": -4.1843925027882567e-20, + "velocityX": -1.2624804704208055e-19, + "velocityY": 8.893976865334932e-21, "moduleForcesX": [ - -10.902305920487686, - 11.194107913077895, - -39.6575688795007, - -18.094880741208897 + -11.831191033758017, + 9.238891886616917, + -39.495635804588694, + -19.129350517864943 ], "moduleForcesY": [ - 114.88625738279923, - 114.84784529450766, - 108.35750475803422, - 113.93583193326243 + 114.79379693930306, + 115.02128580058942, + 108.41678324342674, + 113.76815074013277 ], - "timestamp": 2.379594475558292 + "timestamp": 2.431056832682351 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red 5 to Amp.traj b/src/main/deploy/choreo/Red 5 to Amp.traj index 57e734a..be7b6f9 100644 --- a/src/main/deploy/choreo/Red 5 to Amp.traj +++ b/src/main/deploy/choreo/Red 5 to Amp.traj @@ -3,10 +3,10 @@ { "x": 8.7, "y": 5.789093017578125, - "heading": -2.0455733052614176e-22, - "angularVelocity": -3.8646051503558115e-23, - "velocityX": -1.6361619392483338e-21, - "velocityY": 8.474609168336952e-22, + "heading": 7.247326847218455e-23, + "angularVelocity": 1.03987844992159e-23, + "velocityX": -2.83848661247132e-21, + "velocityY": 1.754450024355998e-22, "moduleForcesX": [ 0, 0, @@ -22,760 +22,760 @@ "timestamp": 0 }, { - "x": 8.735613015250742, - "y": 5.818963407451602, - "heading": -1.0502454961256607e-9, - "angularVelocity": -1.3886948104035371e-8, - "velocityX": 0.47089570623239124, - "velocityY": 0.39496342098173537, + "x": 8.738084296106212, + "y": 5.8198955678928925, + "heading": -7.933185096139342e-10, + "angularVelocity": -1.0218405471537252e-8, + "velocityX": 0.4905479640210178, + "velocityY": 0.3967548278015508, "moduleForcesX": [ - 88.41685134026662, - 88.41685080559071, - 88.41685048601633, - 88.41684995134041 + 89.72456276282517, + 89.72456239926017, + 89.72456216050942, + 89.72456179694441 ], "moduleForcesY": [ - 74.15956644197404, - 74.15956707853893, - 74.15956746147184, - 74.15956809803674 + 72.56915852264277, + 72.56915897147265, + 72.5691592680868, + 72.56915971691669 ], - "timestamp": 0.07562824374781552 + "timestamp": 0.07763623315044796 }, { - "x": 8.806834869518331, - "y": 5.87870068413291, - "heading": -3.1448393381201233e-9, - "angularVelocity": -2.769592070627396e-8, - "velocityX": 0.9417361919057632, - "velocityY": 0.7898805224209977, + "x": 8.814247376335548, + "y": 5.881496210421434, + "heading": -2.349086353373507e-9, + "angularVelocity": -2.0039197944402956e-8, + "velocityX": 0.9810249304824148, + "velocityY": 0.7934522326600846, "moduleForcesX": [ - 88.40648295141082, - 88.406482419705, - 88.40648210214698, - 88.40648157044113 + 89.71157680696294, + 89.71157645751236, + 89.71157622824228, + 89.71157587879172 ], "moduleForcesY": [ - 74.1508693445355, - 74.15086997738463, - 74.15087035828485, - 74.15087099113398 + 72.55865549873482, + 72.55865592998228, + 72.55865621514842, + 72.55865664639586 ], - "timestamp": 0.15125648749563103 + "timestamp": 0.15527246630089592 }, { - "x": 8.913659297587033, - "y": 5.968299592298079, - "heading": -6.275037709731855e-9, - "angularVelocity": -4.138927755679822e-8, - "velocityX": 1.4124938353045782, - "velocityY": 1.1847281349536443, + "x": 8.92848023335885, + "y": 5.973887660021115, + "heading": -4.616950885211499e-9, + "angularVelocity": -2.9211418944595953e-8, + "velocityX": 1.471385877286665, + "velocityY": 1.1900558006290538, "moduleForcesX": [ - 88.39092822093185, - 88.39092769362992, - 88.39092737906077, - 88.39092685175883 + 89.69035599106219, + 89.69035566464014, + 89.6903554508019, + 89.69035512437986 ], "moduleForcesY": [ - 74.13782189710152, - 74.13782252444176, - 74.13782290232763, - 74.13782352966786 + 72.54149213079447, + 72.54149253338225, + 72.54149279985882, + 72.54149320244659 ], - "timestamp": 0.22688473124344655 + "timestamp": 0.23290869945134388 }, { - "x": 9.056075856119596, - "y": 6.087751371974113, - "heading": -1.0426526669284518e-8, - "angularVelocity": -5.489336726363388e-8, - "velocityX": 1.8831133909106106, - "velocityY": 1.5794599181008273, + "x": 9.080765498452484, + "y": 6.097055868839682, + "heading": -7.500088755521719e-9, + "angularVelocity": -3.713649868513303e-8, + "velocityX": 1.961523104792119, + "velocityY": 1.5864784240611538, "moduleForcesX": [ - 88.36500041540005, - 88.36499989530782, - 88.36499958562914, - 88.3649990655369 + 89.64943614914598, + 89.649435867025, + 89.64943568274646, + 89.64943540062548 ], "moduleForcesY": [ - 74.11607342088632, - 74.11607403920983, - 74.11607441215982, - 74.11607503048332 + 72.50839621616343, + 72.50839656371213, + 72.50839679419414, + 72.50839714174283 ], - "timestamp": 0.30251297499126206 + "timestamp": 0.31054493260179183 }, { - "x": 9.234063659046555, - "y": 6.237038503722603, - "heading": -1.557166499309143e-8, - "angularVelocity": -6.803196886289352e-8, - "velocityX": 2.3534567789312155, - "velocityY": 1.9739600491886733, + "x": 9.271055736819628, + "y": 6.250962471535493, + "heading": -1.073549075609472e-8, + "angularVelocity": -4.1673866302906887e-8, + "velocityX": 2.4510493444264494, + "velocityY": 1.9824068794986782, "moduleForcesX": [ - 88.31314630713548, - 88.31314580096671, - 88.31314550072481, - 88.31314499455604 + 89.53768214766602, + 89.53768198601387, + 89.53768188126499, + 89.53768171961285 ], "moduleForcesY": [ - 74.07257772785073, - 74.07257832876682, - 74.07257869218154, - 74.07257929309762 + 72.4180097237592, + 72.41800992227425, + 72.41801005460485, + 72.4180102531199 ], - "timestamp": 0.3781412187390776 + "timestamp": 0.3881811657522398 }, { - "x": 9.4475601226603, - "y": 6.4161084917221185, - "heading": -2.1635301021301765e-8, - "angularVelocity": -8.017687212768675e-8, - "velocityX": 2.8229726492877023, - "velocityY": 2.367766050427255, + "x": 9.49869809900886, + "y": 6.435079442411687, + "heading": -1.0740486365273446e-8, + "angularVelocity": -6.43463622084617e-11, + "velocityX": 2.9321665020518726, + "velocityY": 2.371534055746901, "moduleForcesX": [ - 88.1577689515793, - 88.15776848327017, - 88.15776820865642, - 88.1577677403473 + 87.99960165358361, + 87.9996031521215, + 87.99960401789896, + 87.99960551643677 ], "moduleForcesY": [ - 73.94224579656823, - 73.94224635017488, - 73.94224668764966, - 73.94224724125631 + 71.17401211337125, + 71.17401035154614, + 71.1740090913944, + 71.17400732956926 ], - "timestamp": 0.4537694624868931 + "timestamp": 0.4658173989026878 }, { - "x": 9.677596141882916, - "y": 6.609050171403947, - "heading": -2.1638498516596324e-8, - "angularVelocity": -4.2279116053726436e-11, - "velocityX": 3.0416681364395535, - "velocityY": 2.5511855111325596, + "x": 9.726362042155634, + "y": 6.6192137679384295, + "heading": -1.0742801140563784e-8, + "angularVelocity": -2.9815656897269894e-11, + "velocityX": 2.9324444773820186, + "velocityY": 2.3717575937760413, "moduleForcesX": [ - 41.062946226400335, - 41.06294995986298, - 41.06294742447513, - 41.06295115821872 + 0.05084357930085423, + 0.050843583739799025, + 0.050843576958301495, + 0.0508435813824658 ], "moduleForcesY": [ - 34.43941479451628, - 34.43941386958167, - 34.4394093949046, - 34.439408469304034 + 0.040886627539706996, + 0.04088662735487392, + 0.04088662742758808, + 0.040886627202427216 ], - "timestamp": 0.5293977062347086 + "timestamp": 0.5434536320531358 }, { - "x": 9.907642600238958, - "y": 6.801980462733904, - "heading": -2.1641572661594514e-8, - "angularVelocity": -4.064810771272049e-11, - "velocityX": 3.041806168646975, - "velocityY": 2.5510349278146474, + "x": 9.95402738918908, + "y": 6.8033463585260785, + "heading": -1.0745115871317797e-8, + "angularVelocity": -2.981508324339283e-11, + "velocityX": 2.9324625602618077, + "velocityY": 2.3717352467478166, "moduleForcesX": [ - 0.025917397774308324, - 0.025917328301697018, - 0.025917389351188914, - 0.025917320555020107 + 0.0033074817859168504, + 0.0033074817230494984, + 0.0033074819206924118, + 0.0033074818584953513 ], "moduleForcesY": [ - -0.028274266786933316, - -0.0282736710454231, - -0.028274315413410724, - -0.028273725786296774 + -0.004087423593544569, + -0.004087423562385858, + -0.004087423640464884, + -0.004087423608774378 ], - "timestamp": 0.6050259499825241 + "timestamp": 0.6210898652035838 }, { - "x": 10.137927088417136, - "y": 6.9946265705453845, - "heading": -2.1644649186102807e-8, - "angularVelocity": -4.0679570959587807e-11, - "velocityX": 3.0449535354287685, - "velocityY": 2.5472772903978096, + "x": 10.181733463521837, + "y": 6.9874285814533925, + "heading": -1.074743088800836e-8, + "angularVelocity": -2.981876627307324e-11, + "velocityX": 2.9329871516498844, + "velocityY": 2.371086481882621, "moduleForcesX": [ - 0.5909594800381901, - 0.5909595067609218, - 0.5909593553878006, - 0.5909593823053156 + 0.09595133636687113, + 0.09595133639419236, + 0.09595133622165525, + 0.09595133624918448 ], "moduleForcesY": [ - -0.7055458142174947, - -0.7055457144361905, - -0.7055457941638286, - -0.7055456945121257 + -0.11866351070670934, + -0.11866351061126129, + -0.11866351068580717, + -0.11866351059055767 ], - "timestamp": 0.6806541937303396 + "timestamp": 0.6987260983540318 }, { - "x": 10.373636403489725, - "y": 7.1805951955577285, - "heading": -2.1647795040480304e-8, - "angularVelocity": -4.1596290240205244e-11, - "velocityX": 3.116683706930552, - "velocityY": 2.4589837843182147, + "x": 10.410614966666717, + "y": 7.170047155234762, + "heading": -1.0749756659513525e-8, + "angularVelocity": -2.995729456285404e-11, + "velocityX": 2.948127360859176, + "velocityY": 2.352233826536657, "moduleForcesX": [ - 13.468281333716506, - 13.468281354040442, - 13.468281356188696, - 13.468281376663946 + 2.769247338429343, + 2.7692473379301106, + 2.769247340528678, + 2.7692473400289686 ], "moduleForcesY": [ - -16.57826487435633, - -16.578264863811775, - -16.578264859051377, - -16.578264848527045 + -3.448279011124121, + -3.4482790125873186, + -3.4482790114829, + -3.4482790129453678 ], - "timestamp": 0.7562824374781552 + "timestamp": 0.7763623315044798 }, { - "x": 10.632781435401837, - "y": 7.332200360310185, - "heading": -2.165141717454329e-8, - "angularVelocity": -4.7893933314891495e-11, - "velocityX": 3.426564191761982, - "velocityY": 2.0046104106025284, + "x": 10.65790363132542, + "y": 7.326837161822198, + "heading": -1.0752321554540082e-8, + "angularVelocity": -3.303734509707765e-11, + "velocityX": 3.185222345595928, + "velocityY": 2.0195468046936043, "moduleForcesX": [ - 58.184129060385196, - 58.18412905996343, - 58.1841290607348, - 58.18412906031326 + 43.36628685589712, + 43.36628685569246, + 43.36628685589522, + 43.36628685569056 ], "moduleForcesY": [ - -85.31456581480035, - -85.3145658150421, - -85.31456581447162, - -85.31456581471322 + -60.8507212350991, + -60.8507212351631, + -60.850721234945254, + -60.85072123500925 ], - "timestamp": 0.8319106812259707 + "timestamp": 0.8539985646549277 }, { - "x": 10.911920703178911, - "y": 7.442713249379176, - "heading": -2.1655494793679222e-8, - "angularVelocity": -5.39166181000609e-11, - "velocityX": 3.6909394419877284, - "velocityY": 1.461264781415528, + "x": 10.927391884645788, + "y": 7.44131210061748, + "heading": -1.0755422598178304e-8, + "angularVelocity": -3.994325217049011e-11, + "velocityX": 3.4711660056733877, + "velocityY": 1.4745040318152272, "moduleForcesX": [ - 49.63992388193298, - 49.63992388136623, - 49.63992388229504, - 49.63992388172828 + 52.3010421384724, + 52.3010421378729, + 52.301042138880945, + 52.301042138281446 ], "moduleForcesY": [ - -102.02027478490183, - -102.02027478517164, - -102.02027478470922, - -102.02027478497902 + -99.69203382162233, + -99.69203382192677, + -99.69203382138218, + -99.6920338216866 ], - "timestamp": 0.9075389249737862 + "timestamp": 0.9316347978053757 }, { - "x": 11.204682504640854, - "y": 7.509086944055442, - "heading": -2.1480921256388777e-8, - "angularVelocity": 2.3083114011317104e-9, - "velocityX": 3.8710643927970487, - "velocityY": 0.8776310461153859, + "x": 11.212087760685238, + "y": 7.509594379711241, + "heading": -1.0696752381793351e-8, + "angularVelocity": 7.557066334115547e-10, + "velocityX": 3.6670490631320467, + "velocityY": 0.8795156117561665, "moduleForcesX": [ - 33.82082406908605, - 33.82082434253934, - 33.82082395667349, - 33.82082423012678 + 35.828344760314494, + 35.82834484815565, + 35.82834472183995, + 35.8283448096811 ], "moduleForcesY": [ - -109.58489562300169, - -109.58489553923481, - -109.58489566042633, - -109.58489557665945 + -108.82743272946999, + -108.82743270079978, + -108.82743274315156, + -108.82743271448133 ], - "timestamp": 0.9831671687216017 + "timestamp": 1.0092710309558237 }, { "x": 11.504159927368164, "y": 7.529608249664307, - "heading": -1.1466343403767482e-20, - "angularVelocity": 2.840330568564602e-7, - "velocityX": 3.9598621875436577, - "velocityY": 0.2713444685730626, + "heading": 8.515600651837373e-19, + "angularVelocity": 1.3778041448657172e-7, + "velocityX": 3.7620599922323836, + "velocityY": 0.25779032728548, "moduleForcesX": [ - 16.672936827269105, - 16.672973763417115, - 16.672929594277882, - 16.672966530410555 + 17.37813883051844, + 17.378156269782195, + 17.37813526776897, + 17.378152707029315 ], "moduleForcesY": [ - -113.8382661857452, - -113.838260795902, - -113.83826742735344, - -113.8382620375149 + -113.71778825853883, + -113.71778560366965, + -113.71778889227907, + -113.71778623741098 ], - "timestamp": 1.0587954124694172 + "timestamp": 1.0869072641062716 }, { - "x": 11.723814169865044, - "y": 7.544659774408682, - "heading": 0.0003316437637817544, - "angularVelocity": 0.005977710911031631, - "velocityX": 3.959156496885198, - "velocityY": 0.2712961120273982, + "x": 11.721265473032522, + "y": 7.544485128232928, + "heading": 0.0002306514166804671, + "angularVelocity": 0.003996340436793718, + "velocityX": 3.7616403301464163, + "velocityY": 0.2577615704802419, "moduleForcesX": [ - -0.3800231783618881, - 0.018593166861936215, - -0.37983792514906145, - 0.01877807173599767 + -0.23137972399546738, + 0.02479211763118681, + -0.23129698239156646, + 0.024874744187044034 ], "moduleForcesY": [ - 0.25501866357188097, - 0.25515896497349183, - -0.27991031601977506, - -0.2797750022277884 + 0.1647812621759443, + 0.164843620265754, + -0.17899328061080347, + -0.17893257077430022 ], - "timestamp": 1.1142754731009408 + "timestamp": 1.1446229218007191 }, { - "x": 11.943468396861592, - "y": 7.559711298090919, - "heading": 0.0006633655059358208, - "angularVelocity": 0.005979116431707425, - "velocityX": 3.9591562174995163, - "velocityY": 0.27129609288285333, + "x": 11.938371013459317, + "y": 7.559362006442649, + "heading": 0.0004613303187952159, + "angularVelocity": 0.0039968166582452355, + "velocityX": 3.761640239398693, + "velocityY": 0.25776156426187075, "moduleForcesX": [ - -0.00011941564535959291, - -0.0000256129901485413, - -0.00011740546109203538, - -0.00002360245636695837 + -0.00003773149786372426, + -0.000007204180268209206, + -0.000037450447676189646, + -0.000006923116742158263 ], "moduleForcesY": [ - 0.00005720676973222099, - 0.00005871943011131621, - -0.00006851882637692969, - -0.00006700766069155643 + 0.000018849052548043464, + 0.000019058256258897704, + -0.000022118345812749114, + -0.000021908764086262358 ], - "timestamp": 1.1697555337324643 + "timestamp": 1.2023385794951666 }, { - "x": 12.163122621271087, - "y": 7.574762821595881, - "heading": 0.0009951193580978455, - "angularVelocity": 0.0059796951983416505, - "velocityX": 3.959156170869261, - "velocityY": 0.271296089687575, + "x": 12.155476553334907, + "y": 7.574238884614604, + "heading": 0.000692019206656741, + "angularVelocity": 0.0039969896744972404, + "velocityX": 3.7616402298483314, + "velocityY": 0.2577615636074444, "moduleForcesX": [ - -0.00003182466177350351, - 0.000006771270614396005, - -0.00003064136974812045, - 0.00000795445679541281 + -0.000007911344412282606, + 0.0000031796340398333965, + -0.000007879121829168663, + 0.0000032118573271210495 ], "moduleForcesY": [ - 0.000024637758118900774, - 0.000025519938305896045, - -0.000027155298678241116, - -0.00002627374076892752 + 0.000007268884671306007, + 0.000007292887095077557, + -0.000007614918696669374, + -0.000007590905782512107 ], - "timestamp": 1.2252355943639879 + "timestamp": 1.2600542371896142 }, { - "x": 12.382776843106626, - "y": 7.5898143449244655, - "heading": 0.0013269051795884396, - "angularVelocity": 0.005980271429301126, - "velocityX": 3.959156124474958, - "velocityY": 0.271296086508465, + "x": 12.372582092661531, + "y": 7.589115762748938, + "heading": 0.0009227180479962139, + "angularVelocity": 0.003997162131649172, + "velocityX": 3.7616402203368033, + "velocityY": 0.25776156295567915, "moduleForcesX": [ - -0.000031597095571567786, - 0.000006828726915437893, - -0.00003057810958084459, - 0.000007847742744020969 + -0.000007879578286144631, + 0.0000031755910350543595, + -0.00000785596949064241, + 0.000003199199714775384 ], "moduleForcesY": [ - 0.00002458955536444505, - 0.000025349959143754557, - -0.000026976250714836496, - -0.000026218053664441575 + 0.000007248684803897002, + 0.000007266281577818796, + -0.000007586995098265933, + -0.000007569405129248863 ], - "timestamp": 1.2807156549955114 + "timestamp": 1.3177698948840617 }, { - "x": 12.602431062378338, - "y": 7.604865868077367, - "heading": 0.0016587228388953486, - "angularVelocity": 0.005980845289818807, - "velocityX": 3.9591560782633017, - "velocityY": 0.2712960833418706, + "x": 12.58968763144081, + "y": 7.603992640845768, + "heading": 0.0011534268124538383, + "angularVelocity": 0.00399733406277753, + "velocityX": 3.7616402108533076, + "velocityY": 0.2577615623058348, "moduleForcesX": [ - -0.00003137643765755024, - 0.000007003898149552019, - -0.000030655866990225, - 0.00000771666589842292 + -0.000007856426270151256, + 0.0000031650199598336882, + -0.00000783160436860314, + 0.0000031898417770067777 ], "moduleForcesY": [ - 0.000024566199961317356, - 0.00002508688171878728, - -0.000026734376621624633, - -0.000026160681239715125 + 0.000007226080948355998, + 0.000007244576259354271, + -0.00000756434992770978, + -0.000007545850659556913 ], - "timestamp": 1.336195715627035 + "timestamp": 1.3754855525785092 }, { - "x": 12.822085279034965, - "y": 7.619917391051073, - "heading": 0.0019905723973486535, - "angularVelocity": 0.0059814202557801404, - "velocityX": 3.9591560311277263, - "velocityY": 0.2712960801119659, + "x": 12.806793169674307, + "y": 7.618869518905198, + "heading": 0.0013841454697995558, + "angularVelocity": 0.003997505470130205, + "velocityX": 3.7616402013969266, + "velocityY": 0.25776156165784847, "moduleForcesX": [ - -0.000030180275122252033, - 0.000009319628859125455, - -0.0000334276534927207, - 0.000006030646349786755 + -0.000007849474374256643, + 0.000003139441686262953, + -0.00000779264425404203, + 0.0000031961928870877972 ], "moduleForcesY": [ - 0.00002563136670115969, - 0.00002333338017690202, - -0.000024944009939658092, - -0.000027327530705045235 + 0.00000719180863449233, + 0.000007233883614424872, + -0.000007553109769633687, + -0.0000075102973316054884 ], - "timestamp": 1.3916757762585585 + "timestamp": 1.4332012102729568 }, { - "x": 13.041739217817087, - "y": 7.634968894983787, - "heading": 0.0023233217250107695, - "angularVelocity": 0.005997638140161826, - "velocityX": 3.959151022580424, - "velocityY": 0.2712957369076972, + "x": 13.023898706922797, + "y": 7.633746396897134, + "heading": 0.0016148753076260633, + "angularVelocity": 0.003997699186726992, + "velocityX": 3.7616401843303224, + "velocityY": 0.25776156048838134, "moduleForcesX": [ - -0.001811076616468709, - -0.0007285537490287964, - -0.0018353036207771887, - -0.0007528434903345994 + -0.000011019746567382785, + 0.0000014116140586023405, + -0.000009809503136558279, + 0.000002621561543044522 ], "moduleForcesY": [ - 0.0006476415636713516, - 0.0006274114604783823, - -0.0008052877098447759, - -0.0008211396774428359 + 0.000007586054788733624, + 0.000008490175069037687, + -0.00000906467566976256, + -0.000008162483612596876 ], - "timestamp": 1.447155836890082 + "timestamp": 1.4909168679674043 }, { - "x": 13.260174320772844, - "y": 7.649936879757519, - "heading": 0.006574946131355052, - "angularVelocity": 0.07663337707184353, - "velocityX": 3.9371821239799427, - "velocityY": 0.2697903463578355, + "x": 13.24100074826179, + "y": 7.648623035336362, + "heading": 0.0018561069459867565, + "angularVelocity": 0.004179656751687672, + "velocityX": 3.761579613080985, + "velocityY": 0.25775740992134544, "moduleForcesX": [ - -7.99310631283451, - -3.2965571422513857, - -7.948703890086734, - -3.253508368178124 + -0.020760270003833053, + -0.009094518538519383, + -0.020710863092040826, + -0.009045457185681977 ], "moduleForcesY": [ - 2.759504254840201, - 2.801876303080084, - -3.5597663854085146, - -3.5428410570857647 + 0.006786622699577082, + 0.006822833851212185, + -0.008865931591266973, + -0.008828299600102445 ], - "timestamp": 1.5026358975216056 + "timestamp": 1.5486325256618518 }, { - "x": 13.45491022910445, - "y": 7.663280907669538, - "heading": 0.03547098491568591, - "angularVelocity": 0.5208364672895163, - "velocityX": 3.5100161412036357, - "velocityY": 0.24051934623224105, + "x": 13.443353616594075, + "y": 7.662489005645776, + "heading": 0.04225938920162335, + "angularVelocity": 0.7000402294562001, + "velocityX": 3.506030710133503, + "velocityY": 0.24024624968884079, "moduleForcesX": [ - -112.65722835544774, - -110.08477802292602, - -109.61792794131873, - -104.97488015141087 + -79.0685909618201, + -50.58995823940847, + -75.86574911891587, + -45.97379077401321 ], "moduleForcesY": [ - 17.266378646952028, - 26.808134666937164, - -31.268524352599332, - -42.773795213348265 + 24.57350746925242, + 38.053994012355105, + -34.0608976536489, + -45.8001872458519 ], - "timestamp": 1.5581159581531292 + "timestamp": 1.6063481833562994 }, { - "x": 13.625911868933855, - "y": 7.674998575327416, - "heading": 0.036437057187586885, - "angularVelocity": 0.017412963520664588, - "velocityX": 3.0822179695355967, - "velocityY": 0.2112050261751085, + "x": 13.620987292267783, + "y": 7.674661125038714, + "heading": 0.04217975934168366, + "angularVelocity": -0.0013796924980265383, + "velocityX": 3.0777380483840022, + "velocityY": 0.21089804533422155, "moduleForcesX": [ - -104.3550095871483, - -109.9895441753885, - -110.29427213876139, - -113.34322693340162 + -96.77847026846838, + -107.9030731985583, + -104.77822606455094, + -112.04384390865172 ], "moduleForcesY": [ - -47.97784316156552, - -33.766005815685666, - 31.984331361894537, - 19.74736018603692 + -61.53659629054846, + -39.742791431053234, + 46.56311157639095, + 25.833282603076576 ], - "timestamp": 1.6135960187846528 + "timestamp": 1.664063841050747 }, { "x": 13.774003028869627, "y": 7.685146331787109, - "heading": -1.0216757134766161e-20, - "angularVelocity": -0.656759505538167, - "velocityX": 2.6692681704033068, - "velocityY": 0.18290817176805882, + "heading": -1.007498877189806e-18, + "angularVelocity": -0.7308200413306815, + "velocityX": 2.6511997387593604, + "velocityY": 0.1816700557048792, "moduleForcesX": [ - -96.61655453478754, - -108.47344443180624, - -105.62360385351926, - -112.06660691389176 + -95.19524925336464, + -108.15585163442557, + -104.58809520721027, + -111.83787419864792 ], "moduleForcesY": [ - -62.57662299104666, - -38.92519570430598, - 45.679141765122075, - 26.852206267299998 + -64.67933399592916, + -39.76761501132085, + 47.94032248604527, + 27.74194212984135 ], - "timestamp": 1.6690760794161763 + "timestamp": 1.7217794987451944 }, { - "x": 13.936101730471314, - "y": 7.6649237183136245, - "heading": -0.05404788012796307, - "angularVelocity": -0.8367505818789226, - "velocityX": 2.509556018957628, - "velocityY": -0.3130795056344143, + "x": 13.935035958999284, + "y": 7.664782649008714, + "heading": -0.05780109053495526, + "angularVelocity": -0.8964222673734035, + "velocityX": 2.497418353401382, + "velocityY": -0.31581512596622585, "moduleForcesX": [ - -20.093926933349476, - -41.83422551523411, - -25.248051251260648, - -53.269880817247596 + -19.9714407549644, + -40.44308656666267, + -24.49636920750514, + -50.556470643095416 ], "moduleForcesY": [ - -113.64526973932998, - -107.56161028308789, - -112.58952761642209, - -102.3603069840681 + -113.66567125217688, + -108.09087389552265, + -112.75580340484727, + -103.7266984641109 ], - "timestamp": 1.7336686608836414 + "timestamp": 1.786259256375845 }, { - "x": 14.086544019767228, - "y": 7.613116434507106, - "heading": -0.11934484607806041, - "angularVelocity": -1.010905036873114, - "velocityX": 2.3290954762613043, - "velocityY": -0.8020624447811118, + "x": 14.084799871677337, + "y": 7.612780905683724, + "heading": -0.12587786054142183, + "angularVelocity": -1.0557851410735792, + "velocityX": 2.322650056098518, + "velocityY": -0.8064816810085409, "moduleForcesX": [ - -25.536274706249685, - -46.56911838452923, - -29.770241346526483, - -56.81596418002521 + -25.499150978953384, + -45.22637504187557, + -29.09597042008306, + -54.133424993041125 ], "moduleForcesY": [ - -112.5342845020268, - -105.58420453918785, - -111.46183761296862, - -100.41663085453071 + -112.54112536251206, + -106.16430182617324, + -111.64007832404387, + -101.88695367808475 ], - "timestamp": 1.7982612423511064 + "timestamp": 1.8507390140064957 }, { - "x": 14.223301675262098, - "y": 7.530531275179706, - "heading": -0.19531452901541774, - "angularVelocity": -1.1761363489648249, - "velocityX": 2.1172347100534177, - "velocityY": -1.27855486576267, + "x": 14.221239414597168, + "y": 7.529933622115767, + "heading": -0.20362445988353564, + "angularVelocity": -1.205752040624248, + "velocityX": 2.1160058277727787, + "velocityY": -1.2848572422141997, "moduleForcesX": [ - -33.520931651827894, - -53.22911230390822, - -37.27033259543515, - -62.28363856197366 + -33.61193018096122, + -51.96652105002978, + -36.73910240668662, + -59.717154187720176 ], "moduleForcesY": [ - -110.39863935620404, - -102.36662249013638, - -109.15657312819253, - -97.09133480103486 + -110.36868341598847, + -103.01044274754193, + -109.33674686043942, + -98.68934221201837 ], - "timestamp": 1.8628538238185715 + "timestamp": 1.9152187716371463 }, { - "x": 14.343025710960973, - "y": 7.418854878805072, - "heading": -0.2809594489484934, - "angularVelocity": -1.325925020913038, - "velocityX": 1.8535261012780369, - "velocityY": -1.728935333400246, + "x": 14.340943734877591, + "y": 7.417920323946956, + "heading": -0.28999690085220237, + "angularVelocity": -1.3395280029342027, + "velocityX": 1.8564635581620241, + "velocityY": -1.7371854716086177, "moduleForcesX": [ - -46.39707082363187, - -63.43366418473748, - -50.63883300977956, - -71.42788762753942 + -46.751588789826286, + -62.37320446686807, + -50.35015435786008, + -69.15810736949086 ], "moduleForcesY": [ - -105.59817168074842, - -96.33740524696931, - -103.58836930621422, - -90.52715351089934 + -105.43790145029115, + -97.02260752007686, + -103.72888519276779, + -92.27049869774005 ], - "timestamp": 1.9274464052860365 + "timestamp": 1.9796985292677969 }, { - "x": 14.439640325423767, - "y": 7.282561627306501, - "heading": -0.3741539927257661, - "angularVelocity": -1.4428056854209232, - "velocityX": 1.4957540365755364, - "velocityY": -2.1100449680466906, + "x": 14.437683961642778, + "y": 7.281280072098083, + "heading": -0.38276450479544777, + "angularVelocity": -1.438708942962096, + "velocityX": 1.5003193299721982, + "velocityY": -2.1191185710028404, "moduleForcesX": [ - -70.2431689631601, - -81.12995040952687, - -75.69379680678863, - -87.54712653568923 + -71.23628387541437, + -80.66473849864646, + -75.82283658408791, + -86.00670611740921 ], "moduleForcesY": [ - -91.39966744732322, - -81.90176576678061, - -86.88518138121627, - -74.94978844811001 + -90.61976741253616, + -82.34976809206417, + -86.77144470833049, + -76.70722702894544 ], - "timestamp": 1.9920389867535016 + "timestamp": 2.0441782868984473 }, { - "x": 14.50377014296591, - "y": 7.136817952344609, - "heading": -0.46758899852853547, - "angularVelocity": -1.446528435310054, - "velocityX": 0.9928356490047452, - "velocityY": -2.256353154662236, + "x": 14.501936386050707, + "y": 7.1356478733639035, + "heading": -0.47425263991314337, + "angularVelocity": -1.4188659895676565, + "velocityX": 0.9964743474374752, + "velocityY": -2.2585723657396755, "moduleForcesX": [ - -110.46580054393864, - -110.54658737476862, - -110.57960043427867, - -110.65938530025993 + -111.44531662002107, + -111.05416659333267, + -110.88084813088581, + -110.46111986931393 ], "moduleForcesY": [ - -32.49781898234192, - -32.22495698602894, - -32.10463531819626, - -31.831627846959343 + -28.930831010677075, + -30.379702096445232, + -31.044847165146514, + -32.49068702774292 ], - "timestamp": 2.0566315682209666 + "timestamp": 2.108658044529098 }, { - "x": 14.53996714646827, - "y": 7.00954832171531, - "heading": -0.5431710549769495, - "angularVelocity": -1.1701352497652444, - "velocityX": 0.5603894856035541, - "velocityY": -1.9703443915367327, + "x": 14.538645426348966, + "y": 7.008815909604144, + "heading": -0.5473253251672447, + "angularVelocity": -1.1332655074895337, + "velocityX": 0.5693110775715775, + "velocityY": -1.9670043502066366, "moduleForcesX": [ - -87.53770821277456, - -84.5907695917968, - -103.58271444424955, - -104.56901726794133 + -86.23137198290863, + -82.87186793378041, + -103.10238518870169, + -104.08623484052193 ], "moduleForcesY": [ - 74.87353802308711, - 78.09476192896813, - 50.38760823256533, - 48.15163557428627 + 76.37745701415473, + 79.91712175914675, + 51.366193333691044, + 49.18404252351033 ], - "timestamp": 2.1212241496884316 + "timestamp": 2.1731378021597485 }, { - "x": 14.560150155522226, - "y": 6.911539256829025, - "heading": -0.598147081877329, - "angularVelocity": -0.8511198291102623, - "velocityX": 0.31246636371270964, - "velocityY": -1.517342435611623, + "x": 14.559418537812661, + "y": 6.911177269143886, + "heading": -0.6002567765952495, + "angularVelocity": -0.820900285190336, + "velocityX": 0.3221648502881852, + "velocityY": -1.5142525972189051, "moduleForcesX": [ - -46.109164119120734, - -30.063756225968806, - -74.99270372130417, - -66.85054699912216 + -46.145857817831676, + -30.484801894737284, + -74.56500704734023, + -66.5176061352037 ], "moduleForcesY": [ - 105.68256490842477, - 111.2770803271555, - 87.55367623297964, - 93.84303659418195 + 105.66705745601725, + 111.16368416399354, + 87.9194683312, + 94.0827685467072 ], - "timestamp": 2.1858167311558967 + "timestamp": 2.237617559790399 }, { - "x": 14.570650392409606, - "y": 6.845493549123404, - "heading": -0.6338212894662737, - "angularVelocity": -0.5522957401371792, - "velocityX": 0.16256103485613507, - "velocityY": -1.0224967976994013, + "x": 14.570390149911358, + "y": 6.84537565225515, + "heading": -0.6345291644881725, + "angularVelocity": -0.5315216612512779, + "velocityX": 0.1701559140706136, + "velocityY": -1.020500375724994, "moduleForcesX": [ - -26.678062716919186, - -6.490482928094056, - -57.014388668296064, - -41.63932401569198 + -27.295991115954983, + -7.911741357015105, + -56.732341958223465, + -41.96592679327208 ], "moduleForcesY": [ - 112.22997904008606, - 115.15324971354988, - 100.25774640780512, - 107.51146412413148 + 112.08099626886072, + 115.06446151670661, + 100.41815919051002, + 107.38703277594337 ], - "timestamp": 2.2504093126233617 + "timestamp": 2.3020973174210497 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -0.2696598841914466, - "velocityX": 0.065342965506683, - "velocityY": -0.514035511223207, + "angularVelocity": -0.2591534712639973, + "velocityX": 0.06949333381079491, + "velocityY": -0.5131065156466121, "moduleForcesX": [ - -16.65484746801905, - 4.857070171723746, - -46.43149894465741, - -27.26138342927001 + -17.497246051703055, + 3.059767167772353, + -46.22660111522497, + -28.01046724085712 ], "moduleForcesY": [ - 114.17712362294917, - 115.26897371338562, - 105.61087783646228, - 112.06865783448852 + 114.05057698106343, + 115.33044468651329, + 105.70098429664752, + 111.88568251229185 ], - "timestamp": 2.315001894090827 + "timestamp": 2.3665770750517003 }, { "x": 14.574871063232422, "y": 6.812290668487549, "heading": -0.6512393175044169, - "angularVelocity": -5.645946234609016e-22, - "velocityX": -3.1761678507214283e-21, - "velocityY": 7.19219703597375e-23, + "angularVelocity": -4.1843925027882567e-20, + "velocityX": -1.2624804704208055e-19, + "velocityY": 8.893976865334932e-21, "moduleForcesX": [ - -10.902305920487686, - 11.194107913077895, - -39.6575688795007, - -18.094880741208897 + -11.831191033758017, + 9.238891886616917, + -39.495635804588694, + -19.129350517864943 ], "moduleForcesY": [ - 114.88625738279923, - 114.84784529450766, - 108.35750475803422, - 113.93583193326243 + 114.79379693930306, + 115.02128580058942, + 108.41678324342674, + 113.76815074013277 ], - "timestamp": 2.379594475558292 + "timestamp": 2.431056832682351 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.1.traj b/src/main/deploy/choreo/Red Amp 5 Piece.1.traj index 6e63954..bd2c196 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.1.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.1.traj @@ -3,10 +3,10 @@ { "x": 15.20169734954834, "y": 6.508597373962402, - "heading": -4.3528887118527857e-23, - "angularVelocity": -6.603140405428085e-24, - "velocityX": -1.2060893015993952e-21, - "velocityY": 7.138840853465489e-22, + "heading": -8.498320371979777e-23, + "angularVelocity": -1.303634376415855e-23, + "velocityX": -2.443695081429881e-20, + "velocityY": 2.3610421524139276e-20, "moduleForcesX": [ 0, 0, @@ -22,487 +22,487 @@ "timestamp": 0 }, { - "x": 15.179626306424254, - "y": 6.490858286972303, - "heading": -1.6477847497890382e-10, - "angularVelocity": -2.7912762094873322e-9, - "velocityX": -0.3738739395345731, - "velocityY": -0.3004924733030536, + "x": 15.179323748097806, + "y": 6.491593300242642, + "heading": -3.446686628016041e-10, + "angularVelocity": -5.8607425984795884e-9, + "velocityX": -0.38044050200785395, + "velocityY": -0.2891371045661442, "moduleForcesX": [ - -89.93357437032712, - -89.93357449974754, - -89.93357458600433, - -89.93357471542474 + -91.8611587363816, + -91.8611589873367, + -91.86115917858633, + -91.86115942954144 ], "moduleForcesY": [ - -72.28201666391972, - -72.28201650320274, - -72.28201639524063, - -72.28201623452364 + -69.81504228033312, + -69.81504195081375, + -69.8150416977938, + -69.81504136827444 ], - "timestamp": 0.05903338208477801 + "timestamp": 0.058809725390574434 }, { - "x": 15.134092099800656, - "y": 6.457273283717531, - "heading": -4.5125780037436346e-10, - "angularVelocity": -4.852836061196729e-9, - "velocityX": -0.7713297970664511, - "velocityY": -0.5689154520494917, + "x": 15.133401882134509, + "y": 6.459259290320045, + "heading": -9.442226120947298e-10, + "angularVelocity": -1.0194809537218462e-8, + "velocityX": -0.7808549633298901, + "velocityY": -0.5498071910361231, "moduleForcesX": [ - -95.60609117215738, - -95.60609124537726, - -95.60609131724519, - -95.60609139046507 + -96.68407083847598, + -96.68407098415932, + -96.68407113790389, + -96.68407128358724 ], "moduleForcesY": [ - -64.56785423072616, - -64.56785412261053, - -64.56785401562026, - -64.56785390750461 + -62.941396315731794, + -62.94139609260596, + -62.941395855206785, + -62.941395632080955 ], - "timestamp": 0.11806676416955603 + "timestamp": 0.11761945078114887 }, { - "x": 15.063455246346447, - "y": 6.4106030861332375, - "heading": -7.923518954984216e-10, - "angularVelocity": -5.777986675982209e-9, - "velocityX": -1.1965577942454486, - "velocityY": -0.7905729933831352, + "x": 15.062531609729039, + "y": 6.4140078818149915, + "heading": -1.6620460583836768e-9, + "angularVelocity": -1.2205862916746293e-8, + "velocityX": -1.2050774244361186, + "velocityY": -0.769454511214313, "moduleForcesX": [ - -102.28654560786366, - -102.28654562921926, - -102.28654566257885, - -102.28654568393446 + -102.43275032289199, + -102.43275036895025, + -102.43275044168742, + -102.4327504877457 ], "moduleForcesY": [ - -53.3186535242474, - -53.31865348347508, - -53.318653419144425, - -53.318653378372105 + -53.03603947289089, + -53.03603938436765, + -53.036039243151045, + -53.036039154627815 ], - "timestamp": 0.17710014625433404 + "timestamp": 0.1764291761717233 }, { - "x": 14.965964427690755, - "y": 6.354993169367382, - "heading": -1.0815114154157552e-9, - "angularVelocity": -4.898237399002934e-9, - "velocityX": -1.6514523683512154, - "velocityY": -0.942007975860076, + "x": 14.96515989030649, + "y": 6.359448552089575, + "heading": -2.28357279584149e-9, + "angularVelocity": -1.0568434614002256e-8, + "velocityX": -1.655707772411321, + "velocityY": -0.9277263133447721, "moduleForcesX": [ - -109.42269779178156, - -109.42269778273729, - -109.42269775576457, - -109.42269774672029 + -108.80919849872593, + -108.80919848005888, + -108.80919842819559, + -108.80919840952853 ], "moduleForcesY": [ - -36.426955237033994, - -36.426955263872905, - -36.42695534537222, - -36.42695537221113 + -38.216307330242316, + -38.216307382799684, + -38.21630753133454, + -38.21630758389191 ], - "timestamp": 0.23613352833911205 + "timestamp": 0.23523890156229774 }, { - "x": 14.84031024724876, - "y": 6.296639809307858, - "heading": -1.1586671377582547e-9, - "angularVelocity": -1.3069846181547316e-9, - "velocityX": -2.1285275551643497, - "velocityY": -0.9884807205476066, + "x": 14.839966986250749, + "y": 6.301073904680198, + "heading": -2.4785955133946477e-9, + "angularVelocity": -3.3161643972635273e-9, + "velocityX": -2.1287789260074454, + "velocityY": -0.9926019382286347, "moduleForcesX": [ - -114.75813729736898, - -114.7581372935656, - -114.75813725195086, - -114.75813724814746 + -114.22775518362515, + -114.22775516938998, + -114.22775505468461, + -114.22775504044945 ], "moduleForcesY": [ - -11.178794542775593, - -11.178794576619985, - -11.17879500970412, - -11.178795043548515 + -15.664867092783735, + -15.664867188866841, + -15.66486803443501, + -15.664868130518121 ], - "timestamp": 0.2951669104238901 + "timestamp": 0.29404862695287215 }, { - "x": 14.686942751138512, - "y": 6.243977280961659, - "heading": -8.363450931363897e-10, - "angularVelocity": 5.459996246852681e-9, - "velocityX": -2.5979791550820597, - "velocityY": -0.8920804888083312, + "x": 14.687002517259797, + "y": 6.246814000732414, + "heading": -1.8217268295736112e-9, + "angularVelocity": 1.1169388727096216e-8, + "velocityX": -2.6010063467405375, + "velocityY": -0.9226348803268004, "moduleForcesX": [ - -112.92432010689039, - -112.92432007869421, - -112.92432028404276, - -112.9243202558466 + -114.02402726270896, + -114.02402722958728, + -114.02402754037327, + -114.0240275072516 ], "moduleForcesY": [ - 23.188611580505953, - 23.18861171251525, - 23.188610716345337, - 23.188610848354628 + 16.89424580273815, + 16.894246009646327, + 16.894243925394832, + 16.894244132302983 ], - "timestamp": 0.35420029250866814 + "timestamp": 0.3528583523434466 }, { "x": 14.509410858154297, "y": 6.206027030944824, - "heading": 1.6870395426082385e-22, - "angularVelocity": 1.4167324716980014e-8, - "velocityX": -3.0073136031620438, - "velocityY": -0.6428608471446768, + "heading": 3.969467826839008e-22, + "angularVelocity": 3.0976625336632224e-8, + "velocityX": -3.0197668485281395, + "velocityY": -0.6935412385742346, "moduleForcesX": [ - -98.46342884163919, - -98.46342857989734, - -98.46342941505019, - -98.46342915330834 + -101.11390541508874, + -101.11390491533385, + -101.11390663127975, + -101.1139061315249 ], "moduleForcesY": [ - 59.948584128622876, - 59.948584555913705, - 59.94858318468237, - 59.94858361197319 + 55.316948669637505, + 55.316949575911146, + 55.316946441253606, + 55.316947347527226 ], - "timestamp": 0.4132336745934462 + "timestamp": 0.41166807773402103 }, { - "x": 14.39870668839677, - "y": 6.191150636092829, - "heading": 6.682629988227654e-10, - "angularVelocity": 1.925590029446468e-8, - "velocityX": -3.1899244141732552, - "velocityY": -0.428661135684424, + "x": 14.395876140440663, + "y": 6.189128805794054, + "heading": 1.522966758732963e-9, + "angularVelocity": 4.3040847489578005e-8, + "velocityX": -3.2086258231614164, + "velocityY": -0.4775638912593676, "moduleForcesX": [ - -74.7200621801483, - -74.72006152267782, - -74.72006292902194, - -74.72006227155148 + -75.79182122905944, + -75.79181974401823, + -75.79182296295163, + -75.79182147791046 ], "moduleForcesY": [ - 87.64549967297297, - 87.64550023101394, - 87.64549903065125, - 87.64549958869223 + 86.67481425219046, + 86.67481554424141, + 86.67481272599154, + 86.67481401804254 ], - "timestamp": 0.4479379983904785 + "timestamp": 0.4470522963905207 }, { - "x": 14.281833992771213, - "y": 6.183842078444728, - "heading": 1.46563128230524e-9, - "angularVelocity": 2.297605013558962e-8, - "velocityX": -3.36766958230001, - "velocityY": -0.2105950166568239, + "x": 14.276015624628796, + "y": 6.18016177358942, + "heading": 3.3017017289639248e-9, + "angularVelocity": 5.0269160596653465e-8, + "velocityX": -3.387400382510616, + "velocityY": -0.2534189688256986, "moduleForcesX": [ - -72.72915521902236, - -72.7291547139971, - -72.72915576861566, - -72.72915526359041 + -71.7448005057056, + -71.74479952082729, + -71.74480155376283, + -71.7448005688845 ], "moduleForcesY": [ - 89.22754297343529, - 89.2275433829778, - 89.22754252200183, - 89.22754293154432 + 89.95257946983574, + 89.95258025082046, + 89.95257862628402, + 89.95257940726874 ], - "timestamp": 0.4826423221875108 + "timestamp": 0.48243651504702034 }, { - "x": 14.159050528640018, - "y": 6.184294815459166, - "heading": 2.3229765945150137e-9, - "angularVelocity": 2.470427942131417e-8, - "velocityX": -3.5379875098357174, - "velocityY": 0.013045550666414774, + "x": 14.150428609865713, + "y": 6.179555476543678, + "heading": 5.078023376549813e-9, + "angularVelocity": 5.020095723547424e-8, + "velocityX": -3.5492380369409227, + "velocityY": -0.017134673839445464, "moduleForcesX": [ - -69.69010253451697, - -69.69010228267354, - -69.69010279033854, - -69.69010253849511 + -64.9477771261755, + -64.94777713696463, + -64.9477771163259, + -64.94777712711503 ], "moduleForcesY": [ - 91.50847649519069, - 91.50847668582223, - 91.50847629831208, - 91.5084764889436 + 94.82428414669329, + 94.82428413935362, + 94.82428415353773, + 94.82428414619807 ], - "timestamp": 0.5173466459845432 + "timestamp": 0.51782073370352 }, { - "x": 14.03079533153799, - "y": 6.192809216565774, - "heading": 3.1312188046741175e-9, - "angularVelocity": 2.3289380737857663e-8, - "velocityX": -3.6956546928309977, - "velocityY": 0.2453412190481945, + "x": 14.020285286516224, + "y": 6.187978683471175, + "heading": 6.434200940526406e-9, + "angularVelocity": 3.832718696268834e-8, + "velocityX": -3.6780047233170614, + "velocityY": 0.23804982128522642, "moduleForcesX": [ - -64.51371447905602, - -64.51371470905573, - -64.51371427113206, - -64.51371450113174 + -51.67592186533519, + -51.67592423146429, + -51.67592027633643, + -51.675922642465494 ], "moduleForcesY": [ - 95.0499409165131, - 95.04994076157361, - 95.04994105995034, - 95.04994090501086 + 102.40920632891186, + 102.4092051448318, + 102.40920715698425, + 102.40920597290425 ], - "timestamp": 0.5520509697815755 + "timestamp": 0.5532049523600197 }, { - "x": 13.897963803701671, - "y": 6.20989769926313, - "heading": 3.696973755747146e-9, - "angularVelocity": 1.630214593379525e-8, - "velocityX": -3.827520991712204, - "velocityY": 0.4924021224934038, + "x": 13.888371101336414, + "y": 6.206318425861406, + "heading": 6.680653519085837e-9, + "angularVelocity": 6.96504226789965e-9, + "velocityX": -3.7280513796388863, + "velocityY": 0.5183028787005002, "moduleForcesX": [ - -53.95659746008519, - -53.95659882762597, - -53.95659649016197, - -53.95659785770273 + -20.084439343980858, + -20.08444787570321, + -20.08443732182004, + -20.084445853541588 ], "moduleForcesY": [ - 101.09152899469004, - 101.0915282719287, - 101.09152953035384, - 101.09152880759252 + 112.46958106687981, + 112.46957956001785, + 112.46958155352253, + 112.46958004666087 ], - "timestamp": 0.5867552935786079 + "timestamp": 0.5885891710165193 }, { - "x": 13.763055492335095, - "y": 6.236418641581392, - "heading": 3.6171222083325864e-9, - "angularVelocity": -2.300910626632439e-9, - "velocityX": -3.8873632045270554, - "velocityY": 0.7641970629760271, + "x": 13.758040033310886, + "y": 6.234528802394688, + "heading": 6.645267838303864e-9, + "angularVelocity": -1.00004132140941e-9, + "velocityX": -3.6833106106071467, + "velocityY": 0.7972587103629364, "moduleForcesX": [ - -24.48602860516184, - -24.486033599316524, - -24.48602715105942, - -24.48603214521383 + 17.955115066486492, + 17.95511290507103, + 17.955114609991067, + 17.95511244857563 ], "moduleForcesY": [ - 111.21211725559331, - 111.21211617203417, - 111.21211767341897, - 111.21211658985995 + 111.94898498074906, + 111.94898532090953, + 111.9489851083639, + 111.94898544852435 ], - "timestamp": 0.6214596173756403 + "timestamp": 0.623973389673019 }, { "x": 13.630112648010254, "y": 6.272213459014893, - "heading": -1.0376160127202523e-19, - "angularVelocity": -1.0422684589940892e-7, - "velocityX": -3.830728560001787, - "velocityY": 1.0314224141881108, + "heading": -1.5585370169858288e-19, + "angularVelocity": -1.8780315323536185e-7, + "velocityX": -3.6153796850091533, + "velocityY": 1.0650131061543873, "moduleForcesX": [ - 23.17358566119532, - 23.173558952779945, - 23.17357832384853, - 23.17355161544207 + 27.261687418434768, + 27.261641389084208, + 27.261672495978797, + 27.261626473603524 ], "moduleForcesY": [ - 109.34234401324875, - 109.34234948074236, - 109.342346790233, - 109.34235225772296 + 107.45367915993488, + 107.45369033038008, + 107.45368563018035, + 107.45369679884966 ], - "timestamp": 0.6561639411726726 + "timestamp": 0.6593576083295186 }, { - "x": 13.379601321542795, - "y": 6.323151596088256, - "heading": -0.000044770172369445994, - "angularVelocity": -0.0006952279229347041, - "velocityX": -3.8901451558951234, - "velocityY": 0.7910091331219953, + "x": 13.390615610810706, + "y": 6.321687036535878, + "heading": -0.00007211348501602596, + "angularVelocity": -0.00111204705585835, + "velocityX": -3.6932340053371213, + "velocityY": 0.7629217505264949, "moduleForcesX": [ - -13.064389136262065, - -13.121852274728727, - -13.082219112887778, - -13.13989401364793 + -16.987922786840045, + -17.082996331763876, + -17.01360023100258, + -17.109096037679436 ], "moduleForcesY": [ - -53.03975477268047, - -53.028859886833715, - -52.99881173697238, - -52.9888901966368 + -66.19005542155882, + -66.17422233699283, + -66.12851592804181, + -66.11296782709219 ], - "timestamp": 0.720560336789899 + "timestamp": 0.7242051205243725 }, { - "x": 13.148958187009413, - "y": 6.368906756131173, - "heading": -0.05557421160697782, - "angularVelocity": -0.86230666953282, - "velocityX": -3.5816155907906864, - "velocityY": 0.7105236186647266, + "x": 13.157753730626089, + "y": 6.367449891304318, + "heading": -0.020349716479967844, + "angularVelocity": -0.312696698896045, + "velocityX": -3.590914628843632, + "velocityY": 0.7056994666338302, "moduleForcesX": [ - 77.93257191876994, - 44.11069948512947, - 88.44467603296238, - 61.65027573448044 + 29.89084865554921, + 13.030490785947396, + 32.10384734704793, + 14.597690630081734 ], "moduleForcesY": [ - -49.06442321549933, - -66.62250167596093, - 15.430666972718294, - 29.26408286408135 + -24.010835804939674, + -25.326666831059267, + -0.4836556990558821, + -0.30058703399048453 ], - "timestamp": 0.7849567324071254 + "timestamp": 0.7890526327192263 }, { - "x": 12.951234166317056, - "y": 6.408161403232974, - "heading": -0.10764799496471299, - "angularVelocity": -0.8086443792174783, - "velocityX": -3.0704206158933536, - "velocityY": 0.609578326947544, + "x": 12.957356286277964, + "y": 6.40709453148691, + "heading": -0.07061445763616857, + "angularVelocity": -0.7751221204163579, + "velocityX": -3.090287315047219, + "velocityY": 0.6113517518369715, "moduleForcesX": [ - 113.31038231556686, - 113.37930141281873, - 112.03346259287166, - 112.1759178108579 + 107.3795653758912, + 101.86125988189073, + 114.8648292984834, + 114.40034415500577 ], "moduleForcesY": [ - -19.252528450963577, - -18.974700403964082, - -25.67152082683337, - -25.13995335510332 + -40.97120389792557, + -52.80126855800278, + 3.191564836013126, + 7.940512733376601 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.8539001449140802 }, { - "x": 12.7864611895928, - "y": 6.440888378700205, - "heading": -0.15272288248178728, - "angularVelocity": -0.699959789442261, - "velocityX": -2.5587298038180677, - "velocityY": 0.5082112927835478, + "x": 12.790427998602441, + "y": 6.440171200929543, + "heading": -0.1227572585272402, + "angularVelocity": -0.8040832890303166, + "velocityX": -2.5741664101768, + "velocityY": 0.5100684409178722, "moduleForcesX": [ - 114.09477809264015, - 114.09797780307369, - 111.442266391589, - 111.70139457807396 + 112.71395426887749, + 112.66218369215821, + 113.36635432566672, + 113.33454508007034 ], "moduleForcesY": [ - -15.913469790929499, - -16.046789303580823, - -29.18564939151568, - -28.264792093676622 + -23.760754374513482, + -23.975233317910366, + -20.419260667878685, + -20.560125698223537 ], - "timestamp": 0.9137495236415782 + "timestamp": 0.918747657108934 }, { - "x": 12.654642871116208, - "y": 6.467078064626328, - "heading": -0.18960174396775148, - "angularVelocity": -0.5726851810957397, - "velocityX": -2.0469828662480234, - "velocityY": 0.4066949038855515, + "x": 12.65696171804704, + "y": 6.466645530685566, + "heading": -0.16925593959498417, + "angularVelocity": -0.7170464909744682, + "velocityX": -2.0581557570683704, + "velocityY": 0.4082551336198239, "moduleForcesX": [ - 114.36206703200182, - 114.29110618647663, - 111.25270682753312, - 111.48004226113034 + 114.00144220452592, + 113.99095150053918, + 111.92404445290293, + 112.06402825139133 ], "moduleForcesY": [ - -14.58829144036612, - -15.26085484138321, - -30.238604229918433, - -29.45468827574684 + -17.14637544539112, + -17.295470407167763, + -27.630401033773403, + -27.107357918418792 ], - "timestamp": 0.9781459192588047 + "timestamp": 0.9835951693037879 }, { - "x": 12.555779549706159, - "y": 6.486724686682261, - "heading": -0.21768842940260533, - "angularVelocity": -0.43615306673065574, - "velocityX": -1.5352306672208027, - "velocityY": 0.3050888464738352, + "x": 12.556912258763324, + "y": 6.486507786121201, + "heading": -0.2065751634433522, + "angularVelocity": -0.5754919901357388, + "velocityX": -1.5428419055319835, + "velocityY": 0.3062917105586495, "moduleForcesX": [ - 114.49936666718258, - 114.37291094617846, - 111.17407977417163, - 111.34420578314155 + 114.52951979915348, + 114.41545555950175, + 111.1038117502864, + 111.32134170829701 ], "moduleForcesY": [ - -13.847592290942329, - -14.958857918151065, - -30.693310454837178, - -30.121770154712582 + -13.56849995910181, + -14.610037306397269, + -30.935423415458633, + -30.197132480137224 ], - "timestamp": 1.042542314876031 + "timestamp": 1.0484426814986416 }, { - "x": 12.489870969885784, - "y": 6.4998244090967265, - "heading": -0.23662843692451097, - "angularVelocity": -0.29411595696264536, - "velocityX": -1.0234824354477663, - "velocityY": 0.20342322406258137, + "x": 12.490240750486658, + "y": 6.499752126190816, + "heading": -0.23266460878981102, + "angularVelocity": -0.40231991117971083, + "velocityX": -1.028127464263096, + "velocityY": 0.2042382139474869, "moduleForcesX": [ - 114.58169370325793, - 114.41751735086616, - 111.13270734016913, - 111.25514546342465 + 114.80042068735366, + 114.61054935161582, + 110.59863478703036, + 110.83549271399136 ], "moduleForcesY": [ - -13.383209155395406, - -14.806913472109198, - -30.942388952575417, - -30.541558492400497 + -11.333508890235418, + -13.232312421101899, + -32.792340177493294, + -32.03182827040542 ], - "timestamp": 1.1069387104932575 + "timestamp": 1.1132901936934954 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": -0.14840255835934948, - "velocityX": -0.5117392128533444, - "velocityY": 0.10172039612632167, + "angularVelocity": -0.20849555419783833, + "velocityX": -0.5138815704216196, + "velocityY": 0.10212743022895641, "moduleForcesX": [ - 114.63396863953953, - 114.44886671702369, - 111.10080141802345, - 111.19900874167566 + 114.95598681748038, + 114.72482442231708, + 110.24775114592639, + 110.5061283467711 ], "moduleForcesY": [ - -13.08662495525689, - -14.690983770852931, - -31.12304727525516, - -30.806231170714476 + -9.848309354372528, + -12.36579682333574, + -34.015560796460676, + -33.21050131016418 ], - "timestamp": 1.171335106110484 + "timestamp": 1.178137705888349 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": 3.1053355931895455e-20, - "velocityX": 1.4124500530750476e-19, - "velocityY": 6.271253114440515e-19, + "angularVelocity": -4.8297071609365385e-20, + "velocityX": 6.470993194950448e-19, + "velocityY": 3.3178230289344078e-18, "moduleForcesX": [ - 114.6667993998726, - 114.47707589122747, - 111.06552665667455, - 111.1697067800059 + 115.05021982561283, + 114.80814664741968, + 109.96652897988751, + 110.29067964070444 ], "moduleForcesY": [ - -12.910071305057201, - -14.561200011281274, - -31.296024837317898, - -30.955087024539008 + -8.850873959259241, + -11.686076549662568, + -34.957520485564494, + -33.96027818561143 ], - "timestamp": 1.2357315017277104 + "timestamp": 1.2429852180832028 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.2.traj b/src/main/deploy/choreo/Red Amp 5 Piece.2.traj index 6130ab5..bf903f6 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.2.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.2.traj @@ -4,342 +4,363 @@ "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": 3.1053355931895455e-20, - "velocityX": 1.4124500530750476e-19, - "velocityY": 6.271253114440515e-19, + "angularVelocity": -4.8297071609365385e-20, + "velocityX": 6.470993194950448e-19, + "velocityY": 3.3178230289344078e-18, "moduleForcesX": [ - 114.6667993998726, - 114.47707589122747, - 111.06552665667455, - 111.1697067800059 + 115.05021982561283, + 114.80814664741968, + 109.96652897988751, + 110.29067964070444 ], "moduleForcesY": [ - -12.910071305057201, - -14.561200011281274, - -31.296024837317898, - -30.955087024539008 + -8.850873959259241, + -11.686076549662568, + -34.957520485564494, + -33.96027818561143 ], "timestamp": 0 }, { - "x": 12.391577669935138, - "y": 6.524834886416186, - "heading": -0.2376574883237867, - "angularVelocity": 0.09327225382491915, - "velocityX": -0.7146644720743752, - "velocityY": 0.20191178488512532, + "x": 12.397672522253476, + "y": 6.523112878711347, + "heading": -0.23760577600202967, + "angularVelocity": 0.09853884197084228, + "velocityX": -0.6804630807935004, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - -109.9959827367489, - -109.86538217101113, - -112.07438057028467, - -112.0666311120356 + -109.87343425060293, + -109.71928226568586, + -112.17142318363217, + -112.1683964785196 ], "moduleForcesY": [ - 34.947790309423134, - 35.34716847772434, - 27.56387748227317, - 27.583683757251233 + 35.32323951770473, + 35.78880107821523, + 27.1558429759438, + 27.154535423780597 ], - "timestamp": 0.09142631500519394 + "timestamp": 0.08706466008335179 }, { - "x": 12.260906252411765, - "y": 6.561752331915095, - "heading": -0.2206877610023437, - "angularVelocity": 0.1856109733885584, - "velocityX": -1.4292539026203903, - "velocityY": 0.4037945256440807, + "x": 12.279190101968272, + "y": 6.556586338886186, + "heading": -0.22055367602817383, + "angularVelocity": 0.19585558546407858, + "velocityX": -1.3608554857019426, + "velocityY": 0.3844666727325826, "moduleForcesX": [ - -110.00945422487304, - -109.8504153683674, - -112.06416998026945, - -112.03171567433652 + -109.89245539711597, + -109.70709462938446, + -112.15861944802997, + -112.12825792036844 ], "moduleForcesY": [ - 34.86118581179554, - 35.347956242495144, - 27.54904597391854, - 27.666287641216236 + 35.21826543338556, + 35.77869126173595, + 27.148840736400675, + 27.256949433752844 ], - "timestamp": 0.18285263001038787 + "timestamp": 0.17412932016670357 }, { - "x": 12.064914042906658, - "y": 6.617122892086999, - "heading": -0.19542124177576825, - "angularVelocity": 0.27635937448796954, - "velocityX": -2.143717697623187, - "velocityY": 0.6056304486160079, + "x": 12.101479877603184, + "y": 6.606791013546223, + "heading": -0.1952091525882827, + "angularVelocity": 0.29110001021800874, + "velocityX": -2.041129250317603, + "velocityY": 0.5766366584556093, "moduleForcesX": [ - -110.02889664350995, - -109.82922400996975, - -112.04411023069697, - -111.975470281016 + -109.92048751533741, + -109.69117162238653, + -112.1337688915827, + -112.06359871366234 ], "moduleForcesY": [ - 34.72586213068898, - 35.33767829400725, - 27.53646502457929, - 27.795383551483052 + 35.05402926782684, + 35.74845318822676, + 27.151367351771455, + 27.417403309854482 ], - "timestamp": 0.2742789450155818 + "timestamp": 0.26119398025005536 }, { - "x": 11.80362432610035, - "y": 6.690938650379312, - "heading": -0.16214419063285807, - "angularVelocity": 0.3639767296868492, - "velocityX": -2.857926810147228, - "velocityY": 0.8073797821570227, + "x": 11.864562910114323, + "y": 6.6737192302015265, + "heading": -0.16192803904792102, + "angularVelocity": 0.3822574338256172, + "velocityX": -2.7211611147628307, + "velocityY": 0.7687185201346822, "moduleForcesX": [ - -110.05001149729422, - -109.80240908300567, - -111.99097622261098, - -111.87607678799768 + -109.95591771814263, + -109.67704537348149, + -112.0693733681274, + -111.94887517290029 ], "moduleForcesY": [ - 34.51004456710356, - 35.26876905745422, - 27.56365281863087, - 27.999126804996614 + 34.788017531200495, + 35.6335008373943, + 27.216188056391903, + 27.676054770743054 ], - "timestamp": 0.36570526002077575 + "timestamp": 0.34825864033340714 }, { - "x": 11.477108634875863, - "y": 6.783177700282454, - "heading": -0.12164341187087872, - "angularVelocity": 0.4429882004943381, - "velocityX": -3.571353512453578, - "velocityY": 1.008889507336059, + "x": 11.56850461802944, + "y": 6.7573499531090215, + "heading": -0.1217025196318901, + "angularVelocity": 0.46201891074427753, + "velocityX": -3.400441600546649, + "velocityY": 0.9605587712331278, "moduleForcesX": [ - -110.04642262897133, - -109.76393441481716, - -111.79375874723362, - -111.62926676038809 + -109.98511497469823, + -109.68108201991241, + -111.83317527235297, + -111.6616416691419 ], "moduleForcesY": [ - 34.068957025324174, - 34.92992729055502, - 27.794484147904477, - 28.39936236528553 + 34.22235845768231, + 35.142081931115705, + 27.57984056765442, + 28.211854056677726 ], - "timestamp": 0.4571315750259697 + "timestamp": 0.43532330041675893 }, { - "x": 11.127792753189217, - "y": 6.881877306152213, - "heading": -0.12162478079751621, - "angularVelocity": 0.00020378239417665058, - "velocityX": -3.8207367503196448, - "velocityY": 1.0795535821842135, + "x": 11.252494100051829, + "y": 6.8466425061476945, + "heading": -0.12168267110063807, + "angularVelocity": 0.00022797460224432592, + "velocityX": -3.6296072100330767, + "velocityY": 1.0255889468033135, "moduleForcesX": [ - -33.09132616097768, - -48.347985418148845, - -29.02496895325345, - -44.47101375036062 + -31.02179127200356, + -47.98351788132492, + -26.680968019598573, + -43.820835109423456 ], "moduleForcesY": [ - -3.094463016167937, - -0.5892512773323937, - 23.759456581488084, - 23.82600237416276 + -4.756334887484557, + -1.9309977832536225, + 24.46796105753946, + 24.644907375310982 ], - "timestamp": 0.5485578900311636 + "timestamp": 0.5223879605001107 }, { - "x": 10.778476992179064, - "y": 6.980578519140531, - "heading": -0.12160654197932859, - "angularVelocity": 0.0001994919973158839, - "velocityX": -3.820735430387944, - "velocityY": 1.0795711604772797, + "x": 10.936483790907323, + "y": 6.935936936057917, + "heading": -0.12166324602862022, + "angularVelocity": 0.00022311086954514994, + "velocityX": -3.6296048114352204, + "velocityY": 1.025610504017775, "moduleForcesX": [ - 0.0002512832040627029, - 0.00011234039315012063, - 0.00029742988117872183, - 0.00015898562376514823 + 0.0005154716607218464, + 0.0002417899336236675, + 0.0005410426549909981, + 0.00026653543094474054 ], "moduleForcesY": [ - 0.002591336436009617, - 0.0026141003619889144, - 0.002857948956202869, - 0.0028575487581504696 + 0.0033758890088798066, + 0.0034350821142144186, + 0.0035869113525768474, + 0.0036659942562330076 ], - "timestamp": 0.6399842050363576 + "timestamp": 0.6094526205834625 }, { - "x": 10.42916122482486, - "y": 7.079279709676494, - "heading": -0.12158830320096466, - "angularVelocity": 0.000199491561733752, - "velocityX": -3.8207354997777165, - "velocityY": 1.079570914898582, + "x": 10.620473493797341, + "y": 7.025231408572309, + "heading": -0.12164382100669206, + "angularVelocity": 0.00022311029422917704, + "velocityX": -3.6296046732101006, + "velocityY": 1.0256109933571795, "moduleForcesX": [ - -0.000010817185800089757, - -0.000010826840184563996, - -0.000010728186769667733, - -0.000010737841153636994 + 0.00002434182804179363, + 0.00002440227199946701, + 0.000020678411625246635, + 0.00002075523564597107 ], "moduleForcesY": [ - -0.00003818254602090013, - -0.00003811622625778976, - -0.00003816959017816588, - -0.00003810327041597527 + 0.00008082287391198304, + 0.00007797287404045539, + 0.00008183770796018627, + 0.00007861043704994156 ], - "timestamp": 0.7314105200415515 + "timestamp": 0.6965172806668143 }, { - "x": 10.079845074724386, - "y": 7.17797836765492, - "heading": -0.12156967900738717, - "angularVelocity": 0.00020370714467073155, - "velocityX": -3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 10.304463176887305, + "y": 7.114525811000592, + "heading": -0.12162439602548268, + "angularVelocity": 0.00022310982654477333, + "velocityX": -3.629604900627923, + "velocityY": 1.0256101883680144, "moduleForcesX": [ - -0.000724611981877418, - -0.0005826729788445193, - -0.0007171397023142401, - -0.0005764705403427619 + -0.00003675082473489597, + -0.000037176248898554475, + -0.00003699545409221911, + -0.00003744433216461551 ], "moduleForcesY": [ - -0.004183092119230615, - -0.004164770678407313, - -0.004451422852479581, - -0.004410331431156549 + -0.00013113344539951354, + -0.0001311896105161841, + -0.00013157216497814358, + -0.0001312778439131569 ], - "timestamp": 0.8228368350467452 + "timestamp": 0.7835819407501659 }, { - "x": 9.753318963003084, - "y": 7.270191836288494, - "heading": -0.08193010734885013, - "angularVelocity": 0.43356851532608676, - "velocityX": -3.5714674894503937, - "velocityY": 1.0086097052947562, + "x": 9.988452352347721, + "y": 7.203817281479636, + "heading": -0.12160455496323849, + "angularVelocity": 0.00022788881533772785, + "velocityX": -3.629610731116951, + "velocityY": 1.0255765128303516, "moduleForcesX": [ - 32.71681627397986, - 47.82428831491742, - 29.57806286942199, - 44.74713985839775 + -0.0010130445731977192, + -0.000753992270294424, + -0.0011491207143127223, + -0.0008876399654099 ], "moduleForcesY": [ - 2.410633101239201, - 0.7117166259846383, - -23.90450526901233, - -23.286981568782405 + -0.0053203589783196985, + -0.005461740514528871, + -0.00551336991331991, + -0.005674373284473044 ], - "timestamp": 0.9142631500519389 + "timestamp": 0.8706466008335176 }, { - "x": 9.492019530398496, - "y": 7.343983789856553, - "heading": -0.04944702950219561, - "angularVelocity": 0.35529243243380376, - "velocityX": -2.858033079313581, - "velocityY": 0.8071194115596501, + "x": 9.692382682952024, + "y": 7.2874193702981085, + "heading": -0.0822191306558338, + "angularVelocity": 0.45236981652140956, + "velocityX": -3.4005722771128415, + "velocityY": 0.9602298882053446, "moduleForcesX": [ - 110.11042093282536, - 109.72343096717103, - 111.82904603560874, - 111.57527328961984 + 30.62118617981392, + 47.41130841236055, + 27.280967447136295, + 44.1106943011997 ], "moduleForcesY": [ - -33.86318732230892, - -35.059198202419715, - -27.649683347659746, - -28.608589707922565 + 4.023869535756976, + 2.0544391312139076, + -24.6327470438544, + -24.07754801487098 ], - "timestamp": 1.0056894650571326 + "timestamp": 0.9577112609168694 }, { - "x": 9.2960192355485, - "y": 7.399334406788997, - "heading": -0.02482773338497671, - "angularVelocity": 0.2692801970178966, - "velocityX": -2.1438061332654796, - "velocityY": 0.6054123140509308, + "x": 9.455455171491224, + "y": 7.354320907313611, + "heading": -0.04970482150665087, + "angularVelocity": 0.3734501360030033, + "velocityX": -2.721282219834982, + "velocityY": 0.768412085356498, "moduleForcesX": [ - 110.18532231271769, - 109.7167628980199, - 112.06441279220556, - 111.76405509082988 + 110.05417979801821, + 109.63993232178616, + 111.86911447326588, + 111.60403176355511 ], "moduleForcesY": [ - -34.07720649246468, - -35.53661461014457, - -27.26087793372916, - -28.44065406776567 + -34.00135979147741, + -35.27274549289079, + -27.43088810329592, + -28.43649643947654 ], - "timestamp": 1.0971157800623264 + "timestamp": 1.0447759210002212 }, { - "x": 9.16534208313775, - "y": 7.436237482881837, - "heading": -0.008305113039109078, - "angularVelocity": 0.18072062015109094, - "velocityX": -1.4293166294991293, - "velocityY": 0.4036373563863185, + "x": 9.277736160829281, + "y": 7.404503175997865, + "heading": -0.0249851504638235, + "angularVelocity": 0.2839231327517031, + "velocityX": -2.0412301672320625, + "velocityY": 0.5763793097705944, "moduleForcesX": [ - 110.21880379377984, - 109.70681368656747, - 112.14833562771497, - 111.81972024066971 + 110.1040648842651, + 109.58272113098381, + 112.14908861391895, + 111.82850771075378 ], "moduleForcesY": [ - -34.1198596453768, - -35.718037584285995, - -27.106350443858066, - -28.413265173608863 + -34.31811935636646, + -35.92513988883449, + -26.882739105964255, + -28.155739191192566 ], - "timestamp": 1.18854209506752 + "timestamp": 1.131840581083573 + }, + { + "x": 9.159247496299429, + "y": 7.437960457197711, + "heading": -0.008364737523416488, + "angularVelocity": 0.19089735059547008, + "velocityX": -1.3609272053255366, + "velocityY": 0.38428084561307907, + "moduleForcesX": [ + 110.13043304849137, + 109.55438775829175, + 112.24817460065178, + 111.89507958039741 + ], + "moduleForcesY": [ + -34.39052165205634, + -36.16792173997415, + -26.671524840114127, + -28.094624382026243 + ], + "timestamp": 1.2189052411669248 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 3.668994025305924e-20, - "angularVelocity": 0.09083941574848846, - "velocityX": -0.7146966727690923, - "velocityY": 0.2018291634125037, + "heading": 7.242510620075491e-20, + "angularVelocity": 0.096075003513578, + "velocityX": -0.680499943865953, + "velocityY": 0.19215055040122928, "moduleForcesX": [ - 110.23546235943999, - 109.70058243131005, - 112.19103002395251, - 111.8476455542373 + 110.14366836151463, + 109.53867302844944, + 112.29847947682536, + 111.92834686125501 ], "moduleForcesY": [ - -34.1411922801755, - -35.81216376796426, - -27.025531588293937, - -28.399273440528706 + -34.426167314961276, + -36.29325100794249, + -26.561761552149026, + -28.064179245161927 ], - "timestamp": 1.2799684100727138 + "timestamp": 1.3059699012502766 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 1.8140975017922662e-20, - "angularVelocity": -5.347539139373239e-21, - "velocityX": 1.1027338008988471e-21, - "velocityY": 1.1228733232906781e-21, + "heading": 3.585471297015955e-20, + "angularVelocity": -1.007056327923224e-20, + "velocityX": 3.7291337159094484e-21, + "velocityY": 1.6506889205384567e-21, "moduleForcesX": [ - 110.23935489778837, - 109.69825354519148, - 112.21511593235195, - 111.8696576656152 + 110.14478533871653, + 109.53077444413167, + 112.32693857060057, + 111.95408720798878 ], "moduleForcesY": [ - -34.173575075339315, - -35.86413648487152, - -26.9832725291903, - -28.370205373579942 + -34.46921393384191, + -36.36354115442993, + -26.50294273092508, + -28.022875739605002 ], - "timestamp": 1.3713947250779075 + "timestamp": 1.3930345613336284 } ], "eventMarkers": [ { - "timestamp": 0.3999999999999999, + "timestamp": 0.40000000000000013, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.3.traj b/src/main/deploy/choreo/Red Amp 5 Piece.3.traj index f1e43af..c7a7dd2 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.3.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.3.traj @@ -3,338 +3,359 @@ { "x": 9.1, "y": 7.454689979553223, - "heading": 1.8140975017922662e-20, - "angularVelocity": -5.347539139373239e-21, - "velocityX": 1.1027338008988471e-21, - "velocityY": 1.1228733232906781e-21, + "heading": 3.585471297015955e-20, + "angularVelocity": -1.007056327923224e-20, + "velocityX": 3.7291337159094484e-21, + "velocityY": 1.6506889205384567e-21, "moduleForcesX": [ - 110.23935489778837, - 109.69825354519148, - 112.21511593235195, - 111.8696576656152 + 110.14478533871653, + 109.53077444413167, + 112.32693857060057, + 111.95408720798878 ], "moduleForcesY": [ - -34.173575075339315, - -35.86413648487152, - -26.9832725291903, - -28.370205373579942 + -34.46921393384191, + -36.36354115442993, + -26.50294273092508, + -28.022875739605002 ], "timestamp": 0 }, { - "x": 9.171685854048507, - "y": 7.416972530106804, - "heading": 4.73116158338858e-18, - "angularVelocity": 4.720976000658869e-17, - "velocityX": 0.7180685701633659, - "velocityY": -0.37781115052171915, + "x": 9.165462800190092, + "y": 7.420246784454786, + "heading": 1.0000252535719594e-17, + "angularVelocity": 1.0444752855082387e-16, + "velocityX": 0.6861857407128128, + "velocityY": -0.3610360276753583, "moduleForcesX": [ - 102.13925806744795, - 102.13925806744795, - 102.13925806744794, - 102.13925806744795 + 102.13700666833603, + 102.13700666833603, + 102.13700666833601, + 102.13700666833603 ], "moduleForcesY": [ - -53.74048135140899, - -53.74048135140898, - -53.74048135140899, - -53.74048135140898 + -53.73929677973422, + -53.739296779734225, + -53.73929677973423, + -53.73929677973423 ], - "timestamp": 0.09983148828279464 + "timestamp": 0.09540099175201355 }, { - "x": 9.315046569258698, - "y": 7.341543415111761, - "heading": 2.876637893287952e-17, - "angularVelocity": 2.4075787867618104e-16, - "velocityX": 1.4360270259027919, - "velocityY": -0.755564364435534, + "x": 9.296377871427524, + "y": 7.351365934157169, + "heading": 3.1188473540722436e-17, + "angularVelocity": 2.2209644368399916e-16, + "velocityX": 1.3722611142002972, + "velocityY": -0.7220139857315829, "moduleForcesX": [ - 102.12359521012328, - 102.1235952101233, - 102.12359521012328, - 102.12359521012328 + 102.12057878684489, + 102.12057878684489, + 102.12057878684487, + 102.12057878684489 ], "moduleForcesY": [ - -53.73224035271865, - -53.73224035271864, - -53.732240352718655, - -53.732240352718655 + -53.7306532642474, + -53.7306532642474, + -53.730653264247415, + -53.730653264247415 ], - "timestamp": 0.1996629765655893 + "timestamp": 0.1908019835040271 }, { - "x": 9.530060249336586, - "y": 7.228414155284034, - "heading": 4.9619729837040083e-17, - "angularVelocity": 2.0888550553958917e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246714, + "x": 9.492724224087116, + "y": 7.2480584723333115, + "heading": 4.513674716574335e-17, + "angularVelocity": 1.4620679885932853e-16, + "velocityX": 2.0581164729395796, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 102.09239698765673, - 102.09239698765673, - 102.09239698765673, - 102.09239698765673 + 102.08783014974716, + 102.08783014974716, + 102.08783014974716, + 102.08783014974716 ], "moduleForcesY": [ - -53.71582543523849, - -53.71582543523849, - -53.71582543523849, - -53.71582543523849 + -53.71342259746431, + -53.71342259746431, + -53.7134225974643, + -53.7134225974643 ], - "timestamp": 0.29949446484838393 + "timestamp": 0.28620297525604066 }, { - "x": 9.81666193347748, - "y": 7.077618929694229, - "heading": 5.975283971937042e-17, - "angularVelocity": 1.0150214177102703e-16, - "velocityX": 2.870854567739517, - "velocityY": -1.510497621378186, + "x": 9.754439455027212, + "y": 7.11035723234165, + "heading": 4.2267360158652724e-17, + "angularVelocity": -3.007711940252278e-17, + "velocityX": 2.743317717497125, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 101.99983969748537, - 101.99983969748537, - 101.99983969748537, - 101.99983969748537 + 101.99046691326761, + 101.99046691326761, + 101.99046691326761, + 101.99046691326761 ], "moduleForcesY": [ - -53.667126497919924, - -53.66712649791993, - -53.66712649791992, - -53.667126497919924 + -53.662195015696604, + -53.662195015696604, + -53.66219501569659, + -53.6621950156966 ], - "timestamp": 0.3993259531311786 + "timestamp": 0.3816039670080542 }, { - "x": 10.167455917956454, - "y": 6.893048981392569, - "heading": 5.19391181641435e-17, - "angularVelocity": -7.826910822496646e-17, - "velocityX": 3.5138611124906114, - "velocityY": -1.8488149528415818, + "x": 10.072897912662654, + "y": 6.942800593223961, + "heading": 1.7008792193577606e-17, + "angularVelocity": -2.647621111076902e-16, + "velocityX": 3.3381042669163024, + "velocityY": -1.7563406421731869, "moduleForcesX": [ - 91.46231173778877, - 91.46231173778874, - 91.46231173778877, - 91.46231173778875 + 88.53246892183445, + 88.53246892183445, + 88.53246892183445, + 88.53246892183445 ], "moduleForcesY": [ - -48.12281537286678, - -48.12281537286678, - -48.12281537286676, - -48.12281537286676 + -46.58128113625249, + -46.58128113625251, + -46.58128113625249, + -46.581281136252485 ], - "timestamp": 0.4991574414139732 + "timestamp": 0.47700495876006777 }, { - "x": 10.518252161317257, - "y": 6.70847784458221, - "heading": 3.766456124956393e-17, - "angularVelocity": -1.4298651827732539e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901475, + "x": 10.391358109467166, + "y": 6.775243039043985, + "heading": 1.964059559448171e-17, + "angularVelocity": 2.7586750815932474e-17, + "velocityX": 3.3381224970105308, + "velocityY": -1.75635023392133, "moduleForcesX": [ - 0.003218494319225325, - 0.003218494319216094, - 0.003218494319193459, - 0.003218494319184196 + 0.0027135032766586317, + 0.002713503276605032, + 0.002713503276550828, + 0.0027135032764971424 ], "moduleForcesY": [ - -0.0016934079727223925, - -0.0016934079727399663, - -0.0016934079727242658, - -0.0016934079727418635 + -0.0014277073770695113, + -0.0014277073770064686, + -0.0014277073771330811, + -0.0014277073770701714 ], - "timestamp": 0.5989889296967679 + "timestamp": 0.5724059505120813 }, { - "x": 10.869048404693604, - "y": 6.523906707763672, - "heading": 2.2701290589411372e-17, - "angularVelocity": -1.4988528093015713e-16, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 10.709818306284792, + "y": 6.607685484857109, + "heading": -3.8538311178504195e-18, + "angularVelocity": -2.462702566883343e-16, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936556, "moduleForcesX": [ - 2.214842103369335e-8, - 2.214841971652397e-8, - 2.2148399662466356e-8, - 2.2148398355512985e-8 + 2.0460973813009118e-8, + 2.0460961354645526e-8, + 2.0460963129610995e-8, + 2.0460950665772818e-8 ], "moduleForcesY": [ - -1.1653376600724734e-8, - -1.1653388805406456e-8, - -1.165337704047802e-8, - -1.165338925383615e-8 + -1.0765500981855737e-8, + -1.0765504080928475e-8, + -1.0765488096575326e-8, + -1.0765491204163331e-8 ], - "timestamp": 0.6988204179795625 + "timestamp": 0.6678069422640949 }, { - "x": 11.219844648069952, - "y": 6.339335570945134, - "heading": 3.061231332790382e-17, - "angularVelocity": 7.924376236807535e-17, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 11.028278503102417, + "y": 6.440127930670234, + "heading": -1.300020909937592e-17, + "angularVelocity": -9.58729864932316e-17, + "velocityX": 3.3381224971479946, + "velocityY": -1.756350233993656, "moduleForcesX": [ - 8.153502180996974e-15, - 1.7251673005843974e-14, - -1.58855310989108e-15, - 7.507130962539776e-15 + 1.4474838704178555e-13, + 1.5068927215576243e-13, + 1.408186230548463e-13, + 1.4675794469346446e-13 ], "moduleForcesY": [ - -2.8417399270339567e-16, - -8.464949440223293e-15, - -1.1231547709612304e-14, - -1.9406448996208048e-14 + -8.907551463496866e-14, + -9.211214882671091e-14, + -9.682450585984768e-14, + -9.985744234971747e-14 ], - "timestamp": 0.7986519062623572 + "timestamp": 0.7632079340161084 }, { - "x": 11.570640891430754, - "y": 6.1547644341347745, - "heading": 1.903661500367957e-17, - "angularVelocity": -1.1595237656501265e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901472, + "x": 11.346738699920042, + "y": 6.272570376483358, + "heading": -1.6034884829107134e-17, + "angularVelocity": -3.180968750998064e-17, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936554, "moduleForcesX": [ - -2.2148468458536655e-8, - -2.2148476648513925e-8, - -2.2148474908807252e-8, - -2.2148483100357075e-8 + -1.6409175526761825e-13, + -1.6159239329690174e-13, + -1.6616883137339107e-13, + -1.6366371958278699e-13 ], "moduleForcesY": [ - 1.1653415936522858e-8, - 1.1653413493871686e-8, - 1.165342493176425e-8, - 1.1653422488553742e-8 + 9.856885441627709e-14, + 9.702579680058777e-14, + 9.524682094901744e-14, + 9.370612817889214e-14 ], - "timestamp": 0.8984833945451518 + "timestamp": 0.858608925768122 }, { - "x": 11.921434875909728, - "y": 5.970194485833114, - "heading": 2.2015567565585324e-17, - "angularVelocity": 2.9839809238463793e-17, - "velocityX": 3.513861112490612, - "velocityY": -1.8488149528415816, + "x": 11.665198896724554, + "y": 6.105012822303383, + "heading": -3.327196466558203e-18, + "angularVelocity": 1.33202895790123e-16, + "velocityX": 3.3381224970105308, + "velocityY": -1.7563502339213297, "moduleForcesX": [ - -0.0032184943191482383, - -0.003218494319154078, - -0.003218494319166007, - -0.0032184943191717096 + -2.046097600304392e-8, + -2.046096833033551e-8, + -2.0460974922422488e-8, + -2.0460967227223523e-8 ], "moduleForcesY": [ - 0.0016934079727123717, - 0.0016934079727241181, - 0.0016934079726967873, - 0.001693407972708547 + 1.0765497780128575e-8, + 1.0765495712162903e-8, + 1.0765490146356085e-8, + 1.0765488084589651e-8 ], - "timestamp": 0.9983148828279464 + "timestamp": 0.9540099175201355 }, { - "x": 12.208036560050623, - "y": 5.819399260243309, - "heading": 1.715956257076988e-17, - "angularVelocity": -4.864201740947202e-17, - "velocityX": 2.8708545677395176, - "velocityY": -1.510497621378186, + "x": 11.983657354359996, + "y": 5.937456183185693, + "heading": -1.2837192767441167e-17, + "angularVelocity": -9.968445945953903e-17, + "velocityX": 3.338104266916303, + "velocityY": -1.7563406421731866, "moduleForcesX": [ - -91.4623117377888, - -91.4623117377888, - -91.46231173778881, - -91.46231173778878 + -0.002713503276636462, + -0.0027135032765821195, + -0.002713503276540376, + -0.0027135032764861538 ], "moduleForcesY": [ - 48.122815372866775, - 48.12281537286678, - 48.12281537286677, - 48.122815372866796 + 0.0014277073770852346, + 0.0014277073770136435, + 0.0014277073771445043, + 0.0014277073770729747 ], - "timestamp": 1.098146371110741 + "timestamp": 1.049410909272149 }, { - "x": 12.42305024012851, - "y": 5.706270000415583, - "heading": 4.0500799094748495e-18, - "angularVelocity": -1.3131610960667952e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246712, + "x": 12.245372585300093, + "y": 5.799754943194032, + "heading": 8.061487264185827e-18, + "angularVelocity": 2.1906145481338784e-16, + "velocityX": 2.7433177174971255, + "velocityY": -1.4433942191041782, "moduleForcesX": [ - -101.99983969748537, - -101.99983969748537, - -101.99983969748537, - -101.99983969748537 + -88.53246892183448, + -88.53246892183445, + -88.53246892183448, + -88.53246892183448 ], "moduleForcesY": [ - 53.667126497919924, - 53.667126497919924, - 53.66712649791993, - 53.66712649791993 + 46.581281136252514, + 46.58128113625253, + 46.5812811362525, + 46.58128113625251 ], - "timestamp": 1.1979778593935357 + "timestamp": 1.1448119010241626 }, { - "x": 12.566410955338702, - "y": 5.63084088542054, - "heading": -3.708075207453893e-18, - "angularVelocity": -7.771250580976826e-17, - "velocityX": 1.4360270259027916, - "velocityY": -0.7555643644355339, + "x": 12.441718937959685, + "y": 5.696447481370175, + "heading": -6.661113737991722e-19, + "angularVelocity": -9.14833112894713e-17, + "velocityX": 2.05811647293958, + "velocityY": -1.0828761832203577, "moduleForcesX": [ - -102.09239698765673, - -102.09239698765673, - -102.09239698765673, - -102.09239698765673 + -101.99046691326761, + -101.99046691326762, + -101.99046691326761, + -101.99046691326761 ], "moduleForcesY": [ - 53.715825435238486, - 53.715825435238486, - 53.715825435238486, - 53.71582543523849 + 53.66219501569659, + 53.66219501569659, + 53.66219501569661, + 53.662195015696604 ], - "timestamp": 1.2978093476763304 + "timestamp": 1.2402128927761762 + }, + { + "x": 12.572634009197117, + "y": 5.627566631072558, + "heading": -3.887549896896706e-19, + "angularVelocity": 2.907269528625613e-18, + "velocityX": 1.3722611142002974, + "velocityY": -0.7220139857315828, + "moduleForcesX": [ + -102.08783014974718, + -102.08783014974716, + -102.08783014974716, + -102.08783014974716 + ], + "moduleForcesY": [ + 53.7134225974643, + 53.7134225974643, + 53.7134225974643, + 53.71342259746431 + ], + "timestamp": 1.3356138845281897 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.613826982610023e-18, - "angularVelocity": 9.440731598697995e-19, - "velocityX": 0.718068570163366, - "velocityY": -0.3778111505217191, + "heading": 4.421333072969964e-19, + "angularVelocity": 8.70943051994905e-18, + "velocityX": 0.6861857407128128, + "velocityY": -0.36103602767535825, "moduleForcesX": [ - -102.1235952101233, - -102.12359521012328, - -102.1235952101233, - -102.1235952101233 + -102.12057878684487, + -102.12057878684489, + -102.12057878684489, + -102.12057878684489 ], "moduleForcesY": [ - 53.73224035271864, - 53.73224035271865, - 53.73224035271864, - 53.73224035271865 + 53.73065326424741, + 53.73065326424741, + 53.7306532642474, + 53.73065326424741 ], - "timestamp": 1.397640835959125 + "timestamp": 1.4310148762802029 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.5546712678246825e-18, - "angularVelocity": 5.925557111968679e-19, - "velocityX": 4.845232015144286e-18, - "velocityY": -3.784642229218748e-18, + "heading": 4.2336552415027816e-19, + "angularVelocity": -1.9672511354829974e-19, + "velocityX": 4.977758444457901e-18, + "velocityY": 1.6190413361646781e-18, "moduleForcesX": [ - -102.13925806744795, - -102.13925806744795, - -102.13925806744795, - -102.13925806744794 + -102.13700666833603, + -102.13700666833603, + -102.13700666833603, + -102.13700666833603 ], "moduleForcesY": [ - 53.74048135140898, - 53.74048135140899, - 53.740481351408974, - 53.74048135140899 + 53.73929677973424, + 53.73929677973423, + 53.739296779734225, + 53.739296779734225 ], - "timestamp": 1.4974723242419197 + "timestamp": 1.5264158680322164 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.4.traj b/src/main/deploy/choreo/Red Amp 5 Piece.4.traj index 70f8025..9cd679d 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.4.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.4.traj @@ -3,632 +3,632 @@ { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.5546712678246825e-18, - "angularVelocity": 5.925557111968679e-19, - "velocityX": 4.845232015144286e-18, - "velocityY": -3.784642229218748e-18, + "heading": 4.2336552415027816e-19, + "angularVelocity": -1.9672511354829974e-19, + "velocityX": 4.977758444457901e-18, + "velocityY": 1.6190413361646781e-18, "moduleForcesX": [ - -102.13925806744795, - -102.13925806744795, - -102.13925806744795, - -102.13925806744794 + -102.13700666833603, + -102.13700666833603, + -102.13700666833603, + -102.13700666833603 ], "moduleForcesY": [ - 53.74048135140898, - 53.74048135140899, - 53.740481351408974, - 53.74048135140899 + 53.73929677973424, + 53.73929677973423, + 53.739296779734225, + 53.739296779734225 ], "timestamp": 0 }, { - "x": 12.635601743595934, - "y": 5.59148869514806, - "heading": -0.040469209324330645, - "angularVelocity": -1.1653411306828494, - "velocityX": -0.07184728436451648, - "velocityY": -0.047073583952371864, + "x": 12.635716300422908, + "y": 5.591477621529516, + "heading": -0.04053440079408721, + "angularVelocity": -1.1690740956944317, + "velocityX": -0.06865751831067732, + "velocityY": -0.047467805020289744, "moduleForcesX": [ - 6.715898232782912, - -74.23634164667784, - 61.50244174016689, - -111.49692422807281 + 8.096498399631756, + -73.90381849216459, + 64.47066032298743, + -111.13955678681945 ], "moduleForcesY": [ - -115.15629744618346, - -88.32054795571801, - 97.03134384991834, - 29.45095987898999 + -115.06817413543638, + -88.5992032674739, + 95.13273018745403, + 30.771872674752988 ], - "timestamp": 0.0347273500083336 + "timestamp": 0.03467222560432326 }, { - "x": 12.630989153588672, - "y": 5.587957161161052, - "heading": -0.12142442884644973, - "angularVelocity": -2.3311660550745135, - "velocityX": -0.13282297688005926, - "velocityY": -0.10169316075544019, + "x": 12.63128685127921, + "y": 5.587940767261187, + "heading": -0.12156201076160397, + "angularVelocity": -2.33696016206742, + "velocityX": -0.12775208589855394, + "velocityY": -0.102008284922097, "moduleForcesX": [ - 0.99135751533034, - -78.3059668743301, - 87.10790717980457, - -109.52641997223697 + 2.2065963342952273, + -78.0409085702254, + 88.10645679121941, + -109.08213048053173 ], "moduleForcesY": [ - -115.3287239283564, - -84.70847062161553, - 74.72643789735397, - 35.97383073297602 + -115.31231038297804, + -84.95264569095009, + 73.61772559553323, + 37.297848510277355 ], - "timestamp": 0.0694547000166672 + "timestamp": 0.06934445120864652 }, { - "x": 12.624509421807858, - "y": 5.58199542338269, - "heading": -0.24205524013552657, - "angularVelocity": -3.4736543750136, - "velocityX": -0.18658871982052855, - "velocityY": -0.17167269535197777, + "x": 12.625028987271739, + "y": 5.582022220388997, + "heading": -0.2423139565639912, + "angularVelocity": -3.48267074575483, + "velocityX": -0.18048636620236289, + "velocityY": -0.17069994120746917, "moduleForcesX": [ - -7.591385688898406, - -84.0456517158906, - 109.52068801281428, - -105.82402794572394 + -6.5867304178653185, + -83.86452574104914, + 109.29775219994504, + -105.23692315428146 ], "moduleForcesY": [ - -115.05554501752215, - -78.97617075986716, - 34.00596685578571, - 45.5657537319174 + -115.11732618046953, + -79.16769136400295, + 34.85061884596746, + 46.9022565810502 ], - "timestamp": 0.1041820500250008 + "timestamp": 0.10401667681296978 }, { - "x": 12.61601333895309, - "y": 5.573089966082191, - "heading": -0.40091737527763976, - "angularVelocity": -4.574553920871888, - "velocityX": -0.24465105609063115, - "velocityY": -0.2564392992371348, + "x": 12.61679879499125, + "y": 5.573228753463621, + "heading": -0.4014079147959288, + "angularVelocity": -4.588513008870753, + "velocityX": -0.23737132927115676, + "velocityY": -0.25361703127242496, "moduleForcesX": [ - -18.72557620909359, - -90.96637263149834, - 113.95654026368184, - -99.23256696756765 + -17.998694570457108, + -90.87202731423554, + 114.15847162607923, + -98.47791423254111 ], "moduleForcesY": [ - -113.7295099024964, - -70.81659924554228, - -12.395836704635942, - 58.295909852584266 + -113.84541579014022, + -70.93479429110369, + -10.61021875597528, + 59.55387651430768 ], - "timestamp": 0.1389094000333344 + "timestamp": 0.13868890241729304 }, { - "x": 12.605082130208535, - "y": 5.561092759135586, - "heading": -0.5968969422163409, - "angularVelocity": -5.643378112400488, - "velocityX": -0.31477232619048406, - "velocityY": -0.3454685411851268, + "x": 12.606171501564956, + "y": 5.561383158190227, + "heading": -0.597641326297266, + "angularVelocity": -5.659671627104043, + "velocityX": -0.3065073914657803, + "velocityY": -0.3416450795104292, "moduleForcesX": [ - -32.04770801640716, - -98.43585145612518, - 103.26614786567647, - -87.47440914613598 + -31.702182349069048, + -98.39402131426678, + 103.64312194332079, + -86.80709567336851 ], "moduleForcesY": [ - -110.62167229916327, - -59.81255295495651, - -49.50954102303336, - 74.32567001715357 + -110.71556436707718, + -59.87033716863823, + -48.704407218405564, + 75.08087531888812 ], - "timestamp": 0.173636750041668 + "timestamp": 0.1733611280216163 }, { - "x": 12.591329218838723, - "y": 5.546283772243203, - "heading": -0.8296689344895842, - "angularVelocity": -6.702843499932593, - "velocityX": -0.39602536233005076, - "velocityY": -0.42643584635250353, + "x": 12.59265174321713, + "y": 5.546665747496571, + "heading": -0.8301729234385428, + "angularVelocity": -6.706566800611855, + "velocityX": -0.3899305023598048, + "velocityY": -0.4244726272149572, "moduleForcesX": [ - -47.31647496655648, - -105.61081086052921, - 85.39422216677532, - -65.36610720874525 + -47.633339347555925, + -105.47445484854185, + 83.83071395151596, + -67.38844623517069 ], "moduleForcesY": [ - -104.70081415220629, - -45.20977101766445, - -75.5707601247976, - 93.04952199931408 + -104.5242317395292, + -45.44976016477657, + -77.1734046395607, + 91.457534433043 ], - "timestamp": 0.2083641000500016 + "timestamp": 0.20803335362593955 }, { - "x": 12.572042639393677, - "y": 5.534219720600946, - "heading": -1.073814547044594, - "angularVelocity": -7.030355397011889, - "velocityX": -0.5553714706252239, - "velocityY": -0.3473933841586206, + "x": 12.572877030087271, + "y": 5.534422452953114, + "heading": -1.0590948047093973, + "angularVelocity": -6.602457075680554, + "velocityX": -0.5703329620523357, + "velocityY": -0.35311533453825095, "moduleForcesX": [ - -82.71377263272161, - -84.82446387482808, - -42.35353791946482, - -50.7380639123641 + -69.11423919609621, + -67.8872625428816, + -79.57383821530136, + -78.96383219960605 ], "moduleForcesY": [ - -3.3792218912464422, - 29.67111027754918, - 37.553509843725166, - 65.43811150826103 + 41.078313605626754, + 30.388799241217356, + 28.281282661879363, + 17.150649220262693 ], - "timestamp": 0.2430914500583352 + "timestamp": 0.2427055792302628 }, { - "x": 12.559986566266332, - "y": 5.526755385653593, - "heading": -1.330510420929693, - "angularVelocity": -7.391749552542837, - "velocityX": -0.34716363685831114, - "velocityY": -0.21494110392994975, + "x": 12.560233187149112, + "y": 5.526847142047006, + "heading": -1.3004735728523615, + "angularVelocity": -6.961732739558218, + "velocityX": -0.36466776267695544, + "velocityY": -0.21848354912537238, "moduleForcesX": [ - 105.72590475429266, - 37.456143843089066, - 110.13783644093012, - 87.22921676430109 + 105.17188805717923, + 36.64629093835158, + 109.3871868445873, + 85.71976737512696 ], "moduleForcesY": [ - 16.762047005929656, - 104.18797300994257, - 23.903310122839276, - 71.78839869306294 + 17.180702657687426, + 103.98341170708088, + 26.15382218906551, + 73.23873697676419 ], - "timestamp": 0.2778188000666688 + "timestamp": 0.2773778048345861 }, { - "x": 12.554805000117685, - "y": 5.5258948814498945, - "heading": -1.5817192983329285, - "angularVelocity": -7.233747387662799, - "velocityX": -0.14920707014510395, - "velocityY": -0.024778861718294874, + "x": 12.554266136797898, + "y": 5.525513029563462, + "heading": -1.5511519906743647, + "angularVelocity": -7.2299488553959, + "velocityX": -0.17209885570398845, + "velocityY": -0.03847784387333178, "moduleForcesX": [ - 85.10006434406202, - 98.91322895268817, - 60.59757319762427, - 79.17104780949104 + 79.29225853022504, + 41.96175012878335, + 107.32093626149006, + 86.89556166997258 ], "moduleForcesY": [ - 76.28924255238852, - 56.8610964875441, - 96.53986801348239, - 81.3431465448386 + 78.39773568550407, + 105.27165483766125, + 37.43702182189581, + 73.78278818931089 ], - "timestamp": 0.3125461500750024 + "timestamp": 0.31205003043890933 }, { - "x": 12.553693111577713, - "y": 5.531340138988141, - "heading": -1.8090738890833113, - "angularVelocity": -6.546845373914893, - "velocityX": -0.032017661575237936, - "velocityY": 0.15680026080135756, + "x": 12.553234089263041, + "y": 5.53083198575942, + "heading": -1.783366315606556, + "angularVelocity": -6.69741618499501, + "velocityX": -0.029765828898134138, + "velocityY": 0.15340682933530048, "moduleForcesX": [ - 93.64139046456043, - 114.77127776967987, - 11.773017615907161, - -28.508230169372723 + 91.37221926721882, + 113.32252584700692, + 19.278349706082533, + 9.199917255318628 ], "moduleForcesY": [ - 66.90444420135348, - 5.619126084548563, - 114.36468781389611, - 110.10636482779223 + 69.7968364317707, + 18.15978259725049, + 113.19848312438963, + 113.19447803386177 ], - "timestamp": 0.347273500083336 + "timestamp": 0.3467222560432326 }, { - "x": 12.556050432946392, - "y": 5.5420473258338605, - "heading": -2.005506504495854, - "angularVelocity": -5.656423981829998, - "velocityX": 0.06788083076058496, - "velocityY": 0.30832144817123774, + "x": 12.555779264328171, + "y": 5.54162936928793, + "heading": -1.9860033843796512, + "angularVelocity": -5.8443628939651955, + "velocityX": 0.07340674043181038, + "velocityY": 0.31141305008017556, "moduleForcesX": [ - 100.73960236681776, - 113.64668162060796, - 12.572866576727497, - -63.56308029676134 + 99.46991245107658, + 114.32669032012043, + 12.885145778988177, + -57.662236395363905 ], "moduleForcesY": [ - 55.95250024879295, - -18.155758880065523, - 114.50709600750906, - 95.52739610484751 + 58.11499274397129, + -12.760758459450766, + 114.43208308109202, + 99.062856607364 ], - "timestamp": 0.3820008500916696 + "timestamp": 0.38139448164755585 }, { - "x": 12.56203010772394, - "y": 5.557428390445447, - "heading": -2.1690558980603147, - "angularVelocity": -4.709527030574263, - "velocityX": 0.1721892046502874, - "velocityY": 0.44290925186907815, + "x": 12.56191803403241, + "y": 5.557168661278036, + "heading": -2.156099967433693, + "angularVelocity": -4.905845531670559, + "velocityX": 0.17705150440276152, + "velocityY": 0.4481769404548373, "moduleForcesX": [ - 105.74765097197235, - 109.64221257829823, - 19.07370797888986, - -63.85460645824819 + 105.08894599974387, + 110.32756561762763, + 18.126645587310904, + -63.75008567857288 ], "moduleForcesY": [ - 45.943867600773586, - -35.22297007233559, - 113.69565987258666, - 95.71807842731238 + 47.393531907484665, + -32.91770130594804, + 113.83333151918828, + 95.74037140980943 ], - "timestamp": 0.4167282001000032 + "timestamp": 0.4160667072518791 }, { - "x": 12.57182488488311, - "y": 5.577061809180295, - "heading": -2.2988461247392196, - "angularVelocity": -3.7374065872506375, - "velocityX": 0.2820479292782165, - "velocityY": 0.5653589672156297, + "x": 12.571808374354218, + "y": 5.5769573204468506, + "heading": -2.292448340929877, + "angularVelocity": -3.9324955672641906, + "velocityX": 0.2852525371366751, + "velocityY": 0.5707351871391592, "moduleForcesX": [ - 109.05462491040085, - 104.57283217895744, - 25.584631264200784, - -59.524853150368294 + 108.78605491561635, + 104.6850804882193, + 24.525066052249105, + -60.73895288598403 ], "moduleForcesY": [ - 37.52781331032903, - -48.329200017604535, - 112.45689047019695, - 98.62582006054753 + 38.272268020461155, + -48.04212290386911, + 112.68375035926043, + 97.86364839715985 ], - "timestamp": 0.4514555501083368 + "timestamp": 0.45073893285620237 }, { "x": 12.585567474365234, "y": 5.600627422332764, "heading": -2.3943443337005537, - "angularVelocity": -2.749942305946666, - "velocityX": 0.395728135859107, - "velocityY": 0.6785894445390662, + "angularVelocity": -2.938836229710392, + "velocityX": 0.3968334818778352, + "velocityY": 0.6826819297969253, "moduleForcesX": [ - 111.09605990584453, - 99.46866631123623, - 30.695272549126692, - -55.32226749334036 + 111.07132972844772, + 98.70912927254115, + 29.84347118911907, + -56.82963740078154 ], "moduleForcesY": [ - 31.048087478724806, - -58.16713625641179, - 111.19928569615168, - 101.12190774409382 + 31.11456084047184, + -59.42057702877722, + 111.42567305703156, + 100.27389389986291 ], - "timestamp": 0.4861829001166704 + "timestamp": 0.4854111584605256 }, { - "x": 12.609275137181715, - "y": 5.6362066530252655, - "heading": -2.4596016370427427, - "angularVelocity": -1.490768209280979, - "velocityX": 0.5415888832830659, - "velocityY": 0.8127885050494357, + "x": 12.609526436019335, + "y": 5.636699135016749, + "heading": -2.467431135675984, + "angularVelocity": -1.651944625216517, + "velocityX": 0.541532490962821, + "velocityY": 0.8153109765384976, "moduleForcesX": [ - 112.32207187573187, - 95.02943454284713, - 34.23111294482213, - -52.31611898637682 + 112.47606598208289, + 93.16011868734647, + 33.78704517737306, + -53.65287917781383 ], "moduleForcesY": [ - 26.427771988717435, - -65.28675950904486, - 110.20104060720472, - 102.79243467120517 + 25.753841947921746, + -67.91573899096902, + 110.33638895218567, + 102.09996040314151 ], - "timestamp": 0.5299571789991422 + "timestamp": 0.5296540470294149 }, { - "x": 12.640376756629546, - "y": 5.67868110060817, - "heading": -2.4756065131625133, - "angularVelocity": -0.36562283899049025, - "velocityX": 0.7104998698284803, - "velocityY": 0.9703060488316174, + "x": 12.640768978131616, + "y": 5.679449457084365, + "heading": -2.4883261932610017, + "angularVelocity": -0.4722805915459653, + "velocityX": 0.7061596365624881, + "velocityY": 0.9662642619061936, "moduleForcesX": [ - 110.97907601877183, - 106.0264798075326, - 38.76392005053645, - -36.59336535164529 + 111.543250115618, + 102.57136846109823, + 37.93524392979517, + -40.69497651884954 ], "moduleForcesY": [ - 31.540733116048838, - -45.18048489661897, - 108.67557062608937, - 109.35634824645632 + 29.466868137611527, + -52.52564969838117, + 108.96449307890866, + 107.89412812639198 ], - "timestamp": 0.573731457881614 + "timestamp": 0.5738969355983041 }, { - "x": 12.67988915693076, - "y": 5.729664244872592, - "heading": -2.451631970535245, - "angularVelocity": 0.5476856098906139, - "velocityX": 0.9026396621471977, - "velocityY": 1.164682675899803, + "x": 12.680234323228891, + "y": 5.730326735350004, + "heading": -2.464857721548348, + "angularVelocity": 0.5304461908293124, + "velocityX": 0.8920155616834367, + "velocityY": 1.1499538097838968, "moduleForcesX": [ - 107.73349084432316, - 114.74365869825861, - 42.57429428279717, - -15.73401800942879 + 108.92191896913738, + 112.92169627828845, + 40.83914052431152, + -24.073517173914706 ], "moduleForcesY": [ - 41.23196001279386, - -10.435058862443286, - 107.21934325723095, - 114.20366129024539 + 37.95851016971204, + -22.74755439175256, + 107.88598647473655, + 112.73101496176483 ], - "timestamp": 0.6175057367640857 + "timestamp": 0.6181398241671934 }, { - "x": 12.728715540940653, - "y": 5.790966829650067, - "heading": -2.400757331938542, - "angularVelocity": 1.1622039219262574, - "velocityX": 1.1154126408566907, - "velocityY": 1.4004247778030527, + "x": 12.728861058925617, + "y": 5.791245681753849, + "heading": -2.409256654879776, + "angularVelocity": 1.2567232490256017, + "velocityX": 1.0990859157175115, + "velocityY": 1.3769206390986344, "moduleForcesX": [ - 101.36053530623595, - 110.66151469383205, - 48.45480141271534, - 15.613856789127393 + 103.43030407712452, + 113.54722733635009, + 45.305379884050836, + 3.5622560281788673 ], "moduleForcesY": [ - 55.00994604222918, - 32.04293220940848, - 104.66041275307694, - 114.18177265531891 + 50.97945546219835, + 19.2011880487645, + 106.04826799334413, + 115.16014318689237 ], - "timestamp": 0.6612800156465575 + "timestamp": 0.6623827127360826 }, { "x": 12.787519454956056, "y": 5.863831043243408, "heading": -2.338954063654469, - "angularVelocity": 1.4118626248534205, - "velocityX": 1.3433439799952491, - "velocityY": 1.664544007428914, + "angularVelocity": 1.5890144947439437, + "velocityX": 1.3258265436060839, + "velocityY": 1.6406108153751708, "moduleForcesX": [ - 89.0095262170121, - 91.58391515691522, - 60.88263773717486, - 54.28386759761477 + 91.90028015401259, + 96.27958972310033, + 56.8579037507402, + 46.06087466370149 ], "moduleForcesY": [ - 73.26063193173053, - 69.9179774586011, - 97.89690993994556, - 101.64123727775404 + 69.54780453921919, + 63.17742305853098, + 100.25336076622867, + 105.5573617066181 ], - "timestamp": 0.7050542945290292 + "timestamp": 0.7066256013049719 }, { - "x": 12.915220320349816, - "y": 6.020393862485399, - "heading": -2.2550043978645964, - "angularVelocity": 1.1361394897718229, - "velocityX": 1.7282498350266056, - "velocityY": 2.11885538670354, + "x": 12.914711706648111, + "y": 6.019663725891664, + "heading": -2.24237574365633, + "angularVelocity": 1.2998708875413283, + "velocityX": 1.7119111732169021, + "velocityY": 2.097389636782225, "moduleForcesX": [ - 62.139752976635314, - 64.01795106751091, - 85.86840122939797, - 83.8579203826501 + 61.50166852819614, + 63.359586176485415, + 86.30910394415389, + 83.98957274568104 ], "moduleForcesY": [ - 97.1381071719754, - 95.94171307643394, - 76.96736480457938, - 79.19011036368791 + 97.48422295362255, + 96.32955114118775, + 76.39900626600664, + 78.99253694196852 ], - "timestamp": 0.7789445752081496 + "timestamp": 0.7809239958023007 }, { - "x": 13.071197496085677, - "y": 6.210363644739984, - "heading": -2.1966884800371806, - "angularVelocity": 0.7892231196232886, - "velocityX": 2.1109295336583713, - "velocityY": 2.5709711819820673, + "x": 13.070533718168743, + "y": 6.2093375039790075, + "heading": -2.1683147361300525, + "angularVelocity": 0.9968049515382151, + "velocityX": 2.0972460115034464, + "velocityY": 2.5528650971611744, "moduleForcesX": [ - 58.99376208477216, - 60.82496922096946, - 89.12126008495656, - 85.23274796355747 + 61.44436515676362, + 62.09781410875336, + 87.31016658655857, + 83.73437350844729 ], "moduleForcesY": [ - 98.97383223128598, - 97.91898127763481, - 73.04209646880699, - 77.61460069122454 + 97.27543927473157, + 96.94974979682499, + 74.95382044646945, + 79.02989424707079 ], - "timestamp": 0.85283485588727 + "timestamp": 0.8552223902996294 }, { - "x": 13.254669522546797, - "y": 6.4329309171083375, - "heading": -2.182092105367393, - "angularVelocity": 0.19754119940584156, - "velocityX": 2.4830332863110116, - "velocityY": 3.01213191129812, + "x": 13.250688758689678, + "y": 6.423961245560544, + "heading": -2.168369530757999, + "angularVelocity": -0.000737494104917048, + "velocityX": 2.424750113912751, + "velocityY": 2.8886726696261475, "moduleForcesX": [ - 45.294275725710335, - 52.25945512194472, - 98.3308784358966, - 90.15821094756855 + 18.853251410044052, + 40.74857935885112, + 98.53054513091199, + 92.24301069870756 ], "moduleForcesY": [ - 105.58458947812339, - 102.52257021365493, - 59.49254286882577, - 71.52845266276242 + 93.15672622133015, + 96.3145956066308, + 16.04638677085443, + 51.20564283434744 ], - "timestamp": 0.9267251365663904 + "timestamp": 0.9295207847969582 }, { - "x": 13.426157527489098, - "y": 6.635690019593373, - "heading": -2.2383487439162617, - "angularVelocity": -0.7613536994557007, - "velocityX": 2.3208465763855206, - "velocityY": 2.7440564661751172, + "x": 13.423176073078626, + "y": 6.629426011222936, + "heading": -2.205069527388233, + "angularVelocity": -0.4939541006037903, + "velocityX": 2.3215483397174745, + "velocityY": 2.7653998051031623, "moduleForcesX": [ - -67.52985880281344, - -56.50694068718355, - -16.560789556088512, - 15.921759844219237 + -39.5712782056326, + -27.481431549028095, + -13.336470845500253, + 1.4918968052180324 ], "moduleForcesY": [ - -46.19772680900119, - -13.18456476681599, - -81.95175795997638, - -64.74034721794925 + -22.657178376987773, + -3.7073202434867, + -42.427565932456204, + -25.44947588882923 ], - "timestamp": 1.0006154172455108 + "timestamp": 1.003819179294287 }, { - "x": 13.569140494720084, - "y": 6.804691723426313, - "heading": -2.286189319497097, - "angularVelocity": -0.6474542408167393, - "velocityX": 1.9350713776810868, - "velocityY": 2.2871980222521517, + "x": 13.567172688216592, + "y": 6.8006505476140005, + "heading": -2.2561686473851945, + "angularVelocity": -0.6877553726789927, + "velocityX": 1.9380851512631625, + "velocityY": 2.304552306271156, "moduleForcesX": [ - -69.36641281157236, - -69.8462676272357, - -78.77988767550748, - -78.5597375960959 + -80.49825287187927, + -81.46564305418251, + -66.09113775652278, + -65.10081795177926 ], "moduleForcesY": [ - -91.78872830593477, - -91.46262829883032, - -83.84776974221282, - -84.0961432909433 + -82.1976309213605, + -81.15783169411546, + -94.17140740263714, + -94.78893254492681 ], - "timestamp": 1.0745056979246312 + "timestamp": 1.0781175737916158 }, { - "x": 13.683554684215164, - "y": 6.939904549706659, - "heading": -2.324810505911234, - "angularVelocity": -0.5226829030715882, - "velocityX": 1.5484335482759755, - "velocityY": 1.8299135561215278, + "x": 13.682388889273712, + "y": 6.937545900604296, + "heading": -2.303654079550955, + "angularVelocity": -0.6391178771361977, + "velocityX": 1.5507226210825065, + "velocityY": 1.842507552370002, "moduleForcesX": [ - -68.91646548695905, - -69.76232758546394, - -79.27764146129155, - -79.25899084877969 + -72.01424178451583, + -72.18570029563371, + -75.94750024233308, + -75.98943820596466 ], "moduleForcesY": [ - -92.3862498475593, - -91.77011872190114, - -83.6626902945486, - -83.70370167635772 + -89.99403758231816, + -89.86507715449537, + -86.69993664252142, + -86.67204720164708 ], - "timestamp": 1.1483959786037516 + "timestamp": 1.1524159682889445 }, { - "x": 13.769378113017817, - "y": 7.041319186543625, - "heading": -2.3539370497277994, - "angularVelocity": -0.3941864010918041, - "velocityX": 1.1614982107776157, - "velocityY": 1.3725030667751, + "x": 13.768802126651249, + "y": 7.040166816408869, + "heading": -2.3421837029749835, + "angularVelocity": -0.5185794886242573, + "velocityX": 1.1630565904172108, + "velocityY": 1.3811996409728973, "moduleForcesX": [ - -68.69416422988444, - -69.80382238745496, - -79.38562401155959, - -79.5605145541956 + -68.83655705259301, + -69.78078581158695, + -78.809584162956, + -78.94197823204145 ], "moduleForcesY": [ - -92.63831320439046, - -91.81935170246211, - -83.65606631768833, - -83.50590561929272 + -92.5349745458162, + -91.8382201142605, + -84.2019727811292, + -84.09261841954962 ], - "timestamp": 1.222286259282872 + "timestamp": 1.2267143627862733 }, { - "x": 13.826599505033213, - "y": 7.108931315252294, - "heading": -2.373433389011578, - "angularVelocity": -0.2638552608623059, - "velocityX": 0.7744102673515239, - "velocityY": 0.9150341301623246, + "x": 13.826409668067303, + "y": 7.1085546328421145, + "heading": -2.3692035095547546, + "angularVelocity": -0.36366608945691725, + "velocityX": 0.7753537853112544, + "velocityY": 0.9204481051835359, "moduleForcesX": [ - -68.56304647527125, - -69.84897377197196, - -79.41828548071045, - -79.73113036544858 + -67.15141087474257, + -68.7697448512468, + -80.10733272532873, + -80.36853069934814 ], "moduleForcesY": [ - -92.77867605554368, - -91.82527817186566, - -83.67315905858817, - -83.38745301845488 + -93.80797979702136, + -92.64041961485175, + -83.01627453571552, + -82.77776530877918 ], - "timestamp": 1.2961765399619924 + "timestamp": 1.301012757283602 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -0.1323754049192257, - "velocityX": 0.38723234385763017, - "velocityY": 0.4575300935677065, + "angularVelocity": -0.18857924691523403, + "velocityX": 0.38766037592671854, + "velocityY": 0.46008678483988286, "moduleForcesX": [ - -68.48839210839299, - -69.86757393943373, - -79.44566757381507, - -79.82897176171012 + -66.12682297577675, + -68.20517667619286, + -80.86078377461966, + -81.19705273807568 ], "moduleForcesY": [ - -92.85970357248277, - -91.83521466144767, - -83.67612133165606, - -83.32050872366115 + -94.55836495850359, + -93.08125167677997, + -82.3115890516093, + -81.99291564808973 ], - "timestamp": 1.3700668206411128 + "timestamp": 1.3753111517809309 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -4.38467207280536e-20, - "velocityX": -4.0904408010942157e-19, - "velocityY": 2.6769636069327637e-19, + "angularVelocity": 1.080567090593154e-18, + "velocityX": 3.1368683313884955e-18, + "velocityY": -3.703942145745268e-18, "moduleForcesX": [ - -68.45716377960287, - -69.84827604991912, - -79.49268727695612, - -79.87431218532066 + -65.47502708227233, + -67.78484334953554, + -81.40565230070824, + -81.69905950491292 ], "moduleForcesY": [ - -92.89994179563085, - -91.86589702825168, - -83.65083737459666, - -83.29490255274521 + -95.02748219177589, + -93.40351824166105, + -81.79230598951985, + -81.5109337765353 ], - "timestamp": 1.4439571013202332 + "timestamp": 1.4496095462782597 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.5.traj b/src/main/deploy/choreo/Red Amp 5 Piece.5.traj index e77e19f..3402bb1 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.5.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.5.traj @@ -4,484 +4,484 @@ "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -4.38467207280536e-20, - "velocityX": -4.0904408010942157e-19, - "velocityY": 2.6769636069327637e-19, + "angularVelocity": 1.080567090593154e-18, + "velocityX": 3.1368683313884955e-18, + "velocityY": -3.703942145745268e-18, "moduleForcesX": [ - -68.45716377960287, - -69.84827604991912, - -79.49268727695612, - -79.87431218532066 + -65.47502708227233, + -67.78484334953554, + -81.40565230070824, + -81.69905950491292 ], "moduleForcesY": [ - -92.89994179563085, - -91.86589702825168, - -83.65083737459666, - -83.29490255274521 + -95.02748219177589, + -93.40351824166105, + -81.79230598951985, + -81.5109337765353 ], "timestamp": 0 }, { - "x": 13.861959905913299, - "y": 7.132795995001895, - "heading": -2.342514973243809, - "angularVelocity": 0.896810182021551, - "velocityX": 0.14868426993683032, - "velocityY": -0.21907789247414935, + "x": 13.861807281102129, + "y": 7.133643639193121, + "heading": -2.336022603850437, + "angularVelocity": 1.0267084963209077, + "velocityX": 0.14348211565163527, + "velocityY": -0.19786406226744235, "moduleForcesX": [ - 92.60899812029683, - 36.581383436885694, - 114.99026329766751, - -58.08810301954257 + 93.94614327648092, + 36.13879487108392, + 111.62905057926098, + -64.40510932898498 ], "moduleForcesY": [ - -68.83786410265965, - -109.44730735929382, - 3.712550595135854, - -99.6242520623601 + -67.0032729880947, + -109.595479702191, + 27.752839981561817, + -95.66578127078265 ], - "timestamp": 0.04538270462152827 + "timestamp": 0.04596440095191756 }, { - "x": 13.875819150724183, - "y": 7.112249186067297, - "heading": -2.2656047143722495, - "angularVelocity": 1.6947041722823237, - "velocityX": 0.305386047977193, - "velocityY": -0.4527453598446684, + "x": 13.875608290481761, + "y": 7.114745707898614, + "heading": -2.246841818550783, + "angularVelocity": 1.9402142408631486, + "velocityX": 0.3002543075470427, + "velocityY": -0.41114277360594026, "moduleForcesX": [ - 94.28574172878825, - 40.518324824763326, - 113.84938976113067, - -52.526238566412395 + 95.8672758122096, + 40.82163317785168, + 114.4218987153328, + -57.37863739639605 ], "moduleForcesY": [ - -66.49833461253938, - -108.04061737317623, - -15.264647771952621, - -102.6535173648968 + -64.19626033624898, + -107.9265810590626, + 8.587675737899398, + -100.025272764473 ], - "timestamp": 0.09076540924305654 + "timestamp": 0.09192880190383512 }, { - "x": 13.896716131123098, - "y": 7.0794637940045515, - "heading": -2.160842027100097, - "angularVelocity": 2.308427585923494, - "velocityX": 0.4604613271330157, - "velocityY": -0.7224204096287639, + "x": 13.896548291041885, + "y": 7.083371828358983, + "heading": -2.1286943803030045, + "angularVelocity": 2.570411792625565, + "velocityX": 0.4555699655920011, + "velocityY": -0.6825690945575763, "moduleForcesX": [ - 96.06095182204432, - 45.624218221432486, - 96.82610095310335, - -44.41977169952861 + 97.68723324634834, + 46.630127487620676, + 94.9842558173518, + -47.369366627210084 ], "moduleForcesY": [ - -63.868948710552424, - -105.96943008095943, - -61.2878116865948, - -106.39784959154366 + -61.345098525025094, + -105.52853662580156, + -63.42452839101009, + -105.11852994950135 ], - "timestamp": 0.1361481138645848 + "timestamp": 0.13789320285575268 }, { - "x": 13.923432914333938, - "y": 7.032861637076851, - "heading": -2.033144193714598, - "angularVelocity": 2.813799539944651, - "velocityX": 0.5886996694808474, - "velocityY": -1.026870419388657, + "x": 13.922680903431022, + "y": 7.03765513765653, + "heading": -1.985611009529513, + "angularVelocity": 3.1129171230398116, + "velocityX": 0.5685402582854093, + "velocityY": -0.9946108239347283, "moduleForcesX": [ - 97.08414428392167, - 51.22850417511766, - 45.60897792644892, - -33.41911257960123 + 98.19933570612807, + 52.70680448168723, + 22.355607509561942, + -33.65803533403781 ], "moduleForcesY": [ - -62.239918850679075, - -103.35106272656319, - -105.13082797687291, - -110.32640894319715 + -60.4417252556641, + -102.5971447878816, + -112.31949341574553, + -110.24906301300281 ], - "timestamp": 0.18153081848611308 + "timestamp": 0.18385760380767024 }, { - "x": 13.955563785040498, - "y": 6.972050456195828, - "heading": -1.8825723884399712, - "angularVelocity": 3.317823530579129, - "velocityX": 0.7079981454282456, - "velocityY": -1.3399637899098766, + "x": 13.954174358221836, + "y": 6.977261876671765, + "heading": -1.8186031014993125, + "angularVelocity": 3.6334185711438747, + "velocityX": 0.6851705698015748, + "velocityY": -1.3139138057720028, "moduleForcesX": [ - 95.89341392145519, - 56.462615374362215, - 15.864319365251628, - -18.90693012956116 + 94.58841581785215, + 57.482680844528296, + 7.1519899456507785, + -15.096484175146825 ], "moduleForcesY": [ - -63.953071935174876, - -100.54214801306098, - -113.69206080698899, - -113.67892793538894 + -65.80975762610504, + -99.93840204825545, + -114.6027216210397, + -114.22968117284634 ], - "timestamp": 0.22691352310764135 + "timestamp": 0.2298220047595878 }, { - "x": 13.993619206361197, - "y": 6.896657883852084, - "heading": -1.7125926377755643, - "angularVelocity": 3.7454742303695787, - "velocityX": 0.8385445873723288, - "velocityY": -1.6612622137108406, + "x": 13.991786121737945, + "y": 6.901429215857203, + "heading": -1.6368319977658938, + "angularVelocity": 3.9546061727980697, + "velocityX": 0.8182802938181745, + "velocityY": -1.6498128822322675, "moduleForcesX": [ - 88.01731264292725, - 59.0840763982514, - 15.927056261416332, - 0.36287524026553974 + 75.4236461603671, + 55.684709367906514, + 21.681375782988027, + 11.701403316569385 ], "moduleForcesY": [ - -74.24824099326673, - -98.93287625654578, - -113.78600820918643, - -115.16848981625489 + -86.9055431026712, + -100.8053807575965, + -112.86388870902914, + -114.51447272213056 ], - "timestamp": 0.2722962277291696 + "timestamp": 0.27578640571150537 }, { - "x": 14.037908607813321, - "y": 6.80587456385112, - "heading": -1.5371335721598818, - "angularVelocity": 3.866209981950951, - "velocityX": 0.9759092548907738, - "velocityY": -2.0003946604341567, + "x": 14.03442698872517, + "y": 6.809867684125599, + "heading": -1.4712785182458679, + "angularVelocity": 3.6017760721652428, + "velocityX": 0.927693304038252, + "velocityY": -1.9920096821752111, "moduleForcesX": [ - 55.303727996361445, - 49.44678346076422, - 35.635742871578024, - 31.53872568249567 + 7.4756095549990365, + 5.543216012475767, + 53.51925630688566, + 68.6696974754232 ], "moduleForcesY": [ - -100.77984511033996, - -103.84416234160268, - -109.2529908603062, - -110.57959724006975 + -114.67118987816583, + -114.51283157214998, + -101.73623001018527, + -91.95148315152574 ], - "timestamp": 0.3176789323506979 + "timestamp": 0.32175080666342293 }, { - "x": 14.087144535069578, - "y": 6.700360814437641, - "heading": -1.3841105056888872, - "angularVelocity": 3.3718366445354224, - "velocityX": 1.0849050903172033, - "velocityY": -2.3249771095270226, + "x": 14.0823789754651, + "y": 6.7033924335418655, + "heading": -1.3298228673892658, + "angularVelocity": 3.0775045018986713, + "velocityX": 1.0432418512337802, + "velocityY": -2.316472060521708, "moduleForcesX": [ - 3.0133443991748976, - -9.704067691995961, - 61.74194260289858, - 81.36746218585068 + 4.9681137901011345, + -11.029616583463108, + 64.88816529721264, + 83.96314322378822 ], "moduleForcesY": [ - -114.78558445562432, - -113.97825197610892, - -96.85819727429798, - -80.62385237514702 + -114.67679488503701, + -113.78423953190108, + -94.72104394783508, + -77.77423908356108 ], - "timestamp": 0.36306163697222615 + "timestamp": 0.3677152076153405 }, { - "x": 14.14226859299682, - "y": 6.580743460775094, - "heading": -1.2557023174275241, - "angularVelocity": 2.829452086036561, - "velocityX": 1.2146490251507223, - "velocityY": -2.6357475752074477, + "x": 14.13685205858906, + "y": 6.582925065175055, + "heading": -1.2157167466379832, + "angularVelocity": 2.4824890216810713, + "velocityX": 1.1851146103469143, + "velocityY": -2.620884116227876, "moduleForcesX": [ - 10.480286821125896, - -8.238341876639112, - 70.90518481088853, - 89.23977661435688 + 13.212936622716347, + -8.67539830647213, + 75.84281222650095, + 94.93975692280823 ], "moduleForcesY": [ - -114.10634114609925, - -113.67173817318366, - -90.05586637958596, - -71.12492607944955 + -113.75794165587317, + -113.47578028497102, + -85.85966695629838, + -63.08562287252783 ], - "timestamp": 0.4084443415937544 + "timestamp": 0.41367960856725805 }, { - "x": 14.204835516401594, - "y": 6.448466508306411, - "heading": -1.1561784745953227, - "angularVelocity": 2.192990560218639, - "velocityX": 1.378651270931431, - "velocityY": -2.9146996322016308, + "x": 14.199614035606237, + "y": 6.450362835829553, + "heading": -1.1340552186650188, + "angularVelocity": 1.7766255250098648, + "velocityX": 1.3654475141061873, + "velocityY": -2.884019515106307, "moduleForcesX": [ - 20.960314391027584, - -2.842849356642393, - 84.21445543262153, - 102.93252880524909 + 25.146700133293496, + -1.1305249249662828, + 90.22993499768113, + 108.60135018234804 ], "moduleForcesY": [ - -112.09268001844573, - -112.76901447740485, - -77.01708814164486, - -47.25631657837888 + -111.12312763663773, + -112.36380391179502, + -69.79003312905782, + -31.894172457931834 ], - "timestamp": 0.4538270462152827 + "timestamp": 0.4596440095191756 }, { - "x": 14.278425287943143, - "y": 6.308166137099232, - "heading": -1.0878965211530789, - "angularVelocity": 1.50458096342397, - "velocityX": 1.6215378117116461, - "velocityY": -3.0914942680746504, + "x": 14.273205196850464, + "y": 6.3096531054550145, + "heading": -1.0871135355468409, + "angularVelocity": 1.0212617187654176, + "velocityX": 1.6010468910757547, + "velocityY": -3.061276280348623, "moduleForcesX": [ - 48.859656151615134, - 39.29215925118305, - 105.39970908610701, - 110.44414210433047 + 46.32646503626852, + 29.27418934062715, + 105.8355999225502, + 109.70707968043254 ], "moduleForcesY": [ - -100.5358220207968, - -96.55667751732808, - -39.89417637595948, - 15.711330603946356 + -101.6881811618927, + -98.80485347520826, + -38.70930863434508, + 20.15623938551683 ], - "timestamp": 0.49920975083681096 + "timestamp": 0.5056084104710932 }, { - "x": 14.356885484045446, - "y": 6.180875846162496, - "heading": -0.9964367241653384, - "angularVelocity": 2.015300713134569, - "velocityX": 1.7288567694813934, - "velocityY": -2.804819412996273, + "x": 14.352346828521247, + "y": 6.181353766919092, + "heading": -1.0166113057323838, + "angularVelocity": 1.5338442001715178, + "velocityX": 1.7218027436835717, + "velocityY": -2.7912762024274724, "moduleForcesX": [ - 40.76242627736614, - 85.26282068126751, - -33.51474181780654, - 41.80940406660451 + 43.849222398638176, + 84.51752285087134, + -24.29503991613957, + 45.15305908679976 ], "moduleForcesY": [ - 103.28724328208311, - 69.6297540554303, - 102.88363740482494, - 83.00028269478578 + 98.75569700086677, + 64.96243676079469, + 100.34497692617356, + 69.59109447988128 ], - "timestamp": 0.5445924554583392 + "timestamp": 0.5515728114230107 }, { - "x": 14.428558340071614, - "y": 6.066616737623039, - "heading": -0.8768712055992656, - "angularVelocity": 2.6346053978756356, - "velocityX": 1.5792989118627854, - "velocityY": -2.5176795762246367, + "x": 14.426005725789185, + "y": 6.066518080054045, + "heading": -0.9142430526433137, + "angularVelocity": 2.2271203576906267, + "velocityX": 1.602520553786623, + "velocityY": -2.4983614381306767, "moduleForcesX": [ - -23.024650236953327, - 15.495478785366409, - -85.25414758160815, - -94.40260108810803 + -10.689838775743358, + 35.21196936002609, + -80.76361369266837, + -91.16219383556731 ], "moduleForcesY": [ - 111.58942984648242, - 112.01377982791273, - 75.3161473098706, - 60.46352938099102 + 113.07820027057511, + 106.90487109121052, + 79.40920313766219, + 62.57889090102301 ], - "timestamp": 0.5899751600798675 + "timestamp": 0.5975372123749283 }, { - "x": 14.49142295848577, - "y": 5.9648432002123934, - "heading": -0.7330923745075492, - "angularVelocity": 3.168141526397992, - "velocityX": 1.385210928665889, - "velocityY": -2.24256218882046, + "x": 14.491141108334089, + "y": 5.9645168700924796, + "heading": -0.7848130827682546, + "angularVelocity": 2.815874180769878, + "velocityX": 1.4170832469467167, + "velocityY": -2.2191349794434485, "moduleForcesX": [ - -41.53032424596707, - -9.897010287228593, - -93.16938210809725, - -98.32290187749236 + -36.159456633281756, + -1.6252737093363274, + -91.97875020999615, + -99.39177635875521 ], "moduleForcesY": [ - 106.82441101026959, - 113.74543897439574, - 66.58606054965573, - 57.179734029046564 + 108.60701730025053, + 113.90438381959041, + 67.96114697240343, + 54.58321208531797 ], - "timestamp": 0.6353578647013958 + "timestamp": 0.6435016133268459 }, { - "x": 14.544623158669278, - "y": 5.87572493089785, - "heading": -0.5718154821303135, - "angularVelocity": 3.553708262260154, - "velocityX": 1.1722571545079534, - "velocityY": -1.9637055582683072, + "x": 14.546449970003842, + "y": 5.874850586766935, + "heading": -0.631250104240621, + "angularVelocity": 3.340911125726901, + "velocityX": 1.2032977809850718, + "velocityY": -1.9507767199956136, "moduleForcesX": [ - -53.44415602897267, - -28.980375064219814, - -93.28776986457336, - -90.81965392427354 + -49.09953189561874, + -17.172798234951614, + -97.41391226966714, + -100.50042106685149 ], "moduleForcesY": [ - 101.68618809242784, - 110.93166649748392, - 66.88592374391406, - 69.51188559031735 + 103.78581109073833, + 113.20215773897431, + 60.60212605680512, + 54.03522331953084 ], - "timestamp": 0.680740569322924 + "timestamp": 0.6894660142787634 }, { - "x": 14.588733197240783, - "y": 5.800221418575717, - "heading": -0.42158738976113214, - "angularVelocity": 3.3102498765117416, - "velocityX": 0.9719570250245041, - "velocityY": -1.6637067568317254, + "x": 14.591598722413101, + "y": 5.798850919958515, + "heading": -0.4725640797467414, + "angularVelocity": 3.4523679457908694, + "velocityX": 0.9822547770499443, + "velocityY": -1.6534462591587367, "moduleForcesX": [ - -74.00444289574996, - -84.82750480070263, - -36.15663713104418, - -55.70612713734391 + -64.14132388710318, + -57.74716179082214, + -77.86191188988668, + -73.40481169623028 ], "moduleForcesY": [ - 87.85806255534847, - 77.70219291275825, - 109.19057307139701, - 100.72627828960452 + 95.36643063243639, + 99.2968998274088, + 84.48333541278747, + 88.28122283949911 ], - "timestamp": 0.7261232739444523 + "timestamp": 0.735430415230681 }, { - "x": 14.623971165481974, - "y": 5.737622434633646, - "heading": -0.2905912513710962, - "angularVelocity": 2.886477116833101, - "velocityX": 0.7764624989863818, - "velocityY": -1.3793577192923712, + "x": 14.627266293632685, + "y": 5.736313352300135, + "heading": -0.32976115295452907, + "angularVelocity": 3.106815792978476, + "velocityX": 0.7759825099623375, + "velocityY": -1.3605652714543037, "moduleForcesX": [ - -80.0246768887267, - -100.14721091439696, - -10.744716582138851, - -53.763436622298244 + -79.08825052742094, + -94.49368741243654, + -24.954444481983515, + -56.365800767000515 ], "moduleForcesY": [ - 82.35913095559447, - 56.88672408353364, - 114.69341623133508, - 101.95066373478761 + 83.32375870202404, + 65.75374939597963, + 112.38552797168428, + 100.46638970550259 ], - "timestamp": 0.7715059785659806 + "timestamp": 0.7813948161825985 }, { - "x": 14.650491204975971, - "y": 5.687579858551526, - "heading": -0.18109509490551892, - "angularVelocity": 2.4127287560035904, - "velocityX": 0.5843644559125126, - "velocityY": -1.1026794568427392, + "x": 14.65364085378242, + "y": 5.686523155503303, + "heading": -0.2086770773830198, + "angularVelocity": 2.6343011779523207, + "velocityX": 0.5738040658318332, + "velocityY": -1.0832338889593371, "moduleForcesX": [ - -74.48364034846936, - -106.88461675230056, - -2.774309758119724, - -56.286451842231365 + -80.75753449731462, + -105.75146527274016, + -6.533917978603814, + -56.800299326668465 ], "moduleForcesY": [ - 87.30364939891406, - 43.08617697815872, - 115.24782035664737, - 100.65158178859285 + 81.56714001969844, + 45.74125215422081, + 115.06672888896286, + 100.33878741771153 ], - "timestamp": 0.8168886831875088 + "timestamp": 0.8273592171345161 }, { - "x": 14.668829934744329, - "y": 5.65013543062385, - "heading": -0.09419471226356198, - "angularVelocity": 1.91483481133768, - "velocityX": 0.40409071960989107, - "velocityY": -0.8250814542664746, + "x": 14.671133184520741, + "y": 5.6493303593283635, + "heading": -0.1109888357303956, + "angularVelocity": 2.1253021823304925, + "velocityX": 0.38056257399327703, + "velocityY": -0.8091652540810123, "moduleForcesX": [ - -55.32796842006375, - -110.53141862820286, - -0.4423126125758408, - -59.32807159173019 + -67.41351148580846, + -110.75420648171135, + -0.987299919919722, + -59.64430713959497 ], "moduleForcesY": [ - 100.43619981044367, - 32.748204469854116, - 115.32725877892798, - 98.9287079347535 + 92.68928093179672, + 31.95250489621746, + 115.31159659481133, + 98.72856624844064 ], - "timestamp": 0.8622713878090371 + "timestamp": 0.8733236180864337 }, { - "x": 14.680031947562197, - "y": 5.625376428463603, - "heading": -0.032466736730672914, - "angularVelocity": 1.3601652005466338, - "velocityX": 0.24683440335448031, - "velocityY": -0.5455603046739033, + "x": 14.681023126809134, + "y": 5.624953566198197, + "heading": -0.03923900366198559, + "angularVelocity": 1.5609869939013463, + "velocityX": 0.21516526014856754, + "velocityY": -0.5303407120581256, "moduleForcesX": [ - -22.69780248396784, - -112.62711740856216, - 0.30424038499491796, - -61.80059569568245 + -29.537208536645696, + -113.2612737604008, + 0.7703487270790108, + -62.362582583263325 ], "moduleForcesY": [ - 112.34568644194837, - 24.716987102766776, - 115.35632305606234, - 97.42837626864956 + 110.53903877031718, + 21.605385460346547, + 115.34906975588962, + 97.06559527810772 ], - "timestamp": 0.9076540924305654 + "timestamp": 0.9192880190383512 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -8.02923683034453e-19, - "angularVelocity": 0.7153988948307836, - "velocityX": 0.11473292914177731, - "velocityY": -0.2699509497396526, + "heading": 6.643546626004709e-18, + "angularVelocity": 0.85368247707683, + "velocityX": 0.09171687870089658, + "velocityY": -0.2573348440090306, "moduleForcesX": [ - 10.465866206746178, - -113.77295041301616, - 1.1484884755134444, - -63.178995978692946 + 23.85828752678224, + -114.45714666054057, + 2.026107569486801, + -63.97932141399083 ], "moduleForcesY": [ - 114.14538106924414, - 18.8786582623545, - 115.36971326990154, - 96.55763623804961 + 111.84032387601461, + 14.144281910460025, + 115.35597645325024, + 96.02804598950458 ], - "timestamp": 0.9530367970520937 + "timestamp": 0.9652524199902688 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -3.9015796834549723e-19, - "angularVelocity": 6.131754693956049e-20, - "velocityX": 1.318646419686023e-19, - "velocityY": -2.1826006617042474e-19, + "heading": 3.475412312586324e-18, + "angularVelocity": -5.811723191789812e-19, + "velocityX": -9.954722773585959e-19, + "velocityY": 3.489115231904606e-18, "moduleForcesX": [ - 30.956584752298998, - -114.29048140187894, - 2.8833647328699366, - -63.148669433067454 + 61.21552776416918, + -114.90954967400437, + 4.2529323110693955, + -63.89858977846906 ], "moduleForcesY": [ - 110.35051173008722, - 15.57664785043353, - 115.35208140460223, - 96.59011418775707 + 96.54516819539677, + 10.052179512840738, + 115.30969681756606, + 96.0960223654071 ], - "timestamp": 0.9984195016736219 + "timestamp": 1.0112168209421863 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.6.traj b/src/main/deploy/choreo/Red Amp 5 Piece.6.traj index 598d46b..efb72d6 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.6.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.6.traj @@ -3,296 +3,296 @@ { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -3.9015796834549723e-19, - "angularVelocity": 6.131754693956049e-20, - "velocityX": 1.318646419686023e-19, - "velocityY": -2.1826006617042474e-19, + "heading": 3.475412312586324e-18, + "angularVelocity": -5.811723191789812e-19, + "velocityX": -9.954722773585959e-19, + "velocityY": 3.489115231904606e-18, "moduleForcesX": [ - 30.956584752298998, - -114.29048140187894, - 2.8833647328699366, - -63.148669433067454 + 61.21552776416918, + -114.90954967400437, + 4.2529323110693955, + -63.89858977846906 ], "moduleForcesY": [ - 110.35051173008722, - 15.57664785043353, - 115.35208140460223, - 96.59011418775707 + 96.54516819539677, + 10.052179512840738, + 115.30969681756606, + 96.0960223654071 ], "timestamp": 0 }, { - "x": 14.65591627172833, - "y": 5.612955136335095, - "heading": -8.489678129046805e-19, - "angularVelocity": -7.637362615315964e-18, - "velocityX": -0.4881043332518622, - "velocityY": -0.0028329531955231684, + "x": 14.655916256843003, + "y": 5.612955128559063, + "heading": 3.1230036756654924e-18, + "angularVelocity": -5.866203252382288e-18, + "velocityX": -0.48810444502271244, + "velocityY": -0.0028330818461293926, "moduleForcesX": [ - -115.37658317775369, - -115.37658317775369, - -115.37658317775369, - -115.37658317775369 + -115.37657744801193, + -115.37657744801193, + -115.37657744801193, + -115.37657744801193 ], "moduleForcesY": [ - -0.6696446594201887, - -0.6696446594201887, - -0.6696446594201901, - -0.6696446594201901 + -0.6696748828445834, + -0.6696748828445834, + -0.6696748828445817, + -0.6696748828445817 ], - "timestamp": 0.06007438260610698 + "timestamp": 0.060074399345888096 }, { - "x": 14.597275655749772, - "y": 5.612614333848124, - "heading": -1.5130034106942078e-18, - "angularVelocity": -1.1053556745448901e-17, - "velocityX": -0.9761334771103636, - "velocityY": -0.005673008563491044, + "x": 14.597275612129625, + "y": 5.6126143107496995, + "heading": 2.4415453659675053e-18, + "angularVelocity": -1.1343572587073241e-17, + "velocityX": -0.9761336834305275, + "velocityY": -0.00567326203964737, "moduleForcesX": [ - -115.35881014296135, - -115.35881014296135, - -115.35881014296135, - -115.35881014296135 + -115.35880034739998, + -115.35880034739998, + -115.35880034739998, + -115.35880034739998 ], "moduleForcesY": [ - -0.6713234488387343, - -0.6713234488387343, - -0.6713234488387362, - -0.6713234488387362 + -0.6713527676407227, + -0.6713527676407227, + -0.6713527676407209, + -0.6713527676407209 ], - "timestamp": 0.12014876521221396 + "timestamp": 0.12014879869177619 }, { - "x": 14.509323753069854, - "y": 5.6121022780031975, - "heading": -2.1599359012185637e-18, - "angularVelocity": -1.0768857901728596e-17, - "velocityX": -1.4640500470324869, - "velocityY": -0.008523697168628809, + "x": 14.509323668724555, + "y": 5.612102232338162, + "heading": 1.3270385910322786e-18, + "angularVelocity": -1.8552108501746105e-17, + "velocityX": -1.4640503169856367, + "velocityY": -0.008524070437876919, "moduleForcesX": [ - -115.33220026624166, - -115.33220026624166, - -115.33220026624166, - -115.33220026624166 + -115.33218317019183, + -115.33218317019183, + -115.33218317019183, + -115.33218317019183 ], "moduleForcesY": [ - -0.6738369003473637, - -0.6738369003473637, - -0.6738369003473659, - -0.6738369003473659 + -0.6738650288924735, + -0.6738650288924735, + -0.6738650288924716, + -0.6738650288924716 ], - "timestamp": 0.18022314781832094 + "timestamp": 0.1802231980376643 }, { - "x": 14.392071800967997, - "y": 5.611417907491215, - "heading": -2.4955664249849538e-18, - "angularVelocity": -5.586915894948488e-18, - "velocityX": -1.9517795608595285, - "velocityY": -0.01139205235732751, + "x": 14.392071667687404, + "y": 5.611417832423418, + "heading": -7.763414819258763e-20, + "angularVelocity": -2.338221862268053e-17, + "velocityX": -1.9517798315727315, + "velocityY": -0.011392538622051734, "moduleForcesX": [ - -115.28798452865676, - -115.28798452865676, - -115.28798452865676, - -115.28798452865676 + -115.28795258322376, + -115.28795258322376, + -115.28795258322376, + -115.28795258322376 ], "moduleForcesY": [ - -0.6780128723861801, - -0.6780128723861801, - -0.678012872386183, - -0.678012872386183 + -0.6780393929688643, + -0.6780393929688643, + -0.6780393929688625, + -0.6780393929688625 ], - "timestamp": 0.24029753042442792 + "timestamp": 0.24029759738355239 }, { - "x": 14.245542144768796, - "y": 5.610559112618229, - "heading": -2.17152151744822e-18, - "angularVelocity": 5.394061398292092e-18, - "velocityX": -2.4391371137337936, - "velocityY": -0.01429552557564081, + "x": 14.24554196375991, + "y": 5.6105590018551865, + "heading": -1.80725653301977e-18, + "angularVelocity": -2.879133879933629e-17, + "velocityX": -2.439137228552605, + "velocityY": -0.01429611577615215, "moduleForcesX": [ - -115.20006155628543, - -115.20006155628543, - -115.20006155628543, - -115.20006155628543 + -115.19999260587228, + -115.19999260587228, + -115.19999260587228, + -115.19999260587228 ], "moduleForcesY": [ - -0.6863139629294118, - -0.6863139629294118, - -0.6863139629294153, - -0.6863139629294154 + -0.6863383396984974, + -0.6863383396984974, + -0.6863383396984957, + -0.6863383396984957 ], - "timestamp": 0.3003719130305349 + "timestamp": 0.3003719967294405 }, { - "x": 14.06980078538855, - "y": 5.609519669852626, - "heading": -5.349757299589133e-19, - "angularVelocity": 2.724199096518095e-17, - "velocityX": -2.925396013347973, - "velocityY": -0.01730259589046419, + "x": 14.069800593542725, + "y": 5.609519517509087, + "heading": -3.822402694201517e-18, + "angularVelocity": -3.3544174940246164e-17, + "velocityX": -2.9253953785759013, + "velocityY": -0.01730328321909612, "moduleForcesX": [ - -114.94036531798051, - -114.94036531798051, - -114.94036531798051, - -114.94036531798051 + -114.94015610384217, + -114.94015610384217, + -114.94015610384217, + -114.94015610384217 ], "moduleForcesY": [ - -0.710801922179511, - -0.710801922179511, - -0.7108019221795149, - -0.710801922179515 + -0.7108246829504308, + -0.7108246829504308, + -0.7108246829504284, + -0.7108246829504284 ], - "timestamp": 0.3604462956366419 + "timestamp": 0.3604463960753286 }, { "x": 13.870342254638672, "y": 5.6078338623046875, - "heading": 3.933743569942127e-27, - "angularVelocity": 8.905222349190746e-18, - "velocityX": -3.320192769315282, - "velocityY": -0.028062003716167162, + "heading": 3.9144943965939805e-27, + "angularVelocity": 6.362781384131591e-17, + "velocityX": -3.3201886506702927, + "velocityY": -0.02805945998218547, "moduleForcesX": [ - -93.3208284583402, - -93.3208284583402, - -93.3208284583402, - -93.3208284583402 + -93.31997894760639, + -93.31997894760642, + -93.31997894760639, + -93.31997894760642 ], "moduleForcesY": [ - -2.5432753355726474, - -2.54327533557265, - -2.5432753355726443, - -2.5432753355726456 + -2.5425108785750434, + -2.5425108785750297, + -2.5425108785750763, + -2.5425108785750616 ], - "timestamp": 0.42052067824274886 + "timestamp": 0.4205207954212167 }, { - "x": 13.68164926660538, - "y": 5.606118094653867, - "heading": 3.562246310579434e-18, - "angularVelocity": 5.2260754068954895e-17, - "velocityX": -2.768263899294385, - "velocityY": -0.025171564120364344, + "x": 13.681649301516726, + "y": 5.60611809958223, + "heading": 4.016781723731204e-18, + "angularVelocity": 5.892911448413981e-17, + "velocityX": -2.7682631078990867, + "velocityY": -0.025171489278773905, "moduleForcesX": [ - 114.98181646144474, - 114.98181646144474, - 114.98181646144474, - 114.98181646144474 + 114.98111170716051, + 114.98111170716051, + 114.98111170716051, + 114.98111170716051 ], "moduleForcesY": [ - 0.6021572944443165, - 0.6021572944443164, - 0.6021572944443149, - 0.6021572944443149 + 0.6016428962296182, + 0.6016428962296182, + 0.6016428962296176, + 0.6016428962296176 ], - "timestamp": 0.4886836117265787 + "timestamp": 0.4886837357802891 }, { - "x": 13.530664057996011, - "y": 5.6047070494208535, - "heading": 6.970402547713967e-18, - "angularVelocity": 5.0000140247988346e-17, - "velocityX": -2.21506324467662, - "velocityY": -0.020701063773144956, + "x": 13.53066408912991, + "y": 5.604707049037762, + "heading": 5.1354715756209854e-18, + "angularVelocity": 1.6411995171794605e-17, + "velocityX": -2.215063076672593, + "velocityY": -0.020701139608051117, "moduleForcesX": [ - 115.24676383245284, - 115.24676383245284, - 115.24676383245284, - 115.24676383245284 + 115.24662233874156, + 115.24662233874156, + 115.24662233874156, + 115.24662233874156 ], "moduleForcesY": [ - 0.9313269849343858, - 0.9313269849343858, - 0.9313269849343856, - 0.9313269849343855 + 0.931295500981224, + 0.931295500981224, + 0.9312955009812263, + 0.9312955009812263 ], - "timestamp": 0.5568465452104086 + "timestamp": 0.5568466761393616 }, { - "x": 13.417411634272256, - "y": 5.603631896857166, - "heading": 8.236144995060866e-18, - "angularVelocity": 1.856936577441259e-17, - "velocityX": -1.6614957416793323, - "velocityY": -0.015773273078727883, + "x": 13.4174116528594, + "y": 5.603631894326559, + "heading": 1.818783720138006e-18, + "angularVelocity": -4.865822750357439e-17, + "velocityX": -1.6614957581629166, + "velocityY": -0.015773302993372113, "moduleForcesX": [ - 115.32318834172317, - 115.32318834172317, - 115.32318834172317, - 115.32318834172317 + 115.32313827588082, + 115.32313827588082, + 115.32313827588082, + 115.32313827588082 ], "moduleForcesY": [ - 1.0265930194309745, - 1.0265930194309745, - 1.0265930194309765, - 1.0265930194309765 + 1.0266024823241802, + 1.0266024823241802, + 1.0266024823241848, + 1.026602482324185 ], - "timestamp": 0.6250094786942384 + "timestamp": 0.625009616498434 }, { - "x": 13.341903875147041, - "y": 5.602907459655186, - "heading": 6.178007203351896e-18, - "angularVelocity": -3.0194384099180574e-17, - "velocityX": -1.1077539546200272, - "velocityY": -0.010628022665019901, + "x": 13.341903882006394, + "y": 5.602907458005536, + "heading": 3.991433737025843e-18, + "angularVelocity": 3.187435872955762e-17, + "velocityX": -1.107754014941875, + "velocityY": -0.01062800866874692, "moduleForcesX": [ - 115.35949645880048, - 115.35949645880048, - 115.35949645880048, - 115.35949645880048 + 115.35947569038294, + 115.35947569038294, + 115.35947569038294, + 115.35947569038294 ], "moduleForcesY": [ - 1.0718958018897309, - 1.0718958018897309, - 1.0718958018897344, - 1.0718958018897344 + 1.0719048416122896, + 1.0719048416122896, + 1.071904841612296, + 1.071904841612296 ], - "timestamp": 0.6931724121780682 + "timestamp": 0.6931725568575065 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0496509621177646e-24, - "angularVelocity": -9.063586088757749e-17, - "velocityX": -0.5539103568522852, - "velocityY": -0.0053556863887746315, + "heading": -7.63547360856752e-25, + "angularVelocity": -5.855725242145153e-17, + "velocityX": -0.5539104016139283, + "velocityY": -0.005355661647003148, "moduleForcesX": [ - 115.38070640237679, - 115.38070640237679, - 115.38070640237679, - 115.38070640237679 + 115.38069800613746, + 115.38069800613746, + 115.38069800613746, + 115.38069800613746 ], "moduleForcesY": [ - 1.0983712484822477, - 1.0983712484822479, - 1.0983712484822528, - 1.0983712484822528 + 1.0983733762750212, + 1.0983733762750214, + 1.0983733762750287, + 1.098373376275029 ], - "timestamp": 0.7613353456618981 + "timestamp": 0.7613354972165789 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0735721824105399e-24, - "angularVelocity": 3.03574595814805e-25, - "velocityX": -1.1997143110381767e-25, - "velocityY": 2.1379415454439605e-25, + "heading": -7.751526493297866e-25, + "angularVelocity": -2.26319747894764e-25, + "velocityX": 1.0079660491439562e-23, + "velocityY": 1.0284960672568687e-23, "moduleForcesX": [ - 115.39461413799822, - 115.39461413799822, - 115.39461413799822, - 115.39461413799822 + 115.39461182381044, + 115.39461182381044, + 115.39461182381044, + 115.39461182381044 ], "moduleForcesY": [ - 1.1157353471214961, - 1.1157353471214961, - 1.1157353471215021, - 1.1157353471215021 + 1.1157300801986871, + 1.1157300801986874, + 1.115730080198696, + 1.115730080198696 ], - "timestamp": 0.8294982791457279 + "timestamp": 0.8294984375756513 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.7.traj b/src/main/deploy/choreo/Red Amp 5 Piece.7.traj index 9c15eab..45b5c83 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.7.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.7.traj @@ -3,296 +3,296 @@ { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0735721824105399e-24, - "angularVelocity": 3.03574595814805e-25, - "velocityX": -1.1997143110381767e-25, - "velocityY": 2.1379415454439605e-25, + "heading": -7.751526493297866e-25, + "angularVelocity": -2.26319747894764e-25, + "velocityX": 1.0079660491439562e-23, + "velocityY": 1.0284960672568687e-23, "moduleForcesX": [ - 115.39461413799822, - 115.39461413799822, - 115.39461413799822, - 115.39461413799822 + 115.39461182381044, + 115.39461182381044, + 115.39461182381044, + 115.39461182381044 ], "moduleForcesY": [ - 1.1157353471214961, - 1.1157353471214961, - 1.1157353471215021, - 1.1157353471215021 + 1.1157300801986871, + 1.1157300801986874, + 1.115730080198696, + 1.115730080198696 ], "timestamp": 0 }, { - "x": 13.333301383153968, - "y": 5.573801506681172, - "heading": 0.01582323396916395, - "angularVelocity": 0.22214471367149297, - "velocityX": 0.4092925688636579, - "velocityY": -0.4034976421009908, + "x": 13.333295993090786, + "y": 5.573943438615316, + "heading": 0.020437528196768823, + "angularVelocity": 0.286600169331202, + "velocityX": 0.40875294832828113, + "velocityY": -0.40104983341622946, "moduleForcesX": [ - 83.99858675745838, - 94.50501486045636, - 67.60907694190239, - 80.27135887466491 + 84.66730708312953, + 97.79823624610925, + 63.20469705289822, + 79.91393576166892 ], "moduleForcesY": [ - -79.10404420877467, - -66.22016115527022, - -93.52088748741942, - -82.91786973993533 + -78.37881724715754, + -61.25124940458053, + -96.55297564085095, + -83.2653681457005 ], - "timestamp": 0.07122939685417506 + "timestamp": 0.07131024466754798 }, { - "x": 13.391608661329746, - "y": 5.516308685460145, - "heading": 0.04698081873325925, - "angularVelocity": 0.43742592440987155, - "velocityX": 0.8185844714528077, - "velocityY": -0.8071501902329565, + "x": 13.391605195610097, + "y": 5.516669588157704, + "heading": 0.05964137481241568, + "angularVelocity": 0.5497645786859513, + "velocityX": 0.8176833888475714, + "velocityY": -0.8031644082084757, "moduleForcesX": [ - 83.45340079540242, - 94.33138257713637, - 67.95070369572379, - 80.6480190559037 + 83.61176177048723, + 96.91343804537236, + 64.64704831280237, + 80.55330595264391 ], "moduleForcesY": [ - -79.65440454308327, - -66.4413647938875, - -93.25638851459766, - -82.53433216167754 + -79.47867664464073, + -62.612531761585, + -95.5764752904338, + -82.62882568534256 ], - "timestamp": 0.14245879370835013 + "timestamp": 0.14262048933509686 }, { - "x": 13.479069343718304, - "y": 5.430043615996792, - "heading": 0.09266849307007893, - "angularVelocity": 0.6414159933201998, - "velocityX": 1.227873409732959, - "velocityY": -1.2110880236703392, + "x": 13.479092151862174, + "y": 5.430610082205895, + "heading": 0.11503401938207429, + "angularVelocity": 0.7767838243705603, + "velocityX": 1.226849755739081, + "velocityY": -1.2068322911107945, "moduleForcesX": [ - 82.66507902834793, - 93.96622463847794, - 68.56375935722866, - 81.18607925768542 + 82.31821309565615, + 95.32187408048657, + 66.92262060727154, + 81.35076884094306 ], "moduleForcesY": [ - -80.43604135450076, - -66.91762608001522, - -92.78161616974033, - -81.97870276950549 + -80.78194903679575, + -64.9663793495728, + -93.97078846223012, + -81.81464976514656 ], - "timestamp": 0.2136881905625252 + "timestamp": 0.21393073400264573 }, { - "x": 13.595681225064894, - "y": 5.314972807576324, - "heading": 0.15163714964482242, - "angularVelocity": 0.827869660267757, - "velocityX": 1.6371313881166667, - "velocityY": -1.6154960381883665, + "x": 13.595776572869067, + "y": 5.3156098843885005, + "heading": 0.18248020319766606, + "angularVelocity": 0.9458133838977687, + "velocityX": 1.6362925348367765, + "velocityY": -1.6126742847893822, "moduleForcesX": [ - 81.69939794150892, - 93.23102514178395, - 69.5958264531128, - 81.83020425409691 + 81.1896130380787, + 92.24877909794785, + 70.6324201788653, + 82.06283505268615 ], "moduleForcesY": [ - -81.35800277160789, - -67.87302901661616, - -91.96759965124197, - -81.29029357501486 + -81.8607204454983, + -69.19153030778288, + -91.1668535849204, + -81.04640774388072 ], - "timestamp": 0.28491758741670026 + "timestamp": 0.2852409786701946 }, { - "x": 13.741436224010505, - "y": 5.171041089911012, - "heading": 0.2217535698888416, - "angularVelocity": 0.9843747573430274, - "velocityX": 2.0462759111102518, - "velocityY": -2.020678596506685, + "x": 13.74166340562453, + "y": 5.1714841013846, + "heading": 0.2539935851566899, + "angularVelocity": 1.0028486410672468, + "velocityX": 2.0458046867682906, + "velocityY": -2.021109080130372, "moduleForcesX": [ - 80.7428208802436, - 91.63008521058406, - 71.45739720683228, - 82.43567724433055 + 81.09664380826153, + 85.27750689601766, + 77.82613865257939, + 81.9886155863237 ], "moduleForcesY": [ - -82.19417166226108, - -69.89172174791939, - -90.44018204803689, - -80.58049754682136 + -81.85175642641818, + -77.49783429262001, + -84.99010839197298, + -80.99105848577611 ], - "timestamp": 0.3561469842708753 + "timestamp": 0.3565512233377435 }, { - "x": 13.916293939822738, - "y": 4.998155595405218, - "heading": 0.2975701335207255, - "angularVelocity": 1.0643999104344446, - "velocityX": 2.4548532422675313, - "velocityY": -2.4271649366866526, + "x": 13.916324671873264, + "y": 4.998926787820056, + "heading": 0.3028208316702331, + "angularVelocity": 0.6847157339198316, + "velocityX": 2.4493152009646426, + "velocityY": -2.419810987453681, "moduleForcesX": [ - 80.52618577124296, - 86.7098035480735, - 76.2536897185494, - 82.32400313465453 + 84.03168175068858, + 60.98601461651429, + 100.69711811876594, + 75.69360315918162 ], "moduleForcesY": [ - -82.08532933524775, - -75.55570587121076, - -86.13264049441516, - -80.37257801256403 + -78.57987315738377, + -97.49882069315494, + -55.29287195277618, + -86.20664997158069 ], - "timestamp": 0.4273763811250504 + "timestamp": 0.42786146800529234 }, { - "x": 14.09087619721131, - "y": 4.825248874693559, - "heading": 0.373019602814959, - "angularVelocity": 1.0592462189269634, - "velocityX": 2.4509860408615456, - "velocityY": -2.4274629345190584, + "x": 14.090871166457541, + "y": 4.825643663887782, + "heading": 0.3511151918655964, + "angularVelocity": 0.6772429462346373, + "velocityX": 2.4477057314558563, + "velocityY": -2.42998919356015, "moduleForcesX": [ - -0.5815156712319215, - -0.8313154127123616, - -0.7105986959001992, - -0.9604102516570998 + -0.048891828234506295, + -0.413005607259846, + -0.22796342076112328, + -0.5921306405396577 ], "moduleForcesY": [ - -0.17899030509093042, - -0.275088677914427, - 0.15634311137280021, - 0.06010210281662784 + -2.2043649748922296, + -2.337697398866358, + -1.715902956438727, + -1.8492859161842365 ], - "timestamp": 0.49860577797922545 + "timestamp": 0.4991717126728412 }, { - "x": 14.236385775704122, - "y": 4.681164504915296, - "heading": 0.4379095506597357, - "angularVelocity": 0.9109995410690161, - "velocityX": 2.042830417204086, - "velocityY": -2.022821702017776, + "x": 14.236498874993657, + "y": 4.681149821933151, + "heading": 0.41512274351300327, + "angularVelocity": 0.8975926523014044, + "velocityX": 2.0421709281049076, + "velocityY": -2.026270455644455, "moduleForcesX": [ - -77.62580863219604, - -91.18252045297275, - -72.23833707289428, - -84.43073188208308 + -84.90374854906725, + -67.54599174060318, + -95.29586306490957, + -75.27522227287814 ], "moduleForcesY": [ - 84.80855065381803, - 70.08510741611298, - 89.57057617080255, - 78.2106668523955 + 77.6147583667962, + 93.07759399799761, + 64.18090637545481, + 86.70101544096629 ], - "timestamp": 0.5698351748334005 + "timestamp": 0.5704819573403901 }, { - "x": 14.352794206677883, - "y": 4.565894974920919, - "heading": 0.49049547140066846, - "angularVelocity": 0.7382614912293785, - "velocityX": 1.634275118348653, - "velocityY": -1.6182859196514374, + "x": 14.35293077040835, + "y": 4.565754778501453, + "heading": 0.47353374686901495, + "angularVelocity": 0.8191109654486024, + "velocityX": 1.632751310243042, + "velocityY": -1.6182112958618482, "moduleForcesX": [ - -76.1078859700308, - -92.8635423382786, - -71.22089704597018, - -85.60378749942646 + -79.38401877213782, + -86.70173496470736, + -76.59134612886815, + -83.43809887191112 ], "moduleForcesY": [ - 86.50055242381342, - 68.23029646989542, - 90.64276801323516, - 77.21719460477229 + 83.51024074907058, + 75.89707047860773, + 86.11608026131252, + 79.50816094167695 ], - "timestamp": 0.6410645716875756 + "timestamp": 0.641792202007939 }, { - "x": 14.440098961466248, - "y": 4.4794418527905195, - "heading": 0.530262298117705, - "angularVelocity": 0.5582923409901833, - "velocityX": 1.2256843191737132, - "velocityY": -1.21372812277761, + "x": 14.440197735334287, + "y": 4.479318845326742, + "heading": 0.5205395471666466, + "angularVelocity": 0.6591731737392686, + "velocityX": 1.2237647666584326, + "velocityY": -1.2121110168346618, "moduleForcesX": [ - -75.143525628293, - -93.27282582567612, - -71.14081537799724, - -86.26725520322114 + -76.05393950763325, + -91.96458850927128, + -72.0793563135359, + -85.67235755159167 ], "moduleForcesY": [ - 87.44982615530445, - 67.80015365809159, - 90.78923076727234, - 76.56915606002673 + 86.6543340713705, + 69.55656402670749, + 90.03678616248824, + 77.22355997042732 ], - "timestamp": 0.7122939685417506 + "timestamp": 0.7131024466754878 }, { - "x": 14.498301446686176, - "y": 4.421807328352338, - "heading": 0.5569527942334483, - "angularVelocity": 0.3747118085301997, - "velocityX": 0.8171132677015908, - "velocityY": -0.8091395825823801, + "x": 14.498343080799437, + "y": 4.421751377581397, + "heading": 0.5533788018685339, + "angularVelocity": 0.46051243906097156, + "velocityX": 0.8153855836033778, + "velocityY": -0.8072818711214393, "moduleForcesX": [ - -74.50739015764161, - -93.4289581443932, - -71.18348402973322, - -86.68884220281491 + -73.78272693454574, + -94.2833205460505, + -70.32485404051455, + -86.89555919568168 ], "moduleForcesY": [ - 88.04747340766619, - 67.6505855793752, - 90.79681638747405, - 76.13800705299523 + 88.64901027893603, + 66.44804317305021, + 91.46155626910209, + 75.90013809981603 ], - "timestamp": 0.7835233653959257 + "timestamp": 0.7844126913430367 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": 0.18854710036895106, - "velocityX": 0.4085592803911904, - "velocityY": -0.4045490599221039, + "angularVelocity": 0.23845225440008352, + "velocityX": 0.40751223255026625, + "velocityY": -0.4033057928676898, "moduleForcesX": [ - -74.14598545423118, - -93.54843405198011, - -71.17867844532277, - -86.9219690308431 + -72.28092066696583, + -95.62161114658008, + -69.3711228568063, + -87.60989544654508 ], "moduleForcesY": [ - 88.38488704635118, - 67.52515136113772, - 90.82487231947144, - 75.89955258668193 + 89.90999033784944, + 64.5500491439786, + 92.21350984982257, + 75.10570426878752 ], - "timestamp": 0.8547527622501008 + "timestamp": 0.8557229360105856 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": -3.196480441771765e-23, - "velocityX": 5.465355710587214e-23, - "velocityY": -4.689327739245502e-23, + "angularVelocity": -4.4195950751829394e-23, + "velocityX": 6.565713979713351e-23, + "velocityY": -7.386057640213947e-23, "moduleForcesX": [ - -74.04163357665932, - -93.70754772093753, - -71.06675825660118, - -86.9833483137024 + -71.44716369701283, + -96.59228734629673, + -68.61596217852517, + -87.9404950059459 ], "moduleForcesY": [ - 88.49408635582365, - 67.33114392906674, - 90.92845417388115, - 75.84771503471553 + 90.59549675575025, + 63.117985683089984, + 92.79347338693024, + 74.73839504419418 ], - "timestamp": 0.9259821591042758 + "timestamp": 0.9270331806781344 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.8.traj b/src/main/deploy/choreo/Red Amp 5 Piece.8.traj index 5a58f79..d0db0bf 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.8.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.8.traj @@ -4,211 +4,211 @@ "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": -3.196480441771765e-23, - "velocityX": 5.465355710587214e-23, - "velocityY": -4.689327739245502e-23, + "angularVelocity": -4.4195950751829394e-23, + "velocityX": 6.565713979713351e-23, + "velocityY": -7.386057640213947e-23, "moduleForcesX": [ - -74.04163357665932, - -93.70754772093753, - -71.06675825660118, - -86.9833483137024 + -71.44716369701283, + -96.59228734629673, + -68.61596217852517, + -87.9404950059459 ], "moduleForcesY": [ - 88.49408635582365, - 67.33114392906674, - 90.92845417388115, - 75.84771503471553 + 90.59549675575025, + 63.117985683089984, + 92.79347338693024, + 74.73839504419418 ], "timestamp": 0 }, { - "x": 14.49804638425793, - "y": 4.378378905710642, - "heading": 0.5402862689246644, - "angularVelocity": -0.46684858464490536, - "velocityX": -0.45536797020744996, - "velocityY": -0.22666627016800778, + "x": 14.498046481587462, + "y": 4.378378938668267, + "heading": 0.5402846553367175, + "angularVelocity": -0.4668735990525236, + "velocityX": -0.4553664458137136, + "velocityY": -0.2266657516477214, "moduleForcesX": [ - -86.1910855019154, - -90.31940844346722, - -113.67801849819757, - -111.02458022432769 + -86.18981380029933, + -90.31876641561904, + -113.67833215471812, + -111.02482428420291 ], "moduleForcesY": [ - -76.68979833900977, - -71.82796867166277, - -19.71491355099119, - -31.47718312544661 + -76.69122231911774, + -71.82877383631241, + -19.713086660173527, + -31.47631759103055 ], - "timestamp": 0.06446762941256523 + "timestamp": 0.06446763148675849 }, { - "x": 14.43931308319445, - "y": 4.34921431694764, - "heading": 0.4800316822770909, - "angularVelocity": -0.9346487096953828, - "velocityX": -0.9110510437356667, - "velocityY": -0.45239120825061385, + "x": 14.439313277482153, + "y": 4.349214387879551, + "heading": 0.48002841051040274, + "angularVelocity": -0.9346744007291639, + "velocityX": -0.9110495104411049, + "velocityY": -0.4523906046510628, "moduleForcesX": [ - -85.55141100459039, - -91.08357348554144, - -113.51227513203798, - -111.34346253684424 + -85.55134610222815, + -91.0835993926443, + -113.5122715743279, + -111.3434843298819 ], "moduleForcesY": [ - -77.35792380941993, - -70.82047716964802, - -20.46082717051418, - -30.24125186998676 + -77.35798773989127, + -70.82043772341157, + -20.460816178917394, + -30.241157017363083 ], - "timestamp": 0.12893525882513046 + "timestamp": 0.12893526297351698 }, { - "x": 14.351171016540066, - "y": 4.30558804082172, - "heading": 0.38972613617406754, - "angularVelocity": -1.4007889994699154, - "velocityX": -1.367229840115769, - "velocityY": -0.6767159972135817, + "x": 14.351171166249667, + "y": 4.305588083853979, + "heading": 0.38972365883361226, + "angularVelocity": -1.4007766315307923, + "velocityX": -1.36723048760664, + "velocityY": -0.6767164082107209, "moduleForcesX": [ - -84.73884598587067, - -92.22471205340597, - -113.19203585458268, - -111.77189701377912 + -84.74080845033576, + -92.22557626068495, + -113.19149333747797, + -111.77152136175108 ], "moduleForcesY": [ - -78.16109203854988, - -69.25533775826135, - -21.804600786698895, - -28.42581379359055 + -78.15894950714633, + -69.25416976459643, + -21.80736431950343, + -28.427248361937462 ], - "timestamp": 0.1934028882376957 + "timestamp": 0.19340289446027548 }, { - "x": 14.233589173698537, - "y": 4.247619822740085, - "heading": 0.26996789764323587, - "angularVelocity": -1.8576491740441032, - "velocityX": -1.8238896623460294, - "velocityY": -0.899183336037755, + "x": 14.233588914840404, + "y": 4.247619595905105, + "heading": 0.26997308661776914, + "angularVelocity": -1.8575301970018723, + "velocityX": -1.8238959412277143, + "velocityY": -0.8991874931961759, "moduleForcesX": [ - -83.94734279206497, - -93.71262507711467, - -112.51014857524358, - -112.18119405884299 + -83.95312347953679, + -93.71457960486222, + -112.50854673479257, + -112.18000941325678 ], "moduleForcesY": [ - -78.75950431025406, - -67.00490432643183, - -24.107835571776057, - -26.138048273426037 + -78.75329673294335, + -67.00210588095803, + -24.115214852616447, + -26.14296935585298 ], - "timestamp": 0.2578705176502609 + "timestamp": 0.25787052594703397 }, { - "x": 14.115079803991925, - "y": 4.1906611165057175, - "heading": 0.16138894503781345, - "angularVelocity": -1.684239882787762, - "velocityX": -1.8382771444596275, - "velocityY": -0.8835241306897931, + "x": 14.115079451175838, + "y": 4.190660759682163, + "heading": 0.1613963797549536, + "angularVelocity": -1.684204993402254, + "velocityX": -1.838278542758427, + "velocityY": -0.8835261186017336, "moduleForcesX": [ - -9.13188600483001, - 0.6594868643931586, - -7.033546414107018, - 2.829502387337377 + -9.131767443283287, + 0.657652513902004, + -7.026024173540864, + 2.827996500407243 ], "moduleForcesY": [ - 9.22236053294357, - 10.854211773830855, - -3.940291709352419, - -2.3393545564545586 + 9.220317045131871, + 10.850457001015958, + -3.937376845183369, + -2.33456033627213 ], - "timestamp": 0.32233814706282615 + "timestamp": 0.32233815743379246 }, { - "x": 14.026121874269307, - "y": 4.147944154593341, - "heading": 0.08059232970734283, - "angularVelocity": -1.2532896907594953, - "velocityX": -1.3798852312891086, - "velocityY": -0.6626110235728712, + "x": 14.026121631743985, + "y": 4.147943895629665, + "heading": 0.0805975262697081, + "angularVelocity": -1.2533243679324726, + "velocityX": -1.3798834760995349, + "velocityY": -0.6626094842846951, "moduleForcesX": [ - 83.4973536278126, - 96.20030583423285, - 111.30688094678439, - 112.87287120033251 + 83.50128406439772, + 96.20123306665765, + 111.30567857439888, + 112.87198136728139 ], "moduleForcesY": [ - 79.26624964258428, - 63.39232613998023, - 29.071556787646845, - 22.91076603510508 + 79.26206350790244, + 63.390860409712666, + 29.076088096144087, + 22.914988055013154 ], - "timestamp": 0.3868057764753914 + "timestamp": 0.38680578892055095 }, { - "x": 13.966795553083806, - "y": 4.119469408000457, - "heading": 0.026899111947888268, - "angularVelocity": -0.8328709811220388, - "velocityX": -0.9202497707157782, - "velocityY": -0.44169061050248953, + "x": 13.966795455334186, + "y": 4.119469300656433, + "heading": 0.026901223924660083, + "angularVelocity": -0.8329188013689767, + "velocityX": -0.9202474953959547, + "velocityY": -0.44168824441893756, "moduleForcesX": [ - 83.72178565794114, - 97.04105274434198, - 111.04097404028195, - 113.1692570345272 + 83.7225268890319, + 97.04118666628618, + 111.04073186741968, + 113.16906929813969 ], "moduleForcesY": [ - 79.27865285910264, - 62.33849530904982, - 30.86623247761861, - 22.16395504861237 + 79.277855670948, + 62.338271276948674, + 30.8670649445909, + 22.16486600754754 ], - "timestamp": 0.4512734058879566 + "timestamp": 0.45127342040730944 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -5.471472021048484e-22, - "angularVelocity": -0.4172499003452693, - "velocityX": -0.4601476014328733, - "velocityY": -0.22081995024741832, + "heading": -7.672751967232841e-22, + "angularVelocity": -0.4172826471868354, + "velocityX": -0.46014607036910227, + "velocityY": -0.22081827805865759, "moduleForcesX": [ - 83.78966430984653, - 97.43168523301408, - 110.86442475699113, - 113.29850030582718 + 83.78876895559848, + 97.43147500123011, + 110.86467892511294, + 113.29868293583837 ], "moduleForcesY": [ - 79.28878914703334, - 61.80679526055779, - 31.75377302463106, - 21.754142326817494 + 79.28972924119255, + 61.807121644078165, + 31.75285868370552, + 21.753172555886685 ], - "timestamp": 0.5157410353005218 + "timestamp": 0.5157410518940679 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -2.8621211551694397e-22, - "angularVelocity": 5.572576028883896e-23, - "velocityX": -4.824070785889513e-23, - "velocityY": 2.571239855995328e-23, + "heading": -4.0079483813745946e-22, + "angularVelocity": 7.869245843501478e-23, + "velocityX": -6.798727482788098e-23, + "velocityY": 3.6396954748620986e-23, "moduleForcesX": [ - 83.72024176507074, - 97.43090964153055, - 110.92939949551024, - 113.34375281098819 + 83.71833110199695, + 97.43047601274753, + 110.92997514796727, + 113.34415942502997 ], "moduleForcesY": [ - 79.40203201217798, - 61.848085945116544, - 31.65827320851069, - 21.650429300155597 + 79.40404372307425, + 61.848767947517445, + 31.65623556989346, + 21.648293642924163 ], - "timestamp": 0.5802086647130871 + "timestamp": 0.5802086833808264 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.9.traj b/src/main/deploy/choreo/Red Amp 5 Piece.9.traj index 456f69c..d4bf362 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.9.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.9.traj @@ -3,212 +3,212 @@ { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -2.8621211551694397e-22, - "angularVelocity": 5.572576028883896e-23, - "velocityX": -4.824070785889513e-23, - "velocityY": 2.571239855995328e-23, + "heading": -4.0079483813745946e-22, + "angularVelocity": 7.869245843501478e-23, + "velocityX": -6.798727482788098e-23, + "velocityY": 3.6396954748620986e-23, "moduleForcesX": [ - 83.72024176507074, - 97.43090964153055, - 110.92939949551024, - 113.34375281098819 + 83.71833110199695, + 97.43047601274753, + 110.92997514796727, + 113.34415942502997 ], "moduleForcesY": [ - 79.40203201217798, - 61.848085945116544, - 31.65827320851069, - 21.650429300155597 + 79.40404372307425, + 61.848767947517445, + 31.65623556989346, + 21.648293642924163 ], "timestamp": 0 }, { - "x": 13.963559175947621, - "y": 4.117038967947073, - "heading": 0.030366199225700365, - "angularVelocity": 0.49847391634203947, - "velocityX": 0.4338307912320192, - "velocityY": 0.19378893670305897, + "x": 13.963559067974218, + "y": 4.117038855996892, + "heading": 0.030368053809770958, + "angularVelocity": 0.4985043435513874, + "velocityX": 0.4338290043854112, + "velocityY": 0.19378709255352022, "moduleForcesX": [ - 79.65664846502816, - 96.7817820837899, - 113.52833812262094, - 114.54083675568863 + 79.65476731370322, + 96.78133854290633, + 113.52876962438681, + 114.54105043150145 ], "moduleForcesY": [ - 83.46877311897669, - 62.85593025806044, - 20.384715377312528, - 13.981072396380851 + 83.47056524407438, + 62.85661167452952, + 20.38227792487243, + 13.979310801185607 ], - "timestamp": 0.06091833139141478 + "timestamp": 0.060918333415965975 }, { - "x": 14.016366174130928, - "y": 4.140701386661653, - "heading": 0.09167550612380743, - "angularVelocity": 1.006418027181029, - "velocityX": 0.8668490580283776, - "velocityY": 0.3884285431677946, + "x": 14.016365911548785, + "y": 4.140701139163088, + "heading": 0.09167991518604457, + "angularVelocity": 1.0064599265646343, + "velocityX": 0.8668464912522909, + "velocityY": 0.3884263051752232, "moduleForcesX": [ - 79.75263731487117, - 95.85123578413572, - 113.82581248115163, - 114.32031499165953 + 79.75194362178686, + 95.85098527966768, + 113.82595812934248, + 114.32037290983276 ], "moduleForcesY": [ - 83.33210206979211, - 64.22511537248802, - 18.4223489250406, - 15.504096672679982 + 83.3327591230383, + 64.22548363003438, + 18.42140386226322, + 15.503643170599599 ], - "timestamp": 0.12183666278282956 + "timestamp": 0.12183666683193195 }, { - "x": 14.095461362866395, - "y": 4.176301641210184, - "heading": 0.18482890661175871, - "angularVelocity": 1.5291522003355542, - "velocityX": 1.2983807489286403, - "velocityY": 0.5843931331571135, + "x": 14.09546101627666, + "y": 4.176301351792292, + "heading": 0.18483456282360425, + "angularVelocity": 1.5291726219999324, + "velocityX": 1.2983793267585335, + "velocityY": 0.5843924256121095, "moduleForcesX": [ - 79.85703113409431, - 94.3761457349691, - 114.17093924825683, - 113.9597881511265 + 79.8583024750478, + 94.37638365733321, + 114.17069050727945, + 113.95958149721488 ], "moduleForcesY": [ - 83.13867501463085, - 66.29352669629836, - 15.629038984963566, - 17.657848513922918 + 83.13743831492833, + 66.2931720124335, + 15.630779550308679, + 17.659120262265205 ], - "timestamp": 0.18275499417424435 + "timestamp": 0.18275500024789793 }, { - "x": 14.200699287122616, - "y": 4.223965232327085, - "heading": 0.3106849191969956, - "angularVelocity": 2.065979315431074, - "velocityX": 1.727524734386503, - "velocityY": 0.7824178704214827, + "x": 14.200699188552337, + "y": 4.223965142674428, + "heading": 0.31068656428821845, + "angularVelocity": 2.065913402542767, + "velocityX": 1.7275287483175548, + "velocityY": 0.7824211236488451, "moduleForcesX": [ - 80.1960591657279, - 92.27983792176538, - 114.33788054491679, - 113.32380930105033 + 80.20103541951023, + 92.28142357461464, + 114.33707780014122, + 113.32310550893337 ], "moduleForcesY": [ - 82.52218385370314, - 68.94832064257957, - 12.575832251224803, - 20.593651711278543 + 82.51730402352764, + 68.94614202726275, + 12.582895501177102, + 20.59733382901847 ], - "timestamp": 0.24367332556565913 + "timestamp": 0.2436733336638639 }, { - "x": 14.30480960423839, - "y": 4.273756936630003, - "heading": 0.440274689451697, - "angularVelocity": 2.1272705160300247, - "velocityX": 1.7090145894975617, - "velocityY": 0.8173517423350791, + "x": 14.304809926372224, + "y": 4.273756975831149, + "heading": 0.44027066008733234, + "angularVelocity": 2.127177296763508, + "velocityX": 1.7090214387349074, + "velocityY": 0.8173538303605641, "moduleForcesX": [ - -7.063912641839332, - -3.684421057893775, - -4.954961279242321, - -1.555725211526507 + -7.061909627091463, + -3.68518517704315, + -4.9517960037118725, + -1.5574851448945195 ], "moduleForcesY": [ - 9.597559778514192, - 11.19198717343441, - 5.090196808910568, - 6.6929024451344965 + 9.59809098836741, + 11.190702840893662, + 5.0913730591202535, + 6.691391790761715 ], - "timestamp": 0.3045916569570739 + "timestamp": 0.3045916670798299 }, { - "x": 14.38290241669244, - "y": 4.311211682575675, - "heading": 0.537136017858053, - "angularVelocity": 1.5900193947204506, - "velocityX": 1.2819263211968939, - "velocityY": 0.6148353884648875, + "x": 14.382902717879288, + "y": 4.3112117278174935, + "heading": 0.5371322202602826, + "angularVelocity": 1.5900231464238184, + "velocityX": 1.2819259347399998, + "velocityY": 0.6148354671916827, "moduleForcesX": [ - -82.51336670219094, - -88.82178084722041, - -114.69665015134913, - -112.1890206641741 + -82.51888433729174, + -88.82438792099875, + -114.69599016804355, + -112.18828932823602 ], "moduleForcesY": [ - -80.15041574335491, - -73.33093047177117, - -9.21770289044376, - -26.12896176757333 + -80.14469842932262, + -73.32771655792324, + -9.225518690999811, + -26.131944406933375 ], - "timestamp": 0.3655099883484887 + "timestamp": 0.36551000049579585 }, { - "x": 14.43496566772784, - "y": 4.336216845215367, - "heading": 0.6015938905381637, - "angularVelocity": 1.0581030571233854, - "velocityX": 0.8546401361665806, - "velocityY": 0.4104702487503784, + "x": 14.434965804754063, + "y": 4.33621686660926, + "heading": 0.6015921619911261, + "angularVelocity": 1.0581369862943197, + "velocityX": 0.8546374129980221, + "velocityY": 0.41046984363517086, "moduleForcesX": [ - -83.61446769451484, - -87.93445802257577, - -114.93625421398835, - -111.92017771507035 + -83.61615888406612, + -87.9353553509811, + -114.93605502522537, + -111.91995391554177 ], "moduleForcesY": [ - -79.30871463146501, - -74.61104959107463, - -8.79132443274591, - -27.840746229308348 + -79.30691637646417, + -74.60997644793589, + -8.793781645274763, + -27.84160522062182 ], - "timestamp": 0.42642831973990347 + "timestamp": 0.4264283339117618 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 0.5296576683558456, - "velocityX": 0.4273247996047913, - "velocityY": 0.20526140282074212, + "angularVelocity": 0.529686025578064, + "velocityX": 0.42732253606019294, + "velocityY": 0.20526104480936738, "moduleForcesX": [ - -84.19152726546557, - -87.47215406723159, - -115.01634601054388, - -111.75251144456591 + -84.1911992495474, + -87.47197704017138, + -115.01637354227934, + -111.75254715698384 ], "moduleForcesY": [ - -78.80193174691267, - -75.22571028375239, - -8.61896304131099, - -28.69190883048073 + -78.8022727113627, + -75.22591033857384, + -8.618524833768987, + -28.691755739808066 ], - "timestamp": 0.48734665113131825 + "timestamp": 0.4873466673277278 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 1.1797364189027284e-23, - "velocityX": -1.1325605604528817e-23, - "velocityY": 2.3217947109929744e-23, + "angularVelocity": 1.5901790954601477e-23, + "velocityX": -1.5508239035272037e-23, + "velocityY": 3.190246274802254e-23, "moduleForcesX": [ - -84.15066425501406, - -87.45368989610188, - -115.05496155327525, - -111.78204650706883 + -84.14903985656575, + -87.45282015084248, + -115.05512710586952, + -111.7822513078171 ], "moduleForcesY": [ - -78.90065034494464, - -75.28457785684638, - -8.534123812406214, - -28.668166390935667 + -78.90237620597068, + -75.28558613417827, + -8.531852509603707, + -28.667363381920115 ], - "timestamp": 0.548264982522733 + "timestamp": 0.5482650007436938 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Amp 5 Piece.traj b/src/main/deploy/choreo/Red Amp 5 Piece.traj index bb6c50b..dc2e07f 100644 --- a/src/main/deploy/choreo/Red Amp 5 Piece.traj +++ b/src/main/deploy/choreo/Red Amp 5 Piece.traj @@ -3,10 +3,10 @@ { "x": 15.20169734954834, "y": 6.508597373962402, - "heading": -4.3528887118527857e-23, - "angularVelocity": -6.603140405428085e-24, - "velocityX": -1.2060893015993952e-21, - "velocityY": 7.138840853465489e-22, + "heading": -8.498320371979777e-23, + "angularVelocity": -1.303634376415855e-23, + "velocityX": -2.443695081429881e-20, + "velocityY": 2.3610421524139276e-20, "moduleForcesX": [ 0, 0, @@ -22,3117 +22,3159 @@ "timestamp": 0 }, { - "x": 15.179626306424254, - "y": 6.490858286972303, - "heading": -1.6477847497890382e-10, - "angularVelocity": -2.7912762094873322e-9, - "velocityX": -0.3738739395345731, - "velocityY": -0.3004924733030536, + "x": 15.179323748097806, + "y": 6.491593300242642, + "heading": -3.446686628016041e-10, + "angularVelocity": -5.8607425984795884e-9, + "velocityX": -0.38044050200785395, + "velocityY": -0.2891371045661442, "moduleForcesX": [ - -89.93357437032712, - -89.93357449974754, - -89.93357458600433, - -89.93357471542474 + -91.8611587363816, + -91.8611589873367, + -91.86115917858633, + -91.86115942954144 ], "moduleForcesY": [ - -72.28201666391972, - -72.28201650320274, - -72.28201639524063, - -72.28201623452364 + -69.81504228033312, + -69.81504195081375, + -69.8150416977938, + -69.81504136827444 ], - "timestamp": 0.05903338208477801 + "timestamp": 0.058809725390574434 }, { - "x": 15.134092099800656, - "y": 6.457273283717531, - "heading": -4.5125780037436346e-10, - "angularVelocity": -4.852836061196729e-9, - "velocityX": -0.7713297970664511, - "velocityY": -0.5689154520494917, + "x": 15.133401882134509, + "y": 6.459259290320045, + "heading": -9.442226120947298e-10, + "angularVelocity": -1.0194809537218462e-8, + "velocityX": -0.7808549633298901, + "velocityY": -0.5498071910361231, "moduleForcesX": [ - -95.60609117215738, - -95.60609124537726, - -95.60609131724519, - -95.60609139046507 + -96.68407083847598, + -96.68407098415932, + -96.68407113790389, + -96.68407128358724 ], "moduleForcesY": [ - -64.56785423072616, - -64.56785412261053, - -64.56785401562026, - -64.56785390750461 + -62.941396315731794, + -62.94139609260596, + -62.941395855206785, + -62.941395632080955 ], - "timestamp": 0.11806676416955603 + "timestamp": 0.11761945078114887 }, { - "x": 15.063455246346447, - "y": 6.4106030861332375, - "heading": -7.923518954984216e-10, - "angularVelocity": -5.777986675982209e-9, - "velocityX": -1.1965577942454486, - "velocityY": -0.7905729933831352, + "x": 15.062531609729039, + "y": 6.4140078818149915, + "heading": -1.6620460583836768e-9, + "angularVelocity": -1.2205862916746293e-8, + "velocityX": -1.2050774244361186, + "velocityY": -0.769454511214313, "moduleForcesX": [ - -102.28654560786366, - -102.28654562921926, - -102.28654566257885, - -102.28654568393446 + -102.43275032289199, + -102.43275036895025, + -102.43275044168742, + -102.4327504877457 ], "moduleForcesY": [ - -53.3186535242474, - -53.31865348347508, - -53.318653419144425, - -53.318653378372105 + -53.03603947289089, + -53.03603938436765, + -53.036039243151045, + -53.036039154627815 ], - "timestamp": 0.17710014625433404 + "timestamp": 0.1764291761717233 }, { - "x": 14.965964427690755, - "y": 6.354993169367382, - "heading": -1.0815114154157552e-9, - "angularVelocity": -4.898237399002934e-9, - "velocityX": -1.6514523683512154, - "velocityY": -0.942007975860076, + "x": 14.96515989030649, + "y": 6.359448552089575, + "heading": -2.28357279584149e-9, + "angularVelocity": -1.0568434614002256e-8, + "velocityX": -1.655707772411321, + "velocityY": -0.9277263133447721, "moduleForcesX": [ - -109.42269779178156, - -109.42269778273729, - -109.42269775576457, - -109.42269774672029 + -108.80919849872593, + -108.80919848005888, + -108.80919842819559, + -108.80919840952853 ], "moduleForcesY": [ - -36.426955237033994, - -36.426955263872905, - -36.42695534537222, - -36.42695537221113 + -38.216307330242316, + -38.216307382799684, + -38.21630753133454, + -38.21630758389191 ], - "timestamp": 0.23613352833911205 + "timestamp": 0.23523890156229774 }, { - "x": 14.84031024724876, - "y": 6.296639809307858, - "heading": -1.1586671377582547e-9, - "angularVelocity": -1.3069846181547316e-9, - "velocityX": -2.1285275551643497, - "velocityY": -0.9884807205476066, + "x": 14.839966986250749, + "y": 6.301073904680198, + "heading": -2.4785955133946477e-9, + "angularVelocity": -3.3161643972635273e-9, + "velocityX": -2.1287789260074454, + "velocityY": -0.9926019382286347, "moduleForcesX": [ - -114.75813729736898, - -114.7581372935656, - -114.75813725195086, - -114.75813724814746 + -114.22775518362515, + -114.22775516938998, + -114.22775505468461, + -114.22775504044945 ], "moduleForcesY": [ - -11.178794542775593, - -11.178794576619985, - -11.17879500970412, - -11.178795043548515 + -15.664867092783735, + -15.664867188866841, + -15.66486803443501, + -15.664868130518121 ], - "timestamp": 0.2951669104238901 + "timestamp": 0.29404862695287215 }, { - "x": 14.686942751138512, - "y": 6.243977280961659, - "heading": -8.363450931363897e-10, - "angularVelocity": 5.459996246852681e-9, - "velocityX": -2.5979791550820597, - "velocityY": -0.8920804888083312, + "x": 14.687002517259797, + "y": 6.246814000732414, + "heading": -1.8217268295736112e-9, + "angularVelocity": 1.1169388727096216e-8, + "velocityX": -2.6010063467405375, + "velocityY": -0.9226348803268004, "moduleForcesX": [ - -112.92432010689039, - -112.92432007869421, - -112.92432028404276, - -112.9243202558466 + -114.02402726270896, + -114.02402722958728, + -114.02402754037327, + -114.0240275072516 ], "moduleForcesY": [ - 23.188611580505953, - 23.18861171251525, - 23.188610716345337, - 23.188610848354628 + 16.89424580273815, + 16.894246009646327, + 16.894243925394832, + 16.894244132302983 ], - "timestamp": 0.35420029250866814 + "timestamp": 0.3528583523434466 }, { "x": 14.509410858154297, "y": 6.206027030944824, - "heading": 1.6870395426082385e-22, - "angularVelocity": 1.4167324716980014e-8, - "velocityX": -3.0073136031620438, - "velocityY": -0.6428608471446768, + "heading": 3.969467826839008e-22, + "angularVelocity": 3.0976625336632224e-8, + "velocityX": -3.0197668485281395, + "velocityY": -0.6935412385742346, "moduleForcesX": [ - -98.46342884163919, - -98.46342857989734, - -98.46342941505019, - -98.46342915330834 + -101.11390541508874, + -101.11390491533385, + -101.11390663127975, + -101.1139061315249 ], "moduleForcesY": [ - 59.948584128622876, - 59.948584555913705, - 59.94858318468237, - 59.94858361197319 + 55.316948669637505, + 55.316949575911146, + 55.316946441253606, + 55.316947347527226 ], - "timestamp": 0.4132336745934462 + "timestamp": 0.41166807773402103 }, { - "x": 14.39870668839677, - "y": 6.191150636092829, - "heading": 6.682629988227654e-10, - "angularVelocity": 1.925590029446468e-8, - "velocityX": -3.1899244141732552, - "velocityY": -0.428661135684424, + "x": 14.395876140440663, + "y": 6.189128805794054, + "heading": 1.522966758732963e-9, + "angularVelocity": 4.3040847489578005e-8, + "velocityX": -3.2086258231614164, + "velocityY": -0.4775638912593676, "moduleForcesX": [ - -74.7200621801483, - -74.72006152267782, - -74.72006292902194, - -74.72006227155148 + -75.79182122905944, + -75.79181974401823, + -75.79182296295163, + -75.79182147791046 ], "moduleForcesY": [ - 87.64549967297297, - 87.64550023101394, - 87.64549903065125, - 87.64549958869223 + 86.67481425219046, + 86.67481554424141, + 86.67481272599154, + 86.67481401804254 ], - "timestamp": 0.4479379983904785 + "timestamp": 0.4470522963905207 }, { - "x": 14.281833992771213, - "y": 6.183842078444728, - "heading": 1.46563128230524e-9, - "angularVelocity": 2.297605013558962e-8, - "velocityX": -3.36766958230001, - "velocityY": -0.2105950166568239, + "x": 14.276015624628796, + "y": 6.18016177358942, + "heading": 3.3017017289639248e-9, + "angularVelocity": 5.0269160596653465e-8, + "velocityX": -3.387400382510616, + "velocityY": -0.2534189688256986, "moduleForcesX": [ - -72.72915521902236, - -72.7291547139971, - -72.72915576861566, - -72.72915526359041 + -71.7448005057056, + -71.74479952082729, + -71.74480155376283, + -71.7448005688845 ], "moduleForcesY": [ - 89.22754297343529, - 89.2275433829778, - 89.22754252200183, - 89.22754293154432 + 89.95257946983574, + 89.95258025082046, + 89.95257862628402, + 89.95257940726874 ], - "timestamp": 0.4826423221875108 + "timestamp": 0.48243651504702034 }, { - "x": 14.159050528640018, - "y": 6.184294815459166, - "heading": 2.3229765945150137e-9, - "angularVelocity": 2.470427942131417e-8, - "velocityX": -3.5379875098357174, - "velocityY": 0.013045550666414774, + "x": 14.150428609865713, + "y": 6.179555476543678, + "heading": 5.078023376549813e-9, + "angularVelocity": 5.020095723547424e-8, + "velocityX": -3.5492380369409227, + "velocityY": -0.017134673839445464, "moduleForcesX": [ - -69.69010253451697, - -69.69010228267354, - -69.69010279033854, - -69.69010253849511 + -64.9477771261755, + -64.94777713696463, + -64.9477771163259, + -64.94777712711503 ], "moduleForcesY": [ - 91.50847649519069, - 91.50847668582223, - 91.50847629831208, - 91.5084764889436 + 94.82428414669329, + 94.82428413935362, + 94.82428415353773, + 94.82428414619807 ], - "timestamp": 0.5173466459845432 + "timestamp": 0.51782073370352 }, { - "x": 14.03079533153799, - "y": 6.192809216565774, - "heading": 3.1312188046741175e-9, - "angularVelocity": 2.3289380737857663e-8, - "velocityX": -3.6956546928309977, - "velocityY": 0.2453412190481945, + "x": 14.020285286516224, + "y": 6.187978683471175, + "heading": 6.434200940526406e-9, + "angularVelocity": 3.832718696268834e-8, + "velocityX": -3.6780047233170614, + "velocityY": 0.23804982128522642, "moduleForcesX": [ - -64.51371447905602, - -64.51371470905573, - -64.51371427113206, - -64.51371450113174 + -51.67592186533519, + -51.67592423146429, + -51.67592027633643, + -51.675922642465494 ], "moduleForcesY": [ - 95.0499409165131, - 95.04994076157361, - 95.04994105995034, - 95.04994090501086 + 102.40920632891186, + 102.4092051448318, + 102.40920715698425, + 102.40920597290425 ], - "timestamp": 0.5520509697815755 + "timestamp": 0.5532049523600197 }, { - "x": 13.897963803701671, - "y": 6.20989769926313, - "heading": 3.696973755747146e-9, - "angularVelocity": 1.630214593379525e-8, - "velocityX": -3.827520991712204, - "velocityY": 0.4924021224934038, + "x": 13.888371101336414, + "y": 6.206318425861406, + "heading": 6.680653519085837e-9, + "angularVelocity": 6.96504226789965e-9, + "velocityX": -3.7280513796388863, + "velocityY": 0.5183028787005002, "moduleForcesX": [ - -53.95659746008519, - -53.95659882762597, - -53.95659649016197, - -53.95659785770273 + -20.084439343980858, + -20.08444787570321, + -20.08443732182004, + -20.084445853541588 ], "moduleForcesY": [ - 101.09152899469004, - 101.0915282719287, - 101.09152953035384, - 101.09152880759252 + 112.46958106687981, + 112.46957956001785, + 112.46958155352253, + 112.46958004666087 ], - "timestamp": 0.5867552935786079 + "timestamp": 0.5885891710165193 }, { - "x": 13.763055492335095, - "y": 6.236418641581392, - "heading": 3.6171222083325864e-9, - "angularVelocity": -2.300910626632439e-9, - "velocityX": -3.8873632045270554, - "velocityY": 0.7641970629760271, + "x": 13.758040033310886, + "y": 6.234528802394688, + "heading": 6.645267838303864e-9, + "angularVelocity": -1.00004132140941e-9, + "velocityX": -3.6833106106071467, + "velocityY": 0.7972587103629364, "moduleForcesX": [ - -24.48602860516184, - -24.486033599316524, - -24.48602715105942, - -24.48603214521383 + 17.955115066486492, + 17.95511290507103, + 17.955114609991067, + 17.95511244857563 ], "moduleForcesY": [ - 111.21211725559331, - 111.21211617203417, - 111.21211767341897, - 111.21211658985995 + 111.94898498074906, + 111.94898532090953, + 111.9489851083639, + 111.94898544852435 ], - "timestamp": 0.6214596173756403 + "timestamp": 0.623973389673019 }, { "x": 13.630112648010254, "y": 6.272213459014893, - "heading": -1.0376160127202523e-19, - "angularVelocity": -1.0422684589940892e-7, - "velocityX": -3.830728560001787, - "velocityY": 1.0314224141881108, + "heading": -1.5585370169858288e-19, + "angularVelocity": -1.8780315323536185e-7, + "velocityX": -3.6153796850091533, + "velocityY": 1.0650131061543873, "moduleForcesX": [ - 23.17358566119532, - 23.173558952779945, - 23.17357832384853, - 23.17355161544207 + 27.261687418434768, + 27.261641389084208, + 27.261672495978797, + 27.261626473603524 ], "moduleForcesY": [ - 109.34234401324875, - 109.34234948074236, - 109.342346790233, - 109.34235225772296 + 107.45367915993488, + 107.45369033038008, + 107.45368563018035, + 107.45369679884966 ], - "timestamp": 0.6561639411726726 + "timestamp": 0.6593576083295186 }, { - "x": 13.379601321542795, - "y": 6.323151596088256, - "heading": -0.000044770172369445994, - "angularVelocity": -0.0006952279229347041, - "velocityX": -3.8901451558951234, - "velocityY": 0.7910091331219953, + "x": 13.390615610810706, + "y": 6.321687036535878, + "heading": -0.00007211348501602596, + "angularVelocity": -0.00111204705585835, + "velocityX": -3.6932340053371213, + "velocityY": 0.7629217505264949, "moduleForcesX": [ - -13.064389136262065, - -13.121852274728727, - -13.082219112887778, - -13.13989401364793 + -16.987922786840045, + -17.082996331763876, + -17.01360023100258, + -17.109096037679436 ], "moduleForcesY": [ - -53.03975477268047, - -53.028859886833715, - -52.99881173697238, - -52.9888901966368 + -66.19005542155882, + -66.17422233699283, + -66.12851592804181, + -66.11296782709219 ], - "timestamp": 0.720560336789899 + "timestamp": 0.7242051205243725 }, { - "x": 13.148958187009413, - "y": 6.368906756131173, - "heading": -0.05557421160697782, - "angularVelocity": -0.86230666953282, - "velocityX": -3.5816155907906864, - "velocityY": 0.7105236186647266, + "x": 13.157753730626089, + "y": 6.367449891304318, + "heading": -0.020349716479967844, + "angularVelocity": -0.312696698896045, + "velocityX": -3.590914628843632, + "velocityY": 0.7056994666338302, "moduleForcesX": [ - 77.93257191876994, - 44.11069948512947, - 88.44467603296238, - 61.65027573448044 + 29.89084865554921, + 13.030490785947396, + 32.10384734704793, + 14.597690630081734 ], "moduleForcesY": [ - -49.06442321549933, - -66.62250167596093, - 15.430666972718294, - 29.26408286408135 + -24.010835804939674, + -25.326666831059267, + -0.4836556990558821, + -0.30058703399048453 ], - "timestamp": 0.7849567324071254 + "timestamp": 0.7890526327192263 }, { - "x": 12.951234166317056, - "y": 6.408161403232974, - "heading": -0.10764799496471299, - "angularVelocity": -0.8086443792174783, - "velocityX": -3.0704206158933536, - "velocityY": 0.609578326947544, + "x": 12.957356286277964, + "y": 6.40709453148691, + "heading": -0.07061445763616857, + "angularVelocity": -0.7751221204163579, + "velocityX": -3.090287315047219, + "velocityY": 0.6113517518369715, "moduleForcesX": [ - 113.31038231556686, - 113.37930141281873, - 112.03346259287166, - 112.1759178108579 + 107.3795653758912, + 101.86125988189073, + 114.8648292984834, + 114.40034415500577 ], "moduleForcesY": [ - -19.252528450963577, - -18.974700403964082, - -25.67152082683337, - -25.13995335510332 + -40.97120389792557, + -52.80126855800278, + 3.191564836013126, + 7.940512733376601 ], - "timestamp": 0.8493531280243518 + "timestamp": 0.8539001449140802 }, { - "x": 12.7864611895928, - "y": 6.440888378700205, - "heading": -0.15272288248178728, - "angularVelocity": -0.699959789442261, - "velocityX": -2.5587298038180677, - "velocityY": 0.5082112927835478, + "x": 12.790427998602441, + "y": 6.440171200929543, + "heading": -0.1227572585272402, + "angularVelocity": -0.8040832890303166, + "velocityX": -2.5741664101768, + "velocityY": 0.5100684409178722, "moduleForcesX": [ - 114.09477809264015, - 114.09797780307369, - 111.442266391589, - 111.70139457807396 + 112.71395426887749, + 112.66218369215821, + 113.36635432566672, + 113.33454508007034 ], "moduleForcesY": [ - -15.913469790929499, - -16.046789303580823, - -29.18564939151568, - -28.264792093676622 + -23.760754374513482, + -23.975233317910366, + -20.419260667878685, + -20.560125698223537 ], - "timestamp": 0.9137495236415782 + "timestamp": 0.918747657108934 }, { - "x": 12.654642871116208, - "y": 6.467078064626328, - "heading": -0.18960174396775148, - "angularVelocity": -0.5726851810957397, - "velocityX": -2.0469828662480234, - "velocityY": 0.4066949038855515, + "x": 12.65696171804704, + "y": 6.466645530685566, + "heading": -0.16925593959498417, + "angularVelocity": -0.7170464909744682, + "velocityX": -2.0581557570683704, + "velocityY": 0.4082551336198239, "moduleForcesX": [ - 114.36206703200182, - 114.29110618647663, - 111.25270682753312, - 111.48004226113034 + 114.00144220452592, + 113.99095150053918, + 111.92404445290293, + 112.06402825139133 ], "moduleForcesY": [ - -14.58829144036612, - -15.26085484138321, - -30.238604229918433, - -29.45468827574684 + -17.14637544539112, + -17.295470407167763, + -27.630401033773403, + -27.107357918418792 ], - "timestamp": 0.9781459192588047 + "timestamp": 0.9835951693037879 }, { - "x": 12.555779549706159, - "y": 6.486724686682261, - "heading": -0.21768842940260533, - "angularVelocity": -0.43615306673065574, - "velocityX": -1.5352306672208027, - "velocityY": 0.3050888464738352, + "x": 12.556912258763324, + "y": 6.486507786121201, + "heading": -0.2065751634433522, + "angularVelocity": -0.5754919901357388, + "velocityX": -1.5428419055319835, + "velocityY": 0.3062917105586495, "moduleForcesX": [ - 114.49936666718258, - 114.37291094617846, - 111.17407977417163, - 111.34420578314155 + 114.52951979915348, + 114.41545555950175, + 111.1038117502864, + 111.32134170829701 ], "moduleForcesY": [ - -13.847592290942329, - -14.958857918151065, - -30.693310454837178, - -30.121770154712582 + -13.56849995910181, + -14.610037306397269, + -30.935423415458633, + -30.197132480137224 ], - "timestamp": 1.042542314876031 + "timestamp": 1.0484426814986416 }, { - "x": 12.489870969885784, - "y": 6.4998244090967265, - "heading": -0.23662843692451097, - "angularVelocity": -0.29411595696264536, - "velocityX": -1.0234824354477663, - "velocityY": 0.20342322406258137, + "x": 12.490240750486658, + "y": 6.499752126190816, + "heading": -0.23266460878981102, + "angularVelocity": -0.40231991117971083, + "velocityX": -1.028127464263096, + "velocityY": 0.2042382139474869, "moduleForcesX": [ - 114.58169370325793, - 114.41751735086616, - 111.13270734016913, - 111.25514546342465 + 114.80042068735366, + 114.61054935161582, + 110.59863478703036, + 110.83549271399136 ], "moduleForcesY": [ - -13.383209155395406, - -14.806913472109198, - -30.942388952575417, - -30.541558492400497 + -11.333508890235418, + -13.232312421101899, + -32.792340177493294, + -32.03182827040542 ], - "timestamp": 1.1069387104932575 + "timestamp": 1.1132901936934954 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": -0.14840255835934948, - "velocityX": -0.5117392128533444, - "velocityY": 0.10172039612632167, + "angularVelocity": -0.20849555419783833, + "velocityX": -0.5138815704216196, + "velocityY": 0.10212743022895641, "moduleForcesX": [ - 114.63396863953953, - 114.44886671702369, - 111.10080141802345, - 111.19900874167566 + 114.95598681748038, + 114.72482442231708, + 110.24775114592639, + 110.5061283467711 ], "moduleForcesY": [ - -13.08662495525689, - -14.690983770852931, - -31.12304727525516, - -30.806231170714476 + -9.848309354372528, + -12.36579682333574, + -34.015560796460676, + -33.21050131016418 ], - "timestamp": 1.171335106110484 + "timestamp": 1.178137705888349 }, { "x": 12.456916809082031, "y": 6.506374835968018, "heading": -0.24618502678322815, - "angularVelocity": 3.1053355931895455e-20, - "velocityX": 1.4124500530750476e-19, - "velocityY": 6.271253114440515e-19, + "angularVelocity": -4.8297071609365385e-20, + "velocityX": 6.470993194950448e-19, + "velocityY": 3.3178230289344078e-18, "moduleForcesX": [ - 114.6667993998726, - 114.47707589122747, - 111.06552665667455, - 111.1697067800059 + 115.05021982561283, + 114.80814664741968, + 109.96652897988751, + 110.29067964070444 ], "moduleForcesY": [ - -12.910071305057201, - -14.561200011281274, - -31.296024837317898, - -30.955087024539008 + -8.850873959259241, + -11.686076549662568, + -34.957520485564494, + -33.96027818561143 ], - "timestamp": 1.2357315017277104 + "timestamp": 1.2429852180832028 }, { - "x": 12.391577669935138, - "y": 6.524834886416186, - "heading": -0.2376574883237867, - "angularVelocity": 0.09327225382491915, - "velocityX": -0.7146644720743752, - "velocityY": 0.20191178488512532, + "x": 12.397672522253476, + "y": 6.523112878711347, + "heading": -0.23760577600202967, + "angularVelocity": 0.09853884197084228, + "velocityX": -0.6804630807935004, + "velocityY": 0.19224841315988717, "moduleForcesX": [ - -109.9959827367489, - -109.86538217101113, - -112.07438057028467, - -112.0666311120356 + -109.87343425060293, + -109.71928226568586, + -112.17142318363217, + -112.1683964785196 ], "moduleForcesY": [ - 34.947790309423134, - 35.34716847772434, - 27.56387748227317, - 27.583683757251233 + 35.32323951770473, + 35.78880107821523, + 27.1558429759438, + 27.154535423780597 ], - "timestamp": 1.3271578167329043 + "timestamp": 1.3300498781665546 }, { - "x": 12.260906252411765, - "y": 6.561752331915095, - "heading": -0.2206877610023437, - "angularVelocity": 0.1856109733885584, - "velocityX": -1.4292539026203903, - "velocityY": 0.4037945256440807, + "x": 12.279190101968272, + "y": 6.556586338886186, + "heading": -0.22055367602817383, + "angularVelocity": 0.19585558546407858, + "velocityX": -1.3608554857019426, + "velocityY": 0.3844666727325826, "moduleForcesX": [ - -110.00945422487304, - -109.8504153683674, - -112.06416998026945, - -112.03171567433652 + -109.89245539711597, + -109.70709462938446, + -112.15861944802997, + -112.12825792036844 ], "moduleForcesY": [ - 34.86118581179554, - 35.347956242495144, - 27.54904597391854, - 27.666287641216236 + 35.21826543338556, + 35.77869126173595, + 27.148840736400675, + 27.256949433752844 ], - "timestamp": 1.4185841317380983 + "timestamp": 1.4171145382499064 }, { - "x": 12.064914042906658, - "y": 6.617122892086999, - "heading": -0.19542124177576825, - "angularVelocity": 0.27635937448796954, - "velocityX": -2.143717697623187, - "velocityY": 0.6056304486160079, + "x": 12.101479877603184, + "y": 6.606791013546223, + "heading": -0.1952091525882827, + "angularVelocity": 0.29110001021800874, + "velocityX": -2.041129250317603, + "velocityY": 0.5766366584556093, "moduleForcesX": [ - -110.02889664350995, - -109.82922400996975, - -112.04411023069697, - -111.975470281016 + -109.92048751533741, + -109.69117162238653, + -112.1337688915827, + -112.06359871366234 ], "moduleForcesY": [ - 34.72586213068898, - 35.33767829400725, - 27.53646502457929, - 27.795383551483052 + 35.05402926782684, + 35.74845318822676, + 27.151367351771455, + 27.417403309854482 ], - "timestamp": 1.5100104467432922 + "timestamp": 1.5041791983332582 }, { - "x": 11.80362432610035, - "y": 6.690938650379312, - "heading": -0.16214419063285807, - "angularVelocity": 0.3639767296868492, - "velocityX": -2.857926810147228, - "velocityY": 0.8073797821570227, + "x": 11.864562910114323, + "y": 6.6737192302015265, + "heading": -0.16192803904792102, + "angularVelocity": 0.3822574338256172, + "velocityX": -2.7211611147628307, + "velocityY": 0.7687185201346822, "moduleForcesX": [ - -110.05001149729422, - -109.80240908300567, - -111.99097622261098, - -111.87607678799768 + -109.95591771814263, + -109.67704537348149, + -112.0693733681274, + -111.94887517290029 ], "moduleForcesY": [ - 34.51004456710356, - 35.26876905745422, - 27.56365281863087, - 27.999126804996614 + 34.788017531200495, + 35.6335008373943, + 27.216188056391903, + 27.676054770743054 ], - "timestamp": 1.6014367617484861 + "timestamp": 1.59124385841661 }, { - "x": 11.477108634875863, - "y": 6.783177700282454, - "heading": -0.12164341187087872, - "angularVelocity": 0.4429882004943381, - "velocityX": -3.571353512453578, - "velocityY": 1.008889507336059, + "x": 11.56850461802944, + "y": 6.7573499531090215, + "heading": -0.1217025196318901, + "angularVelocity": 0.46201891074427753, + "velocityX": -3.400441600546649, + "velocityY": 0.9605587712331278, "moduleForcesX": [ - -110.04642262897133, - -109.76393441481716, - -111.79375874723362, - -111.62926676038809 + -109.98511497469823, + -109.68108201991241, + -111.83317527235297, + -111.6616416691419 ], "moduleForcesY": [ - 34.068957025324174, - 34.92992729055502, - 27.794484147904477, - 28.39936236528553 + 34.22235845768231, + 35.142081931115705, + 27.57984056765442, + 28.211854056677726 ], - "timestamp": 1.69286307675368 + "timestamp": 1.6783085184999618 }, { - "x": 11.127792753189217, - "y": 6.881877306152213, - "heading": -0.12162478079751621, - "angularVelocity": 0.00020378239417665058, - "velocityX": -3.8207367503196448, - "velocityY": 1.0795535821842135, + "x": 11.252494100051829, + "y": 6.8466425061476945, + "heading": -0.12168267110063807, + "angularVelocity": 0.00022797460224432592, + "velocityX": -3.6296072100330767, + "velocityY": 1.0255889468033135, "moduleForcesX": [ - -33.09132616097768, - -48.347985418148845, - -29.02496895325345, - -44.47101375036062 + -31.02179127200356, + -47.98351788132492, + -26.680968019598573, + -43.820835109423456 ], "moduleForcesY": [ - -3.094463016167937, - -0.5892512773323937, - 23.759456581488084, - 23.82600237416276 + -4.756334887484557, + -1.9309977832536225, + 24.46796105753946, + 24.644907375310982 ], - "timestamp": 1.784289391758874 + "timestamp": 1.7653731785833136 }, { - "x": 10.778476992179064, - "y": 6.980578519140531, - "heading": -0.12160654197932859, - "angularVelocity": 0.0001994919973158839, - "velocityX": -3.820735430387944, - "velocityY": 1.0795711604772797, + "x": 10.936483790907323, + "y": 6.935936936057917, + "heading": -0.12166324602862022, + "angularVelocity": 0.00022311086954514994, + "velocityX": -3.6296048114352204, + "velocityY": 1.025610504017775, "moduleForcesX": [ - 0.0002512832040627029, - 0.00011234039315012063, - 0.00029742988117872183, - 0.00015898562376514823 + 0.0005154716607218464, + 0.0002417899336236675, + 0.0005410426549909981, + 0.00026653543094474054 ], "moduleForcesY": [ - 0.002591336436009617, - 0.0026141003619889144, - 0.002857948956202869, - 0.0028575487581504696 + 0.0033758890088798066, + 0.0034350821142144186, + 0.0035869113525768474, + 0.0036659942562330076 ], - "timestamp": 1.875715706764068 + "timestamp": 1.8524378386666653 }, { - "x": 10.42916122482486, - "y": 7.079279709676494, - "heading": -0.12158830320096466, - "angularVelocity": 0.000199491561733752, - "velocityX": -3.8207354997777165, - "velocityY": 1.079570914898582, + "x": 10.620473493797341, + "y": 7.025231408572309, + "heading": -0.12164382100669206, + "angularVelocity": 0.00022311029422917704, + "velocityX": -3.6296046732101006, + "velocityY": 1.0256109933571795, "moduleForcesX": [ - -0.000010817185800089757, - -0.000010826840184563996, - -0.000010728186769667733, - -0.000010737841153636994 + 0.00002434182804179363, + 0.00002440227199946701, + 0.000020678411625246635, + 0.00002075523564597107 ], "moduleForcesY": [ - -0.00003818254602090013, - -0.00003811622625778976, - -0.00003816959017816588, - -0.00003810327041597527 + 0.00008082287391198304, + 0.00007797287404045539, + 0.00008183770796018627, + 0.00007861043704994156 ], - "timestamp": 1.967142021769262 + "timestamp": 1.9395024987500171 }, { - "x": 10.079845074724386, - "y": 7.17797836765492, - "heading": -0.12156967900738717, - "angularVelocity": 0.00020370714467073155, - "velocityX": -3.820739686168366, - "velocityY": 1.0795432143668855, + "x": 10.304463176887305, + "y": 7.114525811000592, + "heading": -0.12162439602548268, + "angularVelocity": 0.00022310982654477333, + "velocityX": -3.629604900627923, + "velocityY": 1.0256101883680144, "moduleForcesX": [ - -0.000724611981877418, - -0.0005826729788445193, - -0.0007171397023142401, - -0.0005764705403427619 + -0.00003675082473489597, + -0.000037176248898554475, + -0.00003699545409221911, + -0.00003744433216461551 ], "moduleForcesY": [ - -0.004183092119230615, - -0.004164770678407313, - -0.004451422852479581, - -0.004410331431156549 + -0.00013113344539951354, + -0.0001311896105161841, + -0.00013157216497814358, + -0.0001312778439131569 ], - "timestamp": 2.0585683367744556 + "timestamp": 2.0265671588333687 }, { - "x": 9.753318963003084, - "y": 7.270191836288494, - "heading": -0.08193010734885013, - "angularVelocity": 0.43356851532608676, - "velocityX": -3.5714674894503937, - "velocityY": 1.0086097052947562, + "x": 9.988452352347721, + "y": 7.203817281479636, + "heading": -0.12160455496323849, + "angularVelocity": 0.00022788881533772785, + "velocityX": -3.629610731116951, + "velocityY": 1.0255765128303516, "moduleForcesX": [ - 32.71681627397986, - 47.82428831491742, - 29.57806286942199, - 44.74713985839775 + -0.0010130445731977192, + -0.000753992270294424, + -0.0011491207143127223, + -0.0008876399654099 ], "moduleForcesY": [ - 2.410633101239201, - 0.7117166259846383, - -23.90450526901233, - -23.286981568782405 + -0.0053203589783196985, + -0.005461740514528871, + -0.00551336991331991, + -0.005674373284473044 ], - "timestamp": 2.1499946517796493 + "timestamp": 2.1136318189167205 }, { - "x": 9.492019530398496, - "y": 7.343983789856553, - "heading": -0.04944702950219561, - "angularVelocity": 0.35529243243380376, - "velocityX": -2.858033079313581, - "velocityY": 0.8071194115596501, + "x": 9.692382682952024, + "y": 7.2874193702981085, + "heading": -0.0822191306558338, + "angularVelocity": 0.45236981652140956, + "velocityX": -3.4005722771128415, + "velocityY": 0.9602298882053446, "moduleForcesX": [ - 110.11042093282536, - 109.72343096717103, - 111.82904603560874, - 111.57527328961984 + 30.62118617981392, + 47.41130841236055, + 27.280967447136295, + 44.1106943011997 ], "moduleForcesY": [ - -33.86318732230892, - -35.059198202419715, - -27.649683347659746, - -28.608589707922565 + 4.023869535756976, + 2.0544391312139076, + -24.6327470438544, + -24.07754801487098 ], - "timestamp": 2.241420966784843 + "timestamp": 2.2006964790000723 }, { - "x": 9.2960192355485, - "y": 7.399334406788997, - "heading": -0.02482773338497671, - "angularVelocity": 0.2692801970178966, - "velocityX": -2.1438061332654796, - "velocityY": 0.6054123140509308, + "x": 9.455455171491224, + "y": 7.354320907313611, + "heading": -0.04970482150665087, + "angularVelocity": 0.3734501360030033, + "velocityX": -2.721282219834982, + "velocityY": 0.768412085356498, "moduleForcesX": [ - 110.18532231271769, - 109.7167628980199, - 112.06441279220556, - 111.76405509082988 + 110.05417979801821, + 109.63993232178616, + 111.86911447326588, + 111.60403176355511 ], "moduleForcesY": [ - -34.07720649246468, - -35.53661461014457, - -27.26087793372916, - -28.44065406776567 + -34.00135979147741, + -35.27274549289079, + -27.43088810329592, + -28.43649643947654 ], - "timestamp": 2.3328472817900368 + "timestamp": 2.287761139083424 }, { - "x": 9.16534208313775, - "y": 7.436237482881837, - "heading": -0.008305113039109078, - "angularVelocity": 0.18072062015109094, - "velocityX": -1.4293166294991293, - "velocityY": 0.4036373563863185, + "x": 9.277736160829281, + "y": 7.404503175997865, + "heading": -0.0249851504638235, + "angularVelocity": 0.2839231327517031, + "velocityX": -2.0412301672320625, + "velocityY": 0.5763793097705944, "moduleForcesX": [ - 110.21880379377984, - 109.70681368656747, - 112.14833562771497, - 111.81972024066971 + 110.1040648842651, + 109.58272113098381, + 112.14908861391895, + 111.82850771075378 ], "moduleForcesY": [ - -34.1198596453768, - -35.718037584285995, - -27.106350443858066, - -28.413265173608863 + -34.31811935636646, + -35.92513988883449, + -26.882739105964255, + -28.155739191192566 ], - "timestamp": 2.4242735967952305 + "timestamp": 2.374825799166776 + }, + { + "x": 9.159247496299429, + "y": 7.437960457197711, + "heading": -0.008364737523416488, + "angularVelocity": 0.19089735059547008, + "velocityX": -1.3609272053255366, + "velocityY": 0.38428084561307907, + "moduleForcesX": [ + 110.13043304849137, + 109.55438775829175, + 112.24817460065178, + 111.89507958039741 + ], + "moduleForcesY": [ + -34.39052165205634, + -36.16792173997415, + -26.671524840114127, + -28.094624382026243 + ], + "timestamp": 2.4618904592501276 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 3.668994025305924e-20, - "angularVelocity": 0.09083941574848846, - "velocityX": -0.7146966727690923, - "velocityY": 0.2018291634125037, + "heading": 7.242510620075491e-20, + "angularVelocity": 0.096075003513578, + "velocityX": -0.680499943865953, + "velocityY": 0.19215055040122928, "moduleForcesX": [ - 110.23546235943999, - 109.70058243131005, - 112.19103002395251, - 111.8476455542373 + 110.14366836151463, + 109.53867302844944, + 112.29847947682536, + 111.92834686125501 ], "moduleForcesY": [ - -34.1411922801755, - -35.81216376796426, - -27.025531588293937, - -28.399273440528706 + -34.426167314961276, + -36.29325100794249, + -26.561761552149026, + -28.064179245161927 ], - "timestamp": 2.515699911800424 + "timestamp": 2.5489551193334794 }, { "x": 9.1, "y": 7.454689979553223, - "heading": 1.8140975017922662e-20, - "angularVelocity": -5.347539139373239e-21, - "velocityX": 1.1027338008988471e-21, - "velocityY": 1.1228733232906781e-21, + "heading": 3.585471297015955e-20, + "angularVelocity": -1.007056327923224e-20, + "velocityX": 3.7291337159094484e-21, + "velocityY": 1.6506889205384567e-21, + "moduleForcesX": [ + 110.14478533871653, + 109.53077444413167, + 112.32693857060057, + 111.95408720798878 + ], + "moduleForcesY": [ + -34.46921393384191, + -36.36354115442993, + -26.50294273092508, + -28.022875739605002 + ], + "timestamp": 2.636019779416831 + }, + { + "x": 9.165462800190092, + "y": 7.420246784454786, + "heading": 1.0000252535719594e-17, + "angularVelocity": 1.0444752855082387e-16, + "velocityX": 0.6861857407128128, + "velocityY": -0.3610360276753583, "moduleForcesX": [ - 110.23935489778837, - 109.69825354519148, - 112.21511593235195, - 111.8696576656152 + 102.13700666833603, + 102.13700666833603, + 102.13700666833601, + 102.13700666833603 ], "moduleForcesY": [ - -34.173575075339315, - -35.86413648487152, - -26.9832725291903, - -28.370205373579942 + -53.73929677973422, + -53.739296779734225, + -53.73929677973423, + -53.73929677973423 ], - "timestamp": 2.607126226805618 + "timestamp": 2.7314207711688447 }, { - "x": 9.171685854048507, - "y": 7.416972530106804, - "heading": 4.73116158338858e-18, - "angularVelocity": 4.720976000658869e-17, - "velocityX": 0.7180685701633659, - "velocityY": -0.37781115052171915, + "x": 9.296377871427524, + "y": 7.351365934157169, + "heading": 3.1188473540722436e-17, + "angularVelocity": 2.2209644368399916e-16, + "velocityX": 1.3722611142002972, + "velocityY": -0.7220139857315829, "moduleForcesX": [ - 102.13925806744795, - 102.13925806744795, - 102.13925806744794, - 102.13925806744795 + 102.12057878684489, + 102.12057878684489, + 102.12057878684487, + 102.12057878684489 ], "moduleForcesY": [ - -53.74048135140899, - -53.74048135140898, - -53.74048135140899, - -53.74048135140898 + -53.7306532642474, + -53.7306532642474, + -53.730653264247415, + -53.730653264247415 ], - "timestamp": 2.7069577150884125 + "timestamp": 2.8268217629208583 }, { - "x": 9.315046569258698, - "y": 7.341543415111761, - "heading": 2.876637893287952e-17, - "angularVelocity": 2.4075787867618104e-16, - "velocityX": 1.4360270259027919, - "velocityY": -0.755564364435534, + "x": 9.492724224087116, + "y": 7.2480584723333115, + "heading": 4.513674716574335e-17, + "angularVelocity": 1.4620679885932853e-16, + "velocityX": 2.0581164729395796, + "velocityY": -1.082876183220358, "moduleForcesX": [ - 102.12359521012328, - 102.1235952101233, - 102.12359521012328, - 102.12359521012328 + 102.08783014974716, + 102.08783014974716, + 102.08783014974716, + 102.08783014974716 ], "moduleForcesY": [ - -53.73224035271865, - -53.73224035271864, - -53.732240352718655, - -53.732240352718655 + -53.71342259746431, + -53.71342259746431, + -53.7134225974643, + -53.7134225974643 ], - "timestamp": 2.806789203371207 + "timestamp": 2.922222754672872 }, { - "x": 9.530060249336586, - "y": 7.228414155284034, - "heading": 4.9619729837040083e-17, - "angularVelocity": 2.0888550553958917e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246714, + "x": 9.754439455027212, + "y": 7.11035723234165, + "heading": 4.2267360158652724e-17, + "angularVelocity": -3.007711940252278e-17, + "velocityX": 2.743317717497125, + "velocityY": -1.4433942191041786, "moduleForcesX": [ - 102.09239698765673, - 102.09239698765673, - 102.09239698765673, - 102.09239698765673 + 101.99046691326761, + 101.99046691326761, + 101.99046691326761, + 101.99046691326761 ], "moduleForcesY": [ - -53.71582543523849, - -53.71582543523849, - -53.71582543523849, - -53.71582543523849 + -53.662195015696604, + -53.662195015696604, + -53.66219501569659, + -53.6621950156966 ], - "timestamp": 2.906620691654002 + "timestamp": 3.0176237464248854 }, { - "x": 9.81666193347748, - "y": 7.077618929694229, - "heading": 5.975283971937042e-17, - "angularVelocity": 1.0150214177102703e-16, - "velocityX": 2.870854567739517, - "velocityY": -1.510497621378186, + "x": 10.072897912662654, + "y": 6.942800593223961, + "heading": 1.7008792193577606e-17, + "angularVelocity": -2.647621111076902e-16, + "velocityX": 3.3381042669163024, + "velocityY": -1.7563406421731869, "moduleForcesX": [ - 101.99983969748537, - 101.99983969748537, - 101.99983969748537, - 101.99983969748537 + 88.53246892183445, + 88.53246892183445, + 88.53246892183445, + 88.53246892183445 ], "moduleForcesY": [ - -53.667126497919924, - -53.66712649791993, - -53.66712649791992, - -53.667126497919924 + -46.58128113625249, + -46.58128113625251, + -46.58128113625249, + -46.581281136252485 ], - "timestamp": 3.0064521799367965 + "timestamp": 3.113024738176899 }, { - "x": 10.167455917956454, - "y": 6.893048981392569, - "heading": 5.19391181641435e-17, - "angularVelocity": -7.826910822496646e-17, - "velocityX": 3.5138611124906114, - "velocityY": -1.8488149528415818, + "x": 10.391358109467166, + "y": 6.775243039043985, + "heading": 1.964059559448171e-17, + "angularVelocity": 2.7586750815932474e-17, + "velocityX": 3.3381224970105308, + "velocityY": -1.75635023392133, "moduleForcesX": [ - 91.46231173778877, - 91.46231173778874, - 91.46231173778877, - 91.46231173778875 + 0.0027135032766586317, + 0.002713503276605032, + 0.002713503276550828, + 0.0027135032764971424 ], "moduleForcesY": [ - -48.12281537286678, - -48.12281537286678, - -48.12281537286676, - -48.12281537286676 + -0.0014277073770695113, + -0.0014277073770064686, + -0.0014277073771330811, + -0.0014277073770701714 ], - "timestamp": 3.106283668219591 + "timestamp": 3.2084257299289125 }, { - "x": 10.518252161317257, - "y": 6.70847784458221, - "heading": 3.766456124956393e-17, - "angularVelocity": -1.4298651827732539e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901475, + "x": 10.709818306284792, + "y": 6.607685484857109, + "heading": -3.8538311178504195e-18, + "angularVelocity": -2.462702566883343e-16, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936556, "moduleForcesX": [ - 0.003218494319225325, - 0.003218494319216094, - 0.003218494319193459, - 0.003218494319184196 + 2.0460973813009118e-8, + 2.0460961354645526e-8, + 2.0460963129610995e-8, + 2.0460950665772818e-8 ], "moduleForcesY": [ - -0.0016934079727223925, - -0.0016934079727399663, - -0.0016934079727242658, - -0.0016934079727418635 + -1.0765500981855737e-8, + -1.0765504080928475e-8, + -1.0765488096575326e-8, + -1.0765491204163331e-8 ], - "timestamp": 3.2061151565023858 + "timestamp": 3.303826721680926 }, { - "x": 10.869048404693604, - "y": 6.523906707763672, - "heading": 2.2701290589411372e-17, - "angularVelocity": -1.4988528093015713e-16, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 11.028278503102417, + "y": 6.440127930670234, + "heading": -1.300020909937592e-17, + "angularVelocity": -9.58729864932316e-17, + "velocityX": 3.3381224971479946, + "velocityY": -1.756350233993656, "moduleForcesX": [ - 2.214842103369335e-8, - 2.214841971652397e-8, - 2.2148399662466356e-8, - 2.2148398355512985e-8 + 1.4474838704178555e-13, + 1.5068927215576243e-13, + 1.408186230548463e-13, + 1.4675794469346446e-13 ], "moduleForcesY": [ - -1.1653376600724734e-8, - -1.1653388805406456e-8, - -1.165337704047802e-8, - -1.165338925383615e-8 + -8.907551463496866e-14, + -9.211214882671091e-14, + -9.682450585984768e-14, + -9.985744234971747e-14 ], - "timestamp": 3.3059466447851804 + "timestamp": 3.3992277134329396 }, { - "x": 11.219844648069952, - "y": 6.339335570945134, - "heading": 3.061231332790382e-17, - "angularVelocity": 7.924376236807535e-17, - "velocityX": 3.513883739593664, - "velocityY": -1.8488268580720741, + "x": 11.346738699920042, + "y": 6.272570376483358, + "heading": -1.6034884829107134e-17, + "angularVelocity": -3.180968750998064e-17, + "velocityX": 3.3381224971479937, + "velocityY": -1.7563502339936554, "moduleForcesX": [ - 8.153502180996974e-15, - 1.7251673005843974e-14, - -1.58855310989108e-15, - 7.507130962539776e-15 + -1.6409175526761825e-13, + -1.6159239329690174e-13, + -1.6616883137339107e-13, + -1.6366371958278699e-13 ], "moduleForcesY": [ - -2.8417399270339567e-16, - -8.464949440223293e-15, - -1.1231547709612304e-14, - -1.9406448996208048e-14 + 9.856885441627709e-14, + 9.702579680058777e-14, + 9.524682094901744e-14, + 9.370612817889214e-14 ], - "timestamp": 3.405778133067975 + "timestamp": 3.494628705184953 }, { - "x": 11.570640891430754, - "y": 6.1547644341347745, - "heading": 1.903661500367957e-17, - "angularVelocity": -1.1595237656501265e-16, - "velocityX": 3.513883739437954, - "velocityY": -1.8488268579901472, + "x": 11.665198896724554, + "y": 6.105012822303383, + "heading": -3.327196466558203e-18, + "angularVelocity": 1.33202895790123e-16, + "velocityX": 3.3381224970105308, + "velocityY": -1.7563502339213297, "moduleForcesX": [ - -2.2148468458536655e-8, - -2.2148476648513925e-8, - -2.2148474908807252e-8, - -2.2148483100357075e-8 + -2.046097600304392e-8, + -2.046096833033551e-8, + -2.0460974922422488e-8, + -2.0460967227223523e-8 ], "moduleForcesY": [ - 1.1653415936522858e-8, - 1.1653413493871686e-8, - 1.165342493176425e-8, - 1.1653422488553742e-8 + 1.0765497780128575e-8, + 1.0765495712162903e-8, + 1.0765490146356085e-8, + 1.0765488084589651e-8 ], - "timestamp": 3.5056096213507697 + "timestamp": 3.5900296969369667 }, { - "x": 11.921434875909728, - "y": 5.970194485833114, - "heading": 2.2015567565585324e-17, - "angularVelocity": 2.9839809238463793e-17, - "velocityX": 3.513861112490612, - "velocityY": -1.8488149528415816, + "x": 11.983657354359996, + "y": 5.937456183185693, + "heading": -1.2837192767441167e-17, + "angularVelocity": -9.968445945953903e-17, + "velocityX": 3.338104266916303, + "velocityY": -1.7563406421731866, "moduleForcesX": [ - -0.0032184943191482383, - -0.003218494319154078, - -0.003218494319166007, - -0.0032184943191717096 + -0.002713503276636462, + -0.0027135032765821195, + -0.002713503276540376, + -0.0027135032764861538 ], "moduleForcesY": [ - 0.0016934079727123717, - 0.0016934079727241181, - 0.0016934079726967873, - 0.001693407972708547 + 0.0014277073770852346, + 0.0014277073770136435, + 0.0014277073771445043, + 0.0014277073770729747 ], - "timestamp": 3.6054411096335643 + "timestamp": 3.6854306886889803 }, { - "x": 12.208036560050623, - "y": 5.819399260243309, - "heading": 1.715956257076988e-17, - "angularVelocity": -4.864201740947202e-17, - "velocityX": 2.8708545677395176, - "velocityY": -1.510497621378186, + "x": 12.245372585300093, + "y": 5.799754943194032, + "heading": 8.061487264185827e-18, + "angularVelocity": 2.1906145481338784e-16, + "velocityX": 2.7433177174971255, + "velocityY": -1.4433942191041782, "moduleForcesX": [ - -91.4623117377888, - -91.4623117377888, - -91.46231173778881, - -91.46231173778878 + -88.53246892183448, + -88.53246892183445, + -88.53246892183448, + -88.53246892183448 ], "moduleForcesY": [ - 48.122815372866775, - 48.12281537286678, - 48.12281537286677, - 48.122815372866796 + 46.581281136252514, + 46.58128113625253, + 46.5812811362525, + 46.58128113625251 ], - "timestamp": 3.705272597916359 + "timestamp": 3.780831680440994 }, { - "x": 12.42305024012851, - "y": 5.706270000415583, - "heading": 4.0500799094748495e-18, - "angularVelocity": -1.3131610960667952e-16, - "velocityX": 2.1537661491013114, - "velocityY": -1.1332021767246712, + "x": 12.441718937959685, + "y": 5.696447481370175, + "heading": -6.661113737991722e-19, + "angularVelocity": -9.14833112894713e-17, + "velocityX": 2.05811647293958, + "velocityY": -1.0828761832203577, "moduleForcesX": [ - -101.99983969748537, - -101.99983969748537, - -101.99983969748537, - -101.99983969748537 + -101.99046691326761, + -101.99046691326762, + -101.99046691326761, + -101.99046691326761 ], "moduleForcesY": [ - 53.667126497919924, - 53.667126497919924, - 53.66712649791993, - 53.66712649791993 + 53.66219501569659, + 53.66219501569659, + 53.66219501569661, + 53.662195015696604 ], - "timestamp": 3.8051040861991536 + "timestamp": 3.8762326721930074 }, { - "x": 12.566410955338702, - "y": 5.63084088542054, - "heading": -3.708075207453893e-18, - "angularVelocity": -7.771250580976826e-17, - "velocityX": 1.4360270259027916, - "velocityY": -0.7555643644355339, + "x": 12.572634009197117, + "y": 5.627566631072558, + "heading": -3.887549896896706e-19, + "angularVelocity": 2.907269528625613e-18, + "velocityX": 1.3722611142002974, + "velocityY": -0.7220139857315828, "moduleForcesX": [ - -102.09239698765673, - -102.09239698765673, - -102.09239698765673, - -102.09239698765673 + -102.08783014974718, + -102.08783014974716, + -102.08783014974716, + -102.08783014974716 ], "moduleForcesY": [ - 53.715825435238486, - 53.715825435238486, - 53.715825435238486, - 53.71582543523849 + 53.7134225974643, + 53.7134225974643, + 53.7134225974643, + 53.71342259746431 ], - "timestamp": 3.9049355744819483 + "timestamp": 3.971633663945021 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.613826982610023e-18, - "angularVelocity": 9.440731598697995e-19, - "velocityX": 0.718068570163366, - "velocityY": -0.3778111505217191, + "heading": 4.421333072969964e-19, + "angularVelocity": 8.70943051994905e-18, + "velocityX": 0.6861857407128128, + "velocityY": -0.36103602767535825, "moduleForcesX": [ - -102.1235952101233, - -102.12359521012328, - -102.1235952101233, - -102.1235952101233 + -102.12057878684487, + -102.12057878684489, + -102.12057878684489, + -102.12057878684489 ], "moduleForcesY": [ - 53.73224035271864, - 53.73224035271865, - 53.73224035271864, - 53.73224035271865 + 53.73065326424741, + 53.73065326424741, + 53.7306532642474, + 53.73065326424741 ], - "timestamp": 4.004767062764743 + "timestamp": 4.067034655697034 }, { "x": 12.638096809387209, "y": 5.593123435974121, - "heading": -3.5546712678246825e-18, - "angularVelocity": 5.925557111968679e-19, - "velocityX": 4.845232015144286e-18, - "velocityY": -3.784642229218748e-18, + "heading": 4.2336552415027816e-19, + "angularVelocity": -1.9672511354829974e-19, + "velocityX": 4.977758444457901e-18, + "velocityY": 1.6190413361646781e-18, "moduleForcesX": [ - -102.13925806744795, - -102.13925806744795, - -102.13925806744795, - -102.13925806744794 + -102.13700666833603, + -102.13700666833603, + -102.13700666833603, + -102.13700666833603 ], "moduleForcesY": [ - 53.74048135140898, - 53.74048135140899, - 53.740481351408974, - 53.74048135140899 + 53.73929677973424, + 53.73929677973423, + 53.739296779734225, + 53.739296779734225 ], - "timestamp": 4.104598551047538 + "timestamp": 4.162435647449048 }, { - "x": 12.635601743595934, - "y": 5.59148869514806, - "heading": -0.040469209324330645, - "angularVelocity": -1.1653411306828494, - "velocityX": -0.07184728436451648, - "velocityY": -0.047073583952371864, + "x": 12.635716300422908, + "y": 5.591477621529516, + "heading": -0.04053440079408721, + "angularVelocity": -1.1690740956944317, + "velocityX": -0.06865751831067732, + "velocityY": -0.047467805020289744, "moduleForcesX": [ - 6.715898232782912, - -74.23634164667784, - 61.50244174016689, - -111.49692422807281 + 8.096498399631756, + -73.90381849216459, + 64.47066032298743, + -111.13955678681945 ], "moduleForcesY": [ - -115.15629744618346, - -88.32054795571801, - 97.03134384991834, - 29.45095987898999 + -115.06817413543638, + -88.5992032674739, + 95.13273018745403, + 30.771872674752988 ], - "timestamp": 4.139325901055871 + "timestamp": 4.197107873053371 }, { - "x": 12.630989153588672, - "y": 5.587957161161052, - "heading": -0.12142442884644973, - "angularVelocity": -2.3311660550745135, - "velocityX": -0.13282297688005926, - "velocityY": -0.10169316075544019, + "x": 12.63128685127921, + "y": 5.587940767261187, + "heading": -0.12156201076160397, + "angularVelocity": -2.33696016206742, + "velocityX": -0.12775208589855394, + "velocityY": -0.102008284922097, "moduleForcesX": [ - 0.99135751533034, - -78.3059668743301, - 87.10790717980457, - -109.52641997223697 + 2.2065963342952273, + -78.0409085702254, + 88.10645679121941, + -109.08213048053173 ], "moduleForcesY": [ - -115.3287239283564, - -84.70847062161553, - 74.72643789735397, - 35.97383073297602 + -115.31231038297804, + -84.95264569095009, + 73.61772559553323, + 37.297848510277355 ], - "timestamp": 4.174053251064205 + "timestamp": 4.231780098657694 }, { - "x": 12.624509421807858, - "y": 5.58199542338269, - "heading": -0.24205524013552657, - "angularVelocity": -3.4736543750136, - "velocityX": -0.18658871982052855, - "velocityY": -0.17167269535197777, + "x": 12.625028987271739, + "y": 5.582022220388997, + "heading": -0.2423139565639912, + "angularVelocity": -3.48267074575483, + "velocityX": -0.18048636620236289, + "velocityY": -0.17069994120746917, "moduleForcesX": [ - -7.591385688898406, - -84.0456517158906, - 109.52068801281428, - -105.82402794572394 + -6.5867304178653185, + -83.86452574104914, + 109.29775219994504, + -105.23692315428146 ], "moduleForcesY": [ - -115.05554501752215, - -78.97617075986716, - 34.00596685578571, - 45.5657537319174 + -115.11732618046953, + -79.16769136400295, + 34.85061884596746, + 46.9022565810502 ], - "timestamp": 4.208780601072538 + "timestamp": 4.266452324262017 }, { - "x": 12.61601333895309, - "y": 5.573089966082191, - "heading": -0.40091737527763976, - "angularVelocity": -4.574553920871888, - "velocityX": -0.24465105609063115, - "velocityY": -0.2564392992371348, + "x": 12.61679879499125, + "y": 5.573228753463621, + "heading": -0.4014079147959288, + "angularVelocity": -4.588513008870753, + "velocityX": -0.23737132927115676, + "velocityY": -0.25361703127242496, "moduleForcesX": [ - -18.72557620909359, - -90.96637263149834, - 113.95654026368184, - -99.23256696756765 + -17.998694570457108, + -90.87202731423554, + 114.15847162607923, + -98.47791423254111 ], "moduleForcesY": [ - -113.7295099024964, - -70.81659924554228, - -12.395836704635942, - 58.295909852584266 + -113.84541579014022, + -70.93479429110369, + -10.61021875597528, + 59.55387651430768 ], - "timestamp": 4.243507951080872 + "timestamp": 4.301124549866341 }, { - "x": 12.605082130208535, - "y": 5.561092759135586, - "heading": -0.5968969422163409, - "angularVelocity": -5.643378112400488, - "velocityX": -0.31477232619048406, - "velocityY": -0.3454685411851268, + "x": 12.606171501564956, + "y": 5.561383158190227, + "heading": -0.597641326297266, + "angularVelocity": -5.659671627104043, + "velocityX": -0.3065073914657803, + "velocityY": -0.3416450795104292, "moduleForcesX": [ - -32.04770801640716, - -98.43585145612518, - 103.26614786567647, - -87.47440914613598 + -31.702182349069048, + -98.39402131426678, + 103.64312194332079, + -86.80709567336851 ], "moduleForcesY": [ - -110.62167229916327, - -59.81255295495651, - -49.50954102303336, - 74.32567001715357 + -110.71556436707718, + -59.87033716863823, + -48.704407218405564, + 75.08087531888812 ], - "timestamp": 4.278235301089206 + "timestamp": 4.335796775470664 }, { - "x": 12.591329218838723, - "y": 5.546283772243203, - "heading": -0.8296689344895842, - "angularVelocity": -6.702843499932593, - "velocityX": -0.39602536233005076, - "velocityY": -0.42643584635250353, + "x": 12.59265174321713, + "y": 5.546665747496571, + "heading": -0.8301729234385428, + "angularVelocity": -6.706566800611855, + "velocityX": -0.3899305023598048, + "velocityY": -0.4244726272149572, "moduleForcesX": [ - -47.31647496655648, - -105.61081086052921, - 85.39422216677532, - -65.36610720874525 + -47.633339347555925, + -105.47445484854185, + 83.83071395151596, + -67.38844623517069 ], "moduleForcesY": [ - -104.70081415220629, - -45.20977101766445, - -75.5707601247976, - 93.04952199931408 + -104.5242317395292, + -45.44976016477657, + -77.1734046395607, + 91.457534433043 ], - "timestamp": 4.312962651097539 + "timestamp": 4.370469001074987 }, { - "x": 12.572042639393677, - "y": 5.534219720600946, - "heading": -1.073814547044594, - "angularVelocity": -7.030355397011889, - "velocityX": -0.5553714706252239, - "velocityY": -0.3473933841586206, + "x": 12.572877030087271, + "y": 5.534422452953114, + "heading": -1.0590948047093973, + "angularVelocity": -6.602457075680554, + "velocityX": -0.5703329620523357, + "velocityY": -0.35311533453825095, "moduleForcesX": [ - -82.71377263272161, - -84.82446387482808, - -42.35353791946482, - -50.7380639123641 + -69.11423919609621, + -67.8872625428816, + -79.57383821530136, + -78.96383219960605 ], "moduleForcesY": [ - -3.3792218912464422, - 29.67111027754918, - 37.553509843725166, - 65.43811150826103 + 41.078313605626754, + 30.388799241217356, + 28.281282661879363, + 17.150649220262693 ], - "timestamp": 4.347690001105873 + "timestamp": 4.40514122667931 }, { - "x": 12.559986566266332, - "y": 5.526755385653593, - "heading": -1.330510420929693, - "angularVelocity": -7.391749552542837, - "velocityX": -0.34716363685831114, - "velocityY": -0.21494110392994975, + "x": 12.560233187149112, + "y": 5.526847142047006, + "heading": -1.3004735728523615, + "angularVelocity": -6.961732739558218, + "velocityX": -0.36466776267695544, + "velocityY": -0.21848354912537238, "moduleForcesX": [ - 105.72590475429266, - 37.456143843089066, - 110.13783644093012, - 87.22921676430109 + 105.17188805717923, + 36.64629093835158, + 109.3871868445873, + 85.71976737512696 ], "moduleForcesY": [ - 16.762047005929656, - 104.18797300994257, - 23.903310122839276, - 71.78839869306294 + 17.180702657687426, + 103.98341170708088, + 26.15382218906551, + 73.23873697676419 ], - "timestamp": 4.382417351114206 + "timestamp": 4.439813452283634 }, { - "x": 12.554805000117685, - "y": 5.5258948814498945, - "heading": -1.5817192983329285, - "angularVelocity": -7.233747387662799, - "velocityX": -0.14920707014510395, - "velocityY": -0.024778861718294874, + "x": 12.554266136797898, + "y": 5.525513029563462, + "heading": -1.5511519906743647, + "angularVelocity": -7.2299488553959, + "velocityX": -0.17209885570398845, + "velocityY": -0.03847784387333178, "moduleForcesX": [ - 85.10006434406202, - 98.91322895268817, - 60.59757319762427, - 79.17104780949104 + 79.29225853022504, + 41.96175012878335, + 107.32093626149006, + 86.89556166997258 ], "moduleForcesY": [ - 76.28924255238852, - 56.8610964875441, - 96.53986801348239, - 81.3431465448386 + 78.39773568550407, + 105.27165483766125, + 37.43702182189581, + 73.78278818931089 ], - "timestamp": 4.41714470112254 + "timestamp": 4.474485677887957 }, { - "x": 12.553693111577713, - "y": 5.531340138988141, - "heading": -1.8090738890833113, - "angularVelocity": -6.546845373914893, - "velocityX": -0.032017661575237936, - "velocityY": 0.15680026080135756, + "x": 12.553234089263041, + "y": 5.53083198575942, + "heading": -1.783366315606556, + "angularVelocity": -6.69741618499501, + "velocityX": -0.029765828898134138, + "velocityY": 0.15340682933530048, "moduleForcesX": [ - 93.64139046456043, - 114.77127776967987, - 11.773017615907161, - -28.508230169372723 + 91.37221926721882, + 113.32252584700692, + 19.278349706082533, + 9.199917255318628 ], "moduleForcesY": [ - 66.90444420135348, - 5.619126084548563, - 114.36468781389611, - 110.10636482779223 + 69.7968364317707, + 18.15978259725049, + 113.19848312438963, + 113.19447803386177 ], - "timestamp": 4.451872051130874 + "timestamp": 4.50915790349228 }, { - "x": 12.556050432946392, - "y": 5.5420473258338605, - "heading": -2.005506504495854, - "angularVelocity": -5.656423981829998, - "velocityX": 0.06788083076058496, - "velocityY": 0.30832144817123774, + "x": 12.555779264328171, + "y": 5.54162936928793, + "heading": -1.9860033843796512, + "angularVelocity": -5.8443628939651955, + "velocityX": 0.07340674043181038, + "velocityY": 0.31141305008017556, "moduleForcesX": [ - 100.73960236681776, - 113.64668162060796, - 12.572866576727497, - -63.56308029676134 + 99.46991245107658, + 114.32669032012043, + 12.885145778988177, + -57.662236395363905 ], "moduleForcesY": [ - 55.95250024879295, - -18.155758880065523, - 114.50709600750906, - 95.52739610484751 + 58.11499274397129, + -12.760758459450766, + 114.43208308109202, + 99.062856607364 ], - "timestamp": 4.486599401139207 + "timestamp": 4.543830129096603 }, { - "x": 12.56203010772394, - "y": 5.557428390445447, - "heading": -2.1690558980603147, - "angularVelocity": -4.709527030574263, - "velocityX": 0.1721892046502874, - "velocityY": 0.44290925186907815, + "x": 12.56191803403241, + "y": 5.557168661278036, + "heading": -2.156099967433693, + "angularVelocity": -4.905845531670559, + "velocityX": 0.17705150440276152, + "velocityY": 0.4481769404548373, "moduleForcesX": [ - 105.74765097197235, - 109.64221257829823, - 19.07370797888986, - -63.85460645824819 + 105.08894599974387, + 110.32756561762763, + 18.126645587310904, + -63.75008567857288 ], "moduleForcesY": [ - 45.943867600773586, - -35.22297007233559, - 113.69565987258666, - 95.71807842731238 + 47.393531907484665, + -32.91770130594804, + 113.83333151918828, + 95.74037140980943 ], - "timestamp": 4.521326751147541 + "timestamp": 4.578502354700927 }, { - "x": 12.57182488488311, - "y": 5.577061809180295, - "heading": -2.2988461247392196, - "angularVelocity": -3.7374065872506375, - "velocityX": 0.2820479292782165, - "velocityY": 0.5653589672156297, + "x": 12.571808374354218, + "y": 5.5769573204468506, + "heading": -2.292448340929877, + "angularVelocity": -3.9324955672641906, + "velocityX": 0.2852525371366751, + "velocityY": 0.5707351871391592, "moduleForcesX": [ - 109.05462491040085, - 104.57283217895744, - 25.584631264200784, - -59.524853150368294 + 108.78605491561635, + 104.6850804882193, + 24.525066052249105, + -60.73895288598403 ], "moduleForcesY": [ - 37.52781331032903, - -48.329200017604535, - 112.45689047019695, - 98.62582006054753 + 38.272268020461155, + -48.04212290386911, + 112.68375035926043, + 97.86364839715985 ], - "timestamp": 4.556054101155874 + "timestamp": 4.61317458030525 }, { "x": 12.585567474365234, "y": 5.600627422332764, "heading": -2.3943443337005537, - "angularVelocity": -2.749942305946666, - "velocityX": 0.395728135859107, - "velocityY": 0.6785894445390662, + "angularVelocity": -2.938836229710392, + "velocityX": 0.3968334818778352, + "velocityY": 0.6826819297969253, "moduleForcesX": [ - 111.09605990584453, - 99.46866631123623, - 30.695272549126692, - -55.32226749334036 + 111.07132972844772, + 98.70912927254115, + 29.84347118911907, + -56.82963740078154 ], "moduleForcesY": [ - 31.048087478724806, - -58.16713625641179, - 111.19928569615168, - 101.12190774409382 + 31.11456084047184, + -59.42057702877722, + 111.42567305703156, + 100.27389389986291 ], - "timestamp": 4.590781451164208 + "timestamp": 4.647846805909573 }, { - "x": 12.609275137181715, - "y": 5.6362066530252655, - "heading": -2.4596016370427427, - "angularVelocity": -1.490768209280979, - "velocityX": 0.5415888832830659, - "velocityY": 0.8127885050494357, + "x": 12.609526436019335, + "y": 5.636699135016749, + "heading": -2.467431135675984, + "angularVelocity": -1.651944625216517, + "velocityX": 0.541532490962821, + "velocityY": 0.8153109765384976, "moduleForcesX": [ - 112.32207187573187, - 95.02943454284713, - 34.23111294482213, - -52.31611898637682 + 112.47606598208289, + 93.16011868734647, + 33.78704517737306, + -53.65287917781383 ], "moduleForcesY": [ - 26.427771988717435, - -65.28675950904486, - 110.20104060720472, - 102.79243467120517 + 25.753841947921746, + -67.91573899096902, + 110.33638895218567, + 102.09996040314151 ], - "timestamp": 4.63455573004668 + "timestamp": 4.6920896944784625 }, { - "x": 12.640376756629546, - "y": 5.67868110060817, - "heading": -2.4756065131625133, - "angularVelocity": -0.36562283899049025, - "velocityX": 0.7104998698284803, - "velocityY": 0.9703060488316174, + "x": 12.640768978131616, + "y": 5.679449457084365, + "heading": -2.4883261932610017, + "angularVelocity": -0.4722805915459653, + "velocityX": 0.7061596365624881, + "velocityY": 0.9662642619061936, "moduleForcesX": [ - 110.97907601877183, - 106.0264798075326, - 38.76392005053645, - -36.59336535164529 + 111.543250115618, + 102.57136846109823, + 37.93524392979517, + -40.69497651884954 ], "moduleForcesY": [ - 31.540733116048838, - -45.18048489661897, - 108.67557062608937, - 109.35634824645632 + 29.466868137611527, + -52.52564969838117, + 108.96449307890866, + 107.89412812639198 ], - "timestamp": 4.6783300089291515 + "timestamp": 4.736332583047352 }, { - "x": 12.67988915693076, - "y": 5.729664244872592, - "heading": -2.451631970535245, - "angularVelocity": 0.5476856098906139, - "velocityX": 0.9026396621471977, - "velocityY": 1.164682675899803, + "x": 12.680234323228891, + "y": 5.730326735350004, + "heading": -2.464857721548348, + "angularVelocity": 0.5304461908293124, + "velocityX": 0.8920155616834367, + "velocityY": 1.1499538097838968, "moduleForcesX": [ - 107.73349084432316, - 114.74365869825861, - 42.57429428279717, - -15.73401800942879 + 108.92191896913738, + 112.92169627828845, + 40.83914052431152, + -24.073517173914706 ], "moduleForcesY": [ - 41.23196001279386, - -10.435058862443286, - 107.21934325723095, - 114.20366129024539 + 37.95851016971204, + -22.74755439175256, + 107.88598647473655, + 112.73101496176483 ], - "timestamp": 4.722104287811623 + "timestamp": 4.780575471616241 }, { - "x": 12.728715540940653, - "y": 5.790966829650067, - "heading": -2.400757331938542, - "angularVelocity": 1.1622039219262574, - "velocityX": 1.1154126408566907, - "velocityY": 1.4004247778030527, + "x": 12.728861058925617, + "y": 5.791245681753849, + "heading": -2.409256654879776, + "angularVelocity": 1.2567232490256017, + "velocityX": 1.0990859157175115, + "velocityY": 1.3769206390986344, "moduleForcesX": [ - 101.36053530623595, - 110.66151469383205, - 48.45480141271534, - 15.613856789127393 + 103.43030407712452, + 113.54722733635009, + 45.305379884050836, + 3.5622560281788673 ], "moduleForcesY": [ - 55.00994604222918, - 32.04293220940848, - 104.66041275307694, - 114.18177265531891 + 50.97945546219835, + 19.2011880487645, + 106.04826799334413, + 115.16014318689237 ], - "timestamp": 4.765878566694095 + "timestamp": 4.82481836018513 }, { "x": 12.787519454956056, "y": 5.863831043243408, "heading": -2.338954063654469, - "angularVelocity": 1.4118626248534205, - "velocityX": 1.3433439799952491, - "velocityY": 1.664544007428914, + "angularVelocity": 1.5890144947439437, + "velocityX": 1.3258265436060839, + "velocityY": 1.6406108153751708, "moduleForcesX": [ - 89.0095262170121, - 91.58391515691522, - 60.88263773717486, - 54.28386759761477 + 91.90028015401259, + 96.27958972310033, + 56.8579037507402, + 46.06087466370149 ], "moduleForcesY": [ - 73.26063193173053, - 69.9179774586011, - 97.89690993994556, - 101.64123727775404 + 69.54780453921919, + 63.17742305853098, + 100.25336076622867, + 105.5573617066181 ], - "timestamp": 4.809652845576567 + "timestamp": 4.8690612487540195 }, { - "x": 12.915220320349816, - "y": 6.020393862485399, - "heading": -2.2550043978645964, - "angularVelocity": 1.1361394897718229, - "velocityX": 1.7282498350266056, - "velocityY": 2.11885538670354, + "x": 12.914711706648111, + "y": 6.019663725891664, + "heading": -2.24237574365633, + "angularVelocity": 1.2998708875413283, + "velocityX": 1.7119111732169021, + "velocityY": 2.097389636782225, "moduleForcesX": [ - 62.139752976635314, - 64.01795106751091, - 85.86840122939797, - 83.8579203826501 + 61.50166852819614, + 63.359586176485415, + 86.30910394415389, + 83.98957274568104 ], "moduleForcesY": [ - 97.1381071719754, - 95.94171307643394, - 76.96736480457938, - 79.19011036368791 + 97.48422295362255, + 96.32955114118775, + 76.39900626600664, + 78.99253694196852 ], - "timestamp": 4.883543126255687 + "timestamp": 4.943359643251348 }, { - "x": 13.071197496085677, - "y": 6.210363644739984, - "heading": -2.1966884800371806, - "angularVelocity": 0.7892231196232886, - "velocityX": 2.1109295336583713, - "velocityY": 2.5709711819820673, + "x": 13.070533718168743, + "y": 6.2093375039790075, + "heading": -2.1683147361300525, + "angularVelocity": 0.9968049515382151, + "velocityX": 2.0972460115034464, + "velocityY": 2.5528650971611744, "moduleForcesX": [ - 58.99376208477216, - 60.82496922096946, - 89.12126008495656, - 85.23274796355747 + 61.44436515676362, + 62.09781410875336, + 87.31016658655857, + 83.73437350844729 ], "moduleForcesY": [ - 98.97383223128598, - 97.91898127763481, - 73.04209646880699, - 77.61460069122454 + 97.27543927473157, + 96.94974979682499, + 74.95382044646945, + 79.02989424707079 ], - "timestamp": 4.957433406934808 + "timestamp": 5.017658037748677 }, { - "x": 13.254669522546797, - "y": 6.4329309171083375, - "heading": -2.182092105367393, - "angularVelocity": 0.19754119940584156, - "velocityX": 2.4830332863110116, - "velocityY": 3.01213191129812, + "x": 13.250688758689678, + "y": 6.423961245560544, + "heading": -2.168369530757999, + "angularVelocity": -0.000737494104917048, + "velocityX": 2.424750113912751, + "velocityY": 2.8886726696261475, "moduleForcesX": [ - 45.294275725710335, - 52.25945512194472, - 98.3308784358966, - 90.15821094756855 + 18.853251410044052, + 40.74857935885112, + 98.53054513091199, + 92.24301069870756 ], "moduleForcesY": [ - 105.58458947812339, - 102.52257021365493, - 59.49254286882577, - 71.52845266276242 + 93.15672622133015, + 96.3145956066308, + 16.04638677085443, + 51.20564283434744 ], - "timestamp": 5.031323687613928 + "timestamp": 5.091956432246006 }, { - "x": 13.426157527489098, - "y": 6.635690019593373, - "heading": -2.2383487439162617, - "angularVelocity": -0.7613536994557007, - "velocityX": 2.3208465763855206, - "velocityY": 2.7440564661751172, + "x": 13.423176073078626, + "y": 6.629426011222936, + "heading": -2.205069527388233, + "angularVelocity": -0.4939541006037903, + "velocityX": 2.3215483397174745, + "velocityY": 2.7653998051031623, "moduleForcesX": [ - -67.52985880281344, - -56.50694068718355, - -16.560789556088512, - 15.921759844219237 + -39.5712782056326, + -27.481431549028095, + -13.336470845500253, + 1.4918968052180324 ], "moduleForcesY": [ - -46.19772680900119, - -13.18456476681599, - -81.95175795997638, - -64.74034721794925 + -22.657178376987773, + -3.7073202434867, + -42.427565932456204, + -25.44947588882923 ], - "timestamp": 5.105213968293048 + "timestamp": 5.166254826743335 }, { - "x": 13.569140494720084, - "y": 6.804691723426313, - "heading": -2.286189319497097, - "angularVelocity": -0.6474542408167393, - "velocityX": 1.9350713776810868, - "velocityY": 2.2871980222521517, + "x": 13.567172688216592, + "y": 6.8006505476140005, + "heading": -2.2561686473851945, + "angularVelocity": -0.6877553726789927, + "velocityX": 1.9380851512631625, + "velocityY": 2.304552306271156, "moduleForcesX": [ - -69.36641281157236, - -69.8462676272357, - -78.77988767550748, - -78.5597375960959 + -80.49825287187927, + -81.46564305418251, + -66.09113775652278, + -65.10081795177926 ], "moduleForcesY": [ - -91.78872830593477, - -91.46262829883032, - -83.84776974221282, - -84.0961432909433 + -82.1976309213605, + -81.15783169411546, + -94.17140740263714, + -94.78893254492681 ], - "timestamp": 5.179104248972169 + "timestamp": 5.240553221240663 }, { - "x": 13.683554684215164, - "y": 6.939904549706659, - "heading": -2.324810505911234, - "angularVelocity": -0.5226829030715882, - "velocityX": 1.5484335482759755, - "velocityY": 1.8299135561215278, + "x": 13.682388889273712, + "y": 6.937545900604296, + "heading": -2.303654079550955, + "angularVelocity": -0.6391178771361977, + "velocityX": 1.5507226210825065, + "velocityY": 1.842507552370002, "moduleForcesX": [ - -68.91646548695905, - -69.76232758546394, - -79.27764146129155, - -79.25899084877969 + -72.01424178451583, + -72.18570029563371, + -75.94750024233308, + -75.98943820596466 ], "moduleForcesY": [ - -92.3862498475593, - -91.77011872190114, - -83.6626902945486, - -83.70370167635772 + -89.99403758231816, + -89.86507715449537, + -86.69993664252142, + -86.67204720164708 ], - "timestamp": 5.252994529651289 + "timestamp": 5.314851615737992 }, { - "x": 13.769378113017817, - "y": 7.041319186543625, - "heading": -2.3539370497277994, - "angularVelocity": -0.3941864010918041, - "velocityX": 1.1614982107776157, - "velocityY": 1.3725030667751, + "x": 13.768802126651249, + "y": 7.040166816408869, + "heading": -2.3421837029749835, + "angularVelocity": -0.5185794886242573, + "velocityX": 1.1630565904172108, + "velocityY": 1.3811996409728973, "moduleForcesX": [ - -68.69416422988444, - -69.80382238745496, - -79.38562401155959, - -79.5605145541956 + -68.83655705259301, + -69.78078581158695, + -78.809584162956, + -78.94197823204145 ], "moduleForcesY": [ - -92.63831320439046, - -91.81935170246211, - -83.65606631768833, - -83.50590561929272 + -92.5349745458162, + -91.8382201142605, + -84.2019727811292, + -84.09261841954962 ], - "timestamp": 5.32688481033041 + "timestamp": 5.389150010235321 }, { - "x": 13.826599505033213, - "y": 7.108931315252294, - "heading": -2.373433389011578, - "angularVelocity": -0.2638552608623059, - "velocityX": 0.7744102673515239, - "velocityY": 0.9150341301623246, + "x": 13.826409668067303, + "y": 7.1085546328421145, + "heading": -2.3692035095547546, + "angularVelocity": -0.36366608945691725, + "velocityX": 0.7753537853112544, + "velocityY": 0.9204481051835359, "moduleForcesX": [ - -68.56304647527125, - -69.84897377197196, - -79.41828548071045, - -79.73113036544858 + -67.15141087474257, + -68.7697448512468, + -80.10733272532873, + -80.36853069934814 ], "moduleForcesY": [ - -92.77867605554368, - -91.82527817186566, - -83.67315905858817, - -83.38745301845488 + -93.80797979702136, + -92.64041961485175, + -83.01627453571552, + -82.77776530877918 ], - "timestamp": 5.40077509100953 + "timestamp": 5.46344840473265 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -0.1323754049192257, - "velocityX": 0.38723234385763017, - "velocityY": 0.4575300935677065, + "angularVelocity": -0.18857924691523403, + "velocityX": 0.38766037592671854, + "velocityY": 0.46008678483988286, "moduleForcesX": [ - -68.48839210839299, - -69.86757393943373, - -79.44566757381507, - -79.82897176171012 + -66.12682297577675, + -68.20517667619286, + -80.86078377461966, + -81.19705273807568 ], "moduleForcesY": [ - -92.85970357248277, - -91.83521466144767, - -83.67612133165606, - -83.32050872366115 + -94.55836495850359, + -93.08125167677997, + -82.3115890516093, + -81.99291564808973 ], - "timestamp": 5.47466537168865 + "timestamp": 5.5377467992299785 }, { "x": 13.855212211608888, "y": 7.142738342285156, "heading": -2.383214644836072, - "angularVelocity": -4.38467207280536e-20, - "velocityX": -4.0904408010942157e-19, - "velocityY": 2.6769636069327637e-19, + "angularVelocity": 1.080567090593154e-18, + "velocityX": 3.1368683313884955e-18, + "velocityY": -3.703942145745268e-18, "moduleForcesX": [ - -68.45716377960287, - -69.84827604991912, - -79.49268727695612, - -79.87431218532066 + -65.47502708227233, + -67.78484334953554, + -81.40565230070824, + -81.69905950491292 ], "moduleForcesY": [ - -92.89994179563085, - -91.86589702825168, - -83.65083737459666, - -83.29490255274521 + -95.02748219177589, + -93.40351824166105, + -81.79230598951985, + -81.5109337765353 ], - "timestamp": 5.548555652367771 + "timestamp": 5.612045193727307 }, { - "x": 13.861959905913299, - "y": 7.132795995001895, - "heading": -2.342514973243809, - "angularVelocity": 0.896810182021551, - "velocityX": 0.14868426993683032, - "velocityY": -0.21907789247414935, + "x": 13.861807281102129, + "y": 7.133643639193121, + "heading": -2.336022603850437, + "angularVelocity": 1.0267084963209077, + "velocityX": 0.14348211565163527, + "velocityY": -0.19786406226744235, "moduleForcesX": [ - 92.60899812029683, - 36.581383436885694, - 114.99026329766751, - -58.08810301954257 + 93.94614327648092, + 36.13879487108392, + 111.62905057926098, + -64.40510932898498 ], "moduleForcesY": [ - -68.83786410265965, - -109.44730735929382, - 3.712550595135854, - -99.6242520623601 + -67.0032729880947, + -109.595479702191, + 27.752839981561817, + -95.66578127078265 ], - "timestamp": 5.593938356989299 + "timestamp": 5.658009594679225 }, { - "x": 13.875819150724183, - "y": 7.112249186067297, - "heading": -2.2656047143722495, - "angularVelocity": 1.6947041722823237, - "velocityX": 0.305386047977193, - "velocityY": -0.4527453598446684, + "x": 13.875608290481761, + "y": 7.114745707898614, + "heading": -2.246841818550783, + "angularVelocity": 1.9402142408631486, + "velocityX": 0.3002543075470427, + "velocityY": -0.41114277360594026, "moduleForcesX": [ - 94.28574172878825, - 40.518324824763326, - 113.84938976113067, - -52.526238566412395 + 95.8672758122096, + 40.82163317785168, + 114.4218987153328, + -57.37863739639605 ], "moduleForcesY": [ - -66.49833461253938, - -108.04061737317623, - -15.264647771952621, - -102.6535173648968 + -64.19626033624898, + -107.9265810590626, + 8.587675737899398, + -100.025272764473 ], - "timestamp": 5.639321061610827 + "timestamp": 5.703973995631142 }, { - "x": 13.896716131123098, - "y": 7.0794637940045515, - "heading": -2.160842027100097, - "angularVelocity": 2.308427585923494, - "velocityX": 0.4604613271330157, - "velocityY": -0.7224204096287639, + "x": 13.896548291041885, + "y": 7.083371828358983, + "heading": -2.1286943803030045, + "angularVelocity": 2.570411792625565, + "velocityX": 0.4555699655920011, + "velocityY": -0.6825690945575763, "moduleForcesX": [ - 96.06095182204432, - 45.624218221432486, - 96.82610095310335, - -44.41977169952861 + 97.68723324634834, + 46.630127487620676, + 94.9842558173518, + -47.369366627210084 ], "moduleForcesY": [ - -63.868948710552424, - -105.96943008095943, - -61.2878116865948, - -106.39784959154366 + -61.345098525025094, + -105.52853662580156, + -63.42452839101009, + -105.11852994950135 ], - "timestamp": 5.684703766232356 + "timestamp": 5.74993839658306 }, { - "x": 13.923432914333938, - "y": 7.032861637076851, - "heading": -2.033144193714598, - "angularVelocity": 2.813799539944651, - "velocityX": 0.5886996694808474, - "velocityY": -1.026870419388657, + "x": 13.922680903431022, + "y": 7.03765513765653, + "heading": -1.985611009529513, + "angularVelocity": 3.1129171230398116, + "velocityX": 0.5685402582854093, + "velocityY": -0.9946108239347283, "moduleForcesX": [ - 97.08414428392167, - 51.22850417511766, - 45.60897792644892, - -33.41911257960123 + 98.19933570612807, + 52.70680448168723, + 22.355607509561942, + -33.65803533403781 ], "moduleForcesY": [ - -62.239918850679075, - -103.35106272656319, - -105.13082797687291, - -110.32640894319715 + -60.4417252556641, + -102.5971447878816, + -112.31949341574553, + -110.24906301300281 ], - "timestamp": 5.730086470853884 + "timestamp": 5.7959027975349775 }, { - "x": 13.955563785040498, - "y": 6.972050456195828, - "heading": -1.8825723884399712, - "angularVelocity": 3.317823530579129, - "velocityX": 0.7079981454282456, - "velocityY": -1.3399637899098766, + "x": 13.954174358221836, + "y": 6.977261876671765, + "heading": -1.8186031014993125, + "angularVelocity": 3.6334185711438747, + "velocityX": 0.6851705698015748, + "velocityY": -1.3139138057720028, "moduleForcesX": [ - 95.89341392145519, - 56.462615374362215, - 15.864319365251628, - -18.90693012956116 + 94.58841581785215, + 57.482680844528296, + 7.1519899456507785, + -15.096484175146825 ], "moduleForcesY": [ - -63.953071935174876, - -100.54214801306098, - -113.69206080698899, - -113.67892793538894 + -65.80975762610504, + -99.93840204825545, + -114.6027216210397, + -114.22968117284634 ], - "timestamp": 5.775469175475412 + "timestamp": 5.841867198486895 }, { - "x": 13.993619206361197, - "y": 6.896657883852084, - "heading": -1.7125926377755643, - "angularVelocity": 3.7454742303695787, - "velocityX": 0.8385445873723288, - "velocityY": -1.6612622137108406, + "x": 13.991786121737945, + "y": 6.901429215857203, + "heading": -1.6368319977658938, + "angularVelocity": 3.9546061727980697, + "velocityX": 0.8182802938181745, + "velocityY": -1.6498128822322675, "moduleForcesX": [ - 88.01731264292725, - 59.0840763982514, - 15.927056261416332, - 0.36287524026553974 + 75.4236461603671, + 55.684709367906514, + 21.681375782988027, + 11.701403316569385 ], "moduleForcesY": [ - -74.24824099326673, - -98.93287625654578, - -113.78600820918643, - -115.16848981625489 + -86.9055431026712, + -100.8053807575965, + -112.86388870902914, + -114.51447272213056 ], - "timestamp": 5.82085188009694 + "timestamp": 5.887831599438813 }, { - "x": 14.037908607813321, - "y": 6.80587456385112, - "heading": -1.5371335721598818, - "angularVelocity": 3.866209981950951, - "velocityX": 0.9759092548907738, - "velocityY": -2.0003946604341567, + "x": 14.03442698872517, + "y": 6.809867684125599, + "heading": -1.4712785182458679, + "angularVelocity": 3.6017760721652428, + "velocityX": 0.927693304038252, + "velocityY": -1.9920096821752111, "moduleForcesX": [ - 55.303727996361445, - 49.44678346076422, - 35.635742871578024, - 31.53872568249567 + 7.4756095549990365, + 5.543216012475767, + 53.51925630688566, + 68.6696974754232 ], "moduleForcesY": [ - -100.77984511033996, - -103.84416234160268, - -109.2529908603062, - -110.57959724006975 + -114.67118987816583, + -114.51283157214998, + -101.73623001018527, + -91.95148315152574 ], - "timestamp": 5.866234584718469 + "timestamp": 5.93379600039073 }, { - "x": 14.087144535069578, - "y": 6.700360814437641, - "heading": -1.3841105056888872, - "angularVelocity": 3.3718366445354224, - "velocityX": 1.0849050903172033, - "velocityY": -2.3249771095270226, + "x": 14.0823789754651, + "y": 6.7033924335418655, + "heading": -1.3298228673892658, + "angularVelocity": 3.0775045018986713, + "velocityX": 1.0432418512337802, + "velocityY": -2.316472060521708, "moduleForcesX": [ - 3.0133443991748976, - -9.704067691995961, - 61.74194260289858, - 81.36746218585068 + 4.9681137901011345, + -11.029616583463108, + 64.88816529721264, + 83.96314322378822 ], "moduleForcesY": [ - -114.78558445562432, - -113.97825197610892, - -96.85819727429798, - -80.62385237514702 + -114.67679488503701, + -113.78423953190108, + -94.72104394783508, + -77.77423908356108 ], - "timestamp": 5.911617289339997 + "timestamp": 5.979760401342648 }, { - "x": 14.14226859299682, - "y": 6.580743460775094, - "heading": -1.2557023174275241, - "angularVelocity": 2.829452086036561, - "velocityX": 1.2146490251507223, - "velocityY": -2.6357475752074477, + "x": 14.13685205858906, + "y": 6.582925065175055, + "heading": -1.2157167466379832, + "angularVelocity": 2.4824890216810713, + "velocityX": 1.1851146103469143, + "velocityY": -2.620884116227876, "moduleForcesX": [ - 10.480286821125896, - -8.238341876639112, - 70.90518481088853, - 89.23977661435688 + 13.212936622716347, + -8.67539830647213, + 75.84281222650095, + 94.93975692280823 ], "moduleForcesY": [ - -114.10634114609925, - -113.67173817318366, - -90.05586637958596, - -71.12492607944955 + -113.75794165587317, + -113.47578028497102, + -85.85966695629838, + -63.08562287252783 ], - "timestamp": 5.956999993961525 + "timestamp": 6.025724802294565 }, { - "x": 14.204835516401594, - "y": 6.448466508306411, - "heading": -1.1561784745953227, - "angularVelocity": 2.192990560218639, - "velocityX": 1.378651270931431, - "velocityY": -2.9146996322016308, + "x": 14.199614035606237, + "y": 6.450362835829553, + "heading": -1.1340552186650188, + "angularVelocity": 1.7766255250098648, + "velocityX": 1.3654475141061873, + "velocityY": -2.884019515106307, "moduleForcesX": [ - 20.960314391027584, - -2.842849356642393, - 84.21445543262153, - 102.93252880524909 + 25.146700133293496, + -1.1305249249662828, + 90.22993499768113, + 108.60135018234804 ], "moduleForcesY": [ - -112.09268001844573, - -112.76901447740485, - -77.01708814164486, - -47.25631657837888 + -111.12312763663773, + -112.36380391179502, + -69.79003312905782, + -31.894172457931834 ], - "timestamp": 6.0023826985830535 + "timestamp": 6.071689203246483 }, { - "x": 14.278425287943143, - "y": 6.308166137099232, - "heading": -1.0878965211530789, - "angularVelocity": 1.50458096342397, - "velocityX": 1.6215378117116461, - "velocityY": -3.0914942680746504, + "x": 14.273205196850464, + "y": 6.3096531054550145, + "heading": -1.0871135355468409, + "angularVelocity": 1.0212617187654176, + "velocityX": 1.6010468910757547, + "velocityY": -3.061276280348623, "moduleForcesX": [ - 48.859656151615134, - 39.29215925118305, - 105.39970908610701, - 110.44414210433047 + 46.32646503626852, + 29.27418934062715, + 105.8355999225502, + 109.70707968043254 ], "moduleForcesY": [ - -100.5358220207968, - -96.55667751732808, - -39.89417637595948, - 15.711330603946356 + -101.6881811618927, + -98.80485347520826, + -38.70930863434508, + 20.15623938551683 ], - "timestamp": 6.047765403204582 + "timestamp": 6.1176536041984 }, { - "x": 14.356885484045446, - "y": 6.180875846162496, - "heading": -0.9964367241653384, - "angularVelocity": 2.015300713134569, - "velocityX": 1.7288567694813934, - "velocityY": -2.804819412996273, + "x": 14.352346828521247, + "y": 6.181353766919092, + "heading": -1.0166113057323838, + "angularVelocity": 1.5338442001715178, + "velocityX": 1.7218027436835717, + "velocityY": -2.7912762024274724, "moduleForcesX": [ - 40.76242627736614, - 85.26282068126751, - -33.51474181780654, - 41.80940406660451 + 43.849222398638176, + 84.51752285087134, + -24.29503991613957, + 45.15305908679976 ], "moduleForcesY": [ - 103.28724328208311, - 69.6297540554303, - 102.88363740482494, - 83.00028269478578 + 98.75569700086677, + 64.96243676079469, + 100.34497692617356, + 69.59109447988128 ], - "timestamp": 6.09314810782611 + "timestamp": 6.163618005150318 }, { - "x": 14.428558340071614, - "y": 6.066616737623039, - "heading": -0.8768712055992656, - "angularVelocity": 2.6346053978756356, - "velocityX": 1.5792989118627854, - "velocityY": -2.5176795762246367, + "x": 14.426005725789185, + "y": 6.066518080054045, + "heading": -0.9142430526433137, + "angularVelocity": 2.2271203576906267, + "velocityX": 1.602520553786623, + "velocityY": -2.4983614381306767, "moduleForcesX": [ - -23.024650236953327, - 15.495478785366409, - -85.25414758160815, - -94.40260108810803 + -10.689838775743358, + 35.21196936002609, + -80.76361369266837, + -91.16219383556731 ], "moduleForcesY": [ - 111.58942984648242, - 112.01377982791273, - 75.3161473098706, - 60.46352938099102 + 113.07820027057511, + 106.90487109121052, + 79.40920313766219, + 62.57889090102301 ], - "timestamp": 6.138530812447638 + "timestamp": 6.2095824061022356 }, { - "x": 14.49142295848577, - "y": 5.9648432002123934, - "heading": -0.7330923745075492, - "angularVelocity": 3.168141526397992, - "velocityX": 1.385210928665889, - "velocityY": -2.24256218882046, + "x": 14.491141108334089, + "y": 5.9645168700924796, + "heading": -0.7848130827682546, + "angularVelocity": 2.815874180769878, + "velocityX": 1.4170832469467167, + "velocityY": -2.2191349794434485, "moduleForcesX": [ - -41.53032424596707, - -9.897010287228593, - -93.16938210809725, - -98.32290187749236 + -36.159456633281756, + -1.6252737093363274, + -91.97875020999615, + -99.39177635875521 ], "moduleForcesY": [ - 106.82441101026959, - 113.74543897439574, - 66.58606054965573, - 57.179734029046564 + 108.60701730025053, + 113.90438381959041, + 67.96114697240343, + 54.58321208531797 ], - "timestamp": 6.183913517069167 + "timestamp": 6.255546807054153 }, { - "x": 14.544623158669278, - "y": 5.87572493089785, - "heading": -0.5718154821303135, - "angularVelocity": 3.553708262260154, - "velocityX": 1.1722571545079534, - "velocityY": -1.9637055582683072, + "x": 14.546449970003842, + "y": 5.874850586766935, + "heading": -0.631250104240621, + "angularVelocity": 3.340911125726901, + "velocityX": 1.2032977809850718, + "velocityY": -1.9507767199956136, "moduleForcesX": [ - -53.44415602897267, - -28.980375064219814, - -93.28776986457336, - -90.81965392427354 + -49.09953189561874, + -17.172798234951614, + -97.41391226966714, + -100.50042106685149 ], "moduleForcesY": [ - 101.68618809242784, - 110.93166649748392, - 66.88592374391406, - 69.51188559031735 + 103.78581109073833, + 113.20215773897431, + 60.60212605680512, + 54.03522331953084 ], - "timestamp": 6.229296221690695 + "timestamp": 6.301511208006071 }, { - "x": 14.588733197240783, - "y": 5.800221418575717, - "heading": -0.42158738976113214, - "angularVelocity": 3.3102498765117416, - "velocityX": 0.9719570250245041, - "velocityY": -1.6637067568317254, + "x": 14.591598722413101, + "y": 5.798850919958515, + "heading": -0.4725640797467414, + "angularVelocity": 3.4523679457908694, + "velocityX": 0.9822547770499443, + "velocityY": -1.6534462591587367, "moduleForcesX": [ - -74.00444289574996, - -84.82750480070263, - -36.15663713104418, - -55.70612713734391 + -64.14132388710318, + -57.74716179082214, + -77.86191188988668, + -73.40481169623028 ], "moduleForcesY": [ - 87.85806255534847, - 77.70219291275825, - 109.19057307139701, - 100.72627828960452 + 95.36643063243639, + 99.2968998274088, + 84.48333541278747, + 88.28122283949911 ], - "timestamp": 6.274678926312223 + "timestamp": 6.347475608957988 }, { - "x": 14.623971165481974, - "y": 5.737622434633646, - "heading": -0.2905912513710962, - "angularVelocity": 2.886477116833101, - "velocityX": 0.7764624989863818, - "velocityY": -1.3793577192923712, + "x": 14.627266293632685, + "y": 5.736313352300135, + "heading": -0.32976115295452907, + "angularVelocity": 3.106815792978476, + "velocityX": 0.7759825099623375, + "velocityY": -1.3605652714543037, "moduleForcesX": [ - -80.0246768887267, - -100.14721091439696, - -10.744716582138851, - -53.763436622298244 + -79.08825052742094, + -94.49368741243654, + -24.954444481983515, + -56.365800767000515 ], "moduleForcesY": [ - 82.35913095559447, - 56.88672408353364, - 114.69341623133508, - 101.95066373478761 + 83.32375870202404, + 65.75374939597963, + 112.38552797168428, + 100.46638970550259 ], - "timestamp": 6.320061630933751 + "timestamp": 6.393440009909906 }, { - "x": 14.650491204975971, - "y": 5.687579858551526, - "heading": -0.18109509490551892, - "angularVelocity": 2.4127287560035904, - "velocityX": 0.5843644559125126, - "velocityY": -1.1026794568427392, + "x": 14.65364085378242, + "y": 5.686523155503303, + "heading": -0.2086770773830198, + "angularVelocity": 2.6343011779523207, + "velocityX": 0.5738040658318332, + "velocityY": -1.0832338889593371, "moduleForcesX": [ - -74.48364034846936, - -106.88461675230056, - -2.774309758119724, - -56.286451842231365 + -80.75753449731462, + -105.75146527274016, + -6.533917978603814, + -56.800299326668465 ], "moduleForcesY": [ - 87.30364939891406, - 43.08617697815872, - 115.24782035664737, - 100.65158178859285 + 81.56714001969844, + 45.74125215422081, + 115.06672888896286, + 100.33878741771153 ], - "timestamp": 6.36544433555528 + "timestamp": 6.439404410861823 }, { - "x": 14.668829934744329, - "y": 5.65013543062385, - "heading": -0.09419471226356198, - "angularVelocity": 1.91483481133768, - "velocityX": 0.40409071960989107, - "velocityY": -0.8250814542664746, + "x": 14.671133184520741, + "y": 5.6493303593283635, + "heading": -0.1109888357303956, + "angularVelocity": 2.1253021823304925, + "velocityX": 0.38056257399327703, + "velocityY": -0.8091652540810123, "moduleForcesX": [ - -55.32796842006375, - -110.53141862820286, - -0.4423126125758408, - -59.32807159173019 + -67.41351148580846, + -110.75420648171135, + -0.987299919919722, + -59.64430713959497 ], "moduleForcesY": [ - 100.43619981044367, - 32.748204469854116, - 115.32725877892798, - 98.9287079347535 + 92.68928093179672, + 31.95250489621746, + 115.31159659481133, + 98.72856624844064 ], - "timestamp": 6.410827040176808 + "timestamp": 6.485368811813741 }, { - "x": 14.680031947562197, - "y": 5.625376428463603, - "heading": -0.032466736730672914, - "angularVelocity": 1.3601652005466338, - "velocityX": 0.24683440335448031, - "velocityY": -0.5455603046739033, + "x": 14.681023126809134, + "y": 5.624953566198197, + "heading": -0.03923900366198559, + "angularVelocity": 1.5609869939013463, + "velocityX": 0.21516526014856754, + "velocityY": -0.5303407120581256, "moduleForcesX": [ - -22.69780248396784, - -112.62711740856216, - 0.30424038499491796, - -61.80059569568245 + -29.537208536645696, + -113.2612737604008, + 0.7703487270790108, + -62.362582583263325 ], "moduleForcesY": [ - 112.34568644194837, - 24.716987102766776, - 115.35632305606234, - 97.42837626864956 + 110.53903877031718, + 21.605385460346547, + 115.34906975588962, + 97.06559527810772 ], - "timestamp": 6.456209744798336 + "timestamp": 6.5313332127656585 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -8.02923683034453e-19, - "angularVelocity": 0.7153988948307836, - "velocityX": 0.11473292914177731, - "velocityY": -0.2699509497396526, + "heading": 6.643546626004709e-18, + "angularVelocity": 0.85368247707683, + "velocityX": 0.09171687870089658, + "velocityY": -0.2573348440090306, "moduleForcesX": [ - 10.465866206746178, - -113.77295041301616, - 1.1484884755134444, - -63.178995978692946 + 23.85828752678224, + -114.45714666054057, + 2.026107569486801, + -63.97932141399083 ], "moduleForcesY": [ - 114.14538106924414, - 18.8786582623545, - 115.36971326990154, - 96.55763623804961 + 111.84032387601461, + 14.144281910460025, + 115.35597645325024, + 96.02804598950458 ], - "timestamp": 6.5015924494198645 + "timestamp": 6.577297613717576 }, { "x": 14.6852388381958, "y": 5.613125324249268, - "heading": -3.9015796834549723e-19, - "angularVelocity": 6.131754693956049e-20, - "velocityX": 1.318646419686023e-19, - "velocityY": -2.1826006617042474e-19, + "heading": 3.475412312586324e-18, + "angularVelocity": -5.811723191789812e-19, + "velocityX": -9.954722773585959e-19, + "velocityY": 3.489115231904606e-18, "moduleForcesX": [ - 30.956584752298998, - -114.29048140187894, - 2.8833647328699366, - -63.148669433067454 + 61.21552776416918, + -114.90954967400437, + 4.2529323110693955, + -63.89858977846906 ], "moduleForcesY": [ - 110.35051173008722, - 15.57664785043353, - 115.35208140460223, - 96.59011418775707 + 96.54516819539677, + 10.052179512840738, + 115.30969681756606, + 96.0960223654071 ], - "timestamp": 6.546975154041393 + "timestamp": 6.623262014669494 }, { - "x": 14.65591627172833, - "y": 5.612955136335095, - "heading": -8.489678129046805e-19, - "angularVelocity": -7.637362615315964e-18, - "velocityX": -0.4881043332518622, - "velocityY": -0.0028329531955231684, + "x": 14.655916256843003, + "y": 5.612955128559063, + "heading": 3.1230036756654924e-18, + "angularVelocity": -5.866203252382288e-18, + "velocityX": -0.48810444502271244, + "velocityY": -0.0028330818461293926, "moduleForcesX": [ - -115.37658317775369, - -115.37658317775369, - -115.37658317775369, - -115.37658317775369 + -115.37657744801193, + -115.37657744801193, + -115.37657744801193, + -115.37657744801193 ], "moduleForcesY": [ - -0.6696446594201887, - -0.6696446594201887, - -0.6696446594201901, - -0.6696446594201901 + -0.6696748828445834, + -0.6696748828445834, + -0.6696748828445817, + -0.6696748828445817 ], - "timestamp": 6.6070495366475 + "timestamp": 6.683336414015382 }, { - "x": 14.597275655749772, - "y": 5.612614333848124, - "heading": -1.5130034106942078e-18, - "angularVelocity": -1.1053556745448901e-17, - "velocityX": -0.9761334771103636, - "velocityY": -0.005673008563491044, + "x": 14.597275612129625, + "y": 5.6126143107496995, + "heading": 2.4415453659675053e-18, + "angularVelocity": -1.1343572587073241e-17, + "velocityX": -0.9761336834305275, + "velocityY": -0.00567326203964737, "moduleForcesX": [ - -115.35881014296135, - -115.35881014296135, - -115.35881014296135, - -115.35881014296135 + -115.35880034739998, + -115.35880034739998, + -115.35880034739998, + -115.35880034739998 ], "moduleForcesY": [ - -0.6713234488387343, - -0.6713234488387343, - -0.6713234488387362, - -0.6713234488387362 + -0.6713527676407227, + -0.6713527676407227, + -0.6713527676407209, + -0.6713527676407209 ], - "timestamp": 6.667123919253607 + "timestamp": 6.74341081336127 }, { - "x": 14.509323753069854, - "y": 5.6121022780031975, - "heading": -2.1599359012185637e-18, - "angularVelocity": -1.0768857901728596e-17, - "velocityX": -1.4640500470324869, - "velocityY": -0.008523697168628809, + "x": 14.509323668724555, + "y": 5.612102232338162, + "heading": 1.3270385910322786e-18, + "angularVelocity": -1.8552108501746105e-17, + "velocityX": -1.4640503169856367, + "velocityY": -0.008524070437876919, "moduleForcesX": [ - -115.33220026624166, - -115.33220026624166, - -115.33220026624166, - -115.33220026624166 + -115.33218317019183, + -115.33218317019183, + -115.33218317019183, + -115.33218317019183 ], "moduleForcesY": [ - -0.6738369003473637, - -0.6738369003473637, - -0.6738369003473659, - -0.6738369003473659 + -0.6738650288924735, + -0.6738650288924735, + -0.6738650288924716, + -0.6738650288924716 ], - "timestamp": 6.727198301859714 + "timestamp": 6.803485212707158 }, { - "x": 14.392071800967997, - "y": 5.611417907491215, - "heading": -2.4955664249849538e-18, - "angularVelocity": -5.586915894948488e-18, - "velocityX": -1.9517795608595285, - "velocityY": -0.01139205235732751, + "x": 14.392071667687404, + "y": 5.611417832423418, + "heading": -7.763414819258763e-20, + "angularVelocity": -2.338221862268053e-17, + "velocityX": -1.9517798315727315, + "velocityY": -0.011392538622051734, "moduleForcesX": [ - -115.28798452865676, - -115.28798452865676, - -115.28798452865676, - -115.28798452865676 + -115.28795258322376, + -115.28795258322376, + -115.28795258322376, + -115.28795258322376 ], "moduleForcesY": [ - -0.6780128723861801, - -0.6780128723861801, - -0.678012872386183, - -0.678012872386183 + -0.6780393929688643, + -0.6780393929688643, + -0.6780393929688625, + -0.6780393929688625 ], - "timestamp": 6.787272684465821 + "timestamp": 6.863559612053046 }, { - "x": 14.245542144768796, - "y": 5.610559112618229, - "heading": -2.17152151744822e-18, - "angularVelocity": 5.394061398292092e-18, - "velocityX": -2.4391371137337936, - "velocityY": -0.01429552557564081, + "x": 14.24554196375991, + "y": 5.6105590018551865, + "heading": -1.80725653301977e-18, + "angularVelocity": -2.879133879933629e-17, + "velocityX": -2.439137228552605, + "velocityY": -0.01429611577615215, "moduleForcesX": [ - -115.20006155628543, - -115.20006155628543, - -115.20006155628543, - -115.20006155628543 + -115.19999260587228, + -115.19999260587228, + -115.19999260587228, + -115.19999260587228 ], "moduleForcesY": [ - -0.6863139629294118, - -0.6863139629294118, - -0.6863139629294153, - -0.6863139629294154 + -0.6863383396984974, + -0.6863383396984974, + -0.6863383396984957, + -0.6863383396984957 ], - "timestamp": 6.847347067071928 + "timestamp": 6.923634011398934 }, { - "x": 14.06980078538855, - "y": 5.609519669852626, - "heading": -5.349757299589133e-19, - "angularVelocity": 2.724199096518095e-17, - "velocityX": -2.925396013347973, - "velocityY": -0.01730259589046419, + "x": 14.069800593542725, + "y": 5.609519517509087, + "heading": -3.822402694201517e-18, + "angularVelocity": -3.3544174940246164e-17, + "velocityX": -2.9253953785759013, + "velocityY": -0.01730328321909612, "moduleForcesX": [ - -114.94036531798051, - -114.94036531798051, - -114.94036531798051, - -114.94036531798051 + -114.94015610384217, + -114.94015610384217, + -114.94015610384217, + -114.94015610384217 ], "moduleForcesY": [ - -0.710801922179511, - -0.710801922179511, - -0.7108019221795149, - -0.710801922179515 + -0.7108246829504308, + -0.7108246829504308, + -0.7108246829504284, + -0.7108246829504284 ], - "timestamp": 6.907421449678035 + "timestamp": 6.983708410744822 }, { "x": 13.870342254638672, "y": 5.6078338623046875, - "heading": 3.933743569942127e-27, - "angularVelocity": 8.905222349190746e-18, - "velocityX": -3.320192769315282, - "velocityY": -0.028062003716167162, + "heading": 3.9144943965939805e-27, + "angularVelocity": 6.362781384131591e-17, + "velocityX": -3.3201886506702927, + "velocityY": -0.02805945998218547, "moduleForcesX": [ - -93.3208284583402, - -93.3208284583402, - -93.3208284583402, - -93.3208284583402 + -93.31997894760639, + -93.31997894760642, + -93.31997894760639, + -93.31997894760642 ], "moduleForcesY": [ - -2.5432753355726474, - -2.54327533557265, - -2.5432753355726443, - -2.5432753355726456 + -2.5425108785750434, + -2.5425108785750297, + -2.5425108785750763, + -2.5425108785750616 ], - "timestamp": 6.967495832284142 + "timestamp": 7.04378281009071 }, { - "x": 13.68164926660538, - "y": 5.606118094653867, - "heading": 3.562246310579434e-18, - "angularVelocity": 5.2260754068954895e-17, - "velocityX": -2.768263899294385, - "velocityY": -0.025171564120364344, + "x": 13.681649301516726, + "y": 5.60611809958223, + "heading": 4.016781723731204e-18, + "angularVelocity": 5.892911448413981e-17, + "velocityX": -2.7682631078990867, + "velocityY": -0.025171489278773905, "moduleForcesX": [ - 114.98181646144474, - 114.98181646144474, - 114.98181646144474, - 114.98181646144474 + 114.98111170716051, + 114.98111170716051, + 114.98111170716051, + 114.98111170716051 ], "moduleForcesY": [ - 0.6021572944443165, - 0.6021572944443164, - 0.6021572944443149, - 0.6021572944443149 + 0.6016428962296182, + 0.6016428962296182, + 0.6016428962296176, + 0.6016428962296176 ], - "timestamp": 7.0356587657679714 + "timestamp": 7.111945750449783 }, { - "x": 13.530664057996011, - "y": 5.6047070494208535, - "heading": 6.970402547713967e-18, - "angularVelocity": 5.0000140247988346e-17, - "velocityX": -2.21506324467662, - "velocityY": -0.020701063773144956, + "x": 13.53066408912991, + "y": 5.604707049037762, + "heading": 5.1354715756209854e-18, + "angularVelocity": 1.6411995171794605e-17, + "velocityX": -2.215063076672593, + "velocityY": -0.020701139608051117, "moduleForcesX": [ - 115.24676383245284, - 115.24676383245284, - 115.24676383245284, - 115.24676383245284 + 115.24662233874156, + 115.24662233874156, + 115.24662233874156, + 115.24662233874156 ], "moduleForcesY": [ - 0.9313269849343858, - 0.9313269849343858, - 0.9313269849343856, - 0.9313269849343855 + 0.931295500981224, + 0.931295500981224, + 0.9312955009812263, + 0.9312955009812263 ], - "timestamp": 7.103821699251801 + "timestamp": 7.180108690808855 }, { - "x": 13.417411634272256, - "y": 5.603631896857166, - "heading": 8.236144995060866e-18, - "angularVelocity": 1.856936577441259e-17, - "velocityX": -1.6614957416793323, - "velocityY": -0.015773273078727883, + "x": 13.4174116528594, + "y": 5.603631894326559, + "heading": 1.818783720138006e-18, + "angularVelocity": -4.865822750357439e-17, + "velocityX": -1.6614957581629166, + "velocityY": -0.015773302993372113, "moduleForcesX": [ - 115.32318834172317, - 115.32318834172317, - 115.32318834172317, - 115.32318834172317 + 115.32313827588082, + 115.32313827588082, + 115.32313827588082, + 115.32313827588082 ], "moduleForcesY": [ - 1.0265930194309745, - 1.0265930194309745, - 1.0265930194309765, - 1.0265930194309765 + 1.0266024823241802, + 1.0266024823241802, + 1.0266024823241848, + 1.026602482324185 ], - "timestamp": 7.171984632735631 + "timestamp": 7.248271631167928 }, { - "x": 13.341903875147041, - "y": 5.602907459655186, - "heading": 6.178007203351896e-18, - "angularVelocity": -3.0194384099180574e-17, - "velocityX": -1.1077539546200272, - "velocityY": -0.010628022665019901, + "x": 13.341903882006394, + "y": 5.602907458005536, + "heading": 3.991433737025843e-18, + "angularVelocity": 3.187435872955762e-17, + "velocityX": -1.107754014941875, + "velocityY": -0.01062800866874692, "moduleForcesX": [ - 115.35949645880048, - 115.35949645880048, - 115.35949645880048, - 115.35949645880048 + 115.35947569038294, + 115.35947569038294, + 115.35947569038294, + 115.35947569038294 ], "moduleForcesY": [ - 1.0718958018897309, - 1.0718958018897309, - 1.0718958018897344, - 1.0718958018897344 + 1.0719048416122896, + 1.0719048416122896, + 1.071904841612296, + 1.071904841612296 ], - "timestamp": 7.240147566219461 + "timestamp": 7.316434571527 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0496509621177646e-24, - "angularVelocity": -9.063586088757749e-17, - "velocityX": -0.5539103568522852, - "velocityY": -0.0053556863887746315, + "heading": -7.63547360856752e-25, + "angularVelocity": -5.855725242145153e-17, + "velocityX": -0.5539104016139283, + "velocityY": -0.005355661647003148, "moduleForcesX": [ - 115.38070640237679, - 115.38070640237679, - 115.38070640237679, - 115.38070640237679 + 115.38069800613746, + 115.38069800613746, + 115.38069800613746, + 115.38069800613746 ], "moduleForcesY": [ - 1.0983712484822477, - 1.0983712484822479, - 1.0983712484822528, - 1.0983712484822528 + 1.0983733762750212, + 1.0983733762750214, + 1.0983733762750287, + 1.098373376275029 ], - "timestamp": 7.308310499703291 + "timestamp": 7.3845975118860725 }, { "x": 13.304147720336914, "y": 5.602542400360107, - "heading": 1.0735721824105399e-24, - "angularVelocity": 3.03574595814805e-25, - "velocityX": -1.1997143110381767e-25, - "velocityY": 2.1379415454439605e-25, + "heading": -7.751526493297866e-25, + "angularVelocity": -2.26319747894764e-25, + "velocityX": 1.0079660491439562e-23, + "velocityY": 1.0284960672568687e-23, "moduleForcesX": [ - 115.39461413799822, - 115.39461413799822, - 115.39461413799822, - 115.39461413799822 + 115.39461182381044, + 115.39461182381044, + 115.39461182381044, + 115.39461182381044 ], "moduleForcesY": [ - 1.1157353471214961, - 1.1157353471214961, - 1.1157353471215021, - 1.1157353471215021 + 1.1157300801986871, + 1.1157300801986874, + 1.115730080198696, + 1.115730080198696 ], - "timestamp": 7.376473433187121 + "timestamp": 7.452760452245145 }, { - "x": 13.333301383153968, - "y": 5.573801506681172, - "heading": 0.01582323396916395, - "angularVelocity": 0.22214471367149297, - "velocityX": 0.4092925688636579, - "velocityY": -0.4034976421009908, + "x": 13.333295993090786, + "y": 5.573943438615316, + "heading": 0.020437528196768823, + "angularVelocity": 0.286600169331202, + "velocityX": 0.40875294832828113, + "velocityY": -0.40104983341622946, "moduleForcesX": [ - 83.99858675745838, - 94.50501486045636, - 67.60907694190239, - 80.27135887466491 + 84.66730708312953, + 97.79823624610925, + 63.20469705289822, + 79.91393576166892 ], "moduleForcesY": [ - -79.10404420877467, - -66.22016115527022, - -93.52088748741942, - -82.91786973993533 + -78.37881724715754, + -61.25124940458053, + -96.55297564085095, + -83.2653681457005 ], - "timestamp": 7.447702830041296 + "timestamp": 7.524070696912693 }, { - "x": 13.391608661329746, - "y": 5.516308685460145, - "heading": 0.04698081873325925, - "angularVelocity": 0.43742592440987155, - "velocityX": 0.8185844714528077, - "velocityY": -0.8071501902329565, + "x": 13.391605195610097, + "y": 5.516669588157704, + "heading": 0.05964137481241568, + "angularVelocity": 0.5497645786859513, + "velocityX": 0.8176833888475714, + "velocityY": -0.8031644082084757, "moduleForcesX": [ - 83.45340079540242, - 94.33138257713637, - 67.95070369572379, - 80.6480190559037 + 83.61176177048723, + 96.91343804537236, + 64.64704831280237, + 80.55330595264391 ], "moduleForcesY": [ - -79.65440454308327, - -66.4413647938875, - -93.25638851459766, - -82.53433216167754 + -79.47867664464073, + -62.612531761585, + -95.5764752904338, + -82.62882568534256 ], - "timestamp": 7.518932226895471 + "timestamp": 7.595380941580242 }, { - "x": 13.479069343718304, - "y": 5.430043615996792, - "heading": 0.09266849307007893, - "angularVelocity": 0.6414159933201998, - "velocityX": 1.227873409732959, - "velocityY": -1.2110880236703392, + "x": 13.479092151862174, + "y": 5.430610082205895, + "heading": 0.11503401938207429, + "angularVelocity": 0.7767838243705603, + "velocityX": 1.226849755739081, + "velocityY": -1.2068322911107945, "moduleForcesX": [ - 82.66507902834793, - 93.96622463847794, - 68.56375935722866, - 81.18607925768542 + 82.31821309565615, + 95.32187408048657, + 66.92262060727154, + 81.35076884094306 ], "moduleForcesY": [ - -80.43604135450076, - -66.91762608001522, - -92.78161616974033, - -81.97870276950549 + -80.78194903679575, + -64.9663793495728, + -93.97078846223012, + -81.81464976514656 ], - "timestamp": 7.590161623749646 + "timestamp": 7.666691186247791 }, { - "x": 13.595681225064894, - "y": 5.314972807576324, - "heading": 0.15163714964482242, - "angularVelocity": 0.827869660267757, - "velocityX": 1.6371313881166667, - "velocityY": -1.6154960381883665, + "x": 13.595776572869067, + "y": 5.3156098843885005, + "heading": 0.18248020319766606, + "angularVelocity": 0.9458133838977687, + "velocityX": 1.6362925348367765, + "velocityY": -1.6126742847893822, "moduleForcesX": [ - 81.69939794150892, - 93.23102514178395, - 69.5958264531128, - 81.83020425409691 + 81.1896130380787, + 92.24877909794785, + 70.6324201788653, + 82.06283505268615 ], "moduleForcesY": [ - -81.35800277160789, - -67.87302901661616, - -91.96759965124197, - -81.29029357501486 + -81.8607204454983, + -69.19153030778288, + -91.1668535849204, + -81.04640774388072 ], - "timestamp": 7.661391020603821 + "timestamp": 7.7380014309153395 }, { - "x": 13.741436224010505, - "y": 5.171041089911012, - "heading": 0.2217535698888416, - "angularVelocity": 0.9843747573430274, - "velocityX": 2.0462759111102518, - "velocityY": -2.020678596506685, + "x": 13.74166340562453, + "y": 5.1714841013846, + "heading": 0.2539935851566899, + "angularVelocity": 1.0028486410672468, + "velocityX": 2.0458046867682906, + "velocityY": -2.021109080130372, "moduleForcesX": [ - 80.7428208802436, - 91.63008521058406, - 71.45739720683228, - 82.43567724433055 + 81.09664380826153, + 85.27750689601766, + 77.82613865257939, + 81.9886155863237 ], "moduleForcesY": [ - -82.19417166226108, - -69.89172174791939, - -90.44018204803689, - -80.58049754682136 + -81.85175642641818, + -77.49783429262001, + -84.99010839197298, + -80.99105848577611 ], - "timestamp": 7.732620417457996 + "timestamp": 7.809311675582888 }, { - "x": 13.916293939822738, - "y": 4.998155595405218, - "heading": 0.2975701335207255, - "angularVelocity": 1.0643999104344446, - "velocityX": 2.4548532422675313, - "velocityY": -2.4271649366866526, + "x": 13.916324671873264, + "y": 4.998926787820056, + "heading": 0.3028208316702331, + "angularVelocity": 0.6847157339198316, + "velocityX": 2.4493152009646426, + "velocityY": -2.419810987453681, "moduleForcesX": [ - 80.52618577124296, - 86.7098035480735, - 76.2536897185494, - 82.32400313465453 + 84.03168175068858, + 60.98601461651429, + 100.69711811876594, + 75.69360315918162 ], "moduleForcesY": [ - -82.08532933524775, - -75.55570587121076, - -86.13264049441516, - -80.37257801256403 + -78.57987315738377, + -97.49882069315494, + -55.29287195277618, + -86.20664997158069 ], - "timestamp": 7.803849814312171 + "timestamp": 7.880621920250437 }, { - "x": 14.09087619721131, - "y": 4.825248874693559, - "heading": 0.373019602814959, - "angularVelocity": 1.0592462189269634, - "velocityX": 2.4509860408615456, - "velocityY": -2.4274629345190584, + "x": 14.090871166457541, + "y": 4.825643663887782, + "heading": 0.3511151918655964, + "angularVelocity": 0.6772429462346373, + "velocityX": 2.4477057314558563, + "velocityY": -2.42998919356015, "moduleForcesX": [ - -0.5815156712319215, - -0.8313154127123616, - -0.7105986959001992, - -0.9604102516570998 + -0.048891828234506295, + -0.413005607259846, + -0.22796342076112328, + -0.5921306405396577 ], "moduleForcesY": [ - -0.17899030509093042, - -0.275088677914427, - 0.15634311137280021, - 0.06010210281662784 + -2.2043649748922296, + -2.337697398866358, + -1.715902956438727, + -1.8492859161842365 ], - "timestamp": 7.875079211166346 + "timestamp": 7.951932164917986 }, { - "x": 14.236385775704122, - "y": 4.681164504915296, - "heading": 0.4379095506597357, - "angularVelocity": 0.9109995410690161, - "velocityX": 2.042830417204086, - "velocityY": -2.022821702017776, + "x": 14.236498874993657, + "y": 4.681149821933151, + "heading": 0.41512274351300327, + "angularVelocity": 0.8975926523014044, + "velocityX": 2.0421709281049076, + "velocityY": -2.026270455644455, "moduleForcesX": [ - -77.62580863219604, - -91.18252045297275, - -72.23833707289428, - -84.43073188208308 + -84.90374854906725, + -67.54599174060318, + -95.29586306490957, + -75.27522227287814 ], "moduleForcesY": [ - 84.80855065381803, - 70.08510741611298, - 89.57057617080255, - 78.2106668523955 + 77.6147583667962, + 93.07759399799761, + 64.18090637545481, + 86.70101544096629 ], - "timestamp": 7.946308608020521 + "timestamp": 8.023242409585535 }, { - "x": 14.352794206677883, - "y": 4.565894974920919, - "heading": 0.49049547140066846, - "angularVelocity": 0.7382614912293785, - "velocityX": 1.634275118348653, - "velocityY": -1.6182859196514374, + "x": 14.35293077040835, + "y": 4.565754778501453, + "heading": 0.47353374686901495, + "angularVelocity": 0.8191109654486024, + "velocityX": 1.632751310243042, + "velocityY": -1.6182112958618482, "moduleForcesX": [ - -76.1078859700308, - -92.8635423382786, - -71.22089704597018, - -85.60378749942646 + -79.38401877213782, + -86.70173496470736, + -76.59134612886815, + -83.43809887191112 ], "moduleForcesY": [ - 86.50055242381342, - 68.23029646989542, - 90.64276801323516, - 77.21719460477229 + 83.51024074907058, + 75.89707047860773, + 86.11608026131252, + 79.50816094167695 ], - "timestamp": 8.017538004874696 + "timestamp": 8.094552654253084 }, { - "x": 14.440098961466248, - "y": 4.4794418527905195, - "heading": 0.530262298117705, - "angularVelocity": 0.5582923409901833, - "velocityX": 1.2256843191737132, - "velocityY": -1.21372812277761, + "x": 14.440197735334287, + "y": 4.479318845326742, + "heading": 0.5205395471666466, + "angularVelocity": 0.6591731737392686, + "velocityX": 1.2237647666584326, + "velocityY": -1.2121110168346618, "moduleForcesX": [ - -75.143525628293, - -93.27282582567612, - -71.14081537799724, - -86.26725520322114 + -76.05393950763325, + -91.96458850927128, + -72.0793563135359, + -85.67235755159167 ], "moduleForcesY": [ - 87.44982615530445, - 67.80015365809159, - 90.78923076727234, - 76.56915606002673 + 86.6543340713705, + 69.55656402670749, + 90.03678616248824, + 77.22355997042732 ], - "timestamp": 8.088767401728871 + "timestamp": 8.165862898920633 }, { - "x": 14.498301446686176, - "y": 4.421807328352338, - "heading": 0.5569527942334483, - "angularVelocity": 0.3747118085301997, - "velocityX": 0.8171132677015908, - "velocityY": -0.8091395825823801, + "x": 14.498343080799437, + "y": 4.421751377581397, + "heading": 0.5533788018685339, + "angularVelocity": 0.46051243906097156, + "velocityX": 0.8153855836033778, + "velocityY": -0.8072818711214393, "moduleForcesX": [ - -74.50739015764161, - -93.4289581443932, - -71.18348402973322, - -86.68884220281491 + -73.78272693454574, + -94.2833205460505, + -70.32485404051455, + -86.89555919568168 ], "moduleForcesY": [ - 88.04747340766619, - 67.6505855793752, - 90.79681638747405, - 76.13800705299523 + 88.64901027893603, + 66.44804317305021, + 91.46155626910209, + 75.90013809981603 ], - "timestamp": 8.159996798583046 + "timestamp": 8.237173143588182 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": 0.18854710036895106, - "velocityX": 0.4085592803911904, - "velocityY": -0.4045490599221039, + "angularVelocity": 0.23845225440008352, + "velocityX": 0.40751223255026625, + "velocityY": -0.4033057928676898, "moduleForcesX": [ - -74.14598545423118, - -93.54843405198011, - -71.17867844532277, - -86.9219690308431 + -72.28092066696583, + -95.62161114658008, + -69.3711228568063, + -87.60989544654508 ], "moduleForcesY": [ - 88.38488704635118, - 67.52515136113772, - 90.82487231947144, - 75.89955258668193 + 89.90999033784944, + 64.5500491439786, + 92.21350984982257, + 75.10570426878752 ], - "timestamp": 8.231226195437221 + "timestamp": 8.30848338825573 }, { "x": 14.527402877807615, "y": 4.392991542816162, "heading": 0.5703828904713324, - "angularVelocity": -3.196480441771765e-23, - "velocityX": 5.465355710587214e-23, - "velocityY": -4.689327739245502e-23, + "angularVelocity": -4.4195950751829394e-23, + "velocityX": 6.565713979713351e-23, + "velocityY": -7.386057640213947e-23, "moduleForcesX": [ - -74.04163357665932, - -93.70754772093753, - -71.06675825660118, - -86.9833483137024 + -71.44716369701283, + -96.59228734629673, + -68.61596217852517, + -87.9404950059459 ], "moduleForcesY": [ - 88.49408635582365, - 67.33114392906674, - 90.92845417388115, - 75.84771503471553 + 90.59549675575025, + 63.117985683089984, + 92.79347338693024, + 74.73839504419418 ], - "timestamp": 8.302455592291397 + "timestamp": 8.37979363292328 }, { - "x": 14.49804638425793, - "y": 4.378378905710642, - "heading": 0.5402862689246644, - "angularVelocity": -0.46684858464490536, - "velocityX": -0.45536797020744996, - "velocityY": -0.22666627016800778, + "x": 14.498046481587462, + "y": 4.378378938668267, + "heading": 0.5402846553367175, + "angularVelocity": -0.4668735990525236, + "velocityX": -0.4553664458137136, + "velocityY": -0.2266657516477214, "moduleForcesX": [ - -86.1910855019154, - -90.31940844346722, - -113.67801849819757, - -111.02458022432769 + -86.18981380029933, + -90.31876641561904, + -113.67833215471812, + -111.02482428420291 ], "moduleForcesY": [ - -76.68979833900977, - -71.82796867166277, - -19.71491355099119, - -31.47718312544661 + -76.69122231911774, + -71.82877383631241, + -19.713086660173527, + -31.47631759103055 ], - "timestamp": 8.366923221703962 + "timestamp": 8.444261264410038 }, { - "x": 14.43931308319445, - "y": 4.34921431694764, - "heading": 0.4800316822770909, - "angularVelocity": -0.9346487096953828, - "velocityX": -0.9110510437356667, - "velocityY": -0.45239120825061385, + "x": 14.439313277482153, + "y": 4.349214387879551, + "heading": 0.48002841051040274, + "angularVelocity": -0.9346744007291639, + "velocityX": -0.9110495104411049, + "velocityY": -0.4523906046510628, "moduleForcesX": [ - -85.55141100459039, - -91.08357348554144, - -113.51227513203798, - -111.34346253684424 + -85.55134610222815, + -91.0835993926443, + -113.5122715743279, + -111.3434843298819 ], "moduleForcesY": [ - -77.35792380941993, - -70.82047716964802, - -20.46082717051418, - -30.24125186998676 + -77.35798773989127, + -70.82043772341157, + -20.460816178917394, + -30.241157017363083 ], - "timestamp": 8.431390851116527 + "timestamp": 8.508728895896796 }, { - "x": 14.351171016540066, - "y": 4.30558804082172, - "heading": 0.38972613617406754, - "angularVelocity": -1.4007889994699154, - "velocityX": -1.367229840115769, - "velocityY": -0.6767159972135817, + "x": 14.351171166249667, + "y": 4.305588083853979, + "heading": 0.38972365883361226, + "angularVelocity": -1.4007766315307923, + "velocityX": -1.36723048760664, + "velocityY": -0.6767164082107209, "moduleForcesX": [ - -84.73884598587067, - -92.22471205340597, - -113.19203585458268, - -111.77189701377912 + -84.74080845033576, + -92.22557626068495, + -113.19149333747797, + -111.77152136175108 ], "moduleForcesY": [ - -78.16109203854988, - -69.25533775826135, - -21.804600786698895, - -28.42581379359055 + -78.15894950714633, + -69.25416976459643, + -21.80736431950343, + -28.427248361937462 ], - "timestamp": 8.495858480529092 + "timestamp": 8.573196527383555 }, { - "x": 14.233589173698537, - "y": 4.247619822740085, - "heading": 0.26996789764323587, - "angularVelocity": -1.8576491740441032, - "velocityX": -1.8238896623460294, - "velocityY": -0.899183336037755, + "x": 14.233588914840404, + "y": 4.247619595905105, + "heading": 0.26997308661776914, + "angularVelocity": -1.8575301970018723, + "velocityX": -1.8238959412277143, + "velocityY": -0.8991874931961759, "moduleForcesX": [ - -83.94734279206497, - -93.71262507711467, - -112.51014857524358, - -112.18119405884299 + -83.95312347953679, + -93.71457960486222, + -112.50854673479257, + -112.18000941325678 ], "moduleForcesY": [ - -78.75950431025406, - -67.00490432643183, - -24.107835571776057, - -26.138048273426037 + -78.75329673294335, + -67.00210588095803, + -24.115214852616447, + -26.14296935585298 ], - "timestamp": 8.560326109941657 + "timestamp": 8.637664158870313 }, { - "x": 14.115079803991925, - "y": 4.1906611165057175, - "heading": 0.16138894503781345, - "angularVelocity": -1.684239882787762, - "velocityX": -1.8382771444596275, - "velocityY": -0.8835241306897931, + "x": 14.115079451175838, + "y": 4.190660759682163, + "heading": 0.1613963797549536, + "angularVelocity": -1.684204993402254, + "velocityX": -1.838278542758427, + "velocityY": -0.8835261186017336, "moduleForcesX": [ - -9.13188600483001, - 0.6594868643931586, - -7.033546414107018, - 2.829502387337377 + -9.131767443283287, + 0.657652513902004, + -7.026024173540864, + 2.827996500407243 ], "moduleForcesY": [ - 9.22236053294357, - 10.854211773830855, - -3.940291709352419, - -2.3393545564545586 + 9.220317045131871, + 10.850457001015958, + -3.937376845183369, + -2.33456033627213 ], - "timestamp": 8.624793739354223 + "timestamp": 8.702131790357072 }, { - "x": 14.026121874269307, - "y": 4.147944154593341, - "heading": 0.08059232970734283, - "angularVelocity": -1.2532896907594953, - "velocityX": -1.3798852312891086, - "velocityY": -0.6626110235728712, + "x": 14.026121631743985, + "y": 4.147943895629665, + "heading": 0.0805975262697081, + "angularVelocity": -1.2533243679324726, + "velocityX": -1.3798834760995349, + "velocityY": -0.6626094842846951, "moduleForcesX": [ - 83.4973536278126, - 96.20030583423285, - 111.30688094678439, - 112.87287120033251 + 83.50128406439772, + 96.20123306665765, + 111.30567857439888, + 112.87198136728139 ], "moduleForcesY": [ - 79.26624964258428, - 63.39232613998023, - 29.071556787646845, - 22.91076603510508 + 79.26206350790244, + 63.390860409712666, + 29.076088096144087, + 22.914988055013154 ], - "timestamp": 8.689261368766788 + "timestamp": 8.76659942184383 }, { - "x": 13.966795553083806, - "y": 4.119469408000457, - "heading": 0.026899111947888268, - "angularVelocity": -0.8328709811220388, - "velocityX": -0.9202497707157782, - "velocityY": -0.44169061050248953, + "x": 13.966795455334186, + "y": 4.119469300656433, + "heading": 0.026901223924660083, + "angularVelocity": -0.8329188013689767, + "velocityX": -0.9202474953959547, + "velocityY": -0.44168824441893756, "moduleForcesX": [ - 83.72178565794114, - 97.04105274434198, - 111.04097404028195, - 113.1692570345272 + 83.7225268890319, + 97.04118666628618, + 111.04073186741968, + 113.16906929813969 ], "moduleForcesY": [ - 79.27865285910264, - 62.33849530904982, - 30.86623247761861, - 22.16395504861237 + 79.277855670948, + 62.338271276948674, + 30.8670649445909, + 22.16486600754754 ], - "timestamp": 8.753728998179353 + "timestamp": 8.831067053330589 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -5.471472021048484e-22, - "angularVelocity": -0.4172499003452693, - "velocityX": -0.4601476014328733, - "velocityY": -0.22081995024741832, + "heading": -7.672751967232841e-22, + "angularVelocity": -0.4172826471868354, + "velocityX": -0.46014607036910227, + "velocityY": -0.22081827805865759, "moduleForcesX": [ - 83.78966430984653, - 97.43168523301408, - 110.86442475699113, - 113.29850030582718 + 83.78876895559848, + 97.43147500123011, + 110.86467892511294, + 113.29868293583837 ], "moduleForcesY": [ - 79.28878914703334, - 61.80679526055779, - 31.75377302463106, - 21.754142326817494 + 79.28972924119255, + 61.807121644078165, + 31.75285868370552, + 21.753172555886685 ], - "timestamp": 8.818196627591918 + "timestamp": 8.895534684817347 }, { "x": 13.93713092803955, "y": 4.105233669281006, - "heading": -2.8621211551694397e-22, - "angularVelocity": 5.572576028883896e-23, - "velocityX": -4.824070785889513e-23, - "velocityY": 2.571239855995328e-23, + "heading": -4.0079483813745946e-22, + "angularVelocity": 7.869245843501478e-23, + "velocityX": -6.798727482788098e-23, + "velocityY": 3.6396954748620986e-23, "moduleForcesX": [ - 83.72024176507074, - 97.43090964153055, - 110.92939949551024, - 113.34375281098819 + 83.71833110199695, + 97.43047601274753, + 110.92997514796727, + 113.34415942502997 ], "moduleForcesY": [ - 79.40203201217798, - 61.848085945116544, - 31.65827320851069, - 21.650429300155597 + 79.40404372307425, + 61.848767947517445, + 31.65623556989346, + 21.648293642924163 ], - "timestamp": 8.882664257004484 + "timestamp": 8.960002316304106 }, { - "x": 13.963559175947621, - "y": 4.117038967947073, - "heading": 0.030366199225700365, - "angularVelocity": 0.49847391634203947, - "velocityX": 0.4338307912320192, - "velocityY": 0.19378893670305897, + "x": 13.963559067974218, + "y": 4.117038855996892, + "heading": 0.030368053809770958, + "angularVelocity": 0.4985043435513874, + "velocityX": 0.4338290043854112, + "velocityY": 0.19378709255352022, "moduleForcesX": [ - 79.65664846502816, - 96.7817820837899, - 113.52833812262094, - 114.54083675568863 + 79.65476731370322, + 96.78133854290633, + 113.52876962438681, + 114.54105043150145 ], "moduleForcesY": [ - 83.46877311897669, - 62.85593025806044, - 20.384715377312528, - 13.981072396380851 + 83.47056524407438, + 62.85661167452952, + 20.38227792487243, + 13.979310801185607 ], - "timestamp": 8.943582588395898 + "timestamp": 9.020920649720072 }, { - "x": 14.016366174130928, - "y": 4.140701386661653, - "heading": 0.09167550612380743, - "angularVelocity": 1.006418027181029, - "velocityX": 0.8668490580283776, - "velocityY": 0.3884285431677946, + "x": 14.016365911548785, + "y": 4.140701139163088, + "heading": 0.09167991518604457, + "angularVelocity": 1.0064599265646343, + "velocityX": 0.8668464912522909, + "velocityY": 0.3884263051752232, "moduleForcesX": [ - 79.75263731487117, - 95.85123578413572, - 113.82581248115163, - 114.32031499165953 + 79.75194362178686, + 95.85098527966768, + 113.82595812934248, + 114.32037290983276 ], "moduleForcesY": [ - 83.33210206979211, - 64.22511537248802, - 18.4223489250406, - 15.504096672679982 + 83.3327591230383, + 64.22548363003438, + 18.42140386226322, + 15.503643170599599 ], - "timestamp": 9.004500919787313 + "timestamp": 9.081838983136038 }, { - "x": 14.095461362866395, - "y": 4.176301641210184, - "heading": 0.18482890661175871, - "angularVelocity": 1.5291522003355542, - "velocityX": 1.2983807489286403, - "velocityY": 0.5843931331571135, + "x": 14.09546101627666, + "y": 4.176301351792292, + "heading": 0.18483456282360425, + "angularVelocity": 1.5291726219999324, + "velocityX": 1.2983793267585335, + "velocityY": 0.5843924256121095, "moduleForcesX": [ - 79.85703113409431, - 94.3761457349691, - 114.17093924825683, - 113.9597881511265 + 79.8583024750478, + 94.37638365733321, + 114.17069050727945, + 113.95958149721488 ], "moduleForcesY": [ - 83.13867501463085, - 66.29352669629836, - 15.629038984963566, - 17.657848513922918 + 83.13743831492833, + 66.2931720124335, + 15.630779550308679, + 17.659120262265205 ], - "timestamp": 9.065419251178728 + "timestamp": 9.142757316552004 }, { - "x": 14.200699287122616, - "y": 4.223965232327085, - "heading": 0.3106849191969956, - "angularVelocity": 2.065979315431074, - "velocityX": 1.727524734386503, - "velocityY": 0.7824178704214827, + "x": 14.200699188552337, + "y": 4.223965142674428, + "heading": 0.31068656428821845, + "angularVelocity": 2.065913402542767, + "velocityX": 1.7275287483175548, + "velocityY": 0.7824211236488451, "moduleForcesX": [ - 80.1960591657279, - 92.27983792176538, - 114.33788054491679, - 113.32380930105033 + 80.20103541951023, + 92.28142357461464, + 114.33707780014122, + 113.32310550893337 ], "moduleForcesY": [ - 82.52218385370314, - 68.94832064257957, - 12.575832251224803, - 20.593651711278543 + 82.51730402352764, + 68.94614202726275, + 12.582895501177102, + 20.59733382901847 ], - "timestamp": 9.126337582570143 + "timestamp": 9.20367564996797 }, { - "x": 14.30480960423839, - "y": 4.273756936630003, - "heading": 0.440274689451697, - "angularVelocity": 2.1272705160300247, - "velocityX": 1.7090145894975617, - "velocityY": 0.8173517423350791, + "x": 14.304809926372224, + "y": 4.273756975831149, + "heading": 0.44027066008733234, + "angularVelocity": 2.127177296763508, + "velocityX": 1.7090214387349074, + "velocityY": 0.8173538303605641, "moduleForcesX": [ - -7.063912641839332, - -3.684421057893775, - -4.954961279242321, - -1.555725211526507 + -7.061909627091463, + -3.68518517704315, + -4.9517960037118725, + -1.5574851448945195 ], "moduleForcesY": [ - 9.597559778514192, - 11.19198717343441, - 5.090196808910568, - 6.6929024451344965 + 9.59809098836741, + 11.190702840893662, + 5.0913730591202535, + 6.691391790761715 ], - "timestamp": 9.187255913961557 + "timestamp": 9.264593983383936 }, { - "x": 14.38290241669244, - "y": 4.311211682575675, - "heading": 0.537136017858053, - "angularVelocity": 1.5900193947204506, - "velocityX": 1.2819263211968939, - "velocityY": 0.6148353884648875, + "x": 14.382902717879288, + "y": 4.3112117278174935, + "heading": 0.5371322202602826, + "angularVelocity": 1.5900231464238184, + "velocityX": 1.2819259347399998, + "velocityY": 0.6148354671916827, "moduleForcesX": [ - -82.51336670219094, - -88.82178084722041, - -114.69665015134913, - -112.1890206641741 + -82.51888433729174, + -88.82438792099875, + -114.69599016804355, + -112.18828932823602 ], "moduleForcesY": [ - -80.15041574335491, - -73.33093047177117, - -9.21770289044376, - -26.12896176757333 + -80.14469842932262, + -73.32771655792324, + -9.225518690999811, + -26.131944406933375 ], - "timestamp": 9.248174245352972 + "timestamp": 9.325512316799902 }, { - "x": 14.43496566772784, - "y": 4.336216845215367, - "heading": 0.6015938905381637, - "angularVelocity": 1.0581030571233854, - "velocityX": 0.8546401361665806, - "velocityY": 0.4104702487503784, + "x": 14.434965804754063, + "y": 4.33621686660926, + "heading": 0.6015921619911261, + "angularVelocity": 1.0581369862943197, + "velocityX": 0.8546374129980221, + "velocityY": 0.41046984363517086, "moduleForcesX": [ - -83.61446769451484, - -87.93445802257577, - -114.93625421398835, - -111.92017771507035 + -83.61615888406612, + -87.9353553509811, + -114.93605502522537, + -111.91995391554177 ], "moduleForcesY": [ - -79.30871463146501, - -74.61104959107463, - -8.79132443274591, - -27.840746229308348 + -79.30691637646417, + -74.60997644793589, + -8.793781645274763, + -27.84160522062182 ], - "timestamp": 9.309092576744387 + "timestamp": 9.386430650215868 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 0.5296576683558456, - "velocityX": 0.4273247996047913, - "velocityY": 0.20526140282074212, + "angularVelocity": 0.529686025578064, + "velocityX": 0.42732253606019294, + "velocityY": 0.20526104480936738, "moduleForcesX": [ - -84.19152726546557, - -87.47215406723159, - -115.01634601054388, - -111.75251144456591 + -84.1911992495474, + -87.47197704017138, + -115.01637354227934, + -111.75254715698384 ], "moduleForcesY": [ - -78.80193174691267, - -75.22571028375239, - -8.61896304131099, - -28.69190883048073 + -78.8022727113627, + -75.22591033857384, + -8.618524833768987, + -28.691755739808066 ], - "timestamp": 9.370010908135802 + "timestamp": 9.447348983631834 }, { "x": 14.460997581481934, "y": 4.348721027374268, "heading": 0.6338597519030688, - "angularVelocity": 1.1797364189027284e-23, - "velocityX": -1.1325605604528817e-23, - "velocityY": 2.3217947109929744e-23, + "angularVelocity": 1.5901790954601477e-23, + "velocityX": -1.5508239035272037e-23, + "velocityY": 3.190246274802254e-23, "moduleForcesX": [ - -84.15066425501406, - -87.45368989610188, - -115.05496155327525, - -111.78204650706883 + -84.14903985656575, + -87.45282015084248, + -115.05512710586952, + -111.7822513078171 ], "moduleForcesY": [ - -78.90065034494464, - -75.28457785684638, - -8.534123812406214, - -28.668166390935667 + -78.90237620597068, + -75.28558613417827, + -8.531852509603707, + -28.667363381920115 ], - "timestamp": 9.430929239527217 + "timestamp": 9.5082673170478 } ], "eventMarkers": [ { - "timestamp": 1.6357315017277103, + "timestamp": 1.642985218083203, "command": { "type": "named", "data": { @@ -3141,7 +3183,7 @@ } }, { - "timestamp": 6.746975154041393, + "timestamp": 6.823262014669494, "command": { "type": "named", "data": { @@ -3150,7 +3192,7 @@ } }, { - "timestamp": 8.502455592291396, + "timestamp": 8.579793632923279, "command": { "type": "named", "data": { @@ -3159,7 +3201,7 @@ } }, { - "timestamp": 4.404598551047537, + "timestamp": 4.462435647449047, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Red OP.1.traj b/src/main/deploy/choreo/Red OP.1.traj index bb29222..eb11482 100644 --- a/src/main/deploy/choreo/Red OP.1.traj +++ b/src/main/deploy/choreo/Red OP.1.traj @@ -4,9 +4,9 @@ "x": 15.781251907348633, "y": 6.674294471740723, "heading": -1.0370884287879991, - "angularVelocity": -1.2621726109028427e-25, - "velocityX": 1.4651515238606446e-24, - "velocityY": -1.680503205752954e-25, + "angularVelocity": -1.9866208287541445e-22, + "velocityX": -1.3943691504612067e-20, + "velocityY": 1.721129501746892e-21, "moduleForcesX": [ 0, 0, @@ -22,214 +22,214 @@ "timestamp": 0 }, { - "x": 15.737579234276897, - "y": 6.679677617673034, - "heading": -1.0238784708913053, - "angularVelocity": 0.17911083631788308, - "velocityX": -0.5921479129069697, - "velocityY": 0.07298886018394904, + "x": 15.737579450239823, + "y": 6.679677689320791, + "heading": -1.0238715954789284, + "angularVelocity": 0.1792040409939818, + "velocityX": -0.592144926929208, + "velocityY": 0.07298982451690347, "moduleForcesX": [ - -111.52415378273292, - -114.49845914960217, - -114.62304761463147, - -115.39645209570611 + -111.5219305913229, + -114.498394155326, + -114.62307907253539, + -115.39636467253322 ], "moduleForcesY": [ - 29.64724689974533, - 14.302632979180668, - 13.43617051536317, - -1.1737539863505893 + 29.65555787933653, + 14.3029848589867, + 13.435844022960673, + -1.1813531589219308 ], - "timestamp": 0.07375297982110327 + "timestamp": 0.0737529870183815 }, { - "x": 15.65024272244521, - "y": 6.690442536464301, - "heading": -0.9972998437394694, - "angularVelocity": 0.36037360410800473, - "velocityX": -1.1841760433752266, - "velocityY": 0.1459591031762828, + "x": 15.650243268574524, + "y": 6.690442727379406, + "heading": -0.9972824865204766, + "angularVelocity": 0.3605156893757415, + "velocityX": -1.1841714511648371, + "velocityY": 0.14596070605154865, "moduleForcesX": [ - -111.50844636902373, - -114.41456026220695, - -114.64994745113319, - -115.37690823700736 + -111.50730603264702, + -114.41445099721365, + -114.6499789417417, + -115.37684481502328 ], "moduleForcesY": [ - 29.631929160379492, - 14.78872900282211, - 13.058413629305413, - -1.281113395748797 + 29.636133156128178, + 14.789343949904154, + 13.057990695853707, + -1.2850231166130164 ], - "timestamp": 0.14750595964220653 + "timestamp": 0.147505974036763 }, { - "x": 15.519260170047334, - "y": 6.706587085965137, - "heading": -0.9570257848318809, - "angularVelocity": 0.5460668708610573, - "velocityX": -1.7759628521530966, - "velocityY": 0.21890030124879606, + "x": 15.519260985004637, + "y": 6.706587400459137, + "heading": -0.9570001256980181, + "angularVelocity": 0.5461793813505997, + "velocityX": -1.7759590338658693, + "velocityY": 0.21890195546531085, "moduleForcesX": [ - -111.46040731354765, - -114.27773305577186, - -114.68449962172555, - -115.34136867400807 + -111.46108154508877, + -114.27765420928104, + -114.68446600714896, + -115.34135846330668 ], "moduleForcesY": [ - 29.681971808482846, - 15.525374011394444, - 12.482698846734126, - -1.5144551853011516 + 29.67926678958357, + 15.525601814683496, + 12.482626306329125, + -1.5118713708448794 ], - "timestamp": 0.2212589394633098 + "timestamp": 0.22125896105514448 }, { - "x": 15.344671348566528, - "y": 6.7281056267189525, - "heading": -0.9024652860812764, - "angularVelocity": 0.7397734828199154, - "velocityX": -2.3672104083698318, - "velocityY": 0.29176503520279506, + "x": 15.344671992310621, + "y": 6.728105972585149, + "heading": -0.9024462454019326, + "angularVelocity": 0.7396836725065657, + "velocityX": -2.367212498803648, + "velocityY": 0.29176543209902306, "moduleForcesX": [ - -111.33731276290986, - -114.047317314268, - -114.70303402913382, - -115.26103974744757 + -111.3416986263144, + -114.04761304875294, + -114.70270359118507, + -115.26119474678515 ], "moduleForcesY": [ - 29.852227212177972, - 16.537440340405904, - 11.678182443826497, - -1.9511492781752187 + 29.835398318882262, + 16.53470475362042, + 11.680162554712537, + -1.9345387090441741 ], - "timestamp": 0.29501191928441306 + "timestamp": 0.295011948073526 }, { - "x": 15.126638225171718, - "y": 6.754973444774636, - "heading": -0.8320689272797918, - "angularVelocity": 0.9544883335187218, - "velocityX": -2.956261888315243, - "velocityY": 0.3642946782740956, + "x": 15.126636955507474, + "y": 6.754973345333405, + "heading": -0.8321165267909179, + "angularVelocity": 0.9535846811666963, + "velocityX": -2.9562875432937514, + "velocityY": 0.36428860490166864, "moduleForcesX": [ - -110.76647931585221, - -113.4372446028584, - -114.54159557891052, - -114.91207845018252 + -110.78310373820221, + -113.43975897922056, + -114.53954300836371, + -114.91309615963544 ], "moduleForcesY": [ - 30.725491734044457, - 18.019343819168096, - 10.430723288375898, - -3.31692802572431 + 30.66242904873677, + 18.000125302132766, + 10.443175232183501, + -3.252087288558954 ], - "timestamp": 0.36876489910551635 + "timestamp": 0.3687649350919075 }, { - "x": 14.95206300120593, - "y": 6.77647174900219, - "heading": -0.773433535697502, - "angularVelocity": 0.7950240346155092, - "velocityX": -2.3670260427340133, - "velocityY": 0.29149065271260355, + "x": 14.952061791200475, + "y": 6.776471593869833, + "heading": -0.773477230035834, + "angularVelocity": 0.7950769063830467, + "velocityX": -2.367025002844833, + "velocityY": 0.29148986916380626, "moduleForcesX": [ - 111.67454146499206, - 113.21740142392865, - 114.23838580721042, - 114.66905825851461 + 111.69180132345558, + 113.22262332485307, + 114.23686977658001, + 114.66860726835483 ], "moduleForcesY": [ - -26.07191731663405, - -17.63441497120966, - -10.811867231610925, - -1.5517466920592173 + -26.00046807992641, + -17.609482537218337, + -10.829705083256483, + -1.6262110875675433 ], - "timestamp": 0.44251787892661965 + "timestamp": 0.442517922110289 }, { - "x": 14.821107358373453, - "y": 6.792594475814811, - "heading": -0.7289082448366585, - "angularVelocity": 0.6037083649887086, - "velocityX": -1.7755979914320057, - "velocityY": 0.21860441234684685, + "x": 14.821106606729163, + "y": 6.792594367193026, + "heading": -0.728934985378209, + "angularVelocity": 0.6039381787550343, + "velocityX": -1.7755916033431103, + "velocityY": 0.21860502164033546, "moduleForcesX": [ - 111.76581158852909, - 113.62556481771135, - 114.85540369095074, - 115.24093186284539 + 111.76902146309567, + 113.62660597529597, + 114.85509991104111, + 115.24105907142824 ], "moduleForcesY": [ - -28.104376111602893, - -19.05291831548317, - -9.730572920361016, - 0.7546034880784759 + -28.09175703488538, + -19.04718344009563, + -9.734361300742906, + 0.7411160901552712 ], - "timestamp": 0.5162708587477229 + "timestamp": 0.5162709091286705 }, { - "x": 14.733794757049841, - "y": 6.8033423608281804, - "heading": -0.699054593949396, - "angularVelocity": 0.40477891143756034, - "velocityX": -1.1838518461952143, - "velocityY": 0.14572814602799683, + "x": 14.733794470977603, + "y": 6.8033423167589095, + "heading": -0.6990646840438874, + "angularVelocity": 0.40500463156667743, + "velocityX": -1.183845418081848, + "velocityY": 0.14572900705980713, "moduleForcesX": [ - 111.79320392724134, - 113.62956435917394, - 114.97926679056616, - 115.33065660328327 + 111.7931349384804, + 113.62959134846821, + 114.9792838560784, + 115.33066788879077 ], "moduleForcesY": [ - -28.3773819380287, - -19.66367922942836, - -9.251806083394841, - 1.1672848935603741 + -28.37771557003671, + -19.66362346001396, + -9.251771451433502, + 1.167727477271745 ], - "timestamp": 0.5900238385688262 + "timestamp": 0.590023896147052 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": 0.2026753043980143, - "velocityX": -0.5919727585178587, - "velocityY": 0.07286398915017836, + "angularVelocity": 0.20281209391920932, + "velocityX": -0.591968821960951, + "velocityY": 0.07286457956489158, "moduleForcesX": [ - 111.81186730618849, - 113.62366087491984, - 115.03206722044585, - 115.36748176404834 + 111.8103126294131, + 113.62315026046184, + 115.03223801565095, + 115.36741290735165 ], "moduleForcesY": [ - -28.459057623857394, - -19.953358992688436, - -9.022048294829766, - 1.3182086277737222 + -28.465206698015187, + -19.95629133803773, + -9.02002923668353, + 1.325068049848567 ], - "timestamp": 0.6637768183899295 + "timestamp": 0.6637768831654335 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": -1.6373628874461133e-23, - "velocityX": 8.947893033904734e-24, - "velocityY": -1.1505319118510811e-23, + "angularVelocity": -2.5642140347804797e-20, + "velocityX": -3.5823449426452e-20, + "velocityY": -1.925043641959108e-19, "moduleForcesX": [ - 111.82265390196439, - 113.64454489492644, - 115.05199065534637, - 115.38802821587312 + 111.82024353932489, + 113.64374505858738, + 115.05224225386621, + 115.38791059104989 ], "moduleForcesY": [ - -28.500501780206477, - -19.972823998599004, - -9.007971358764712, - 1.3651700292396918 + -28.50998973892722, + -19.97737600929884, + -9.004897700061502, + 1.3756871088737914 ], - "timestamp": 0.7375297982110328 + "timestamp": 0.737529870183815 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red OP.2.traj b/src/main/deploy/choreo/Red OP.2.traj index 61cb4a4..6db7b8a 100644 --- a/src/main/deploy/choreo/Red OP.2.traj +++ b/src/main/deploy/choreo/Red OP.2.traj @@ -4,400 +4,400 @@ "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": -1.6373628874461133e-23, - "velocityX": 8.947893033904734e-24, - "velocityY": -1.1505319118510811e-23, + "angularVelocity": -2.5642140347804797e-20, + "velocityX": -3.5823449426452e-20, + "velocityY": -1.925043641959108e-19, "moduleForcesX": [ - 111.82265390196439, - 113.64454489492644, - 115.05199065534637, - 115.38802821587312 + 111.82024353932489, + 113.64374505858738, + 115.05224225386621, + 115.38791059104989 ], "moduleForcesY": [ - -28.500501780206477, - -19.972823998599004, - -9.007971358764712, - 1.3651700292396918 + -28.50998973892722, + -19.97737600929884, + -9.004897700061502, + 1.3756871088737914 ], "timestamp": 0 }, { - "x": 14.675442670065264, - "y": 6.813379455407895, - "heading": -0.6717552714338458, - "angularVelocity": 0.28012842601201576, - "velocityX": -0.3332201126313312, - "velocityY": 0.10575980127060357, + "x": 14.675427628708652, + "y": 6.813251052040293, + "heading": -0.6712306053842845, + "angularVelocity": 0.29193748147934406, + "velocityX": -0.33345810585500363, + "velocityY": 0.1028158279786869, "moduleForcesX": [ - -98.66143888298555, - -101.74059915261991, - -113.5288649606166, - -115.33460700108112 + -98.56104344072963, + -101.77209540362654, + -113.76419860866348, + -115.34193264889893 ], "moduleForcesY": [ - 59.785007713118624, - 54.28404650214978, - 20.548862722674233, - 1.6254648649671486 + 59.95036989637328, + 54.21915011775324, + 19.206886815923188, + -0.9665078147572825 ], - "timestamp": 0.04409197258516573 + "timestamp": 0.04410561077790165 }, { - "x": 14.645995324424886, - "y": 6.822611735205374, - "heading": -0.6475745131726771, - "angularVelocity": 0.5484163407400843, - "velocityX": -0.6678618332055477, - "velocityY": 0.20938686241916543, + "x": 14.645951659507638, + "y": 6.822252244551949, + "heading": -0.6460812610559683, + "angularVelocity": 0.5702073700998768, + "velocityX": -0.6683042969168805, + "velocityY": 0.20408270859191352, "moduleForcesX": [ - -99.75522587908065, - -102.42692626434821, - -113.61159697879016, - -115.30312469583279 + -99.67413943343905, + -102.41667407252237, + -113.80517697131697, + -115.33090537915734 ], "moduleForcesY": [ - 57.918836347024914, - 52.949230173428, - 20.022389058972617, - 2.6054576839941515 + 58.057715139352084, + 52.96303310230855, + 18.892577765031255, + 0.5017832153100624 ], - "timestamp": 0.08818394517033146 + "timestamp": 0.0882112215558033 }, { - "x": 14.601720929906575, - "y": 6.836296863592373, - "heading": -0.6121698252606008, - "angularVelocity": 0.802973553602993, - "velocityX": -1.0041373048754916, - "velocityY": 0.3103768687274164, + "x": 14.60163725558127, + "y": 6.835636025102194, + "heading": -0.6093693928259745, + "angularVelocity": 0.83236276706064, + "velocityX": -1.0047339362222996, + "velocityY": 0.30344848000491226, "moduleForcesX": [ - -101.05043111896799, - -103.17292508176739, - -113.72399441780098, - -115.25417706262766 + -100.991325152693, + -103.11790484339444, + -113.86495520158219, + -115.29193191628325 ], "moduleForcesY": [ - 55.59926387355985, - 51.44579662555788, - 19.28978582137924, - 3.763922989102108 + 55.705085158124895, + 51.549723350324534, + 18.43745216980293, + 2.2745321495909177 ], - "timestamp": 0.13227591775549719 + "timestamp": 0.13231683233370495 }, { - "x": 14.542534274068288, - "y": 6.854289480670813, - "heading": -0.5663088411318837, - "angularVelocity": 1.04012094356029, - "velocityX": -1.3423453832546366, - "velocityY": 0.40807013212408705, + "x": 14.54240224861384, + "y": 6.853299205917846, + "heading": -0.5620118203579388, + "angularVelocity": 1.0737312471764549, + "velocityX": -1.3430265656157756, + "velocityY": 0.40047469027457633, "moduleForcesX": [ - -102.57468929953593, - -104.09282628417807, - -113.84725221188148, - -115.17640973922873 + -102.53916594922721, + -104.00399188740985, + -113.91900928393952, + -115.20317523209395 ], "moduleForcesY": [ - 52.69527446824037, - 49.514027860489485, - 18.434236842874185, - 5.208253519164049 + 52.761241240453465, + 49.693648028830694, + 17.977297280367917, + 4.521635796707823 ], - "timestamp": 0.17636789034066291 + "timestamp": 0.1764224431116066 }, { - "x": 14.468332402329434, - "y": 6.876403676556318, - "heading": -0.5110338700297112, - "angularVelocity": 1.2536289002585717, - "velocityX": -1.6828884576558436, - "velocityY": 0.501546984381149, + "x": 14.468148235945801, + "y": 6.875112546792884, + "heading": -0.5052716820349888, + "angularVelocity": 1.286460777261897, + "velocityX": -1.6835502639776507, + "velocityY": 0.4945706564383568, "moduleForcesX": [ - -104.36995920291493, - -105.32254762054377, - -113.95741323469906, - -115.04927896233585 + -104.36005213468482, + -105.22540646754365, + -113.93211638348767, + -115.02101774687752 ], "moduleForcesY": [ - 48.98783162688297, - 46.78241555241345, - 17.57930257657602, - 7.070518349276318 + 49.00253104776368, + 46.99284585116924, + 17.723543700297828, + 7.461228629108571 ], - "timestamp": 0.22045986292582864 + "timestamp": 0.22052805388950825 }, { - "x": 14.37898957009058, - "y": 6.902392060853308, - "heading": -0.44783074537436557, - "angularVelocity": 1.4334383550943604, - "velocityX": -2.026283402637178, - "velocityY": 0.5894130557845081, + "x": 14.378757412573508, + "y": 6.900907275957238, + "heading": -0.4409704067619092, + "angularVelocity": 1.4578933187633483, + "velocityX": -2.0267449377911255, + "velocityY": 0.5848400851820366, "moduleForcesX": [ - -106.49908090238071, - -107.01525529263431, - -114.02178183246805, - -114.83695790685455 + -106.52188217914602, + -106.94884746449374, + -113.84546391040449, + -114.66217685453101 ], "moduleForcesY": [ - 44.081369792919354, - 42.68370625113583, - 16.92078527818248, - 9.50620759153989 + 44.012594395755805, + 42.839962321036545, + 18.031148465609164, + 11.368492354698162 ], - "timestamp": 0.2645518355109945 + "timestamp": 0.26463366466741 }, { - "x": 14.27435337661712, - "y": 6.9319034624003555, - "heading": -0.378909376081055, - "angularVelocity": 1.5631273733599833, - "velocityX": -2.3731347757542367, - "velocityY": 0.6693146125418837, + "x": 14.274093603671082, + "y": 6.930444659197211, + "heading": -0.37184741685344586, + "angularVelocity": 1.5672153426587654, + "velocityX": -2.373027083322251, + "velocityY": 0.6696967283529704, "moduleForcesX": [ - -109.05079129956879, - -109.30978180404821, - -113.98678875725696, - -114.47840264239277 + -109.13072597484623, + -109.3202988487006, + -113.53294594518621, + -113.97055609730344 ], "moduleForcesY": [ - 37.169217718197665, - 36.26992503225888, - 16.79745494938532, - 12.695311902448891 + 36.90107882775114, + 36.22279873439767, + 19.561487229518704, + 16.596053973633666 ], - "timestamp": 0.3086438080961603 + "timestamp": 0.30873927544531166 }, { - "x": 14.154251482794562, - "y": 6.964387520079728, - "heading": -0.30775640664377, - "angularVelocity": 1.6137397640772269, - "velocityX": -2.7238947767776662, - "velocityY": 0.7367340532707765, + "x": 14.15402395976836, + "y": 6.963340036530724, + "heading": -0.30230713856933716, + "angularVelocity": 1.5766764603779295, + "velocityX": -2.7223213052722017, + "velocityY": 0.7458320325537722, "moduleForcesX": [ - -112.08031010757401, - -112.18021841591917, - -113.73249543230662, - -113.86796827837567 + -112.27314779877986, + -112.29121526331127, + -112.62446776737106, + -112.64475573276913 ], "moduleForcesY": [ - 26.31054160567366, - 25.791337814688173, - 17.883772198148794, - 16.866370546912236 + 25.3687700693123, + 25.27084960348355, + 23.762742580916523, + 23.647404391326813 ], - "timestamp": 0.35273578068132616 + "timestamp": 0.3528448862232133 }, { "x": 14.018568992614746, "y": 6.998851299285889, "heading": -0.2405341289144176, - "angularVelocity": 1.5245922055201624, - "velocityX": -3.077260603792211, - "velocityY": 0.7816338708727887, + "angularVelocity": 1.4005703257570525, + "velocityX": -3.0711504673568144, + "velocityY": 0.8051416164258196, "moduleForcesX": [ - -114.82237403261927, - -114.74700757937691, - -112.85254185437864, - -112.7959826533612 + -114.88838435677177, + -114.82492813620281, + -109.50587966957576, + -110.01547367885283 ], "moduleForcesY": [ - 5.717046194433142, - 7.799925169065911, - 21.890043385783084, - 22.434461113364925 + 1.804812129477657, + 6.353046745851207, + 34.75647703160557, + 33.46666656638838 ], - "timestamp": 0.396827753266492 + "timestamp": 0.39695049700111495 }, { - "x": 13.785764027917146, - "y": 7.049557069939888, - "heading": -0.17998468944051094, - "angularVelocity": 0.9309010044100465, - "velocityX": -3.5791970553589576, - "velocityY": 0.7795621766496209, + "x": 13.788287000145154, + "y": 7.053740973657355, + "heading": -0.21166669107253983, + "angularVelocity": 0.44310544982728, + "velocityX": -3.5347510374590354, + "velocityY": 0.8425380176261146, "moduleForcesX": [ - -105.90034530214052, - -112.5578546807494, - -108.95118327774632, - -110.9158025657128 + -97.329322675789, + -112.16551931316292, + -90.56768367714201, + -104.13823940579265 ], "moduleForcesY": [ - -44.54881353554729, - -23.89201960495729, - 36.12411374491502, - 30.50757452772645 + -60.86272843982779, + -25.633925874682763, + 70.25124390630064, + 48.85031849268775 ], - "timestamp": 0.4618716614662469 + "timestamp": 0.46209850602048086 }, { - "x": 13.548480509194473, - "y": 7.083413324629865, - "heading": -0.23170832211848127, - "angularVelocity": -0.7952110214399025, - "velocityX": -3.6480513746799783, - "velocityY": 0.520513844063655, + "x": 13.55067748815617, + "y": 7.084433906415849, + "heading": -0.23000952086779244, + "angularVelocity": -0.2815562604499559, + "velocityX": -3.647225994555768, + "velocityY": 0.47112618206602946, "moduleForcesX": [ - 9.943360980697118, - -64.05615636732168, - 102.05846309668772, - -108.07396127616538 + -2.9715371277537543, + -50.32031969204716, + 26.184948512995206, + -70.95695667054495 ], "moduleForcesY": [ - -112.65864909231027, - -93.25868171164684, - -35.74086748752557, - 15.439504342633342 + -102.27224679452286, + -89.36908292050822, + -80.58938519969703, + -51.59319249987748 ], - "timestamp": 0.5269155696660018 + "timestamp": 0.5272465150398468 }, { - "x": 13.344677164525947, - "y": 7.110151219170367, - "heading": -0.28721528091170123, - "angularVelocity": -0.8533767470237762, - "velocityX": -3.1333194807825815, - "velocityY": 0.411074538423911, + "x": 13.346050543006005, + "y": 7.110014029553323, + "heading": -0.27803893764500576, + "angularVelocity": -0.7372353737308557, + "velocityX": -3.1409547003859206, + "velocityY": 0.3926462761105312, "moduleForcesX": [ - 111.64039245061323, - 111.67573063214599, - 113.05374138509697, - 113.12917537886882 + 107.29038544493396, + 105.50415195458457, + 114.90061482209745, + 113.70906001277713 ], "moduleForcesY": [ - -27.3804179148427, - -27.135696145803145, - -20.80013262963892, - -20.25362840349172 + -41.12412783239415, + -44.92027941539363, + 2.350623072487603, + 15.269282404330298 ], - "timestamp": 0.5919594778657568 + "timestamp": 0.5923945240592127 }, { - "x": 13.174758752766676, - "y": 7.131608923168944, - "heading": -0.33740943490813896, - "angularVelocity": -0.7716964645218987, - "velocityX": -2.612364731181882, - "velocityY": 0.32989567497511807, + "x": 13.17555433292844, + "y": 7.131108704498771, + "heading": -0.3278649259101783, + "angularVelocity": -0.7648121410795735, + "velocityX": -2.617059410470719, + "velocityY": 0.32379615682769, "moduleForcesX": [ - 114.5610194383314, - 114.39486717948932, - 113.08162800775546, - 112.89574776865835 + 113.95000686208219, + 114.00926980580654, + 114.37824029202245, + 114.432579234299 ], "moduleForcesY": [ - -12.147523599218806, - -13.756071322380498, - -21.984601963668993, - -23.002730233684403 + -16.845089796422403, + -16.397310132902103, + -13.650410305482506, + -13.135741678489495 ], - "timestamp": 0.6570033860655117 + "timestamp": 0.6575425330785786 }, { - "x": 13.03879537020891, - "y": 7.148379691490802, - "heading": -0.37942088256423195, - "angularVelocity": -0.6458936558220427, - "velocityX": -2.090332305067128, - "velocityY": 0.2578376482291461, + "x": 13.039211960013166, + "y": 7.1478899748634275, + "heading": -0.3721868233579608, + "angularVelocity": -0.6803262005229891, + "velocityX": -2.0928095112583573, + "velocityY": 0.257586849041975, "moduleForcesX": [ - 115.09723127896024, - 114.86715102435959, - 113.15121967782909, - 112.75876113770701 + 114.97790928984213, + 114.81105309086456, + 113.77046476766135, + 113.51984327567988 ], "moduleForcesY": [ - -6.694150425031576, - -10.065224665337288, - -22.080340952979505, - -24.086273621516778 + -8.413922151143758, + -10.5686669898906, + -18.601337026327453, + -20.14217381557217 ], - "timestamp": 0.7220472942652666 + "timestamp": 0.7226905420979445 }, { - "x": 12.93681096444313, - "y": 7.1607529171336655, - "heading": -0.4118889861172464, - "angularVelocity": -0.49917208931084484, - "velocityX": -1.5679317031900568, - "velocityY": 0.19022881596941998, + "x": 12.936993453855967, + "y": 7.16043119839742, + "heading": -0.4076788949391856, + "angularVelocity": -0.5447913468955652, + "velocityX": -1.5690196476582259, + "velocityY": 0.1925035580176633, "moduleForcesX": [ - 115.27036043262517, - 115.03722833246768, - 113.22264635282365, - 112.66564421864199 + 115.25718411477271, + 115.04192430676589, + 113.43999532206203, + 112.93907410546886 ], "moduleForcesY": [ - -3.897941495417185, - -8.482092446228034, - -21.944669919102676, - -24.71594535140867 + -4.1842117021754905, + -8.36626096655789, + -20.776774168788005, + -23.417109666661794 ], - "timestamp": 0.7870912024650215 + "timestamp": 0.7878385511173104 }, { - "x": 12.86881655254604, - "y": 7.168899399845526, - "heading": -0.4340261020129738, - "angularVelocity": -0.3403411096968923, - "velocityX": -1.045361722242647, - "velocityY": 0.1252458983067642, + "x": 12.868869943457646, + "y": 7.168770766708618, + "heading": -0.43245925393772605, + "angularVelocity": -0.38037016589677036, + "velocityX": -1.0456729441734487, + "velocityY": 0.1280095652457402, "moduleForcesX": [ - 115.34180830581067, - 115.1220732972316, - 113.27936411804733, - 112.60054698627378 + 115.34930465283051, + 115.14281844208664, + 113.24852185391626, + 112.55115361335103 ], "moduleForcesY": [ - -2.2058871322716747, - -7.623094959817495, - -21.792793628817755, - -25.125745546203547 + -1.6624491289951602, + -7.285612760344197, + -21.94224971099902, + -25.340251738278926 ], - "timestamp": 0.8521351106647764 + "timestamp": 0.8529865601366763 }, { "x": 12.83481788635254, - "y": 7.172932147979736, + "y": 7.172932147979735, "heading": -0.44530098242829574, - "angularVelocity": -0.17334260390221193, - "velocityX": -0.5227033112629944, - "velocityY": 0.06200039705217003, + "angularVelocity": -0.19711620790671255, + "velocityX": -0.5226876096087977, + "velocityY": 0.06387580117578445, "moduleForcesX": [ - 115.37550458711002, - 115.17526382073038, - 113.31339825214359, - 112.55684919025829 + 115.37974072229976, + 115.20102163601167, + 113.11488966367791, + 112.28107877840188 ], "moduleForcesY": [ - -1.08050082459098, - -7.042007188765636, - -21.71168485805975, - -25.396097743199675 + -0.004287565574101409, + -6.608776467019539, + -22.71557758012725, + -26.587848089395145 ], - "timestamp": 0.9171790188645313 + "timestamp": 0.9181345691560422 }, { "x": 12.83481788635254, "y": 7.172932147979736, "heading": -0.44530098242829574, - "angularVelocity": -3.9933853319259413e-22, - "velocityX": 8.259574098341232e-22, - "velocityY": -8.025414561021505e-21, + "angularVelocity": -4.3322696611731714e-20, + "velocityX": -8.054779748279346e-20, + "velocityY": -2.673843206569549e-19, "moduleForcesX": [ - 115.3927162988571, - 115.2157166646866, - 113.32030793770694, - 112.5314849425636 + 115.38688887330075, + 115.24383423254851, + 112.99392182289489, + 112.09250755639513 ], "moduleForcesY": [ - -0.2866941492311068, - -6.549472740050449, - -21.74513414149322, - -25.561679568405665 + 1.1556352772333405, + -6.047136158151505, + -23.37602173859373, + -27.42405623065844 ], - "timestamp": 0.9822229270642863 + "timestamp": 0.9832825781754081 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red OP.3.traj b/src/main/deploy/choreo/Red OP.3.traj index d6fade9..33c3c03 100644 --- a/src/main/deploy/choreo/Red OP.3.traj +++ b/src/main/deploy/choreo/Red OP.3.traj @@ -4,484 +4,484 @@ "x": 12.83481788635254, "y": 7.172932147979736, "heading": -0.44530098242829574, - "angularVelocity": -3.9933853319259413e-22, - "velocityX": 8.259574098341232e-22, - "velocityY": -8.025414561021505e-21, + "angularVelocity": -4.3322696611731714e-20, + "velocityX": -8.054779748279346e-20, + "velocityY": -2.673843206569549e-19, "moduleForcesX": [ - 115.3927162988571, - 115.2157166646866, - 113.32030793770694, - 112.5314849425636 + 115.38688887330075, + 115.24383423254851, + 112.99392182289489, + 112.09250755639513 ], "moduleForcesY": [ - -0.2866941492311068, - -6.549472740050449, - -21.74513414149322, - -25.561679568405665 + 1.1556352772333405, + -6.047136158151505, + -23.37602173859373, + -27.42405623065844 ], "timestamp": 0 }, { - "x": 12.807227728725032, - "y": 7.174709038499013, - "heading": -0.4281784561783119, - "angularVelocity": 0.2913880585511266, - "velocityX": -0.46952431836436137, - "velocityY": 0.030238801863144257, + "x": 12.806218245833676, + "y": 7.174820039076195, + "heading": -0.4245523778880747, + "angularVelocity": 0.3458966849026219, + "velocityX": -0.47678005649515354, + "velocityY": 0.03147273207971745, "moduleForcesX": [ - -111.63376359219195, - -113.03432284252689, - -115.30641606592077, - -113.87965459197578 + -110.78430493237788, + -112.32377906856804, + -115.23706895839638, + -113.12589486821221 ], "moduleForcesY": [ - 29.185604964347988, - 23.049027164974667, - -4.482758375470643, - -18.522278194463308 + 32.27146527448446, + 26.289960305975733, + -6.074152668020973, + -22.68521400402437 ], - "timestamp": 0.058761935321311576 + "timestamp": 0.05998497657201396 }, { - "x": 12.75201337328418, - "y": 7.178230603874502, - "heading": -0.39459826783402535, - "angularVelocity": 0.5714615790080666, - "velocityX": -0.9396279264618801, - "velocityY": 0.05992936339201547, + "x": 12.748952905107773, + "y": 7.178545444277793, + "heading": -0.38415999659299915, + "angularVelocity": 0.6733749615886423, + "velocityX": -0.9546613835408188, + "velocityY": 0.062105637352804374, "moduleForcesX": [ - -111.97456605857009, - -113.08025540759344, - -115.2878683815402, - -114.07142344583939 + -111.34041034625368, + -112.46001862879739, + -115.21709287532448, + -113.49633756841047 ], "moduleForcesY": [ - 27.798664214369428, - 22.750200267155396, - -4.644259008500988, - -17.20495297529052 + 30.249349366921713, + 25.63630342009708, + -6.2116432185373744, + -20.667196776631027 ], - "timestamp": 0.11752387064262315 + "timestamp": 0.11996995314402792 }, { - "x": 12.669133432086447, - "y": 7.183456533131369, - "heading": -0.34543352510474484, - "angularVelocity": 0.8366767101942217, - "velocityX": -1.410435867105893, - "velocityY": 0.08893392003330741, + "x": 12.662940297741304, + "y": 7.184048443151815, + "heading": -0.32564500296154497, + "angularVelocity": 0.975494148292365, + "velocityX": -1.4339024916215266, + "velocityY": 0.09173961862624963, "moduleForcesX": [ - -112.39241209224183, - -113.13856392421164, - -115.26232496995146, - -114.30163807419474 + -112.01287501883925, + -112.65201576445827, + -115.19409328267592, + -113.94247486613864 ], "moduleForcesY": [ - 25.984522474314748, - 22.361639151859034, - -4.855118557125519, - -15.454500356763997 + 27.582891138596644, + 24.690234496665074, + -6.303104707024134, + -17.90910605865672 ], - "timestamp": 0.17628580596393473 + "timestamp": 0.17995492971604188 }, { - "x": 12.55853332818378, - "y": 7.1903382613240066, - "heading": -0.28201202301705236, - "angularVelocity": 1.0792956654831465, - "velocityX": -1.8821725883925233, - "velocityY": 0.11711200720343988, + "x": 12.548073202688675, + "y": 7.191263389762513, + "heading": -0.2514092768535465, + "angularVelocity": 1.237571978024797, + "velocityX": -1.9149310646929252, + "velocityY": 0.12027922695005987, "moduleForcesX": [ - -112.89842492883132, - -113.27691583678147, - -115.23714227829124, - -114.5802390264178 + -112.81041180905635, + -113.02354769728048, + -115.18961505698347, + -114.47046500698896 ], "moduleForcesY": [ - 23.57272456251679, - 21.510094456969895, - -4.864096919796805, - -12.981065814635949 + 23.98927394171314, + 22.793596210138528, + -5.8660066614304105, + -13.892228757886931 ], - "timestamp": 0.2350477412852463 + "timestamp": 0.23993990628805584 }, { - "x": 12.420138411669608, - "y": 7.1988188813829685, - "heading": -0.20656770962185922, - "angularVelocity": 1.2838976964026465, - "velocityX": -2.3551796883037355, - "velocityY": 0.14432166014599362, + "x": 12.404212619219079, + "y": 7.200124822376674, + "heading": -0.1656029487785582, + "angularVelocity": 1.4304636423751034, + "velocityX": -2.398276896830811, + "velocityY": 0.14772753313528253, "moduleForcesX": [ - -113.50883091034551, - -113.59238050873091, - -115.2246253766407, - -114.89486558850359 + -113.74212753677462, + -113.71654311369026, + -115.22737898976276, + -115.00224148188839 ], "moduleForcesY": [ - 20.21586561081966, - 19.545611913909976, - -4.167774994305711, - -9.292159419632245 + 18.81992692642623, + 18.78236752442216, + -3.863631013963434, + -7.747401038811083 ], - "timestamp": 0.2938096766065579 + "timestamp": 0.2999248828600698 }, { - "x": 12.25385215279822, - "y": 7.20882879407445, - "heading": -0.12324014213695786, - "angularVelocity": 1.418053490397559, - "velocityX": -2.8298295139894725, - "velocityY": 0.17034688590065417, + "x": 12.231222631446618, + "y": 7.210562916135438, + "heading": -0.07622689905581251, + "angularVelocity": 1.4899739039732183, + "velocityX": -2.8838885610762883, + "velocityY": 0.17401180020855656, "moduleForcesX": [ - -114.24355796594509, - -114.20109143791724, - -115.21632171398484, - -115.14763181288494 + -114.76126852409654, + -114.7421155109847, + -115.16877303317679, + -115.16168855405087 ], "moduleForcesY": [ - 15.001571052472121, - 15.09888258206903, - -1.5352801286814335, - -3.4085278625122855 + 10.008825147658298, + 10.070314335440338, + 2.5624628546635875, + 2.2474118634241425 ], - "timestamp": 0.35257161192786945 + "timestamp": 0.35990985943208376 }, { - "x": 12.059627085386966, - "y": 7.22024637414857, - "heading": -0.04129541884931243, - "angularVelocity": 1.3945204976583903, - "velocityX": -3.3052871105968005, - "velocityY": 0.19430231512438093, + "x": 12.029500394811427, + "y": 7.222385830186037, + "heading": -0.0039485688178259514, + "angularVelocity": 1.204940542924344, + "velocityX": -3.3628793101722345, + "velocityY": 0.19709791894983314, "moduleForcesX": [ - -114.97100473665364, - -114.97889469256124, - -114.8139912747789, - -114.82552416001533 + -114.04384036644842, + -114.49070976762575, + -111.91885906316082, + -113.1109806049009 ], "moduleForcesY": [ - 4.2427491405482245, - 4.253087696650936, - 7.355545167868264, - 7.30454562824674 + -14.076136858623709, + -11.072443207696098, + 26.086845583351657, + 20.922368283412005 ], - "timestamp": 0.41133354724918103 + "timestamp": 0.4198948360040977 }, { - "x": 11.839765743551363, - "y": 7.23241969553516, - "heading": -0.0006749768142111347, - "angularVelocity": 0.6912713445019788, - "velocityX": -3.7415605975772905, - "velocityY": 0.20716338425592043, + "x": 11.80460462204042, + "y": 7.235252445190618, + "heading": -0.0008006446065590651, + "angularVelocity": 0.05247854364813661, + "velocityX": -3.7492016438651103, + "velocityY": 0.2144972914865366, "moduleForcesX": [ - -102.78978326842798, - -110.70709433093434, - -99.03740787130111, - -109.17877166162 + -81.54498134539398, + -107.40451669387666, + -72.77164512682661, + -104.09396678970617 ], "moduleForcesY": [ - -49.60370655750785, - -29.865882900776136, - 56.82286597574406, - 35.07856026223796 + -79.06583770683336, + -39.74553876688151, + 87.47036330162258, + 47.81677142513769 ], - "timestamp": 0.4700954825704926 + "timestamp": 0.4798798125761117 }, { - "x": 11.606961624069507, - "y": 7.246562519511796, - "heading": -0.0005355014534405035, - "angularVelocity": 0.0023735664934787628, - "velocityX": -3.9618184494584505, - "velocityY": 0.24068002354419354, + "x": 11.578837837946322, + "y": 7.24893697247758, + "heading": -0.0006403041671407614, + "angularVelocity": 0.00267300995318069, + "velocityX": -3.763722135042569, + "velocityY": 0.22813257700507097, "moduleForcesX": [ - -38.90533896850442, - -71.13047771062192, - -35.06934232415729, - -67.80168692280769 + -1.905073107730994, + -4.979358092034403, + -1.8985551229214885, + -4.966710791426678 ], "moduleForcesY": [ - -29.244976944441376, - -20.88166507672035, - 46.999796252022335, - 35.52488241556469 + 1.1660681917013023, + 1.1666845103684094, + 5.292556396001393, + 5.28617190164468 ], - "timestamp": 0.5288574178918042 + "timestamp": 0.5398647891481256 }, { - "x": 11.374166105742725, - "y": 7.260879607361727, - "heading": -0.0004016151661947471, - "angularVelocity": 0.0022784526498942454, - "velocityX": -3.961672076555177, - "velocityY": 0.24364561465930565, + "x": 11.353074323427755, + "y": 7.262676760108333, + "heading": -0.00048021470173828523, + "angularVelocity": 0.002668826005296234, + "velocityX": -3.7636676284691517, + "velocityY": 0.22905381340371728, "moduleForcesX": [ - 0.038364732131467016, - 0.032375744635614497, - 0.038368146904853476, - 0.0323791503117189 + 0.013031053607783862, + 0.012772921444523999, + 0.013033680353923839, + 0.012775534950563829 ], "moduleForcesY": [ - 0.712634533787872, - 0.7126371600804828, - 0.7206706947523008, - 0.7206734674425367 + 0.2179094533492434, + 0.21791141098177333, + 0.21825566239591795, + 0.21825770061287675 ], - "timestamp": 0.5876193532131158 + "timestamp": 0.5998497657201396 }, { - "x": 11.141371561910887, - "y": 7.275212536833178, - "heading": -0.00026773225352809773, - "angularVelocity": 0.002278395221916618, - "velocityX": -3.9616554927763006, - "velocityY": 0.24391520451254395, + "x": 11.127311121333316, + "y": 7.276421682496976, + "heading": -0.0003201284847273866, + "angularVelocity": 0.002668771851877109, + "velocityX": -3.7636624200962037, + "velocityY": 0.22913941413551184, "moduleForcesX": [ - 0.004009381579098697, - 0.004005764410869393, - 0.004009387088650458, - 0.004005769695837714 + 0.001234624812908876, + 0.0012312846204447392, + 0.0012346644208775844, + 0.0012313220175801665 ], "moduleForcesY": [ - 0.06514567586811906, - 0.06514567997746004, - 0.0651505264669484, - 0.06515053178951452 + 0.02026193639435043, + 0.020261967907305133, + 0.02026641742373401, + 0.02026644973896179 ], - "timestamp": 0.6463812885344273 + "timestamp": 0.6598347422921536 }, { - "x": 10.908578322216146, - "y": 7.289566634568185, - "heading": -0.0001338526766265076, - "angularVelocity": 0.0022783384544694425, - "velocityX": -3.9616332992067487, - "velocityY": 0.2442754421977271, + "x": 10.901548911262122, + "y": 7.290182893091728, + "heading": -0.00016004688535705913, + "angularVelocity": 0.0026686948719258762, + "velocityX": -3.7636458822345045, + "velocityY": 0.2294109522278709, "moduleForcesX": [ - 0.005365004147551414, - 0.005361429921381281, - 0.0053650047309120935, - 0.005361430429434329 + 0.003917363554224196, + 0.003912617107756982, + 0.003917372465434683, + 0.003912626035956667 ], "moduleForcesY": [ - 0.08705133042548914, - 0.0870513309885176, - 0.08705612689598109, - 0.08705612743994169 + 0.06427780505229556, + 0.06427781349839326, + 0.06428417983115862, + 0.06428418449535106 ], - "timestamp": 0.7051432238557389 + "timestamp": 0.7198197188641675 }, { "x": 10.675800323486328, "y": 7.304165840148926, - "heading": 1.7042025537647997e-21, - "angularVelocity": 0.002277880670447602, - "velocityX": -3.9613739312189615, - "velocityY": 0.24844664323787644, + "heading": 4.902614731908987e-20, + "angularVelocity": 0.0026681161601341567, + "velocityX": -3.763418787115392, + "velocityY": 0.23310748551197824, "moduleForcesX": [ - 0.06269233899547927, - 0.06266351116723548, - 0.06269233826753248, - 0.06266351034664668 + 0.05377795064678017, + 0.053742159378856506, + 0.05377793434799179, + 0.05374214026788467 ], "moduleForcesY": [ - 1.007977935654259, - 1.0079779361307588, - 1.0080166121174583, - 1.008016612499835 + 0.8750534536430745, + 0.8750534628319293, + 0.875101282349867, + 0.8751012884750409 ], - "timestamp": 0.7639051591770505 + "timestamp": 0.7798046954361815 }, { - "x": 10.375996780740442, - "y": 7.329310693479934, - "heading": 2.0952126811330077e-9, - "angularVelocity": 2.764850905030086e-8, - "velocityX": -3.9562193564264954, - "velocityY": 0.33181247476771986, + "x": 10.387622426571776, + "y": 7.328344294067126, + "heading": 2.3254481669479827e-9, + "angularVelocity": 3.032787466640411e-8, + "velocityX": -3.7583392584954223, + "velocityY": 0.3153289462634989, "moduleForcesX": [ - 1.0229926855250218, - 0.9091406227519973, - 1.0226331700096871, - 0.9088211451962043 + 1.0067102595186133, + 0.8750670830655214, + 1.0063138780752319, + 0.8747253009280082 ], "moduleForcesY": [ - 15.547847834608662, - 15.548099923086475, - 15.695135166721935, - 15.695389362462524 + 15.141564196519592, + 15.141847578839105, + 15.312185150396871, + 15.312470356023791 ], - "timestamp": 0.8396854725863374 + "timestamp": 0.856481620294189 }, { - "x": 10.076214527720056, - "y": 7.354701655214317, - "heading": 2.094930318371914e-9, - "angularVelocity": -3.7260701149184505e-12, - "velocityX": -3.955938416370364, - "velocityY": 0.3350601309504519, + "x": 10.099463518452877, + "y": 7.3527474199811484, + "heading": 2.3248702362929507e-9, + "angularVelocity": -7.537217436692108e-12, + "velocityX": -3.75809161168789, + "velocityY": 0.3182590585004953, "moduleForcesX": [ - 0.05264500382423462, - 0.05264365410486792, - 0.05264500378601022, - 0.052643654069695955 + 0.04586372569533866, + 0.04586225728281445, + 0.04586372442294008, + 0.04586225608157109 ], "moduleForcesY": [ - 0.6085655004355156, - 0.6085655004799007, - 0.6085673123929624, - 0.60856731249484 + 0.5426416315110343, + 0.5426416339386481, + 0.5426435918286837, + 0.5426435952885554 ], - "timestamp": 0.9154657859956243 + "timestamp": 0.9331585451521964 }, { - "x": 9.797406327584714, - "y": 7.378325085957681, - "heading": 1.5073724891563739e-9, - "angularVelocity": -7.753436252528545e-9, - "velocityX": -3.679163988534978, - "velocityY": 0.31173572238710123, + "x": 9.814017805583175, + "y": 7.376928795577381, + "heading": 1.9467555589251595e-9, + "angularVelocity": -4.931270758027853e-9, + "velocityX": -3.722706843007822, + "velocityY": 0.31536705000900056, "moduleForcesX": [ - 51.863747239900356, - 51.86374695379424, - 51.863747256238625, - 51.86374697013233 + 6.5530881077342835, + 6.5530878919904225, + 6.553088110092179, + 6.553087894351924 ], "moduleForcesY": [ - -4.370675841289359, - -4.370675853259884, - -4.37067526479211, - -4.370675276765134 + -0.5355861518431727, + -0.5355861508230616, + -0.5355858164479997, + -0.535585816026562 ], - "timestamp": 0.9912460994049113 + "timestamp": 1.009835470010204 }, { - "x": 9.564977522412576, - "y": 7.398018834411508, - "heading": 1.0091532234135017e-9, - "angularVelocity": -6.574521050764288e-9, - "velocityX": -3.067139666166313, - "velocityY": 0.259879480142313, + "x": 9.576052798884584, + "y": 7.397087900656233, + "heading": 1.3998387250690954e-9, + "angularVelocity": -7.13274345402949e-9, + "velocityX": -3.1034761388678853, + "velocityY": 0.26290967088448547, "moduleForcesX": [ - 114.6849979131527, - 114.68499791407868, - 114.68499790306541, - 114.68499790399139 + 114.67853113769715, + 114.67853113597926, + 114.6785311563086, + 114.67853115459069 ], "moduleForcesY": [ - -9.717151397060475, - -9.717151389543696, - -9.717151516501819, - -9.71715150898504 + -9.71485297726741, + -9.714852991136166, + -9.714852756840832, + -9.714852770709586 ], - "timestamp": 1.0670264128141982 + "timestamp": 1.0865123948682114 }, { - "x": 9.379002999894094, - "y": 7.413776516620944, - "heading": 6.07279161464561e-10, - "angularVelocity": -5.303145947397083e-9, - "velocityX": -2.454127122885302, - "velocityY": 0.2079389949778709, + "x": 9.38564843718617, + "y": 7.413217936567628, + "heading": 8.817223023849284e-10, + "angularVelocity": -6.7571361741962134e-9, + "velocityX": -2.483202893843367, + "velocityY": 0.2103636255792007, "moduleForcesX": [ - 114.8701770137192, - 114.8701770145637, - 114.87017700281322, - 114.87017700365773 + 114.871604676597, + 114.8716046768432, + 114.87160467341323, + 114.87160467365942 ], "moduleForcesY": [ - -9.732937365029667, - -9.73293735690283, - -9.732937493953377, - -9.73293748582654 + -9.73127340414734, + -9.731273401774862, + -9.731273441790679, + -9.7312734394182 ], - "timestamp": 1.1428067262234851 + "timestamp": 1.1631893197262189 }, { - "x": 9.23950774412561, - "y": 7.425596002759894, - "heading": 3.043248809966869e-10, - "angularVelocity": -3.997796615482812e-9, - "velocityX": -1.8407848884851736, - "velocityY": 0.15597040454443006, + "x": 9.242830540920899, + "y": 7.425316707330115, + "heading": 4.5664978487651237e-10, + "angularVelocity": -5.5436823828756494e-9, + "velocityX": -1.8625929056198445, + "velocityY": 0.15778894086965362, "moduleForcesX": [ - 114.93195662610684, - 114.93195662692112, - 114.9319566149, - 114.93195661571428 + 114.93396789150813, + 114.93396789225454, + 114.93396788121369, + 114.9339678819601 ], "moduleForcesY": [ - -9.73820390689876, - -9.73820389854772, - -9.738204039306959, - -9.73820403095592 + -9.736577243932624, + -9.736577236261477, + -9.736577365581361, + -9.736577357910216 ], - "timestamp": 1.218587039632772 + "timestamp": 1.2398662445842263 }, { - "x": 9.146504246330785, - "y": 7.433476227985266, - "heading": 1.0162592903545258e-10, - "angularVelocity": -2.6748233524248435e-9, - "velocityX": -1.2272778194056342, - "velocityY": 0.10398776239958622, + "x": 9.147611861943055, + "y": 7.433383128421549, + "heading": 1.5641822672976188e-10, + "angularVelocity": -3.915539892904257e-9, + "velocityX": -1.2418166111143913, + "velocityY": 0.10520011211157348, "moduleForcesX": [ - 114.96284439351281, - 114.96284439431135, - 114.9628443821499, - 114.96284438294843 + 114.9647670121377, + 114.96476701310675, + 114.96476699831942, + 114.96476699928847 ], "moduleForcesY": [ - -9.74083700482707, - -9.740836996359715, - -9.74083713904288, - -9.740837130575525 + -9.739196633819809, + -9.739196623522792, + -9.739196797065262, + -9.739196786768243 ], - "timestamp": 1.294367353042059 + "timestamp": 1.3165431694422338 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 7.916223464815508e-22, - "angularVelocity": -1.3410597616003847e-9, - "velocityX": -0.6136718659319499, - "velocityY": 0.051996690628184836, + "heading": 3.99836183035016e-20, + "angularVelocity": -2.039964787052138e-9, + "velocityX": -0.6209412027311271, + "velocityY": 0.052602853899473855, "moduleForcesX": [ - 114.98137397829139, - 114.98137397908025, - 114.98137396683289, - 114.98137396762175 + 114.98312242387729, + 114.98312242497133, + 114.98312240795504, + 114.98312240904907 ], "moduleForcesY": [ - -9.742416601179544, - -9.74241659264097, - -9.742416736502106, - -9.742416727963532 + -9.740757716301594, + -9.740757704436747, + -9.740757904372455, + -9.740757892507608 ], - "timestamp": 1.370147666451346 + "timestamp": 1.3932200943002413 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 8.037920803587129e-22, - "angularVelocity": 1.6446873974517507e-22, - "velocityX": -2.757905967086945e-22, - "velocityY": -1.294831886303353e-21, + "heading": 4.06614059613504e-20, + "angularVelocity": 8.844729643904558e-21, + "velocityX": -1.4964447302773342e-20, + "velocityY": -4.1999091669097654e-20, "moduleForcesX": [ - 114.99372507265782, - 114.99372507344016, - 114.99372506113471, - 114.99372506191705 + 114.99530721950912, + 114.99530722068296, + 114.99530720218843, + 114.99530720336229 ], "moduleForcesY": [ - -9.743469497838449, - -9.743469489251723, - -9.743469633909358, - -9.74346962532263 + -9.741794002809645, + -9.741793989902737, + -9.741794207376442, + -9.741794194469533 ], - "timestamp": 1.4459279798606328 + "timestamp": 1.4698970191582488 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red OP.4.traj b/src/main/deploy/choreo/Red OP.4.traj index 11dedc3..3ccf0c1 100644 --- a/src/main/deploy/choreo/Red OP.4.traj +++ b/src/main/deploy/choreo/Red OP.4.traj @@ -3,359 +3,380 @@ { "x": 9.1, "y": 7.437416553497315, - "heading": 8.037920803587129e-22, - "angularVelocity": 1.6446873974517507e-22, - "velocityX": -2.757905967086945e-22, - "velocityY": -1.294831886303353e-21, + "heading": 4.06614059613504e-20, + "angularVelocity": 8.844729643904558e-21, + "velocityX": -1.4964447302773342e-20, + "velocityY": -4.1999091669097654e-20, "moduleForcesX": [ - 114.99372507265782, - 114.99372507344016, - 114.99372506113471, - 114.99372506191705 + 114.99530721950912, + 114.99530722068296, + 114.99530720218843, + 114.99530720336229 ], "moduleForcesY": [ - -9.743469497838449, - -9.743469489251723, - -9.743469633909358, - -9.74346962532263 + -9.741794002809645, + -9.741793989902737, + -9.741794207376442, + -9.741794194469533 ], "timestamp": 0 }, { - "x": 9.164075734077805, - "y": 7.4270458645926025, - "heading": -0.011277793242374901, - "angularVelocity": -0.1261254526683904, - "velocityX": 0.7165924034905254, - "velocityY": -0.11598083104372046, + "x": 9.158729002384682, + "y": 7.427913275125405, + "heading": -0.011345627876544048, + "angularVelocity": -0.1325178974362472, + "velocityX": 0.6859597370222545, + "velocityY": -0.1109990987101228, "moduleForcesX": [ - 113.09738136430255, - 112.7673730946546, - 114.71860842032127, - 114.61964933108011 + 113.00915752320314, + 112.63135889504281, + 114.77561717238223, + 114.67559733618697 ], "moduleForcesY": [ - -23.006176875829937, - -24.55462377070611, - -12.640293814526908, - -13.473735738920114 + -23.425636698784487, + -25.159294856402457, + -12.091339079978018, + -12.964745355934468 ], - "timestamp": 0.08941726672748995 + "timestamp": 0.08561581564484388 }, { - "x": 9.29222001122731, - "y": 7.406304055209759, - "heading": -0.03377768545568418, - "angularVelocity": -0.2516280472079336, - "velocityX": 1.4331043862036081, - "velocityY": -0.23196648859841448, + "x": 9.276180573932086, + "y": 7.408905935250988, + "heading": -0.03395538753487, + "angularVelocity": -0.2640839135623844, + "velocityX": 1.371844333465473, + "velocityY": -0.22200734445215983, "moduleForcesX": [ - 113.0694204236125, - 112.7779690278557, - 114.69165035279205, - 114.61288648897437 + 112.98106218312499, + 112.64778912905899, + 114.74591804100635, + 114.66711046089802 ], "moduleForcesY": [ - -23.075208455820306, - -24.43716999398038, - -12.759685477746057, - -13.405832230605759 + -23.491323485598002, + -25.015409413102297, + -12.2368225134811, + -12.903529067142655 ], - "timestamp": 0.1788345334549799 + "timestamp": 0.17123163128968777 }, { - "x": 9.484420777015211, - "y": 7.375190745931852, - "heading": -0.06740746126447136, - "angularVelocity": -0.37609934903599723, - "velocityX": 2.1494815578925746, - "velocityY": -0.3479563893708387, + "x": 9.452343907652057, + "y": 7.38039364196082, + "heading": -0.06769375321072268, + "angularVelocity": -0.39406697724878365, + "velocityX": 2.0576027033456232, + "velocityY": -0.3330260078166348, "moduleForcesX": [ - 113.02648757078286, - 112.79182810566901, - 114.64860236410797, - 114.59937186585587 + 112.9386256400279, + 112.67062512533334, + 114.69841226670894, + 114.65047328808508 ], "moduleForcesY": [ - -23.171552214300505, - -24.2575926575561, - -12.939705956083847, - -13.311740761370503 + -23.578915171806088, + -24.794121720549402, + -12.457213413083553, + -12.82374562009901 ], - "timestamp": 0.26825180018246986 + "timestamp": 0.25684744693453165 }, { - "x": 9.740654140944983, - "y": 7.333706777922525, - "heading": -0.11195989555510154, - "angularVelocity": -0.4982531441763822, - "velocityX": 2.8655915496799285, - "velocityY": -0.4639368829708782, + "x": 9.687197586383895, + "y": 7.342376469148144, + "heading": -0.11226638905729562, + "angularVelocity": -0.5206121732399493, + "velocityX": 2.743110918969357, + "velocityY": -0.44404380810177685, "moduleForcesX": [ - 112.96263341798881, - 112.8024310121022, - 114.57186680035291, - 114.55963723401477 + 112.87896079459628, + 112.69640034788527, + 114.61328861565241, + 114.60352473160059 ], "moduleForcesY": [ - -23.25555865139767, - -23.974881093119578, - -13.211149123897183, - -13.233026976268087 + -23.631898261793967, + -24.43715365857457, + -12.797480453077931, + -12.786890952496725 ], - "timestamp": 0.3576690669099598 + "timestamp": 0.34246326257937554 }, { - "x": 10.060848676971931, - "y": 7.281860220949749, - "heading": -0.16679543077391148, - "angularVelocity": -0.6132544331278634, - "velocityX": 3.580902746700832, - "velocityY": -0.5798271281405271, + "x": 9.980677153153964, + "y": 7.294861028140363, + "heading": -0.16677637741321044, + "angularVelocity": -0.6366812947509158, + "velocityX": 3.4278662716652395, + "velocityY": -0.5549843875211934, "moduleForcesX": [ - 112.84129933826836, - 112.76864885600135, - 114.3772823040652, - 114.40191731519991 + 112.77901668126034, + 112.69725731706323, + 114.39506493358313, + 114.4213577102299 ], "moduleForcesY": [ - -23.163205809397628, - -23.425697611861274, - -13.69531288022575, - -13.333070778392425 + -23.40728121770182, + -23.70138914183569, + -13.446589360294247, + -13.046932352219967 ], - "timestamp": 0.44708633363744976 + "timestamp": 0.4280790782242194 }, { - "x": 10.41129384334292, - "y": 7.2250876773172195, - "heading": -0.1668212421294265, - "angularVelocity": -0.0002886618710195688, - "velocityX": 3.9192113469427756, - "velocityY": -0.6349170099948512, + "x": 10.299439397239984, + "y": 7.243222544857861, + "heading": -0.16680362160119563, + "angularVelocity": -0.00031821443012600435, + "velocityX": 3.723170090539417, + "velocityY": -0.6031418715522293, "moduleForcesX": [ - 48.09172614407473, - 65.77795724959624, - 41.06473783405297, - 59.97030443873925 + 42.223193429450774, + 62.56452184359159, + 34.743970358798585, + 56.38407855591621 ], "moduleForcesY": [ - 13.930551075122137, - 7.145486045502102, - -28.297723373409983, - -27.773214670319934 + 16.217064048220223, + 8.77165872965158, + -28.615859678623103, + -28.322366228837797 ], - "timestamp": 0.5365036003649397 + "timestamp": 0.5136948938690633 }, { - "x": 10.761739409451776, - "y": 7.168314324053237, - "heading": -0.16684631379631512, - "angularVelocity": -0.00028038954674184204, - "velocityX": 3.9192158174201577, - "velocityY": -0.6349260645262742, + "x": 10.618201967925774, + "y": 7.191583190738454, + "heading": -0.16683012378420822, + "angularVelocity": -0.0003095477490107596, + "velocityX": 3.723173905252498, + "velocityY": -0.60315204300127, "moduleForcesX": [ - 0.0005793240121072635, - 0.0009168544852833605, - 0.0005030425526133945, - 0.0008405728974754847 + 0.0004897050109594019, + 0.0008590684186937887, + 0.00040634585315998815, + 0.0007757061947028893 ], "moduleForcesY": [ - -0.0011830360653050716, - -0.0012398789775864547, - -0.0016359884022599947, - -0.001692832071165764 + -0.001408166713429625, + -0.0014702823341160227, + -0.0019037711048343804, + -0.001965905284357917 ], - "timestamp": 0.6259208670924297 + "timestamp": 0.5993107095139072 }, { - "x": 11.112184972267482, - "y": 7.111540950421515, - "heading": -0.16687138545298627, - "angularVelocity": -0.00028038943247455934, - "velocityX": 3.9192157805911356, - "velocityY": -0.6349262923093676, + "x": 10.936964535235408, + "y": 7.139943815739948, + "heading": -0.16685662595604722, + "angularVelocity": -0.0003095476185024568, + "velocityX": 3.7231738658186835, + "velocityY": -0.6031522868709133, "moduleForcesX": [ - -0.000005850554579745332, - -0.000005845897104160572, - -0.000005851605075096937, - -0.000005846946542409484 + -0.0000065426488173444, + -0.000006537391676682717, + -0.000006543595223207877, + -0.0000065382539258484816 ], "moduleForcesY": [ - -0.000036170301490425664, - -0.00003617108561777815, - -0.0000361765653900908, - -0.00003617734391211807 + -0.00004044379525409588, + -0.000040444633841499524, + -0.00004045179634633909, + -0.000040452153945866205 ], - "timestamp": 0.7153381338199196 + "timestamp": 0.6849265251587511 }, { - "x": 11.462630522276916, - "y": 7.054767497780465, - "heading": -0.16689645711343162, - "angularVelocity": -0.00028038947468350146, - "velocityX": 3.9192156373718943, - "velocityY": -0.6349271759119326, + "x": 11.255727102089605, + "y": 7.088304437930091, + "heading": -0.1668831281242396, + "angularVelocity": -0.0003095475759096733, + "velocityX": 3.7231738604991516, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - -0.000022743718365883173, - -0.000022745437083135405, - -0.000022743343544297057, - -0.000022745063428281636 + -8.829967596549955e-7, + -8.811818122884496e-7, + -8.83407730166138e-7, + -8.815927827995014e-7 ], "moduleForcesY": [ - -0.0001403246359939683, - -0.00014032435530360055, - -0.00014032231584433397, - -0.00014032204068779427 + -0.000005444926099204542, + -0.000005445232343639541, + -0.000005447361702145372, + -0.000005447667946580389 ], - "timestamp": 0.8047554005474096 + "timestamp": 0.770542340803595 }, { - "x": 11.813075052865031, - "y": 6.997991026251115, - "heading": -0.1669222646722176, - "angularVelocity": -0.0002886194102157951, - "velocityX": 3.919204236650811, - "velocityY": -0.6349609377166883, + "x": 11.574489654914423, + "y": 7.03666497355743, + "heading": -0.16690963029636716, + "angularVelocity": -0.0003095476218725492, + "velocityX": 3.723173696634823, + "velocityY": -0.6031533307686342, "moduleForcesX": [ - -0.0016805912310601232, - -0.0020163880861174925, - -0.0016046680941889473, - -0.0019404647758239804 + -0.000027178077701561358, + -0.000027179633990853534, + -0.000027177224588690765, + -0.00002717888034638878 ], "moduleForcesY": [ - -0.00561525265620871, - -0.00555867675995663, - -0.0051646268094223844, - -0.005108050168229615 + -0.00016769583752692974, + -0.00016769506176135174, + -0.00016769279541623932, + -0.00016769249521777092 ], - "timestamp": 0.8941726672749 + "timestamp": 0.8561581564484388 }, { - "x": 12.133260147509837, - "y": 6.946071670476197, - "heading": -0.2214120834435135, - "angularVelocity": -0.6093881055138954, - "velocityX": 3.5807971587926977, - "velocityY": -0.5806412751705889, + "x": 11.89325121567058, + "y": 6.985022268597528, + "heading": -0.16693687038180605, + "angularVelocity": -0.00031816651203696647, + "velocityX": 3.7231621091885887, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - -48.98536673051253, - -66.16678250893118, - -40.57967406296097, - -59.23545857774057 + -0.001779708571581063, + -0.002147028456388743, + -0.001696749596509706, + -0.002064065106765412 ], "moduleForcesY": [ - -14.49226605581401, - -6.32104906707722, - 27.138034597036604, - 28.180912866906336 + -0.006555181384699155, + -0.006493363428438249, + -0.006062320028938968, + -0.006000483846621922 ], - "timestamp": 0.9835899340023899 + "timestamp": 0.9417739720932827 }, { - "x": 12.389484680735665, - "y": 6.904520503456371, - "heading": -0.26566908147622087, - "angularVelocity": -0.494949126185951, - "velocityX": 2.8654927913050736, - "velocityY": -0.46468840460599237, + "x": 12.18672005263425, + "y": 6.937424176402156, + "heading": -0.2210923200647369, + "angularVelocity": -0.6325402529315551, + "velocityX": 3.427740946614994, + "velocityY": -0.5559497604136832, "moduleForcesX": [ - -112.7694787816175, - -112.84469963183767, - -114.33052227126576, - -114.44010878513953 + -43.253472476542086, + -63.00675890235155, + -34.1682886774338, + -55.5650943963929 ], "moduleForcesY": [ - 23.504795933148486, - 23.05021971834787, - 14.088814392674252, - 13.013238741851007 + -16.812254107810563, + -7.912658283060262, + 27.348618818937386, + 28.718045503658878 ], - "timestamp": 1.0730072007298799 + "timestamp": 1.0273897877381266 }, { - "x": 12.581677956353516, - "y": 6.873351406790412, - "heading": -0.2990847660317501, - "angularVelocity": -0.37370505472245713, - "velocityX": 2.1493977914085036, - "velocityY": -0.34858028887139747, + "x": 12.42156370881826, + "y": 6.899331547752736, + "heading": -0.2653717816908411, + "angularVelocity": -0.5171878734390234, + "velocityX": 2.7429938547592765, + "velocityY": -0.4449251386851015, "moduleForcesX": [ - -112.81581362288203, - -112.95645164652021, - -114.4800037317309, - -114.63477612228742 + -112.70336730639953, + -112.77868429037684, + -114.34574505410617, + -114.45941943627881 ], "moduleForcesY": [ - 23.952236268957105, - 23.23198064868569, - 13.993453486124862, - 12.578015209156012 + 23.762739676331556, + 23.303963933906203, + 13.868946571317782, + 12.722298748930942 ], - "timestamp": 1.1624244674573698 + "timestamp": 1.1130056033829705 }, { - "x": 12.70981674564107, - "y": 6.85256977540764, - "heading": -0.32145862582537077, - "angularVelocity": -0.25021856082682203, - "velocityX": 1.433043012576884, - "velocityY": -0.23241183882421468, + "x": 12.597718540040942, + "y": 6.8707567698528536, + "heading": -0.29890040217417135, + "angularVelocity": -0.39161713558176675, + "velocityX": 2.057503393454997, + "velocityY": -0.33375583336632164, "moduleForcesX": [ - -112.82068889216025, - -113.0039471018814, - -114.52336848119276, - -114.70406075329403 + -112.71749084303553, + -112.86515330511084, + -114.51664915991034, + -114.6811022921368 ], "moduleForcesY": [ - 24.148746420326255, - 23.24343434131617, - 14.012855946804562, - 12.388975239916268 + 24.3844752316013, + 23.638347947621615, + 13.64501010429044, + 12.086104233396249 ], - "timestamp": 1.2518417341848598 + "timestamp": 1.1986214190278144 + }, + { + "x": 12.715163878739139, + "y": 6.851704848123817, + "heading": -0.32138821070438484, + "angularVelocity": -0.26265951402599025, + "velocityX": 1.3717715332572546, + "velocityY": -0.22252806430143826, + "moduleForcesX": [ + -112.70949942311833, + -112.90541799785672, + -114.56628411956218, + -114.75934724991008 + ], + "moduleForcesY": [ + 24.64547404232941, + 23.69527448754719, + 13.628136423288359, + 11.823839632394252 + ], + "timestamp": 1.2842372346726583 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -0.12555956863634032, - "velocityX": 0.7165595452629516, - "velocityY": -0.11621279716307112, + "angularVelocity": -0.13195702773884246, + "velocityX": 0.6859207314037198, + "velocityY": -0.11127036897917744, "moduleForcesX": [ - -112.8221827849924, - -113.02767779062647, - -114.54498863487578, - -114.73896316536626 + -112.70422548752346, + -112.925655713762, + -114.59090344176342, + -114.79867455728487 ], "moduleForcesY": [ - 24.250854636389008, - 23.249516784409256, - 14.022523907560226, - 12.290549417164618 + 24.780696781270144, + 23.723484974899865, + 13.620484396497059, + 11.687912648139795 ], - "timestamp": 1.3412590009123497 + "timestamp": 1.3698530503175022 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -6.396298753724966e-21, - "velocityX": 2.2882522060511837e-20, - "velocityY": -2.4594541543729887e-20, + "angularVelocity": -1.0481075996790548e-19, + "velocityX": 5.399599322710278e-19, + "velocityY": -9.80243210157971e-19, "moduleForcesX": [ - -112.82700125465155, - -113.0347603386625, - -114.5621659937604, - -114.75821199877026 + -112.7054623515789, + -112.92977017260733, + -114.61013224495392, + -114.8204883495519 ], "moduleForcesY": [ - 24.293809761632847, - 23.288094379310174, - 13.993645143555229, - 12.246633407284664 + 24.84159448258286, + 23.778744232903236, + 13.5778974907208, + 11.622750779733966 ], - "timestamp": 1.4306762676398397 + "timestamp": 1.455468865962346 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red OP.5.traj b/src/main/deploy/choreo/Red OP.5.traj index 08ae63e..c427de6 100644 --- a/src/main/deploy/choreo/Red OP.5.traj +++ b/src/main/deploy/choreo/Red OP.5.traj @@ -4,631 +4,631 @@ "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -6.396298753724966e-21, - "velocityX": 2.2882522060511837e-20, - "velocityY": -2.4594541543729887e-20, + "angularVelocity": -1.0481075996790548e-19, + "velocityX": 5.399599322710278e-19, + "velocityY": -9.80243210157971e-19, "moduleForcesX": [ - -112.82700125465155, - -113.0347603386625, - -114.5621659937604, - -114.75821199877026 + -112.7054623515789, + -112.92977017260733, + -114.61013224495392, + -114.8204883495519 ], "moduleForcesY": [ - 24.293809761632847, - 23.288094379310174, - 13.993645143555229, - 12.246633407284664 + 24.84159448258286, + 23.778744232903236, + 13.5778974907208, + 11.622750779733966 ], "timestamp": 0 }, { - "x": 12.75399450349522, - "y": 6.841766146112416, - "heading": -0.305766058140526, - "angularVelocity": 0.5268296966780065, - "velocityX": -0.3893532656410479, - "velocityY": -0.008066879563426856, + "x": 12.753385587015702, + "y": 6.841782127477455, + "heading": -0.30142200681603537, + "angularVelocity": 0.5981564744362009, + "velocityX": -0.39229294961925354, + "velocityY": -0.00758064657775971, "moduleForcesX": [ - -109.7288300984058, - -109.4206374282859, - -112.53880632418142, - -101.12162507107456 + -108.8413082444939, + -107.42080956929516, + -112.04459817860715, + -98.01523216314021 ], "moduleForcesY": [ - 35.669533302226604, - 36.387074666689884, - -25.504590588279502, - -55.51926033598724 + 38.29718260293832, + 41.90465414683766, + -27.603083990034282, + -60.83697376383006 ], - "timestamp": 0.0510976531762255 + "timestamp": 0.052266946500491684 }, { - "x": 12.714061656462052, - "y": 6.840779251207409, - "heading": -0.2532975989930795, - "angularVelocity": 1.0268271806239895, - "velocityX": -0.7815006081678176, - "velocityY": -0.019313898851738565, + "x": 12.712181951373154, + "y": 6.840743713694041, + "heading": -0.24058628304443966, + "angularVelocity": 1.1639425649444288, + "velocityX": -0.7883306449165999, + "velocityY": -0.019867504281806173, "moduleForcesX": [ - -110.81993188505729, - -110.0950661211093, - -112.36550007471497, - -102.63533121639855 + -110.25146907706204, + -108.49838326382822, + -111.77509833383621, + -99.86657679489407 ], "moduleForcesY": [ - 32.07800706429278, - 34.2533713879541, - -26.203707120752757, - -52.6299968823863 + 33.98129300971091, + 38.992548405352025, + -28.619699977126256, + -57.706808413427645 ], - "timestamp": 0.102195306352451 + "timestamp": 0.10453389300098337 }, { - "x": 12.65392586500865, - "y": 6.839035138240057, - "heading": -0.1770515773993922, - "angularVelocity": 1.4921628852646045, - "velocityX": -1.1768797139470222, - "velocityY": -0.03413293681682431, + "x": 12.650044214892105, + "y": 6.8387849883626215, + "heading": -0.1525027567272929, + "angularVelocity": 1.6852625266011638, + "velocityX": -1.1888533890238768, + "velocityY": -0.037475411566368036, "moduleForcesX": [ - -112.01913727447982, - -110.82018043359403, - -112.13805673866041, - -104.53092279690576 + -111.79514898339704, + -109.70138251498295, + -111.44106852220095, + -102.32802663455409 ], "moduleForcesY": [ - 27.537215204389696, - 31.77880633104241, - -27.08883274674824, - -48.700214418067695 + 28.423757447065572, + 35.415890676664, + -29.81768363836112, + -53.15724933762533 ], - "timestamp": 0.1532929595286765 + "timestamp": 0.15680083950147505 }, { - "x": 12.573375826882684, - "y": 6.836347748309206, - "heading": -0.07973620783654102, - "angularVelocity": 1.9044978294253423, - "velocityX": -1.5763940830739311, - "velocityY": -0.05259321639650792, + "x": 12.56665849968872, + "y": 6.835624849307061, + "heading": -0.041001428555590726, + "angularVelocity": 2.1333048061388658, + "velocityX": -1.5953814176348047, + "velocityY": -0.060461520466354446, "moduleForcesX": [ - -113.23819484894514, - -111.82728548746545, - -112.00948759102613, - -107.03013912743917 + -113.33306294894338, + -111.36765197462111, + -111.29923323362245, + -105.79188446547711 ], "moduleForcesY": [ - 21.882075353027112, - 27.953507157746554, - -27.513403358833262, - -42.84285393246143 + 21.344964061000436, + 29.67677517374125, + -30.226858179680615, + -45.774893406209785 ], - "timestamp": 0.204390612704902 + "timestamp": 0.20906778600196674 }, { - "x": 12.472142423483454, - "y": 6.832556869927306, - "heading": 0.0343228381313417, - "angularVelocity": 2.2321777787820345, - "velocityX": -1.9811752029020766, - "velocityY": -0.07418889413231182, + "x": 12.461620097191034, + "y": 6.831026292095148, + "heading": 0.08742245485977619, + "angularVelocity": 2.4570764510637413, + "velocityX": -2.009652553487107, + "velocityY": -0.08798212866492651, "moduleForcesX": [ - -114.34728768901107, - -113.22575760455813, - -112.26817875434023, - -110.11846813519524 + -114.6447825791982, + -113.5383273084868, + -111.87702649396596, + -110.14647037122361 ], "moduleForcesY": [ - 14.79403533609548, - 21.457523434245793, - -26.272584682099957, - -33.98499618387014 + 12.088459054314818, + 19.59915376642277, + -27.79947446244152, + -33.7959899091021 ], - "timestamp": 0.2554882658811275 + "timestamp": 0.2613347325024584 }, { - "x": 12.34992963494983, - "y": 6.827548067939446, - "heading": 0.15826458263637594, - "angularVelocity": 2.4255858498546536, - "velocityX": -2.3917495410628016, - "velocityY": -0.09802411023818115, + "x": 12.334544332063512, + "y": 6.824790196070031, + "heading": 0.22169906935297032, + "angularVelocity": 2.5690541247120793, + "velocityX": -2.4312835096712537, + "velocityY": -0.11931242291082081, "moduleForcesX": [ - -115.11333345954517, - -114.74574741924968, - -113.34482631497849, - -113.1955980388714 + -115.17279654304959, + -115.14891953151032, + -113.8889949915641, + -113.99413512743355 ], "moduleForcesY": [ - 5.448077962340946, - 10.194849320269142, - -20.799257564932656, - -21.339190325625058 + -1.6355007974511553, + 1.0232280605865918, + -17.189766351140257, + -16.24596532339107 ], - "timestamp": 0.306585919057353 + "timestamp": 0.3136016790029501 }, { - "x": 12.206597161799994, - "y": 6.821199257095827, - "heading": 0.2805699285354723, - "angularVelocity": 2.393560922989729, - "velocityX": -2.805069592051702, - "velocityY": -0.12424857990490915, + "x": 12.185948955691865, + "y": 6.816459874974, + "heading": 0.33880653198690125, + "angularVelocity": 2.2405644575550046, + "velocityX": -2.8430085612566742, + "velocityY": -0.15938029010259208, "moduleForcesX": [ - -114.73378991745247, - -114.6841205049078, - -115.02985196430274, - -115.00391113761037 + -109.76726168084946, + -109.54277500123322, + -113.18437639744384, + -114.94525226928013 ], "moduleForcesY": [ - -9.331880356810258, - -10.050186347462049, - -4.453466685132893, - -5.315910986053548 + -33.87003877484263, + -35.13851211848978, + 20.071079184942906, + 5.393963684061636 ], - "timestamp": 0.3576835722335785 + "timestamp": 0.3658686255034418 }, { - "x": 12.043550195136016, - "y": 6.812872270792408, - "heading": 0.37568052330999124, - "angularVelocity": 1.8613495701358527, - "velocityX": -3.1908895326691793, - "velocityY": -0.16296220639921025, + "x": 12.018989253325442, + "y": 6.8051390333200885, + "heading": 0.41041046526758185, + "angularVelocity": 1.3699658785310278, + "velocityX": -3.194364958069012, + "velocityY": -0.21659657607496546, "moduleForcesX": [ - -102.79608932766197, - -104.86344163188949, - -106.89092371318497, - -114.33175651351912 + -78.10169132485171, + -96.13389774106385, + -94.13325434178383, + -113.46555797863145 ], "moduleForcesY": [ - -50.77985160422074, - -47.216095581596974, - 42.06566908876746, - 12.895732740628755 + -83.01049814576065, + -62.80652414189374, + 65.38310369002106, + 18.254472024247004 ], - "timestamp": 0.408781225409804 + "timestamp": 0.4181355720039335 }, { - "x": 11.86287182736092, - "y": 6.802007556416456, - "heading": 0.42796486587483507, - "angularVelocity": 1.0232239509028977, - "velocityX": -3.5359425833505957, - "velocityY": -0.21262648479142307, + "x": 11.833657880476915, + "y": 6.7914137455253085, + "heading": 0.4377864800344317, + "angularVelocity": 0.5237729884716399, + "velocityX": -3.5458618736562415, + "velocityY": -0.26259976359377907, "moduleForcesX": [ - -80.87009063485023, - -96.67728867515605, - -92.79877473998546, - -113.21907877847823 + -81.50657246245372, + -96.52600367181357, + -91.36526851275521, + -112.58926465292839 ], "moduleForcesY": [ - -79.97059189776519, - -61.82807121867147, - 67.16099978368727, - 19.43023807698715 + -77.03852162154085, + -60.91221738822319, + 67.84251293202183, + 20.114545224135288 ], - "timestamp": 0.4598788785860295 + "timestamp": 0.47040251850442516 }, { - "x": 11.664633065712652, - "y": 6.7891315300219, - "heading": 0.43821140426349137, - "angularVelocity": 0.20052855173833478, - "velocityX": -3.8796059960832747, - "velocityY": -0.25198860601576917, + "x": 11.636885911361938, + "y": 6.781657287742647, + "heading": 0.4381195657454411, + "angularVelocity": 0.0063727792287653654, + "velocityX": -3.764749660918859, + "velocityY": -0.18666592245960945, "moduleForcesX": [ - -82.8099099991411, - -97.03131746492355, - -89.98282568718102, - -112.19644097022719 + -39.57182354200839, + -70.977437875031, + -50.32863077942037, + -76.99706320058098 ], "moduleForcesY": [ - -74.87714839288478, - -59.775887106560354, - 69.37126688318338, - 21.526348508475152 + 6.664753543230538, + -15.9657457537299, + 58.329975351840964, + 33.49165128421014 ], - "timestamp": 0.510976531762255 + "timestamp": 0.5226694650049168 }, { - "x": 11.462084020525632, - "y": 6.780072353267369, - "heading": 0.4385154377916661, - "angularVelocity": 0.00595004876498203, - "velocityX": -3.9639598415305968, - "velocityY": -0.1772914447418647, + "x": 11.44006845734196, + "y": 6.772736369563235, + "heading": 0.43843743025567056, + "angularVelocity": 0.006081558834253376, + "velocityX": -3.7656199031658693, + "velocityY": -0.1706799187000424, "moduleForcesX": [ - -13.088021988665616, - -26.977283498936934, - -20.501105728823166, - -33.202365222684826 + -0.22117703166854616, + -0.2400226961394301, + -0.23285423489332768, + -0.25167644227536323 ], "moduleForcesY": [ - 15.885560108854344, - 8.723342744728185, - 32.68451149483246, - 25.740872695475744 + 4.334916585446057, + 4.326391928789567, + 4.359954585223913, + 4.351428080985648 ], - "timestamp": 0.5620741849384805 + "timestamp": 0.5749364115054085 }, { - "x": 11.259528982095853, - "y": 6.771117377305431, - "heading": 0.43881605165352044, - "angularVelocity": 0.005883124628398257, - "velocityX": -3.964077131511387, - "velocityY": -0.17525219663325328, + "x": 11.243256268673136, + "y": 6.763700701720559, + "heading": 0.4387554337586175, + "angularVelocity": 0.006084218119455662, + "velocityX": -3.7655191635688174, + "velocityY": -0.17287537244203355, "moduleForcesX": [ - -0.029013194122842832, - -0.033411893880355564, - -0.03177958055818728, - -0.036176322713582246 + 0.027246197185640832, + 0.027387868108118486, + 0.027350411158643794, + 0.02749366051981494 ], "moduleForcesY": [ - 0.5648011109503727, - 0.5627467701499554, - 0.5706799263120281, - 0.5686255765235023 + -0.5963956352276373, + -0.5963054368452669, + -0.5966429834962519, + -0.59655178395572 ], - "timestamp": 0.613171838114706 + "timestamp": 0.6272033580059002 }, { - "x": 11.057156198653269, - "y": 6.758726217540709, - "heading": 0.4391223685729557, - "angularVelocity": 0.005994735577754182, - "velocityX": -3.960510333902073, - "velocityY": -0.24249958646803477, + "x": 11.046545630444271, + "y": 6.752686472005722, + "heading": 0.43907714703071105, + "angularVelocity": 0.006155195465465934, + "velocityX": -3.7635762446351886, + "velocityY": -0.2107303076283464, "moduleForcesX": [ - 0.9850808010020188, - 0.9926378040046129, - 0.9898104285367836, - 0.9973672418755148 + 0.5239825346725352, + 0.5287852184841983, + 0.5269382194510348, + 0.5317492184600278 ], "moduleForcesY": [ - -18.685150756065987, - -18.681766202326127, - -18.694748257197254, - -18.691363885723828 + -10.28276906511369, + -10.280662894429112, + -10.28864362114341, + -10.286542208886416 ], - "timestamp": 0.6642694912909315 + "timestamp": 0.6794703045063919 }, { - "x": 10.856270538125138, - "y": 6.731334695007788, - "heading": 0.439461064317222, - "angularVelocity": 0.006628401173301292, - "velocityX": -3.9314067876134358, - "velocityY": -0.5360622422022665, + "x": 10.851002317831199, + "y": 6.728677589687026, + "heading": 0.4394302072073043, + "angularVelocity": 0.006754941702782354, + "velocityX": -3.7412423281936964, + "velocityY": -0.4593511564422143, "moduleForcesX": [ - 8.032996251393905, - 8.10506598626941, - 8.070890615781677, - 8.142908653908856 + 6.0235300238737315, + 6.080411522594157, + 6.055226639619957, + 6.112078025502511 ], "moduleForcesY": [ - -81.57543466978522, - -81.55969024172876, - -81.60424655492223, - -81.58850238971223 + -67.53691218233139, + -67.52145044143396, + -67.57213537559059, + -67.55667901028482 ], - "timestamp": 0.715367144467157 + "timestamp": 0.7317372510068836 }, { "x": 10.659042358398438, "y": 6.684422969818115, "heading": 0.4398426718598864, - "angularVelocity": 0.007468200963130881, - "velocityX": -3.859828533543358, - "velocityY": -0.9180798387722997, + "angularVelocity": 0.007891500847063856, + "velocityX": -3.6726836420596647, + "velocityY": -0.8467037550871565, "moduleForcesX": [ - 19.797209295771516, - 19.935633669547133, - 19.84811263846736, - 19.986315671242973 + 18.502266587341634, + 18.68181883852657, + 18.57123057302974, + 18.75041412959953 ], "moduleForcesY": [ - -106.1764049578853, - -106.14800306857407, - -106.17974187192408, - -106.15132868263454 + -105.25254288064538, + -105.21692402603102, + -105.25961417671951, + -105.22397106219512 ], - "timestamp": 0.7664647976433825 + "timestamp": 0.7840041975073753 }, { - "x": 10.544019823742392, - "y": 6.649741816530494, - "heading": 0.43765692306832477, - "angularVelocity": -0.07178828851456667, - "velocityX": -3.7777767213885807, - "velocityY": -1.1390607410335976, + "x": 10.544035049630981, + "y": 6.649793265438035, + "heading": 0.4376694651514174, + "angularVelocity": -0.06782792164292281, + "velocityX": -3.5894913709978917, + "velocityY": -1.0808271785950743, "moduleForcesX": [ - 49.61097001099647, - 29.960020675030893, - 49.810683980327475, - 23.69035732916015 + 47.53506576758568, + 29.333765309885795, + 47.10755646583849, + 23.50756589105131 ], "moduleForcesY": [ - -99.62262552981636, - -107.24025708495017, - -97.95156957526038, - -107.4372074994834 + -100.61864430851121, + -107.4084137041551, + -99.4198469130243, + -107.60905700250359 ], - "timestamp": 0.7969119476839932 + "timestamp": 0.8160441989673899 }, { - "x": 10.43174307337387, - "y": 6.608629575449158, - "heading": 0.4335563624753091, - "angularVelocity": -0.13467797766116807, - "velocityX": -3.687594741010725, - "velocityY": -1.3502820798170498, + "x": 10.432043306335318, + "y": 6.608067008873336, + "heading": 0.43347817669732147, + "angularVelocity": -0.13081424042150525, + "velocityX": -3.4953726027566367, + "velocityY": -1.3023175612706317, "moduleForcesX": [ - 50.47238680977663, - 35.09011732252253, - 50.89792921334029, - 31.77886111111452 + 49.756367759871594, + 35.106461239154875, + 49.99578261370558, + 31.995927341800396 ], "moduleForcesY": [ - -95.93088215086546, - -102.59136541098549, - -93.68871350341784, - -101.83371240771545 + -95.75188215465406, + -102.069745623008, + -93.60026996740459, + -101.23810381235339 ], - "timestamp": 0.8273590977246039 + "timestamp": 0.8480842004274045 }, { - "x": 10.322457917154331, - "y": 6.561748076363306, - "heading": 0.42703446728967825, - "angularVelocity": -0.2142037982843, - "velocityX": -3.589339431564968, - "velocityY": -1.5397664156848374, + "x": 10.323383938634551, + "y": 6.560219585431149, + "heading": 0.42637679727464484, + "angularVelocity": -0.22164104553923633, + "velocityX": -3.39136587856971, + "velocityY": -1.4933652079236626, "moduleForcesX": [ - 54.54451585503099, - 37.80311413224697, - 56.068371436953264, - 34.884519018136295 + 55.05567925117758, + 37.86533543157213, + 56.65721776322309, + 34.80575744961734 ], "moduleForcesY": [ - -86.38037479041058, - -94.79851130258069, - -80.69537934854387, - -91.61886969958681 + -83.0438884795672, + -91.96968065788715, + -75.97006732019702, + -87.70722824777432 ], - "timestamp": 0.8578062477652146 + "timestamp": 0.8801242018874191 }, { - "x": 10.215423792334374, - "y": 6.510355295341807, - "heading": 0.41995401673996147, - "angularVelocity": -0.23254887699744417, - "velocityX": -3.515407014357416, - "velocityY": -1.6879340415424797, + "x": 10.216545636110244, + "y": 6.508277508435219, + "heading": 0.4196471967806787, + "angularVelocity": -0.21003745902962243, + "velocityX": -3.334528640943329, + "velocityY": -1.6211633779352665, "moduleForcesX": [ - 36.442468575381426, - 33.174927914274654, - 35.8528195340503, - 32.45465163128756 + 24.038621985218352, + 25.77272071949514, + 24.62367588838952, + 26.32651129956415 ], "moduleForcesY": [ - -69.21668807394214, - -70.77919539967725, - -67.39520207920303, - -69.02352334329365 + -56.390122550390586, + -55.61754417494375, + -57.656326035557406, + -56.89767113448526 ], - "timestamp": 0.8882533978058254 + "timestamp": 0.9121642033474338 }, { - "x": 10.109265668494423, - "y": 6.456274689185196, - "heading": 0.41438013914701705, - "angularVelocity": -0.18306730138977947, - "velocityX": -3.486635816434527, - "velocityY": -1.776212423313201, + "x": 10.110214948281255, + "y": 6.454517230975398, + "heading": 0.4141905501156165, + "angularVelocity": -0.17030731636737448, + "velocityX": -3.3186854863808724, + "velocityY": -1.677911205057923, "moduleForcesX": [ - 8.471205328468896, - 15.23866932736421, - 11.77361519881396, - 18.190714448046055 + 3.5123356730005804, + 8.059917813162626, + 6.035176967026881, + 10.479446367424668 ], "moduleForcesY": [ - -39.299918406604114, - -36.510563952245334, - -45.75459276690234, - -43.12295459661491 + -23.417268009154352, + -21.484740623999084, + -28.788257649111483, + -26.912755922055677 ], - "timestamp": 0.9187005478464361 + "timestamp": 0.9442042048074484 }, { - "x": 10.003524317388626, - "y": 6.400874064288048, - "heading": 0.4096367853957852, - "angularVelocity": -0.15578974534250664, - "velocityX": -3.4729474175663793, - "velocityY": -1.8195668502061122, + "x": 10.004109121840859, + "y": 6.3999345000371175, + "heading": 0.4093478527591147, + "angularVelocity": -0.15114535380235383, + "velocityX": -3.3116673409891164, + "velocityY": -1.7035807881104348, "moduleForcesX": [ - 3.9042382491596532, - 7.105966453517206, - 5.683970643639738, - 8.842262844225818 + 1.487894997911832, + 3.5515928558607346, + 2.674373241969133, + 4.727965710328632 ], "moduleForcesY": [ - -18.918192324174065, - -17.55122761626256, - -22.8772581877901, - -21.53331764786267 + -10.470814273459197, + -9.58171840845681, + -13.16887634219489, + -12.285842350063524 ], - "timestamp": 0.9491476978870468 + "timestamp": 0.976244206267463 }, { "x": 9.898398399353027, "y": 6.344369888305664, "heading": 0.40489200306154377, - "angularVelocity": -0.15583666543215785, - "velocityX": -3.45273425904824, - "velocityY": -1.8558116574791457, + "angularVelocity": -0.13907145738216475, + "velocityX": -3.299335757514504, + "velocityY": -1.7342262546637257, "moduleForcesX": [ - 9.431345346606545, - 9.425930347002394, - 9.428431462071497, - 9.423018174876928 + 4.444919794866705, + 5.756082971948941, + 5.177358266597356, + 6.483173214059894 ], "moduleForcesY": [ - -16.906432080263507, - -16.908789517761008, - -16.8995214585308, - -16.90187811085413 + -13.01289673438949, + -12.451995720736903, + -14.711065470774846, + -14.152581305403867 ], - "timestamp": 0.9795948479276575 + "timestamp": 1.0082842077274776 }, { - "x": 9.670246530984475, - "y": 6.195179516897854, - "heading": 0.4012737715516626, - "angularVelocity": -0.04837328675412599, - "velocityX": -3.050234823819816, - "velocityY": -1.9945734808167912, + "x": 9.670268652542475, + "y": 6.195147686170206, + "heading": 0.40147320180126633, + "angularVelocity": -0.04570696870230372, + "velocityX": -3.04993429091239, + "velocityY": -1.9949959074662753, "moduleForcesX": [ - 74.77834883929572, - 78.31714320835279, - 74.46722774433924, - 78.09040380789128 + 44.35336751964116, + 49.84791066719054, + 44.98425405334999, + 50.206578864953734 ], "moduleForcesY": [ - -24.40515766450398, - -20.14008207645028, - -32.569084988593396, - -28.259698256337934 + -48.756394596706954, + -45.107327355028076, + -53.79518756589766, + -50.36604891302273 ], - "timestamp": 1.0543929803818788 + "timestamp": 1.083082457476758 }, { - "x": 9.4801504252691, - "y": 6.070649750515126, - "heading": 0.39828552067975415, - "angularVelocity": -0.039950875427770885, - "velocityX": -2.5414552406334514, - "velocityY": -1.6648780162919794, + "x": 9.480173271877787, + "y": 6.070616528520398, + "heading": 0.39849121405650767, + "angularVelocity": -0.039867079173030166, + "velocityX": -2.541441561826215, + "velocityY": -1.6648940057719865, "moduleForcesX": [ - 96.32186712116838, - 96.38792598998765, - 96.79419017964749, - 96.85697827552185 + 96.3494121391391, + 96.39508860152752, + 96.67696001450231, + 96.72106180217908 ], "moduleForcesY": [ - 63.00396831226178, - 62.90663890135131, - 62.274968928445375, - 62.18110701001115 + 62.9543807201797, + 62.88707197355149, + 62.44956252680797, + 62.383918224986004 ], - "timestamp": 1.1291911128361 + "timestamp": 1.1578807072260382 }, { - "x": 9.32808449174239, - "y": 5.970953271268857, - "heading": 0.39590322000722883, - "angularVelocity": -0.03184973467062609, - "velocityX": -2.0330177844985764, - "velocityY": -1.3328739097501774, + "x": 9.328101551518529, + "y": 5.970928319469064, + "heading": 0.3960566471955998, + "angularVelocity": -0.03254844690976579, + "velocityX": -2.0330919622982955, + "velocityY": -1.3327612529101711, "moduleForcesX": [ - 96.26487658800978, - 96.32997314585457, - 96.7221348425724, - 96.78416991240434 + 96.27315885630196, + 96.33189190207462, + 96.686273793815, + 96.74250734840614 ], "moduleForcesY": [ - 63.427687906728025, - 63.33059042831499, - 62.72773938264778, - 62.633819804313426 + 63.41348692578717, + 63.325874029911354, + 62.78139687764546, + 62.69637660722109 ], - "timestamp": 1.2039892452903214 + "timestamp": 1.2326789569753185 }, { - "x": 9.214040059471193, - "y": 5.8961477456875455, - "heading": 0.39412002885262637, - "angularVelocity": -0.023840049157562253, - "velocityX": -1.524696252824158, - "velocityY": -1.0000988410652472, + "x": 9.214049861102318, + "y": 5.896133355137771, + "heading": 0.3942081084317932, + "angularVelocity": -0.02471366335446106, + "velocityX": -1.5247908981630351, + "velocityY": -0.9999560762718345, "moduleForcesX": [ - 96.24488535024153, - 96.31011450913444, - 96.69795042437514, - 96.7601725947593 + 96.2464886620466, + 96.31025854518813, + 96.6896674358515, + 96.75056013471918 ], "moduleForcesY": [ - 63.57019718383229, - 63.47252205472779, - 62.87858000727268, - 62.78399745101661 + 63.56717322481581, + 63.47168328918838, + 62.89071925102452, + 62.798188225264994 ], - "timestamp": 1.2787873777445427 + "timestamp": 1.3074772067245988 }, { - "x": 9.138012769594361, - "y": 5.846262014344345, - "heading": 0.3929327805602388, - "angularVelocity": -0.01587269967086738, - "velocityX": -1.0164329961495118, - "velocityY": -0.6669381935937063, + "x": 9.138016376281193, + "y": 5.84625670461297, + "heading": 0.3929651715340159, + "angularVelocity": -0.016617192273128887, + "velocityX": -1.0165142242764738, + "velocityY": -0.6668157435766093, "moduleForcesX": [ - 96.23467746677126, - 96.30009844719443, - 96.68582788542034, - 96.74826576061236 + 96.23291594154362, + 96.29939278470015, + 96.69137390831771, + 96.75477051723124 ], "moduleForcesY": [ - 63.64170695487282, - 63.54355942757056, - 62.95396491375018, - 62.85886919168339 + 63.64410996343634, + 63.54438360092073, + 62.94517892257058, + 62.84860449412174 ], - "timestamp": 1.353585510198764 + "timestamp": 1.382275456473879 }, { "x": 9.1, - "y": 5.821313381195068, + "y": 5.821313381195065, "heading": 0.39233969745911407, - "angularVelocity": -0.007929116431986712, - "velocityX": -0.50820479532195, - "velocityY": -0.33354620403852975, + "angularVelocity": -0.008362148539550444, + "velocityX": -0.5082522172460242, + "velocityY": -0.33347469361261933, "moduleForcesX": [ - 96.2285045107745, - 96.29401110747635, - 96.67859802056262, - 96.74113494181448 + 96.22472066349764, + 96.292810190967, + 96.69245071862318, + 96.75733376592395 ], "moduleForcesY": [ - 63.68466012516553, - 63.586276007748886, - 62.99909879542885, - 62.90374389419577 + 63.690259240991296, + 63.58800475764593, + 62.977708646167464, + 62.878726323912026 ], - "timestamp": 1.4283836426529852 + "timestamp": 1.4570737062231593 }, { "x": 9.1, "y": 5.821313381195068, "heading": 0.39233969745911407, - "angularVelocity": 9.242967284264404e-21, - "velocityX": -5.393065463580557e-21, - "velocityY": -4.6660816363364264e-20, + "angularVelocity": 1.4293258494945315e-19, + "velocityX": -9.48788595009282e-19, + "velocityY": 6.222095483602862e-19, "moduleForcesX": [ - 96.22440473642781, - 96.28984267330931, - 96.67387504230591, - 96.73635227532323 + 96.219277135115, + 96.28830838426227, + 96.69327817490581, + 96.75901741442976 ], "moduleForcesY": [ - 63.713260147549505, - 63.61490939882356, - 63.02902588165876, - 62.93369197756521 + 63.720955818602604, + 63.617216172933794, + 62.99919868599543, + 62.89881547606205 ], - "timestamp": 1.5031817751072065 + "timestamp": 1.5318719559724396 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red OP.6.traj b/src/main/deploy/choreo/Red OP.6.traj index 2de0f02..8c26d97 100644 --- a/src/main/deploy/choreo/Red OP.6.traj +++ b/src/main/deploy/choreo/Red OP.6.traj @@ -4,505 +4,505 @@ "x": 9.1, "y": 5.821313381195068, "heading": 0.39233969745911407, - "angularVelocity": 9.242967284264404e-21, - "velocityX": -5.393065463580557e-21, - "velocityY": -4.6660816363364264e-20, + "angularVelocity": 1.4293258494945315e-19, + "velocityX": -9.48788595009282e-19, + "velocityY": 6.222095483602862e-19, "moduleForcesX": [ - 96.22440473642781, - 96.28984267330931, - 96.67387504230591, - 96.73635227532323 + 96.219277135115, + 96.28830838426227, + 96.69327817490581, + 96.75901741442976 ], "moduleForcesY": [ - 63.713260147549505, - 63.61490939882356, - 63.02902588165876, - 62.93369197756521 + 63.720955818602604, + 63.617216172933794, + 62.99919868599543, + 62.89881547606205 ], "timestamp": 0 }, { - "x": 9.124426408265597, - "y": 5.838158154369932, - "heading": 0.37440374574477503, - "angularVelocity": -0.2948190027369444, - "velocityX": 0.4015047230279816, - "velocityY": 0.2768829503913697, + "x": 9.12606508426789, + "y": 5.8377585148435465, + "heading": 0.37148092735484195, + "angularVelocity": -0.3358803058762973, + "velocityX": 0.41971546897661194, + "velocityY": 0.2648093100607021, "moduleForcesX": [ - 104.6690647215055, - 103.79621548715683, - 86.74486016660066, - 79.6558343319196 + 107.06597038486554, + 106.89549145493712, + 88.60061528259641, + 81.32645261923491 ], "moduleForcesY": [ - 48.576006219936566, - 50.364330112069474, - 76.10242127485564, - 83.46976074034517 + 43.037242158674665, + 43.394757591016905, + 73.93350925841953, + 81.83966143502103 ], - "timestamp": 0.060837162963822244 + "timestamp": 0.06210179560796991 }, { - "x": 9.173316821931977, - "y": 5.871875693217713, - "heading": 0.33976042091244324, - "angularVelocity": -0.5694434642347314, - "velocityX": 0.8036274422502436, - "velocityY": 0.5542260224697108, + "x": 9.178251711242993, + "y": 5.870675766257217, + "heading": 0.33123239786143516, + "angularVelocity": -0.6481057286569294, + "velocityX": 0.8403400652783892, + "velocityY": 0.5300531343967613, "moduleForcesX": [ - 104.36224405802564, - 102.97011057048299, - 87.53838797956297, - 80.57222592370948 + 106.81766172551309, + 106.04093622896602, + 89.53141023846203, + 82.33004570732504 ], "moduleForcesY": [ - 49.20246899931035, - 52.0005698939217, - 75.17096632236314, - 82.56810699384471 + 43.6115687458894, + 45.3991721549242, + 72.78287839067802, + 80.80897526070483 ], - "timestamp": 0.12167432592764449 + "timestamp": 0.12420359121593982 }, { - "x": 9.24671717457305, - "y": 5.9225047085781934, - "heading": 0.2901169140945015, - "angularVelocity": -0.8160062764179685, - "velocityX": 1.2065051863894711, - "velocityY": 0.8322053970627751, + "x": 9.256631385149708, + "y": 5.920106690428395, + "heading": 0.27372901582427783, + "angularVelocity": -0.9259536133247956, + "velocityX": 1.2621160650732033, + "velocityY": 0.7959661019017846, "moduleForcesX": [ - 103.86961088775287, - 101.81794700730569, - 88.59644120728534, - 81.86390049299227 + 106.36127377314644, + 104.78762461695499, + 90.79435455500894, + 83.829920572498 ], "moduleForcesY": [ - 50.19424330306308, - 54.18124068785469, - 73.89664129178026, - 81.26407249712199 + 44.65822687033308, + 48.164003127686335, + 71.17035492491335, + 79.22203469459357 ], - "timestamp": 0.18251148889146673 + "timestamp": 0.18630538682390974 }, { - "x": 9.344679660258, - "y": 5.990100130181784, - "heading": 0.2278705872436387, - "angularVelocity": -1.0231628797003336, - "velocityX": 1.6102408612184482, - "velocityY": 1.1110876692883864, + "x": 9.36128953490754, + "y": 5.986116860930104, + "heading": 0.20215350943413754, + "angularVelocity": -1.152551318193366, + "velocityX": 1.6852676920729739, + "velocityY": 1.0629349740289324, "moduleForcesX": [ - 102.97098993160485, - 100.2816827855571, - 89.91507313466994, - 83.78116306119976 + 105.38356550288955, + 103.01244546536586, + 92.40747603148937, + 86.2278900967571 ], "moduleForcesY": [ - 51.956544160187924, - 56.921561602046935, - 72.24946473264366, - 79.2516201108616 + 46.83633622576909, + 51.77437024681331, + 69.01195080914106, + 76.55773487195233 ], - "timestamp": 0.24334865185528898 + "timestamp": 0.24840718243187965 }, { - "x": 9.467258608861432, - "y": 6.074736051006052, - "heading": 0.15653642733851053, - "angularVelocity": -1.1725425123381934, - "velocityX": 2.014869573657247, - "velocityY": 1.3911878315988937, + "x": 9.492321085260913, + "y": 6.0687979662658655, + "heading": 0.121648680830616, + "angularVelocity": -1.296336568297074, + "velocityX": 2.10994785369074, + "velocityY": 1.3313802689008425, "moduleForcesX": [ - 101.19960247774684, - 98.2967857325556, - 91.51945696061505, - 86.7668507310473 + 103.06905054921917, + 100.53419705098851, + 94.48545431834287, + 90.34073398334215 ], "moduleForcesY": [ - 55.2444277985547, - 60.21289489893423, - 70.14362208312178, - 75.91533220936323 + 51.59846953149261, + 56.324216066065965, + 66.03839637354766, + 71.56970538755411 ], - "timestamp": 0.3041858148191112 + "timestamp": 0.31050897803984956 }, { - "x": 9.614495005457098, - "y": 6.176489945212865, - "heading": 0.08185672674254803, - "angularVelocity": -1.2275342398916924, - "velocityX": 2.4201719709254568, - "velocityY": 1.6725614616073192, + "x": 9.649780293998948, + "y": 6.1681885527545415, + "heading": 0.042497044738964006, + "angularVelocity": -1.27454665870393, + "velocityX": 2.535501706456818, + "velocityY": 1.6004462594946747, "moduleForcesX": [ - 97.31237310212737, - 95.75953255949932, - 93.57306626338041, - 91.76671164693622 + 96.2916687370116, + 96.91797721607092, + 97.71513392557925, + 98.30376883932867 ], "moduleForcesY": [ - 61.70410058784353, - 64.06733787812753, - 67.2529692333703, - 69.68084586415326 + 63.117273034962174, + 62.16157487034735, + 60.8818194493432, + 59.937833099468726 ], - "timestamp": 0.36502297778293347 + "timestamp": 0.37261077364781947 }, { - "x": 9.786303556479535, - "y": 6.295259954535899, - "heading": 0.01573807289290187, - "angularVelocity": -1.0868135631006441, - "velocityX": 2.8240723704457604, - "velocityY": 1.952260814556102, + "x": 9.832603238264776, + "y": 6.282083749845622, + "heading": 0.0010258848806129173, + "angularVelocity": -0.6677932490091972, + "velocityX": 2.9439236414343237, + "velocityY": 1.8340081148388663, "moduleForcesX": [ - 86.5321701180405, - 92.25427081535645, - 97.1144659926379, - 101.20179764226765 + 59.97477963943079, + 89.39704823104167, + 110.38024149575084, + 113.80694315967614 ], "moduleForcesY": [ - 75.85885179568086, - 68.8487316739205, - 61.64809216339909, - 54.78638460823519 + 97.79151184647147, + 72.20506885999235, + 28.839425985382572, + 14.78899376484699 ], - "timestamp": 0.4258601407467557 + "timestamp": 0.4347125692557894 }, { - "x": 9.98099357991982, - "y": 6.426527001243398, - "heading": 0.0010512168806646742, - "angularVelocity": -0.24141257245955028, - "velocityX": 3.2001824864196897, - "velocityY": 2.1576786344484677, + "x": 10.030346062720374, + "y": 6.407528929196308, + "heading": 0.0009143240312192765, + "angularVelocity": -0.001796419061662757, + "velocityX": 3.1841724143354813, + "velocityY": 2.0199927896220706, "moduleForcesX": [ - 38.81568526776312, - 84.74996163721521, - 112.94150068763072, - 114.64908329430031 + 27.910051624663126, + 63.73430047048076, + 47.02333960869323, + 81.07343060013112 ], "moduleForcesY": [ - 107.86535624618263, - 77.5428290412158, - 4.720404786879428, - 1.6603151606164208 + 78.23128798690065, + 63.59254149911866, + 17.492746703171225, + 10.792434877491871 ], - "timestamp": 0.48669730371057796 + "timestamp": 0.4968143648637593 }, { - "x": 10.18064296034454, - "y": 6.562363363203818, - "heading": 0.0009441064746914683, - "angularVelocity": -0.0017606081670327233, - "velocityX": 3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 10.228012029363544, + "y": 6.533099878628409, + "heading": 0.0008079294489062711, + "angularVelocity": -0.001713228760479697, + "velocityX": 3.182934804187995, + "velocityY": 2.022018014177882, "moduleForcesX": [ - 11.445573252588428, - 25.631275124727225, - 12.108894286774559, - 26.924267849023067 + -0.28545851563204555, + -0.2804480463731822, + -0.2855446348313677, + -0.28051646942635683 ], "moduleForcesY": [ - 27.856532036433503, - 26.8185016500409, - 7.889518984358191, - 7.559585000410401 + 0.4662962959748132, + 0.46648326649752214, + 0.45969100337572294, + 0.459880692548048 ], - "timestamp": 0.5475344666744002 + "timestamp": 0.5589161604717292 }, { - "x": 10.389186424222014, - "y": 6.684102379422477, - "heading": 0.0008315498846507851, - "angularVelocity": -0.001850128844890692, - "velocityX": 3.427895939222019, - "velocityY": 2.0010633351041336, + "x": 10.427113469333392, + "y": 6.656381795149376, + "heading": 0.0007006205611460927, + "angularVelocity": -0.0017279514498676949, + "velocityX": 3.206049648334116, + "velocityY": 1.9851586466067421, "moduleForcesX": [ - 34.125974092877684, - 34.119566969812965, - 34.12806959993071, - 34.12166225634625 + 5.285867690419364, + 5.284961607340059, + 5.285918211927382, + 5.285012064001373 ], "moduleForcesY": [ - -54.08961846611769, - -54.091189136841685, - -54.08302939294419, - -54.08460010575838 + -8.428820483504277, + -8.428859802450413, + -8.427665220567818, + -8.427704094896713 ], - "timestamp": 0.6083716296382224 + "timestamp": 0.6210179560796991 }, { - "x": 10.61051606687712, - "y": 6.780644990322361, - "heading": 0.000701833947664439, - "angularVelocity": -0.0021321825454530797, - "velocityX": 3.638066469120572, - "velocityY": 1.5869019230448598, + "x": 10.636846447566278, + "y": 6.76054779134001, + "heading": 0.0005836892297171069, + "angularVelocity": -0.0018828977533457954, + "velocityX": 3.3772449923487615, + "velocityY": 1.6773427430054264, "moduleForcesX": [ - 49.06229197687783, - 49.03163546387942, - 49.0815105306153, - 49.05084786401312 + 39.14902863114247, + 39.136505585616426, + 39.15454418789416, + 39.14202011232547 ], "moduleForcesY": [ - -96.67004058315037, - -96.68438290730597, - -96.65707564207322, - -96.67142765058261 + -70.38808653661697, + -70.39220856869599, + -70.37815024115632, + -70.38227306623787 ], - "timestamp": 0.6692087926020447 + "timestamp": 0.683119751687669 }, { - "x": 10.841956159147276, - "y": 6.849459835142262, - "heading": 0.0005411494775797474, - "angularVelocity": -0.002641222276920527, - "velocityX": 3.80425517882526, - "velocityY": 1.1311317206034728, + "x": 10.858199057460208, + "y": 6.836948493802416, + "heading": 0.0004443289376354839, + "angularVelocity": -0.002244062200091015, + "velocityX": 3.564351203164376, + "velocityY": 1.230249491410887, "moduleForcesX": [ - 38.80840694131433, - 38.74033390445177, - 38.8409572070115, - 38.77284195160276 + 42.79383002375116, + 42.750355155538415, + 42.817059002037766, + 42.773568530416895 ], "moduleForcesY": [ - -106.37757896352497, - -106.40184229774033, - -106.3636821482131, - -106.38798347831754 + -102.22993200522636, + -102.24725073962176, + -102.21741225918262, + -102.23474808291235 ], - "timestamp": 0.7300459555658669 + "timestamp": 0.7452215472956389 }, { - "x": 11.080086659996805, - "y": 6.889216371961374, - "heading": 0.0003245280393203164, - "angularVelocity": -0.003560676200306194, - "velocityX": 3.914227574864692, - "velocityY": 0.6534909729888787, + "x": 11.087670752139442, + "y": 6.883506999197637, + "heading": 0.0002634313814932412, + "angularVelocity": -0.0029129198982296074, + "velocityX": 3.6950895289376384, + "velocityY": 0.7497127086168028, "moduleForcesX": [ - 25.717865755187493, - 25.577114001753998, - 25.76100486674207, - 25.620041504490047 + 29.92547693151462, + 29.82914130574372, + 29.960153351309838, + 29.86372234770639 ], "moduleForcesY": [ - -111.47748761628131, - -111.50955109747035, - -111.46568684412034, - -111.49785520760967 + -109.87230666320606, + -109.89810991838907, + -109.86092743160701, + -109.88678831438042 ], - "timestamp": 0.7908831185296892 + "timestamp": 0.8073233429036089 }, { "x": 11.321250915527344, "y": 6.899192810058594, - "heading": -5.820220043024201e-20, - "angularVelocity": -0.0053343716818830345, - "velocityX": 3.9640943755702462, - "velocityY": 0.16398591931634138, + "heading": 1.7044959641647185e-19, + "angularVelocity": -0.004241928577334639, + "velocityX": 3.7612465324259428, + "velocityY": 0.2525822435148066, "moduleForcesX": [ - 11.766242291584698, - 11.472950024585101, - 11.806680580907997, - 11.512400965900941 + 15.214683881783662, + 15.002575278462187, + 15.252598453614608, + 15.0399798318798 ], "moduleForcesY": [ - -114.24520441209951, - -114.27486879290603, - -114.2388907542841, - -114.26875836780002 + -113.66335076467918, + -113.69134460089437, + -113.65627458813691, + -113.68440690030411 ], - "timestamp": 0.8517202814935114 + "timestamp": 0.8694251385115788 }, { - "x": 11.623075674299576, - "y": 6.864260942419369, - "heading": 0.0000023499430894192195, - "angularVelocity": 0.00003069941458455491, - "velocityX": 3.943007574588477, - "velocityY": -0.4563463224696058, + "x": 11.611818027854001, + "y": 6.870157772665709, + "heading": 0.000006706968945754724, + "angularVelocity": 0.00008661247380923753, + "velocityX": 3.7523263652724554, + "velocityY": -0.37495274483614, "moduleForcesX": [ - -4.2903004525975135, - -3.566125676157951, - -4.254477917247945, - -3.5363367506884154 + -1.930017347362055, + -1.3524659590983, + -1.9171433879503843, + -1.343441667490837 ], "moduleForcesY": [ - -115.06352371966176, - -115.08817444708899, - -115.06756634659666, - -115.091807306801 + -115.07098399891115, + -115.0791940311929, + -115.0737409512458, + -115.08184184287788 ], - "timestamp": 0.9282671186635447 + "timestamp": 0.946861662961008 }, { - "x": 11.915766240995925, - "y": 6.782789828791696, - "heading": 0.000020549966953337708, - "angularVelocity": 0.00023776323799624486, - "velocityX": 3.8236794297091086, - "velocityY": -1.06433024066954, + "x": 11.89360394252261, + "y": 6.793457496928237, + "heading": 0.000014010027713151718, + "angularVelocity": 0.00009431026016884775, + "velocityX": 3.6389277110781117, + "velocityY": -0.9904922293815296, "moduleForcesX": [ - -22.15296905683905, - -22.126953133722456, - -22.146146005278485, - -22.120137478708045 + -20.795476451655723, + -20.794515439942504, + -20.795240317066728, + -20.794279315526506 ], "moduleForcesY": [ - -112.783738070124, - -112.78882065085001, - -112.78524441350454, - -112.79032392449628 + -112.87660869109384, + -112.87678463656188, + -112.87666020166296, + -112.87683614320375 ], - "timestamp": 1.004813955833578 + "timestamp": 1.0242981874104373 }, { - "x": 12.175184864757565, - "y": 6.667702152711534, - "heading": 0.0029536724169984983, - "angularVelocity": 0.03831800971122835, - "velocityX": 3.389018192683671, - "velocityY": -1.5034935515953167, + "x": 12.158153629182106, + "y": 6.67179475203828, + "heading": 0.0004871969822431189, + "angularVelocity": 0.006110642980096399, + "velocityX": 3.4163424629454027, + "velocityY": -1.5711286857845936, "moduleForcesX": [ - -82.77126323116941, - -80.94192654719535, - -80.35273216958193, - -78.46991677908551 + -41.28977010687008, + -40.662563471279185, + -40.970425111678914, + -40.3466587799709 ], "moduleForcesY": [ - -79.32224282560553, - -81.16083698479886, - -81.80494379688955, - -83.58853211441256 + -106.29034131292164, + -106.52838528799589, + -106.42582853323141, + -106.66047133973117 ], - "timestamp": 1.0813607930036113 + "timestamp": 1.1017347118598666 }, { - "x": 12.387977367389736, - "y": 6.561745619437614, - "heading": 0.006312957325942295, - "angularVelocity": 0.043885352199226915, - "velocityX": 2.779899346585585, - "velocityY": -1.3842052420605957, + "x": 12.375778537307344, + "y": 6.562682372433733, + "heading": 0.003922386449226963, + "angularVelocity": 0.04436135907968387, + "velocityX": 2.810365130312186, + "velocityY": -1.4090557444349707, "moduleForcesX": [ - -112.95285116511828, - -112.9351029547452, - -113.05965579629233, - -113.04267855576265 + -110.75149967016266, + -110.51967200781796, + -111.70364987570524, + -111.51809488586058 ], "moduleForcesY": [ - 22.361919228925938, - 22.445395936831783, - 21.813838326495244, - 21.895492780162307 + 31.163125703536394, + 31.938835770863207, + 27.54075660649726, + 28.240069272526465 ], - "timestamp": 1.1579076301736446 + "timestamp": 1.1791712363092959 }, { - "x": 12.556502410271355, - "y": 6.473209425403713, - "heading": 0.009331441590312019, - "angularVelocity": 0.03943316766523955, - "velocityX": 2.2015938099085006, - "velocityY": -1.1566277237194698, + "x": 12.54876174639912, + "y": 6.472975043297138, + "heading": 0.007608118501472647, + "angularVelocity": 0.047596816598512205, + "velocityX": 2.233871035944323, + "velocityY": -1.1584627509358207, "moduleForcesX": [ - -107.33800844105599, - -107.38700511167124, - -107.17535879811419, - -107.22522115524384 + -105.67464605947448, + -105.63214461850302, + -105.80089159312246, + -105.75886325172866 ], "moduleForcesY": [ - 42.07330120256334, - 41.94949084700674, - 42.48667211202762, - 42.36206037528201 + 46.050955922132566, + 46.14736365416792, + 45.75956571011295, + 45.855608257532616 ], - "timestamp": 1.234454467343678 + "timestamp": 1.2566077607587252 }, { - "x": 12.682025347004867, - "y": 6.405071382147858, - "heading": 0.011744144953739091, - "angularVelocity": 0.031519308342782756, - "velocityX": 1.639818722420714, - "velocityY": -0.8901483820226406, + "x": 12.677980051109994, + "y": 6.40464261213393, + "heading": 0.010776485842896305, + "angularVelocity": 0.040915670789083536, + "velocityX": 1.6686996947449795, + "velocityY": -0.8824315353645927, "moduleForcesX": [ - -104.3219357419469, - -104.4433579329168, - -103.98479429515396, - -104.10925807795152 + -103.73019304787827, + -103.83684095617447, + -103.44265988179235, + -103.55145256185558 ], "moduleForcesY": [ - 49.20870816840665, - 48.951926696699964, - 49.918130797069644, - 49.6594512669405 + 50.43388218964502, + 50.21517063638304, + 51.02184694806671, + 50.801888282932815 ], - "timestamp": 1.3110013045137112 + "timestamp": 1.3340442852081544 }, { - "x": 12.765280960185926, - "y": 6.358839505806994, - "heading": 0.013420862139108694, - "angularVelocity": 0.02190446068522871, - "velocityX": 1.0876427591139382, - "velocityY": -0.6039684727687442, + "x": 12.763883221887731, + "y": 6.358611977323751, + "heading": 0.013070566515867264, + "angularVelocity": 0.029625305232663646, + "velocityX": 1.1093366003769727, + "velocityY": -0.5944305369779237, "moduleForcesX": [ - -102.56600686278175, - -102.73833096424606, - -102.12754606615566, - -102.30453214622369 + -102.72849667186838, + -102.92566676985246, + -102.22155812605043, + -102.42499394558608 ], "moduleForcesY": [ - 52.83532642023232, - 52.500706634421135, - 53.67882683102995, - 53.34195778156508 + 52.51643901990649, + 52.130430374424144, + 53.49751224898022, + 53.1084108565624 ], - "timestamp": 1.3875481416837445 + "timestamp": 1.4114808096575837 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 0.011284751527060218, - "velocityX": 0.5416639429287425, - "velocityY": -0.30593583373417904, + "angularVelocity": 0.015678746812564974, + "velocityX": 0.5534907492707788, + "velocityY": -0.29948260373218116, "moduleForcesX": [ - -101.43052677926974, - -101.63866464193977, - -100.9273864836681, - -101.14130973054235 + -102.12022129821462, + -102.37649295640067, + -101.47905712486354, + -101.74499661591264 ], "moduleForcesY": [ - 55.02158505666223, - 54.63721275613784, - 55.9399480328183, - 55.553266367098956 + 53.73126222218935, + 53.24277344389703, + 54.93360379578871, + 54.44082769369371 ], - "timestamp": 1.4640949788537778 + "timestamp": 1.488917334107013 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 5.114105590962525e-23, - "velocityX": -8.881224909325008e-21, - "velocityY": -1.1113020413435585e-20, + "angularVelocity": -1.2522021181482855e-21, + "velocityX": -6.11163916168187e-20, + "velocityY": -8.886685040205295e-20, "moduleForcesX": [ - -100.63924602824052, - -100.8733842366393, - -100.09136074426306, - -100.33208991745954 + -101.71254310622051, + -102.0097340749321, + -100.98075222935972, + -101.2902381868248 ], "moduleForcesY": [ - 56.48082932732088, - 56.062516688082894, - 57.44686854165235, - 57.026280875989876 + 54.52603575485248, + 53.96929568440209, + 55.870598413077815, + 55.308782033960505 ], - "timestamp": 1.5406418160238111 + "timestamp": 1.5663538585564423 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red OP.traj b/src/main/deploy/choreo/Red OP.traj index af04ceb..2809693 100644 --- a/src/main/deploy/choreo/Red OP.traj +++ b/src/main/deploy/choreo/Red OP.traj @@ -4,9 +4,9 @@ "x": 15.781251907348633, "y": 6.674294471740723, "heading": -1.0370884287879991, - "angularVelocity": -1.2621726109028427e-25, - "velocityX": 1.4651515238606446e-24, - "velocityY": -1.680503205752954e-25, + "angularVelocity": -1.9866208287541445e-22, + "velocityX": -1.3943691504612067e-20, + "velocityY": 1.721129501746892e-21, "moduleForcesX": [ 0, 0, @@ -22,2487 +22,2508 @@ "timestamp": 0 }, { - "x": 15.737579234276897, - "y": 6.679677617673034, - "heading": -1.0238784708913053, - "angularVelocity": 0.17911083631788308, - "velocityX": -0.5921479129069697, - "velocityY": 0.07298886018394904, + "x": 15.737579450239823, + "y": 6.679677689320791, + "heading": -1.0238715954789284, + "angularVelocity": 0.1792040409939818, + "velocityX": -0.592144926929208, + "velocityY": 0.07298982451690347, "moduleForcesX": [ - -111.52415378273292, - -114.49845914960217, - -114.62304761463147, - -115.39645209570611 + -111.5219305913229, + -114.498394155326, + -114.62307907253539, + -115.39636467253322 ], "moduleForcesY": [ - 29.64724689974533, - 14.302632979180668, - 13.43617051536317, - -1.1737539863505893 + 29.65555787933653, + 14.3029848589867, + 13.435844022960673, + -1.1813531589219308 ], - "timestamp": 0.07375297982110327 + "timestamp": 0.0737529870183815 }, { - "x": 15.65024272244521, - "y": 6.690442536464301, - "heading": -0.9972998437394694, - "angularVelocity": 0.36037360410800473, - "velocityX": -1.1841760433752266, - "velocityY": 0.1459591031762828, + "x": 15.650243268574524, + "y": 6.690442727379406, + "heading": -0.9972824865204766, + "angularVelocity": 0.3605156893757415, + "velocityX": -1.1841714511648371, + "velocityY": 0.14596070605154865, "moduleForcesX": [ - -111.50844636902373, - -114.41456026220695, - -114.64994745113319, - -115.37690823700736 + -111.50730603264702, + -114.41445099721365, + -114.6499789417417, + -115.37684481502328 ], "moduleForcesY": [ - 29.631929160379492, - 14.78872900282211, - 13.058413629305413, - -1.281113395748797 + 29.636133156128178, + 14.789343949904154, + 13.057990695853707, + -1.2850231166130164 ], - "timestamp": 0.14750595964220653 + "timestamp": 0.147505974036763 }, { - "x": 15.519260170047334, - "y": 6.706587085965137, - "heading": -0.9570257848318809, - "angularVelocity": 0.5460668708610573, - "velocityX": -1.7759628521530966, - "velocityY": 0.21890030124879606, + "x": 15.519260985004637, + "y": 6.706587400459137, + "heading": -0.9570001256980181, + "angularVelocity": 0.5461793813505997, + "velocityX": -1.7759590338658693, + "velocityY": 0.21890195546531085, "moduleForcesX": [ - -111.46040731354765, - -114.27773305577186, - -114.68449962172555, - -115.34136867400807 + -111.46108154508877, + -114.27765420928104, + -114.68446600714896, + -115.34135846330668 ], "moduleForcesY": [ - 29.681971808482846, - 15.525374011394444, - 12.482698846734126, - -1.5144551853011516 + 29.67926678958357, + 15.525601814683496, + 12.482626306329125, + -1.5118713708448794 ], - "timestamp": 0.2212589394633098 + "timestamp": 0.22125896105514448 }, { - "x": 15.344671348566528, - "y": 6.7281056267189525, - "heading": -0.9024652860812764, - "angularVelocity": 0.7397734828199154, - "velocityX": -2.3672104083698318, - "velocityY": 0.29176503520279506, + "x": 15.344671992310621, + "y": 6.728105972585149, + "heading": -0.9024462454019326, + "angularVelocity": 0.7396836725065657, + "velocityX": -2.367212498803648, + "velocityY": 0.29176543209902306, "moduleForcesX": [ - -111.33731276290986, - -114.047317314268, - -114.70303402913382, - -115.26103974744757 + -111.3416986263144, + -114.04761304875294, + -114.70270359118507, + -115.26119474678515 ], "moduleForcesY": [ - 29.852227212177972, - 16.537440340405904, - 11.678182443826497, - -1.9511492781752187 + 29.835398318882262, + 16.53470475362042, + 11.680162554712537, + -1.9345387090441741 ], - "timestamp": 0.29501191928441306 + "timestamp": 0.295011948073526 }, { - "x": 15.126638225171718, - "y": 6.754973444774636, - "heading": -0.8320689272797918, - "angularVelocity": 0.9544883335187218, - "velocityX": -2.956261888315243, - "velocityY": 0.3642946782740956, + "x": 15.126636955507474, + "y": 6.754973345333405, + "heading": -0.8321165267909179, + "angularVelocity": 0.9535846811666963, + "velocityX": -2.9562875432937514, + "velocityY": 0.36428860490166864, "moduleForcesX": [ - -110.76647931585221, - -113.4372446028584, - -114.54159557891052, - -114.91207845018252 + -110.78310373820221, + -113.43975897922056, + -114.53954300836371, + -114.91309615963544 ], "moduleForcesY": [ - 30.725491734044457, - 18.019343819168096, - 10.430723288375898, - -3.31692802572431 + 30.66242904873677, + 18.000125302132766, + 10.443175232183501, + -3.252087288558954 ], - "timestamp": 0.36876489910551635 + "timestamp": 0.3687649350919075 }, { - "x": 14.95206300120593, - "y": 6.77647174900219, - "heading": -0.773433535697502, - "angularVelocity": 0.7950240346155092, - "velocityX": -2.3670260427340133, - "velocityY": 0.29149065271260355, + "x": 14.952061791200475, + "y": 6.776471593869833, + "heading": -0.773477230035834, + "angularVelocity": 0.7950769063830467, + "velocityX": -2.367025002844833, + "velocityY": 0.29148986916380626, "moduleForcesX": [ - 111.67454146499206, - 113.21740142392865, - 114.23838580721042, - 114.66905825851461 + 111.69180132345558, + 113.22262332485307, + 114.23686977658001, + 114.66860726835483 ], "moduleForcesY": [ - -26.07191731663405, - -17.63441497120966, - -10.811867231610925, - -1.5517466920592173 + -26.00046807992641, + -17.609482537218337, + -10.829705083256483, + -1.6262110875675433 ], - "timestamp": 0.44251787892661965 + "timestamp": 0.442517922110289 }, { - "x": 14.821107358373453, - "y": 6.792594475814811, - "heading": -0.7289082448366585, - "angularVelocity": 0.6037083649887086, - "velocityX": -1.7755979914320057, - "velocityY": 0.21860441234684685, + "x": 14.821106606729163, + "y": 6.792594367193026, + "heading": -0.728934985378209, + "angularVelocity": 0.6039381787550343, + "velocityX": -1.7755916033431103, + "velocityY": 0.21860502164033546, "moduleForcesX": [ - 111.76581158852909, - 113.62556481771135, - 114.85540369095074, - 115.24093186284539 + 111.76902146309567, + 113.62660597529597, + 114.85509991104111, + 115.24105907142824 ], "moduleForcesY": [ - -28.104376111602893, - -19.05291831548317, - -9.730572920361016, - 0.7546034880784759 + -28.09175703488538, + -19.04718344009563, + -9.734361300742906, + 0.7411160901552712 ], - "timestamp": 0.5162708587477229 + "timestamp": 0.5162709091286705 }, { - "x": 14.733794757049841, - "y": 6.8033423608281804, - "heading": -0.699054593949396, - "angularVelocity": 0.40477891143756034, - "velocityX": -1.1838518461952143, - "velocityY": 0.14572814602799683, + "x": 14.733794470977603, + "y": 6.8033423167589095, + "heading": -0.6990646840438874, + "angularVelocity": 0.40500463156667743, + "velocityX": -1.183845418081848, + "velocityY": 0.14572900705980713, "moduleForcesX": [ - 111.79320392724134, - 113.62956435917394, - 114.97926679056616, - 115.33065660328327 + 111.7931349384804, + 113.62959134846821, + 114.9792838560784, + 115.33066788879077 ], "moduleForcesY": [ - -28.3773819380287, - -19.66367922942836, - -9.251806083394841, - 1.1672848935603741 + -28.37771557003671, + -19.66362346001396, + -9.251771451433502, + 1.167727477271745 ], - "timestamp": 0.5900238385688262 + "timestamp": 0.590023896147052 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": 0.2026753043980143, - "velocityX": -0.5919727585178587, - "velocityY": 0.07286398915017836, + "angularVelocity": 0.20281209391920932, + "velocityX": -0.591968821960951, + "velocityY": 0.07286457956489158, "moduleForcesX": [ - 111.81186730618849, - 113.62366087491984, - 115.03206722044585, - 115.36748176404834 + 111.8103126294131, + 113.62315026046184, + 115.03223801565095, + 115.36741290735165 ], "moduleForcesY": [ - -28.459057623857394, - -19.953358992688436, - -9.022048294829766, - 1.3182086277737222 + -28.465206698015187, + -19.95629133803773, + -9.02002923668353, + 1.325068049848567 ], - "timestamp": 0.6637768183899295 + "timestamp": 0.6637768831654335 }, { "x": 14.69013500213623, "y": 6.808716297149658, "heading": -0.6841066863138933, - "angularVelocity": -1.6373628874461133e-23, - "velocityX": 8.947893033904734e-24, - "velocityY": -1.1505319118510811e-23, + "angularVelocity": -2.5642140347804797e-20, + "velocityX": -3.5823449426452e-20, + "velocityY": -1.925043641959108e-19, "moduleForcesX": [ - 111.82265390196439, - 113.64454489492644, - 115.05199065534637, - 115.38802821587312 + 111.82024353932489, + 113.64374505858738, + 115.05224225386621, + 115.38791059104989 ], "moduleForcesY": [ - -28.500501780206477, - -19.972823998599004, - -9.007971358764712, - 1.3651700292396918 + -28.50998973892722, + -19.97737600929884, + -9.004897700061502, + 1.3756871088737914 ], - "timestamp": 0.7375297982110328 + "timestamp": 0.737529870183815 }, { - "x": 14.675442670065264, - "y": 6.813379455407895, - "heading": -0.6717552714338458, - "angularVelocity": 0.28012842601201576, - "velocityX": -0.3332201126313312, - "velocityY": 0.10575980127060357, + "x": 14.675427628708652, + "y": 6.813251052040293, + "heading": -0.6712306053842845, + "angularVelocity": 0.29193748147934406, + "velocityX": -0.33345810585500363, + "velocityY": 0.1028158279786869, "moduleForcesX": [ - -98.66143888298555, - -101.74059915261991, - -113.5288649606166, - -115.33460700108112 + -98.56104344072963, + -101.77209540362654, + -113.76419860866348, + -115.34193264889893 ], "moduleForcesY": [ - 59.785007713118624, - 54.28404650214978, - 20.548862722674233, - 1.6254648649671486 + 59.95036989637328, + 54.21915011775324, + 19.206886815923188, + -0.9665078147572825 ], - "timestamp": 0.7816217707961985 + "timestamp": 0.7816354809617166 }, { - "x": 14.645995324424886, - "y": 6.822611735205374, - "heading": -0.6475745131726771, - "angularVelocity": 0.5484163407400843, - "velocityX": -0.6678618332055477, - "velocityY": 0.20938686241916543, + "x": 14.645951659507638, + "y": 6.822252244551949, + "heading": -0.6460812610559683, + "angularVelocity": 0.5702073700998768, + "velocityX": -0.6683042969168805, + "velocityY": 0.20408270859191352, "moduleForcesX": [ - -99.75522587908065, - -102.42692626434821, - -113.61159697879016, - -115.30312469583279 + -99.67413943343905, + -102.41667407252237, + -113.80517697131697, + -115.33090537915734 ], "moduleForcesY": [ - 57.918836347024914, - 52.949230173428, - 20.022389058972617, - 2.6054576839941515 + 58.057715139352084, + 52.96303310230855, + 18.892577765031255, + 0.5017832153100624 ], - "timestamp": 0.8257137433813643 + "timestamp": 0.8257410917396183 }, { - "x": 14.601720929906575, - "y": 6.836296863592373, - "heading": -0.6121698252606008, - "angularVelocity": 0.802973553602993, - "velocityX": -1.0041373048754916, - "velocityY": 0.3103768687274164, + "x": 14.60163725558127, + "y": 6.835636025102194, + "heading": -0.6093693928259745, + "angularVelocity": 0.83236276706064, + "velocityX": -1.0047339362222996, + "velocityY": 0.30344848000491226, "moduleForcesX": [ - -101.05043111896799, - -103.17292508176739, - -113.72399441780098, - -115.25417706262766 + -100.991325152693, + -103.11790484339444, + -113.86495520158219, + -115.29193191628325 ], "moduleForcesY": [ - 55.59926387355985, - 51.44579662555788, - 19.28978582137924, - 3.763922989102108 + 55.705085158124895, + 51.549723350324534, + 18.43745216980293, + 2.2745321495909177 ], - "timestamp": 0.86980571596653 + "timestamp": 0.8698467025175199 }, { - "x": 14.542534274068288, - "y": 6.854289480670813, - "heading": -0.5663088411318837, - "angularVelocity": 1.04012094356029, - "velocityX": -1.3423453832546366, - "velocityY": 0.40807013212408705, + "x": 14.54240224861384, + "y": 6.853299205917846, + "heading": -0.5620118203579388, + "angularVelocity": 1.0737312471764549, + "velocityX": -1.3430265656157756, + "velocityY": 0.40047469027457633, "moduleForcesX": [ - -102.57468929953593, - -104.09282628417807, - -113.84725221188148, - -115.17640973922873 + -102.53916594922721, + -104.00399188740985, + -113.91900928393952, + -115.20317523209395 ], "moduleForcesY": [ - 52.69527446824037, - 49.514027860489485, - 18.434236842874185, - 5.208253519164049 + 52.761241240453465, + 49.693648028830694, + 17.977297280367917, + 4.521635796707823 ], - "timestamp": 0.9138976885516957 + "timestamp": 0.9139523132954216 }, { - "x": 14.468332402329434, - "y": 6.876403676556318, - "heading": -0.5110338700297112, - "angularVelocity": 1.2536289002585717, - "velocityX": -1.6828884576558436, - "velocityY": 0.501546984381149, + "x": 14.468148235945801, + "y": 6.875112546792884, + "heading": -0.5052716820349888, + "angularVelocity": 1.286460777261897, + "velocityX": -1.6835502639776507, + "velocityY": 0.4945706564383568, "moduleForcesX": [ - -104.36995920291493, - -105.32254762054377, - -113.95741323469906, - -115.04927896233585 + -104.36005213468482, + -105.22540646754365, + -113.93211638348767, + -115.02101774687752 ], "moduleForcesY": [ - 48.98783162688297, - 46.78241555241345, - 17.57930257657602, - 7.070518349276318 + 49.00253104776368, + 46.99284585116924, + 17.723543700297828, + 7.461228629108571 ], - "timestamp": 0.9579896611368615 + "timestamp": 0.9580579240733232 }, { - "x": 14.37898957009058, - "y": 6.902392060853308, - "heading": -0.44783074537436557, - "angularVelocity": 1.4334383550943604, - "velocityX": -2.026283402637178, - "velocityY": 0.5894130557845081, + "x": 14.378757412573508, + "y": 6.900907275957238, + "heading": -0.4409704067619092, + "angularVelocity": 1.4578933187633483, + "velocityX": -2.0267449377911255, + "velocityY": 0.5848400851820366, "moduleForcesX": [ - -106.49908090238071, - -107.01525529263431, - -114.02178183246805, - -114.83695790685455 + -106.52188217914602, + -106.94884746449374, + -113.84546391040449, + -114.66217685453101 ], "moduleForcesY": [ - 44.081369792919354, - 42.68370625113583, - 16.92078527818248, - 9.50620759153989 + 44.012594395755805, + 42.839962321036545, + 18.031148465609164, + 11.368492354698162 ], - "timestamp": 1.0020816337220273 + "timestamp": 1.002163534851225 }, { - "x": 14.27435337661712, - "y": 6.9319034624003555, - "heading": -0.378909376081055, - "angularVelocity": 1.5631273733599833, - "velocityX": -2.3731347757542367, - "velocityY": 0.6693146125418837, + "x": 14.274093603671082, + "y": 6.930444659197211, + "heading": -0.37184741685344586, + "angularVelocity": 1.5672153426587654, + "velocityX": -2.373027083322251, + "velocityY": 0.6696967283529704, "moduleForcesX": [ - -109.05079129956879, - -109.30978180404821, - -113.98678875725696, - -114.47840264239277 + -109.13072597484623, + -109.3202988487006, + -113.53294594518621, + -113.97055609730344 ], "moduleForcesY": [ - 37.169217718197665, - 36.26992503225888, - 16.79745494938532, - 12.695311902448891 + 36.90107882775114, + 36.22279873439767, + 19.561487229518704, + 16.596053973633666 ], - "timestamp": 1.0461736063071931 + "timestamp": 1.0462691456291267 }, { - "x": 14.154251482794562, - "y": 6.964387520079728, - "heading": -0.30775640664377, - "angularVelocity": 1.6137397640772269, - "velocityX": -2.7238947767776662, - "velocityY": 0.7367340532707765, + "x": 14.15402395976836, + "y": 6.963340036530724, + "heading": -0.30230713856933716, + "angularVelocity": 1.5766764603779295, + "velocityX": -2.7223213052722017, + "velocityY": 0.7458320325537722, "moduleForcesX": [ - -112.08031010757401, - -112.18021841591917, - -113.73249543230662, - -113.86796827837567 + -112.27314779877986, + -112.29121526331127, + -112.62446776737106, + -112.64475573276913 ], "moduleForcesY": [ - 26.31054160567366, - 25.791337814688173, - 17.883772198148794, - 16.866370546912236 + 25.3687700693123, + 25.27084960348355, + 23.762742580916523, + 23.647404391326813 ], - "timestamp": 1.090265578892359 + "timestamp": 1.0903747564070283 }, { "x": 14.018568992614746, "y": 6.998851299285889, "heading": -0.2405341289144176, - "angularVelocity": 1.5245922055201624, - "velocityX": -3.077260603792211, - "velocityY": 0.7816338708727887, + "angularVelocity": 1.4005703257570525, + "velocityX": -3.0711504673568144, + "velocityY": 0.8051416164258196, "moduleForcesX": [ - -114.82237403261927, - -114.74700757937691, - -112.85254185437864, - -112.7959826533612 + -114.88838435677177, + -114.82492813620281, + -109.50587966957576, + -110.01547367885283 ], "moduleForcesY": [ - 5.717046194433142, - 7.799925169065911, - 21.890043385783084, - 22.434461113364925 + 1.804812129477657, + 6.353046745851207, + 34.75647703160557, + 33.46666656638838 ], - "timestamp": 1.1343575514775248 + "timestamp": 1.13448036718493 }, { - "x": 13.785764027917146, - "y": 7.049557069939888, - "heading": -0.17998468944051094, - "angularVelocity": 0.9309010044100465, - "velocityX": -3.5791970553589576, - "velocityY": 0.7795621766496209, + "x": 13.788287000145154, + "y": 7.053740973657355, + "heading": -0.21166669107253983, + "angularVelocity": 0.44310544982728, + "velocityX": -3.5347510374590354, + "velocityY": 0.8425380176261146, "moduleForcesX": [ - -105.90034530214052, - -112.5578546807494, - -108.95118327774632, - -110.9158025657128 + -97.329322675789, + -112.16551931316292, + -90.56768367714201, + -104.13823940579265 ], "moduleForcesY": [ - -44.54881353554729, - -23.89201960495729, - 36.12411374491502, - 30.50757452772645 + -60.86272843982779, + -25.633925874682763, + 70.25124390630064, + 48.85031849268775 ], - "timestamp": 1.1994014596772797 + "timestamp": 1.1996283762042959 }, { - "x": 13.548480509194473, - "y": 7.083413324629865, - "heading": -0.23170832211848127, - "angularVelocity": -0.7952110214399025, - "velocityX": -3.6480513746799783, - "velocityY": 0.520513844063655, + "x": 13.55067748815617, + "y": 7.084433906415849, + "heading": -0.23000952086779244, + "angularVelocity": -0.2815562604499559, + "velocityX": -3.647225994555768, + "velocityY": 0.47112618206602946, "moduleForcesX": [ - 9.943360980697118, - -64.05615636732168, - 102.05846309668772, - -108.07396127616538 + -2.9715371277537543, + -50.32031969204716, + 26.184948512995206, + -70.95695667054495 ], "moduleForcesY": [ - -112.65864909231027, - -93.25868171164684, - -35.74086748752557, - 15.439504342633342 + -102.27224679452286, + -89.36908292050822, + -80.58938519969703, + -51.59319249987748 ], - "timestamp": 1.2644453678770347 + "timestamp": 1.2647763852236618 }, { - "x": 13.344677164525947, - "y": 7.110151219170367, - "heading": -0.28721528091170123, - "angularVelocity": -0.8533767470237762, - "velocityX": -3.1333194807825815, - "velocityY": 0.411074538423911, + "x": 13.346050543006005, + "y": 7.110014029553323, + "heading": -0.27803893764500576, + "angularVelocity": -0.7372353737308557, + "velocityX": -3.1409547003859206, + "velocityY": 0.3926462761105312, "moduleForcesX": [ - 111.64039245061323, - 111.67573063214599, - 113.05374138509697, - 113.12917537886882 + 107.29038544493396, + 105.50415195458457, + 114.90061482209745, + 113.70906001277713 ], "moduleForcesY": [ - -27.3804179148427, - -27.135696145803145, - -20.80013262963892, - -20.25362840349172 + -41.12412783239415, + -44.92027941539363, + 2.350623072487603, + 15.269282404330298 ], - "timestamp": 1.3294892760767896 + "timestamp": 1.3299243942430277 }, { - "x": 13.174758752766676, - "y": 7.131608923168944, - "heading": -0.33740943490813896, - "angularVelocity": -0.7716964645218987, - "velocityX": -2.612364731181882, - "velocityY": 0.32989567497511807, + "x": 13.17555433292844, + "y": 7.131108704498771, + "heading": -0.3278649259101783, + "angularVelocity": -0.7648121410795735, + "velocityX": -2.617059410470719, + "velocityY": 0.32379615682769, "moduleForcesX": [ - 114.5610194383314, - 114.39486717948932, - 113.08162800775546, - 112.89574776865835 + 113.95000686208219, + 114.00926980580654, + 114.37824029202245, + 114.432579234299 ], "moduleForcesY": [ - -12.147523599218806, - -13.756071322380498, - -21.984601963668993, - -23.002730233684403 + -16.845089796422403, + -16.397310132902103, + -13.650410305482506, + -13.135741678489495 ], - "timestamp": 1.3945331842765445 + "timestamp": 1.3950724032623936 }, { - "x": 13.03879537020891, - "y": 7.148379691490802, - "heading": -0.37942088256423195, - "angularVelocity": -0.6458936558220427, - "velocityX": -2.090332305067128, - "velocityY": 0.2578376482291461, + "x": 13.039211960013166, + "y": 7.1478899748634275, + "heading": -0.3721868233579608, + "angularVelocity": -0.6803262005229891, + "velocityX": -2.0928095112583573, + "velocityY": 0.257586849041975, "moduleForcesX": [ - 115.09723127896024, - 114.86715102435959, - 113.15121967782909, - 112.75876113770701 + 114.97790928984213, + 114.81105309086456, + 113.77046476766135, + 113.51984327567988 ], "moduleForcesY": [ - -6.694150425031576, - -10.065224665337288, - -22.080340952979505, - -24.086273621516778 + -8.413922151143758, + -10.5686669898906, + -18.601337026327453, + -20.14217381557217 ], - "timestamp": 1.4595770924762994 + "timestamp": 1.4602204122817595 }, { - "x": 12.93681096444313, - "y": 7.1607529171336655, - "heading": -0.4118889861172464, - "angularVelocity": -0.49917208931084484, - "velocityX": -1.5679317031900568, - "velocityY": 0.19022881596941998, + "x": 12.936993453855967, + "y": 7.16043119839742, + "heading": -0.4076788949391856, + "angularVelocity": -0.5447913468955652, + "velocityX": -1.5690196476582259, + "velocityY": 0.1925035580176633, "moduleForcesX": [ - 115.27036043262517, - 115.03722833246768, - 113.22264635282365, - 112.66564421864199 + 115.25718411477271, + 115.04192430676589, + 113.43999532206203, + 112.93907410546886 ], "moduleForcesY": [ - -3.897941495417185, - -8.482092446228034, - -21.944669919102676, - -24.71594535140867 + -4.1842117021754905, + -8.36626096655789, + -20.776774168788005, + -23.417109666661794 ], - "timestamp": 1.5246210006760543 + "timestamp": 1.5253684213011254 }, { - "x": 12.86881655254604, - "y": 7.168899399845526, - "heading": -0.4340261020129738, - "angularVelocity": -0.3403411096968923, - "velocityX": -1.045361722242647, - "velocityY": 0.1252458983067642, + "x": 12.868869943457646, + "y": 7.168770766708618, + "heading": -0.43245925393772605, + "angularVelocity": -0.38037016589677036, + "velocityX": -1.0456729441734487, + "velocityY": 0.1280095652457402, "moduleForcesX": [ - 115.34180830581067, - 115.1220732972316, - 113.27936411804733, - 112.60054698627378 + 115.34930465283051, + 115.14281844208664, + 113.24852185391626, + 112.55115361335103 ], "moduleForcesY": [ - -2.2058871322716747, - -7.623094959817495, - -21.792793628817755, - -25.125745546203547 + -1.6624491289951602, + -7.285612760344197, + -21.94224971099902, + -25.340251738278926 ], - "timestamp": 1.5896649088758092 + "timestamp": 1.5905164303204913 }, { "x": 12.83481788635254, - "y": 7.172932147979736, + "y": 7.172932147979735, "heading": -0.44530098242829574, - "angularVelocity": -0.17334260390221193, - "velocityX": -0.5227033112629944, - "velocityY": 0.06200039705217003, + "angularVelocity": -0.19711620790671255, + "velocityX": -0.5226876096087977, + "velocityY": 0.06387580117578445, "moduleForcesX": [ - 115.37550458711002, - 115.17526382073038, - 113.31339825214359, - 112.55684919025829 + 115.37974072229976, + 115.20102163601167, + 113.11488966367791, + 112.28107877840188 ], "moduleForcesY": [ - -1.08050082459098, - -7.042007188765636, - -21.71168485805975, - -25.396097743199675 + -0.004287565574101409, + -6.608776467019539, + -22.71557758012725, + -26.587848089395145 ], - "timestamp": 1.6547088170755642 + "timestamp": 1.6556644393398572 }, { "x": 12.83481788635254, "y": 7.172932147979736, "heading": -0.44530098242829574, - "angularVelocity": -3.9933853319259413e-22, - "velocityX": 8.259574098341232e-22, - "velocityY": -8.025414561021505e-21, + "angularVelocity": -4.3322696611731714e-20, + "velocityX": -8.054779748279346e-20, + "velocityY": -2.673843206569549e-19, "moduleForcesX": [ - 115.3927162988571, - 115.2157166646866, - 113.32030793770694, - 112.5314849425636 + 115.38688887330075, + 115.24383423254851, + 112.99392182289489, + 112.09250755639513 ], "moduleForcesY": [ - -0.2866941492311068, - -6.549472740050449, - -21.74513414149322, - -25.561679568405665 + 1.1556352772333405, + -6.047136158151505, + -23.37602173859373, + -27.42405623065844 ], - "timestamp": 1.719752725275319 + "timestamp": 1.720812448359223 }, { - "x": 12.807227728725032, - "y": 7.174709038499013, - "heading": -0.4281784561783119, - "angularVelocity": 0.2913880585511266, - "velocityX": -0.46952431836436137, - "velocityY": 0.030238801863144257, + "x": 12.806218245833676, + "y": 7.174820039076195, + "heading": -0.4245523778880747, + "angularVelocity": 0.3458966849026219, + "velocityX": -0.47678005649515354, + "velocityY": 0.03147273207971745, "moduleForcesX": [ - -111.63376359219195, - -113.03432284252689, - -115.30641606592077, - -113.87965459197578 + -110.78430493237788, + -112.32377906856804, + -115.23706895839638, + -113.12589486821221 ], "moduleForcesY": [ - 29.185604964347988, - 23.049027164974667, - -4.482758375470643, - -18.522278194463308 + 32.27146527448446, + 26.289960305975733, + -6.074152668020973, + -22.68521400402437 ], - "timestamp": 1.7785146605966307 + "timestamp": 1.780797424931237 }, { - "x": 12.75201337328418, - "y": 7.178230603874502, - "heading": -0.39459826783402535, - "angularVelocity": 0.5714615790080666, - "velocityX": -0.9396279264618801, - "velocityY": 0.05992936339201547, + "x": 12.748952905107773, + "y": 7.178545444277793, + "heading": -0.38415999659299915, + "angularVelocity": 0.6733749615886423, + "velocityX": -0.9546613835408188, + "velocityY": 0.062105637352804374, "moduleForcesX": [ - -111.97456605857009, - -113.08025540759344, - -115.2878683815402, - -114.07142344583939 + -111.34041034625368, + -112.46001862879739, + -115.21709287532448, + -113.49633756841047 ], "moduleForcesY": [ - 27.798664214369428, - 22.750200267155396, - -4.644259008500988, - -17.20495297529052 + 30.249349366921713, + 25.63630342009708, + -6.2116432185373744, + -20.667196776631027 ], - "timestamp": 1.8372765959179422 + "timestamp": 1.840782401503251 }, { - "x": 12.669133432086447, - "y": 7.183456533131369, - "heading": -0.34543352510474484, - "angularVelocity": 0.8366767101942217, - "velocityX": -1.410435867105893, - "velocityY": 0.08893392003330741, + "x": 12.662940297741304, + "y": 7.184048443151815, + "heading": -0.32564500296154497, + "angularVelocity": 0.975494148292365, + "velocityX": -1.4339024916215266, + "velocityY": 0.09173961862624963, "moduleForcesX": [ - -112.39241209224183, - -113.13856392421164, - -115.26232496995146, - -114.30163807419474 + -112.01287501883925, + -112.65201576445827, + -115.19409328267592, + -113.94247486613864 ], "moduleForcesY": [ - 25.984522474314748, - 22.361639151859034, - -4.855118557125519, - -15.454500356763997 + 27.582891138596644, + 24.690234496665074, + -6.303104707024134, + -17.90910605865672 ], - "timestamp": 1.8960385312392538 + "timestamp": 1.900767378075265 }, { - "x": 12.55853332818378, - "y": 7.1903382613240066, - "heading": -0.28201202301705236, - "angularVelocity": 1.0792956654831465, - "velocityX": -1.8821725883925233, - "velocityY": 0.11711200720343988, + "x": 12.548073202688675, + "y": 7.191263389762513, + "heading": -0.2514092768535465, + "angularVelocity": 1.237571978024797, + "velocityX": -1.9149310646929252, + "velocityY": 0.12027922695005987, "moduleForcesX": [ - -112.89842492883132, - -113.27691583678147, - -115.23714227829124, - -114.5802390264178 + -112.81041180905635, + -113.02354769728048, + -115.18961505698347, + -114.47046500698896 ], "moduleForcesY": [ - 23.57272456251679, - 21.510094456969895, - -4.864096919796805, - -12.981065814635949 + 23.98927394171314, + 22.793596210138528, + -5.8660066614304105, + -13.892228757886931 ], - "timestamp": 1.9548004665605654 + "timestamp": 1.960752354647279 }, { - "x": 12.420138411669608, - "y": 7.1988188813829685, - "heading": -0.20656770962185922, - "angularVelocity": 1.2838976964026465, - "velocityX": -2.3551796883037355, - "velocityY": 0.14432166014599362, + "x": 12.404212619219079, + "y": 7.200124822376674, + "heading": -0.1656029487785582, + "angularVelocity": 1.4304636423751034, + "velocityX": -2.398276896830811, + "velocityY": 0.14772753313528253, "moduleForcesX": [ - -113.50883091034551, - -113.59238050873091, - -115.2246253766407, - -114.89486558850359 + -113.74212753677462, + -113.71654311369026, + -115.22737898976276, + -115.00224148188839 ], "moduleForcesY": [ - 20.21586561081966, - 19.545611913909976, - -4.167774994305711, - -9.292159419632245 + 18.81992692642623, + 18.78236752442216, + -3.863631013963434, + -7.747401038811083 ], - "timestamp": 2.013562401881877 + "timestamp": 2.020737331219293 }, { - "x": 12.25385215279822, - "y": 7.20882879407445, - "heading": -0.12324014213695786, - "angularVelocity": 1.418053490397559, - "velocityX": -2.8298295139894725, - "velocityY": 0.17034688590065417, + "x": 12.231222631446618, + "y": 7.210562916135438, + "heading": -0.07622689905581251, + "angularVelocity": 1.4899739039732183, + "velocityX": -2.8838885610762883, + "velocityY": 0.17401180020855656, "moduleForcesX": [ - -114.24355796594509, - -114.20109143791724, - -115.21632171398484, - -115.14763181288494 + -114.76126852409654, + -114.7421155109847, + -115.16877303317679, + -115.16168855405087 ], "moduleForcesY": [ - 15.001571052472121, - 15.09888258206903, - -1.5352801286814335, - -3.4085278625122855 + 10.008825147658298, + 10.070314335440338, + 2.5624628546635875, + 2.2474118634241425 ], - "timestamp": 2.0723243372031885 + "timestamp": 2.080722307791307 }, { - "x": 12.059627085386966, - "y": 7.22024637414857, - "heading": -0.04129541884931243, - "angularVelocity": 1.3945204976583903, - "velocityX": -3.3052871105968005, - "velocityY": 0.19430231512438093, + "x": 12.029500394811427, + "y": 7.222385830186037, + "heading": -0.0039485688178259514, + "angularVelocity": 1.204940542924344, + "velocityX": -3.3628793101722345, + "velocityY": 0.19709791894983314, "moduleForcesX": [ - -114.97100473665364, - -114.97889469256124, - -114.8139912747789, - -114.82552416001533 + -114.04384036644842, + -114.49070976762575, + -111.91885906316082, + -113.1109806049009 ], "moduleForcesY": [ - 4.2427491405482245, - 4.253087696650936, - 7.355545167868264, - 7.30454562824674 + -14.076136858623709, + -11.072443207696098, + 26.086845583351657, + 20.922368283412005 ], - "timestamp": 2.1310862725245 + "timestamp": 2.140707284363321 }, { - "x": 11.839765743551363, - "y": 7.23241969553516, - "heading": -0.0006749768142111347, - "angularVelocity": 0.6912713445019788, - "velocityX": -3.7415605975772905, - "velocityY": 0.20716338425592043, + "x": 11.80460462204042, + "y": 7.235252445190618, + "heading": -0.0008006446065590651, + "angularVelocity": 0.05247854364813661, + "velocityX": -3.7492016438651103, + "velocityY": 0.2144972914865366, "moduleForcesX": [ - -102.78978326842798, - -110.70709433093434, - -99.03740787130111, - -109.17877166162 + -81.54498134539398, + -107.40451669387666, + -72.77164512682661, + -104.09396678970617 ], "moduleForcesY": [ - -49.60370655750785, - -29.865882900776136, - 56.82286597574406, - 35.07856026223796 + -79.06583770683336, + -39.74553876688151, + 87.47036330162258, + 47.81677142513769 ], - "timestamp": 2.1898482078458117 + "timestamp": 2.2006922609353348 }, { - "x": 11.606961624069507, - "y": 7.246562519511796, - "heading": -0.0005355014534405035, - "angularVelocity": 0.0023735664934787628, - "velocityX": -3.9618184494584505, - "velocityY": 0.24068002354419354, + "x": 11.578837837946322, + "y": 7.24893697247758, + "heading": -0.0006403041671407614, + "angularVelocity": 0.00267300995318069, + "velocityX": -3.763722135042569, + "velocityY": 0.22813257700507097, "moduleForcesX": [ - -38.90533896850442, - -71.13047771062192, - -35.06934232415729, - -67.80168692280769 + -1.905073107730994, + -4.979358092034403, + -1.8985551229214885, + -4.966710791426678 ], "moduleForcesY": [ - -29.244976944441376, - -20.88166507672035, - 46.999796252022335, - 35.52488241556469 + 1.1660681917013023, + 1.1666845103684094, + 5.292556396001393, + 5.28617190164468 ], - "timestamp": 2.2486101431671233 + "timestamp": 2.2606772375073487 }, { - "x": 11.374166105742725, - "y": 7.260879607361727, - "heading": -0.0004016151661947471, - "angularVelocity": 0.0022784526498942454, - "velocityX": -3.961672076555177, - "velocityY": 0.24364561465930565, + "x": 11.353074323427755, + "y": 7.262676760108333, + "heading": -0.00048021470173828523, + "angularVelocity": 0.002668826005296234, + "velocityX": -3.7636676284691517, + "velocityY": 0.22905381340371728, "moduleForcesX": [ - 0.038364732131467016, - 0.032375744635614497, - 0.038368146904853476, - 0.0323791503117189 + 0.013031053607783862, + 0.012772921444523999, + 0.013033680353923839, + 0.012775534950563829 ], "moduleForcesY": [ - 0.712634533787872, - 0.7126371600804828, - 0.7206706947523008, - 0.7206734674425367 + 0.2179094533492434, + 0.21791141098177333, + 0.21825566239591795, + 0.21825770061287675 ], - "timestamp": 2.307372078488435 + "timestamp": 2.3206622140793627 }, { - "x": 11.141371561910887, - "y": 7.275212536833178, - "heading": -0.00026773225352809773, - "angularVelocity": 0.002278395221916618, - "velocityX": -3.9616554927763006, - "velocityY": 0.24391520451254395, + "x": 11.127311121333316, + "y": 7.276421682496976, + "heading": -0.0003201284847273866, + "angularVelocity": 0.002668771851877109, + "velocityX": -3.7636624200962037, + "velocityY": 0.22913941413551184, "moduleForcesX": [ - 0.004009381579098697, - 0.004005764410869393, - 0.004009387088650458, - 0.004005769695837714 + 0.001234624812908876, + 0.0012312846204447392, + 0.0012346644208775844, + 0.0012313220175801665 ], "moduleForcesY": [ - 0.06514567586811906, - 0.06514567997746004, - 0.0651505264669484, - 0.06515053178951452 + 0.02026193639435043, + 0.020261967907305133, + 0.02026641742373401, + 0.02026644973896179 ], - "timestamp": 2.3661340138097464 + "timestamp": 2.3806471906513766 }, { - "x": 10.908578322216146, - "y": 7.289566634568185, - "heading": -0.0001338526766265076, - "angularVelocity": 0.0022783384544694425, - "velocityX": -3.9616332992067487, - "velocityY": 0.2442754421977271, + "x": 10.901548911262122, + "y": 7.290182893091728, + "heading": -0.00016004688535705913, + "angularVelocity": 0.0026686948719258762, + "velocityX": -3.7636458822345045, + "velocityY": 0.2294109522278709, "moduleForcesX": [ - 0.005365004147551414, - 0.005361429921381281, - 0.0053650047309120935, - 0.005361430429434329 + 0.003917363554224196, + 0.003912617107756982, + 0.003917372465434683, + 0.003912626035956667 ], "moduleForcesY": [ - 0.08705133042548914, - 0.0870513309885176, - 0.08705612689598109, - 0.08705612743994169 + 0.06427780505229556, + 0.06427781349839326, + 0.06428417983115862, + 0.06428418449535106 ], - "timestamp": 2.424895949131058 + "timestamp": 2.4406321672233906 }, { "x": 10.675800323486328, "y": 7.304165840148926, - "heading": 1.7042025537647997e-21, - "angularVelocity": 0.002277880670447602, - "velocityX": -3.9613739312189615, - "velocityY": 0.24844664323787644, + "heading": 4.902614731908987e-20, + "angularVelocity": 0.0026681161601341567, + "velocityX": -3.763418787115392, + "velocityY": 0.23310748551197824, "moduleForcesX": [ - 0.06269233899547927, - 0.06266351116723548, - 0.06269233826753248, - 0.06266351034664668 + 0.05377795064678017, + 0.053742159378856506, + 0.05377793434799179, + 0.05374214026788467 ], "moduleForcesY": [ - 1.007977935654259, - 1.0079779361307588, - 1.0080166121174583, - 1.008016612499835 + 0.8750534536430745, + 0.8750534628319293, + 0.875101282349867, + 0.8751012884750409 ], - "timestamp": 2.4836578844523696 + "timestamp": 2.5006171437954046 }, { - "x": 10.375996780740442, - "y": 7.329310693479934, - "heading": 2.0952126811330077e-9, - "angularVelocity": 2.764850905030086e-8, - "velocityX": -3.9562193564264954, - "velocityY": 0.33181247476771986, + "x": 10.387622426571776, + "y": 7.328344294067126, + "heading": 2.3254481669479827e-9, + "angularVelocity": 3.032787466640411e-8, + "velocityX": -3.7583392584954223, + "velocityY": 0.3153289462634989, "moduleForcesX": [ - 1.0229926855250218, - 0.9091406227519973, - 1.0226331700096871, - 0.9088211451962043 + 1.0067102595186133, + 0.8750670830655214, + 1.0063138780752319, + 0.8747253009280082 ], "moduleForcesY": [ - 15.547847834608662, - 15.548099923086475, - 15.695135166721935, - 15.695389362462524 + 15.141564196519592, + 15.141847578839105, + 15.312185150396871, + 15.312470356023791 ], - "timestamp": 2.5594381978616565 + "timestamp": 2.577294068653412 }, { - "x": 10.076214527720056, - "y": 7.354701655214317, - "heading": 2.094930318371914e-9, - "angularVelocity": -3.7260701149184505e-12, - "velocityX": -3.955938416370364, - "velocityY": 0.3350601309504519, + "x": 10.099463518452877, + "y": 7.3527474199811484, + "heading": 2.3248702362929507e-9, + "angularVelocity": -7.537217436692108e-12, + "velocityX": -3.75809161168789, + "velocityY": 0.3182590585004953, "moduleForcesX": [ - 0.05264500382423462, - 0.05264365410486792, - 0.05264500378601022, - 0.052643654069695955 + 0.04586372569533866, + 0.04586225728281445, + 0.04586372442294008, + 0.04586225608157109 ], "moduleForcesY": [ - 0.6085655004355156, - 0.6085655004799007, - 0.6085673123929624, - 0.60856731249484 + 0.5426416315110343, + 0.5426416339386481, + 0.5426435918286837, + 0.5426435952885554 ], - "timestamp": 2.6352185112709434 + "timestamp": 2.6539709935114195 }, { - "x": 9.797406327584714, - "y": 7.378325085957681, - "heading": 1.5073724891563739e-9, - "angularVelocity": -7.753436252528545e-9, - "velocityX": -3.679163988534978, - "velocityY": 0.31173572238710123, + "x": 9.814017805583175, + "y": 7.376928795577381, + "heading": 1.9467555589251595e-9, + "angularVelocity": -4.931270758027853e-9, + "velocityX": -3.722706843007822, + "velocityY": 0.31536705000900056, "moduleForcesX": [ - 51.863747239900356, - 51.86374695379424, - 51.863747256238625, - 51.86374697013233 + 6.5530881077342835, + 6.5530878919904225, + 6.553088110092179, + 6.553087894351924 ], "moduleForcesY": [ - -4.370675841289359, - -4.370675853259884, - -4.37067526479211, - -4.370675276765134 + -0.5355861518431727, + -0.5355861508230616, + -0.5355858164479997, + -0.535585816026562 ], - "timestamp": 2.7109988246802303 + "timestamp": 2.730647918369427 }, { - "x": 9.564977522412576, - "y": 7.398018834411508, - "heading": 1.0091532234135017e-9, - "angularVelocity": -6.574521050764288e-9, - "velocityX": -3.067139666166313, - "velocityY": 0.259879480142313, + "x": 9.576052798884584, + "y": 7.397087900656233, + "heading": 1.3998387250690954e-9, + "angularVelocity": -7.13274345402949e-9, + "velocityX": -3.1034761388678853, + "velocityY": 0.26290967088448547, "moduleForcesX": [ - 114.6849979131527, - 114.68499791407868, - 114.68499790306541, - 114.68499790399139 + 114.67853113769715, + 114.67853113597926, + 114.6785311563086, + 114.67853115459069 ], "moduleForcesY": [ - -9.717151397060475, - -9.717151389543696, - -9.717151516501819, - -9.71715150898504 + -9.71485297726741, + -9.714852991136166, + -9.714852756840832, + -9.714852770709586 ], - "timestamp": 2.7867791380895173 + "timestamp": 2.8073248432274345 }, { - "x": 9.379002999894094, - "y": 7.413776516620944, - "heading": 6.07279161464561e-10, - "angularVelocity": -5.303145947397083e-9, - "velocityX": -2.454127122885302, - "velocityY": 0.2079389949778709, + "x": 9.38564843718617, + "y": 7.413217936567628, + "heading": 8.817223023849284e-10, + "angularVelocity": -6.7571361741962134e-9, + "velocityX": -2.483202893843367, + "velocityY": 0.2103636255792007, "moduleForcesX": [ - 114.8701770137192, - 114.8701770145637, - 114.87017700281322, - 114.87017700365773 + 114.871604676597, + 114.8716046768432, + 114.87160467341323, + 114.87160467365942 ], "moduleForcesY": [ - -9.732937365029667, - -9.73293735690283, - -9.732937493953377, - -9.73293748582654 + -9.73127340414734, + -9.731273401774862, + -9.731273441790679, + -9.7312734394182 ], - "timestamp": 2.862559451498804 + "timestamp": 2.884001768085442 }, { - "x": 9.23950774412561, - "y": 7.425596002759894, - "heading": 3.043248809966869e-10, - "angularVelocity": -3.997796615482812e-9, - "velocityX": -1.8407848884851736, - "velocityY": 0.15597040454443006, + "x": 9.242830540920899, + "y": 7.425316707330115, + "heading": 4.5664978487651237e-10, + "angularVelocity": -5.5436823828756494e-9, + "velocityX": -1.8625929056198445, + "velocityY": 0.15778894086965362, "moduleForcesX": [ - 114.93195662610684, - 114.93195662692112, - 114.9319566149, - 114.93195661571428 + 114.93396789150813, + 114.93396789225454, + 114.93396788121369, + 114.9339678819601 ], "moduleForcesY": [ - -9.73820390689876, - -9.73820389854772, - -9.738204039306959, - -9.73820403095592 + -9.736577243932624, + -9.736577236261477, + -9.736577365581361, + -9.736577357910216 ], - "timestamp": 2.938339764908091 + "timestamp": 2.9606786929434494 }, { - "x": 9.146504246330785, - "y": 7.433476227985266, - "heading": 1.0162592903545258e-10, - "angularVelocity": -2.6748233524248435e-9, - "velocityX": -1.2272778194056342, - "velocityY": 0.10398776239958622, + "x": 9.147611861943055, + "y": 7.433383128421549, + "heading": 1.5641822672976188e-10, + "angularVelocity": -3.915539892904257e-9, + "velocityX": -1.2418166111143913, + "velocityY": 0.10520011211157348, "moduleForcesX": [ - 114.96284439351281, - 114.96284439431135, - 114.9628443821499, - 114.96284438294843 + 114.9647670121377, + 114.96476701310675, + 114.96476699831942, + 114.96476699928847 ], "moduleForcesY": [ - -9.74083700482707, - -9.740836996359715, - -9.74083713904288, - -9.740837130575525 + -9.739196633819809, + -9.739196623522792, + -9.739196797065262, + -9.739196786768243 ], - "timestamp": 3.014120078317378 + "timestamp": 3.037355617801457 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 7.916223464815508e-22, - "angularVelocity": -1.3410597616003847e-9, - "velocityX": -0.6136718659319499, - "velocityY": 0.051996690628184836, + "heading": 3.99836183035016e-20, + "angularVelocity": -2.039964787052138e-9, + "velocityX": -0.6209412027311271, + "velocityY": 0.052602853899473855, "moduleForcesX": [ - 114.98137397829139, - 114.98137397908025, - 114.98137396683289, - 114.98137396762175 + 114.98312242387729, + 114.98312242497133, + 114.98312240795504, + 114.98312240904907 ], "moduleForcesY": [ - -9.742416601179544, - -9.74241659264097, - -9.742416736502106, - -9.742416727963532 + -9.740757716301594, + -9.740757704436747, + -9.740757904372455, + -9.740757892507608 ], - "timestamp": 3.089900391726665 + "timestamp": 3.1140325426594644 }, { "x": 9.1, "y": 7.437416553497315, - "heading": 8.037920803587129e-22, - "angularVelocity": 1.6446873974517507e-22, - "velocityX": -2.757905967086945e-22, - "velocityY": -1.294831886303353e-21, + "heading": 4.06614059613504e-20, + "angularVelocity": 8.844729643904558e-21, + "velocityX": -1.4964447302773342e-20, + "velocityY": -4.1999091669097654e-20, + "moduleForcesX": [ + 114.99530721950912, + 114.99530722068296, + 114.99530720218843, + 114.99530720336229 + ], + "moduleForcesY": [ + -9.741794002809645, + -9.741793989902737, + -9.741794207376442, + -9.741794194469533 + ], + "timestamp": 3.190709467517472 + }, + { + "x": 9.158729002384682, + "y": 7.427913275125405, + "heading": -0.011345627876544048, + "angularVelocity": -0.1325178974362472, + "velocityX": 0.6859597370222545, + "velocityY": -0.1109990987101228, "moduleForcesX": [ - 114.99372507265782, - 114.99372507344016, - 114.99372506113471, - 114.99372506191705 + 113.00915752320314, + 112.63135889504281, + 114.77561717238223, + 114.67559733618697 ], "moduleForcesY": [ - -9.743469497838449, - -9.743469489251723, - -9.743469633909358, - -9.74346962532263 + -23.425636698784487, + -25.159294856402457, + -12.091339079978018, + -12.964745355934468 ], - "timestamp": 3.165680705135952 + "timestamp": 3.2763252831623157 }, { - "x": 9.164075734077805, - "y": 7.4270458645926025, - "heading": -0.011277793242374901, - "angularVelocity": -0.1261254526683904, - "velocityX": 0.7165924034905254, - "velocityY": -0.11598083104372046, + "x": 9.276180573932086, + "y": 7.408905935250988, + "heading": -0.03395538753487, + "angularVelocity": -0.2640839135623844, + "velocityX": 1.371844333465473, + "velocityY": -0.22200734445215983, "moduleForcesX": [ - 113.09738136430255, - 112.7673730946546, - 114.71860842032127, - 114.61964933108011 + 112.98106218312499, + 112.64778912905899, + 114.74591804100635, + 114.66711046089802 ], "moduleForcesY": [ - -23.006176875829937, - -24.55462377070611, - -12.640293814526908, - -13.473735738920114 + -23.491323485598002, + -25.015409413102297, + -12.2368225134811, + -12.903529067142655 ], - "timestamp": 3.255097971863442 + "timestamp": 3.3619410988071596 }, { - "x": 9.29222001122731, - "y": 7.406304055209759, - "heading": -0.03377768545568418, - "angularVelocity": -0.2516280472079336, - "velocityX": 1.4331043862036081, - "velocityY": -0.23196648859841448, + "x": 9.452343907652057, + "y": 7.38039364196082, + "heading": -0.06769375321072268, + "angularVelocity": -0.39406697724878365, + "velocityX": 2.0576027033456232, + "velocityY": -0.3330260078166348, "moduleForcesX": [ - 113.0694204236125, - 112.7779690278557, - 114.69165035279205, - 114.61288648897437 + 112.9386256400279, + 112.67062512533334, + 114.69841226670894, + 114.65047328808508 ], "moduleForcesY": [ - -23.075208455820306, - -24.43716999398038, - -12.759685477746057, - -13.405832230605759 + -23.578915171806088, + -24.794121720549402, + -12.457213413083553, + -12.82374562009901 ], - "timestamp": 3.344515238590932 + "timestamp": 3.4475569144520035 }, { - "x": 9.484420777015211, - "y": 7.375190745931852, - "heading": -0.06740746126447136, - "angularVelocity": -0.37609934903599723, - "velocityX": 2.1494815578925746, - "velocityY": -0.3479563893708387, + "x": 9.687197586383895, + "y": 7.342376469148144, + "heading": -0.11226638905729562, + "angularVelocity": -0.5206121732399493, + "velocityX": 2.743110918969357, + "velocityY": -0.44404380810177685, "moduleForcesX": [ - 113.02648757078286, - 112.79182810566901, - 114.64860236410797, - 114.59937186585587 + 112.87896079459628, + 112.69640034788527, + 114.61328861565241, + 114.60352473160059 ], "moduleForcesY": [ - -23.171552214300505, - -24.2575926575561, - -12.939705956083847, - -13.311740761370503 + -23.631898261793967, + -24.43715365857457, + -12.797480453077931, + -12.786890952496725 ], - "timestamp": 3.4339325053184218 + "timestamp": 3.5331727300968474 }, { - "x": 9.740654140944983, - "y": 7.333706777922525, - "heading": -0.11195989555510154, - "angularVelocity": -0.4982531441763822, - "velocityX": 2.8655915496799285, - "velocityY": -0.4639368829708782, + "x": 9.980677153153964, + "y": 7.294861028140363, + "heading": -0.16677637741321044, + "angularVelocity": -0.6366812947509158, + "velocityX": 3.4278662716652395, + "velocityY": -0.5549843875211934, "moduleForcesX": [ - 112.96263341798881, - 112.8024310121022, - 114.57186680035291, - 114.55963723401477 + 112.77901668126034, + 112.69725731706323, + 114.39506493358313, + 114.4213577102299 ], "moduleForcesY": [ - -23.25555865139767, - -23.974881093119578, - -13.211149123897183, - -13.233026976268087 + -23.40728121770182, + -23.70138914183569, + -13.446589360294247, + -13.046932352219967 ], - "timestamp": 3.5233497720459117 + "timestamp": 3.6187885457416913 }, { - "x": 10.060848676971931, - "y": 7.281860220949749, - "heading": -0.16679543077391148, - "angularVelocity": -0.6132544331278634, - "velocityX": 3.580902746700832, - "velocityY": -0.5798271281405271, + "x": 10.299439397239984, + "y": 7.243222544857861, + "heading": -0.16680362160119563, + "angularVelocity": -0.00031821443012600435, + "velocityX": 3.723170090539417, + "velocityY": -0.6031418715522293, "moduleForcesX": [ - 112.84129933826836, - 112.76864885600135, - 114.3772823040652, - 114.40191731519991 + 42.223193429450774, + 62.56452184359159, + 34.743970358798585, + 56.38407855591621 ], "moduleForcesY": [ - -23.163205809397628, - -23.425697611861274, - -13.69531288022575, - -13.333070778392425 + 16.217064048220223, + 8.77165872965158, + -28.615859678623103, + -28.322366228837797 ], - "timestamp": 3.6127670387734017 + "timestamp": 3.704404361386535 }, { - "x": 10.41129384334292, - "y": 7.2250876773172195, - "heading": -0.1668212421294265, - "angularVelocity": -0.0002886618710195688, - "velocityX": 3.9192113469427756, - "velocityY": -0.6349170099948512, + "x": 10.618201967925774, + "y": 7.191583190738454, + "heading": -0.16683012378420822, + "angularVelocity": -0.0003095477490107596, + "velocityX": 3.723173905252498, + "velocityY": -0.60315204300127, "moduleForcesX": [ - 48.09172614407473, - 65.77795724959624, - 41.06473783405297, - 59.97030443873925 + 0.0004897050109594019, + 0.0008590684186937887, + 0.00040634585315998815, + 0.0007757061947028893 ], "moduleForcesY": [ - 13.930551075122137, - 7.145486045502102, - -28.297723373409983, - -27.773214670319934 + -0.001408166713429625, + -0.0014702823341160227, + -0.0019037711048343804, + -0.001965905284357917 ], - "timestamp": 3.7021843055008916 + "timestamp": 3.790020177031379 }, { - "x": 10.761739409451776, - "y": 7.168314324053237, - "heading": -0.16684631379631512, - "angularVelocity": -0.00028038954674184204, - "velocityX": 3.9192158174201577, - "velocityY": -0.6349260645262742, + "x": 10.936964535235408, + "y": 7.139943815739948, + "heading": -0.16685662595604722, + "angularVelocity": -0.0003095476185024568, + "velocityX": 3.7231738658186835, + "velocityY": -0.6031522868709133, "moduleForcesX": [ - 0.0005793240121072635, - 0.0009168544852833605, - 0.0005030425526133945, - 0.0008405728974754847 + -0.0000065426488173444, + -0.000006537391676682717, + -0.000006543595223207877, + -0.0000065382539258484816 ], "moduleForcesY": [ - -0.0011830360653050716, - -0.0012398789775864547, - -0.0016359884022599947, - -0.001692832071165764 + -0.00004044379525409588, + -0.000040444633841499524, + -0.00004045179634633909, + -0.000040452153945866205 ], - "timestamp": 3.7916015722283816 + "timestamp": 3.875635992676223 }, { - "x": 11.112184972267482, - "y": 7.111540950421515, - "heading": -0.16687138545298627, - "angularVelocity": -0.00028038943247455934, - "velocityX": 3.9192157805911356, - "velocityY": -0.6349262923093676, + "x": 11.255727102089605, + "y": 7.088304437930091, + "heading": -0.1668831281242396, + "angularVelocity": -0.0003095475759096733, + "velocityX": 3.7231738604991516, + "velocityY": -0.6031523197077259, "moduleForcesX": [ - -0.000005850554579745332, - -0.000005845897104160572, - -0.000005851605075096937, - -0.000005846946542409484 + -8.829967596549955e-7, + -8.811818122884496e-7, + -8.83407730166138e-7, + -8.815927827995014e-7 ], "moduleForcesY": [ - -0.000036170301490425664, - -0.00003617108561777815, - -0.0000361765653900908, - -0.00003617734391211807 + -0.000005444926099204542, + -0.000005445232343639541, + -0.000005447361702145372, + -0.000005447667946580389 ], - "timestamp": 3.8810188389558715 + "timestamp": 3.961251808321067 }, { - "x": 11.462630522276916, - "y": 7.054767497780465, - "heading": -0.16689645711343162, - "angularVelocity": -0.00028038947468350146, - "velocityX": 3.9192156373718943, - "velocityY": -0.6349271759119326, + "x": 11.574489654914423, + "y": 7.03666497355743, + "heading": -0.16690963029636716, + "angularVelocity": -0.0003095476218725492, + "velocityX": 3.723173696634823, + "velocityY": -0.6031533307686342, "moduleForcesX": [ - -0.000022743718365883173, - -0.000022745437083135405, - -0.000022743343544297057, - -0.000022745063428281636 + -0.000027178077701561358, + -0.000027179633990853534, + -0.000027177224588690765, + -0.00002717888034638878 ], "moduleForcesY": [ - -0.0001403246359939683, - -0.00014032435530360055, - -0.00014032231584433397, - -0.00014032204068779427 + -0.00016769583752692974, + -0.00016769506176135174, + -0.00016769279541623932, + -0.00016769249521777092 ], - "timestamp": 3.9704361056833615 + "timestamp": 4.046867623965911 }, { - "x": 11.813075052865031, - "y": 6.997991026251115, - "heading": -0.1669222646722176, - "angularVelocity": -0.0002886194102157951, - "velocityX": 3.919204236650811, - "velocityY": -0.6349609377166883, + "x": 11.89325121567058, + "y": 6.985022268597528, + "heading": -0.16693687038180605, + "angularVelocity": -0.00031816651203696647, + "velocityX": 3.7231621091885887, + "velocityY": -0.6031911811029123, "moduleForcesX": [ - -0.0016805912310601232, - -0.0020163880861174925, - -0.0016046680941889473, - -0.0019404647758239804 + -0.001779708571581063, + -0.002147028456388743, + -0.001696749596509706, + -0.002064065106765412 ], "moduleForcesY": [ - -0.00561525265620871, - -0.00555867675995663, - -0.0051646268094223844, - -0.005108050168229615 + -0.006555181384699155, + -0.006493363428438249, + -0.006062320028938968, + -0.006000483846621922 ], - "timestamp": 4.059853372410852 + "timestamp": 4.132483439610755 }, { - "x": 12.133260147509837, - "y": 6.946071670476197, - "heading": -0.2214120834435135, - "angularVelocity": -0.6093881055138954, - "velocityX": 3.5807971587926977, - "velocityY": -0.5806412751705889, + "x": 12.18672005263425, + "y": 6.937424176402156, + "heading": -0.2210923200647369, + "angularVelocity": -0.6325402529315551, + "velocityX": 3.427740946614994, + "velocityY": -0.5559497604136832, "moduleForcesX": [ - -48.98536673051253, - -66.16678250893118, - -40.57967406296097, - -59.23545857774057 + -43.253472476542086, + -63.00675890235155, + -34.1682886774338, + -55.5650943963929 ], "moduleForcesY": [ - -14.49226605581401, - -6.32104906707722, - 27.138034597036604, - 28.180912866906336 + -16.812254107810563, + -7.912658283060262, + 27.348618818937386, + 28.718045503658878 ], - "timestamp": 4.149270639138342 + "timestamp": 4.2180992552555985 }, { - "x": 12.389484680735665, - "y": 6.904520503456371, - "heading": -0.26566908147622087, - "angularVelocity": -0.494949126185951, - "velocityX": 2.8654927913050736, - "velocityY": -0.46468840460599237, + "x": 12.42156370881826, + "y": 6.899331547752736, + "heading": -0.2653717816908411, + "angularVelocity": -0.5171878734390234, + "velocityX": 2.7429938547592765, + "velocityY": -0.4449251386851015, "moduleForcesX": [ - -112.7694787816175, - -112.84469963183767, - -114.33052227126576, - -114.44010878513953 + -112.70336730639953, + -112.77868429037684, + -114.34574505410617, + -114.45941943627881 ], "moduleForcesY": [ - 23.504795933148486, - 23.05021971834787, - 14.088814392674252, - 13.013238741851007 + 23.762739676331556, + 23.303963933906203, + 13.868946571317782, + 12.722298748930942 ], - "timestamp": 4.238687905865832 + "timestamp": 4.303715070900442 }, { - "x": 12.581677956353516, - "y": 6.873351406790412, - "heading": -0.2990847660317501, - "angularVelocity": -0.37370505472245713, - "velocityX": 2.1493977914085036, - "velocityY": -0.34858028887139747, + "x": 12.597718540040942, + "y": 6.8707567698528536, + "heading": -0.29890040217417135, + "angularVelocity": -0.39161713558176675, + "velocityX": 2.057503393454997, + "velocityY": -0.33375583336632164, "moduleForcesX": [ - -112.81581362288203, - -112.95645164652021, - -114.4800037317309, - -114.63477612228742 + -112.71749084303553, + -112.86515330511084, + -114.51664915991034, + -114.6811022921368 ], "moduleForcesY": [ - 23.952236268957105, - 23.23198064868569, - 13.993453486124862, - 12.578015209156012 + 24.3844752316013, + 23.638347947621615, + 13.64501010429044, + 12.086104233396249 ], - "timestamp": 4.328105172593322 + "timestamp": 4.389330886545286 }, { - "x": 12.70981674564107, - "y": 6.85256977540764, - "heading": -0.32145862582537077, - "angularVelocity": -0.25021856082682203, - "velocityX": 1.433043012576884, - "velocityY": -0.23241183882421468, + "x": 12.715163878739139, + "y": 6.851704848123817, + "heading": -0.32138821070438484, + "angularVelocity": -0.26265951402599025, + "velocityX": 1.3717715332572546, + "velocityY": -0.22252806430143826, "moduleForcesX": [ - -112.82068889216025, - -113.0039471018814, - -114.52336848119276, - -114.70406075329403 + -112.70949942311833, + -112.90541799785672, + -114.56628411956218, + -114.75934724991008 ], "moduleForcesY": [ - 24.148746420326255, - 23.24343434131617, - 14.012855946804562, - 12.388975239916268 + 24.64547404232941, + 23.69527448754719, + 13.628136423288359, + 11.823839632394252 ], - "timestamp": 4.417522439320812 + "timestamp": 4.47494670219013 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -0.12555956863634032, - "velocityX": 0.7165595452629516, - "velocityY": -0.11621279716307112, + "angularVelocity": -0.13195702773884246, + "velocityX": 0.6859207314037198, + "velocityY": -0.11127036897917744, "moduleForcesX": [ - -112.8221827849924, - -113.02767779062647, - -114.54498863487578, - -114.73896316536626 + -112.70422548752346, + -112.925655713762, + -114.59090344176342, + -114.79867455728487 ], "moduleForcesY": [ - 24.250854636389008, - 23.249516784409256, - 14.022523907560226, - 12.290549417164618 + 24.780696781270144, + 23.723484974899865, + 13.620484396497059, + 11.687912648139795 ], - "timestamp": 4.506939706048302 + "timestamp": 4.560562517834974 }, { "x": 12.773889541625977, "y": 6.8421783447265625, "heading": -0.33268581926431506, - "angularVelocity": -6.396298753724966e-21, - "velocityX": 2.2882522060511837e-20, - "velocityY": -2.4594541543729887e-20, + "angularVelocity": -1.0481075996790548e-19, + "velocityX": 5.399599322710278e-19, + "velocityY": -9.80243210157971e-19, "moduleForcesX": [ - -112.82700125465155, - -113.0347603386625, - -114.5621659937604, - -114.75821199877026 + -112.7054623515789, + -112.92977017260733, + -114.61013224495392, + -114.8204883495519 ], "moduleForcesY": [ - 24.293809761632847, - 23.288094379310174, - 13.993645143555229, - 12.246633407284664 + 24.84159448258286, + 23.778744232903236, + 13.5778974907208, + 11.622750779733966 ], - "timestamp": 4.596356972775792 + "timestamp": 4.646178333479818 }, { - "x": 12.75399450349522, - "y": 6.841766146112416, - "heading": -0.305766058140526, - "angularVelocity": 0.5268296966780065, - "velocityX": -0.3893532656410479, - "velocityY": -0.008066879563426856, + "x": 12.753385587015702, + "y": 6.841782127477455, + "heading": -0.30142200681603537, + "angularVelocity": 0.5981564744362009, + "velocityX": -0.39229294961925354, + "velocityY": -0.00758064657775971, "moduleForcesX": [ - -109.7288300984058, - -109.4206374282859, - -112.53880632418142, - -101.12162507107456 + -108.8413082444939, + -107.42080956929516, + -112.04459817860715, + -98.01523216314021 ], "moduleForcesY": [ - 35.669533302226604, - 36.387074666689884, - -25.504590588279502, - -55.51926033598724 + 38.29718260293832, + 41.90465414683766, + -27.603083990034282, + -60.83697376383006 ], - "timestamp": 4.647454625952017 + "timestamp": 4.69844527998031 }, { - "x": 12.714061656462052, - "y": 6.840779251207409, - "heading": -0.2532975989930795, - "angularVelocity": 1.0268271806239895, - "velocityX": -0.7815006081678176, - "velocityY": -0.019313898851738565, + "x": 12.712181951373154, + "y": 6.840743713694041, + "heading": -0.24058628304443966, + "angularVelocity": 1.1639425649444288, + "velocityX": -0.7883306449165999, + "velocityY": -0.019867504281806173, "moduleForcesX": [ - -110.81993188505729, - -110.0950661211093, - -112.36550007471497, - -102.63533121639855 + -110.25146907706204, + -108.49838326382822, + -111.77509833383621, + -99.86657679489407 ], "moduleForcesY": [ - 32.07800706429278, - 34.2533713879541, - -26.203707120752757, - -52.6299968823863 + 33.98129300971091, + 38.992548405352025, + -28.619699977126256, + -57.706808413427645 ], - "timestamp": 4.698552279128243 + "timestamp": 4.750712226480801 }, { - "x": 12.65392586500865, - "y": 6.839035138240057, - "heading": -0.1770515773993922, - "angularVelocity": 1.4921628852646045, - "velocityX": -1.1768797139470222, - "velocityY": -0.03413293681682431, + "x": 12.650044214892105, + "y": 6.8387849883626215, + "heading": -0.1525027567272929, + "angularVelocity": 1.6852625266011638, + "velocityX": -1.1888533890238768, + "velocityY": -0.037475411566368036, "moduleForcesX": [ - -112.01913727447982, - -110.82018043359403, - -112.13805673866041, - -104.53092279690576 + -111.79514898339704, + -109.70138251498295, + -111.44106852220095, + -102.32802663455409 ], "moduleForcesY": [ - 27.537215204389696, - 31.77880633104241, - -27.08883274674824, - -48.700214418067695 + 28.423757447065572, + 35.415890676664, + -29.81768363836112, + -53.15724933762533 ], - "timestamp": 4.749649932304468 + "timestamp": 4.802979172981293 }, { - "x": 12.573375826882684, - "y": 6.836347748309206, - "heading": -0.07973620783654102, - "angularVelocity": 1.9044978294253423, - "velocityX": -1.5763940830739311, - "velocityY": -0.05259321639650792, + "x": 12.56665849968872, + "y": 6.835624849307061, + "heading": -0.041001428555590726, + "angularVelocity": 2.1333048061388658, + "velocityX": -1.5953814176348047, + "velocityY": -0.060461520466354446, "moduleForcesX": [ - -113.23819484894514, - -111.82728548746545, - -112.00948759102613, - -107.03013912743917 + -113.33306294894338, + -111.36765197462111, + -111.29923323362245, + -105.79188446547711 ], "moduleForcesY": [ - 21.882075353027112, - 27.953507157746554, - -27.513403358833262, - -42.84285393246143 + 21.344964061000436, + 29.67677517374125, + -30.226858179680615, + -45.774893406209785 ], - "timestamp": 4.800747585480694 + "timestamp": 4.855246119481785 }, { - "x": 12.472142423483454, - "y": 6.832556869927306, - "heading": 0.0343228381313417, - "angularVelocity": 2.2321777787820345, - "velocityX": -1.9811752029020766, - "velocityY": -0.07418889413231182, + "x": 12.461620097191034, + "y": 6.831026292095148, + "heading": 0.08742245485977619, + "angularVelocity": 2.4570764510637413, + "velocityX": -2.009652553487107, + "velocityY": -0.08798212866492651, "moduleForcesX": [ - -114.34728768901107, - -113.22575760455813, - -112.26817875434023, - -110.11846813519524 + -114.6447825791982, + -113.5383273084868, + -111.87702649396596, + -110.14647037122361 ], "moduleForcesY": [ - 14.79403533609548, - 21.457523434245793, - -26.272584682099957, - -33.98499618387014 + 12.088459054314818, + 19.59915376642277, + -27.79947446244152, + -33.7959899091021 ], - "timestamp": 4.851845238656919 + "timestamp": 4.907513065982276 }, { - "x": 12.34992963494983, - "y": 6.827548067939446, - "heading": 0.15826458263637594, - "angularVelocity": 2.4255858498546536, - "velocityX": -2.3917495410628016, - "velocityY": -0.09802411023818115, + "x": 12.334544332063512, + "y": 6.824790196070031, + "heading": 0.22169906935297032, + "angularVelocity": 2.5690541247120793, + "velocityX": -2.4312835096712537, + "velocityY": -0.11931242291082081, "moduleForcesX": [ - -115.11333345954517, - -114.74574741924968, - -113.34482631497849, - -113.1955980388714 + -115.17279654304959, + -115.14891953151032, + -113.8889949915641, + -113.99413512743355 ], "moduleForcesY": [ - 5.448077962340946, - 10.194849320269142, - -20.799257564932656, - -21.339190325625058 + -1.6355007974511553, + 1.0232280605865918, + -17.189766351140257, + -16.24596532339107 ], - "timestamp": 4.902942891833145 + "timestamp": 4.959780012482768 }, { - "x": 12.206597161799994, - "y": 6.821199257095827, - "heading": 0.2805699285354723, - "angularVelocity": 2.393560922989729, - "velocityX": -2.805069592051702, - "velocityY": -0.12424857990490915, + "x": 12.185948955691865, + "y": 6.816459874974, + "heading": 0.33880653198690125, + "angularVelocity": 2.2405644575550046, + "velocityX": -2.8430085612566742, + "velocityY": -0.15938029010259208, "moduleForcesX": [ - -114.73378991745247, - -114.6841205049078, - -115.02985196430274, - -115.00391113761037 + -109.76726168084946, + -109.54277500123322, + -113.18437639744384, + -114.94525226928013 ], "moduleForcesY": [ - -9.331880356810258, - -10.050186347462049, - -4.453466685132893, - -5.315910986053548 + -33.87003877484263, + -35.13851211848978, + 20.071079184942906, + 5.393963684061636 ], - "timestamp": 4.95404054500937 + "timestamp": 5.01204695898326 }, { - "x": 12.043550195136016, - "y": 6.812872270792408, - "heading": 0.37568052330999124, - "angularVelocity": 1.8613495701358527, - "velocityX": -3.1908895326691793, - "velocityY": -0.16296220639921025, + "x": 12.018989253325442, + "y": 6.8051390333200885, + "heading": 0.41041046526758185, + "angularVelocity": 1.3699658785310278, + "velocityX": -3.194364958069012, + "velocityY": -0.21659657607496546, "moduleForcesX": [ - -102.79608932766197, - -104.86344163188949, - -106.89092371318497, - -114.33175651351912 + -78.10169132485171, + -96.13389774106385, + -94.13325434178383, + -113.46555797863145 ], "moduleForcesY": [ - -50.77985160422074, - -47.216095581596974, - 42.06566908876746, - 12.895732740628755 + -83.01049814576065, + -62.80652414189374, + 65.38310369002106, + 18.254472024247004 ], - "timestamp": 5.005138198185596 + "timestamp": 5.064313905483751 }, { - "x": 11.86287182736092, - "y": 6.802007556416456, - "heading": 0.42796486587483507, - "angularVelocity": 1.0232239509028977, - "velocityX": -3.5359425833505957, - "velocityY": -0.21262648479142307, + "x": 11.833657880476915, + "y": 6.7914137455253085, + "heading": 0.4377864800344317, + "angularVelocity": 0.5237729884716399, + "velocityX": -3.5458618736562415, + "velocityY": -0.26259976359377907, "moduleForcesX": [ - -80.87009063485023, - -96.67728867515605, - -92.79877473998546, - -113.21907877847823 + -81.50657246245372, + -96.52600367181357, + -91.36526851275521, + -112.58926465292839 ], "moduleForcesY": [ - -79.97059189776519, - -61.82807121867147, - 67.16099978368727, - 19.43023807698715 + -77.03852162154085, + -60.91221738822319, + 67.84251293202183, + 20.114545224135288 ], - "timestamp": 5.056235851361821 + "timestamp": 5.116580851984243 }, { - "x": 11.664633065712652, - "y": 6.7891315300219, - "heading": 0.43821140426349137, - "angularVelocity": 0.20052855173833478, - "velocityX": -3.8796059960832747, - "velocityY": -0.25198860601576917, + "x": 11.636885911361938, + "y": 6.781657287742647, + "heading": 0.4381195657454411, + "angularVelocity": 0.0063727792287653654, + "velocityX": -3.764749660918859, + "velocityY": -0.18666592245960945, "moduleForcesX": [ - -82.8099099991411, - -97.03131746492355, - -89.98282568718102, - -112.19644097022719 + -39.57182354200839, + -70.977437875031, + -50.32863077942037, + -76.99706320058098 ], "moduleForcesY": [ - -74.87714839288478, - -59.775887106560354, - 69.37126688318338, - 21.526348508475152 + 6.664753543230538, + -15.9657457537299, + 58.329975351840964, + 33.49165128421014 ], - "timestamp": 5.107333504538047 + "timestamp": 5.168847798484735 }, { - "x": 11.462084020525632, - "y": 6.780072353267369, - "heading": 0.4385154377916661, - "angularVelocity": 0.00595004876498203, - "velocityX": -3.9639598415305968, - "velocityY": -0.1772914447418647, + "x": 11.44006845734196, + "y": 6.772736369563235, + "heading": 0.43843743025567056, + "angularVelocity": 0.006081558834253376, + "velocityX": -3.7656199031658693, + "velocityY": -0.1706799187000424, "moduleForcesX": [ - -13.088021988665616, - -26.977283498936934, - -20.501105728823166, - -33.202365222684826 + -0.22117703166854616, + -0.2400226961394301, + -0.23285423489332768, + -0.25167644227536323 ], "moduleForcesY": [ - 15.885560108854344, - 8.723342744728185, - 32.68451149483246, - 25.740872695475744 + 4.334916585446057, + 4.326391928789567, + 4.359954585223913, + 4.351428080985648 ], - "timestamp": 5.158431157714272 + "timestamp": 5.221114744985226 }, { - "x": 11.259528982095853, - "y": 6.771117377305431, - "heading": 0.43881605165352044, - "angularVelocity": 0.005883124628398257, - "velocityX": -3.964077131511387, - "velocityY": -0.17525219663325328, + "x": 11.243256268673136, + "y": 6.763700701720559, + "heading": 0.4387554337586175, + "angularVelocity": 0.006084218119455662, + "velocityX": -3.7655191635688174, + "velocityY": -0.17287537244203355, "moduleForcesX": [ - -0.029013194122842832, - -0.033411893880355564, - -0.03177958055818728, - -0.036176322713582246 + 0.027246197185640832, + 0.027387868108118486, + 0.027350411158643794, + 0.02749366051981494 ], "moduleForcesY": [ - 0.5648011109503727, - 0.5627467701499554, - 0.5706799263120281, - 0.5686255765235023 + -0.5963956352276373, + -0.5963054368452669, + -0.5966429834962519, + -0.59655178395572 ], - "timestamp": 5.209528810890498 + "timestamp": 5.273381691485718 }, { - "x": 11.057156198653269, - "y": 6.758726217540709, - "heading": 0.4391223685729557, - "angularVelocity": 0.005994735577754182, - "velocityX": -3.960510333902073, - "velocityY": -0.24249958646803477, + "x": 11.046545630444271, + "y": 6.752686472005722, + "heading": 0.43907714703071105, + "angularVelocity": 0.006155195465465934, + "velocityX": -3.7635762446351886, + "velocityY": -0.2107303076283464, "moduleForcesX": [ - 0.9850808010020188, - 0.9926378040046129, - 0.9898104285367836, - 0.9973672418755148 + 0.5239825346725352, + 0.5287852184841983, + 0.5269382194510348, + 0.5317492184600278 ], "moduleForcesY": [ - -18.685150756065987, - -18.681766202326127, - -18.694748257197254, - -18.691363885723828 + -10.28276906511369, + -10.280662894429112, + -10.28864362114341, + -10.286542208886416 ], - "timestamp": 5.260626464066723 + "timestamp": 5.32564863798621 }, { - "x": 10.856270538125138, - "y": 6.731334695007788, - "heading": 0.439461064317222, - "angularVelocity": 0.006628401173301292, - "velocityX": -3.9314067876134358, - "velocityY": -0.5360622422022665, + "x": 10.851002317831199, + "y": 6.728677589687026, + "heading": 0.4394302072073043, + "angularVelocity": 0.006754941702782354, + "velocityX": -3.7412423281936964, + "velocityY": -0.4593511564422143, "moduleForcesX": [ - 8.032996251393905, - 8.10506598626941, - 8.070890615781677, - 8.142908653908856 + 6.0235300238737315, + 6.080411522594157, + 6.055226639619957, + 6.112078025502511 ], "moduleForcesY": [ - -81.57543466978522, - -81.55969024172876, - -81.60424655492223, - -81.58850238971223 + -67.53691218233139, + -67.52145044143396, + -67.57213537559059, + -67.55667901028482 ], - "timestamp": 5.311724117242949 + "timestamp": 5.3779155844867015 }, { "x": 10.659042358398438, "y": 6.684422969818115, "heading": 0.4398426718598864, - "angularVelocity": 0.007468200963130881, - "velocityX": -3.859828533543358, - "velocityY": -0.9180798387722997, + "angularVelocity": 0.007891500847063856, + "velocityX": -3.6726836420596647, + "velocityY": -0.8467037550871565, "moduleForcesX": [ - 19.797209295771516, - 19.935633669547133, - 19.84811263846736, - 19.986315671242973 + 18.502266587341634, + 18.68181883852657, + 18.57123057302974, + 18.75041412959953 ], "moduleForcesY": [ - -106.1764049578853, - -106.14800306857407, - -106.17974187192408, - -106.15132868263454 + -105.25254288064538, + -105.21692402603102, + -105.25961417671951, + -105.22397106219512 ], - "timestamp": 5.362821770419174 + "timestamp": 5.430182530987193 }, { - "x": 10.544019823742392, - "y": 6.649741816530494, - "heading": 0.43765692306832477, - "angularVelocity": -0.07178828851456667, - "velocityX": -3.7777767213885807, - "velocityY": -1.1390607410335976, + "x": 10.544035049630981, + "y": 6.649793265438035, + "heading": 0.4376694651514174, + "angularVelocity": -0.06782792164292281, + "velocityX": -3.5894913709978917, + "velocityY": -1.0808271785950743, "moduleForcesX": [ - 49.61097001099647, - 29.960020675030893, - 49.810683980327475, - 23.69035732916015 + 47.53506576758568, + 29.333765309885795, + 47.10755646583849, + 23.50756589105131 ], "moduleForcesY": [ - -99.62262552981636, - -107.24025708495017, - -97.95156957526038, - -107.4372074994834 + -100.61864430851121, + -107.4084137041551, + -99.4198469130243, + -107.60905700250359 ], - "timestamp": 5.393268920459785 + "timestamp": 5.462222532447208 }, { - "x": 10.43174307337387, - "y": 6.608629575449158, - "heading": 0.4335563624753091, - "angularVelocity": -0.13467797766116807, - "velocityX": -3.687594741010725, - "velocityY": -1.3502820798170498, + "x": 10.432043306335318, + "y": 6.608067008873336, + "heading": 0.43347817669732147, + "angularVelocity": -0.13081424042150525, + "velocityX": -3.4953726027566367, + "velocityY": -1.3023175612706317, "moduleForcesX": [ - 50.47238680977663, - 35.09011732252253, - 50.89792921334029, - 31.77886111111452 + 49.756367759871594, + 35.106461239154875, + 49.99578261370558, + 31.995927341800396 ], "moduleForcesY": [ - -95.93088215086546, - -102.59136541098549, - -93.68871350341784, - -101.83371240771545 + -95.75188215465406, + -102.069745623008, + -93.60026996740459, + -101.23810381235339 ], - "timestamp": 5.4237160705003955 + "timestamp": 5.494262533907222 }, { - "x": 10.322457917154331, - "y": 6.561748076363306, - "heading": 0.42703446728967825, - "angularVelocity": -0.2142037982843, - "velocityX": -3.589339431564968, - "velocityY": -1.5397664156848374, + "x": 10.323383938634551, + "y": 6.560219585431149, + "heading": 0.42637679727464484, + "angularVelocity": -0.22164104553923633, + "velocityX": -3.39136587856971, + "velocityY": -1.4933652079236626, "moduleForcesX": [ - 54.54451585503099, - 37.80311413224697, - 56.068371436953264, - 34.884519018136295 + 55.05567925117758, + 37.86533543157213, + 56.65721776322309, + 34.80575744961734 ], "moduleForcesY": [ - -86.38037479041058, - -94.79851130258069, - -80.69537934854387, - -91.61886969958681 + -83.0438884795672, + -91.96968065788715, + -75.97006732019702, + -87.70722824777432 ], - "timestamp": 5.454163220541006 + "timestamp": 5.526302535367237 }, { - "x": 10.215423792334374, - "y": 6.510355295341807, - "heading": 0.41995401673996147, - "angularVelocity": -0.23254887699744417, - "velocityX": -3.515407014357416, - "velocityY": -1.6879340415424797, + "x": 10.216545636110244, + "y": 6.508277508435219, + "heading": 0.4196471967806787, + "angularVelocity": -0.21003745902962243, + "velocityX": -3.334528640943329, + "velocityY": -1.6211633779352665, "moduleForcesX": [ - 36.442468575381426, - 33.174927914274654, - 35.8528195340503, - 32.45465163128756 + 24.038621985218352, + 25.77272071949514, + 24.62367588838952, + 26.32651129956415 ], "moduleForcesY": [ - -69.21668807394214, - -70.77919539967725, - -67.39520207920303, - -69.02352334329365 + -56.390122550390586, + -55.61754417494375, + -57.656326035557406, + -56.89767113448526 ], - "timestamp": 5.484610370581617 + "timestamp": 5.558342536827252 }, { - "x": 10.109265668494423, - "y": 6.456274689185196, - "heading": 0.41438013914701705, - "angularVelocity": -0.18306730138977947, - "velocityX": -3.486635816434527, - "velocityY": -1.776212423313201, + "x": 10.110214948281255, + "y": 6.454517230975398, + "heading": 0.4141905501156165, + "angularVelocity": -0.17030731636737448, + "velocityX": -3.3186854863808724, + "velocityY": -1.677911205057923, "moduleForcesX": [ - 8.471205328468896, - 15.23866932736421, - 11.77361519881396, - 18.190714448046055 + 3.5123356730005804, + 8.059917813162626, + 6.035176967026881, + 10.479446367424668 ], "moduleForcesY": [ - -39.299918406604114, - -36.510563952245334, - -45.75459276690234, - -43.12295459661491 + -23.417268009154352, + -21.484740623999084, + -28.788257649111483, + -26.912755922055677 ], - "timestamp": 5.515057520622228 + "timestamp": 5.590382538287266 }, { - "x": 10.003524317388626, - "y": 6.400874064288048, - "heading": 0.4096367853957852, - "angularVelocity": -0.15578974534250664, - "velocityX": -3.4729474175663793, - "velocityY": -1.8195668502061122, + "x": 10.004109121840859, + "y": 6.3999345000371175, + "heading": 0.4093478527591147, + "angularVelocity": -0.15114535380235383, + "velocityX": -3.3116673409891164, + "velocityY": -1.7035807881104348, "moduleForcesX": [ - 3.9042382491596532, - 7.105966453517206, - 5.683970643639738, - 8.842262844225818 + 1.487894997911832, + 3.5515928558607346, + 2.674373241969133, + 4.727965710328632 ], "moduleForcesY": [ - -18.918192324174065, - -17.55122761626256, - -22.8772581877901, - -21.53331764786267 + -10.470814273459197, + -9.58171840845681, + -13.16887634219489, + -12.285842350063524 ], - "timestamp": 5.545504670662838 + "timestamp": 5.622422539747281 }, { "x": 9.898398399353027, "y": 6.344369888305664, "heading": 0.40489200306154377, - "angularVelocity": -0.15583666543215785, - "velocityX": -3.45273425904824, - "velocityY": -1.8558116574791457, + "angularVelocity": -0.13907145738216475, + "velocityX": -3.299335757514504, + "velocityY": -1.7342262546637257, "moduleForcesX": [ - 9.431345346606545, - 9.425930347002394, - 9.428431462071497, - 9.423018174876928 + 4.444919794866705, + 5.756082971948941, + 5.177358266597356, + 6.483173214059894 ], "moduleForcesY": [ - -16.906432080263507, - -16.908789517761008, - -16.8995214585308, - -16.90187811085413 + -13.01289673438949, + -12.451995720736903, + -14.711065470774846, + -14.152581305403867 ], - "timestamp": 5.575951820703449 + "timestamp": 5.6544625412072955 }, { - "x": 9.670246530984475, - "y": 6.195179516897854, - "heading": 0.4012737715516626, - "angularVelocity": -0.04837328675412599, - "velocityX": -3.050234823819816, - "velocityY": -1.9945734808167912, + "x": 9.670268652542475, + "y": 6.195147686170206, + "heading": 0.40147320180126633, + "angularVelocity": -0.04570696870230372, + "velocityX": -3.04993429091239, + "velocityY": -1.9949959074662753, "moduleForcesX": [ - 74.77834883929572, - 78.31714320835279, - 74.46722774433924, - 78.09040380789128 + 44.35336751964116, + 49.84791066719054, + 44.98425405334999, + 50.206578864953734 ], "moduleForcesY": [ - -24.40515766450398, - -20.14008207645028, - -32.569084988593396, - -28.259698256337934 + -48.756394596706954, + -45.107327355028076, + -53.79518756589766, + -50.36604891302273 ], - "timestamp": 5.65074995315767 + "timestamp": 5.729260790956576 }, { - "x": 9.4801504252691, - "y": 6.070649750515126, - "heading": 0.39828552067975415, - "angularVelocity": -0.039950875427770885, - "velocityX": -2.5414552406334514, - "velocityY": -1.6648780162919794, + "x": 9.480173271877787, + "y": 6.070616528520398, + "heading": 0.39849121405650767, + "angularVelocity": -0.039867079173030166, + "velocityX": -2.541441561826215, + "velocityY": -1.6648940057719865, "moduleForcesX": [ - 96.32186712116838, - 96.38792598998765, - 96.79419017964749, - 96.85697827552185 + 96.3494121391391, + 96.39508860152752, + 96.67696001450231, + 96.72106180217908 ], "moduleForcesY": [ - 63.00396831226178, - 62.90663890135131, - 62.274968928445375, - 62.18110701001115 + 62.9543807201797, + 62.88707197355149, + 62.44956252680797, + 62.383918224986004 ], - "timestamp": 5.725548085611892 + "timestamp": 5.804059040705856 }, { - "x": 9.32808449174239, - "y": 5.970953271268857, - "heading": 0.39590322000722883, - "angularVelocity": -0.03184973467062609, - "velocityX": -2.0330177844985764, - "velocityY": -1.3328739097501774, + "x": 9.328101551518529, + "y": 5.970928319469064, + "heading": 0.3960566471955998, + "angularVelocity": -0.03254844690976579, + "velocityX": -2.0330919622982955, + "velocityY": -1.3327612529101711, "moduleForcesX": [ - 96.26487658800978, - 96.32997314585457, - 96.7221348425724, - 96.78416991240434 + 96.27315885630196, + 96.33189190207462, + 96.686273793815, + 96.74250734840614 ], "moduleForcesY": [ - 63.427687906728025, - 63.33059042831499, - 62.72773938264778, - 62.633819804313426 + 63.41348692578717, + 63.325874029911354, + 62.78139687764546, + 62.69637660722109 ], - "timestamp": 5.800346218066113 + "timestamp": 5.878857290455136 }, { - "x": 9.214040059471193, - "y": 5.8961477456875455, - "heading": 0.39412002885262637, - "angularVelocity": -0.023840049157562253, - "velocityX": -1.524696252824158, - "velocityY": -1.0000988410652472, + "x": 9.214049861102318, + "y": 5.896133355137771, + "heading": 0.3942081084317932, + "angularVelocity": -0.02471366335446106, + "velocityX": -1.5247908981630351, + "velocityY": -0.9999560762718345, "moduleForcesX": [ - 96.24488535024153, - 96.31011450913444, - 96.69795042437514, - 96.7601725947593 + 96.2464886620466, + 96.31025854518813, + 96.6896674358515, + 96.75056013471918 ], "moduleForcesY": [ - 63.57019718383229, - 63.47252205472779, - 62.87858000727268, - 62.78399745101661 + 63.56717322481581, + 63.47168328918838, + 62.89071925102452, + 62.798188225264994 ], - "timestamp": 5.875144350520334 + "timestamp": 5.953655540204417 }, { - "x": 9.138012769594361, - "y": 5.846262014344345, - "heading": 0.3929327805602388, - "angularVelocity": -0.01587269967086738, - "velocityX": -1.0164329961495118, - "velocityY": -0.6669381935937063, + "x": 9.138016376281193, + "y": 5.84625670461297, + "heading": 0.3929651715340159, + "angularVelocity": -0.016617192273128887, + "velocityX": -1.0165142242764738, + "velocityY": -0.6668157435766093, "moduleForcesX": [ - 96.23467746677126, - 96.30009844719443, - 96.68582788542034, - 96.74826576061236 + 96.23291594154362, + 96.29939278470015, + 96.69137390831771, + 96.75477051723124 ], "moduleForcesY": [ - 63.64170695487282, - 63.54355942757056, - 62.95396491375018, - 62.85886919168339 + 63.64410996343634, + 63.54438360092073, + 62.94517892257058, + 62.84860449412174 ], - "timestamp": 5.9499424829745555 + "timestamp": 6.028453789953697 }, { "x": 9.1, - "y": 5.821313381195068, + "y": 5.821313381195065, "heading": 0.39233969745911407, - "angularVelocity": -0.007929116431986712, - "velocityX": -0.50820479532195, - "velocityY": -0.33354620403852975, + "angularVelocity": -0.008362148539550444, + "velocityX": -0.5082522172460242, + "velocityY": -0.33347469361261933, "moduleForcesX": [ - 96.2285045107745, - 96.29401110747635, - 96.67859802056262, - 96.74113494181448 + 96.22472066349764, + 96.292810190967, + 96.69245071862318, + 96.75733376592395 ], "moduleForcesY": [ - 63.68466012516553, - 63.586276007748886, - 62.99909879542885, - 62.90374389419577 + 63.690259240991296, + 63.58800475764593, + 62.977708646167464, + 62.878726323912026 ], - "timestamp": 6.024740615428777 + "timestamp": 6.103252039702977 }, { "x": 9.1, "y": 5.821313381195068, "heading": 0.39233969745911407, - "angularVelocity": 9.242967284264404e-21, - "velocityX": -5.393065463580557e-21, - "velocityY": -4.6660816363364264e-20, + "angularVelocity": 1.4293258494945315e-19, + "velocityX": -9.48788595009282e-19, + "velocityY": 6.222095483602862e-19, "moduleForcesX": [ - 96.22440473642781, - 96.28984267330931, - 96.67387504230591, - 96.73635227532323 + 96.219277135115, + 96.28830838426227, + 96.69327817490581, + 96.75901741442976 ], "moduleForcesY": [ - 63.713260147549505, - 63.61490939882356, - 63.02902588165876, - 62.93369197756521 + 63.720955818602604, + 63.617216172933794, + 62.99919868599543, + 62.89881547606205 ], - "timestamp": 6.099538747882998 + "timestamp": 6.1780502894522575 }, { - "x": 9.124426408265597, - "y": 5.838158154369932, - "heading": 0.37440374574477503, - "angularVelocity": -0.2948190027369444, - "velocityX": 0.4015047230279816, - "velocityY": 0.2768829503913697, + "x": 9.12606508426789, + "y": 5.8377585148435465, + "heading": 0.37148092735484195, + "angularVelocity": -0.3358803058762973, + "velocityX": 0.41971546897661194, + "velocityY": 0.2648093100607021, "moduleForcesX": [ - 104.6690647215055, - 103.79621548715683, - 86.74486016660066, - 79.6558343319196 + 107.06597038486554, + 106.89549145493712, + 88.60061528259641, + 81.32645261923491 ], "moduleForcesY": [ - 48.576006219936566, - 50.364330112069474, - 76.10242127485564, - 83.46976074034517 + 43.037242158674665, + 43.394757591016905, + 73.93350925841953, + 81.83966143502103 ], - "timestamp": 6.16037591084682 + "timestamp": 6.2401520850602274 }, { - "x": 9.173316821931977, - "y": 5.871875693217713, - "heading": 0.33976042091244324, - "angularVelocity": -0.5694434642347314, - "velocityX": 0.8036274422502436, - "velocityY": 0.5542260224697108, + "x": 9.178251711242993, + "y": 5.870675766257217, + "heading": 0.33123239786143516, + "angularVelocity": -0.6481057286569294, + "velocityX": 0.8403400652783892, + "velocityY": 0.5300531343967613, "moduleForcesX": [ - 104.36224405802564, - 102.97011057048299, - 87.53838797956297, - 80.57222592370948 + 106.81766172551309, + 106.04093622896602, + 89.53141023846203, + 82.33004570732504 ], "moduleForcesY": [ - 49.20246899931035, - 52.0005698939217, - 75.17096632236314, - 82.56810699384471 + 43.6115687458894, + 45.3991721549242, + 72.78287839067802, + 80.80897526070483 ], - "timestamp": 6.221213073810643 + "timestamp": 6.302253880668197 }, { - "x": 9.24671717457305, - "y": 5.9225047085781934, - "heading": 0.2901169140945015, - "angularVelocity": -0.8160062764179685, - "velocityX": 1.2065051863894711, - "velocityY": 0.8322053970627751, + "x": 9.256631385149708, + "y": 5.920106690428395, + "heading": 0.27372901582427783, + "angularVelocity": -0.9259536133247956, + "velocityX": 1.2621160650732033, + "velocityY": 0.7959661019017846, "moduleForcesX": [ - 103.86961088775287, - 101.81794700730569, - 88.59644120728534, - 81.86390049299227 + 106.36127377314644, + 104.78762461695499, + 90.79435455500894, + 83.829920572498 ], "moduleForcesY": [ - 50.19424330306308, - 54.18124068785469, - 73.89664129178026, - 81.26407249712199 + 44.65822687033308, + 48.164003127686335, + 71.17035492491335, + 79.22203469459357 ], - "timestamp": 6.282050236774465 + "timestamp": 6.364355676276167 }, { - "x": 9.344679660258, - "y": 5.990100130181784, - "heading": 0.2278705872436387, - "angularVelocity": -1.0231628797003336, - "velocityX": 1.6102408612184482, - "velocityY": 1.1110876692883864, + "x": 9.36128953490754, + "y": 5.986116860930104, + "heading": 0.20215350943413754, + "angularVelocity": -1.152551318193366, + "velocityX": 1.6852676920729739, + "velocityY": 1.0629349740289324, "moduleForcesX": [ - 102.97098993160485, - 100.2816827855571, - 89.91507313466994, - 83.78116306119976 + 105.38356550288955, + 103.01244546536586, + 92.40747603148937, + 86.2278900967571 ], "moduleForcesY": [ - 51.956544160187924, - 56.921561602046935, - 72.24946473264366, - 79.2516201108616 + 46.83633622576909, + 51.77437024681331, + 69.01195080914106, + 76.55773487195233 ], - "timestamp": 6.342887399738287 + "timestamp": 6.426457471884137 }, { - "x": 9.467258608861432, - "y": 6.074736051006052, - "heading": 0.15653642733851053, - "angularVelocity": -1.1725425123381934, - "velocityX": 2.014869573657247, - "velocityY": 1.3911878315988937, + "x": 9.492321085260913, + "y": 6.0687979662658655, + "heading": 0.121648680830616, + "angularVelocity": -1.296336568297074, + "velocityX": 2.10994785369074, + "velocityY": 1.3313802689008425, "moduleForcesX": [ - 101.19960247774684, - 98.2967857325556, - 91.51945696061505, - 86.7668507310473 + 103.06905054921917, + 100.53419705098851, + 94.48545431834287, + 90.34073398334215 ], "moduleForcesY": [ - 55.2444277985547, - 60.21289489893423, - 70.14362208312178, - 75.91533220936323 + 51.59846953149261, + 56.324216066065965, + 66.03839637354766, + 71.56970538755411 ], - "timestamp": 6.403724562702109 + "timestamp": 6.488559267492107 }, { - "x": 9.614495005457098, - "y": 6.176489945212865, - "heading": 0.08185672674254803, - "angularVelocity": -1.2275342398916924, - "velocityX": 2.4201719709254568, - "velocityY": 1.6725614616073192, + "x": 9.649780293998948, + "y": 6.1681885527545415, + "heading": 0.042497044738964006, + "angularVelocity": -1.27454665870393, + "velocityX": 2.535501706456818, + "velocityY": 1.6004462594946747, "moduleForcesX": [ - 97.31237310212737, - 95.75953255949932, - 93.57306626338041, - 91.76671164693622 + 96.2916687370116, + 96.91797721607092, + 97.71513392557925, + 98.30376883932867 ], "moduleForcesY": [ - 61.70410058784353, - 64.06733787812753, - 67.2529692333703, - 69.68084586415326 + 63.117273034962174, + 62.16157487034735, + 60.8818194493432, + 59.937833099468726 ], - "timestamp": 6.464561725665932 + "timestamp": 6.550661063100077 }, { - "x": 9.786303556479535, - "y": 6.295259954535899, - "heading": 0.01573807289290187, - "angularVelocity": -1.0868135631006441, - "velocityX": 2.8240723704457604, - "velocityY": 1.952260814556102, + "x": 9.832603238264776, + "y": 6.282083749845622, + "heading": 0.0010258848806129173, + "angularVelocity": -0.6677932490091972, + "velocityX": 2.9439236414343237, + "velocityY": 1.8340081148388663, "moduleForcesX": [ - 86.5321701180405, - 92.25427081535645, - 97.1144659926379, - 101.20179764226765 + 59.97477963943079, + 89.39704823104167, + 110.38024149575084, + 113.80694315967614 ], "moduleForcesY": [ - 75.85885179568086, - 68.8487316739205, - 61.64809216339909, - 54.78638460823519 + 97.79151184647147, + 72.20506885999235, + 28.839425985382572, + 14.78899376484699 ], - "timestamp": 6.525398888629754 + "timestamp": 6.612762858708047 }, { - "x": 9.98099357991982, - "y": 6.426527001243398, - "heading": 0.0010512168806646742, - "angularVelocity": -0.24141257245955028, - "velocityX": 3.2001824864196897, - "velocityY": 2.1576786344484677, + "x": 10.030346062720374, + "y": 6.407528929196308, + "heading": 0.0009143240312192765, + "angularVelocity": -0.001796419061662757, + "velocityX": 3.1841724143354813, + "velocityY": 2.0199927896220706, "moduleForcesX": [ - 38.81568526776312, - 84.74996163721521, - 112.94150068763072, - 114.64908329430031 + 27.910051624663126, + 63.73430047048076, + 47.02333960869323, + 81.07343060013112 ], "moduleForcesY": [ - 107.86535624618263, - 77.5428290412158, - 4.720404786879428, - 1.6603151606164208 + 78.23128798690065, + 63.59254149911866, + 17.492746703171225, + 10.792434877491871 ], - "timestamp": 6.586236051593576 + "timestamp": 6.674864654316017 }, { - "x": 10.18064296034454, - "y": 6.562363363203818, - "heading": 0.0009441064746914683, - "angularVelocity": -0.0017606081670327233, - "velocityX": 3.2817010310531267, - "velocityY": 2.2327859377860437, + "x": 10.228012029363544, + "y": 6.533099878628409, + "heading": 0.0008079294489062711, + "angularVelocity": -0.001713228760479697, + "velocityX": 3.182934804187995, + "velocityY": 2.022018014177882, "moduleForcesX": [ - 11.445573252588428, - 25.631275124727225, - 12.108894286774559, - 26.924267849023067 + -0.28545851563204555, + -0.2804480463731822, + -0.2855446348313677, + -0.28051646942635683 ], "moduleForcesY": [ - 27.856532036433503, - 26.8185016500409, - 7.889518984358191, - 7.559585000410401 + 0.4662962959748132, + 0.46648326649752214, + 0.45969100337572294, + 0.459880692548048 ], - "timestamp": 6.647073214557398 + "timestamp": 6.736966449923987 }, { - "x": 10.389186424222014, - "y": 6.684102379422477, - "heading": 0.0008315498846507851, - "angularVelocity": -0.001850128844890692, - "velocityX": 3.427895939222019, - "velocityY": 2.0010633351041336, + "x": 10.427113469333392, + "y": 6.656381795149376, + "heading": 0.0007006205611460927, + "angularVelocity": -0.0017279514498676949, + "velocityX": 3.206049648334116, + "velocityY": 1.9851586466067421, "moduleForcesX": [ - 34.125974092877684, - 34.119566969812965, - 34.12806959993071, - 34.12166225634625 + 5.285867690419364, + 5.284961607340059, + 5.285918211927382, + 5.285012064001373 ], "moduleForcesY": [ - -54.08961846611769, - -54.091189136841685, - -54.08302939294419, - -54.08460010575838 + -8.428820483504277, + -8.428859802450413, + -8.427665220567818, + -8.427704094896713 ], - "timestamp": 6.7079103775212205 + "timestamp": 6.799068245531957 }, { - "x": 10.61051606687712, - "y": 6.780644990322361, - "heading": 0.000701833947664439, - "angularVelocity": -0.0021321825454530797, - "velocityX": 3.638066469120572, - "velocityY": 1.5869019230448598, + "x": 10.636846447566278, + "y": 6.76054779134001, + "heading": 0.0005836892297171069, + "angularVelocity": -0.0018828977533457954, + "velocityX": 3.3772449923487615, + "velocityY": 1.6773427430054264, "moduleForcesX": [ - 49.06229197687783, - 49.03163546387942, - 49.0815105306153, - 49.05084786401312 + 39.14902863114247, + 39.136505585616426, + 39.15454418789416, + 39.14202011232547 ], "moduleForcesY": [ - -96.67004058315037, - -96.68438290730597, - -96.65707564207322, - -96.67142765058261 + -70.38808653661697, + -70.39220856869599, + -70.37815024115632, + -70.38227306623787 ], - "timestamp": 6.768747540485043 + "timestamp": 6.861170041139927 }, { - "x": 10.841956159147276, - "y": 6.849459835142262, - "heading": 0.0005411494775797474, - "angularVelocity": -0.002641222276920527, - "velocityX": 3.80425517882526, - "velocityY": 1.1311317206034728, + "x": 10.858199057460208, + "y": 6.836948493802416, + "heading": 0.0004443289376354839, + "angularVelocity": -0.002244062200091015, + "velocityX": 3.564351203164376, + "velocityY": 1.230249491410887, "moduleForcesX": [ - 38.80840694131433, - 38.74033390445177, - 38.8409572070115, - 38.77284195160276 + 42.79383002375116, + 42.750355155538415, + 42.817059002037766, + 42.773568530416895 ], "moduleForcesY": [ - -106.37757896352497, - -106.40184229774033, - -106.3636821482131, - -106.38798347831754 + -102.22993200522636, + -102.24725073962176, + -102.21741225918262, + -102.23474808291235 ], - "timestamp": 6.829584703448865 + "timestamp": 6.9232718367478965 }, { - "x": 11.080086659996805, - "y": 6.889216371961374, - "heading": 0.0003245280393203164, - "angularVelocity": -0.003560676200306194, - "velocityX": 3.914227574864692, - "velocityY": 0.6534909729888787, + "x": 11.087670752139442, + "y": 6.883506999197637, + "heading": 0.0002634313814932412, + "angularVelocity": -0.0029129198982296074, + "velocityX": 3.6950895289376384, + "velocityY": 0.7497127086168028, "moduleForcesX": [ - 25.717865755187493, - 25.577114001753998, - 25.76100486674207, - 25.620041504490047 + 29.92547693151462, + 29.82914130574372, + 29.960153351309838, + 29.86372234770639 ], "moduleForcesY": [ - -111.47748761628131, - -111.50955109747035, - -111.46568684412034, - -111.49785520760967 + -109.87230666320606, + -109.89810991838907, + -109.86092743160701, + -109.88678831438042 ], - "timestamp": 6.890421866412687 + "timestamp": 6.985373632355866 }, { "x": 11.321250915527344, "y": 6.899192810058594, - "heading": -5.820220043024201e-20, - "angularVelocity": -0.0053343716818830345, - "velocityX": 3.9640943755702462, - "velocityY": 0.16398591931634138, + "heading": 1.7044959641647185e-19, + "angularVelocity": -0.004241928577334639, + "velocityX": 3.7612465324259428, + "velocityY": 0.2525822435148066, "moduleForcesX": [ - 11.766242291584698, - 11.472950024585101, - 11.806680580907997, - 11.512400965900941 + 15.214683881783662, + 15.002575278462187, + 15.252598453614608, + 15.0399798318798 ], "moduleForcesY": [ - -114.24520441209951, - -114.27486879290603, - -114.2388907542841, - -114.26875836780002 + -113.66335076467918, + -113.69134460089437, + -113.65627458813691, + -113.68440690030411 ], - "timestamp": 6.9512590293765095 + "timestamp": 7.047475427963836 }, { - "x": 11.623075674299576, - "y": 6.864260942419369, - "heading": 0.0000023499430894192195, - "angularVelocity": 0.00003069941458455491, - "velocityX": 3.943007574588477, - "velocityY": -0.4563463224696058, + "x": 11.611818027854001, + "y": 6.870157772665709, + "heading": 0.000006706968945754724, + "angularVelocity": 0.00008661247380923753, + "velocityX": 3.7523263652724554, + "velocityY": -0.37495274483614, "moduleForcesX": [ - -4.2903004525975135, - -3.566125676157951, - -4.254477917247945, - -3.5363367506884154 + -1.930017347362055, + -1.3524659590983, + -1.9171433879503843, + -1.343441667490837 ], "moduleForcesY": [ - -115.06352371966176, - -115.08817444708899, - -115.06756634659666, - -115.091807306801 + -115.07098399891115, + -115.0791940311929, + -115.0737409512458, + -115.08184184287788 ], - "timestamp": 7.027805866546543 + "timestamp": 7.124911952413266 }, { - "x": 11.915766240995925, - "y": 6.782789828791696, - "heading": 0.000020549966953337708, - "angularVelocity": 0.00023776323799624486, - "velocityX": 3.8236794297091086, - "velocityY": -1.06433024066954, + "x": 11.89360394252261, + "y": 6.793457496928237, + "heading": 0.000014010027713151718, + "angularVelocity": 0.00009431026016884775, + "velocityX": 3.6389277110781117, + "velocityY": -0.9904922293815296, "moduleForcesX": [ - -22.15296905683905, - -22.126953133722456, - -22.146146005278485, - -22.120137478708045 + -20.795476451655723, + -20.794515439942504, + -20.795240317066728, + -20.794279315526506 ], "moduleForcesY": [ - -112.783738070124, - -112.78882065085001, - -112.78524441350454, - -112.79032392449628 + -112.87660869109384, + -112.87678463656188, + -112.87666020166296, + -112.87683614320375 ], - "timestamp": 7.104352703716576 + "timestamp": 7.202348476862695 }, { - "x": 12.175184864757565, - "y": 6.667702152711534, - "heading": 0.0029536724169984983, - "angularVelocity": 0.03831800971122835, - "velocityX": 3.389018192683671, - "velocityY": -1.5034935515953167, + "x": 12.158153629182106, + "y": 6.67179475203828, + "heading": 0.0004871969822431189, + "angularVelocity": 0.006110642980096399, + "velocityX": 3.4163424629454027, + "velocityY": -1.5711286857845936, "moduleForcesX": [ - -82.77126323116941, - -80.94192654719535, - -80.35273216958193, - -78.46991677908551 + -41.28977010687008, + -40.662563471279185, + -40.970425111678914, + -40.3466587799709 ], "moduleForcesY": [ - -79.32224282560553, - -81.16083698479886, - -81.80494379688955, - -83.58853211441256 + -106.29034131292164, + -106.52838528799589, + -106.42582853323141, + -106.66047133973117 ], - "timestamp": 7.180899540886609 + "timestamp": 7.279785001312124 }, { - "x": 12.387977367389736, - "y": 6.561745619437614, - "heading": 0.006312957325942295, - "angularVelocity": 0.043885352199226915, - "velocityX": 2.779899346585585, - "velocityY": -1.3842052420605957, + "x": 12.375778537307344, + "y": 6.562682372433733, + "heading": 0.003922386449226963, + "angularVelocity": 0.04436135907968387, + "velocityX": 2.810365130312186, + "velocityY": -1.4090557444349707, "moduleForcesX": [ - -112.95285116511828, - -112.9351029547452, - -113.05965579629233, - -113.04267855576265 + -110.75149967016266, + -110.51967200781796, + -111.70364987570524, + -111.51809488586058 ], "moduleForcesY": [ - 22.361919228925938, - 22.445395936831783, - 21.813838326495244, - 21.895492780162307 + 31.163125703536394, + 31.938835770863207, + 27.54075660649726, + 28.240069272526465 ], - "timestamp": 7.257446378056643 + "timestamp": 7.357221525761553 }, { - "x": 12.556502410271355, - "y": 6.473209425403713, - "heading": 0.009331441590312019, - "angularVelocity": 0.03943316766523955, - "velocityX": 2.2015938099085006, - "velocityY": -1.1566277237194698, + "x": 12.54876174639912, + "y": 6.472975043297138, + "heading": 0.007608118501472647, + "angularVelocity": 0.047596816598512205, + "velocityX": 2.233871035944323, + "velocityY": -1.1584627509358207, "moduleForcesX": [ - -107.33800844105599, - -107.38700511167124, - -107.17535879811419, - -107.22522115524384 + -105.67464605947448, + -105.63214461850302, + -105.80089159312246, + -105.75886325172866 ], "moduleForcesY": [ - 42.07330120256334, - 41.94949084700674, - 42.48667211202762, - 42.36206037528201 + 46.050955922132566, + 46.14736365416792, + 45.75956571011295, + 45.855608257532616 ], - "timestamp": 7.333993215226676 + "timestamp": 7.434658050210983 }, { - "x": 12.682025347004867, - "y": 6.405071382147858, - "heading": 0.011744144953739091, - "angularVelocity": 0.031519308342782756, - "velocityX": 1.639818722420714, - "velocityY": -0.8901483820226406, + "x": 12.677980051109994, + "y": 6.40464261213393, + "heading": 0.010776485842896305, + "angularVelocity": 0.040915670789083536, + "velocityX": 1.6686996947449795, + "velocityY": -0.8824315353645927, "moduleForcesX": [ - -104.3219357419469, - -104.4433579329168, - -103.98479429515396, - -104.10925807795152 + -103.73019304787827, + -103.83684095617447, + -103.44265988179235, + -103.55145256185558 ], "moduleForcesY": [ - 49.20870816840665, - 48.951926696699964, - 49.918130797069644, - 49.6594512669405 + 50.43388218964502, + 50.21517063638304, + 51.02184694806671, + 50.801888282932815 ], - "timestamp": 7.410540052396709 + "timestamp": 7.512094574660412 }, { - "x": 12.765280960185926, - "y": 6.358839505806994, - "heading": 0.013420862139108694, - "angularVelocity": 0.02190446068522871, - "velocityX": 1.0876427591139382, - "velocityY": -0.6039684727687442, + "x": 12.763883221887731, + "y": 6.358611977323751, + "heading": 0.013070566515867264, + "angularVelocity": 0.029625305232663646, + "velocityX": 1.1093366003769727, + "velocityY": -0.5944305369779237, "moduleForcesX": [ - -102.56600686278175, - -102.73833096424606, - -102.12754606615566, - -102.30453214622369 + -102.72849667186838, + -102.92566676985246, + -102.22155812605043, + -102.42499394558608 ], "moduleForcesY": [ - 52.83532642023232, - 52.500706634421135, - 53.67882683102995, - 53.34195778156508 + 52.51643901990649, + 52.130430374424144, + 53.49751224898022, + 53.1084108565624 ], - "timestamp": 7.487086889566743 + "timestamp": 7.589531099109841 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 0.011284751527060218, - "velocityX": 0.5416639429287425, - "velocityY": -0.30593583373417904, + "angularVelocity": 0.015678746812564974, + "velocityX": 0.5534907492707788, + "velocityY": -0.29948260373218116, "moduleForcesX": [ - -101.43052677926974, - -101.63866464193977, - -100.9273864836681, - -101.14130973054235 + -102.12022129821462, + -102.37649295640067, + -101.47905712486354, + -101.74499661591264 ], "moduleForcesY": [ - 55.02158505666223, - 54.63721275613784, - 55.9399480328183, - 55.553266367098956 + 53.73126222218935, + 53.24277344389703, + 54.93360379578871, + 54.44082769369371 ], - "timestamp": 7.563633726736776 + "timestamp": 7.6669676235592705 }, { "x": 12.806743621826172, "y": 6.335421085357666, "heading": 0.01428467417675486, - "angularVelocity": 5.114105590962525e-23, - "velocityX": -8.881224909325008e-21, - "velocityY": -1.1113020413435585e-20, + "angularVelocity": -1.2522021181482855e-21, + "velocityX": -6.11163916168187e-20, + "velocityY": -8.886685040205295e-20, "moduleForcesX": [ - -100.63924602824052, - -100.8733842366393, - -100.09136074426306, - -100.33208991745954 + -101.71254310622051, + -102.0097340749321, + -100.98075222935972, + -101.2902381868248 ], "moduleForcesY": [ - 56.48082932732088, - 56.062516688082894, - 57.44686854165235, - 57.026280875989876 + 54.52603575485248, + 53.96929568440209, + 55.870598413077815, + 55.308782033960505 ], - "timestamp": 7.640180563906809 + "timestamp": 7.7444041480087 } ], "eventMarkers": [ { - "timestamp": 0.8375297982110328, + "timestamp": 0.837529870183815, "command": { "type": "named", "data": { @@ -2511,7 +2532,7 @@ } }, { - "timestamp": 1.919752725275319, + "timestamp": 1.920812448359223, "command": { "type": "named", "data": { @@ -2520,7 +2541,7 @@ } }, { - "timestamp": 4.796356972775792, + "timestamp": 4.846178333479818, "command": { "type": "named", "data": { diff --git a/src/main/deploy/choreo/Red Source 4 Piece.1.traj b/src/main/deploy/choreo/Red Source 4 Piece.1.traj index 1568860..6675723 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.1.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.1.traj @@ -3,10 +3,10 @@ { "x": 16.113388061523438, "y": 2.058690309524536, - "heading": -5.911290029889773e-27, - "angularVelocity": -2.2741368514930436e-27, - "velocityX": -1.5134316947281816e-27, - "velocityY": 1.4749091747640022e-26, + "heading": -1.3192675701555174e-27, + "angularVelocity": -5.120628312608516e-28, + "velocityX": 1.3128854005502987e-26, + "velocityY": -8.391381995810073e-27, "moduleForcesX": [ 0, 0, @@ -22,508 +22,529 @@ "timestamp": 0 }, { - "x": 16.034243809496502, - "y": 2.0445076102417237, - "heading": -1.9973497625460715e-17, - "angularVelocity": -2.0081338779051517e-16, - "velocityX": -0.7957156869122083, - "velocityY": -0.14259274695339164, + "x": 16.035595110824165, + "y": 2.0447497642817187, + "heading": -2.4595850198596315e-17, + "angularVelocity": -2.4942588059145585e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.14137070869321683, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230425, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.357774654060638, - -20.357774654060627, - -20.357774654060627 + -20.35792154651867, + -20.35792154651867, + -20.357921546518657, + -20.357921546518657 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.09860985611290378 }, { - "x": 15.875967747836052, - "y": 2.016144441360754, - "heading": -5.1600821479672036e-17, - "angularVelocity": -3.1798086502327113e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.2851630766748124, + "x": 15.88002131887555, + "y": 2.0168708438170575, + "heading": -6.714340880249808e-17, + "angularVelocity": -4.3147369116802484e-16, + "velocityX": -1.5776697997661686, + "velocityY": -0.2827194112598734, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - -20.354574176009816, - -20.35457417600981, - -20.35457417600981, - -20.354574176009802 + -20.354752580314873, + -20.354752580314873, + -20.35475258031486, + -20.35475258031486 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.19721971222580756 }, { - "x": 15.638584633735167, - "y": 1.973605239386054, - "heading": -1.0173338631202558e-16, - "angularVelocity": -5.040324121575685e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563984, + "x": 15.64669087734002, + "y": 1.9750578832915355, + "heading": -1.2272941117994356e-16, + "angularVelocity": -5.636962121969091e-16, + "velocityX": -2.366197971817096, + "velocityY": -0.4240241510711468, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.55106593310009, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - -20.348206040044566, - -20.348206040044566, - -20.34820604004456, - -20.34820604004456 + -20.348421775770348, + -20.348421775770344, + -20.34842177577033, + -20.34842177577033 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.2958295683387113 }, { - "x": 15.322167709896716, - "y": 1.9169031294556198, - "heading": -1.5831936298865416e-16, - "angularVelocity": -5.689149640432954e-16, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 15.33567611436212, + "y": 1.919323843953726, + "heading": -1.984834521633126e-16, + "angularVelocity": -7.682197699925159e-16, + "velocityX": -3.153992666025245, + "velocityY": -0.5651974511959198, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048417 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - -20.32936628350109, - -20.329366283501095, - -20.329366283501088, - -20.32936628350109 + -20.32949395931806, + -20.329493959318057, + -20.329493959318047, + -20.329493959318047 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.3944394244516151 }, { - "x": 14.933440688201186, - "y": 1.847243004928388, - "heading": -1.3388748730441698e-16, - "angularVelocity": 2.4563788587865287e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 14.96955403361122, + "y": 1.853714538930282, + "heading": -2.677696161176793e-16, + "angularVelocity": -7.02629196352577e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180248, - -103.79354790180248 + -80.47536393454658, + -80.47536393454658, + -80.47536393454658, + -80.47536393454656 ], "moduleForcesY": [ - -18.59986846406024, - -18.59986846406025, - -18.599868464060304, - -18.599868464060314 + -14.421235366152786, + -14.421235366152787, + -14.421235366152782, + -14.421235366152784 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.4930492805645189 }, { - "x": 14.544710433230385, - "y": 1.7775823009962126, - "heading": -1.3942252466686606e-16, - "angularVelocity": -5.564922203932182e-17, - "velocityX": -3.9082909236715535, - "velocityY": -0.7003681690151492, + "x": 14.603431176065946, + "y": 1.7881050947048025, + "heading": -2.763926852338733e-16, + "angularVelocity": -8.744632081727001e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - -0.004641026935404772, - -0.004641026935415979, - -0.004641026935404772, - -0.004641026935415979 + -0.0011343830986481722, + -0.0011343830986250908, + -0.0011343830986481722, + -0.0011343830986250908 ], "moduleForcesY": [ - -0.0008316749189531905, - -0.0008316749189531906, - -0.0008316749189381512, - -0.0008316749189381512 + -0.00020328215815896224, + -0.00020328215815896224, + -0.0002032821581899367, + -0.0002032821581899367 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.5916591366774226 }, { - "x": 14.155980178236081, - "y": 1.7079215970598258, - "heading": -1.1657687895751773e-16, - "angularVelocity": 2.2968994216356014e-16, - "velocityX": -3.9082909239078325, - "velocityY": -0.7003681690574903, + "x": 14.237308318515241, + "y": 1.7224956504783495, + "heading": -2.5700045344553785e-16, + "angularVelocity": 1.9665612096159002e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -3.3733252146964024e-8, - -3.373324153298994e-8, - -3.3733252146964024e-8, - -3.373324153298994e-8 + -7.931396623961562e-9, + -7.93138596456208e-9, + -7.931396623961562e-9, + -7.93138596456208e-9 ], "moduleForcesY": [ - -6.044967827882044e-9, - -6.044967827882044e-9, - -6.044982071505302e-9, - -6.044982071505302e-9 + -1.4213120821275926e-9, + -1.4213120821275924e-9, + -1.4213263867103173e-9, + -1.4213263867103171e-9 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.6902689927903264 }, { - "x": 13.76724992324178, - "y": 1.638260893123439, - "heading": -1.4660809842490734e-16, - "angularVelocity": -3.0193364413974614e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.871185460964536, + "y": 1.6568862062518965, + "heading": -2.332515600997504e-16, + "angularVelocity": 2.40836913132689e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145579, "moduleForcesX": [ - -1.7870291174645942e-13, - -1.984781114965229e-13, - -1.787029117464594e-13, - -1.984781114965229e-13 + -7.562455688591036e-14, + -7.396691286762598e-14, + -7.562455688591036e-14, + -7.396691286762598e-14 ], "moduleForcesY": [ - -8.523302234904917e-14, - -8.523302234904917e-14, - -5.869531905751317e-14, - -5.869531905751317e-14 + 1.6709316559536332e-14, + 1.6709316559536325e-14, + 1.4484809819973387e-14, + 1.4484809819973394e-14 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.7888788489032301 }, { - "x": 13.378519668247476, - "y": 1.568600189187052, - "heading": -1.8997026664410195e-16, - "angularVelocity": -4.3596289796236307e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.505062603413833, + "y": 1.5912767620254435, + "heading": -2.82486849779877e-16, + "angularVelocity": -4.992937989801628e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.2971156305683035e-14, - -2.795674260204148e-14, - -2.2971156305683035e-14, - -2.7956742602041482e-14 + -7.061347163052097e-15, + -3.483072809517994e-14, + -7.061347163052085e-15, + -3.483072809517994e-14 ], "moduleForcesY": [ - 2.0004203762822518e-15, - 2.0004203762822534e-15, - 8.690922193675191e-15, - 8.690922193675194e-15 + -2.7110230144014444e-14, + -2.7110230144014435e-14, + 1.0155415770084611e-14, + 1.0155415770084619e-14 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.8874887050161339 }, { - "x": 12.989789413253172, - "y": 1.498939485250665, - "heading": -1.9166223749477501e-16, - "angularVelocity": -1.701106162880346e-17, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.138939745863128, + "y": 1.5256673177989906, + "heading": -2.91424140142493e-16, + "angularVelocity": -9.063283035491444e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - 1.7087397903500836e-14, - 3.2671462385594046e-14, - 1.708739790350083e-14, - 3.267146238559404e-14 + -3.0037169962633365e-14, + -1.4704388976622156e-14, + -3.003716996263337e-14, + -1.4704388976622162e-14 ], "moduleForcesY": [ - 1.1214756938034063e-14, - 1.1214756938034063e-14, - -9.698573118246464e-15, - -9.698573118246464e-15 + -7.860080706118566e-15, + -7.860080706118574e-15, + -2.843619612257921e-14, + -2.8436196122579215e-14 ], - "timestamp": 0.9946297820777839 + "timestamp": 0.9860985611290376 }, { - "x": 12.60105915825887, - "y": 1.4292787813142782, - "heading": -2.1132473221281133e-16, - "angularVelocity": -1.9768656716015265e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 12.772816888312423, + "y": 1.4600578735725376, + "heading": -2.7866776993087006e-16, + "angularVelocity": 1.2936202034999922e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -3.1561091183989215e-14, - -3.8281812957585957e-14, - -3.1561091183989215e-14, - -3.828181295758595e-14 + -2.8027421800298478e-14, + -1.9773311124507672e-14, + -2.802742180029848e-14, + -1.9773311124507675e-14 ], "moduleForcesY": [ - -4.378246769835839e-15, - -4.378246769835839e-15, - 4.6407529159753206e-15, - 4.640752915975323e-15 + 1.1639794476609557e-14, + 1.1639794476609555e-14, + 5.630345541752581e-16, + 5.6303455417525595e-16 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.0847084172419414 }, { - "x": 12.212328903264568, - "y": 1.3596180773778912, - "heading": -2.338892446919063e-16, - "angularVelocity": -2.268634308989279e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 12.406694030761718, + "y": 1.3944484293460846, + "heading": -2.5646567159181086e-16, + "angularVelocity": 2.2515090492364207e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7190572709139343e-14, - 1.610525910872734e-14, - 1.7190572709139343e-14, - 1.610525910872734e-14 + -1.3808172671853046e-14, + -1.0214215575821213e-14, + -1.3808172671853046e-14, + -1.0214215575821214e-14 ], "moduleForcesY": [ - -7.29643917334954e-15, - -7.296439173349538e-15, - -5.839982061915815e-15, - -5.839982061915817e-15 + 2.222720485034565e-14, + 2.2227204850345648e-14, + 1.7404226156707074e-14, + 1.7404226156707077e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.1833182733548453 }, { - "x": 11.823598648270266, - "y": 1.2899573734415042, - "heading": -2.5927098275735137e-16, - "angularVelocity": -2.5518779478058447e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 12.040571173211013, + "y": 1.3288389851196316, + "heading": -2.2224229801002295e-16, + "angularVelocity": 3.470583461819397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.6641443511735072e-14, - 2.5587840985466278e-14, - 2.6641443511735072e-14, - 2.5587840985466278e-14 + 2.0175105295583998e-14, + 2.474901922640669e-14, + 2.0175105295583998e-14, + 2.474901922640669e-14 ], "moduleForcesY": [ - -1.386672429304071e-14, - -1.3866724293040708e-14, - -1.245282245727067e-14, - -1.2452822457270669e-14 + -6.607702607368945e-16, + -6.607702607368945e-16, + -6.798820561685491e-15, + -6.798820561685492e-15 ], - "timestamp": 1.293018716701119 + "timestamp": 1.2819281294677491 }, { - "x": 11.434868393275963, - "y": 1.2202966695051174, - "heading": -2.6144430481414593e-16, - "angularVelocity": -2.1850562913018142e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 11.674448315660308, + "y": 1.2632295408931786, + "heading": -1.749528087057396e-16, + "angularVelocity": 4.795614877086492e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 4.753825314085828e-15, - 1.343344466918967e-14, - 4.7538253140858264e-15, - 1.343344466918967e-14 + 5.420610091677358e-16, + 5.5135209844670774e-15, + 5.420610091677348e-16, + 5.513520984467076e-15 ], "moduleForcesY": [ - 1.0157777233279833e-14, - 1.0157777233279832e-14, - -1.4900021085434622e-15, - -1.4900021085434647e-15 + 3.291962753668972e-15, + 3.291962753668971e-15, + -3.3795819800228904e-15, + -3.379581980022891e-15 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.380537985580653 }, { - "x": 11.046138138281659, - "y": 1.1506359655687304, - "heading": -2.6668925840610884e-16, - "angularVelocity": -5.273272220977154e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 11.308325458109605, + "y": 1.1976200966667256, + "heading": -1.6545141916537567e-16, + "angularVelocity": 9.635334550294471e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7853846881122523e-14, - 1.6705100127704452e-14, - 1.7853846881122526e-14, - 1.6705100127704452e-14 + 2.6333944897208536e-14, + 1.1956142837319584e-14, + 2.633394489720854e-14, + 1.1956142837319587e-14 ], "moduleForcesY": [ - 1.849796258873549e-14, - 1.849796258873549e-14, - 2.003954501948825e-14, - 2.003954501948825e-14 + -1.1841756113294508e-14, + -1.1841756113294505e-14, + 7.452807272774088e-15, + 7.45280727277409e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.4791478416935568 }, { - "x": 10.657407883287357, - "y": 1.0809752616323434, - "heading": -2.7494742477186974e-16, - "angularVelocity": -8.30275397395283e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 10.9422026005589, + "y": 1.1320106524402727, + "heading": -1.526261764676561e-16, + "angularVelocity": 1.300604543963397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.1611152108969522e-14, - -2.2738051071840055e-14, - -2.1611152108969522e-14, - -2.273805107184005e-14 + 3.007335775164219e-14, + 3.1338033749628167e-14, + 3.007335775164219e-14, + 3.1338033749628167e-14 ], "moduleForcesY": [ - -2.541885019413972e-15, - -2.541885019413971e-15, - -1.029621644370098e-15, - -1.0296216443700978e-15 + 1.4884372070057383e-15, + 1.488437207005738e-15, + -2.0871866593917718e-16, + -2.0871866593917757e-16 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.5777576978064607 }, { - "x": 10.268677628293055, - "y": 1.0113145576959566, - "heading": -2.4823569959460315e-16, - "angularVelocity": 2.685594745727998e-16, - "velocityX": -3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 10.576079743008195, + "y": 1.0664012082138195, + "heading": -2.1191759554461745e-16, + "angularVelocity": -6.012727471398986e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.1832676574649537e-13, - 2.314050106112521e-13, - 2.1832676574649537e-13, - 2.314050106112521e-13 + -2.3895223984057537e-15, + -2.9828824577607686e-14, + -2.3895223984057454e-15, + -2.9828824577607686e-14 ], "moduleForcesY": [ - 5.4206089243145896e-14, - 5.420608924314589e-14, - 3.665549121220295e-14, - 3.665549121220295e-14 + -1.750033498040077e-14, + -1.7500334980400767e-14, + 1.932235550878732e-14, + 1.9322355508787322e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.6763675539193645 }, { - "x": 9.879947373322251, - "y": 0.9416538537637811, - "heading": -2.9953417979362097e-16, - "angularVelocity": -5.157545162271987e-16, - "velocityX": -3.908290923671554, - "velocityY": -0.7003681690151493, + "x": 10.20995688545749, + "y": 1.0007917639873665, + "heading": -2.51438081505781e-16, + "angularVelocity": -4.0077622585012835e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.6653436767145577, "moduleForcesX": [ - 3.3733273434030475e-8, - 3.3733244259316946e-8, - 3.3733273434030475e-8, - 3.3733244259316946e-8 + 2.725363312900704e-14, + 3.4776175004574016e-14, + 2.725363312900703e-14, + 3.477617500457401e-14 ], "moduleForcesY": [ - 6.0449968765387015e-9, - 6.0449968765387015e-9, - 6.045036028097271e-9, - 6.045036028097271e-9 + 3.7096019824998565e-14, + 3.709601982499856e-14, + 2.7001002489393173e-14, + 2.7001002489393167e-14 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.7749774100322684 }, { - "x": 9.49122035162672, - "y": 0.8719937292365494, - "heading": -3.3337730352683075e-16, - "angularVelocity": -3.402584997030302e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 9.843834027912218, + "y": 0.9351823197618869, + "heading": -2.4245001806495676e-16, + "angularVelocity": 9.114771881288216e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - 0.004641026935428245, - 0.004641026935434773, - 0.004641026935428245, - 0.004641026935434773 + 7.931400721741463e-9, + 7.931419178512931e-9, + 7.931400721741463e-9, + 7.931419178512931e-9 ], "moduleForcesY": [ - 0.0008316749189632649, - 0.0008316749189632649, - 0.0008316749189545045, - 0.0008316749189545045 + 1.4212969989409796e-9, + 1.4212969989409796e-9, + 1.4212722305274573e-9, + 1.4212722305274573e-9 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.8735872661451722 }, { - "x": 9.17480342778827, - "y": 0.8152916193061152, - "heading": -2.1211685834383712e-16, - "angularVelocity": 1.2191515613294572e-15, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223712, + "x": 9.477711947161318, + "y": 0.8695730147384431, + "heading": -2.6800974586446296e-16, + "angularVelocity": -2.5920053846645386e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - 103.79354790180251, - 103.79354790180251, - 103.79354790180251, - 103.79354790180253 + 0.0011343830986540345, + 0.0011343830986408896, + 0.0011343830986540345, + 0.0011343830986408896 ], "moduleForcesY": [ - 18.59986846406036, - 18.599868464060346, - 18.599868464060243, - 18.599868464060233 + 0.00020328215816338424, + 0.00020328215816338424, + 0.0002032821581810242, + 0.0002032821581810242 ], - "timestamp": 1.9892595641555668 + "timestamp": 1.972197122258076 }, { - "x": 8.937420313687385, - "y": 0.7727524173314154, - "heading": -1.1312637475443375e-16, - "angularVelocity": 9.95249542760621e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563973, + "x": 9.166697184183416, + "y": 0.8138389754006334, + "heading": -1.6375905468462317e-16, + "angularVelocity": 1.0572035624806777e-15, + "velocityX": -3.1539926660252453, + "velocityY": -0.5651974511959199, "moduleForcesX": [ - 113.44472985048417, - 113.44472985048417, - 113.44472985048415, - 113.44472985048415 + 80.47536393454655, + 80.47536393454658, + 80.47536393454656, + 80.47536393454658 ], "moduleForcesY": [ - 20.329366283501077, - 20.32936628350108, - 20.329366283501102, - 20.329366283501106 + 14.42123536615281, + 14.421235366152803, + 14.421235366152724, + 14.421235366152716 ], - "timestamp": 2.088722542363345 + "timestamp": 2.07080697837098 }, { - "x": 8.779144252026935, - "y": 0.7443892484504455, - "heading": -3.93728468407683e-17, - "angularVelocity": 7.415173890439025e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.28516307667481233, + "x": 8.933366742647888, + "y": 0.7720260148751115, + "heading": -8.625567458400124e-17, + "angularVelocity": 7.859597727261062e-16, + "velocityX": -2.3661979718170962, + "velocityY": -0.4240241510711469, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - 20.348206040044545, - 20.34820604004455, - 20.34820604004457, - 20.348206040044573 + 20.329493959318043, + 20.329493959318043, + 20.32949395931806, + 20.32949395931806 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.169416834483884 + }, + { + "x": 8.777792950699272, + "y": 0.7441470944104505, + "heading": -2.504882545970686e-17, + "angularVelocity": 6.206970736540284e-16, + "velocityX": -1.5776697997661688, + "velocityY": -0.2827194112598734, + "moduleForcesX": [ + 113.55106593310009, + 113.5510659331001, + 113.55106593310009, + 113.55106593310009 + ], + "moduleForcesY": [ + 20.34842177577033, + 20.348421775770326, + 20.348421775770344, + 20.348421775770348 + ], + "timestamp": 2.2680266905967876 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.2763995877770643e-23, - "angularVelocity": 3.95854163827864e-16, - "velocityX": -0.7957156869122084, - "velocityY": -0.1425927469533916, + "heading": 1.3902950846098237e-21, + "angularVelocity": 2.5403358995413573e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.1413707086932168, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060846, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - 20.354574176009788, - 20.354574176009795, - 20.354574176009816, - 20.354574176009823 + 20.35475258031486, + 20.35475258031486, + 20.354752580314877, + 20.354752580314877 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.3666365467096915 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.315227470936058e-23, - "angularVelocity": -3.969132704994349e-24, - "velocityX": 1.0890521860195893e-24, - "velocityY": 5.6866921822786504e-24, + "heading": 1.4027105999712067e-21, + "angularVelocity": 1.258894947744667e-22, + "velocityX": 1.6132701940704752e-22, + "velocityY": 3.624341577856218e-22, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277731, - 113.60325815277731 + 113.60407786230425, + 113.60407786230425, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - 20.357774654060616, - 20.357774654060616, - 20.35777465406064, - 20.35777465406065 + 20.357921546518654, + 20.357921546518654, + 20.357921546518668, + 20.35792154651867 ], - "timestamp": 2.38711147698668 + "timestamp": 2.4652464028225953 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Source 4 Piece.2.traj b/src/main/deploy/choreo/Red Source 4 Piece.2.traj index 924c9e1..7613d98 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.2.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.2.traj @@ -3,443 +3,464 @@ { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.315227470936058e-23, - "angularVelocity": -3.969132704994349e-24, - "velocityX": 1.0890521860195893e-24, - "velocityY": 5.6866921822786504e-24, + "heading": 1.4027105999712067e-21, + "angularVelocity": 1.258894947744667e-22, + "velocityX": 1.6132701940704752e-22, + "velocityY": 3.624341577856218e-22, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277731, - 113.60325815277731 + 113.60407786230425, + 113.60407786230425, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - 20.357774654060616, - 20.357774654060616, - 20.35777465406064, - 20.35777465406065 + 20.357921546518654, + 20.357921546518654, + 20.357921546518668, + 20.35792154651867 ], "timestamp": 0 }, { - "x": 8.749697525208294, - "y": 0.7486471398847376, - "heading": 0.02845270874371011, - "angularVelocity": 0.35037941350634527, - "velocityX": 0.611997609508755, - "velocityY": 0.22708570274870504, + "x": 8.746921743709395, + "y": 0.7475758768470208, + "heading": 0.030374708631720888, + "angularVelocity": 0.3844322390186118, + "velocityX": 0.5938569225985214, + "velocityY": 0.21983188747567822, "moduleForcesX": [ - 98.5991688650241, - 103.9054385308619, - 112.25808633757455, - 113.31145977613869 + 97.08636346934237, + 103.3854037020227, + 112.73947029508177, + 113.70612876978298 ], "moduleForcesY": [ - 59.96747683817386, - 50.24070001601607, - 26.723188479519543, - 21.9083400310118 + 62.38345613408076, + 51.30130417295828, + 24.59721210153914, + 19.752811466970538 ], - "timestamp": 0.0812054237404416 + "timestamp": 0.07901186619848044 }, { - "x": 8.849156577034107, - "y": 0.7856168809153166, - "heading": 0.08307898135737164, - "angularVelocity": 0.6726924150813449, - "velocityX": 1.224783361068523, - "velocityY": 0.45526196807673974, + "x": 8.840842415957127, + "y": 0.7824201103535564, + "heading": 0.0887396108421577, + "angularVelocity": 0.7386852762573924, + "velocityX": 1.1886907216164013, + "velocityY": 0.44100000649276727, "moduleForcesX": [ - 99.75724138640882, - 103.91806545859839, - 112.08705733206624, - 112.86307129194968 + 98.44357768722071, + 103.3663432807897, + 112.56382635716881, + 113.2458848815574 ], "moduleForcesY": [ - 57.99159008453139, - 50.18528756830434, - 27.37363860720728, - 24.052005242751928 + 60.18928815483851, + 51.30995429297123, + 25.32325446348916, + 22.17288947410142 ], - "timestamp": 0.1624108474808832 + "timestamp": 0.15802373239696088 }, { - "x": 8.998468662854163, - "y": 0.8412229963489036, - "heading": 0.16020071685878773, - "angularVelocity": 0.949711631921556, - "velocityX": 1.838695975496751, - "velocityY": 0.6847586389219772, + "x": 8.981875095948194, + "y": 0.8348658019205454, + "heading": 0.17117745322357367, + "angularVelocity": 1.0433602741938677, + "velocityX": 1.784955688007542, + "velocityY": 0.6637698119323436, "moduleForcesX": [ - 101.42006410641166, - 104.11265608433904, - 111.7271355600726, - 112.15378683051922 + 100.41233501810491, + 103.5548940276436, + 112.18043737384708, + 112.5008166473148 ], "moduleForcesY": [ - 54.984671240448485, - 49.73281322981778, - 28.724585734295502, - 27.08403574576014 + 56.79519440863829, + 50.8794713381393, + 26.877817481486677, + 25.594338331171862 ], - "timestamp": 0.2436162712213248 + "timestamp": 0.23703559859544132 }, { - "x": 9.197770113060493, - "y": 0.9155841520343786, - "heading": 0.25288489149857346, - "angularVelocity": 1.141354485582565, - "velocityX": 2.454287423502156, - "velocityY": 0.9157166142394266, + "x": 9.170193806235403, + "y": 0.905047849903824, + "heading": 0.27014704823869273, + "angularVelocity": 1.2525915381685058, + "velocityX": 2.383423140698203, + "velocityY": 0.8882469350487014, "moduleForcesX": [ - 103.92861554586716, - 104.98869457390772, - 110.77607463143484, - 110.8945520614623 + 103.40298640344946, + 104.5638907933371, + 111.12271990152317, + 111.14222972427875 ], "moduleForcesY": [ - 49.99408871314561, - 47.7642847739149, - 32.07204722537332, - 31.71782432020252 + 51.0556107106465, + 48.6758061597135, + 30.821794358941716, + 30.820982678865775 ], - "timestamp": 0.3248216949617664 + "timestamp": 0.31604746479392176 }, { - "x": 9.44716479258539, - "y": 1.0087906432972022, - "heading": 0.34521028833138984, - "angularVelocity": 1.1369363347935713, - "velocityX": 3.0711579108563343, - "velocityY": 1.1477865266825218, + "x": 9.40593573622577, + "y": 0.9930498413232173, + "heading": 0.36785454850899846, + "angularVelocity": 1.2366180546205672, + "velocityX": 2.983626907358139, + "velocityY": 1.113781962804538, "moduleForcesX": [ - 107.9455056410082, - 107.94355502791348, - 107.7979462288896, - 107.79557995601229 + 108.1423184266996, + 108.14622857930792, + 107.59649154427585, + 107.59500574441716 ], "moduleForcesY": [ - 40.383323246666976, - 40.386866616605445, - 40.77561046788362, - 40.780211699947586 + 39.81251263328706, + 39.79515762619855, + 41.26483057998931, + 41.26220935675603 ], - "timestamp": 0.406027118702208 + "timestamp": 0.3950593309924022 }, { - "x": 9.743254546944904, - "y": 1.1197154475688877, - "heading": 0.366082064748327, - "angularVelocity": 0.25702441358658573, - "velocityX": 3.6461820001815624, - "velocityY": 1.3659777778666213, + "x": 9.683387271031574, + "y": 1.0968882632669579, + "heading": 0.3737950413323585, + "angularVelocity": 0.0751848185491193, + "velocityX": 3.511517296767004, + "velocityY": 1.3142130029291395, "moduleForcesX": [ - 114.50263359045593, - 114.48153022441875, - 92.89940889941946, - 80.3287014204201 + 114.92109699391807, + 111.16467067641456, + 88.39242273361798, + 65.01654331360074 ], "moduleForcesY": [ - 11.01893061920688, - -8.214078066637066, - 67.83670510440811, - 81.97674297463185 + 4.148148544540557, + -28.016980604792366, + 73.55404230537428, + 94.40251274978336 ], - "timestamp": 0.4872325424426496 + "timestamp": 0.47407119719088264 }, { - "x": 10.04517026477605, - "y": 1.2327664453559726, - "heading": 0.36619792232508147, - "angularVelocity": 0.001426722150047545, - "velocityX": 3.7179255267008346, - "velocityY": 1.3921606781885905, + "x": 9.962406006796718, + "y": 1.201509394881753, + "heading": 0.37391809195022235, + "angularVelocity": 0.001557368833116526, + "velocityX": 3.5313523042759076, + "velocityY": 1.3241192323186375, "moduleForcesX": [ - 20.675376664017367, - 10.058722820162606, - 15.100494848677528, - 4.347871917595204 + 6.012702465623703, + 2.809169459616938, + 4.321760134676471, + 1.1155418972110314 ], "moduleForcesY": [ - -0.6516753204632776, - -4.9242298237286946, - 13.911513369659277, - 9.978553002629607 + 0.25591605391839173, + -1.0053994170959915, + 4.561565207999552, + 3.3094001138140294 ], - "timestamp": 0.5684379661830912 + "timestamp": 0.5530830633893631 }, { - "x": 10.347086763223185, - "y": 1.3458158061592695, - "heading": 0.366313361291408, - "angularVelocity": 0.0014215671935355297, - "velocityX": 3.717935139556162, - "velocityY": 1.3921405196362118, + "x": 10.241422645398577, + "y": 1.3061362496498794, + "heading": 0.374041018087458, + "angularVelocity": 0.0015557933656043376, + "velocityX": 3.5313257618920133, + "velocityY": 1.3241916664175475, "moduleForcesX": [ - 0.0018470631612436685, - 0.0016277805976543929, - 0.0017341728177355192, - 0.001514890254104659 + -0.0047178363595807, + -0.004786508231731981, + -0.004754009184713588, + -0.004822681056852332 ], "moduleForcesY": [ - -0.0036301509175129874, - -0.0037142738378569294, - -0.003335880534841119, - -0.0034200034551973633 + 0.012985423783144328, + 0.012958468742882152, + 0.013077579297975673, + 0.013050624257716973 ], - "timestamp": 0.6496433899235328 + "timestamp": 0.6320949295878435 }, { - "x": 10.64900328277143, - "y": 1.4588651106250559, - "heading": 0.36642880011188633, - "angularVelocity": 0.0014215653974949576, - "velocityX": 3.717935399404689, - "velocityY": 1.3921398258708442, + "x": 10.520439212462904, + "y": 1.4107632952116884, + "heading": 0.3741639439073583, + "angularVelocity": 0.001555789349304766, + "velocityX": 3.531324856489611, + "velocityY": 1.3241940811647468, "moduleForcesX": [ - 0.00004549695252604368, - 0.000045420555579632215, - 0.00004545760851848642, - 0.000045381211572074955 + -0.0001625873675282764, + -0.0001627624225494424, + -0.0001626796108707561, + -0.00016285466589192513 ], "moduleForcesY": [ - -0.00012135367009232236, - -0.00012138298821378404, - -0.00012125114776527303, - -0.0001212804658867347 + 0.0004339008689113104, + 0.0004338321315943089, + 0.00043413578730753475, + 0.0004340670499905359 ], - "timestamp": 0.7308488136639744 + "timestamp": 0.711106795786324 }, { - "x": 10.950919802007403, - "y": 1.5719144159306049, - "heading": 0.36654423879403597, - "angularVelocity": 0.0014215636940539118, - "velocityX": 3.7179353955592287, - "velocityY": 1.392139836212059, + "x": 10.799455776813222, + "y": 1.5153903480276578, + "heading": 0.37428686940727074, + "angularVelocity": 0.0015557852994340933, + "velocityX": 3.53132482214022, + "velocityY": 1.3241941729757738, "moduleForcesX": [ - -6.175555322723859e-7, - -6.900104256789466e-7, - -6.548822821618376e-7, - -7.273371755683984e-7 + -0.000006038575439683577, + -0.000006215085169064049, + -0.000006131618953715752, + -0.000006308128683095867 ], "moduleForcesY": [ - 0.0000017736345295412757, - 0.000001745819615530989, - 0.0000018708667440091473, - 0.0000018430518299988607 + 0.000016416721911056802, + 0.000016347388327240465, + 0.000016653592480530648, + 0.00001658425889671332 ], - "timestamp": 0.812054237404416 + "timestamp": 0.7901186619848044 }, { - "x": 11.252836297906729, - "y": 1.6849637835662303, - "heading": 0.36665967733637467, - "angularVelocity": 0.0014215619723584874, - "velocityX": 3.7179351081812904, - "velocityY": 1.392140603772568, + "x": 11.07847234022828, + "y": 1.6200174033544013, + "heading": 0.3744097945845876, + "angularVelocity": 0.0015557812165593802, + "velocityX": 3.5313248103033033, + "velocityY": 1.3241942047529474, "moduleForcesX": [ - -0.00005019760036002295, - -0.00005027082844721402, - -0.00005023533845441479, - -0.000050308566541605865 + -0.0000019914727432141183, + -0.0000021694123278502697, + -0.0000020853038623682895, + -0.00000226324344700444 ], "moduleForcesY": [ - 0.00013418637131016692, - 0.00013415824987303315, - 0.0001342846411266562, - 0.0001342565196895224 + 0.000005626632786408257, + 0.000005556712299934303, + 0.0000058654221771894254, + 0.000005795501690715472 ], - "timestamp": 0.8932596611448576 + "timestamp": 0.8691305281832848 }, { - "x": 11.554752108451195, - "y": 1.7980149815274173, - "heading": 0.36677511575973815, - "angularVelocity": 0.0014215605072443334, - "velocityX": 3.7179266684142243, - "velocityY": 1.3921631432222437, + "x": 11.357488887388348, + "y": 1.7246445020461594, + "heading": 0.3745327194374754, + "angularVelocity": 0.00155577711047777, + "velocityX": 3.531324604574814, + "velocityY": 1.3241947535947427, "moduleForcesX": [ - -0.0014757943893018654, - -0.001475856701571945, - -0.001475826513007055, - -0.0014758888252771351 + -0.00003683733250123687, + -0.00003701627484165169, + -0.00003693172647393205, + -0.00003711066881434762 ], "moduleForcesY": [ - 0.003941389083174159, - 0.003941365145432393, - 0.0039414727043032135, - 0.003941448766561447 + 0.00009855422104990495, + 0.00009848388113975036, + 0.0000987943561077727, + 0.00009872401619761882 ], - "timestamp": 0.9744650848852991 + "timestamp": 0.9481423943817653 }, { - "x": 11.856647446672115, - "y": 1.911120366719257, - "heading": 0.3668909923479222, - "angularVelocity": 0.0014269562653164898, - "velocityX": 3.717674563042425, - "velocityY": 1.3928304290777476, + "x": 11.63650495567805, + "y": 1.8292728777764502, + "heading": 0.3746556439873936, + "angularVelocity": 0.0015557732759965874, + "velocityX": 3.5313185438349786, + "velocityY": 1.32421091621176, "moduleForcesX": [ - -0.04425896362884921, - -0.04402948835633619, - -0.0441406220757317, - -0.04391114680180525 + -0.0010891225625817823, + -0.0010892896605572684, + -0.0010892107403075175, + -0.0010893778382830058 ], "moduleForcesY": [ - 0.11679654129672462, - 0.11688472651506654, - 0.11648859333556225, - 0.11657677855445653 + 0.002904703698206433, + 0.002904637990480236, + 0.0029049279384945298, + 0.002904862230768327 ], - "timestamp": 1.0556705086257407 + "timestamp": 1.0271542605802457 }, { - "x": 12.15185011782445, - "y": 2.023490901110545, - "heading": 0.38847604869790386, - "angularVelocity": 0.2658080625128484, - "velocityX": 3.635258059805189, - "velocityY": 1.3837811468167476, + "x": 11.9155066014505, + "y": 1.933939583482744, + "heading": 0.3747786859738994, + "angularVelocity": 0.0015572595918276028, + "velocityX": 3.5311360077432856, + "velocityY": 1.3246960329144353, "moduleForcesX": [ - -22.83840056240393, - -12.043870771869477, - -16.90529380786833, - -5.860331369774487 + -0.032855287769666466, + -0.03279052058954477, + -0.03282109775071749, + -0.03275633057051873 ], "moduleForcesY": [ - 3.6231590205459683, - 8.365079303423084, - -11.362059153742951, - -6.955883377496448 + 0.08721701632802349, + 0.08724249386316295, + 0.08713010090018317, + 0.08715557843535474 ], - "timestamp": 1.1368759323661823 + "timestamp": 1.1061661267787262 }, { - "x": 12.400755383704196, - "y": 2.117659437341253, - "heading": 0.48329601767345703, - "angularVelocity": 1.1676556147115023, - "velocityX": 3.0651310517795785, - "velocityY": 1.1596335797926638, + "x": 12.192538240584097, + "y": 2.039177693852194, + "heading": 0.3803730340943993, + "angularVelocity": 0.07080389806825643, + "velocityX": 3.506202959915975, + "velocityY": 1.3319279170686587, "moduleForcesX": [ - -114.17872059898711, - -114.30356134591156, - -90.19939840298346, - -80.1052308451629 + -6.787368546566498, + -3.784269941628227, + -5.182022231798085, + -2.1704396914350084 ], "moduleForcesY": [ - -14.08163508293927, - 10.797887995941533, - -71.37399843226963, - -82.12682115917191 + 2.7165308525253336, + 3.927000047116944, + -1.3250575905079343, + -0.11954942939397993 ], - "timestamp": 1.218081356106624 + "timestamp": 1.1851779929772066 }, { - "x": 12.599581408201276, - "y": 2.192945515401507, - "heading": 0.5780713991757789, - "angularVelocity": 1.167106544573357, - "velocityX": 2.448432818140226, - "velocityY": 0.9271065230925032, + "x": 12.427978262373196, + "y": 2.1280236238213828, + "heading": 0.47663420593072064, + "angularVelocity": 1.2183128492941782, + "velocityX": 2.979805858498074, + "velocityY": 1.124463124893227, "moduleForcesX": [ - -107.83281776344127, - -107.82986538656014, - -107.85118599185448, - -107.84823135382317 + -114.73981520594829, + -111.18079581607797, + -86.14799527800552, + -66.35261871218253 ], "moduleForcesY": [ - -40.68175318481147, - -40.689783654449414, - -40.63309333309364, - -40.64114069086623 + -7.795647023550036, + 28.177549378571307, + -76.14784747221293, + -93.3782667153953 ], - "timestamp": 1.2992867798470655 + "timestamp": 1.264189859175687 }, { - "x": 12.74846595255012, - "y": 2.2493986724180166, - "heading": 0.6567776497722155, - "angularVelocity": 0.9692240612893908, - "velocityX": 1.8334310381129904, - "velocityY": 0.6951894887828137, + "x": 12.615965734027, + "y": 2.199126658591582, + "heading": 0.5737884271556586, + "angularVelocity": 1.2296155742086012, + "velocityX": 2.3792308763037235, + "velocityY": 0.89990324480611, "moduleForcesX": [ - -104.92855177072474, - -103.58820516720519, - -111.54097597186703, - -110.1177486633702 + -108.0986373688516, + -108.16057441934431, + -107.71338177916209, + -107.77431358980553 ], "moduleForcesY": [ - -47.84626346354842, - -50.7219346420931, - -29.320464413930953, - -34.33041579719788 + -39.92967545115843, + -39.756848729907475, + -40.95621385148542, + -40.790948973447925 ], - "timestamp": 1.3804922035875071 + "timestamp": 1.3432017253741675 }, { - "x": 12.847594216215393, - "y": 2.287032791210217, - "heading": 0.7126183270589642, - "angularVelocity": 0.687647138758041, - "velocityX": 1.2207098873360585, - "velocityY": 0.463443413736636, + "x": 12.756677891744804, + "y": 2.2524751443391073, + "heading": 0.6545619050636577, + "angularVelocity": 1.0222955334973773, + "velocityX": 1.7808990533691502, + "velocityY": 0.675195870117938, "moduleForcesX": [ - -103.65261141149999, - -101.33099886518954, - -112.89020105896142, - -110.70643780421157 + -104.71639898474407, + -103.30559580568976, + -111.8097050026696, + -110.30262425390252 ], "moduleForcesY": [ - -50.63164845334595, - -55.16991177134879, - -23.783026122978413, - -32.51491104120575 + -48.29042179755709, + -51.28282431794385, + -28.25140262149225, + -33.715070554259015 ], - "timestamp": 1.4616976273279487 + "timestamp": 1.422213591572648 + }, + { + "x": 12.850336914665005, + "y": 2.288054717515041, + "heading": 0.7118620959658994, + "angularVelocity": 0.7252099419889868, + "velocityX": 1.1853792022191647, + "velocityY": 0.45030670566059755, + "moduleForcesX": [ + -103.22725405324366, + -100.76683441661494, + -113.21054868518623, + -110.90819056427041 + ], + "moduleForcesY": [ + -51.48157539975729, + -56.18800584688865, + -22.188774881580073, + -31.81204987645629 + ], + "timestamp": 1.5012254577711284 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 0.35994321486729053, - "velocityX": 0.6097006638724112, - "velocityY": 0.23169454365301478, + "angularVelocity": 0.3795072034311285, + "velocityX": 0.591914918165481, + "velocityY": 0.2251931025926012, "moduleForcesX": [ - -102.93131489378747, - -99.9529403855715, - -113.5371251884651, - -110.9614263550785 + -102.38974249930051, + -99.2333325232405, + -113.85285218516329, + -111.1591753938583 ], "moduleForcesY": [ - -52.12981175149366, - -57.669598676950365, - -20.595444632987483, - -31.70659737313563 + -53.177087365808944, + -58.89587684714717, + -18.75697096029462, + -31.00181733914533 ], - "timestamp": 1.5429030510683903 + "timestamp": 1.5802373239696088 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 5.2713736123368476e-24, - "velocityX": -1.2575111514507032e-24, - "velocityY": -4.677232863444744e-24, + "angularVelocity": 4.222228434888889e-22, + "velocityX": 4.2990324061792614e-21, + "velocityY": -4.011907557779764e-21, "moduleForcesX": [ - -102.27730985577767, - -99.09462528312666, - -113.90720400078715, - -111.1883691091121 + -101.63548974867733, + -98.28908180907341, + -114.21009011513806, + -111.386618425042 ], "moduleForcesY": [ - -53.43303751633116, - -59.15782976040063, - -18.525172105483644, - -30.94741332746109 + -54.637387770778965, + -60.48460075810778, + -16.54354448292929, + -30.223370855342132 ], - "timestamp": 1.6241084748088315 + "timestamp": 1.6592491901680892 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Source 4 Piece.3.traj b/src/main/deploy/choreo/Red Source 4 Piece.3.traj index 41c2daf..cec9afa 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.3.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.3.traj @@ -4,589 +4,589 @@ "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 5.2713736123368476e-24, - "velocityX": -1.2575111514507032e-24, - "velocityY": -4.677232863444744e-24, + "angularVelocity": 4.222228434888889e-22, + "velocityX": 4.2990324061792614e-21, + "velocityY": -4.011907557779764e-21, "moduleForcesX": [ - -102.27730985577767, - -99.09462528312666, - -113.90720400078715, - -111.1883691091121 + -101.63548974867733, + -98.28908180907341, + -114.21009011513806, + -111.386618425042 ], "moduleForcesY": [ - -53.43303751633116, - -59.15782976040063, - -18.525172105483644, - -30.94741332746109 + -54.637387770778965, + -60.48460075810778, + -16.54354448292929, + -30.223370855342132 ], "timestamp": 0 }, { - "x": 12.878326844262283, - "y": 2.2989594406099587, - "heading": 0.7005045669662167, - "angularVelocity": -0.7787767050645679, - "velocityX": -0.3537267099935758, - "velocityY": -0.12975255335628538, + "x": 12.877999676968232, + "y": 2.29858470070828, + "heading": 0.6929652035770414, + "angularVelocity": -0.895192392543208, + "velocityX": -0.34988280879900624, + "velocityY": -0.13300745644801076, "moduleForcesX": [ - -72.94619674814248, - -82.30668691722371, - -108.15778531261913, - -115.0598645177216 + -63.35936817512306, + -80.10356434853757, + -105.25411125517046, + -115.2316867824649 ], "moduleForcesY": [ - -89.24912908119802, - -80.86584959263499, - 40.14347495933019, - -8.857475561829991 + -96.27483320533037, + -83.05086248624922, + 47.239128737124624, + -6.268029819257333 ], - "timestamp": 0.05308723426070472 + "timestamp": 0.054605540859038015 }, { - "x": 12.840219976733476, - "y": 2.285572424541842, - "heading": 0.6202251467662581, - "angularVelocity": -1.5122170389535827, - "velocityX": -0.7178160260085901, - "velocityY": -0.252170154549299, + "x": 12.83896543758541, + "y": 2.2846494014998036, + "heading": 0.5985027683944565, + "angularVelocity": -1.7299056780050237, + "velocityX": -0.7148402665507607, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - -77.9377516249161, - -86.98787858056687, - -109.4406212161063, - -115.19177113993022 + -71.53272845126982, + -85.95725612054817, + -106.80144207930026, + -115.33798101701309 ], "moduleForcesY": [ - -84.91967760133534, - -75.788435232065, - 36.43023788237509, - -6.703058984175765 + -90.36459624820593, + -76.95483823713556, + 43.55724850599798, + -3.342055562830003 ], - "timestamp": 0.10617446852140944 + "timestamp": 0.10921108171807603 }, { - "x": 12.782177244041925, - "y": 2.266103908321777, - "heading": 0.5042008090194892, - "angularVelocity": -2.1855412014305973, - "velocityX": -1.0933463289217318, - "velocityY": -0.3667268881339164, + "x": 12.7790871054742, + "y": 2.2646755465629314, + "heading": 0.4630663339899602, + "angularVelocity": -2.480269076614779, + "velocityX": -1.096561469206608, + "velocityY": -0.3657843988476259, "moduleForcesX": [ - -83.00336971918546, - -92.33620304947924, - -111.16605663240462, - -115.29369779681878 + -79.8109340460071, + -92.6408907817173, + -109.25337437613236, + -115.36188623484176 ], "moduleForcesY": [ - -79.96612718536689, - -69.14410094650641, - 30.64026316812107, - -4.1002194480586285 + -83.13387654195827, + -68.72829018973381, + 36.84729749065963, + -0.015885734863739443 ], - "timestamp": 0.15926170278211416 + "timestamp": 0.16381662257711405 }, { - "x": 12.703462361937405, - "y": 2.2408921611397123, - "heading": 0.3580649303430616, - "angularVelocity": -2.752749897626456, - "velocityX": -1.4827459595646482, - "velocityY": -0.47491167195211426, + "x": 12.697235826568717, + "y": 2.239145023664725, + "heading": 0.29538035410743513, + "angularVelocity": -3.0708601589607962, + "velocityX": -1.4989555568505593, + "velocityY": -0.46754454761490505, "moduleForcesX": [ - -89.65379875606007, - -98.13983385768606, - -113.54027185482593, - -115.30493503306579 + -90.33198646116189, + -99.85169207378266, + -113.07409659910392, + -115.31328266124063 ], "moduleForcesY": [ - -72.40887140224788, - -60.57623674894681, - 19.8541582997784, - -2.6215553765171156 + -71.52890617387138, + -57.683472950501425, + 22.212990208565554, + 1.1482981099846643 ], - "timestamp": 0.21234893704281887 + "timestamp": 0.21842216343615206 }, { - "x": 12.603247350879384, - "y": 2.210057158622966, - "heading": 0.19174239462916676, - "angularVelocity": -3.133004347092273, - "velocityX": -1.887742174811279, - "velocityY": -0.5808364844421805, + "x": 12.592206955696092, + "y": 2.2082229653738406, + "heading": 0.11160745845427096, + "angularVelocity": -3.3654624194194347, + "velocityX": -1.9234105041419007, + "velocityY": -0.5662805972512617, "moduleForcesX": [ - -98.79018954476506, - -104.20314131415653, - -115.19744688183164, - -115.13565568271744 + -103.97533493870596, + -107.44888382024821, + -115.0584177361961, + -115.03616740781044 ], "moduleForcesY": [ - -59.282961502664314, - -49.313671267245034, - 1.005530916636403, - -5.743342962263224 + -49.54196790951789, + -41.65055661100523, + -4.805861192354253, + -6.707031707137319 ], - "timestamp": 0.2654361713035236 + "timestamp": 0.2730277042951901 }, { - "x": 12.48089900238875, - "y": 2.1736228332964016, - "heading": 0.021527886856620944, - "angularVelocity": -3.206317114518393, - "velocityX": -2.3046660877037954, - "velocityY": -0.6863104818691433, + "x": 12.463838013593607, + "y": 2.1725870949498365, + "heading": -0.057259944646070635, + "angularVelocity": -3.0924957512327658, + "velocityX": -2.350840960148443, + "velocityY": -0.652605392482001, "moduleForcesX": [ - -109.90169912281644, - -110.54551793687568, - -112.66305677296602, - -112.97822127254382 + -115.06107533407756, + -114.85560912614942, + -109.41725119475672, + -105.2799977954633 ], "moduleForcesY": [ - -34.382418266787134, - -32.32487235746525, - -23.78897776007878, - -22.35582603859897 + -2.484190771745183, + -5.214634192772953, + -35.76089164102002, + -46.335491532966486 ], - "timestamp": 0.3185234055642283 + "timestamp": 0.3276332451542281 }, { - "x": 12.337568769520207, - "y": 2.1329281275620455, - "heading": -0.119658826861653, - "angularVelocity": -2.659522871824945, - "velocityX": -2.699900171191159, - "velocityY": -0.7665629280009049, + "x": 12.3153052167684, + "y": 2.134500210018156, + "heading": -0.1767990324670285, + "angularVelocity": -2.18913842698754, + "velocityX": -2.7201048554511935, + "velocityY": -0.6974912130254506, "moduleForcesX": [ - -114.04991592545967, - -113.57345993390194, - -105.8743122544602, - -89.38373476732247 + -109.45603084784327, + -99.09147098340229, + -104.32045073180943, + -71.24101923486771 ], "moduleForcesY": [ - 15.248423187591095, - 16.388126000916763, - -45.19852750676207, - -72.30427165301562 + 35.13049278248973, + 56.727219331269474, + -48.502488172187334, + -90.04553565784445 ], - "timestamp": 0.37161063982493303 + "timestamp": 0.3822387860132661 }, { - "x": 12.17519289047435, - "y": 2.089437332859002, - "heading": -0.2154342943934576, - "angularVelocity": -1.8041148472994986, - "velocityX": -3.058661490038241, - "velocityY": -0.819232633018052, + "x": 12.14665280523782, + "y": 2.093252415972482, + "heading": -0.24943106792656752, + "angularVelocity": -1.3301220776667324, + "velocityX": -3.0885585762431846, + "velocityY": -0.7553774469912005, "moduleForcesX": [ - -109.62064454997089, - -101.90531447708317, - -103.74089498833104, - -68.59046833424644 + -109.18925395485236, + -102.87029241138681, + -103.62950593233244, + -67.5771745078602 ], "moduleForcesY": [ - 34.45553967608259, - 50.94411816852015, - -49.68325972504408, - -92.07044431884985 + 34.902052219211484, + 46.81112964031985, + -49.45128884065186, + -92.47525829145374 ], - "timestamp": 0.42469787408563775 + "timestamp": 0.4368443268723041 }, { - "x": 11.993827203156602, - "y": 2.042600207999434, - "heading": -0.2677420696484354, - "angularVelocity": -0.9853173928425161, - "velocityX": -3.416370994711849, - "velocityY": -0.8822671874288431, + "x": 11.95823070560661, + "y": 2.047917121127896, + "heading": -0.2768116340377964, + "angularVelocity": -0.5014246847570069, + "velocityX": -3.450604035176877, + "velocityY": -0.8302325026249097, "moduleForcesX": [ - -109.2866023215497, - -104.44398071027051, - -103.15267730358437, - -65.84867153585363 + -108.8300334396521, + -103.51069866239682, + -101.6714557058711, + -62.588153422601906 ], "moduleForcesY": [ - 34.370980784960594, - 42.21513175186766, - -50.35760769522869, - -93.6724404068542 + 32.94109351617987, + 36.02257862078941, + -51.9503458632938, + -94.87769053752216 ], - "timestamp": 0.47778510834634247 + "timestamp": 0.49144986773134214 }, { - "x": 11.793836587977145, - "y": 1.9916718961789552, - "heading": -0.27766508814737484, - "angularVelocity": -0.18691910846605192, - "velocityX": -3.7672072761848483, - "velocityY": -0.9593325500887041, + "x": 11.76006896944174, + "y": 1.9924964021643288, + "heading": -0.2773174658125964, + "angularVelocity": -0.009263378163504579, + "velocityX": -3.628967556175626, + "velocityY": -1.0149284869576567, "moduleForcesX": [ - -108.88611511085563, - -103.69547133936662, - -101.19104160044988, - -61.605286218644906 + -68.62335338934369, + -24.81706564096114, + -62.366993278311014, + -29.7266448483014 ], "moduleForcesY": [ - 32.177770647209805, - 33.35515323370195, - -52.640976055772406, - -95.34817206799451 + -16.13797050297586, + -40.26298442970836, + -59.120123116749426, + -76.60001892131655 ], - "timestamp": 0.5308723426070472 + "timestamp": 0.5460554085903802 }, { - "x": 11.591451943279344, - "y": 1.933426458170254, - "heading": -0.2781082451680907, - "angularVelocity": -0.008347713473630615, - "velocityX": -3.8123034193854206, - "velocityY": -1.0971646728225646, + "x": 11.562226376151372, + "y": 1.9359085884076388, + "heading": -0.2777983149631616, + "angularVelocity": -0.008805867371710638, + "velocityX": -3.623123041690747, + "velocityY": -1.0363016804973944, "moduleForcesX": [ - -17.252714549210435, - -2.8125866154956327, - -20.620616684560133, - -7.564782178530354 + 1.5106753807232935, + 1.5405489498137173, + 1.4991886990742167, + 1.5290615087927133 ], "moduleForcesY": [ - -27.379147574375533, - -31.607890163153368, - -42.31980344027155, - -46.16688797563918 + -5.533911414001025, + -5.542359638354378, + -5.573858055453885, + -5.582305470869689 ], - "timestamp": 0.5839595768677519 + "timestamp": 0.6006609494494182 }, { - "x": 11.389273898801664, - "y": 1.8744592854650965, - "heading": -0.2785452808398492, - "angularVelocity": -0.008232406111274897, - "velocityX": -3.808411707507817, - "velocityY": -1.110759931767715, + "x": 11.364411791386928, + "y": 1.8792226813116377, + "heading": -0.2782788094947775, + "angularVelocity": -0.008799373178196058, + "velocityX": -3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - 1.038606533558001, - 1.0463397310111893, - 1.035632368601159, - 1.0433655330901692 + 0.1332558384274762, + 0.13367893133843997, + 0.13309362384339607, + 0.13351671673403107 ], "moduleForcesY": [ - -3.630285143013034, - -3.6324886421775022, - -3.6406473318268184, - -3.642850794642551 + -0.46681005875092235, + -0.4669309252933711, + -0.46737782224581564, + -0.46749868876945894 ], - "timestamp": 0.6370468111284566 + "timestamp": 0.6552664903084562 }, { - "x": 11.187060728663313, - "y": 1.8156128822911932, - "heading": -0.27898248808757475, - "angularVelocity": -0.008235638074089533, - "velocityX": -3.8090733667778998, - "velocityY": -1.1084850057344429, + "x": 11.166579234513257, + "y": 1.8225996642524476, + "heading": -0.27875936764242787, + "angularVelocity": -0.008800538188806259, + "velocityX": -3.6229392431872234, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - -0.17691923574930024, - -0.177135776816015, - -0.1768359899000005, - -0.17705253096240006 + -0.08556602339210856, + -0.0856419121099448, + -0.08553687515721092, + -0.08561276387472146 ], "moduleForcesY": [ - 0.6083390056735662, - 0.6084010281484636, - 0.6086295849668705, - 0.6086916074369444 + 0.2994423048828335, + 0.29946402445964476, + 0.2995441440606429, + 0.299565863636418 ], - "timestamp": 0.6901340453891613 + "timestamp": 0.7098720311674942 }, { - "x": 10.984313418298765, - "y": 1.7586381037974586, - "heading": -0.2794239203831664, - "angularVelocity": -0.008315224963949383, - "velocityX": -3.8191349236406036, - "velocityY": -1.0732293608278434, + "x": 10.968518470285098, + "y": 1.766782291857663, + "heading": -0.27924201654885805, + "angularVelocity": -0.008838826588608089, + "velocityX": -3.6271184409553947, + "velocityY": -1.0221924646598646, "moduleForcesX": [ - -2.689710937985897, - -2.695074176438558, - -2.687616330679038, - -2.6929795285133227 + -1.0860355533928898, + -1.0885317610039205, + -1.0850727795644968, + -1.0875689835908182 ], "moduleForcesY": [ - 9.42614694187036, - 9.427648428799488, - 9.43327212811977, - 9.43477357105278 + 3.8347296996097495, + 3.835442563757532, + 3.8380739343659003, + 3.8387867944503786 ], - "timestamp": 0.7432212796498661 + "timestamp": 0.7644775720265322 }, { - "x": 10.778488668647217, - "y": 1.7140924382303233, - "heading": -0.27990255467751685, - "angularVelocity": -0.009015996049068832, - "velocityX": -3.8771044021764074, - "velocityY": -0.8391031513975062, + "x": 10.768382316330444, + "y": 1.7189715185814527, + "heading": -0.2797518256877861, + "angularVelocity": -0.00933621626867676, + "velocityX": -3.665125384826737, + "velocityY": -0.8755663349188755, "moduleForcesX": [ - -15.492703910893802, - -15.55336531368553, - -15.458920515444744, - -15.519558726536355 + -9.874094547382661, + -9.909831175721294, + -9.85761782165409, + -9.893348215058941 ], "moduleForcesY": [ - 62.59915932231857, - 62.60222625959514, - 62.649654814616326, - 62.65272108090153 + 38.10667280305693, + 38.11330911683297, + 38.14707559852625, + 38.15370784735128 ], - "timestamp": 0.7963085139105708 + "timestamp": 0.8190831128855702 }, { - "x": 10.569281338812399, - "y": 1.6902969703482535, - "heading": -0.2804899410650269, - "angularVelocity": -0.011064550558905711, - "velocityX": -3.9408217954513325, - "velocityY": -0.44823333167467494, + "x": 10.564408931858496, + "y": 1.6921473086815817, + "heading": -0.28038185385941405, + "angularVelocity": -0.011537806634941384, + "velocityX": -3.7353972007803753, + "velocityY": -0.4912360445090406, "moduleForcesX": [ - -16.989466098780625, - -17.26841193735081, - -16.819178445964713, - -17.097483761569933 + -18.223496328433487, + -18.496021684044194, + -18.05270477943314, + -18.32464726681692 ], "moduleForcesY": [ - 104.53971564488899, - 104.50562642972606, - 104.6000776405437, - 104.56645125313038 + 99.92208309280701, + 99.88968062550067, + 100.00063874310935, + 99.96866077815216 ], - "timestamp": 0.8493957481712755 + "timestamp": 0.8736886537446082 }, { "x": 10.358807563781738, "y": 1.6887441873550415, "heading": -0.28131737276900265, - "angularVelocity": -0.015586265050319821, - "velocityX": -3.964677722652637, - "velocityY": -0.029249649465378225, + "angularVelocity": -0.017132307360595633, + "velocityX": -3.765210724814718, + "velocityY": -0.06232190493864942, "moduleForcesX": [ - -6.18572157157631, - -6.9202746933831, - -5.844740651408106, - -6.573955564662377 + -7.529271015507784, + -8.398980799855844, + -7.110732370059438, + -7.973097440144591 ], "moduleForcesY": [ - 112.06720187117625, - 112.03161900342097, - 112.11336799839647, - 112.08016014025495 + 111.53171815583704, + 111.47999858137479, + 111.59688033555024, + 111.54866670440515 ], - "timestamp": 0.9024829824319802 + "timestamp": 0.9282941946036463 }, { - "x": 10.074031104225313, - "y": 1.7288019189642057, - "heading": -0.28133183349243884, - "angularVelocity": -0.00019962394982934355, - "velocityX": -3.931214224926528, - "velocityY": 0.5529794301309934, + "x": 10.08393736820923, + "y": 1.7277034984607378, + "heading": -0.28133184198304767, + "angularVelocity": -0.00019656089199339045, + "velocityX": -3.734047381979395, + "velocityY": 0.5292531383220508, "moduleForcesX": [ - 5.868356427204316, - 7.872028825010418, - 5.2245262323577535, - 7.274148654405299 + 5.273262788820698, + 7.435057509898819, + 4.561459737278025, + 6.776645494665948 ], "moduleForcesY": [ - 114.19123917565138, - 114.06618405796584, - 114.19557828660732, - 114.07858878844017 + 114.17857048927304, + 114.05312633616373, + 114.17906174500055, + 114.06354518890141 ], - "timestamp": 0.9749228046504577 + "timestamp": 1.0019060606177304 }, { - "x": 9.797922122377006, - "y": 1.8092440058536325, - "heading": -0.2813429282119763, - "angularVelocity": -0.00015315774111119407, - "velocityX": -3.8115634935652762, - "velocityY": 1.1104677569033128, + "x": 9.818202185590613, + "y": 1.8080829466543498, + "heading": -0.28134297586169704, + "angularVelocity": -0.0001512511399625565, + "velocityX": -3.609950365444831, + "velocityY": 1.0919360226275558, "moduleForcesX": [ - 23.452096627965147, - 23.458196144337972, - 23.451465640201057, - 23.45756560307959 + 23.93648599054604, + 23.942282612665448, + 23.93591950874844, + 23.941716534513144 ], "moduleForcesY": [ - 109.28376366394927, - 109.2824400014251, - 109.28362046955922, - 109.28229674147876 + 108.54583486390916, + 108.54454153578949, + 108.54564914640099, + 108.54435575416598 ], - "timestamp": 1.047362626868935 + "timestamp": 1.0755179266318144 }, { - "x": 9.530417627011207, - "y": 1.9148302457499569, - "heading": -0.2813548125722149, - "angularVelocity": -0.0001640583849411106, - "velocityX": -3.692782328468601, - "velocityY": 1.457571770094606, + "x": 9.55957700395428, + "y": 1.909026956405172, + "heading": -0.28135415722511536, + "angularVelocity": -0.00015189620945305375, + "velocityX": -3.5133626633897372, + "velocityY": 1.3713007863638298, "moduleForcesX": [ - 23.284729079604, - 23.283902232747476, - 23.284842009272996, - 23.284015169836746 + 18.632396331688547, + 18.63235498740305, + 18.632405037196314, + 18.632363692926397 ], "moduleForcesY": [ - 68.04154028777809, - 68.04180366771809, - 68.04204433937217, - 68.04230771680363 + 53.89121026384353, + 53.89122312286384, + 53.89124460812597, + 53.891257467141436 ], - "timestamp": 1.1198024490874126 + "timestamp": 1.1491297926458985 }, { - "x": 9.293245060968994, - "y": 2.010127611481761, - "heading": -0.3014330787042576, - "angularVelocity": -0.2771716649370988, - "velocityX": -3.2740633366949123, - "velocityY": 1.315538371206782, + "x": 9.314078063004189, + "y": 2.00599679218808, + "heading": -0.3009876013168922, + "angularVelocity": -0.26671575052886687, + "velocityX": -3.335045750682662, + "velocityY": 1.3173125615964598, "moduleForcesX": [ - 81.01560658870925, - 75.11544611300343, - 88.38909893685307, - 83.80155867415682 + 37.2832858474123, + 25.84642277568476, + 42.75006123891907, + 31.714081507752265 ], "moduleForcesY": [ - -39.65492799695376, - -40.25210144011162, - -17.310769456098512, - -14.151996507909613 + -21.015362736520213, + -18.1500142144038, + -3.319730193685859, + 0.8264239519393597 ], - "timestamp": 1.19224227130589 + "timestamp": 1.2227416586599826 }, { - "x": 9.09552927538301, - "y": 2.0895893588177756, - "heading": -0.31844570606675093, - "angularVelocity": -0.23485186519623918, - "velocityX": -2.729379773871831, - "velocityY": 1.096934598988375, + "x": 9.10941935629468, + "y": 2.086840876505934, + "heading": -0.31798427093228115, + "angularVelocity": -0.23089578536342262, + "velocityX": -2.7802407110607743, + "velocityY": 1.0982479958107088, "moduleForcesX": [ - 107.5793065716789, - 107.64208344195727, - 105.87575754009715, - 105.99463103451073 + 107.68858293139235, + 107.738552826401, + 106.29323252806583, + 106.38126830053615 ], "moduleForcesY": [ - -40.83034886509639, - -40.697127559381315, - -45.06642730066156, - -44.81548009939982 + -40.5682562760582, + -40.462053452478216, + -44.096907679115134, + -43.90855630284436 ], - "timestamp": 1.2646820935243674 + "timestamp": 1.2963535246740667 }, { - "x": 8.937331011810468, - "y": 2.153175677565822, - "heading": -0.33216267776880665, - "angularVelocity": -0.1893567830783133, - "velocityX": -2.1838577004705906, - "velocityY": 0.8777812645132024, + "x": 8.945665590155809, + "y": 2.151528839125374, + "heading": -0.3318177617543003, + "angularVelocity": -0.18792474054892708, + "velocityX": -2.224556651064109, + "velocityY": 0.8787708575009153, "moduleForcesX": [ - 107.81855559484976, - 107.86118930596342, - 105.98182204499231, - 106.08769609512697 + 108.00459288569083, + 108.03895547091057, + 106.32434275384833, + 106.41201988616298 ], "moduleForcesY": [ - -40.76058786716746, - -40.66527143933629, - -45.32350556529571, - -45.0909361635883 + -40.28289239333359, + -40.20672149366398, + -44.52996596613108, + -44.33454527838807 ], - "timestamp": 1.337121915742845 + "timestamp": 1.3699653906881508 }, { - "x": 8.8186706046164, - "y": 2.2008731582030556, - "heading": -0.3425003600582634, - "angularVelocity": -0.1427071736631058, - "velocityX": -1.6380549200713106, - "velocityY": 0.65844281745169, + "x": 8.822838083638423, + "y": 2.2000505965479666, + "heading": -0.3423020852827545, + "angularVelocity": -0.1424270854164775, + "velocityX": -1.6685829767430085, + "velocityY": 0.6591567372209985, "moduleForcesX": [ - 107.90467393449282, - 107.93229359869257, - 106.0198371641577, - 106.11256348212794 + 108.11666519143748, + 108.1367372735272, + 106.33573686070704, + 106.41424542733333 ], "moduleForcesY": [ - -40.72210440542275, - -40.66091896254574, - -45.404374735866405, - -45.19805154468376 + -40.168809305270315, + -40.12609997700313, + -44.67103028526917, + -44.4938843255294 ], - "timestamp": 1.4095617379613223 + "timestamp": 1.443577256702235 }, { - "x": 8.739558229904278, - "y": 2.232675064823596, - "heading": -0.3494154778567653, - "angularVelocity": -0.09546017075588695, - "velocityX": -1.0921116630231633, - "velocityY": 0.439011384161408, + "x": 8.740947438367238, + "y": 2.232401107243289, + "heading": -0.34934249092246195, + "angularVelocity": -0.09564226558745821, + "velocityX": -1.1124652818272123, + "velocityY": 0.4394741289282456, "moduleForcesX": [ - 107.94946633207205, - 107.96697591893108, - 106.03987686308874, - 106.12319819766434 + 108.1744880611608, + 108.18447910649813, + 106.34236528854647, + 106.41318223955082 ], "moduleForcesY": [ - -40.698520186674784, - -40.66122527870845, - -45.442664241769215, - -45.25595136469532 + -40.1066849659844, + -40.088485624896734, + -44.739176472038366, + -44.57832391748549 ], - "timestamp": 1.4820015601797998 + "timestamp": 1.517189122716319 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -0.047850528600588194, - "velocityX": -0.5460840279946031, - "velocityY": 0.2195241654092463, + "angularVelocity": -0.048080165750898934, + "velocityX": -0.556261382633667, + "velocityY": 0.21975056429240547, "moduleForcesX": [ - 107.97604331480812, - 107.9882753754576, - 106.05139834798732, - 106.12996188400123 + 108.20892496086539, + 108.21348472478888, + 106.3458501916204, + 106.41277222504725 ], "moduleForcesY": [ - -40.68522330978408, - -40.660146907176184, - -45.466900880102564, - -45.28983190819318 + -40.06999069497857, + -40.064797915468255, + -44.78118450203358, + -44.62830082076761 ], - "timestamp": 1.5544413823982772 + "timestamp": 1.590800988730403 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -4.8288976906928006e-27, - "velocityX": 1.7587671009889585e-26, - "velocityY": 3.3751021564294008e-25, + "angularVelocity": 7.228649510679406e-23, + "velocityX": 2.8012684640616525e-22, + "velocityY": -6.2742965542830935e-22, "moduleForcesX": [ - 107.99223491781001, - 108.0040016915483, - 106.05743685003779, - 106.13622374630019 + 108.23038445425983, + 108.23430457634595, + 106.34652059702094, + 106.41417815468229 ], "moduleForcesY": [ - -40.68042792406633, - -40.65537952997916, - -45.48693154917796, - -45.30833424193728 + -40.04952106692136, + -40.0449273344048, + -44.81309642327084, + -44.65756272827848 ], - "timestamp": 1.6268812046167547 + "timestamp": 1.6644128547444872 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Source 4 Piece.4.traj b/src/main/deploy/choreo/Red Source 4 Piece.4.traj index 592c879..7a2ecaa 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.4.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.4.traj @@ -4,589 +4,589 @@ "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -4.8288976906928006e-27, - "velocityX": 1.7587671009889585e-26, - "velocityY": 3.3751021564294008e-25, + "angularVelocity": 7.228649510679406e-23, + "velocityX": 2.8012684640616525e-22, + "velocityY": -6.2742965542830935e-22, "moduleForcesX": [ - 107.99223491781001, - 108.0040016915483, - 106.05743685003779, - 106.13622374630019 + 108.23038445425983, + 108.23430457634595, + 106.34652059702094, + 106.41417815468229 ], "moduleForcesY": [ - -40.68042792406633, - -40.65537952997916, - -45.48693154917796, - -45.30833424193728 + -40.04952106692136, + -40.0449273344048, + -44.81309642327084, + -44.65756272827848 ], "timestamp": 0 }, { - "x": 8.733926813861677, - "y": 2.235358433045618, - "heading": -0.35026869308585346, - "angularVelocity": 0.03903296429686566, - "velocityX": 0.5067850635723455, - "velocityY": -0.19745894526536673, + "x": 8.735160496003328, + "y": 2.2353073040625637, + "heading": -0.34950341211539854, + "angularVelocity": 0.049669524785278404, + "velocityX": 0.5169403325880028, + "velocityY": -0.195100354566496, "moduleForcesX": [ - 108.31232931165216, - 108.31646484929276, - 106.65379169981476, - 106.70790819705412 + 108.92708748634631, + 108.91169498268742, + 106.90012644635497, + 106.95921424095818 ], "moduleForcesY": [ - -39.790421347467806, - -39.78562240023523, - -44.043414234869644, - -43.917976590357014 + -38.06986059379512, + -38.12247627099088, + -43.43729059553142, + -43.29915093821453 ], - "timestamp": 0.066945173211157 + "timestamp": 0.06801654617913311 }, { - "x": 8.801777689763007, - "y": 2.208924184045344, - "heading": -0.3450752782075868, - "angularVelocity": 0.07757713706835337, - "velocityX": 1.0135290215370254, - "velocityY": -0.3948641512494974, + "x": 8.805476972134196, + "y": 2.20876912539207, + "heading": -0.34277198887220717, + "angularVelocity": 0.09896743691546771, + "velocityX": 1.0338142713932752, + "velocityY": -0.39017239423773575, "moduleForcesX": [ - 108.28996331730457, - 108.30053379408332, - 106.65261534540024, - 106.71250484198276 + 108.90060339205657, + 108.8953561059007, + 106.88867772089172, + 106.95804032881324 ], "moduleForcesY": [ - -39.81362083255557, - -39.7923038373262, - -44.01229472070396, - -43.873619165906334 + -38.097560026146894, + -38.122799476396146, + -43.42345092393567, + -43.26132213447991 ], - "timestamp": 0.133890346422314 + "timestamp": 0.13603309235826622 }, { - "x": 8.903548768119284, - "y": 2.1692796518761055, - "heading": -0.3373473298717038, - "angularVelocity": 0.11543697573994958, - "velocityX": 1.5202153265818417, - "velocityY": -0.5921940338281327, + "x": 8.910942661149685, + "y": 2.168965701827033, + "heading": -0.33272524311327834, + "angularVelocity": 0.14771031937536208, + "velocityX": 1.5505887161298455, + "velocityY": -0.5852020692172026, "moduleForcesX": [ - 108.25850057581366, - 108.27833136732968, - 106.65081131519337, - 106.71905743006441 + 108.86109478467073, + 108.87073710864843, + 106.87169078257577, + 106.9560671341383 ], "moduleForcesY": [ - -39.84643901580114, - -39.80130085429087, - -43.969072663952105, - -43.81111658495434 + -38.13854642095758, + -38.123667627725496, + -43.40238220899807, + -43.20515744662125 ], - "timestamp": 0.20083551963347102 + "timestamp": 0.20404963853739932 }, { - "x": 9.039234239007644, - "y": 2.1164324000873393, - "heading": -0.3271533501766025, - "angularVelocity": 0.15227355769097134, - "velocityX": 2.0268148453419146, - "velocityY": -0.7894109351554927, + "x": 9.051546291570848, + "y": 2.1159017878510578, + "heading": -0.3194253273769413, + "angularVelocity": 0.19553941626658664, + "velocityX": 2.067197444146294, + "velocityY": -0.7801618423291163, "moduleForcesX": [ - 108.21238741016386, - 108.24396960661257, - 106.6491337463018, - 106.7275746109919 + 108.79813451721276, + 108.8272916619506, + 106.8462010419442, + 106.94957215478408 ], "moduleForcesY": [ - -39.89260206806913, - -39.81751467144118, - -43.901653051914266, - -43.72029844384376 + -38.1988424152394, + -38.13223147648961, + -43.36068150975463, + -43.11962308400631 ], - "timestamp": 0.267780692844628 + "timestamp": 0.27206618471653243 }, { - "x": 9.208824365155895, - "y": 2.0503950328281664, - "heading": -0.31460646106714574, - "angularVelocity": 0.1874203696490803, - "velocityX": 2.533268912656832, - "velocityY": -0.9864395607862412, + "x": 9.22726536615065, + "y": 2.049586749721687, + "heading": -0.30299277062018, + "angularVelocity": 0.2415964596832561, + "velocityX": 2.5834754107775137, + "velocityY": -0.9749839098668391, "moduleForcesX": [ - 108.13878069799291, - 108.18385543698201, - 106.64908314006513, - 106.7379353214454 + 108.6811050373854, + 108.73406931364026, + 106.80275120146628, + 106.92705418988609 ], "moduleForcesY": [ - -39.96046705876718, - -39.851878052023736, - -43.78233752560014, - -43.57763984939862 + -38.29522411554184, + -38.1683694994336, + -43.25999294811074, + -42.97279366403858 ], - "timestamp": 0.334725866055785 + "timestamp": 0.34008273089566554 }, { - "x": 9.412299498127187, - "y": 1.971192793059601, - "heading": -0.2999281888843931, - "angularVelocity": 0.21925811046084911, - "velocityX": 3.0394294795458103, - "velocityY": -1.1830911172452587, + "x": 9.438033057725468, + "y": 1.970048065593295, + "heading": -0.2837631233482766, + "angularVelocity": 0.2827201372627604, + "velocityX": 3.0987708640736242, + "velocityY": -1.1694019852009818, "moduleForcesX": [ - 107.99968413751532, - 108.05776232379695, - 106.65408367462612, - 106.74909898164714 + 108.3626740241462, + 108.4418328543596, + 106.6908681014183, + 106.82910549783023 ], "moduleForcesY": [ - -40.073559976513465, - -39.93516235271832, - -43.53014008693058, - -43.31352925259886 + -38.50231437653497, + -38.32060078212658, + -42.92203871274231, + -42.61405148852438 ], - "timestamp": 0.40167103926694203 + "timestamp": 0.40809927707479865 }, { - "x": 9.64959962518174, - "y": 1.8789019078745433, - "heading": -0.28374565683521485, - "angularVelocity": 0.24172813771256552, - "velocityX": 3.5446936003297025, - "velocityY": -1.3786040241311388, + "x": 9.678076559868247, + "y": 1.879644856366163, + "heading": -0.28374820647577687, + "angularVelocity": 0.00021931240760807876, + "velocityX": 3.529192757165067, + "velocityY": -1.329135545769102, "moduleForcesX": [ - 107.61137555141407, - 107.67012594458993, - 106.67046549630616, - 106.74805702593525 + 87.67092010469722, + 82.29673746119292, + 96.41433044145562, + 93.06437688109202 ], "moduleForcesY": [ - -40.33210283996674, - -40.200949635022816, - -42.761473825206764, - -42.59175857555703 + -45.81494056023983, + -48.188084286902104, + -20.914888530025944, + -18.475969737183867 ], - "timestamp": 0.46861621247809904 + "timestamp": 0.47611582325393176 }, { - "x": 9.900298294638016, - "y": 1.790758792782665, - "heading": -0.2837335320815777, - "angularVelocity": 0.00018111468020203295, - "velocityX": 3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 9.91942147309829, + "y": 1.7927653335156666, + "heading": -0.2837356440414742, + "angularVelocity": 0.00018469673937243685, + "velocityX": 3.5483264997669806, + "velocityY": -1.2773292342966782, "moduleForcesX": [ - 46.83355979424887, - 35.139698926947005, - 49.463406566005, - 38.377272751925325 + 3.9952241861110123, + 3.993394223196805, + 3.995923175642631, + 3.9940931809808093 ], "moduleForcesY": [ - 1.5254319217028312, - 6.193009340047282, - 19.63550881795331, - 25.21513933953295 + 10.81442104002948, + 10.814957408993081, + 10.816830640829714, + 10.81736703378314 ], - "timestamp": 0.535561385689256 + "timestamp": 0.5441323694330649 }, { - "x": 10.15979314102593, - "y": 1.7334916000286844, - "heading": -0.2837214488432004, - "angularVelocity": 0.00018049454199105732, - "velocityX": 3.8762293671183365, - "velocityY": -0.8554342308346725, + "x": 10.169106994861316, + "y": 1.7340196610481893, + "heading": -0.28372258147039636, + "angularVelocity": 0.00019204990273192154, + "velocityX": 3.670952669449541, + "velocityY": -0.8636967880250899, "moduleForcesX": [ - 27.870855303386527, - 27.87078008363208, - 27.87085955385126, - 27.87078433416476 + 25.60101320769064, + 25.601760187553346, + 25.600945387189146, + 25.60169237360391 ], "moduleForcesY": [ - 97.83081049698777, - 97.83083198961774, - 97.83082304661332, - 97.83084453922426 + 86.35659720719445, + 86.35637664311918, + 86.35635196045361, + 86.35613139442138 ], - "timestamp": 0.602506558900413 + "timestamp": 0.612148915612198 }, { "x": 10.424600601196287, "y": 1.7113943099975586, "heading": -0.2837047824958171, - "angularVelocity": 0.00024895517606220293, - "velocityX": 3.9555870493471943, - "velocityY": -0.3300804071628431, + "angularVelocity": 0.00026168595112677055, + "velocityX": 3.756344899696669, + "velocityY": -0.33264480955917264, "moduleForcesX": [ - 16.829101110309146, - 16.838915102240243, - 16.827278780287177, - 16.837093906581575 + 17.823774151167182, + 17.83355423810466, + 17.822074295255895, + 17.83185551284743 ], "moduleForcesY": [ - 111.43715289160197, - 111.43563757699792, - 111.43710122782548, - 111.43558589017641 + 110.87155302236657, + 110.86994540179049, + 110.87145101626253, + 110.86984335012644 ], - "timestamp": 0.66945173211157 + "timestamp": 0.6801654617913311 }, { - "x": 10.649647240268498, - "y": 1.7185557092564774, - "heading": -0.28304825482562407, - "angularVelocity": 0.011565209036453545, - "velocityX": 3.9643590696733866, - "velocityY": 0.1261532197089931, + "x": 10.644414774625627, + "y": 1.7193809732535479, + "heading": -0.2828019280537436, + "angularVelocity": 0.015459837026566284, + "velocityX": 3.7639414937610223, + "velocityY": 0.13675793856658902, "moduleForcesX": [ - 1.612409435028023, - 3.449197442112493, - 0.920737067471497, - 2.7948238151606644 + 1.09713864157884, + 3.483800587637876, + 0.17889110374315617, + 2.6287399657540216 ], "moduleForcesY": [ - 114.15637546330666, - 114.11007946252991, - 114.1356704809822, - 114.09921998413924 + 114.17621366105449, + 114.12110918273105, + 114.14468636650177, + 114.10669848112909 ], - "timestamp": 0.726219203250543 + "timestamp": 0.7385654591860025 }, { - "x": 10.872486526800158, - "y": 1.7511786253728163, - "heading": -0.2825635463774615, - "angularVelocity": 0.008538489357327173, - "velocityX": 3.9254749605830384, - "velocityY": 0.5746762267509568, + "x": 10.861693485566251, + "y": 1.754234167279391, + "heading": -0.2821930397682389, + "angularVelocity": 0.010426169737471161, + "velocityX": 3.720526038250279, + "velocityY": 0.5968012941901759, "moduleForcesX": [ - -9.617734238949605, - -10.066815271135845, - -9.387604811781262, - -9.834772017123038 + -10.385540743401451, + -11.10514334159848, + -10.010565773367109, + -10.725324626777565 ], "moduleForcesY": [ - 112.19647225066657, - 112.1614659010998, - 112.23111915488862, - 112.19714365211973 + 111.86098322186378, + 111.79973293870482, + 111.92171623690528, + 111.86317871279545 ], - "timestamp": 0.782986674389516 + "timestamp": 0.7969654565806739 }, { - "x": 11.090604076378652, - "y": 1.8073745478916146, - "heading": -0.28216255506909754, - "angularVelocity": 0.007063751481588911, - "velocityX": 3.842298154246073, - "velocityY": 0.9899317582991157, + "x": 11.073781283880631, + "y": 1.813061818721627, + "heading": -0.28170357599097573, + "angularVelocity": 0.008381229436627325, + "velocityX": 3.6316405441095316, + "velocityY": 1.0073228436069037, "moduleForcesX": [ - -20.776539685058307, - -20.95690176428432, - -20.656026809805056, - -20.836146342062964 + -21.575934691647564, + -21.80574823449794, + -21.420174805115277, + -21.649612023660485 ], "moduleForcesY": [ - 103.86595800234613, - 103.83805579833923, - 103.91143822729335, - 103.88375203666148 + 99.80080758549971, + 99.76654159220668, + 99.87324161618055, + 99.83931034438025 ], - "timestamp": 0.8397541455284889 + "timestamp": 0.8553654539753452 }, { - "x": 11.305331510363592, - "y": 1.8754073625880365, - "heading": -0.2817861235290747, - "angularVelocity": 0.006631113425879257, - "velocityX": 3.7825788198185237, - "velocityY": 1.1984471622818953, + "x": 11.283587635771832, + "y": 1.8795916481170019, + "heading": -0.2812364772082353, + "angularVelocity": 0.007998267184563267, + "velocityX": 3.592574678956124, + "velocityY": 1.1392094582772114, "moduleForcesX": [ - -14.93113836042353, - -14.963264037670038, - -14.913927685174185, - -14.946047731778885 + -9.49218404818873, + -9.517076511502912, + -9.480971029856981, + -9.50586093834778 ], "moduleForcesY": [ - 52.14197332650795, - 52.14527104247297, - 52.17361050090557, - 52.17690623845406 + 32.05124416889292, + 32.0564927746003, + 32.08103597153202, + 32.086282418465686 ], - "timestamp": 0.8965216166674619 + "timestamp": 0.9137654513700166 }, { - "x": 11.519652692450972, - "y": 1.9447110026462533, - "heading": -0.28141169188970344, - "angularVelocity": 0.006595883731628649, - "velocityX": 3.7754223992591815, - "velocityY": 1.2208336687846026, + "x": 11.493202658637001, + "y": 1.9467231127720637, + "heading": -0.2807706851083828, + "angularVelocity": 0.007975892476580818, + "velocityX": 3.5892984968573782, + "velocityY": 1.1495114323615963, "moduleForcesX": [ - -1.7894810492252815, - -1.7916911360220178, - -1.7886188443613336, - -1.7908289271510018 + -0.7961996165924138, + -0.7975621457668051, + -0.7956717132450022, + -0.7970342417583107 ], "moduleForcesY": [ - 5.59811618322889, - 5.598749349977472, - 5.601072120131871, - 5.6017052821445015 + 2.5038569339269885, + 2.5042491658535546, + 2.505684173989879, + 2.506076405059044 ], - "timestamp": 0.9532890878064348 + "timestamp": 0.972165448764688 }, { - "x": 11.733959431080516, - "y": 2.014059333930838, - "heading": -0.281037272981895, - "angularVelocity": 0.006595659455954908, - "velocityX": 3.77516796731879, - "velocityY": 1.2216209370118305, + "x": 11.702813327657477, + "y": 2.0138681893180537, + "heading": -0.2803048424702293, + "angularVelocity": 0.007976757858486104, + "velocityX": 3.5892239447189, + "velocityY": 1.1497445126960992, "moduleForcesX": [ - -0.06364100877139726, - -0.06365505243487238, - -0.06363556826688263, - -0.06364961193035205 + -0.01814381941383678, + -0.018091134855889958, + -0.018164173207132702, + -0.018111488649066233 ], "moduleForcesY": [ - 0.1969210992616689, - 0.19692515330886895, - 0.19693994534373072, - 0.1969439993909239 + 0.05671736020618125, + 0.0567021930988224, + 0.05664665917209394, + 0.05663149206454538 ], - "timestamp": 1.0100565589454078 + "timestamp": 1.0305654461593594 }, { - "x": 11.94849901356588, - "y": 2.082663911446821, - "heading": -0.2806488087861412, - "angularVelocity": 0.006843077346228324, - "velocityX": 3.779269679992362, - "velocityY": 1.2085191772596517, + "x": 11.912555116213372, + "y": 2.0806013070151295, + "heading": -0.27983771695717125, + "angularVelocity": 0.007998724895503196, + "velocityX": 3.591469142343322, + "velocityY": 1.1426904225027354, "moduleForcesX": [ - 1.0212819494692333, - 1.0367870294859038, - 1.015272810913435, - 1.0307777743362587 + 0.545518088488526, + 0.5468558718661225, + 0.5450018966008922, + 0.5463396795091038 ], "moduleForcesY": [ - -3.264742509835954, - -3.2691983489944296, - -3.285525660592635, - -3.289981363380365 + -1.7141411533773943, + -1.7145252782998055, + -1.7159358500537687, + -1.7163199744295505 ], - "timestamp": 1.0668240300843808 + "timestamp": 1.0889654435540308 }, { - "x": 12.152037072754059, - "y": 2.142322529407559, - "heading": -0.2510180942418901, - "angularVelocity": 0.5219664351739706, - "velocityX": 3.585469902118673, - "velocityY": 1.0509296391711178, + "x": 12.123582090461483, + "y": 2.141695128776019, + "heading": -0.2784545161826354, + "angularVelocity": 0.023684945826077396, + "velocityX": 3.613475747643897, + "velocityY": 1.0461271316163527, "moduleForcesX": [ - -67.96426240208135, - -30.062890973818163, - -63.34891083146934, - -32.53743564226132 + 5.056830451597807, + 6.052976456784937, + 4.650734177456533, + 5.643439292990552 ], "moduleForcesY": [ - -8.235178803765649, - -27.016971831599303, - -52.69317016977563, - -69.73669104087452 + -22.732394581032693, + -22.979924677069157, + -23.981026840246905, + -24.225672996948276 ], - "timestamp": 1.1235915012233537 + "timestamp": 1.1473654409487022 }, { - "x": 12.334148820301001, - "y": 2.1971654821119366, - "heading": -0.17114703208449755, - "angularVelocity": 1.406986440559578, - "velocityX": 3.208029949072625, - "velocityY": 0.966098217940971, + "x": 12.312845499111194, + "y": 2.1960087754333726, + "heading": -0.22597278443049482, + "angularVelocity": 0.8986598303672022, + "velocityX": 3.240811936525529, + "velocityY": 0.930028237677772, "moduleForcesX": [ - -110.90141886725935, - -104.51767942702155, - -99.94508162050465, - -62.2972554143191 + -110.09390991333008, + -103.48471382580139, + -96.45188523190053, + -52.42834336586494 ], "moduleForcesY": [ - 26.85599963756138, - 39.311826008079045, - -55.67355131570806, - -95.37547475461713 + 24.89118915347873, + 22.28582245406149, + -60.0582233614142, + -100.03845095304496 ], - "timestamp": 1.1803589723623267 + "timestamp": 1.2057654383433736 }, { - "x": 12.494844000544365, - "y": 2.247628220403907, - "heading": -0.03691006304613977, - "angularVelocity": 2.36468115181193, - "velocityX": 2.8307616495715395, - "velocityY": 0.8889375777975359, + "x": 12.479529781632614, + "y": 2.2449867624612256, + "heading": -0.1184996439866557, + "angularVelocity": 1.84029358284946, + "velocityX": 2.8541830472175405, + "velocityY": 0.8386641988501548, "moduleForcesX": [ - -112.18575793402451, - -101.8689939557043, - -99.30217040259397, - -64.13275876528363 + -111.9090944895469, + -104.84618511277107, + -98.77086477361028, + -60.51536896101172 ], "moduleForcesY": [ - 24.489794047684235, - 51.11251099285013, - -57.83793809446346, - -94.97028505916231 + 24.43643622108832, + 42.12552095732977, + -58.374344881869746, + -97.04975471639112 ], - "timestamp": 1.2371264435012996 + "timestamp": 1.264165435738045 }, { - "x": 12.633730382727341, - "y": 2.2936459171983987, - "heading": 0.15068702087135824, - "angularVelocity": 3.3046581105971575, - "velocityX": 2.4465839220310848, - "velocityY": 0.8106349617342448, + "x": 12.623809461398077, + "y": 2.289494145161703, + "heading": 0.04954714385936545, + "angularVelocity": 2.8775136188850925, + "velocityX": 2.470542571952716, + "velocityY": 0.7621127514731357, "moduleForcesX": [ - -113.52781849420326, - -101.72159587923039, - -98.27794501691677, - -70.87580416849228 + -112.53923361529047, + -98.88615121430331, + -98.21581874489462, + -63.49372991199005 ], "moduleForcesY": [ - 18.795877029064826, - 53.03473995293743, - -59.883306375450104, - -90.29587475253841 + 23.427197480933216, + 57.43559858001425, + -59.82012493838722, + -95.49784743209881 ], - "timestamp": 1.2938939146402726 + "timestamp": 1.3225654331327164 }, { - "x": 12.747373227511964, - "y": 2.33297655165956, - "heading": 0.33465067573891905, - "angularVelocity": 3.2406526339212256, - "velocityX": 2.0019007805793065, - "velocityY": 0.692837529522422, + "x": 12.742567636762507, + "y": 2.329195026608957, + "heading": 0.2532418400568153, + "angularVelocity": 3.4879230356958084, + "velocityX": 2.033530490795285, + "velocityY": 0.679809644150375, "moduleForcesX": [ - -110.15119273382385, - -110.09590584370162, - -112.42030542510648, - -112.27667812755305 + -114.89005050626218, + -111.51397335746597, + -103.13454077524403, + -95.5064562830338 ], "moduleForcesY": [ - -33.543041884285, - -33.78436386293674, - -24.91070248135435, - -25.628447678324406 + 7.12526379432016, + 27.76672389886986, + -51.10134531295922, + -63.839976213971404 ], - "timestamp": 1.3506613857792455 + "timestamp": 1.3809654305273877 }, { - "x": 12.836684119739113, - "y": 2.3652177680520627, - "heading": 0.49472956453813244, - "angularVelocity": 2.8199052307142933, - "velocityX": 1.5732758644207596, - "velocityY": 0.567952310462666, + "x": 12.83479843521252, + "y": 2.3624207500453496, + "heading": 0.44054512932062534, + "angularVelocity": 3.2072482469134482, + "velocityX": 1.5792945644622498, + "velocityY": 0.5689336458673059, "moduleForcesX": [ - -99.1906995535979, - -99.97859392638925, - -115.15979579307127, - -114.54734457522899 + -106.34982483559645, + -105.95228683396374, + -115.09460575424762, + -114.4004939951579 ], "moduleForcesY": [ - -58.57964610086167, - -57.39726866081906, - 4.13728262086476, - -13.118869737078935 + -44.17247603120524, + -45.29021140358265, + -4.506204608148659, + -13.87089784378298 ], - "timestamp": 1.4074288569182185 + "timestamp": 1.4393654279220591 }, { - "x": 12.902648711217271, - "y": 2.3899438580710273, - "heading": 0.6212528884768642, - "angularVelocity": 2.2287997228023118, - "velocityX": 1.162013916678965, - "velocityY": 0.4355679321777755, + "x": 12.902153785945606, + "y": 2.388339311177531, + "heading": 0.5920521705772573, + "angularVelocity": 2.5942987673909688, + "velocityX": 1.1533450982521831, + "velocityY": 0.44381099808998664, "moduleForcesX": [ - -90.92322148643733, - -92.24578923617236, - -113.61714858975364, - -114.71711750544789 + -92.38930111082509, + -93.92589046885863, + -112.97863519241551, + -114.99151586069087 ], "moduleForcesY": [ - -70.78350796787741, - -69.22716039877027, - 19.619781271549844, - -12.071174524868752 + -68.80392001259384, + -66.8988698725461, + 22.89679875087174, + -8.890320559157662 ], - "timestamp": 1.4641963280571915 + "timestamp": 1.4977654253167305 }, { - "x": 12.946021910632137, - "y": 2.4067236714663482, - "heading": 0.7092144892181306, - "angularVelocity": 1.549507120476202, - "velocityX": 0.7640502306097657, - "velocityY": 0.2955885308725854, + "x": 12.94599898532897, + "y": 2.4061455217676833, + "heading": 0.6987986006648391, + "angularVelocity": 1.8278499118104674, + "velocityX": 0.7507739955372641, + "velocityY": 0.3049008798719041, "moduleForcesX": [ - -85.10523672353476, - -86.41137299899846, - -112.06170126554508, - -114.61890071891574 + -81.25618436721729, + -85.27321950996416, + -110.08736666214384, + -114.93039749975733 ], "moduleForcesY": [ - -77.71146885299495, - -76.42757490922745, - 27.300042653259524, - -13.22254030124739 + -81.68368062704863, + -77.68627318980845, + 34.38228873619402, + -10.118563442601245 ], - "timestamp": 1.5209637991961644 + "timestamp": 1.556165422711402 }, { "x": 12.967412948608398, - "y": 2.415215253829956, + "y": 2.4152152538299556, "heading": 0.7551043250796196, - "angularVelocity": 0.8083825990618009, - "velocityX": 0.3768185819638491, - "velocityY": 0.14958535571928933, + "angularVelocity": 0.9641391597034191, + "velocityX": 0.36667746977301147, + "velocityY": 0.15530363813167133, "moduleForcesX": [ - -79.8120626088093, - -82.24535135891634, - -110.85189362912443, - -114.54956911255539 + -71.24184841573965, + -79.34168407653632, + -108.15322189105373, + -114.84174119771971 ], "moduleForcesY": [ - -83.1630963954795, - -80.92027537570912, - 31.94949718085646, - -13.954975426754949 + -90.57520191146978, + -83.76752129096904, + 40.14476142563533, + -11.30273600011981 ], - "timestamp": 1.5777312703351374 + "timestamp": 1.6145654201060733 }, { "x": 12.967412948608398, "y": 2.415215253829956, "heading": 0.7551043250796196, - "angularVelocity": -1.3336137182058527e-20, - "velocityX": 7.896803099134162e-20, - "velocityY": -8.450419355688481e-20, + "angularVelocity": 9.053251338585555e-21, + "velocityX": -3.8997560756165654e-20, + "velocityY": 8.026582215029425e-20, "moduleForcesX": [ - -73.04670295538688, - -79.74797430779527, - -109.59078372653275, - -114.65423863578631 + -59.447576805243436, + -76.0182207018807, + -106.23908134928888, + -114.93156102990737 ], "moduleForcesY": [ - -89.19074412625777, - -83.40210179987234, - 36.08914873029201, - -13.169435415720292 + -98.75016323489919, + -86.81696405456789, + 45.01411898852267, + -10.497822934908333 ], - "timestamp": 1.6344987414741103 + "timestamp": 1.6729654175007447 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Source 4 Piece.5.traj b/src/main/deploy/choreo/Red Source 4 Piece.5.traj index 9ebe0b9..33e83c5 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.5.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.5.traj @@ -4,631 +4,631 @@ "x": 12.967412948608398, "y": 2.415215253829956, "heading": 0.7551043250796196, - "angularVelocity": -1.3336137182058527e-20, - "velocityX": 7.896803099134162e-20, - "velocityY": -8.450419355688481e-20, + "angularVelocity": 9.053251338585555e-21, + "velocityX": -3.8997560756165654e-20, + "velocityY": 8.026582215029425e-20, "moduleForcesX": [ - -73.04670295538688, - -79.74797430779527, - -109.59078372653275, - -114.65423863578631 + -59.447576805243436, + -76.0182207018807, + -106.23908134928888, + -114.93156102990737 ], "moduleForcesY": [ - -89.19074412625777, - -83.40210179987234, - 36.08914873029201, - -13.169435415720292 + -98.75016323489919, + -86.81696405456789, + 45.01411898852267, + -10.497822934908333 ], "timestamp": 0 }, { - "x": 12.970048360747468, - "y": 2.4137790529276497, - "heading": 0.7937123904808917, - "angularVelocity": 1.1279408340974115, - "velocityX": 0.07699398909111418, - "velocityY": -0.04195884012456589, + "x": 12.96998343707109, + "y": 2.414002895867038, + "heading": 0.7972120394307962, + "angularVelocity": 1.1925305688726804, + "velocityX": 0.07279868109514463, + "velocityY": -0.03433513201728092, "moduleForcesX": [ - -108.01660145288726, - 63.314454594733206, - 60.59422206639011, - 111.87513675069263 + -111.21616724439681, + 56.92485396981027, + 59.189341209886784, + 112.20973399379479 ], "moduleForcesY": [ - -39.618466232021234, - 96.33566340014396, - -98.1623898281533, - -28.183152137146752 + -29.647343877850524, + 100.25021857445405, + -99.01585760311724, + -26.82030436731245 ], - "timestamp": 0.034228803705087074 + "timestamp": 0.035309547151467946 }, { - "x": 12.975621766996525, - "y": 2.4106424063814402, - "heading": 0.8697774779478025, - "angularVelocity": 2.222253752198958, - "velocityX": 0.16282795908031536, - "velocityY": -0.0916376328318483, + "x": 12.975382665164473, + "y": 2.411312891081737, + "heading": 0.8804592395786249, + "angularVelocity": 2.3576399830539327, + "velocityX": 0.15291128119587102, + "velocityY": -0.07618349716500683, "moduleForcesX": [ - -96.65015385418619, - 60.2572282410898, - 65.93464425581767, - 112.89494643133521 + -102.0282025796209, + 52.4117542511673, + 65.18685502936165, + 113.30290747157059 ], "moduleForcesY": [ - -62.329753787693775, - 98.21955261781349, - -94.63903361003725, - -23.689938883154483 + -53.14869773571917, + 102.62130539045927, + -95.15210347949893, + -21.639970807289608 ], - "timestamp": 0.06845760741017415 + "timestamp": 0.07061909430293589 }, { - "x": 12.984638262041022, - "y": 2.40560314630279, - "heading": 0.981604703565313, - "angularVelocity": 3.2670503643950517, - "velocityX": 0.2634183514613656, - "velocityY": -0.14722279288698714, + "x": 12.984095673066808, + "y": 2.406910573419745, + "heading": 1.0032632315683296, + "angularVelocity": 3.477925997263877, + "velocityX": 0.24676068104083002, + "velocityY": -0.1246778284382388, "moduleForcesX": [ - -75.73920484802935, - 55.647722774813666, - 72.9840009621066, - 114.03160254054053 + -82.28667122957336, + 45.662880673923205, + 73.15743467730792, + 114.4374038272442 ], "moduleForcesY": [ - -86.50130488193668, - 100.80472826924579, - -89.2887526232794, - -17.255130186537208 + -80.3144525443013, + 105.68805654601378, + -89.1356191703524, + -14.2484998053063 ], - "timestamp": 0.10268641111526122 + "timestamp": 0.10592864145440384 }, { - "x": 12.997789852791989, - "y": 2.398632583933518, - "heading": 1.1269751697569061, - "angularVelocity": 4.247021527369041, - "velocityX": 0.384225836937812, - "velocityY": -0.20364609962244667, + "x": 12.996877140681336, + "y": 2.4007272960210755, + "heading": 1.1632571037667327, + "angularVelocity": 4.531178820053266, + "velocityX": 0.36198333441376895, + "velocityY": -0.17511630415825236, "moduleForcesX": [ - -47.052833680267064, - 51.55657320839896, - 81.07269190656048, - 114.89682349470702 + -51.418086814419254, + 39.35983727831288, + 82.27641388148449, + 115.13501591899251 ], "moduleForcesY": [ - -104.87988948985272, - 102.76487920670435, - -81.97187217875056, - -9.5444344265138 + -102.7787620179167, + 107.95631863586193, + -80.73399410186636, + -5.581529823013248 ], - "timestamp": 0.1369152148203483 + "timestamp": 0.14123818860587178 }, { - "x": 13.01604908890962, - "y": 2.3898145535116964, - "heading": 1.30230612560941, - "angularVelocity": 5.122322046751738, - "velocityX": 0.5334465170026499, - "velocityY": -0.25762017562547473, + "x": 13.015049064249819, + "y": 2.3927861943346507, + "heading": 1.3554989134366557, + "angularVelocity": 5.444471118399243, + "velocityX": 0.5146461802677791, + "velocityY": -0.22489956193372712, "moduleForcesX": [ - -13.83132865379064, - 56.89712099256609, - 89.34828449880882, - 115.20928290206547 + -10.940950643938722, + 49.962099870379674, + 91.40372157976817, + 115.15655922442267 ], "moduleForcesY": [ - -114.07904848518923, - 99.40316122357095, - -72.78432529295559, - -2.1067431308289684 + -114.29555191993943, + 102.6827935808022, + -70.09920994331412, + 1.628018794334819 ], - "timestamp": 0.17114401852543537 + "timestamp": 0.17654773575733973 }, { - "x": 13.041330772308694, - "y": 2.3782677142113013, - "heading": 1.4965650837086486, - "angularVelocity": 5.675306673670554, - "velocityX": 0.7386084426695338, - "velocityY": -0.337342765456264, + "x": 13.041336393679563, + "y": 2.380821542261088, + "heading": 1.5611649438949164, + "angularVelocity": 5.824657834778007, + "velocityX": 0.7444822024189007, + "velocityY": -0.3388503404537995, "moduleForcesX": [ - 23.62733870295094, - 105.17566327178272, - 96.55369553063645, - 115.09802567519542 + 44.018601789505944, + 112.32060939232755, + 98.58413579678957, + 114.80288651764442 ], "moduleForcesY": [ - -112.36357969798449, - 42.3756044319675, - -62.73241252810405, - 0.42521575450602284 + -105.76548150864933, + -13.981211872807418, + -59.14888259144886, + -4.411599951380392 ], - "timestamp": 0.20537282223052244 + "timestamp": 0.21185728290880768 }, { - "x": 13.074571748977242, - "y": 2.3622293034747717, - "heading": 1.6983784117666543, - "angularVelocity": 5.896008805823781, - "velocityX": 0.9711404744073342, - "velocityY": -0.46856474666171494, + "x": 13.075568670437569, + "y": 2.363605977955592, + "heading": 1.7569917778370125, + "angularVelocity": 5.546002419743737, + "velocityX": 0.9694906765912515, + "velocityY": -0.4875611752160383, "moduleForcesX": [ - 71.12553566693927, - 100.91027402459993, - 100.75435384797667, - 113.08371748677187 + 112.77483449910198, + 99.15399456797537, + 90.29830581798545, + 59.73325270720686 ], "moduleForcesY": [ - -89.84770615754807, - -53.21727890658172, - -55.16195289043256, - -19.528589252981142 + -17.7589765691773, + -57.092373513786576, + -67.32011989023349, + -97.05254853412107 ], - "timestamp": 0.23960162593560952 + "timestamp": 0.24716683006027562 }, { - "x": 13.114509281067164, - "y": 2.340957999926888, - "heading": 1.8863558488571963, - "angularVelocity": 5.491791028110231, - "velocityX": 1.166781417020328, - "velocityY": -0.6214445509474895, + "x": 13.116425328315025, + "y": 2.3404059032444886, + "heading": 1.936779809038105, + "angularVelocity": 5.091768252644345, + "velocityX": 1.1570994581774832, + "velocityY": -0.657048208847239, "moduleForcesX": [ - 114.25525292589651, - 101.5198450249115, - 62.82771454322464, - 46.05237264124183 + 113.58831274277301, + 99.7780845838403, + 45.433109941728226, + 42.997780804688276 ], "moduleForcesY": [ - -3.0662620881109772, - -53.164971916677835, - -92.89456142147867, - -104.56967598650544 + -8.813998457097396, + -55.91347232549451, + -102.28351156220437, + -105.6347151591242 ], - "timestamp": 0.2738304296406966 + "timestamp": 0.28247637721174357 }, { - "x": 13.16127250279366, - "y": 2.3144796562214776, - "heading": 2.0604510155338396, - "angularVelocity": 5.086218267417001, - "velocityX": 1.3661950364785713, - "velocityY": -0.7735690657912138, + "x": 13.164348878372106, + "y": 2.311286163678727, + "heading": 2.102441153162455, + "angularVelocity": 4.691687022031468, + "velocityX": 1.3572405743835967, + "velocityY": -0.8246987547269855, "moduleForcesX": [ - 113.85700055139108, - 103.5977835443585, - 57.60230783383877, - 55.858639098030515 + 112.23361382448608, + 101.31991173599144, + 52.83399612225048, + 55.56993463789342 ], "moduleForcesY": [ - -7.038353644791787, - -48.731921179952906, - -97.0132702772452, - -99.65856579041063 + -17.942568729740564, + -52.73023800246578, + -99.48263504998427, + -99.53598557359436 ], - "timestamp": 0.30805923334578367 + "timestamp": 0.3177859243632115 }, { - "x": 13.215371818566618, - "y": 2.283182129389797, - "heading": 2.222199775394, - "angularVelocity": 4.725516008499068, - "velocityX": 1.5805202027821996, - "velocityY": -0.9143622751583239, + "x": 13.219851677647156, + "y": 2.2766875060838747, + "heading": 2.255229935633236, + "angularVelocity": 4.327123817684807, + "velocityX": 1.5718921298242057, + "velocityY": -0.9798669307882757, "moduleForcesX": [ - 113.4504714545397, - 106.32220430919419, - 67.34185140885803, - 68.54608055150739 + 111.9924020775366, + 104.4925935573574, + 62.07558249791472, + 66.73912886868742 ], "moduleForcesY": [ - -9.493241665912656, - -42.053893387015094, - -90.8154825702002, - -91.27582657149121 + -17.66498742329877, + -45.65536628701666, + -94.04562308108473, + -92.24565830688235 ], - "timestamp": 0.34228803705087074 + "timestamp": 0.35309547151467946 }, { - "x": 13.277347449903122, - "y": 2.2478394917559394, - "heading": 2.3724726135624645, - "angularVelocity": 4.3902451123681105, - "velocityX": 1.8106280275084354, - "velocityY": -1.032540837195327, + "x": 13.28353970410351, + "y": 2.2375422812207173, + "heading": 2.3954911150696994, + "angularVelocity": 3.972330169933441, + "velocityX": 1.8037055582489414, + "velocityY": -1.1086300454442182, "moduleForcesX": [ - 113.5653767711979, - 109.86203798468613, - 78.22814414337026, - 80.19548638705947 + 112.87425186361119, + 108.91840198905972, + 73.13263930631699, + 77.98189938274406 ], "moduleForcesY": [ - -2.651547534152781, - -31.01826752750063, - -81.44565214036037, - -80.99523654285561 + -6.223365306848344, + -32.97990859437656, + -85.29569693218718, + -82.63610290053495 ], - "timestamp": 0.3765168407559578 + "timestamp": 0.3884050186661474 }, { - "x": 13.347738923201241, - "y": 2.209798230712871, - "heading": 2.5114070565980735, - "angularVelocity": 4.058992076750882, - "velocityX": 2.056498202642214, - "velocityY": -1.111381553700728, + "x": 13.356027725868415, + "y": 2.1954929185575316, + "heading": 2.5227266765592224, + "angularVelocity": 3.603432265605644, + "velocityX": 2.05292980547018, + "velocityY": -1.1908779935020604, "moduleForcesX": [ - 112.19207649662098, - 113.16894691538694, - 90.80572403866687, - 91.84103538443951 + 111.12012886761015, + 112.86988205346621, + 86.88778676806567, + 90.03734763330992 ], "moduleForcesY": [ - 15.928502193312395, - -13.308928426826157, - -66.37795970134175, - -67.07336672078067 + 18.73827221813339, + -12.34828439071452, + -69.97685042739457, + -68.72148386204216 ], - "timestamp": 0.4107456444610449 + "timestamp": 0.42371456581761535 }, { - "x": 13.426870193585469, - "y": 2.171263792990934, - "heading": 2.6387846589283668, - "angularVelocity": 3.721357118635243, - "velocityX": 2.3118327787911346, - "velocityY": -1.1257897896174638, + "x": 13.437612450726574, + "y": 2.1532107657883417, + "heading": 2.6363795977141677, + "angularVelocity": 3.2187589568171635, + "velocityX": 2.310557099704127, + "velocityY": -1.1974708309852242, "moduleForcesX": [ - 102.63355880151254, - 112.95185304826374, - 104.73192313748237, - 103.39609116937378 + 97.20248405701679, + 111.86974536596307, + 103.03466347126968, + 102.32583288762171 ], "moduleForcesY": [ - 47.5032430073068, - 13.428590930969284, - -38.36223908730184, - -46.47925525510383 + 56.63338441321471, + 18.095398070103148, + -37.97062581902301, + -47.36373949630385 ], - "timestamp": 0.44497444816613196 + "timestamp": 0.4590241129690833 }, { - "x": 13.514211992892422, - "y": 2.1355999035658586, - "heading": 2.7553046690686678, - "angularVelocity": 3.404150818247408, - "velocityX": 2.5517047005060185, - "velocityY": -1.041926259889313, + "x": 13.52742112558017, + "y": 2.114825451689113, + "heading": 2.7381791424535917, + "angularVelocity": 2.8830600489644733, + "velocityX": 2.5434671951001175, + "velocityY": -1.0871086489602033, "moduleForcesX": [ - 75.57886955728137, - 102.96113998905116, - 107.63125638242843, - 111.88275135917017 + 65.89792156241022, + 99.43709283642043, + 97.88415343385961, + 111.45218049666381 ], "moduleForcesY": [ - 84.19790217808342, - 48.1221710956847, - 21.89000669551172, - -15.04325013116753 + 91.46142231462393, + 54.22012108641089, + 43.67400047278733, + -11.821171765210279 ], - "timestamp": 0.47920325187121904 + "timestamp": 0.49433366012055124 }, { - "x": 13.608382873111731, - "y": 2.104027882799267, - "heading": 2.8572670405922005, - "angularVelocity": 2.978847066991696, - "velocityX": 2.7512173966310547, - "velocityY": -0.9223816595721166, + "x": 13.624109013301569, + "y": 2.082166798124268, + "heading": 2.8283496984778993, + "angularVelocity": 2.5537160144677564, + "velocityX": 2.7382930544713884, + "velocityY": -0.9249241692269164, "moduleForcesX": [ - 43.05897579116903, - 91.6113139764606, - 86.0284662891163, - 110.3813871494816 + 47.53439495990041, + 87.45802427935757, + 68.84720326442992, + 109.56743396568841 ], "moduleForcesY": [ - 103.90780630948846, - 66.29758480169258, - 44.88832766753545, - -16.716151028620235 + 101.06114313793714, + 70.39136956871369, + 77.82924862847176, + 11.616666431402512 ], - "timestamp": 0.5134320555763061 + "timestamp": 0.5296432072720192 }, { - "x": 13.709392507782326, - "y": 2.0756519490371312, - "heading": 2.94318081891027, - "angularVelocity": 2.5099848378663028, - "velocityX": 2.951012706750959, - "velocityY": -0.8290074641980617, + "x": 13.72686903772777, + "y": 2.0553682797529484, + "heading": 2.9074090191549895, + "angularVelocity": 2.2390352483975082, + "velocityX": 2.91026174834215, + "velocityY": -0.758959560040714, "moduleForcesX": [ - 44.52299290536762, - 89.70386834247236, - 89.89738881433836, - 107.4248752374718 + 40.22780438179703, + 78.40481006980285, + 57.57268745635085, + 100.4325239168598 ], "moduleForcesY": [ - 99.54624373858208, - 64.70732173234636, - 5.23775664216174, - -14.542075390294418 + 98.4313106563725, + 73.82616586327329, + 71.5409821365442, + 23.18088284906935 ], - "timestamp": 0.5476608592813932 + "timestamp": 0.5649527544234862 }, { - "x": 13.816873348205831, - "y": 2.0493588330156762, - "heading": 3.0127614350084757, - "angularVelocity": 2.0328088792616716, - "velocityX": 3.140070022591264, - "velocityY": -0.7681576092481421, + "x": 13.833446542907254, + "y": 2.0337946936747766, + "heading": 2.978868034125111, + "angularVelocity": 2.023787353136609, + "velocityX": 3.018376438595989, + "velocityY": -0.6109845018859891, "moduleForcesX": [ - 51.259757063966916, - 87.90465515997464, - 76.04326290186623, - 98.52235017226005 + 27.71133529028477, + 53.321617344173696, + 30.59724389817127, + 62.288742887948686 ], "moduleForcesY": [ - 83.80305982182361, - 54.18397152510217, - -19.682023673725332, - -17.32808198285826 + 77.76542044513596, + 67.01241376251376, + 54.08148222741618, + 39.18109337921699 ], - "timestamp": 0.5818896629864803 + "timestamp": 0.6002623015749533 }, { - "x": 13.929707201661447, - "y": 2.0240992265198385, - "heading": 3.068040845669453, - "angularVelocity": 1.6149968645489765, - "velocityX": 3.2964591584264133, - "velocityY": -0.7379634623965822, + "x": 13.941082897090102, + "y": 2.014552811875832, + "heading": 3.046276067820356, + "angularVelocity": 1.909059705752796, + "velocityX": 3.0483640506949308, + "velocityY": -0.5449484162575098, "moduleForcesX": [ - 47.295717118224054, - 78.04506650685518, - 52.74429299675803, - 81.43393391647136 + 6.338411935153288, + 18.630960550653445, + 5.06353490915197, + 18.20673219295047 ], "moduleForcesY": [ - 57.972821530832974, - 39.43293491124601, - -26.72428249075782, - -20.575978623147435 + 35.187167487602544, + 33.453819907714234, + 19.61232716700604, + 17.975782973141456 ], - "timestamp": 0.6161184666915673 + "timestamp": 0.6355718487264204 }, { - "x": 14.047884577428986, - "y": 2.0018097256387324, - "heading": 3.1110017017202476, - "angularVelocity": 1.2551083123132851, - "velocityX": 3.4525710213465004, - "velocityY": -0.6511913496333745, + "x": 14.05314484024913, + "y": 1.9975368200863013, + "heading": 3.1018857561383033, + "angularVelocity": 1.5749193293076669, + "velocityX": 3.173700944911924, + "velocityY": -0.4819090915135053, "moduleForcesX": [ - 40.41850941273932, - 72.26596436397179, - 60.165986562380006, - 86.20843132854377 + 32.38825659623406, + 61.429438389035255, + 39.21145043820505, + 68.59433110232229 ], "moduleForcesY": [ - 74.57460703229934, - 57.34619153849231, - 8.435378772880814, - 3.6372831123246727 + 56.694726366304984, + 45.459912121099414, + 0.48491739779044996, + -1.2312044805406857 ], - "timestamp": 0.6503472703966544 + "timestamp": 0.6708813958778874 }, { "x": 14.171788215637209, "y": 1.984554409980774, "heading": 3.141592653589793, - "angularVelocity": 0.8937195741082631, - "velocityX": 3.619864698625444, - "velocityY": -0.5041168194664397, + "angularVelocity": 1.124537148017186, + "velocityX": 3.360093373022707, + "velocityY": -0.36767421711301757, "moduleForcesX": [ - 31.013647911651436, - 72.0282862596618, - 73.76190608414021, - 100.81064597402093 + 36.55913016223622, + 77.99345741140219, + 82.65797442708791, + 102.63003632076331 ], "moduleForcesY": [ - 99.50918080631918, - 78.69145966069404, - 44.945495220702036, - 20.9158085162814 + 95.80128612213797, + 71.69774957943521, + 11.330071286912512, + 4.935080412220265 ], - "timestamp": 0.6845760741017415 + "timestamp": 0.7061909430293545 }, { - "x": 14.465911674508094, - "y": 1.9753101696961057, - "heading": 3.1416390533992677, - "angularVelocity": 0.0006259678214476079, - "velocityX": 3.9679434650520284, - "velocityY": -0.12471165328920111, + "x": 14.454593476941811, + "y": 1.97796448772176, + "heading": 3.1416429856731254, + "angularVelocity": 0.0006710133266609316, + "velocityX": 3.7702810339357056, + "velocityY": -0.08785500946360723, "moduleForcesX": [ - 12.487145015519305, - 69.66097734031248, - 72.91874659974623, - 111.66054849173449 + 18.90105163422517, + 76.09798989324729, + 102.58200087249564, + 113.03447520897573 ], "moduleForcesY": [ - 112.68237698463481, - 89.98445533687041, - 72.22468092466957, - 15.840843626755948 + 111.7491169958333, + 84.68950673878763, + 12.795896757028622, + 2.6591962220306633 ], - "timestamp": 0.758700985774853 + "timestamp": 0.7812000096636771 }, { - "x": 14.759680867707536, - "y": 1.9926744865605754, - "heading": 3.141639047674968, - "angularVelocity": -7.722504859421795e-8, - "velocityX": 3.9631641585618773, - "velocityY": 0.23425750496730716, + "x": 14.73702423123013, + "y": 1.9942197501048884, + "heading": 3.141642978594246, + "angularVelocity": -9.437364784490279e-8, + "velocityX": 3.7652882106265917, + "velocityY": 0.21671063396078938, "moduleForcesX": [ - -0.9389057010062756, - -0.8918110984524966, - -0.9393548495237268, - -0.8922375760075535 + -0.9672719038049086, + -0.9227533462325223, + -0.9676691170691535, + -0.9231321771109741 ], "moduleForcesY": [ - 68.78303298559197, - 68.78336233513552, - 68.75291633774563, - 68.75324593515026 + 57.67606024664952, + 57.67635291233172, + 57.6401521151496, + 57.640444913455646 ], - "timestamp": 0.8328258974479645 + "timestamp": 0.8562090762979997 }, { - "x": 15.026827970969723, - "y": 2.0099691813791303, - "heading": 3.1416259895563514, - "angularVelocity": -0.00017616369884637328, - "velocityX": 3.604012432963095, - "velocityY": 0.23331825196411826, + "x": 15.010642804361149, + "y": 2.011079932044252, + "heading": 3.141629628938074, + "angularVelocity": -0.0001779739006345567, + "velocityX": 3.64780666402562, + "velocityY": 0.22477525312446248, "moduleForcesX": [ - -68.80569709908896, - -68.80055108905634, - -68.80567698548732, - -68.80053097288132 + -22.244941885332093, + -22.236580273652777, + -22.24500082399066, + -22.23663920902384 ], "moduleForcesY": [ - -0.17267223974178206, - -0.17268609942239904, - -0.18718088491331014, - -0.1871959394377115 + 1.5327560088699677, + 1.5328008081495923, + 1.5206747766652815, + 1.5207191865207244 ], - "timestamp": 0.9069508091210761 + "timestamp": 0.9312181429323223 }, { - "x": 15.249536975116508, - "y": 2.0243970355953347, - "heading": 3.141614954022603, - "angularVelocity": -0.00014887752982443867, - "velocityX": 3.0045095382902, - "velocityY": 0.1946424473303505, + "x": 15.238746449573442, + "y": 2.025140105667011, + "heading": 3.141617683794715, + "angularVelocity": -0.0001592493267130903, + "velocityX": 3.0410143126340383, + "velocityY": 0.18744632154013266, "moduleForcesX": [ - -114.84736831647434, - -114.84738407657306, - -114.84755033754627, - -114.84756609099593 + -114.87365016225687, + -114.8736602533315, + -114.87376789982473, + -114.87377798798217 ], "moduleForcesY": [ - -7.410652114275073, - -7.410516501125907, - -7.407821278678371, - -7.407685716920534 + -7.067858015952322, + -7.067770306332378, + -7.065937872922811, + -7.06585018696093 ], - "timestamp": 0.9810757207941876 + "timestamp": 1.006227209566645 }, { - "x": 15.427734932644807, - "y": 2.035944875109631, - "heading": 3.1416060662035123, - "angularVelocity": -0.00011990326719874652, - "velocityX": 2.4040225277319003, - "velocityY": 0.15578891432912842, + "x": 15.42126048503754, + "y": 2.0363917821596837, + "heading": 3.141607829317923, + "angularVelocity": -0.0001313771419136315, + "velocityX": 2.433226323877269, + "velocityY": 0.15000421945692372, "moduleForcesX": [ - -115.03589170672049, - -115.03590480898394, - -115.03608605645235, - -115.03609915116974 + -115.06210747733799, + -115.06211903061897, + -115.06228342780778, + -115.06229497459297 ], "moduleForcesY": [ - -7.444793267880758, - -7.444648447596564, - -7.441784589248815, - -7.441639827013844 + -7.0897746850507195, + -7.0896435800698425, + -7.086913890620305, + -7.086782838153622 ], - "timestamp": 1.0552006324672991 + "timestamp": 1.0812362762009675 }, { - "x": 15.561397445196155, - "y": 2.0446082921325672, - "heading": 3.141599372332212, - "angularVelocity": -0.0000903052853512078, - "velocityX": 1.8032063652338357, - "velocityY": 0.11687591698101098, + "x": 15.55816017917051, + "y": 2.0448321500588196, + "heading": 3.141600301323743, + "angularVelocity": -0.0001003611232318043, + "velocityX": 1.8251086205401539, + "velocityY": 0.11252463572546204, "moduleForcesX": [ - -115.09894593189205, - -115.09895807541444, - -115.0991448304989, - -115.09915696612956 + -115.1245166883893, + -115.12452826743665, + -115.1247127410453, + -115.1247243120354 ], "moduleForcesY": [ - -7.456219470556481, - -7.4560712446453135, - -7.453145099192203, - -7.452996933892054 + -7.097039766327021, + -7.096893661739564, + -7.09385533338325, + -7.093709293863294 ], - "timestamp": 1.1293255441404106 + "timestamp": 1.1562453428352901 }, { - "x": 15.650512302084337, - "y": 2.0503850805660555, - "heading": 3.141594896520999, - "angularVelocity": -0.00006038201073843798, - "velocityX": 1.2022254715280745, - "velocityY": 0.07793315773480654, + "x": 15.649433203495256, + "y": 2.0504598078795278, + "heading": 3.141595218831146, + "angularVelocity": -0.00006775837675300562, + "velocityX": 1.216826557377529, + "velocityY": 0.07502636778758355, "moduleForcesX": [ - -115.13050274279995, - -115.13051439212589, - -115.13070401220862, - -115.13071565345946 + -115.15562710583616, + -115.1556386080867, + -115.15583332234816, + -115.1558448156885 ], "moduleForcesY": [ - -7.461939008917163, - -7.461789005484221, - -7.458830380578395, - -7.4586804391143025 + -7.100662428852205, + -7.100508735512367, + -7.097314584597426, + -7.09716096317408 ], - "timestamp": 1.2034504558135222 + "timestamp": 1.2312544094696127 }, { - "x": 15.695072174072267, - "y": 2.0532739162445135, + "x": 15.695072174072266, + "y": 2.0532739162445086, "heading": 3.141592653589793, - "angularVelocity": -0.000030258804437930826, - "velocityX": 0.6011457009815155, - "velocityY": 0.0389725345128546, + "angularVelocity": -0.00003419908376354715, + "velocityX": 0.6084460535885152, + "velocityY": 0.03751690950502779, "moduleForcesX": [ - -115.14944411679562, - -115.14945546462413, - -115.14964684268682, - -115.14965818232656 + -115.17426017282052, + -115.1742715999137, + -115.1744725223164, + -115.1744839399641 ], "moduleForcesY": [ - -7.465372303464892, - -7.465221209099038, - -7.462242621788976, - -7.462091590233925 + -7.1028324617840966, + -7.102674189928448, + -7.099386084718839, + -7.099227889075033 ], - "timestamp": 1.2775753674866337 + "timestamp": 1.3062634761039353 }, { "x": 15.695072174072266, "y": 2.053273916244507, "heading": 3.141592653589793, - "angularVelocity": -9.292016747356084e-24, - "velocityX": -1.793915534938115e-21, - "velocityY": 6.2893253710272155e-21, + "angularVelocity": 7.360266802879611e-18, + "velocityX": -3.548120676165313e-17, + "velocityY": 1.645505940598732e-17, "moduleForcesX": [ - -115.16207409488239, - -115.16208523948659, - -115.16227780816574, - -115.16228894450374 + -115.1866675847214, + -115.18667894938694, + -115.18688403868423, + -115.18689539353758 ], "moduleForcesY": [ - -7.467661670085714, - -7.467509839682893, - -7.464517710638041, - -7.46436594362026 + -7.104277561224014, + -7.104116229492547, + -7.100765271069564, + -7.100604018492855 ], - "timestamp": 1.3517002791597452 + "timestamp": 1.381272542738258 } ], "eventMarkers": [ diff --git a/src/main/deploy/choreo/Red Source 4 Piece.6.traj b/src/main/deploy/choreo/Red Source 4 Piece.6.traj index 066eb26..a1af7ba 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.6.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.6.traj @@ -4,505 +4,505 @@ "x": 15.695072174072266, "y": 2.053273916244507, "heading": 3.141592653589793, - "angularVelocity": -9.292016747356084e-24, - "velocityX": -1.793915534938115e-21, - "velocityY": 6.2893253710272155e-21, + "angularVelocity": 7.360266802879611e-18, + "velocityX": -3.548120676165313e-17, + "velocityY": 1.645505940598732e-17, "moduleForcesX": [ - -115.16207409488239, - -115.16208523948659, - -115.16227780816574, - -115.16228894450374 + -115.1866675847214, + -115.18667894938694, + -115.18688403868423, + -115.18689539353758 ], "moduleForcesY": [ - -7.467661670085714, - -7.467509839682893, - -7.464517710638041, - -7.46436594362026 + -7.104277561224014, + -7.104116229492547, + -7.100765271069564, + -7.100604018492855 ], "timestamp": 0 }, { - "x": 15.683032734310219, - "y": 2.065243087486579, - "heading": 3.115114997508429, - "angularVelocity": -0.5490817512048347, - "velocityX": -0.2496684996494882, - "velocityY": 0.24821130261198696, + "x": 15.682503427057059, + "y": 2.0646337327221738, + "heading": 3.1105221295886483, + "angularVelocity": -0.6347005775094131, + "velocityX": -0.256751092735796, + "velocityY": 0.2320553744418617, "moduleForcesX": [ - -71.19396438514681, - -16.351962141394477, - -113.73960028992641, - -92.80128040966147 + -70.5113246528861, + -10.018801848294446, + -114.81418680640073, + -102.56695754289538 ], "moduleForcesY": [ - 90.82485498148873, - 114.2197124413682, - 19.306054425681616, - 68.01973967114493 + 91.35804066484329, + 114.95032459741512, + 11.291141101368888, + 51.657036115035055 ], - "timestamp": 0.04822170109144075 + "timestamp": 0.0489530419573061 }, { - "x": 15.658925173391546, - "y": 2.0892962989602575, - "heading": 3.062358403873359, - "angularVelocity": -1.0940425667487261, - "velocityX": -0.49993178119037096, - "velocityY": 0.498804706786825, + "x": 15.65742036306147, + "y": 2.0876131196932546, + "heading": 3.0485249865888644, + "angularVelocity": -1.2664615010820823, + "velocityX": -0.5123903028885073, + "velocityY": 0.46941693602952456, "moduleForcesX": [ - -69.20082557973149, - -16.95272733429739, - -112.51565970212599, - -96.11819363500827 + -67.98037553477958, + -10.477656621264348, + -113.74547934312902, + -104.41762909388488 ], "moduleForcesY": [ - 92.3390007447845, - 114.1166649077064, - 25.431491565284002, - 63.28910350060903 + 93.24160102529723, + 114.89176486973722, + 19.194965643610416, + 48.08504142954779 ], - "timestamp": 0.0964434021828815 + "timestamp": 0.0979060839146122 }, { - "x": 15.62279726830929, - "y": 2.12560868155957, - "heading": 2.9832806496410678, - "angularVelocity": -1.639878984823432, - "velocityX": -0.7492042848872155, - "velocityY": 0.7530298968602243, + "x": 15.619984364865571, + "y": 2.122583149169414, + "heading": 2.9555670776733143, + "angularVelocity": -1.898919968990331, + "velocityX": -0.7647328275973524, + "velocityY": 0.7143586604192456, "moduleForcesX": [ - -66.36796972826156, - -17.450975110192893, - -110.621364173897, - -99.18005096251872 + -64.39521228894338, + -10.835990160847423, + -111.74412944489666, + -105.82062634096789 ], "moduleForcesY": [ - 94.37769509418551, - 114.01956856414778, - 32.64856908645184, - 58.408341771039105 + 95.73186682963218, + 114.83217133102714, + 28.557801462027836, + 45.08688416388965 ], - "timestamp": 0.14466510327432225 + "timestamp": 0.1468591258719183 }, { - "x": 15.574792792817318, - "y": 2.1745030635707616, - "heading": 2.878098250144675, - "angularVelocity": -2.181225405071048, - "velocityX": -0.9954952729880231, - "velocityY": 1.013949755079664, + "x": 15.570467933857678, + "y": 2.170168664476953, + "heading": 2.8324199256452296, + "angularVelocity": -2.5156179698799113, + "velocityX": -1.0115087648950551, + "velocityY": 0.9720645215752571, "moduleForcesX": [ - -62.904518048583384, - -18.765520932194924, - -107.7608463249948, - -100.67752020321787 + -60.10508416922476, + -12.632263453369584, + -108.31270835066015, + -105.28692632471801 ], "moduleForcesY": [ - 96.69530558377407, - 113.77796058506848, - 41.059685679799614, - 55.80693345276965 + 98.45078742590746, + 114.60669150976062, + 39.55592248262243, + 46.40569830412261 ], - "timestamp": 0.192886804365763 + "timestamp": 0.1958121678292244 }, { - "x": 15.515115418351767, - "y": 2.2365113766993776, - "heading": 2.748238313390357, - "angularVelocity": -2.6929770998345632, - "velocityX": -1.2375626142343545, - "velocityY": 1.2859005743292333, + "x": 15.509173235477315, + "y": 2.231318730757613, + "heading": 2.6823266470561213, + "angularVelocity": -3.0660664299475155, + "velocityX": -1.2521121452208077, + "velocityY": 1.249157638351185, "moduleForcesX": [ - -59.32922192701663, - -22.65425748350358, - -103.41216352884263, - -99.73769034374713 + -56.107596300781445, + -19.19352006993177, + -102.46843648837859, + -101.40533999140591 ], "moduleForcesY": [ - 98.89044870030654, - 113.0169064497809, - 50.96198665871155, - 57.464013291731035 + 100.7295111846094, + 113.62114180098361, + 52.787569948269265, + 54.3761343490552 ], - "timestamp": 0.24110850545720375 + "timestamp": 0.2447652097865305 }, { - "x": 15.443945120311788, - "y": 2.312397535168875, - "heading": 2.598049453482882, - "angularVelocity": -3.1145491865307253, - "velocityX": -1.475897706408575, - "velocityY": 1.5736931039740272, + "x": 15.43629756865313, + "y": 2.3072905794447975, + "heading": 2.5143967135906133, + "angularVelocity": -3.430428973381599, + "velocityX": -1.4886851543897108, + "velocityY": 1.5519331516069275, "moduleForcesX": [ - -57.02616538718774, - -32.46022038133978, - -96.42189325761598, - -94.82880396936186 + -55.566033052317195, + -37.364595107963666, + -91.32795604295461, + -90.23982224737182 ], "moduleForcesY": [ - 100.1682414386154, - 110.51663143062801, - 63.10043038238431, - 65.20814728614427 + 100.91772810006313, + 108.8790331542822, + 70.17696973257495, + 71.3402088109634 ], - "timestamp": 0.2893302065486445 + "timestamp": 0.2937182517438366 }, { - "x": 15.361397570597198, - "y": 2.4030627345914812, - "heading": 2.4379497025502035, - "angularVelocity": -3.3200767975623116, - "velocityX": -1.711834046626805, - "velocityY": 1.8801742238557955, + "x": 15.352292498894688, + "y": 2.3990896446839507, + "heading": 2.351450276494965, + "angularVelocity": -3.328627406602441, + "velocityX": -1.7160337008704416, + "velocityY": 1.8752474120484843, "moduleForcesX": [ - -60.19075395749284, - -52.99761897342073, - -83.00503571063983, - -81.71816250502042 + -71.99046256530353, + -72.9535224518983, + -58.21609003135491, + -60.635080354255095 ], "moduleForcesY": [ - 98.14890485863737, - 102.13208160331287, - 79.7649281328897, - 80.96099716076799 + 89.5505221976233, + 88.84114044999198, + 99.07653572080291, + 97.67708800954779 ], - "timestamp": 0.33755190764008525 + "timestamp": 0.3426712937011427 }, { - "x": 15.268296814292313, - "y": 2.508757545140913, - "heading": 2.2929332529509288, - "angularVelocity": -3.007286062436612, - "velocityX": -1.9306817096382098, - "velocityY": 2.1918515555684537, + "x": 15.260507627409444, + "y": 2.505421301762789, + "heading": 2.227820518874649, + "angularVelocity": -2.5254765113093023, + "velocityX": -1.8749574656677745, + "velocityY": 2.17211541550255, "moduleForcesX": [ - -85.6509418331789, - -83.21974573343564, - -39.29014814005921, - -49.62182640039944 + -103.96409482483048, + -88.63793057016247, + 27.03297066939857, + -18.83203285938997 ], "moduleForcesY": [ - 76.33230295247037, - 79.26870386093083, - 107.83989683014454, - 103.68667351103075 + 46.94680786578636, + 72.95986689454536, + 111.23995258444597, + 113.31276031147173 ], - "timestamp": 0.385773608731526 + "timestamp": 0.3916243356584488 }, { - "x": 15.167273163864417, - "y": 2.6272614661882616, - "heading": 2.192483841142394, - "angularVelocity": -2.0830748301072206, - "velocityX": -2.094983132932844, - "velocityY": 2.457481141584662, + "x": 15.160614493792021, + "y": 2.625256965891475, + "heading": 2.148185511483945, + "angularVelocity": -1.6267632042183744, + "velocityX": -2.040590934152655, + "velocityY": 2.447971757052899, "moduleForcesX": [ - -111.50990385741927, - -93.77065830212739, - 31.47024486109391, - -19.72183059871059 + -109.76906836848089, + -91.60388970860063, + 28.057909186627626, + -18.87138570625826 ], "moduleForcesY": [ - 23.807930537003042, - 66.15966523066265, - 109.83338652042386, - 113.0865344229725 + 28.563607965062683, + 68.5617497423252, + 110.07521153624224, + 112.87874340021123 ], - "timestamp": 0.43399530982296675 + "timestamp": 0.4405773776157549 }, { - "x": 15.057713599974441, - "y": 2.758409518264657, - "heading": 2.1346911830057307, - "angularVelocity": -1.19847821268423, - "velocityX": -2.271997076217241, - "velocityY": 2.7196894574022785, + "x": 15.051627946447192, + "y": 2.757792536125906, + "heading": 2.111350366896993, + "angularVelocity": -0.7524587464672408, + "velocityX": -2.226348823013889, + "velocityY": 2.707402133469893, "moduleForcesX": [ - -111.33690202203812, - -94.29329121436452, - 20.64874218877548, - -23.524890313415185 + -110.18950347500598, + -94.4259270542439, + 14.699834174267496, + -25.62143661919158 ], "moduleForcesY": [ - 21.14398791701492, - 64.60956935693724, - 111.26982412256345, - 111.83418988380888 + 18.184454461784757, + 62.64193597534585, + 109.9317151220563, + 110.2619692224848 ], - "timestamp": 0.4822170109144075 + "timestamp": 0.489530419573061 }, { - "x": 14.939123021885464, - "y": 2.9015305147589396, - "heading": 2.118515084109538, - "angularVelocity": -0.33545268064100403, - "velocityX": -2.459278196430613, - "velocityY": 2.9679790064412654, + "x": 14.932668002427238, + "y": 2.8984574184284, + "heading": 2.110069243770664, + "angularVelocity": -0.02617044978437293, + "velocityX": -2.430082774514228, + "velocityY": 2.8734656045941884, "moduleForcesX": [ - -109.90734646465863, - -95.44964108875479, - 12.323649647426928, - -27.56680498190866 + -92.36401865218923, + -91.86525255334118, + -13.775378324438481, + -38.39021742122913 ], "moduleForcesY": [ - 14.22484679740834, - 60.09889909493547, - 108.94658536069632, - 109.19219744802825 + -7.300594232715907, + 39.18020348444654, + 72.06842144476734, + 88.73734095010511 ], - "timestamp": 0.5304387120058482 + "timestamp": 0.5384834615303671 }, { - "x": 14.831414608923223, - "y": 3.042823929898297, - "heading": 2.079454334080419, - "angularVelocity": -0.810024307418132, - "velocityX": -2.2336087388953505, - "velocityY": 2.9300794443445275, + "x": 14.823742433714235, + "y": 3.0397405651206304, + "heading": 2.0918846184637117, + "angularVelocity": -0.37147079282243645, + "velocityX": -2.2251031673879456, + "velocityY": 2.886095348476168, "moduleForcesX": [ - 78.58895661845102, - 86.9590857830952, - 44.49000954099232, - 55.78006427224323 + 66.0958843630111, + 75.77307715908528, + 41.70517572547554, + 54.2660783742387 ], "moduleForcesY": [ - 25.485604518307493, - -12.094864031659714, - -7.044135345916485, - -50.98884566344755 + 27.97723606877112, + 0.7831305877592326, + 9.942344895823817, + -24.048273238894506 ], - "timestamp": 0.578660413097289 + "timestamp": 0.5874365034876732 }, { - "x": 14.733793356735978, - "y": 3.1721894754099615, - "heading": 2.0031780174103724, - "angularVelocity": -1.5817840296717673, - "velocityX": -2.024425724885401, - "velocityY": 2.682724636079386, + "x": 14.72599195439228, + "y": 3.1702342553440688, + "heading": 2.0336869133387605, + "angularVelocity": -1.1888475730620756, + "velocityX": -1.9968213498878276, + "velocityY": 2.665691140060036, "moduleForcesX": [ - 111.37255677304942, - 95.99744403653128, - 7.645693964257517, - 31.382888958151483 + 111.27282203862381, + 101.22591211394963, + 14.318118907425358, + 38.061187531246006 ], "moduleForcesY": [ - -13.253824008375226, - -60.24311649694943, - -109.35760318563327, - -108.50694531086866 + 4.4785198846546805, + -49.58576299828389, + -105.25159638909281, + -105.37871989926775 ], - "timestamp": 0.6268821141887297 + "timestamp": 0.6363895454449793 }, { - "x": 14.645878240653719, - "y": 3.288248837696076, - "heading": 1.8939909192803934, - "angularVelocity": -2.2642730484130293, - "velocityX": -1.8231442295150284, - "velocityY": 2.4067869788756644, + "x": 14.638748196164602, + "y": 3.2878829961076765, + "heading": 1.9394014366639316, + "angularVelocity": -1.926039177648179, + "velocityX": -1.78219278598079, + "velocityY": 2.4032978556606244, "moduleForcesX": [ - 109.70942329970316, - 89.71754326673916, - 12.019633647312192, - 25.644712508023197 + 111.93956922977851, + 94.27122591142299, + 13.09747450250458, + 29.72774244507937 ], "moduleForcesY": [ - -30.590752966210594, - -71.02373862357852, - -112.0983625887034, - -111.31663378024953 + -18.973143563334187, + -64.43873357870562, + -111.06555752369113, + -109.98053661348601 ], - "timestamp": 0.6751038152801705 + "timestamp": 0.6853425874022854 }, { - "x": 14.567227788945956, - "y": 3.3902029354711787, - "heading": 1.7550450964686277, - "angularVelocity": -2.881396128027259, - "velocityX": -1.631017776801797, - "velocityY": 2.1142783325244223, + "x": 14.561389703577776, + "y": 3.3914450724763703, + "heading": 1.8130509208960486, + "angularVelocity": -2.5810554506107266, + "velocityX": -1.5802591523046463, + "velocityY": 2.115539141839674, "moduleForcesX": [ - 107.14229823866029, - 83.56953629253546, - 16.512015162582642, - 19.08365462270342 + 108.89813742754394, + 86.94044286405637, + 15.945707139726329, + 22.521649867339463 ], "moduleForcesY": [ - -40.388808530169484, - -78.71040904165837, - -112.40665921116027, - -113.04273071952844 + -34.72614750544731, + -74.77427759019352, + -112.13240268428117, + -112.25694546017392 ], - "timestamp": 0.7233255163716112 + "timestamp": 0.7342956293595915 }, { - "x": 14.49719619180086, - "y": 3.4776074509889465, - "heading": 1.5874267428579882, - "angularVelocity": -3.475994206276373, - "velocityX": -1.4522838381893535, - "velocityY": 1.812555624116751, + "x": 14.493202146414575, + "y": 3.4801843218782924, + "heading": 1.6568085525977703, + "angularVelocity": -3.1916784340907887, + "velocityX": -1.392917670422911, + "velocityY": 1.8127422902937624, "moduleForcesX": [ - 106.14720313378764, - 77.64221219396602, - 18.40490708195517, - 8.33801716568237 + 106.45822211595201, + 80.10960219573016, + 17.65679408253046, + 13.149875929102251 ], "moduleForcesY": [ - -43.736432029436294, - -84.81783816234795, - -112.32150159790282, - -114.52616360787027 + -42.63111245871026, + -82.37686544045971, + -112.34316617829377, + -113.98755478600889 ], - "timestamp": 0.771547217463052 + "timestamp": 0.7832486713168976 }, { - "x": 14.436617373792393, - "y": 3.5501556245447876, - "heading": 1.3983005141839007, - "angularVelocity": -3.9220148686885814, - "velocityX": -1.2562563459466622, - "velocityY": 1.5044714705993272, + "x": 14.433222849775504, + "y": 3.5537494938016434, + "heading": 1.4705951628332716, + "angularVelocity": -3.803918659986439, + "velocityX": -1.2252414608224262, + "velocityY": 1.502770185148768, "moduleForcesX": [ - 101.15910205833607, - 70.91594042910839, - 49.12014885114002, - 9.707383087632545 + 106.15263304237581, + 73.3443765179212, + 17.473283255487672, + -2.41364200971868 ], "moduleForcesY": [ - -54.64864966949359, - -90.63705631390815, - -103.10697098452282, - -114.50246275576043 + -43.97011401143013, + -88.63358939438082, + -112.21755339050702, + -114.84297204095257 ], - "timestamp": 0.8197689185544927 + "timestamp": 0.8322017132742037 }, { - "x": 14.387392259795076, - "y": 3.6078010779952034, - "heading": 1.2154463058080842, - "angularVelocity": -3.7919485260189636, - "velocityX": -1.0208083266074082, - "velocityY": 1.1954255479520526, + "x": 14.384281474280659, + "y": 3.6117067421179105, + "heading": 1.27402659735858, + "angularVelocity": -4.015451494232434, + "velocityX": -0.9997616805356296, + "velocityY": 1.1839355841171237, "moduleForcesX": [ - 54.314455652099966, - 71.44382936842365, - 69.05779006643577, - 82.5202984339565 + 86.3744676805752, + 67.41409192129979, + 66.76192995299246, + 41.0763147581172 ], "moduleForcesY": [ - -101.45774094468416, - -90.14981383751505, - -92.14633676825393, - -80.27412481999961 + -75.94459361481906, + -93.25513893468546, + -93.38866768134871, + -107.35908537611219 ], - "timestamp": 0.8679906196459335 + "timestamp": 0.8811547552315098 }, { - "x": 14.349211618513907, - "y": 3.651400600452789, - "heading": 1.0506438733831094, - "angularVelocity": -3.4175988962410613, - "velocityX": -0.7917730071108346, - "velocityY": 0.9041473334777183, + "x": 14.346752541400093, + "y": 3.654620410688194, + "heading": 1.0910815045741515, + "angularVelocity": -3.737154739923585, + "velocityX": -0.7666312731561086, + "velocityY": 0.8766292521816487, "moduleForcesX": [ - 18.55584251040697, - 90.7960685839383, - 63.853520232036196, - 96.57736445012137 + 32.49392465624227, + 80.55920555280773, + 65.3512771133556, + 92.09950834270302 ], "moduleForcesY": [ - -113.64992224377941, - -70.53849669010278, - -95.98904481306886, - -62.92180680397959 + -110.42446436365066, + -82.02909062557538, + -94.9088970754182, + -69.20864919843588 ], - "timestamp": 0.9162123207373742 + "timestamp": 0.9301077971888159 }, { - "x": 14.32169543229896, - "y": 3.682483763115444, - "heading": 0.9151656588315976, - "angularVelocity": -2.8094864238532335, - "velocityX": -0.5706183231232216, - "velocityY": 0.6445886801818389, + "x": 14.320188407757405, + "y": 3.6843861833792286, + "heading": 0.9370514938584996, + "angularVelocity": -3.146484969207519, + "velocityX": -0.5426452081556838, + "velocityY": 0.6080474573529125, "moduleForcesX": [ - -6.332456186499789, - 110.7185031174238, - 57.28231604872361, - 98.83176021702745 + -5.385270543258571, + 108.75425048231756, + 57.78740711133415, + 98.73724209082938 ], "moduleForcesY": [ - -115.02092054012307, - -31.162381403626863, - -100.11057776943015, - -59.44262986998 + -115.0420177801382, + -37.2349168657311, + -99.80030517652864, + -59.5613318859354 ], - "timestamp": 0.964434021828815 + "timestamp": 0.979060839146122 }, { - "x": 14.304035283172022, - "y": 3.7023940350495996, - "heading": 0.8190216834517414, - "angularVelocity": -1.9937906213126355, - "velocityX": -0.3662282484280051, - "velocityY": 0.4128902855666648, + "x": 14.303469101351862, + "y": 3.703097894493808, + "heading": 0.8266449121513226, + "angularVelocity": -2.2553569153774875, + "velocityX": -0.3415376396905139, + "velocityY": 0.3822379645701155, "moduleForcesX": [ - -24.884078394615464, - 115.10010865685537, - 51.72593444923851, - 98.81097200345768 + -31.6917140615662, + 114.57748285872601, + 51.062756198166554, + 99.39891925787309 ], "moduleForcesY": [ - -112.50306629791396, - 2.2494262109702245, - -103.12309638155044, - -59.542919825583255 + -110.7628666047164, + 10.74305716248206, + -103.44652639596045, + -58.54303770810003 ], - "timestamp": 1.0126557229202557 + "timestamp": 1.028013881103428 }, { "x": 14.295448303222656, "y": 3.712002992630005, - "heading": 0.7688022564378523, - "angularVelocity": -1.0414279437936045, - "velocityX": -0.17807293718407954, - "velocityY": 0.19926625073189186, + "heading": 0.7688022564378524, + "angularVelocity": -1.1815947160937619, + "velocityX": -0.1638467765895081, + "velocityY": 0.18191102693290262, "moduleForcesX": [ - -38.582698455325584, - 113.1869774052545, - 48.251824048408935, - 98.7737574928677 + -49.71533486003576, + 109.59554076263647, + 46.816698420140504, + 99.47986509579346 ], "moduleForcesY": [ - -108.59855539761742, - 21.4261400418289, - -104.81345448783509, - -59.64383290029868 + -103.9680438500685, + 35.442271926549225, + -105.4606645383995, + -58.45523278739201 ], - "timestamp": 1.0608774240116965 + "timestamp": 1.0769669230607342 }, { "x": 14.295448303222656, "y": 3.712002992630005, "heading": 0.7688022564378523, - "angularVelocity": 5.898913315314164e-24, - "velocityX": 1.6143876828462686e-23, - "velocityY": -7.539437488938966e-24, + "angularVelocity": -5.838715201828975e-18, + "velocityX": 3.298801988973473e-17, + "velocityY": -5.0573065053666e-17, "moduleForcesX": [ - -47.48175193227343, - 110.17194913173417, - 47.45736232942377, - 99.60618042375738 + -60.020043156793854, + 103.80869334005449, + 45.863956482431625, + 100.46070860174449 ], "moduleForcesY": [ - -105.04769902960695, - 33.78870027617788, - -105.1895227540307, - -58.26901613919841 + -98.42521384623716, + 50.03039404179523, + -105.89459694294194, + -56.78405771323294 ], - "timestamp": 1.1090991251031372 + "timestamp": 1.1259199650180403 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/Red Source 4 Piece.traj b/src/main/deploy/choreo/Red Source 4 Piece.traj index de7bf11..994d449 100644 --- a/src/main/deploy/choreo/Red Source 4 Piece.traj +++ b/src/main/deploy/choreo/Red Source 4 Piece.traj @@ -3,10 +3,10 @@ { "x": 16.113388061523438, "y": 2.058690309524536, - "heading": -5.911290029889773e-27, - "angularVelocity": -2.2741368514930436e-27, - "velocityX": -1.5134316947281816e-27, - "velocityY": 1.4749091747640022e-26, + "heading": -1.3192675701555174e-27, + "angularVelocity": -5.120628312608516e-28, + "velocityX": 1.3128854005502987e-26, + "velocityY": -8.391381995810073e-27, "moduleForcesX": [ 0, 0, @@ -22,3154 +22,3196 @@ "timestamp": 0 }, { - "x": 16.034243809496502, - "y": 2.0445076102417237, - "heading": -1.9973497625460715e-17, - "angularVelocity": -2.0081338779051517e-16, - "velocityX": -0.7957156869122083, - "velocityY": -0.14259274695339164, + "x": 16.035595110824165, + "y": 2.0447497642817187, + "heading": -2.4595850198596315e-17, + "angularVelocity": -2.4942588059145585e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.14137070869321683, "moduleForcesX": [ - -113.60325815277731, - -113.60325815277731, - -113.60325815277731, - -113.60325815277731 + -113.60407786230425, + -113.60407786230425, + -113.60407786230425, + -113.60407786230425 ], "moduleForcesY": [ - -20.357774654060638, - -20.357774654060638, - -20.357774654060627, - -20.357774654060627 + -20.35792154651867, + -20.35792154651867, + -20.357921546518657, + -20.357921546518657 ], - "timestamp": 0.09946297820777839 + "timestamp": 0.09860985611290378 }, { - "x": 15.875967747836052, - "y": 2.016144441360754, - "heading": -5.1600821479672036e-17, - "angularVelocity": -3.1798086502327113e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.2851630766748124, + "x": 15.88002131887555, + "y": 2.0168708438170575, + "heading": -6.714340880249808e-17, + "angularVelocity": -4.3147369116802484e-16, + "velocityX": -1.5776697997661686, + "velocityY": -0.2827194112598734, "moduleForcesX": [ - -113.58539840433238, - -113.58539840433238, - -113.58539840433238, - -113.58539840433238 + -113.58639396060845, + -113.58639396060845, + -113.58639396060845, + -113.58639396060845 ], "moduleForcesY": [ - -20.354574176009816, - -20.35457417600981, - -20.35457417600981, - -20.354574176009802 + -20.354752580314873, + -20.354752580314873, + -20.35475258031486, + -20.35475258031486 ], - "timestamp": 0.19892595641555677 + "timestamp": 0.19721971222580756 }, { - "x": 15.638584633735167, - "y": 1.973605239386054, - "heading": -1.0173338631202558e-16, - "angularVelocity": -5.040324121575685e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563984, + "x": 15.64669087734002, + "y": 1.9750578832915355, + "heading": -1.2272941117994356e-16, + "angularVelocity": -5.636962121969091e-16, + "velocityX": -2.366197971817096, + "velocityY": -0.4240241510711468, "moduleForcesX": [ - -113.54986205488825, - -113.54986205488825, - -113.54986205488825, - -113.54986205488825 + -113.55106593310009, + -113.5510659331001, + -113.5510659331001, + -113.5510659331001 ], "moduleForcesY": [ - -20.348206040044566, - -20.348206040044566, - -20.34820604004456, - -20.34820604004456 + -20.348421775770348, + -20.348421775770344, + -20.34842177577033, + -20.34842177577033 ], - "timestamp": 0.29838893462333516 + "timestamp": 0.2958295683387113 }, { - "x": 15.322167709896716, - "y": 1.9169031294556198, - "heading": -1.5831936298865416e-16, - "angularVelocity": -5.689149640432954e-16, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223714, + "x": 15.33567611436212, + "y": 1.919323843953726, + "heading": -1.984834521633126e-16, + "angularVelocity": -7.682197699925159e-16, + "velocityX": -3.153992666025245, + "velocityY": -0.5651974511959198, "moduleForcesX": [ - -113.44472985048415, - -113.44472985048415, - -113.44472985048417, - -113.44472985048417 + -113.44544232466369, + -113.44544232466369, + -113.44544232466369, + -113.44544232466369 ], "moduleForcesY": [ - -20.32936628350109, - -20.329366283501095, - -20.329366283501088, - -20.32936628350109 + -20.32949395931806, + -20.329493959318057, + -20.329493959318047, + -20.329493959318047 ], - "timestamp": 0.39785191283111354 + "timestamp": 0.3944394244516151 }, { - "x": 14.933440688201186, - "y": 1.847243004928388, - "heading": -1.3388748730441698e-16, - "angularVelocity": 2.4563788587865287e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 14.96955403361122, + "y": 1.853714538930282, + "heading": -2.677696161176793e-16, + "angularVelocity": -7.02629196352577e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - -103.7935479018025, - -103.7935479018025, - -103.79354790180248, - -103.79354790180248 + -80.47536393454658, + -80.47536393454658, + -80.47536393454658, + -80.47536393454656 ], "moduleForcesY": [ - -18.59986846406024, - -18.59986846406025, - -18.599868464060304, - -18.599868464060314 + -14.421235366152786, + -14.421235366152787, + -14.421235366152782, + -14.421235366152784 ], - "timestamp": 0.4973148910388919 + "timestamp": 0.4930492805645189 }, { - "x": 14.544710433230385, - "y": 1.7775823009962126, - "heading": -1.3942252466686606e-16, - "angularVelocity": -5.564922203932182e-17, - "velocityX": -3.9082909236715535, - "velocityY": -0.7003681690151492, + "x": 14.603431176065946, + "y": 1.7881050947048025, + "heading": -2.763926852338733e-16, + "angularVelocity": -8.744632081727001e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - -0.004641026935404772, - -0.004641026935415979, - -0.004641026935404772, - -0.004641026935415979 + -0.0011343830986481722, + -0.0011343830986250908, + -0.0011343830986481722, + -0.0011343830986250908 ], "moduleForcesY": [ - -0.0008316749189531905, - -0.0008316749189531906, - -0.0008316749189381512, - -0.0008316749189381512 + -0.00020328215815896224, + -0.00020328215815896224, + -0.0002032821581899367, + -0.0002032821581899367 ], - "timestamp": 0.5967778692466703 + "timestamp": 0.5916591366774226 }, { - "x": 14.155980178236081, - "y": 1.7079215970598258, - "heading": -1.1657687895751773e-16, - "angularVelocity": 2.2968994216356014e-16, - "velocityX": -3.9082909239078325, - "velocityY": -0.7003681690574903, + "x": 14.237308318515241, + "y": 1.7224956504783495, + "heading": -2.5700045344553785e-16, + "angularVelocity": 1.9665612096159002e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -3.3733252146964024e-8, - -3.373324153298994e-8, - -3.3733252146964024e-8, - -3.373324153298994e-8 + -7.931396623961562e-9, + -7.93138596456208e-9, + -7.931396623961562e-9, + -7.93138596456208e-9 ], "moduleForcesY": [ - -6.044967827882044e-9, - -6.044967827882044e-9, - -6.044982071505302e-9, - -6.044982071505302e-9 + -1.4213120821275926e-9, + -1.4213120821275924e-9, + -1.4213263867103173e-9, + -1.4213263867103171e-9 ], - "timestamp": 0.6962408474544487 + "timestamp": 0.6902689927903264 }, { - "x": 13.76724992324178, - "y": 1.638260893123439, - "heading": -1.4660809842490734e-16, - "angularVelocity": -3.0193364413974614e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.871185460964536, + "y": 1.6568862062518965, + "heading": -2.332515600997504e-16, + "angularVelocity": 2.40836913132689e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145579, "moduleForcesX": [ - -1.7870291174645942e-13, - -1.984781114965229e-13, - -1.787029117464594e-13, - -1.984781114965229e-13 + -7.562455688591036e-14, + -7.396691286762598e-14, + -7.562455688591036e-14, + -7.396691286762598e-14 ], "moduleForcesY": [ - -8.523302234904917e-14, - -8.523302234904917e-14, - -5.869531905751317e-14, - -5.869531905751317e-14 + 1.6709316559536332e-14, + 1.6709316559536325e-14, + 1.4484809819973387e-14, + 1.4484809819973394e-14 ], - "timestamp": 0.7957038256622271 + "timestamp": 0.7888788489032301 }, { - "x": 13.378519668247476, - "y": 1.568600189187052, - "heading": -1.8997026664410195e-16, - "angularVelocity": -4.3596289796236307e-16, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.505062603413833, + "y": 1.5912767620254435, + "heading": -2.82486849779877e-16, + "angularVelocity": -4.992937989801628e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.2971156305683035e-14, - -2.795674260204148e-14, - -2.2971156305683035e-14, - -2.7956742602041482e-14 + -7.061347163052097e-15, + -3.483072809517994e-14, + -7.061347163052085e-15, + -3.483072809517994e-14 ], "moduleForcesY": [ - 2.0004203762822518e-15, - 2.0004203762822534e-15, - 8.690922193675191e-15, - 8.690922193675194e-15 + -2.7110230144014444e-14, + -2.7110230144014435e-14, + 1.0155415770084611e-14, + 1.0155415770084619e-14 ], - "timestamp": 0.8951668038700055 + "timestamp": 0.8874887050161339 }, { - "x": 12.989789413253172, - "y": 1.498939485250665, - "heading": -1.9166223749477501e-16, - "angularVelocity": -1.701106162880346e-17, - "velocityX": -3.908290923907834, - "velocityY": -0.7003681690574908, + "x": 13.138939745863128, + "y": 1.5256673177989906, + "heading": -2.91424140142493e-16, + "angularVelocity": -9.063283035491444e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - 1.7087397903500836e-14, - 3.2671462385594046e-14, - 1.708739790350083e-14, - 3.267146238559404e-14 + -3.0037169962633365e-14, + -1.4704388976622156e-14, + -3.003716996263337e-14, + -1.4704388976622162e-14 ], "moduleForcesY": [ - 1.1214756938034063e-14, - 1.1214756938034063e-14, - -9.698573118246464e-15, - -9.698573118246464e-15 + -7.860080706118566e-15, + -7.860080706118574e-15, + -2.843619612257921e-14, + -2.8436196122579215e-14 ], - "timestamp": 0.9946297820777839 + "timestamp": 0.9860985611290376 }, { - "x": 12.60105915825887, - "y": 1.4292787813142782, - "heading": -2.1132473221281133e-16, - "angularVelocity": -1.9768656716015265e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574908, + "x": 12.772816888312423, + "y": 1.4600578735725376, + "heading": -2.7866776993087006e-16, + "angularVelocity": 1.2936202034999922e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.6653436767145581, "moduleForcesX": [ - -3.1561091183989215e-14, - -3.8281812957585957e-14, - -3.1561091183989215e-14, - -3.828181295758595e-14 + -2.8027421800298478e-14, + -1.9773311124507672e-14, + -2.802742180029848e-14, + -1.9773311124507675e-14 ], "moduleForcesY": [ - -4.378246769835839e-15, - -4.378246769835839e-15, - 4.6407529159753206e-15, - 4.640752915975323e-15 + 1.1639794476609557e-14, + 1.1639794476609555e-14, + 5.630345541752581e-16, + 5.6303455417525595e-16 ], - "timestamp": 1.0940927602855623 + "timestamp": 1.0847084172419414 }, { - "x": 12.212328903264568, - "y": 1.3596180773778912, - "heading": -2.338892446919063e-16, - "angularVelocity": -2.268634308989279e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 12.406694030761718, + "y": 1.3944484293460846, + "heading": -2.5646567159181086e-16, + "angularVelocity": 2.2515090492364207e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7190572709139343e-14, - 1.610525910872734e-14, - 1.7190572709139343e-14, - 1.610525910872734e-14 + -1.3808172671853046e-14, + -1.0214215575821213e-14, + -1.3808172671853046e-14, + -1.0214215575821214e-14 ], "moduleForcesY": [ - -7.29643917334954e-15, - -7.296439173349538e-15, - -5.839982061915815e-15, - -5.839982061915817e-15 + 2.222720485034565e-14, + 2.2227204850345648e-14, + 1.7404226156707074e-14, + 1.7404226156707077e-14 ], - "timestamp": 1.1935557384933406 + "timestamp": 1.1833182733548453 }, { - "x": 11.823598648270266, - "y": 1.2899573734415042, - "heading": -2.5927098275735137e-16, - "angularVelocity": -2.5518779478058447e-16, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 12.040571173211013, + "y": 1.3288389851196316, + "heading": -2.2224229801002295e-16, + "angularVelocity": 3.470583461819397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.6641443511735072e-14, - 2.5587840985466278e-14, - 2.6641443511735072e-14, - 2.5587840985466278e-14 + 2.0175105295583998e-14, + 2.474901922640669e-14, + 2.0175105295583998e-14, + 2.474901922640669e-14 ], "moduleForcesY": [ - -1.386672429304071e-14, - -1.3866724293040708e-14, - -1.245282245727067e-14, - -1.2452822457270669e-14 + -6.607702607368945e-16, + -6.607702607368945e-16, + -6.798820561685491e-15, + -6.798820561685492e-15 ], - "timestamp": 1.293018716701119 + "timestamp": 1.2819281294677491 }, { - "x": 11.434868393275963, - "y": 1.2202966695051174, - "heading": -2.6144430481414593e-16, - "angularVelocity": -2.1850562913018142e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.700368169057491, + "x": 11.674448315660308, + "y": 1.2632295408931786, + "heading": -1.749528087057396e-16, + "angularVelocity": 4.795614877086492e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 4.753825314085828e-15, - 1.343344466918967e-14, - 4.7538253140858264e-15, - 1.343344466918967e-14 + 5.420610091677358e-16, + 5.5135209844670774e-15, + 5.420610091677348e-16, + 5.513520984467076e-15 ], "moduleForcesY": [ - 1.0157777233279833e-14, - 1.0157777233279832e-14, - -1.4900021085434622e-15, - -1.4900021085434647e-15 + 3.291962753668972e-15, + 3.291962753668971e-15, + -3.3795819800228904e-15, + -3.379581980022891e-15 ], - "timestamp": 1.3924816949088972 + "timestamp": 1.380537985580653 }, { - "x": 11.046138138281659, - "y": 1.1506359655687304, - "heading": -2.6668925840610884e-16, - "angularVelocity": -5.273272220977154e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 11.308325458109605, + "y": 1.1976200966667256, + "heading": -1.6545141916537567e-16, + "angularVelocity": 9.635334550294471e-17, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 1.7853846881122523e-14, - 1.6705100127704452e-14, - 1.7853846881122526e-14, - 1.6705100127704452e-14 + 2.6333944897208536e-14, + 1.1956142837319584e-14, + 2.633394489720854e-14, + 1.1956142837319587e-14 ], "moduleForcesY": [ - 1.849796258873549e-14, - 1.849796258873549e-14, - 2.003954501948825e-14, - 2.003954501948825e-14 + -1.1841756113294508e-14, + -1.1841756113294505e-14, + 7.452807272774088e-15, + 7.45280727277409e-15 ], - "timestamp": 1.4919446731166754 + "timestamp": 1.4791478416935568 }, { - "x": 10.657407883287357, - "y": 1.0809752616323434, - "heading": -2.7494742477186974e-16, - "angularVelocity": -8.30275397395283e-17, - "velocityX": -3.9082909239078343, - "velocityY": -0.7003681690574909, + "x": 10.9422026005589, + "y": 1.1320106524402727, + "heading": -1.526261764676561e-16, + "angularVelocity": 1.300604543963397e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - -2.1611152108969522e-14, - -2.2738051071840055e-14, - -2.1611152108969522e-14, - -2.273805107184005e-14 + 3.007335775164219e-14, + 3.1338033749628167e-14, + 3.007335775164219e-14, + 3.1338033749628167e-14 ], "moduleForcesY": [ - -2.541885019413972e-15, - -2.541885019413971e-15, - -1.029621644370098e-15, - -1.0296216443700978e-15 + 1.4884372070057383e-15, + 1.488437207005738e-15, + -2.0871866593917718e-16, + -2.0871866593917757e-16 ], - "timestamp": 1.5914076513244537 + "timestamp": 1.5777576978064607 }, { - "x": 10.268677628293055, - "y": 1.0113145576959566, - "heading": -2.4823569959460315e-16, - "angularVelocity": 2.685594745727998e-16, - "velocityX": -3.908290923907833, - "velocityY": -0.7003681690574906, + "x": 10.576079743008195, + "y": 1.0664012082138195, + "heading": -2.1191759554461745e-16, + "angularVelocity": -6.012727471398986e-16, + "velocityX": -3.71284242755116, + "velocityY": -0.665343676714558, "moduleForcesX": [ - 2.1832676574649537e-13, - 2.314050106112521e-13, - 2.1832676574649537e-13, - 2.314050106112521e-13 + -2.3895223984057537e-15, + -2.9828824577607686e-14, + -2.3895223984057454e-15, + -2.9828824577607686e-14 ], "moduleForcesY": [ - 5.4206089243145896e-14, - 5.420608924314589e-14, - 3.665549121220295e-14, - 3.665549121220295e-14 + -1.750033498040077e-14, + -1.7500334980400767e-14, + 1.932235550878732e-14, + 1.9322355508787322e-14 ], - "timestamp": 1.690870629532232 + "timestamp": 1.6763675539193645 }, { - "x": 9.879947373322251, - "y": 0.9416538537637811, - "heading": -2.9953417979362097e-16, - "angularVelocity": -5.157545162271987e-16, - "velocityX": -3.908290923671554, - "velocityY": -0.7003681690151493, + "x": 10.20995688545749, + "y": 1.0007917639873665, + "heading": -2.51438081505781e-16, + "angularVelocity": -4.0077622585012835e-16, + "velocityX": -3.7128424275511596, + "velocityY": -0.6653436767145577, "moduleForcesX": [ - 3.3733273434030475e-8, - 3.3733244259316946e-8, - 3.3733273434030475e-8, - 3.3733244259316946e-8 + 2.725363312900704e-14, + 3.4776175004574016e-14, + 2.725363312900703e-14, + 3.477617500457401e-14 ], "moduleForcesY": [ - 6.0449968765387015e-9, - 6.0449968765387015e-9, - 6.045036028097271e-9, - 6.045036028097271e-9 + 3.7096019824998565e-14, + 3.709601982499856e-14, + 2.7001002489393173e-14, + 2.7001002489393167e-14 ], - "timestamp": 1.7903336077400103 + "timestamp": 1.7749774100322684 }, { - "x": 9.49122035162672, - "y": 0.8719937292365494, - "heading": -3.3337730352683075e-16, - "angularVelocity": -3.402584997030302e-16, - "velocityX": -3.9082584163474157, - "velocityY": -0.7003623436824064, + "x": 9.843834027912218, + "y": 0.9351823197618869, + "heading": -2.4245001806495676e-16, + "angularVelocity": 9.114771881288216e-17, + "velocityX": -3.712842427496082, + "velocityY": -0.665343676704688, "moduleForcesX": [ - 0.004641026935428245, - 0.004641026935434773, - 0.004641026935428245, - 0.004641026935434773 + 7.931400721741463e-9, + 7.931419178512931e-9, + 7.931400721741463e-9, + 7.931419178512931e-9 ], "moduleForcesY": [ - 0.0008316749189632649, - 0.0008316749189632649, - 0.0008316749189545045, - 0.0008316749189545045 + 1.4212969989409796e-9, + 1.4212969989409796e-9, + 1.4212722305274573e-9, + 1.4212722305274573e-9 ], - "timestamp": 1.8897965859477885 + "timestamp": 1.8735872661451722 }, { - "x": 9.17480342778827, - "y": 0.8152916193061152, - "heading": -2.1211685834383712e-16, - "angularVelocity": 1.2191515613294572e-15, - "velocityX": -3.181253261665425, - "velocityY": -0.5700825669223712, + "x": 9.477711947161318, + "y": 0.8695730147384431, + "heading": -2.6800974586446296e-16, + "angularVelocity": -2.5920053846645386e-16, + "velocityX": -3.7128345500444366, + "velocityY": -0.6653422650604442, "moduleForcesX": [ - 103.79354790180251, - 103.79354790180251, - 103.79354790180251, - 103.79354790180253 + 0.0011343830986540345, + 0.0011343830986408896, + 0.0011343830986540345, + 0.0011343830986408896 ], "moduleForcesY": [ - 18.59986846406036, - 18.599868464060346, - 18.599868464060243, - 18.599868464060233 + 0.00020328215816338424, + 0.00020328215816338424, + 0.0002032821581810242, + 0.0002032821581810242 ], - "timestamp": 1.9892595641555668 + "timestamp": 1.972197122258076 }, { - "x": 8.937420313687385, - "y": 0.7727524173314154, - "heading": -1.1312637475443375e-16, - "angularVelocity": 9.95249542760621e-16, - "velocityX": -2.3866479606612034, - "velocityY": -0.42768880181563973, + "x": 9.166697184183416, + "y": 0.8138389754006334, + "heading": -1.6375905468462317e-16, + "angularVelocity": 1.0572035624806777e-15, + "velocityX": -3.1539926660252453, + "velocityY": -0.5651974511959199, "moduleForcesX": [ - 113.44472985048417, - 113.44472985048417, - 113.44472985048415, - 113.44472985048415 + 80.47536393454655, + 80.47536393454658, + 80.47536393454656, + 80.47536393454658 ], "moduleForcesY": [ - 20.329366283501077, - 20.32936628350108, - 20.329366283501102, - 20.329366283501106 + 14.42123536615281, + 14.421235366152803, + 14.421235366152724, + 14.421235366152716 ], - "timestamp": 2.088722542363345 + "timestamp": 2.07080697837098 }, { - "x": 8.779144252026935, - "y": 0.7443892484504455, - "heading": -3.93728468407683e-17, - "angularVelocity": 7.415173890439025e-16, - "velocityX": -1.59130627809888, - "velocityY": -0.28516307667481233, + "x": 8.933366742647888, + "y": 0.7720260148751115, + "heading": -8.625567458400124e-17, + "angularVelocity": 7.859597727261062e-16, + "velocityX": -2.3661979718170962, + "velocityY": -0.4240241510711469, "moduleForcesX": [ - 113.54986205488825, - 113.54986205488825, - 113.54986205488825, - 113.54986205488825 + 113.44544232466369, + 113.44544232466369, + 113.44544232466369, + 113.44544232466369 ], "moduleForcesY": [ - 20.348206040044545, - 20.34820604004455, - 20.34820604004457, - 20.348206040044573 + 20.329493959318043, + 20.329493959318043, + 20.32949395931806, + 20.32949395931806 ], - "timestamp": 2.1881855205711234 + "timestamp": 2.169416834483884 + }, + { + "x": 8.777792950699272, + "y": 0.7441470944104505, + "heading": -2.504882545970686e-17, + "angularVelocity": 6.206970736540284e-16, + "velocityX": -1.5776697997661688, + "velocityY": -0.2827194112598734, + "moduleForcesX": [ + 113.55106593310009, + 113.5510659331001, + 113.55106593310009, + 113.55106593310009 + ], + "moduleForcesY": [ + 20.34842177577033, + 20.348421775770326, + 20.348421775770344, + 20.348421775770348 + ], + "timestamp": 2.2680266905967876 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.2763995877770643e-23, - "angularVelocity": 3.95854163827864e-16, - "velocityX": -0.7957156869122084, - "velocityY": -0.1425927469533916, + "heading": 1.3902950846098237e-21, + "angularVelocity": 2.5403358995413573e-16, + "velocityX": -0.7888963006923341, + "velocityY": -0.1413707086932168, "moduleForcesX": [ - 113.58539840433238, - 113.58539840433238, - 113.58539840433238, - 113.58539840433238 + 113.58639396060846, + 113.58639396060845, + 113.58639396060845, + 113.58639396060845 ], "moduleForcesY": [ - 20.354574176009788, - 20.354574176009795, - 20.354574176009816, - 20.354574176009823 + 20.35475258031486, + 20.35475258031486, + 20.354752580314877, + 20.354752580314877 ], - "timestamp": 2.2876484987789016 + "timestamp": 2.3666365467096915 }, { "x": 8.7, "y": 0.7302065491676331, - "heading": -1.315227470936058e-23, - "angularVelocity": -3.969132704994349e-24, - "velocityX": 1.0890521860195893e-24, - "velocityY": 5.6866921822786504e-24, + "heading": 1.4027105999712067e-21, + "angularVelocity": 1.258894947744667e-22, + "velocityX": 1.6132701940704752e-22, + "velocityY": 3.624341577856218e-22, "moduleForcesX": [ - 113.60325815277731, - 113.60325815277731, - 113.60325815277731, - 113.60325815277731 + 113.60407786230425, + 113.60407786230425, + 113.60407786230425, + 113.60407786230425 ], "moduleForcesY": [ - 20.357774654060616, - 20.357774654060616, - 20.35777465406064, - 20.35777465406065 + 20.357921546518654, + 20.357921546518654, + 20.357921546518668, + 20.35792154651867 ], - "timestamp": 2.38711147698668 + "timestamp": 2.4652464028225953 }, { - "x": 8.749697525208294, - "y": 0.7486471398847376, - "heading": 0.02845270874371011, - "angularVelocity": 0.35037941350634527, - "velocityX": 0.611997609508755, - "velocityY": 0.22708570274870504, + "x": 8.746921743709395, + "y": 0.7475758768470208, + "heading": 0.030374708631720888, + "angularVelocity": 0.3844322390186118, + "velocityX": 0.5938569225985214, + "velocityY": 0.21983188747567822, "moduleForcesX": [ - 98.5991688650241, - 103.9054385308619, - 112.25808633757455, - 113.31145977613869 + 97.08636346934237, + 103.3854037020227, + 112.73947029508177, + 113.70612876978298 ], "moduleForcesY": [ - 59.96747683817386, - 50.24070001601607, - 26.723188479519543, - 21.9083400310118 + 62.38345613408076, + 51.30130417295828, + 24.59721210153914, + 19.752811466970538 ], - "timestamp": 2.4683169007271215 + "timestamp": 2.5442582690210758 }, { - "x": 8.849156577034107, - "y": 0.7856168809153166, - "heading": 0.08307898135737164, - "angularVelocity": 0.6726924150813449, - "velocityX": 1.224783361068523, - "velocityY": 0.45526196807673974, + "x": 8.840842415957127, + "y": 0.7824201103535564, + "heading": 0.0887396108421577, + "angularVelocity": 0.7386852762573924, + "velocityX": 1.1886907216164013, + "velocityY": 0.44100000649276727, "moduleForcesX": [ - 99.75724138640882, - 103.91806545859839, - 112.08705733206624, - 112.86307129194968 + 98.44357768722071, + 103.3663432807897, + 112.56382635716881, + 113.2458848815574 ], "moduleForcesY": [ - 57.99159008453139, - 50.18528756830434, - 27.37363860720728, - 24.052005242751928 + 60.18928815483851, + 51.30995429297123, + 25.32325446348916, + 22.17288947410142 ], - "timestamp": 2.549522324467563 + "timestamp": 2.623270135219556 }, { - "x": 8.998468662854163, - "y": 0.8412229963489036, - "heading": 0.16020071685878773, - "angularVelocity": 0.949711631921556, - "velocityX": 1.838695975496751, - "velocityY": 0.6847586389219772, + "x": 8.981875095948194, + "y": 0.8348658019205454, + "heading": 0.17117745322357367, + "angularVelocity": 1.0433602741938677, + "velocityX": 1.784955688007542, + "velocityY": 0.6637698119323436, "moduleForcesX": [ - 101.42006410641166, - 104.11265608433904, - 111.7271355600726, - 112.15378683051922 + 100.41233501810491, + 103.5548940276436, + 112.18043737384708, + 112.5008166473148 ], "moduleForcesY": [ - 54.984671240448485, - 49.73281322981778, - 28.724585734295502, - 27.08403574576014 + 56.79519440863829, + 50.8794713381393, + 26.877817481486677, + 25.594338331171862 ], - "timestamp": 2.6307277482080047 + "timestamp": 2.7022820014180366 }, { - "x": 9.197770113060493, - "y": 0.9155841520343786, - "heading": 0.25288489149857346, - "angularVelocity": 1.141354485582565, - "velocityX": 2.454287423502156, - "velocityY": 0.9157166142394266, + "x": 9.170193806235403, + "y": 0.905047849903824, + "heading": 0.27014704823869273, + "angularVelocity": 1.2525915381685058, + "velocityX": 2.383423140698203, + "velocityY": 0.8882469350487014, "moduleForcesX": [ - 103.92861554586716, - 104.98869457390772, - 110.77607463143484, - 110.8945520614623 + 103.40298640344946, + 104.5638907933371, + 111.12271990152317, + 111.14222972427875 ], "moduleForcesY": [ - 49.99408871314561, - 47.7642847739149, - 32.07204722537332, - 31.71782432020252 + 51.0556107106465, + 48.6758061597135, + 30.821794358941716, + 30.820982678865775 ], - "timestamp": 2.7119331719484463 + "timestamp": 2.781293867616517 }, { - "x": 9.44716479258539, - "y": 1.0087906432972022, - "heading": 0.34521028833138984, - "angularVelocity": 1.1369363347935713, - "velocityX": 3.0711579108563343, - "velocityY": 1.1477865266825218, + "x": 9.40593573622577, + "y": 0.9930498413232173, + "heading": 0.36785454850899846, + "angularVelocity": 1.2366180546205672, + "velocityX": 2.983626907358139, + "velocityY": 1.113781962804538, "moduleForcesX": [ - 107.9455056410082, - 107.94355502791348, - 107.7979462288896, - 107.79557995601229 + 108.1423184266996, + 108.14622857930792, + 107.59649154427585, + 107.59500574441716 ], "moduleForcesY": [ - 40.383323246666976, - 40.386866616605445, - 40.77561046788362, - 40.780211699947586 + 39.81251263328706, + 39.79515762619855, + 41.26483057998931, + 41.26220935675603 ], - "timestamp": 2.793138595688888 + "timestamp": 2.8603057338149975 }, { - "x": 9.743254546944904, - "y": 1.1197154475688877, - "heading": 0.366082064748327, - "angularVelocity": 0.25702441358658573, - "velocityX": 3.6461820001815624, - "velocityY": 1.3659777778666213, + "x": 9.683387271031574, + "y": 1.0968882632669579, + "heading": 0.3737950413323585, + "angularVelocity": 0.0751848185491193, + "velocityX": 3.511517296767004, + "velocityY": 1.3142130029291395, "moduleForcesX": [ - 114.50263359045593, - 114.48153022441875, - 92.89940889941946, - 80.3287014204201 + 114.92109699391807, + 111.16467067641456, + 88.39242273361798, + 65.01654331360074 ], "moduleForcesY": [ - 11.01893061920688, - -8.214078066637066, - 67.83670510440811, - 81.97674297463185 + 4.148148544540557, + -28.016980604792366, + 73.55404230537428, + 94.40251274978336 ], - "timestamp": 2.8743440194293295 + "timestamp": 2.939317600013478 }, { - "x": 10.04517026477605, - "y": 1.2327664453559726, - "heading": 0.36619792232508147, - "angularVelocity": 0.001426722150047545, - "velocityX": 3.7179255267008346, - "velocityY": 1.3921606781885905, + "x": 9.962406006796718, + "y": 1.201509394881753, + "heading": 0.37391809195022235, + "angularVelocity": 0.001557368833116526, + "velocityX": 3.5313523042759076, + "velocityY": 1.3241192323186375, "moduleForcesX": [ - 20.675376664017367, - 10.058722820162606, - 15.100494848677528, - 4.347871917595204 + 6.012702465623703, + 2.809169459616938, + 4.321760134676471, + 1.1155418972110314 ], "moduleForcesY": [ - -0.6516753204632776, - -4.9242298237286946, - 13.911513369659277, - 9.978553002629607 + 0.25591605391839173, + -1.0053994170959915, + 4.561565207999552, + 3.3094001138140294 ], - "timestamp": 2.955549443169771 + "timestamp": 3.0183294662119584 }, { - "x": 10.347086763223185, - "y": 1.3458158061592695, - "heading": 0.366313361291408, - "angularVelocity": 0.0014215671935355297, - "velocityX": 3.717935139556162, - "velocityY": 1.3921405196362118, + "x": 10.241422645398577, + "y": 1.3061362496498794, + "heading": 0.374041018087458, + "angularVelocity": 0.0015557933656043376, + "velocityX": 3.5313257618920133, + "velocityY": 1.3241916664175475, "moduleForcesX": [ - 0.0018470631612436685, - 0.0016277805976543929, - 0.0017341728177355192, - 0.001514890254104659 + -0.0047178363595807, + -0.004786508231731981, + -0.004754009184713588, + -0.004822681056852332 ], "moduleForcesY": [ - -0.0036301509175129874, - -0.0037142738378569294, - -0.003335880534841119, - -0.0034200034551973633 + 0.012985423783144328, + 0.012958468742882152, + 0.013077579297975673, + 0.013050624257716973 ], - "timestamp": 3.0367548669102127 + "timestamp": 3.097341332410439 }, { - "x": 10.64900328277143, - "y": 1.4588651106250559, - "heading": 0.36642880011188633, - "angularVelocity": 0.0014215653974949576, - "velocityX": 3.717935399404689, - "velocityY": 1.3921398258708442, + "x": 10.520439212462904, + "y": 1.4107632952116884, + "heading": 0.3741639439073583, + "angularVelocity": 0.001555789349304766, + "velocityX": 3.531324856489611, + "velocityY": 1.3241940811647468, "moduleForcesX": [ - 0.00004549695252604368, - 0.000045420555579632215, - 0.00004545760851848642, - 0.000045381211572074955 + -0.0001625873675282764, + -0.0001627624225494424, + -0.0001626796108707561, + -0.00016285466589192513 ], "moduleForcesY": [ - -0.00012135367009232236, - -0.00012138298821378404, - -0.00012125114776527303, - -0.0001212804658867347 + 0.0004339008689113104, + 0.0004338321315943089, + 0.00043413578730753475, + 0.0004340670499905359 ], - "timestamp": 3.1179602906506543 + "timestamp": 3.1763531986089193 }, { - "x": 10.950919802007403, - "y": 1.5719144159306049, - "heading": 0.36654423879403597, - "angularVelocity": 0.0014215636940539118, - "velocityX": 3.7179353955592287, - "velocityY": 1.392139836212059, + "x": 10.799455776813222, + "y": 1.5153903480276578, + "heading": 0.37428686940727074, + "angularVelocity": 0.0015557852994340933, + "velocityX": 3.53132482214022, + "velocityY": 1.3241941729757738, "moduleForcesX": [ - -6.175555322723859e-7, - -6.900104256789466e-7, - -6.548822821618376e-7, - -7.273371755683984e-7 + -0.000006038575439683577, + -0.000006215085169064049, + -0.000006131618953715752, + -0.000006308128683095867 ], "moduleForcesY": [ - 0.0000017736345295412757, - 0.000001745819615530989, - 0.0000018708667440091473, - 0.0000018430518299988607 + 0.000016416721911056802, + 0.000016347388327240465, + 0.000016653592480530648, + 0.00001658425889671332 ], - "timestamp": 3.199165714391096 + "timestamp": 3.2553650648073997 }, { - "x": 11.252836297906729, - "y": 1.6849637835662303, - "heading": 0.36665967733637467, - "angularVelocity": 0.0014215619723584874, - "velocityX": 3.7179351081812904, - "velocityY": 1.392140603772568, + "x": 11.07847234022828, + "y": 1.6200174033544013, + "heading": 0.3744097945845876, + "angularVelocity": 0.0015557812165593802, + "velocityX": 3.5313248103033033, + "velocityY": 1.3241942047529474, "moduleForcesX": [ - -0.00005019760036002295, - -0.00005027082844721402, - -0.00005023533845441479, - -0.000050308566541605865 + -0.0000019914727432141183, + -0.0000021694123278502697, + -0.0000020853038623682895, + -0.00000226324344700444 ], "moduleForcesY": [ - 0.00013418637131016692, - 0.00013415824987303315, - 0.0001342846411266562, - 0.0001342565196895224 + 0.000005626632786408257, + 0.000005556712299934303, + 0.0000058654221771894254, + 0.000005795501690715472 ], - "timestamp": 3.2803711381315375 + "timestamp": 3.33437693100588 }, { - "x": 11.554752108451195, - "y": 1.7980149815274173, - "heading": 0.36677511575973815, - "angularVelocity": 0.0014215605072443334, - "velocityX": 3.7179266684142243, - "velocityY": 1.3921631432222437, + "x": 11.357488887388348, + "y": 1.7246445020461594, + "heading": 0.3745327194374754, + "angularVelocity": 0.00155577711047777, + "velocityX": 3.531324604574814, + "velocityY": 1.3241947535947427, "moduleForcesX": [ - -0.0014757943893018654, - -0.001475856701571945, - -0.001475826513007055, - -0.0014758888252771351 + -0.00003683733250123687, + -0.00003701627484165169, + -0.00003693172647393205, + -0.00003711066881434762 ], "moduleForcesY": [ - 0.003941389083174159, - 0.003941365145432393, - 0.0039414727043032135, - 0.003941448766561447 + 0.00009855422104990495, + 0.00009848388113975036, + 0.0000987943561077727, + 0.00009872401619761882 ], - "timestamp": 3.361576561871979 + "timestamp": 3.4133887972043606 }, { - "x": 11.856647446672115, - "y": 1.911120366719257, - "heading": 0.3668909923479222, - "angularVelocity": 0.0014269562653164898, - "velocityX": 3.717674563042425, - "velocityY": 1.3928304290777476, + "x": 11.63650495567805, + "y": 1.8292728777764502, + "heading": 0.3746556439873936, + "angularVelocity": 0.0015557732759965874, + "velocityX": 3.5313185438349786, + "velocityY": 1.32421091621176, "moduleForcesX": [ - -0.04425896362884921, - -0.04402948835633619, - -0.0441406220757317, - -0.04391114680180525 + -0.0010891225625817823, + -0.0010892896605572684, + -0.0010892107403075175, + -0.0010893778382830058 ], "moduleForcesY": [ - 0.11679654129672462, - 0.11688472651506654, - 0.11648859333556225, - 0.11657677855445653 + 0.002904703698206433, + 0.002904637990480236, + 0.0029049279384945298, + 0.002904862230768327 ], - "timestamp": 3.4427819856124207 + "timestamp": 3.492400663402841 }, { - "x": 12.15185011782445, - "y": 2.023490901110545, - "heading": 0.38847604869790386, - "angularVelocity": 0.2658080625128484, - "velocityX": 3.635258059805189, - "velocityY": 1.3837811468167476, + "x": 11.9155066014505, + "y": 1.933939583482744, + "heading": 0.3747786859738994, + "angularVelocity": 0.0015572595918276028, + "velocityX": 3.5311360077432856, + "velocityY": 1.3246960329144353, "moduleForcesX": [ - -22.83840056240393, - -12.043870771869477, - -16.90529380786833, - -5.860331369774487 + -0.032855287769666466, + -0.03279052058954477, + -0.03282109775071749, + -0.03275633057051873 ], "moduleForcesY": [ - 3.6231590205459683, - 8.365079303423084, - -11.362059153742951, - -6.955883377496448 + 0.08721701632802349, + 0.08724249386316295, + 0.08713010090018317, + 0.08715557843535474 ], - "timestamp": 3.5239874093528623 + "timestamp": 3.5714125296013215 }, { - "x": 12.400755383704196, - "y": 2.117659437341253, - "heading": 0.48329601767345703, - "angularVelocity": 1.1676556147115023, - "velocityX": 3.0651310517795785, - "velocityY": 1.1596335797926638, + "x": 12.192538240584097, + "y": 2.039177693852194, + "heading": 0.3803730340943993, + "angularVelocity": 0.07080389806825643, + "velocityX": 3.506202959915975, + "velocityY": 1.3319279170686587, "moduleForcesX": [ - -114.17872059898711, - -114.30356134591156, - -90.19939840298346, - -80.1052308451629 + -6.787368546566498, + -3.784269941628227, + -5.182022231798085, + -2.1704396914350084 ], "moduleForcesY": [ - -14.08163508293927, - 10.797887995941533, - -71.37399843226963, - -82.12682115917191 + 2.7165308525253336, + 3.927000047116944, + -1.3250575905079343, + -0.11954942939397993 ], - "timestamp": 3.605192833093304 + "timestamp": 3.650424395799802 }, { - "x": 12.599581408201276, - "y": 2.192945515401507, - "heading": 0.5780713991757789, - "angularVelocity": 1.167106544573357, - "velocityX": 2.448432818140226, - "velocityY": 0.9271065230925032, + "x": 12.427978262373196, + "y": 2.1280236238213828, + "heading": 0.47663420593072064, + "angularVelocity": 1.2183128492941782, + "velocityX": 2.979805858498074, + "velocityY": 1.124463124893227, "moduleForcesX": [ - -107.83281776344127, - -107.82986538656014, - -107.85118599185448, - -107.84823135382317 + -114.73981520594829, + -111.18079581607797, + -86.14799527800552, + -66.35261871218253 ], "moduleForcesY": [ - -40.68175318481147, - -40.689783654449414, - -40.63309333309364, - -40.64114069086623 + -7.795647023550036, + 28.177549378571307, + -76.14784747221293, + -93.3782667153953 ], - "timestamp": 3.6863982568337454 + "timestamp": 3.7294362619982824 }, { - "x": 12.74846595255012, - "y": 2.2493986724180166, - "heading": 0.6567776497722155, - "angularVelocity": 0.9692240612893908, - "velocityX": 1.8334310381129904, - "velocityY": 0.6951894887828137, + "x": 12.615965734027, + "y": 2.199126658591582, + "heading": 0.5737884271556586, + "angularVelocity": 1.2296155742086012, + "velocityX": 2.3792308763037235, + "velocityY": 0.89990324480611, "moduleForcesX": [ - -104.92855177072474, - -103.58820516720519, - -111.54097597186703, - -110.1177486633702 + -108.0986373688516, + -108.16057441934431, + -107.71338177916209, + -107.77431358980553 ], "moduleForcesY": [ - -47.84626346354842, - -50.7219346420931, - -29.320464413930953, - -34.33041579719788 + -39.92967545115843, + -39.756848729907475, + -40.95621385148542, + -40.790948973447925 ], - "timestamp": 3.767603680574187 + "timestamp": 3.808448128196763 }, { - "x": 12.847594216215393, - "y": 2.287032791210217, - "heading": 0.7126183270589642, - "angularVelocity": 0.687647138758041, - "velocityX": 1.2207098873360585, - "velocityY": 0.463443413736636, + "x": 12.756677891744804, + "y": 2.2524751443391073, + "heading": 0.6545619050636577, + "angularVelocity": 1.0222955334973773, + "velocityX": 1.7808990533691502, + "velocityY": 0.675195870117938, "moduleForcesX": [ - -103.65261141149999, - -101.33099886518954, - -112.89020105896142, - -110.70643780421157 + -104.71639898474407, + -103.30559580568976, + -111.8097050026696, + -110.30262425390252 ], "moduleForcesY": [ - -50.63164845334595, - -55.16991177134879, - -23.783026122978413, - -32.51491104120575 + -48.29042179755709, + -51.28282431794385, + -28.25140262149225, + -33.715070554259015 ], - "timestamp": 3.8488091043146286 + "timestamp": 3.8874599943952433 + }, + { + "x": 12.850336914665005, + "y": 2.288054717515041, + "heading": 0.7118620959658994, + "angularVelocity": 0.7252099419889868, + "velocityX": 1.1853792022191647, + "velocityY": 0.45030670566059755, + "moduleForcesX": [ + -103.22725405324366, + -100.76683441661494, + -113.21054868518623, + -110.90819056427041 + ], + "moduleForcesY": [ + -51.48157539975729, + -56.18800584688865, + -22.188774881580073, + -31.81204987645629 + ], + "timestamp": 3.9664718605937237 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 0.35994321486729053, - "velocityX": 0.6097006638724112, - "velocityY": 0.23169454365301478, + "angularVelocity": 0.3795072034311285, + "velocityX": 0.591914918165481, + "velocityY": 0.2251931025926012, "moduleForcesX": [ - -102.93131489378747, - -99.9529403855715, - -113.5371251884651, - -110.9614263550785 + -102.38974249930051, + -99.2333325232405, + -113.85285218516329, + -111.1591753938583 ], "moduleForcesY": [ - -52.12981175149366, - -57.669598676950365, - -20.595444632987483, - -31.70659737313563 + -53.177087365808944, + -58.89587684714717, + -18.75697096029462, + -31.00181733914533 ], - "timestamp": 3.9300145280550702 + "timestamp": 4.045483726792204 }, { "x": 12.89710521697998, "y": 2.305847644805908, "heading": 0.7418476683447593, - "angularVelocity": 5.2713736123368476e-24, - "velocityX": -1.2575111514507032e-24, - "velocityY": -4.677232863444744e-24, + "angularVelocity": 4.222228434888889e-22, + "velocityX": 4.2990324061792614e-21, + "velocityY": -4.011907557779764e-21, "moduleForcesX": [ - -102.27730985577767, - -99.09462528312666, - -113.90720400078715, - -111.1883691091121 + -101.63548974867733, + -98.28908180907341, + -114.21009011513806, + -111.386618425042 ], "moduleForcesY": [ - -53.43303751633116, - -59.15782976040063, - -18.525172105483644, - -30.94741332746109 + -54.637387770778965, + -60.48460075810778, + -16.54354448292929, + -30.223370855342132 ], - "timestamp": 4.011219951795511 + "timestamp": 4.124495592990685 }, { - "x": 12.878326844262283, - "y": 2.2989594406099587, - "heading": 0.7005045669662167, - "angularVelocity": -0.7787767050645679, - "velocityX": -0.3537267099935758, - "velocityY": -0.12975255335628538, + "x": 12.877999676968232, + "y": 2.29858470070828, + "heading": 0.6929652035770414, + "angularVelocity": -0.895192392543208, + "velocityX": -0.34988280879900624, + "velocityY": -0.13300745644801076, "moduleForcesX": [ - -72.94619674814248, - -82.30668691722371, - -108.15778531261913, - -115.0598645177216 + -63.35936817512306, + -80.10356434853757, + -105.25411125517046, + -115.2316867824649 ], "moduleForcesY": [ - -89.24912908119802, - -80.86584959263499, - 40.14347495933019, - -8.857475561829991 + -96.27483320533037, + -83.05086248624922, + 47.239128737124624, + -6.268029819257333 ], - "timestamp": 4.064307186056216 + "timestamp": 4.179101133849723 }, { - "x": 12.840219976733476, - "y": 2.285572424541842, - "heading": 0.6202251467662581, - "angularVelocity": -1.5122170389535827, - "velocityX": -0.7178160260085901, - "velocityY": -0.252170154549299, + "x": 12.83896543758541, + "y": 2.2846494014998036, + "heading": 0.5985027683944565, + "angularVelocity": -1.7299056780050237, + "velocityX": -0.7148402665507607, + "velocityY": -0.2551993623586515, "moduleForcesX": [ - -77.9377516249161, - -86.98787858056687, - -109.4406212161063, - -115.19177113993022 + -71.53272845126982, + -85.95725612054817, + -106.80144207930026, + -115.33798101701309 ], "moduleForcesY": [ - -84.91967760133534, - -75.788435232065, - 36.43023788237509, - -6.703058984175765 + -90.36459624820593, + -76.95483823713556, + 43.55724850599798, + -3.342055562830003 ], - "timestamp": 4.117394420316921 + "timestamp": 4.233706674708761 }, { - "x": 12.782177244041925, - "y": 2.266103908321777, - "heading": 0.5042008090194892, - "angularVelocity": -2.1855412014305973, - "velocityX": -1.0933463289217318, - "velocityY": -0.3667268881339164, + "x": 12.7790871054742, + "y": 2.2646755465629314, + "heading": 0.4630663339899602, + "angularVelocity": -2.480269076614779, + "velocityX": -1.096561469206608, + "velocityY": -0.3657843988476259, "moduleForcesX": [ - -83.00336971918546, - -92.33620304947924, - -111.16605663240462, - -115.29369779681878 + -79.8109340460071, + -92.6408907817173, + -109.25337437613236, + -115.36188623484176 ], "moduleForcesY": [ - -79.96612718536689, - -69.14410094650641, - 30.64026316812107, - -4.1002194480586285 + -83.13387654195827, + -68.72829018973381, + 36.84729749065963, + -0.015885734863739443 ], - "timestamp": 4.1704816545776255 + "timestamp": 4.288312215567799 }, { - "x": 12.703462361937405, - "y": 2.2408921611397123, - "heading": 0.3580649303430616, - "angularVelocity": -2.752749897626456, - "velocityX": -1.4827459595646482, - "velocityY": -0.47491167195211426, + "x": 12.697235826568717, + "y": 2.239145023664725, + "heading": 0.29538035410743513, + "angularVelocity": -3.0708601589607962, + "velocityX": -1.4989555568505593, + "velocityY": -0.46754454761490505, "moduleForcesX": [ - -89.65379875606007, - -98.13983385768606, - -113.54027185482593, - -115.30493503306579 + -90.33198646116189, + -99.85169207378266, + -113.07409659910392, + -115.31328266124063 ], "moduleForcesY": [ - -72.40887140224788, - -60.57623674894681, - 19.8541582997784, - -2.6215553765171156 + -71.52890617387138, + -57.683472950501425, + 22.212990208565554, + 1.1482981099846643 ], - "timestamp": 4.22356888883833 + "timestamp": 4.342917756426837 }, { - "x": 12.603247350879384, - "y": 2.210057158622966, - "heading": 0.19174239462916676, - "angularVelocity": -3.133004347092273, - "velocityX": -1.887742174811279, - "velocityY": -0.5808364844421805, + "x": 12.592206955696092, + "y": 2.2082229653738406, + "heading": 0.11160745845427096, + "angularVelocity": -3.3654624194194347, + "velocityX": -1.9234105041419007, + "velocityY": -0.5662805972512617, "moduleForcesX": [ - -98.79018954476506, - -104.20314131415653, - -115.19744688183164, - -115.13565568271744 + -103.97533493870596, + -107.44888382024821, + -115.0584177361961, + -115.03616740781044 ], "moduleForcesY": [ - -59.282961502664314, - -49.313671267245034, - 1.005530916636403, - -5.743342962263224 + -49.54196790951789, + -41.65055661100523, + -4.805861192354253, + -6.707031707137319 ], - "timestamp": 4.276656123099035 + "timestamp": 4.397523297285875 }, { - "x": 12.48089900238875, - "y": 2.1736228332964016, - "heading": 0.021527886856620944, - "angularVelocity": -3.206317114518393, - "velocityX": -2.3046660877037954, - "velocityY": -0.6863104818691433, + "x": 12.463838013593607, + "y": 2.1725870949498365, + "heading": -0.057259944646070635, + "angularVelocity": -3.0924957512327658, + "velocityX": -2.350840960148443, + "velocityY": -0.652605392482001, "moduleForcesX": [ - -109.90169912281644, - -110.54551793687568, - -112.66305677296602, - -112.97822127254382 + -115.06107533407756, + -114.85560912614942, + -109.41725119475672, + -105.2799977954633 ], "moduleForcesY": [ - -34.382418266787134, - -32.32487235746525, - -23.78897776007878, - -22.35582603859897 + -2.484190771745183, + -5.214634192772953, + -35.76089164102002, + -46.335491532966486 ], - "timestamp": 4.32974335735974 + "timestamp": 4.452128838144913 }, { - "x": 12.337568769520207, - "y": 2.1329281275620455, - "heading": -0.119658826861653, - "angularVelocity": -2.659522871824945, - "velocityX": -2.699900171191159, - "velocityY": -0.7665629280009049, + "x": 12.3153052167684, + "y": 2.134500210018156, + "heading": -0.1767990324670285, + "angularVelocity": -2.18913842698754, + "velocityX": -2.7201048554511935, + "velocityY": -0.6974912130254506, "moduleForcesX": [ - -114.04991592545967, - -113.57345993390194, - -105.8743122544602, - -89.38373476732247 + -109.45603084784327, + -99.09147098340229, + -104.32045073180943, + -71.24101923486771 ], "moduleForcesY": [ - 15.248423187591095, - 16.388126000916763, - -45.19852750676207, - -72.30427165301562 + 35.13049278248973, + 56.727219331269474, + -48.502488172187334, + -90.04553565784445 ], - "timestamp": 4.382830591620444 + "timestamp": 4.506734379003951 }, { - "x": 12.17519289047435, - "y": 2.089437332859002, - "heading": -0.2154342943934576, - "angularVelocity": -1.8041148472994986, - "velocityX": -3.058661490038241, - "velocityY": -0.819232633018052, + "x": 12.14665280523782, + "y": 2.093252415972482, + "heading": -0.24943106792656752, + "angularVelocity": -1.3301220776667324, + "velocityX": -3.0885585762431846, + "velocityY": -0.7553774469912005, "moduleForcesX": [ - -109.62064454997089, - -101.90531447708317, - -103.74089498833104, - -68.59046833424644 + -109.18925395485236, + -102.87029241138681, + -103.62950593233244, + -67.5771745078602 ], "moduleForcesY": [ - 34.45553967608259, - 50.94411816852015, - -49.68325972504408, - -92.07044431884985 + 34.902052219211484, + 46.81112964031985, + -49.45128884065186, + -92.47525829145374 ], - "timestamp": 4.435917825881149 + "timestamp": 4.561339919862989 }, { - "x": 11.993827203156602, - "y": 2.042600207999434, - "heading": -0.2677420696484354, - "angularVelocity": -0.9853173928425161, - "velocityX": -3.416370994711849, - "velocityY": -0.8822671874288431, + "x": 11.95823070560661, + "y": 2.047917121127896, + "heading": -0.2768116340377964, + "angularVelocity": -0.5014246847570069, + "velocityX": -3.450604035176877, + "velocityY": -0.8302325026249097, "moduleForcesX": [ - -109.2866023215497, - -104.44398071027051, - -103.15267730358437, - -65.84867153585363 + -108.8300334396521, + -103.51069866239682, + -101.6714557058711, + -62.588153422601906 ], "moduleForcesY": [ - 34.370980784960594, - 42.21513175186766, - -50.35760769522869, - -93.6724404068542 + 32.94109351617987, + 36.02257862078941, + -51.9503458632938, + -94.87769053752216 ], - "timestamp": 4.489005060141854 + "timestamp": 4.615945460722027 }, { - "x": 11.793836587977145, - "y": 1.9916718961789552, - "heading": -0.27766508814737484, - "angularVelocity": -0.18691910846605192, - "velocityX": -3.7672072761848483, - "velocityY": -0.9593325500887041, + "x": 11.76006896944174, + "y": 1.9924964021643288, + "heading": -0.2773174658125964, + "angularVelocity": -0.009263378163504579, + "velocityX": -3.628967556175626, + "velocityY": -1.0149284869576567, "moduleForcesX": [ - -108.88611511085563, - -103.69547133936662, - -101.19104160044988, - -61.605286218644906 + -68.62335338934369, + -24.81706564096114, + -62.366993278311014, + -29.7266448483014 ], "moduleForcesY": [ - 32.177770647209805, - 33.35515323370195, - -52.640976055772406, - -95.34817206799451 + -16.13797050297586, + -40.26298442970836, + -59.120123116749426, + -76.60001892131655 ], - "timestamp": 4.542092294402559 + "timestamp": 4.670551001581065 }, { - "x": 11.591451943279344, - "y": 1.933426458170254, - "heading": -0.2781082451680907, - "angularVelocity": -0.008347713473630615, - "velocityX": -3.8123034193854206, - "velocityY": -1.0971646728225646, + "x": 11.562226376151372, + "y": 1.9359085884076388, + "heading": -0.2777983149631616, + "angularVelocity": -0.008805867371710638, + "velocityX": -3.623123041690747, + "velocityY": -1.0363016804973944, "moduleForcesX": [ - -17.252714549210435, - -2.8125866154956327, - -20.620616684560133, - -7.564782178530354 + 1.5106753807232935, + 1.5405489498137173, + 1.4991886990742167, + 1.5290615087927133 ], "moduleForcesY": [ - -27.379147574375533, - -31.607890163153368, - -42.31980344027155, - -46.16688797563918 + -5.533911414001025, + -5.542359638354378, + -5.573858055453885, + -5.582305470869689 ], - "timestamp": 4.595179528663263 + "timestamp": 4.725156542440103 }, { - "x": 11.389273898801664, - "y": 1.8744592854650965, - "heading": -0.2785452808398492, - "angularVelocity": -0.008232406111274897, - "velocityX": -3.808411707507817, - "velocityY": -1.110759931767715, + "x": 11.364411791386928, + "y": 1.8792226813116377, + "heading": -0.2782788094947775, + "angularVelocity": -0.008799373178196058, + "velocityX": -3.6226101170776013, + "velocityY": -1.038098079503194, "moduleForcesX": [ - 1.038606533558001, - 1.0463397310111893, - 1.035632368601159, - 1.0433655330901692 + 0.1332558384274762, + 0.13367893133843997, + 0.13309362384339607, + 0.13351671673403107 ], "moduleForcesY": [ - -3.630285143013034, - -3.6324886421775022, - -3.6406473318268184, - -3.642850794642551 + -0.46681005875092235, + -0.4669309252933711, + -0.46737782224581564, + -0.46749868876945894 ], - "timestamp": 4.648266762923968 + "timestamp": 4.779762083299141 }, { - "x": 11.187060728663313, - "y": 1.8156128822911932, - "heading": -0.27898248808757475, - "angularVelocity": -0.008235638074089533, - "velocityX": -3.8090733667778998, - "velocityY": -1.1084850057344429, + "x": 11.166579234513257, + "y": 1.8225996642524476, + "heading": -0.27875936764242787, + "angularVelocity": -0.008800538188806259, + "velocityX": -3.6229392431872234, + "velocityY": -1.0369463642043275, "moduleForcesX": [ - -0.17691923574930024, - -0.177135776816015, - -0.1768359899000005, - -0.17705253096240006 + -0.08556602339210856, + -0.0856419121099448, + -0.08553687515721092, + -0.08561276387472146 ], "moduleForcesY": [ - 0.6083390056735662, - 0.6084010281484636, - 0.6086295849668705, - 0.6086916074369444 + 0.2994423048828335, + 0.29946402445964476, + 0.2995441440606429, + 0.299565863636418 ], - "timestamp": 4.701353997184673 + "timestamp": 4.834367624158179 }, { - "x": 10.984313418298765, - "y": 1.7586381037974586, - "heading": -0.2794239203831664, - "angularVelocity": -0.008315224963949383, - "velocityX": -3.8191349236406036, - "velocityY": -1.0732293608278434, + "x": 10.968518470285098, + "y": 1.766782291857663, + "heading": -0.27924201654885805, + "angularVelocity": -0.008838826588608089, + "velocityX": -3.6271184409553947, + "velocityY": -1.0221924646598646, "moduleForcesX": [ - -2.689710937985897, - -2.695074176438558, - -2.687616330679038, - -2.6929795285133227 + -1.0860355533928898, + -1.0885317610039205, + -1.0850727795644968, + -1.0875689835908182 ], "moduleForcesY": [ - 9.42614694187036, - 9.427648428799488, - 9.43327212811977, - 9.43477357105278 + 3.8347296996097495, + 3.835442563757532, + 3.8380739343659003, + 3.8387867944503786 ], - "timestamp": 4.7544412314453774 + "timestamp": 4.888973165017217 }, { - "x": 10.778488668647217, - "y": 1.7140924382303233, - "heading": -0.27990255467751685, - "angularVelocity": -0.009015996049068832, - "velocityX": -3.8771044021764074, - "velocityY": -0.8391031513975062, + "x": 10.768382316330444, + "y": 1.7189715185814527, + "heading": -0.2797518256877861, + "angularVelocity": -0.00933621626867676, + "velocityX": -3.665125384826737, + "velocityY": -0.8755663349188755, "moduleForcesX": [ - -15.492703910893802, - -15.55336531368553, - -15.458920515444744, - -15.519558726536355 + -9.874094547382661, + -9.909831175721294, + -9.85761782165409, + -9.893348215058941 ], "moduleForcesY": [ - 62.59915932231857, - 62.60222625959514, - 62.649654814616326, - 62.65272108090153 + 38.10667280305693, + 38.11330911683297, + 38.14707559852625, + 38.15370784735128 ], - "timestamp": 4.807528465706082 + "timestamp": 4.943578705876255 }, { - "x": 10.569281338812399, - "y": 1.6902969703482535, - "heading": -0.2804899410650269, - "angularVelocity": -0.011064550558905711, - "velocityX": -3.9408217954513325, - "velocityY": -0.44823333167467494, + "x": 10.564408931858496, + "y": 1.6921473086815817, + "heading": -0.28038185385941405, + "angularVelocity": -0.011537806634941384, + "velocityX": -3.7353972007803753, + "velocityY": -0.4912360445090406, "moduleForcesX": [ - -16.989466098780625, - -17.26841193735081, - -16.819178445964713, - -17.097483761569933 + -18.223496328433487, + -18.496021684044194, + -18.05270477943314, + -18.32464726681692 ], "moduleForcesY": [ - 104.53971564488899, - 104.50562642972606, - 104.6000776405437, - 104.56645125313038 + 99.92208309280701, + 99.88968062550067, + 100.00063874310935, + 99.96866077815216 ], - "timestamp": 4.860615699966787 + "timestamp": 4.998184246735293 }, { "x": 10.358807563781738, "y": 1.6887441873550415, "heading": -0.28131737276900265, - "angularVelocity": -0.015586265050319821, - "velocityX": -3.964677722652637, - "velocityY": -0.029249649465378225, + "angularVelocity": -0.017132307360595633, + "velocityX": -3.765210724814718, + "velocityY": -0.06232190493864942, "moduleForcesX": [ - -6.18572157157631, - -6.9202746933831, - -5.844740651408106, - -6.573955564662377 + -7.529271015507784, + -8.398980799855844, + -7.110732370059438, + -7.973097440144591 ], "moduleForcesY": [ - 112.06720187117625, - 112.03161900342097, - 112.11336799839647, - 112.08016014025495 + 111.53171815583704, + 111.47999858137479, + 111.59688033555024, + 111.54866670440515 ], - "timestamp": 4.913702934227492 + "timestamp": 5.052789787594331 }, { - "x": 10.074031104225313, - "y": 1.7288019189642057, - "heading": -0.28133183349243884, - "angularVelocity": -0.00019962394982934355, - "velocityX": -3.931214224926528, - "velocityY": 0.5529794301309934, + "x": 10.08393736820923, + "y": 1.7277034984607378, + "heading": -0.28133184198304767, + "angularVelocity": -0.00019656089199339045, + "velocityX": -3.734047381979395, + "velocityY": 0.5292531383220508, "moduleForcesX": [ - 5.868356427204316, - 7.872028825010418, - 5.2245262323577535, - 7.274148654405299 + 5.273262788820698, + 7.435057509898819, + 4.561459737278025, + 6.776645494665948 ], "moduleForcesY": [ - 114.19123917565138, - 114.06618405796584, - 114.19557828660732, - 114.07858878844017 + 114.17857048927304, + 114.05312633616373, + 114.17906174500055, + 114.06354518890141 ], - "timestamp": 4.986142756445969 + "timestamp": 5.126401653608415 }, { - "x": 9.797922122377006, - "y": 1.8092440058536325, - "heading": -0.2813429282119763, - "angularVelocity": -0.00015315774111119407, - "velocityX": -3.8115634935652762, - "velocityY": 1.1104677569033128, + "x": 9.818202185590613, + "y": 1.8080829466543498, + "heading": -0.28134297586169704, + "angularVelocity": -0.0001512511399625565, + "velocityX": -3.609950365444831, + "velocityY": 1.0919360226275558, "moduleForcesX": [ - 23.452096627965147, - 23.458196144337972, - 23.451465640201057, - 23.45756560307959 + 23.93648599054604, + 23.942282612665448, + 23.93591950874844, + 23.941716534513144 ], "moduleForcesY": [ - 109.28376366394927, - 109.2824400014251, - 109.28362046955922, - 109.28229674147876 + 108.54583486390916, + 108.54454153578949, + 108.54564914640099, + 108.54435575416598 ], - "timestamp": 5.0585825786644465 + "timestamp": 5.200013519622499 }, { - "x": 9.530417627011207, - "y": 1.9148302457499569, - "heading": -0.2813548125722149, - "angularVelocity": -0.0001640583849411106, - "velocityX": -3.692782328468601, - "velocityY": 1.457571770094606, + "x": 9.55957700395428, + "y": 1.909026956405172, + "heading": -0.28135415722511536, + "angularVelocity": -0.00015189620945305375, + "velocityX": -3.5133626633897372, + "velocityY": 1.3713007863638298, "moduleForcesX": [ - 23.284729079604, - 23.283902232747476, - 23.284842009272996, - 23.284015169836746 + 18.632396331688547, + 18.63235498740305, + 18.632405037196314, + 18.632363692926397 ], "moduleForcesY": [ - 68.04154028777809, - 68.04180366771809, - 68.04204433937217, - 68.04230771680363 + 53.89121026384353, + 53.89122312286384, + 53.89124460812597, + 53.891257467141436 ], - "timestamp": 5.131022400882924 + "timestamp": 5.273625385636583 }, { - "x": 9.293245060968994, - "y": 2.010127611481761, - "heading": -0.3014330787042576, - "angularVelocity": -0.2771716649370988, - "velocityX": -3.2740633366949123, - "velocityY": 1.315538371206782, + "x": 9.314078063004189, + "y": 2.00599679218808, + "heading": -0.3009876013168922, + "angularVelocity": -0.26671575052886687, + "velocityX": -3.335045750682662, + "velocityY": 1.3173125615964598, "moduleForcesX": [ - 81.01560658870925, - 75.11544611300343, - 88.38909893685307, - 83.80155867415682 + 37.2832858474123, + 25.84642277568476, + 42.75006123891907, + 31.714081507752265 ], "moduleForcesY": [ - -39.65492799695376, - -40.25210144011162, - -17.310769456098512, - -14.151996507909613 + -21.015362736520213, + -18.1500142144038, + -3.319730193685859, + 0.8264239519393597 ], - "timestamp": 5.203462223101401 + "timestamp": 5.347237251650667 }, { - "x": 9.09552927538301, - "y": 2.0895893588177756, - "heading": -0.31844570606675093, - "angularVelocity": -0.23485186519623918, - "velocityX": -2.729379773871831, - "velocityY": 1.096934598988375, + "x": 9.10941935629468, + "y": 2.086840876505934, + "heading": -0.31798427093228115, + "angularVelocity": -0.23089578536342262, + "velocityX": -2.7802407110607743, + "velocityY": 1.0982479958107088, "moduleForcesX": [ - 107.5793065716789, - 107.64208344195727, - 105.87575754009715, - 105.99463103451073 + 107.68858293139235, + 107.738552826401, + 106.29323252806583, + 106.38126830053615 ], "moduleForcesY": [ - -40.83034886509639, - -40.697127559381315, - -45.06642730066156, - -44.81548009939982 + -40.5682562760582, + -40.462053452478216, + -44.096907679115134, + -43.90855630284436 ], - "timestamp": 5.275902045319879 + "timestamp": 5.420849117664751 }, { - "x": 8.937331011810468, - "y": 2.153175677565822, - "heading": -0.33216267776880665, - "angularVelocity": -0.1893567830783133, - "velocityX": -2.1838577004705906, - "velocityY": 0.8777812645132024, + "x": 8.945665590155809, + "y": 2.151528839125374, + "heading": -0.3318177617543003, + "angularVelocity": -0.18792474054892708, + "velocityX": -2.224556651064109, + "velocityY": 0.8787708575009153, "moduleForcesX": [ - 107.81855559484976, - 107.86118930596342, - 105.98182204499231, - 106.08769609512697 + 108.00459288569083, + 108.03895547091057, + 106.32434275384833, + 106.41201988616298 ], "moduleForcesY": [ - -40.76058786716746, - -40.66527143933629, - -45.32350556529571, - -45.0909361635883 + -40.28289239333359, + -40.20672149366398, + -44.52996596613108, + -44.33454527838807 ], - "timestamp": 5.348341867538356 + "timestamp": 5.494460983678835 }, { - "x": 8.8186706046164, - "y": 2.2008731582030556, - "heading": -0.3425003600582634, - "angularVelocity": -0.1427071736631058, - "velocityX": -1.6380549200713106, - "velocityY": 0.65844281745169, + "x": 8.822838083638423, + "y": 2.2000505965479666, + "heading": -0.3423020852827545, + "angularVelocity": -0.1424270854164775, + "velocityX": -1.6685829767430085, + "velocityY": 0.6591567372209985, "moduleForcesX": [ - 107.90467393449282, - 107.93229359869257, - 106.0198371641577, - 106.11256348212794 + 108.11666519143748, + 108.1367372735272, + 106.33573686070704, + 106.41424542733333 ], "moduleForcesY": [ - -40.72210440542275, - -40.66091896254574, - -45.404374735866405, - -45.19805154468376 + -40.168809305270315, + -40.12609997700313, + -44.67103028526917, + -44.4938843255294 ], - "timestamp": 5.420781689756834 + "timestamp": 5.5680728496929195 }, { - "x": 8.739558229904278, - "y": 2.232675064823596, - "heading": -0.3494154778567653, - "angularVelocity": -0.09546017075588695, - "velocityX": -1.0921116630231633, - "velocityY": 0.439011384161408, + "x": 8.740947438367238, + "y": 2.232401107243289, + "heading": -0.34934249092246195, + "angularVelocity": -0.09564226558745821, + "velocityX": -1.1124652818272123, + "velocityY": 0.4394741289282456, "moduleForcesX": [ - 107.94946633207205, - 107.96697591893108, - 106.03987686308874, - 106.12319819766434 + 108.1744880611608, + 108.18447910649813, + 106.34236528854647, + 106.41318223955082 ], "moduleForcesY": [ - -40.698520186674784, - -40.66122527870845, - -45.442664241769215, - -45.25595136469532 + -40.1066849659844, + -40.088485624896734, + -44.739176472038366, + -44.57832391748549 ], - "timestamp": 5.493221511975311 + "timestamp": 5.641684715707004 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -0.047850528600588194, - "velocityX": -0.5460840279946031, - "velocityY": 0.2195241654092463, + "angularVelocity": -0.048080165750898934, + "velocityX": -0.556261382633667, + "velocityY": 0.21975056429240547, "moduleForcesX": [ - 107.97604331480812, - 107.9882753754576, - 106.05139834798732, - 106.12996188400123 + 108.20892496086539, + 108.21348472478888, + 106.3458501916204, + 106.41277222504725 ], "moduleForcesY": [ - -40.68522330978408, - -40.660146907176184, - -45.466900880102564, - -45.28983190819318 + -40.06999069497857, + -40.064797915468255, + -44.78118450203358, + -44.62830082076761 ], - "timestamp": 5.565661334193789 + "timestamp": 5.715296581721088 }, { "x": 8.7, "y": 2.248577356338501, "heading": -0.3528817616416521, - "angularVelocity": -4.8288976906928006e-27, - "velocityX": 1.7587671009889585e-26, - "velocityY": 3.3751021564294008e-25, + "angularVelocity": 7.228649510679406e-23, + "velocityX": 2.8012684640616525e-22, + "velocityY": -6.2742965542830935e-22, "moduleForcesX": [ - 107.99223491781001, - 108.0040016915483, - 106.05743685003779, - 106.13622374630019 + 108.23038445425983, + 108.23430457634595, + 106.34652059702094, + 106.41417815468229 ], "moduleForcesY": [ - -40.68042792406633, - -40.65537952997916, - -45.48693154917796, - -45.30833424193728 + -40.04952106692136, + -40.0449273344048, + -44.81309642327084, + -44.65756272827848 ], - "timestamp": 5.638101156412266 + "timestamp": 5.788908447735172 }, { - "x": 8.733926813861677, - "y": 2.235358433045618, - "heading": -0.35026869308585346, - "angularVelocity": 0.03903296429686566, - "velocityX": 0.5067850635723455, - "velocityY": -0.19745894526536673, + "x": 8.735160496003328, + "y": 2.2353073040625637, + "heading": -0.34950341211539854, + "angularVelocity": 0.049669524785278404, + "velocityX": 0.5169403325880028, + "velocityY": -0.195100354566496, "moduleForcesX": [ - 108.31232931165216, - 108.31646484929276, - 106.65379169981476, - 106.70790819705412 + 108.92708748634631, + 108.91169498268742, + 106.90012644635497, + 106.95921424095818 ], "moduleForcesY": [ - -39.790421347467806, - -39.78562240023523, - -44.043414234869644, - -43.917976590357014 + -38.06986059379512, + -38.12247627099088, + -43.43729059553142, + -43.29915093821453 ], - "timestamp": 5.705046329623423 + "timestamp": 5.856924993914305 }, { - "x": 8.801777689763007, - "y": 2.208924184045344, - "heading": -0.3450752782075868, - "angularVelocity": 0.07757713706835337, - "velocityX": 1.0135290215370254, - "velocityY": -0.3948641512494974, + "x": 8.805476972134196, + "y": 2.20876912539207, + "heading": -0.34277198887220717, + "angularVelocity": 0.09896743691546771, + "velocityX": 1.0338142713932752, + "velocityY": -0.39017239423773575, "moduleForcesX": [ - 108.28996331730457, - 108.30053379408332, - 106.65261534540024, - 106.71250484198276 + 108.90060339205657, + 108.8953561059007, + 106.88867772089172, + 106.95804032881324 ], "moduleForcesY": [ - -39.81362083255557, - -39.7923038373262, - -44.01229472070396, - -43.873619165906334 + -38.097560026146894, + -38.122799476396146, + -43.42345092393567, + -43.26132213447991 ], - "timestamp": 5.77199150283458 + "timestamp": 5.924941540093438 }, { - "x": 8.903548768119284, - "y": 2.1692796518761055, - "heading": -0.3373473298717038, - "angularVelocity": 0.11543697573994958, - "velocityX": 1.5202153265818417, - "velocityY": -0.5921940338281327, + "x": 8.910942661149685, + "y": 2.168965701827033, + "heading": -0.33272524311327834, + "angularVelocity": 0.14771031937536208, + "velocityX": 1.5505887161298455, + "velocityY": -0.5852020692172026, "moduleForcesX": [ - 108.25850057581366, - 108.27833136732968, - 106.65081131519337, - 106.71905743006441 + 108.86109478467073, + 108.87073710864843, + 106.87169078257577, + 106.9560671341383 ], "moduleForcesY": [ - -39.84643901580114, - -39.80130085429087, - -43.969072663952105, - -43.81111658495434 + -38.13854642095758, + -38.123667627725496, + -43.40238220899807, + -43.20515744662125 ], - "timestamp": 5.838936676045737 + "timestamp": 5.992958086272571 }, { - "x": 9.039234239007644, - "y": 2.1164324000873393, - "heading": -0.3271533501766025, - "angularVelocity": 0.15227355769097134, - "velocityX": 2.0268148453419146, - "velocityY": -0.7894109351554927, + "x": 9.051546291570848, + "y": 2.1159017878510578, + "heading": -0.3194253273769413, + "angularVelocity": 0.19553941626658664, + "velocityX": 2.067197444146294, + "velocityY": -0.7801618423291163, "moduleForcesX": [ - 108.21238741016386, - 108.24396960661257, - 106.6491337463018, - 106.7275746109919 + 108.79813451721276, + 108.8272916619506, + 106.8462010419442, + 106.94957215478408 ], "moduleForcesY": [ - -39.89260206806913, - -39.81751467144118, - -43.901653051914266, - -43.72029844384376 + -38.1988424152394, + -38.13223147648961, + -43.36068150975463, + -43.11962308400631 ], - "timestamp": 5.905881849256894 + "timestamp": 6.060974632451704 }, { - "x": 9.208824365155895, - "y": 2.0503950328281664, - "heading": -0.31460646106714574, - "angularVelocity": 0.1874203696490803, - "velocityX": 2.533268912656832, - "velocityY": -0.9864395607862412, + "x": 9.22726536615065, + "y": 2.049586749721687, + "heading": -0.30299277062018, + "angularVelocity": 0.2415964596832561, + "velocityX": 2.5834754107775137, + "velocityY": -0.9749839098668391, "moduleForcesX": [ - 108.13878069799291, - 108.18385543698201, - 106.64908314006513, - 106.7379353214454 + 108.6811050373854, + 108.73406931364026, + 106.80275120146628, + 106.92705418988609 ], "moduleForcesY": [ - -39.96046705876718, - -39.851878052023736, - -43.78233752560014, - -43.57763984939862 + -38.29522411554184, + -38.1683694994336, + -43.25999294811074, + -42.97279366403858 ], - "timestamp": 5.972827022468051 + "timestamp": 6.128991178630837 }, { - "x": 9.412299498127187, - "y": 1.971192793059601, - "heading": -0.2999281888843931, - "angularVelocity": 0.21925811046084911, - "velocityX": 3.0394294795458103, - "velocityY": -1.1830911172452587, + "x": 9.438033057725468, + "y": 1.970048065593295, + "heading": -0.2837631233482766, + "angularVelocity": 0.2827201372627604, + "velocityX": 3.0987708640736242, + "velocityY": -1.1694019852009818, "moduleForcesX": [ - 107.99968413751532, - 108.05776232379695, - 106.65408367462612, - 106.74909898164714 + 108.3626740241462, + 108.4418328543596, + 106.6908681014183, + 106.82910549783023 ], "moduleForcesY": [ - -40.073559976513465, - -39.93516235271832, - -43.53014008693058, - -43.31352925259886 + -38.50231437653497, + -38.32060078212658, + -42.92203871274231, + -42.61405148852438 ], - "timestamp": 6.039772195679208 + "timestamp": 6.19700772480997 }, { - "x": 9.64959962518174, - "y": 1.8789019078745433, - "heading": -0.28374565683521485, - "angularVelocity": 0.24172813771256552, - "velocityX": 3.5446936003297025, - "velocityY": -1.3786040241311388, + "x": 9.678076559868247, + "y": 1.879644856366163, + "heading": -0.28374820647577687, + "angularVelocity": 0.00021931240760807876, + "velocityX": 3.529192757165067, + "velocityY": -1.329135545769102, "moduleForcesX": [ - 107.61137555141407, - 107.67012594458993, - 106.67046549630616, - 106.74805702593525 + 87.67092010469722, + 82.29673746119292, + 96.41433044145562, + 93.06437688109202 ], "moduleForcesY": [ - -40.33210283996674, - -40.200949635022816, - -42.761473825206764, - -42.59175857555703 + -45.81494056023983, + -48.188084286902104, + -20.914888530025944, + -18.475969737183867 ], - "timestamp": 6.106717368890365 + "timestamp": 6.2650242709891035 }, { - "x": 9.900298294638016, - "y": 1.790758792782665, - "heading": -0.2837335320815777, - "angularVelocity": 0.00018111468020203295, - "velocityX": 3.7448356234067472, - "velocityY": -1.316646307178247, + "x": 9.91942147309829, + "y": 1.7927653335156666, + "heading": -0.2837356440414742, + "angularVelocity": 0.00018469673937243685, + "velocityX": 3.5483264997669806, + "velocityY": -1.2773292342966782, "moduleForcesX": [ - 46.83355979424887, - 35.139698926947005, - 49.463406566005, - 38.377272751925325 + 3.9952241861110123, + 3.993394223196805, + 3.995923175642631, + 3.9940931809808093 ], "moduleForcesY": [ - 1.5254319217028312, - 6.193009340047282, - 19.63550881795331, - 25.21513933953295 + 10.81442104002948, + 10.814957408993081, + 10.816830640829714, + 10.81736703378314 ], - "timestamp": 6.173662542101522 + "timestamp": 6.333040817168237 }, { - "x": 10.15979314102593, - "y": 1.7334916000286844, - "heading": -0.2837214488432004, - "angularVelocity": 0.00018049454199105732, - "velocityX": 3.8762293671183365, - "velocityY": -0.8554342308346725, + "x": 10.169106994861316, + "y": 1.7340196610481893, + "heading": -0.28372258147039636, + "angularVelocity": 0.00019204990273192154, + "velocityX": 3.670952669449541, + "velocityY": -0.8636967880250899, "moduleForcesX": [ - 27.870855303386527, - 27.87078008363208, - 27.87085955385126, - 27.87078433416476 + 25.60101320769064, + 25.601760187553346, + 25.600945387189146, + 25.60169237360391 ], "moduleForcesY": [ - 97.83081049698777, - 97.83083198961774, - 97.83082304661332, - 97.83084453922426 + 86.35659720719445, + 86.35637664311918, + 86.35635196045361, + 86.35613139442138 ], - "timestamp": 6.240607715312679 + "timestamp": 6.40105736334737 }, { "x": 10.424600601196287, "y": 1.7113943099975586, "heading": -0.2837047824958171, - "angularVelocity": 0.00024895517606220293, - "velocityX": 3.9555870493471943, - "velocityY": -0.3300804071628431, + "angularVelocity": 0.00026168595112677055, + "velocityX": 3.756344899696669, + "velocityY": -0.33264480955917264, "moduleForcesX": [ - 16.829101110309146, - 16.838915102240243, - 16.827278780287177, - 16.837093906581575 + 17.823774151167182, + 17.83355423810466, + 17.822074295255895, + 17.83185551284743 ], "moduleForcesY": [ - 111.43715289160197, - 111.43563757699792, - 111.43710122782548, - 111.43558589017641 + 110.87155302236657, + 110.86994540179049, + 110.87145101626253, + 110.86984335012644 ], - "timestamp": 6.307552888523836 + "timestamp": 6.469073909526503 }, { - "x": 10.649647240268498, - "y": 1.7185557092564774, - "heading": -0.28304825482562407, - "angularVelocity": 0.011565209036453545, - "velocityX": 3.9643590696733866, - "velocityY": 0.1261532197089931, + "x": 10.644414774625627, + "y": 1.7193809732535479, + "heading": -0.2828019280537436, + "angularVelocity": 0.015459837026566284, + "velocityX": 3.7639414937610223, + "velocityY": 0.13675793856658902, "moduleForcesX": [ - 1.612409435028023, - 3.449197442112493, - 0.920737067471497, - 2.7948238151606644 + 1.09713864157884, + 3.483800587637876, + 0.17889110374315617, + 2.6287399657540216 ], "moduleForcesY": [ - 114.15637546330666, - 114.11007946252991, - 114.1356704809822, - 114.09921998413924 + 114.17621366105449, + 114.12110918273105, + 114.14468636650177, + 114.10669848112909 ], - "timestamp": 6.364320359662809 + "timestamp": 6.527473906921174 }, { - "x": 10.872486526800158, - "y": 1.7511786253728163, - "heading": -0.2825635463774615, - "angularVelocity": 0.008538489357327173, - "velocityX": 3.9254749605830384, - "velocityY": 0.5746762267509568, + "x": 10.861693485566251, + "y": 1.754234167279391, + "heading": -0.2821930397682389, + "angularVelocity": 0.010426169737471161, + "velocityX": 3.720526038250279, + "velocityY": 0.5968012941901759, "moduleForcesX": [ - -9.617734238949605, - -10.066815271135845, - -9.387604811781262, - -9.834772017123038 + -10.385540743401451, + -11.10514334159848, + -10.010565773367109, + -10.725324626777565 ], "moduleForcesY": [ - 112.19647225066657, - 112.1614659010998, - 112.23111915488862, - 112.19714365211973 + 111.86098322186378, + 111.79973293870482, + 111.92171623690528, + 111.86317871279545 ], - "timestamp": 6.421087830801782 + "timestamp": 6.585873904315846 }, { - "x": 11.090604076378652, - "y": 1.8073745478916146, - "heading": -0.28216255506909754, - "angularVelocity": 0.007063751481588911, - "velocityX": 3.842298154246073, - "velocityY": 0.9899317582991157, + "x": 11.073781283880631, + "y": 1.813061818721627, + "heading": -0.28170357599097573, + "angularVelocity": 0.008381229436627325, + "velocityX": 3.6316405441095316, + "velocityY": 1.0073228436069037, "moduleForcesX": [ - -20.776539685058307, - -20.95690176428432, - -20.656026809805056, - -20.836146342062964 + -21.575934691647564, + -21.80574823449794, + -21.420174805115277, + -21.649612023660485 ], "moduleForcesY": [ - 103.86595800234613, - 103.83805579833923, - 103.91143822729335, - 103.88375203666148 + 99.80080758549971, + 99.76654159220668, + 99.87324161618055, + 99.83931034438025 ], - "timestamp": 6.477855301940755 + "timestamp": 6.644273901710517 }, { - "x": 11.305331510363592, - "y": 1.8754073625880365, - "heading": -0.2817861235290747, - "angularVelocity": 0.006631113425879257, - "velocityX": 3.7825788198185237, - "velocityY": 1.1984471622818953, + "x": 11.283587635771832, + "y": 1.8795916481170019, + "heading": -0.2812364772082353, + "angularVelocity": 0.007998267184563267, + "velocityX": 3.592574678956124, + "velocityY": 1.1392094582772114, "moduleForcesX": [ - -14.93113836042353, - -14.963264037670038, - -14.913927685174185, - -14.946047731778885 + -9.49218404818873, + -9.517076511502912, + -9.480971029856981, + -9.50586093834778 ], "moduleForcesY": [ - 52.14197332650795, - 52.14527104247297, - 52.17361050090557, - 52.17690623845406 + 32.05124416889292, + 32.0564927746003, + 32.08103597153202, + 32.086282418465686 ], - "timestamp": 6.534622773079728 + "timestamp": 6.702673899105188 }, { - "x": 11.519652692450972, - "y": 1.9447110026462533, - "heading": -0.28141169188970344, - "angularVelocity": 0.006595883731628649, - "velocityX": 3.7754223992591815, - "velocityY": 1.2208336687846026, + "x": 11.493202658637001, + "y": 1.9467231127720637, + "heading": -0.2807706851083828, + "angularVelocity": 0.007975892476580818, + "velocityX": 3.5892984968573782, + "velocityY": 1.1495114323615963, "moduleForcesX": [ - -1.7894810492252815, - -1.7916911360220178, - -1.7886188443613336, - -1.7908289271510018 + -0.7961996165924138, + -0.7975621457668051, + -0.7956717132450022, + -0.7970342417583107 ], "moduleForcesY": [ - 5.59811618322889, - 5.598749349977472, - 5.601072120131871, - 5.6017052821445015 + 2.5038569339269885, + 2.5042491658535546, + 2.505684173989879, + 2.506076405059044 ], - "timestamp": 6.591390244218701 + "timestamp": 6.76107389649986 }, { - "x": 11.733959431080516, - "y": 2.014059333930838, - "heading": -0.281037272981895, - "angularVelocity": 0.006595659455954908, - "velocityX": 3.77516796731879, - "velocityY": 1.2216209370118305, + "x": 11.702813327657477, + "y": 2.0138681893180537, + "heading": -0.2803048424702293, + "angularVelocity": 0.007976757858486104, + "velocityX": 3.5892239447189, + "velocityY": 1.1497445126960992, "moduleForcesX": [ - -0.06364100877139726, - -0.06365505243487238, - -0.06363556826688263, - -0.06364961193035205 + -0.01814381941383678, + -0.018091134855889958, + -0.018164173207132702, + -0.018111488649066233 ], "moduleForcesY": [ - 0.1969210992616689, - 0.19692515330886895, - 0.19693994534373072, - 0.1969439993909239 + 0.05671736020618125, + 0.0567021930988224, + 0.05664665917209394, + 0.05663149206454538 ], - "timestamp": 6.648157715357674 + "timestamp": 6.819473893894531 }, { - "x": 11.94849901356588, - "y": 2.082663911446821, - "heading": -0.2806488087861412, - "angularVelocity": 0.006843077346228324, - "velocityX": 3.779269679992362, - "velocityY": 1.2085191772596517, + "x": 11.912555116213372, + "y": 2.0806013070151295, + "heading": -0.27983771695717125, + "angularVelocity": 0.007998724895503196, + "velocityX": 3.591469142343322, + "velocityY": 1.1426904225027354, "moduleForcesX": [ - 1.0212819494692333, - 1.0367870294859038, - 1.015272810913435, - 1.0307777743362587 + 0.545518088488526, + 0.5468558718661225, + 0.5450018966008922, + 0.5463396795091038 ], "moduleForcesY": [ - -3.264742509835954, - -3.2691983489944296, - -3.285525660592635, - -3.289981363380365 + -1.7141411533773943, + -1.7145252782998055, + -1.7159358500537687, + -1.7163199744295505 ], - "timestamp": 6.704925186496647 + "timestamp": 6.877873891289203 }, { - "x": 12.152037072754059, - "y": 2.142322529407559, - "heading": -0.2510180942418901, - "angularVelocity": 0.5219664351739706, - "velocityX": 3.585469902118673, - "velocityY": 1.0509296391711178, + "x": 12.123582090461483, + "y": 2.141695128776019, + "heading": -0.2784545161826354, + "angularVelocity": 0.023684945826077396, + "velocityX": 3.613475747643897, + "velocityY": 1.0461271316163527, "moduleForcesX": [ - -67.96426240208135, - -30.062890973818163, - -63.34891083146934, - -32.53743564226132 + 5.056830451597807, + 6.052976456784937, + 4.650734177456533, + 5.643439292990552 ], "moduleForcesY": [ - -8.235178803765649, - -27.016971831599303, - -52.69317016977563, - -69.73669104087452 + -22.732394581032693, + -22.979924677069157, + -23.981026840246905, + -24.225672996948276 ], - "timestamp": 6.76169265763562 + "timestamp": 6.936273888683874 }, { - "x": 12.334148820301001, - "y": 2.1971654821119366, - "heading": -0.17114703208449755, - "angularVelocity": 1.406986440559578, - "velocityX": 3.208029949072625, - "velocityY": 0.966098217940971, + "x": 12.312845499111194, + "y": 2.1960087754333726, + "heading": -0.22597278443049482, + "angularVelocity": 0.8986598303672022, + "velocityX": 3.240811936525529, + "velocityY": 0.930028237677772, "moduleForcesX": [ - -110.90141886725935, - -104.51767942702155, - -99.94508162050465, - -62.2972554143191 + -110.09390991333008, + -103.48471382580139, + -96.45188523190053, + -52.42834336586494 ], "moduleForcesY": [ - 26.85599963756138, - 39.311826008079045, - -55.67355131570806, - -95.37547475461713 + 24.89118915347873, + 22.28582245406149, + -60.0582233614142, + -100.03845095304496 ], - "timestamp": 6.818460128774593 + "timestamp": 6.994673886078545 }, { - "x": 12.494844000544365, - "y": 2.247628220403907, - "heading": -0.03691006304613977, - "angularVelocity": 2.36468115181193, - "velocityX": 2.8307616495715395, - "velocityY": 0.8889375777975359, + "x": 12.479529781632614, + "y": 2.2449867624612256, + "heading": -0.1184996439866557, + "angularVelocity": 1.84029358284946, + "velocityX": 2.8541830472175405, + "velocityY": 0.8386641988501548, "moduleForcesX": [ - -112.18575793402451, - -101.8689939557043, - -99.30217040259397, - -64.13275876528363 + -111.9090944895469, + -104.84618511277107, + -98.77086477361028, + -60.51536896101172 ], "moduleForcesY": [ - 24.489794047684235, - 51.11251099285013, - -57.83793809446346, - -94.97028505916231 + 24.43643622108832, + 42.12552095732977, + -58.374344881869746, + -97.04975471639112 ], - "timestamp": 6.875227599913566 + "timestamp": 7.053073883473217 }, { - "x": 12.633730382727341, - "y": 2.2936459171983987, - "heading": 0.15068702087135824, - "angularVelocity": 3.3046581105971575, - "velocityX": 2.4465839220310848, - "velocityY": 0.8106349617342448, + "x": 12.623809461398077, + "y": 2.289494145161703, + "heading": 0.04954714385936545, + "angularVelocity": 2.8775136188850925, + "velocityX": 2.470542571952716, + "velocityY": 0.7621127514731357, "moduleForcesX": [ - -113.52781849420326, - -101.72159587923039, - -98.27794501691677, - -70.87580416849228 + -112.53923361529047, + -98.88615121430331, + -98.21581874489462, + -63.49372991199005 ], "moduleForcesY": [ - 18.795877029064826, - 53.03473995293743, - -59.883306375450104, - -90.29587475253841 + 23.427197480933216, + 57.43559858001425, + -59.82012493838722, + -95.49784743209881 ], - "timestamp": 6.931995071052539 + "timestamp": 7.111473880867888 }, { - "x": 12.747373227511964, - "y": 2.33297655165956, - "heading": 0.33465067573891905, - "angularVelocity": 3.2406526339212256, - "velocityX": 2.0019007805793065, - "velocityY": 0.692837529522422, + "x": 12.742567636762507, + "y": 2.329195026608957, + "heading": 0.2532418400568153, + "angularVelocity": 3.4879230356958084, + "velocityX": 2.033530490795285, + "velocityY": 0.679809644150375, "moduleForcesX": [ - -110.15119273382385, - -110.09590584370162, - -112.42030542510648, - -112.27667812755305 + -114.89005050626218, + -111.51397335746597, + -103.13454077524403, + -95.5064562830338 ], "moduleForcesY": [ - -33.543041884285, - -33.78436386293674, - -24.91070248135435, - -25.628447678324406 + 7.12526379432016, + 27.76672389886986, + -51.10134531295922, + -63.839976213971404 ], - "timestamp": 6.988762542191512 + "timestamp": 7.1698738782625595 }, { - "x": 12.836684119739113, - "y": 2.3652177680520627, - "heading": 0.49472956453813244, - "angularVelocity": 2.8199052307142933, - "velocityX": 1.5732758644207596, - "velocityY": 0.567952310462666, + "x": 12.83479843521252, + "y": 2.3624207500453496, + "heading": 0.44054512932062534, + "angularVelocity": 3.2072482469134482, + "velocityX": 1.5792945644622498, + "velocityY": 0.5689336458673059, "moduleForcesX": [ - -99.1906995535979, - -99.97859392638925, - -115.15979579307127, - -114.54734457522899 + -106.34982483559645, + -105.95228683396374, + -115.09460575424762, + -114.4004939951579 ], "moduleForcesY": [ - -58.57964610086167, - -57.39726866081906, - 4.13728262086476, - -13.118869737078935 + -44.17247603120524, + -45.29021140358265, + -4.506204608148659, + -13.87089784378298 ], - "timestamp": 7.045530013330485 + "timestamp": 7.228273875657231 }, { - "x": 12.902648711217271, - "y": 2.3899438580710273, - "heading": 0.6212528884768642, - "angularVelocity": 2.2287997228023118, - "velocityX": 1.162013916678965, - "velocityY": 0.4355679321777755, + "x": 12.902153785945606, + "y": 2.388339311177531, + "heading": 0.5920521705772573, + "angularVelocity": 2.5942987673909688, + "velocityX": 1.1533450982521831, + "velocityY": 0.44381099808998664, "moduleForcesX": [ - -90.92322148643733, - -92.24578923617236, - -113.61714858975364, - -114.71711750544789 + -92.38930111082509, + -93.92589046885863, + -112.97863519241551, + -114.99151586069087 ], "moduleForcesY": [ - -70.78350796787741, - -69.22716039877027, - 19.619781271549844, - -12.071174524868752 + -68.80392001259384, + -66.8988698725461, + 22.89679875087174, + -8.890320559157662 ], - "timestamp": 7.1022974844694575 + "timestamp": 7.286673873051902 }, { - "x": 12.946021910632137, - "y": 2.4067236714663482, - "heading": 0.7092144892181306, - "angularVelocity": 1.549507120476202, - "velocityX": 0.7640502306097657, - "velocityY": 0.2955885308725854, + "x": 12.94599898532897, + "y": 2.4061455217676833, + "heading": 0.6987986006648391, + "angularVelocity": 1.8278499118104674, + "velocityX": 0.7507739955372641, + "velocityY": 0.3049008798719041, "moduleForcesX": [ - -85.10523672353476, - -86.41137299899846, - -112.06170126554508, - -114.61890071891574 + -81.25618436721729, + -85.27321950996416, + -110.08736666214384, + -114.93039749975733 ], "moduleForcesY": [ - -77.71146885299495, - -76.42757490922745, - 27.300042653259524, - -13.22254030124739 + -81.68368062704863, + -77.68627318980845, + 34.38228873619402, + -10.118563442601245 ], - "timestamp": 7.1590649556084305 + "timestamp": 7.345073870446574 }, { "x": 12.967412948608398, - "y": 2.415215253829956, + "y": 2.4152152538299556, "heading": 0.7551043250796196, - "angularVelocity": 0.8083825990618009, - "velocityX": 0.3768185819638491, - "velocityY": 0.14958535571928933, + "angularVelocity": 0.9641391597034191, + "velocityX": 0.36667746977301147, + "velocityY": 0.15530363813167133, "moduleForcesX": [ - -79.8120626088093, - -82.24535135891634, - -110.85189362912443, - -114.54956911255539 + -71.24184841573965, + -79.34168407653632, + -108.15322189105373, + -114.84174119771971 ], "moduleForcesY": [ - -83.1630963954795, - -80.92027537570912, - 31.94949718085646, - -13.954975426754949 + -90.57520191146978, + -83.76752129096904, + 40.14476142563533, + -11.30273600011981 ], - "timestamp": 7.215832426747403 + "timestamp": 7.403473867841245 }, { "x": 12.967412948608398, "y": 2.415215253829956, "heading": 0.7551043250796196, - "angularVelocity": -1.3336137182058527e-20, - "velocityX": 7.896803099134162e-20, - "velocityY": -8.450419355688481e-20, + "angularVelocity": 9.053251338585555e-21, + "velocityX": -3.8997560756165654e-20, + "velocityY": 8.026582215029425e-20, "moduleForcesX": [ - -73.04670295538688, - -79.74797430779527, - -109.59078372653275, - -114.65423863578631 + -59.447576805243436, + -76.0182207018807, + -106.23908134928888, + -114.93156102990737 ], "moduleForcesY": [ - -89.19074412625777, - -83.40210179987234, - 36.08914873029201, - -13.169435415720292 + -98.75016323489919, + -86.81696405456789, + 45.01411898852267, + -10.497822934908333 ], - "timestamp": 7.272599897886376 + "timestamp": 7.4618738652359164 }, { - "x": 12.970048360747468, - "y": 2.4137790529276497, - "heading": 0.7937123904808917, - "angularVelocity": 1.1279408340974115, - "velocityX": 0.07699398909111418, - "velocityY": -0.04195884012456589, + "x": 12.96998343707109, + "y": 2.414002895867038, + "heading": 0.7972120394307962, + "angularVelocity": 1.1925305688726804, + "velocityX": 0.07279868109514463, + "velocityY": -0.03433513201728092, "moduleForcesX": [ - -108.01660145288726, - 63.314454594733206, - 60.59422206639011, - 111.87513675069263 + -111.21616724439681, + 56.92485396981027, + 59.189341209886784, + 112.20973399379479 ], "moduleForcesY": [ - -39.618466232021234, - 96.33566340014396, - -98.1623898281533, - -28.183152137146752 + -29.647343877850524, + 100.25021857445405, + -99.01585760311724, + -26.82030436731245 ], - "timestamp": 7.3068287015914635 + "timestamp": 7.497183412387384 }, { - "x": 12.975621766996525, - "y": 2.4106424063814402, - "heading": 0.8697774779478025, - "angularVelocity": 2.222253752198958, - "velocityX": 0.16282795908031536, - "velocityY": -0.0916376328318483, + "x": 12.975382665164473, + "y": 2.411312891081737, + "heading": 0.8804592395786249, + "angularVelocity": 2.3576399830539327, + "velocityX": 0.15291128119587102, + "velocityY": -0.07618349716500683, "moduleForcesX": [ - -96.65015385418619, - 60.2572282410898, - 65.93464425581767, - 112.89494643133521 + -102.0282025796209, + 52.4117542511673, + 65.18685502936165, + 113.30290747157059 ], "moduleForcesY": [ - -62.329753787693775, - 98.21955261781349, - -94.63903361003725, - -23.689938883154483 + -53.14869773571917, + 102.62130539045927, + -95.15210347949893, + -21.639970807289608 ], - "timestamp": 7.3410575052965505 + "timestamp": 7.532492959538852 }, { - "x": 12.984638262041022, - "y": 2.40560314630279, - "heading": 0.981604703565313, - "angularVelocity": 3.2670503643950517, - "velocityX": 0.2634183514613656, - "velocityY": -0.14722279288698714, + "x": 12.984095673066808, + "y": 2.406910573419745, + "heading": 1.0032632315683296, + "angularVelocity": 3.477925997263877, + "velocityX": 0.24676068104083002, + "velocityY": -0.1246778284382388, "moduleForcesX": [ - -75.73920484802935, - 55.647722774813666, - 72.9840009621066, - 114.03160254054053 + -82.28667122957336, + 45.662880673923205, + 73.15743467730792, + 114.4374038272442 ], "moduleForcesY": [ - -86.50130488193668, - 100.80472826924579, - -89.2887526232794, - -17.255130186537208 + -80.3144525443013, + 105.68805654601378, + -89.1356191703524, + -14.2484998053063 ], - "timestamp": 7.375286309001638 + "timestamp": 7.56780250669032 }, { - "x": 12.997789852791989, - "y": 2.398632583933518, - "heading": 1.1269751697569061, - "angularVelocity": 4.247021527369041, - "velocityX": 0.384225836937812, - "velocityY": -0.20364609962244667, + "x": 12.996877140681336, + "y": 2.4007272960210755, + "heading": 1.1632571037667327, + "angularVelocity": 4.531178820053266, + "velocityX": 0.36198333441376895, + "velocityY": -0.17511630415825236, "moduleForcesX": [ - -47.052833680267064, - 51.55657320839896, - 81.07269190656048, - 114.89682349470702 + -51.418086814419254, + 39.35983727831288, + 82.27641388148449, + 115.13501591899251 ], "moduleForcesY": [ - -104.87988948985272, - 102.76487920670435, - -81.97187217875056, - -9.5444344265138 + -102.7787620179167, + 107.95631863586193, + -80.73399410186636, + -5.581529823013248 ], - "timestamp": 7.409515112706725 + "timestamp": 7.603112053841788 }, { - "x": 13.01604908890962, - "y": 2.3898145535116964, - "heading": 1.30230612560941, - "angularVelocity": 5.122322046751738, - "velocityX": 0.5334465170026499, - "velocityY": -0.25762017562547473, + "x": 13.015049064249819, + "y": 2.3927861943346507, + "heading": 1.3554989134366557, + "angularVelocity": 5.444471118399243, + "velocityX": 0.5146461802677791, + "velocityY": -0.22489956193372712, "moduleForcesX": [ - -13.83132865379064, - 56.89712099256609, - 89.34828449880882, - 115.20928290206547 + -10.940950643938722, + 49.962099870379674, + 91.40372157976817, + 115.15655922442267 ], "moduleForcesY": [ - -114.07904848518923, - 99.40316122357095, - -72.78432529295559, - -2.1067431308289684 + -114.29555191993943, + 102.6827935808022, + -70.09920994331412, + 1.628018794334819 ], - "timestamp": 7.443743916411812 + "timestamp": 7.638421600993256 }, { - "x": 13.041330772308694, - "y": 2.3782677142113013, - "heading": 1.4965650837086486, - "angularVelocity": 5.675306673670554, - "velocityX": 0.7386084426695338, - "velocityY": -0.337342765456264, + "x": 13.041336393679563, + "y": 2.380821542261088, + "heading": 1.5611649438949164, + "angularVelocity": 5.824657834778007, + "velocityX": 0.7444822024189007, + "velocityY": -0.3388503404537995, "moduleForcesX": [ - 23.62733870295094, - 105.17566327178272, - 96.55369553063645, - 115.09802567519542 + 44.018601789505944, + 112.32060939232755, + 98.58413579678957, + 114.80288651764442 ], "moduleForcesY": [ - -112.36357969798449, - 42.3756044319675, - -62.73241252810405, - 0.42521575450602284 + -105.76548150864933, + -13.981211872807418, + -59.14888259144886, + -4.411599951380392 ], - "timestamp": 7.477972720116899 + "timestamp": 7.673731148144724 }, { - "x": 13.074571748977242, - "y": 2.3622293034747717, - "heading": 1.6983784117666543, - "angularVelocity": 5.896008805823781, - "velocityX": 0.9711404744073342, - "velocityY": -0.46856474666171494, + "x": 13.075568670437569, + "y": 2.363605977955592, + "heading": 1.7569917778370125, + "angularVelocity": 5.546002419743737, + "velocityX": 0.9694906765912515, + "velocityY": -0.4875611752160383, "moduleForcesX": [ - 71.12553566693927, - 100.91027402459993, - 100.75435384797667, - 113.08371748677187 + 112.77483449910198, + 99.15399456797537, + 90.29830581798545, + 59.73325270720686 ], "moduleForcesY": [ - -89.84770615754807, - -53.21727890658172, - -55.16195289043256, - -19.528589252981142 + -17.7589765691773, + -57.092373513786576, + -67.32011989023349, + -97.05254853412107 ], - "timestamp": 7.512201523821986 + "timestamp": 7.709040695296192 }, { - "x": 13.114509281067164, - "y": 2.340957999926888, - "heading": 1.8863558488571963, - "angularVelocity": 5.491791028110231, - "velocityX": 1.166781417020328, - "velocityY": -0.6214445509474895, + "x": 13.116425328315025, + "y": 2.3404059032444886, + "heading": 1.936779809038105, + "angularVelocity": 5.091768252644345, + "velocityX": 1.1570994581774832, + "velocityY": -0.657048208847239, "moduleForcesX": [ - 114.25525292589651, - 101.5198450249115, - 62.82771454322464, - 46.05237264124183 + 113.58831274277301, + 99.7780845838403, + 45.433109941728226, + 42.997780804688276 ], "moduleForcesY": [ - -3.0662620881109772, - -53.164971916677835, - -92.89456142147867, - -104.56967598650544 + -8.813998457097396, + -55.91347232549451, + -102.28351156220437, + -105.6347151591242 ], - "timestamp": 7.546430327527073 + "timestamp": 7.74435024244766 }, { - "x": 13.16127250279366, - "y": 2.3144796562214776, - "heading": 2.0604510155338396, - "angularVelocity": 5.086218267417001, - "velocityX": 1.3661950364785713, - "velocityY": -0.7735690657912138, + "x": 13.164348878372106, + "y": 2.311286163678727, + "heading": 2.102441153162455, + "angularVelocity": 4.691687022031468, + "velocityX": 1.3572405743835967, + "velocityY": -0.8246987547269855, "moduleForcesX": [ - 113.85700055139108, - 103.5977835443585, - 57.60230783383877, - 55.858639098030515 + 112.23361382448608, + 101.31991173599144, + 52.83399612225048, + 55.56993463789342 ], "moduleForcesY": [ - -7.038353644791787, - -48.731921179952906, - -97.0132702772452, - -99.65856579041063 + -17.942568729740564, + -52.73023800246578, + -99.48263504998427, + -99.53598557359436 ], - "timestamp": 7.58065913123216 + "timestamp": 7.779659789599128 }, { - "x": 13.215371818566618, - "y": 2.283182129389797, - "heading": 2.222199775394, - "angularVelocity": 4.725516008499068, - "velocityX": 1.5805202027821996, - "velocityY": -0.9143622751583239, + "x": 13.219851677647156, + "y": 2.2766875060838747, + "heading": 2.255229935633236, + "angularVelocity": 4.327123817684807, + "velocityX": 1.5718921298242057, + "velocityY": -0.9798669307882757, "moduleForcesX": [ - 113.4504714545397, - 106.32220430919419, - 67.34185140885803, - 68.54608055150739 + 111.9924020775366, + 104.4925935573574, + 62.07558249791472, + 66.73912886868742 ], "moduleForcesY": [ - -9.493241665912656, - -42.053893387015094, - -90.8154825702002, - -91.27582657149121 + -17.66498742329877, + -45.65536628701666, + -94.04562308108473, + -92.24565830688235 ], - "timestamp": 7.614887934937247 + "timestamp": 7.814969336750596 }, { - "x": 13.277347449903122, - "y": 2.2478394917559394, - "heading": 2.3724726135624645, - "angularVelocity": 4.3902451123681105, - "velocityX": 1.8106280275084354, - "velocityY": -1.032540837195327, + "x": 13.28353970410351, + "y": 2.2375422812207173, + "heading": 2.3954911150696994, + "angularVelocity": 3.972330169933441, + "velocityX": 1.8037055582489414, + "velocityY": -1.1086300454442182, "moduleForcesX": [ - 113.5653767711979, - 109.86203798468613, - 78.22814414337026, - 80.19548638705947 + 112.87425186361119, + 108.91840198905972, + 73.13263930631699, + 77.98189938274406 ], "moduleForcesY": [ - -2.651547534152781, - -31.01826752750063, - -81.44565214036037, - -80.99523654285561 + -6.223365306848344, + -32.97990859437656, + -85.29569693218718, + -82.63610290053495 ], - "timestamp": 7.649116738642334 + "timestamp": 7.850278883902064 }, { - "x": 13.347738923201241, - "y": 2.209798230712871, - "heading": 2.5114070565980735, - "angularVelocity": 4.058992076750882, - "velocityX": 2.056498202642214, - "velocityY": -1.111381553700728, + "x": 13.356027725868415, + "y": 2.1954929185575316, + "heading": 2.5227266765592224, + "angularVelocity": 3.603432265605644, + "velocityX": 2.05292980547018, + "velocityY": -1.1908779935020604, "moduleForcesX": [ - 112.19207649662098, - 113.16894691538694, - 90.80572403866687, - 91.84103538443951 + 111.12012886761015, + 112.86988205346621, + 86.88778676806567, + 90.03734763330992 ], "moduleForcesY": [ - 15.928502193312395, - -13.308928426826157, - -66.37795970134175, - -67.07336672078067 + 18.73827221813339, + -12.34828439071452, + -69.97685042739457, + -68.72148386204216 ], - "timestamp": 7.683345542347421 + "timestamp": 7.885588431053532 }, { - "x": 13.426870193585469, - "y": 2.171263792990934, - "heading": 2.6387846589283668, - "angularVelocity": 3.721357118635243, - "velocityX": 2.3118327787911346, - "velocityY": -1.1257897896174638, + "x": 13.437612450726574, + "y": 2.1532107657883417, + "heading": 2.6363795977141677, + "angularVelocity": 3.2187589568171635, + "velocityX": 2.310557099704127, + "velocityY": -1.1974708309852242, "moduleForcesX": [ - 102.63355880151254, - 112.95185304826374, - 104.73192313748237, - 103.39609116937378 + 97.20248405701679, + 111.86974536596307, + 103.03466347126968, + 102.32583288762171 ], "moduleForcesY": [ - 47.5032430073068, - 13.428590930969284, - -38.36223908730184, - -46.47925525510383 + 56.63338441321471, + 18.095398070103148, + -37.97062581902301, + -47.36373949630385 ], - "timestamp": 7.717574346052508 + "timestamp": 7.920897978205 }, { - "x": 13.514211992892422, - "y": 2.1355999035658586, - "heading": 2.7553046690686678, - "angularVelocity": 3.404150818247408, - "velocityX": 2.5517047005060185, - "velocityY": -1.041926259889313, + "x": 13.52742112558017, + "y": 2.114825451689113, + "heading": 2.7381791424535917, + "angularVelocity": 2.8830600489644733, + "velocityX": 2.5434671951001175, + "velocityY": -1.0871086489602033, "moduleForcesX": [ - 75.57886955728137, - 102.96113998905116, - 107.63125638242843, - 111.88275135917017 + 65.89792156241022, + 99.43709283642043, + 97.88415343385961, + 111.45218049666381 ], "moduleForcesY": [ - 84.19790217808342, - 48.1221710956847, - 21.89000669551172, - -15.04325013116753 + 91.46142231462393, + 54.22012108641089, + 43.67400047278733, + -11.821171765210279 ], - "timestamp": 7.751803149757595 + "timestamp": 7.956207525356468 }, { - "x": 13.608382873111731, - "y": 2.104027882799267, - "heading": 2.8572670405922005, - "angularVelocity": 2.978847066991696, - "velocityX": 2.7512173966310547, - "velocityY": -0.9223816595721166, + "x": 13.624109013301569, + "y": 2.082166798124268, + "heading": 2.8283496984778993, + "angularVelocity": 2.5537160144677564, + "velocityX": 2.7382930544713884, + "velocityY": -0.9249241692269164, "moduleForcesX": [ - 43.05897579116903, - 91.6113139764606, - 86.0284662891163, - 110.3813871494816 + 47.53439495990041, + 87.45802427935757, + 68.84720326442992, + 109.56743396568841 ], "moduleForcesY": [ - 103.90780630948846, - 66.29758480169258, - 44.88832766753545, - -16.716151028620235 + 101.06114313793714, + 70.39136956871369, + 77.82924862847176, + 11.616666431402512 ], - "timestamp": 7.7860319534626825 + "timestamp": 7.991517072507936 }, { - "x": 13.709392507782326, - "y": 2.0756519490371312, - "heading": 2.94318081891027, - "angularVelocity": 2.5099848378663028, - "velocityX": 2.951012706750959, - "velocityY": -0.8290074641980617, + "x": 13.72686903772777, + "y": 2.0553682797529484, + "heading": 2.9074090191549895, + "angularVelocity": 2.2390352483975082, + "velocityX": 2.91026174834215, + "velocityY": -0.758959560040714, "moduleForcesX": [ - 44.52299290536762, - 89.70386834247236, - 89.89738881433836, - 107.4248752374718 + 40.22780438179703, + 78.40481006980285, + 57.57268745635085, + 100.4325239168598 ], "moduleForcesY": [ - 99.54624373858208, - 64.70732173234636, - 5.23775664216174, - -14.542075390294418 + 98.4313106563725, + 73.82616586327329, + 71.5409821365442, + 23.18088284906935 ], - "timestamp": 7.82026075716777 + "timestamp": 8.026826619659403 }, { - "x": 13.816873348205831, - "y": 2.0493588330156762, - "heading": 3.0127614350084757, - "angularVelocity": 2.0328088792616716, - "velocityX": 3.140070022591264, - "velocityY": -0.7681576092481421, + "x": 13.833446542907254, + "y": 2.0337946936747766, + "heading": 2.978868034125111, + "angularVelocity": 2.023787353136609, + "velocityX": 3.018376438595989, + "velocityY": -0.6109845018859891, "moduleForcesX": [ - 51.259757063966916, - 87.90465515997464, - 76.04326290186623, - 98.52235017226005 + 27.71133529028477, + 53.321617344173696, + 30.59724389817127, + 62.288742887948686 ], "moduleForcesY": [ - 83.80305982182361, - 54.18397152510217, - -19.682023673725332, - -17.32808198285826 + 77.76542044513596, + 67.01241376251376, + 54.08148222741618, + 39.18109337921699 ], - "timestamp": 7.854489560872857 + "timestamp": 8.06213616681087 }, { - "x": 13.929707201661447, - "y": 2.0240992265198385, - "heading": 3.068040845669453, - "angularVelocity": 1.6149968645489765, - "velocityX": 3.2964591584264133, - "velocityY": -0.7379634623965822, + "x": 13.941082897090102, + "y": 2.014552811875832, + "heading": 3.046276067820356, + "angularVelocity": 1.909059705752796, + "velocityX": 3.0483640506949308, + "velocityY": -0.5449484162575098, "moduleForcesX": [ - 47.295717118224054, - 78.04506650685518, - 52.74429299675803, - 81.43393391647136 + 6.338411935153288, + 18.630960550653445, + 5.06353490915197, + 18.20673219295047 ], "moduleForcesY": [ - 57.972821530832974, - 39.43293491124601, - -26.72428249075782, - -20.575978623147435 + 35.187167487602544, + 33.453819907714234, + 19.61232716700604, + 17.975782973141456 ], - "timestamp": 7.888718364577944 + "timestamp": 8.097445713962337 }, { - "x": 14.047884577428986, - "y": 2.0018097256387324, - "heading": 3.1110017017202476, - "angularVelocity": 1.2551083123132851, - "velocityX": 3.4525710213465004, - "velocityY": -0.6511913496333745, + "x": 14.05314484024913, + "y": 1.9975368200863013, + "heading": 3.1018857561383033, + "angularVelocity": 1.5749193293076669, + "velocityX": 3.173700944911924, + "velocityY": -0.4819090915135053, "moduleForcesX": [ - 40.41850941273932, - 72.26596436397179, - 60.165986562380006, - 86.20843132854377 + 32.38825659623406, + 61.429438389035255, + 39.21145043820505, + 68.59433110232229 ], "moduleForcesY": [ - 74.57460703229934, - 57.34619153849231, - 8.435378772880814, - 3.6372831123246727 + 56.694726366304984, + 45.459912121099414, + 0.48491739779044996, + -1.2312044805406857 ], - "timestamp": 7.922947168283031 + "timestamp": 8.132755261113804 }, { "x": 14.171788215637209, "y": 1.984554409980774, "heading": 3.141592653589793, - "angularVelocity": 0.8937195741082631, - "velocityX": 3.619864698625444, - "velocityY": -0.5041168194664397, + "angularVelocity": 1.124537148017186, + "velocityX": 3.360093373022707, + "velocityY": -0.36767421711301757, "moduleForcesX": [ - 31.013647911651436, - 72.0282862596618, - 73.76190608414021, - 100.81064597402093 + 36.55913016223622, + 77.99345741140219, + 82.65797442708791, + 102.63003632076331 ], "moduleForcesY": [ - 99.50918080631918, - 78.69145966069404, - 44.945495220702036, - 20.9158085162814 + 95.80128612213797, + 71.69774957943521, + 11.330071286912512, + 4.935080412220265 ], - "timestamp": 7.957175971988118 + "timestamp": 8.168064808265271 }, { - "x": 14.465911674508094, - "y": 1.9753101696961057, - "heading": 3.1416390533992677, - "angularVelocity": 0.0006259678214476079, - "velocityX": 3.9679434650520284, - "velocityY": -0.12471165328920111, + "x": 14.454593476941811, + "y": 1.97796448772176, + "heading": 3.1416429856731254, + "angularVelocity": 0.0006710133266609316, + "velocityX": 3.7702810339357056, + "velocityY": -0.08785500946360723, "moduleForcesX": [ - 12.487145015519305, - 69.66097734031248, - 72.91874659974623, - 111.66054849173449 + 18.90105163422517, + 76.09798989324729, + 102.58200087249564, + 113.03447520897573 ], "moduleForcesY": [ - 112.68237698463481, - 89.98445533687041, - 72.22468092466957, - 15.840843626755948 + 111.7491169958333, + 84.68950673878763, + 12.795896757028622, + 2.6591962220306633 ], - "timestamp": 8.03130088366123 + "timestamp": 8.243073874899594 }, { - "x": 14.759680867707536, - "y": 1.9926744865605754, - "heading": 3.141639047674968, - "angularVelocity": -7.722504859421795e-8, - "velocityX": 3.9631641585618773, - "velocityY": 0.23425750496730716, + "x": 14.73702423123013, + "y": 1.9942197501048884, + "heading": 3.141642978594246, + "angularVelocity": -9.437364784490279e-8, + "velocityX": 3.7652882106265917, + "velocityY": 0.21671063396078938, "moduleForcesX": [ - -0.9389057010062756, - -0.8918110984524966, - -0.9393548495237268, - -0.8922375760075535 + -0.9672719038049086, + -0.9227533462325223, + -0.9676691170691535, + -0.9231321771109741 ], "moduleForcesY": [ - 68.78303298559197, - 68.78336233513552, - 68.75291633774563, - 68.75324593515026 + 57.67606024664952, + 57.67635291233172, + 57.6401521151496, + 57.640444913455646 ], - "timestamp": 8.105425795334341 + "timestamp": 8.318082941533916 }, { - "x": 15.026827970969723, - "y": 2.0099691813791303, - "heading": 3.1416259895563514, - "angularVelocity": -0.00017616369884637328, - "velocityX": 3.604012432963095, - "velocityY": 0.23331825196411826, + "x": 15.010642804361149, + "y": 2.011079932044252, + "heading": 3.141629628938074, + "angularVelocity": -0.0001779739006345567, + "velocityX": 3.64780666402562, + "velocityY": 0.22477525312446248, "moduleForcesX": [ - -68.80569709908896, - -68.80055108905634, - -68.80567698548732, - -68.80053097288132 + -22.244941885332093, + -22.236580273652777, + -22.24500082399066, + -22.23663920902384 ], "moduleForcesY": [ - -0.17267223974178206, - -0.17268609942239904, - -0.18718088491331014, - -0.1871959394377115 + 1.5327560088699677, + 1.5328008081495923, + 1.5206747766652815, + 1.5207191865207244 ], - "timestamp": 8.179550707007452 + "timestamp": 8.393092008168239 }, { - "x": 15.249536975116508, - "y": 2.0243970355953347, - "heading": 3.141614954022603, - "angularVelocity": -0.00014887752982443867, - "velocityX": 3.0045095382902, - "velocityY": 0.1946424473303505, + "x": 15.238746449573442, + "y": 2.025140105667011, + "heading": 3.141617683794715, + "angularVelocity": -0.0001592493267130903, + "velocityX": 3.0410143126340383, + "velocityY": 0.18744632154013266, "moduleForcesX": [ - -114.84736831647434, - -114.84738407657306, - -114.84755033754627, - -114.84756609099593 + -114.87365016225687, + -114.8736602533315, + -114.87376789982473, + -114.87377798798217 ], "moduleForcesY": [ - -7.410652114275073, - -7.410516501125907, - -7.407821278678371, - -7.407685716920534 + -7.067858015952322, + -7.067770306332378, + -7.065937872922811, + -7.06585018696093 ], - "timestamp": 8.253675618680564 + "timestamp": 8.468101074802561 }, { - "x": 15.427734932644807, - "y": 2.035944875109631, - "heading": 3.1416060662035123, - "angularVelocity": -0.00011990326719874652, - "velocityX": 2.4040225277319003, - "velocityY": 0.15578891432912842, + "x": 15.42126048503754, + "y": 2.0363917821596837, + "heading": 3.141607829317923, + "angularVelocity": -0.0001313771419136315, + "velocityX": 2.433226323877269, + "velocityY": 0.15000421945692372, "moduleForcesX": [ - -115.03589170672049, - -115.03590480898394, - -115.03608605645235, - -115.03609915116974 + -115.06210747733799, + -115.06211903061897, + -115.06228342780778, + -115.06229497459297 ], "moduleForcesY": [ - -7.444793267880758, - -7.444648447596564, - -7.441784589248815, - -7.441639827013844 + -7.0897746850507195, + -7.0896435800698425, + -7.086913890620305, + -7.086782838153622 ], - "timestamp": 8.327800530353676 + "timestamp": 8.543110141436884 }, { - "x": 15.561397445196155, - "y": 2.0446082921325672, - "heading": 3.141599372332212, - "angularVelocity": -0.0000903052853512078, - "velocityX": 1.8032063652338357, - "velocityY": 0.11687591698101098, + "x": 15.55816017917051, + "y": 2.0448321500588196, + "heading": 3.141600301323743, + "angularVelocity": -0.0001003611232318043, + "velocityX": 1.8251086205401539, + "velocityY": 0.11252463572546204, "moduleForcesX": [ - -115.09894593189205, - -115.09895807541444, - -115.0991448304989, - -115.09915696612956 + -115.1245166883893, + -115.12452826743665, + -115.1247127410453, + -115.1247243120354 ], "moduleForcesY": [ - -7.456219470556481, - -7.4560712446453135, - -7.453145099192203, - -7.452996933892054 + -7.097039766327021, + -7.096893661739564, + -7.09385533338325, + -7.093709293863294 ], - "timestamp": 8.401925442026787 + "timestamp": 8.618119208071207 }, { - "x": 15.650512302084337, - "y": 2.0503850805660555, - "heading": 3.141594896520999, - "angularVelocity": -0.00006038201073843798, - "velocityX": 1.2022254715280745, - "velocityY": 0.07793315773480654, + "x": 15.649433203495256, + "y": 2.0504598078795278, + "heading": 3.141595218831146, + "angularVelocity": -0.00006775837675300562, + "velocityX": 1.216826557377529, + "velocityY": 0.07502636778758355, "moduleForcesX": [ - -115.13050274279995, - -115.13051439212589, - -115.13070401220862, - -115.13071565345946 + -115.15562710583616, + -115.1556386080867, + -115.15583332234816, + -115.1558448156885 ], "moduleForcesY": [ - -7.461939008917163, - -7.461789005484221, - -7.458830380578395, - -7.4586804391143025 + -7.100662428852205, + -7.100508735512367, + -7.097314584597426, + -7.09716096317408 ], - "timestamp": 8.476050353699899 + "timestamp": 8.69312827470553 }, { - "x": 15.695072174072267, - "y": 2.0532739162445135, + "x": 15.695072174072266, + "y": 2.0532739162445086, "heading": 3.141592653589793, - "angularVelocity": -0.000030258804437930826, - "velocityX": 0.6011457009815155, - "velocityY": 0.0389725345128546, + "angularVelocity": -0.00003419908376354715, + "velocityX": 0.6084460535885152, + "velocityY": 0.03751690950502779, "moduleForcesX": [ - -115.14944411679562, - -115.14945546462413, - -115.14964684268682, - -115.14965818232656 + -115.17426017282052, + -115.1742715999137, + -115.1744725223164, + -115.1744839399641 ], "moduleForcesY": [ - -7.465372303464892, - -7.465221209099038, - -7.462242621788976, - -7.462091590233925 + -7.1028324617840966, + -7.102674189928448, + -7.099386084718839, + -7.099227889075033 ], - "timestamp": 8.55017526537301 + "timestamp": 8.768137341339852 }, { "x": 15.695072174072266, "y": 2.053273916244507, "heading": 3.141592653589793, - "angularVelocity": -9.292016747356084e-24, - "velocityX": -1.793915534938115e-21, - "velocityY": 6.2893253710272155e-21, + "angularVelocity": 7.360266802879611e-18, + "velocityX": -3.548120676165313e-17, + "velocityY": 1.645505940598732e-17, "moduleForcesX": [ - -115.16207409488239, - -115.16208523948659, - -115.16227780816574, - -115.16228894450374 + -115.1866675847214, + -115.18667894938694, + -115.18688403868423, + -115.18689539353758 ], "moduleForcesY": [ - -7.467661670085714, - -7.467509839682893, - -7.464517710638041, - -7.46436594362026 + -7.104277561224014, + -7.104116229492547, + -7.100765271069564, + -7.100604018492855 ], - "timestamp": 8.624300177046122 + "timestamp": 8.843146407974174 }, { - "x": 15.683032734310219, - "y": 2.065243087486579, - "heading": 3.115114997508429, - "angularVelocity": -0.5490817512048347, - "velocityX": -0.2496684996494882, - "velocityY": 0.24821130261198696, + "x": 15.682503427057059, + "y": 2.0646337327221738, + "heading": 3.1105221295886483, + "angularVelocity": -0.6347005775094131, + "velocityX": -0.256751092735796, + "velocityY": 0.2320553744418617, "moduleForcesX": [ - -71.19396438514681, - -16.351962141394477, - -113.73960028992641, - -92.80128040966147 + -70.5113246528861, + -10.018801848294446, + -114.81418680640073, + -102.56695754289538 ], "moduleForcesY": [ - 90.82485498148873, - 114.2197124413682, - 19.306054425681616, - 68.01973967114493 + 91.35804066484329, + 114.95032459741512, + 11.291141101368888, + 51.657036115035055 ], - "timestamp": 8.672521878137562 + "timestamp": 8.89209944993148 }, { - "x": 15.658925173391546, - "y": 2.0892962989602575, - "heading": 3.062358403873359, - "angularVelocity": -1.0940425667487261, - "velocityX": -0.49993178119037096, - "velocityY": 0.498804706786825, + "x": 15.65742036306147, + "y": 2.0876131196932546, + "heading": 3.0485249865888644, + "angularVelocity": -1.2664615010820823, + "velocityX": -0.5123903028885073, + "velocityY": 0.46941693602952456, "moduleForcesX": [ - -69.20082557973149, - -16.95272733429739, - -112.51565970212599, - -96.11819363500827 + -67.98037553477958, + -10.477656621264348, + -113.74547934312902, + -104.41762909388488 ], "moduleForcesY": [ - 92.3390007447845, - 114.1166649077064, - 25.431491565284002, - 63.28910350060903 + 93.24160102529723, + 114.89176486973722, + 19.194965643610416, + 48.08504142954779 ], - "timestamp": 8.720743579229003 + "timestamp": 8.941052491888787 }, { - "x": 15.62279726830929, - "y": 2.12560868155957, - "heading": 2.9832806496410678, - "angularVelocity": -1.639878984823432, - "velocityX": -0.7492042848872155, - "velocityY": 0.7530298968602243, + "x": 15.619984364865571, + "y": 2.122583149169414, + "heading": 2.9555670776733143, + "angularVelocity": -1.898919968990331, + "velocityX": -0.7647328275973524, + "velocityY": 0.7143586604192456, "moduleForcesX": [ - -66.36796972826156, - -17.450975110192893, - -110.621364173897, - -99.18005096251872 + -64.39521228894338, + -10.835990160847423, + -111.74412944489666, + -105.82062634096789 ], "moduleForcesY": [ - 94.37769509418551, - 114.01956856414778, - 32.64856908645184, - 58.408341771039105 + 95.73186682963218, + 114.83217133102714, + 28.557801462027836, + 45.08688416388965 ], - "timestamp": 8.768965280320444 + "timestamp": 8.990005533846093 }, { - "x": 15.574792792817318, - "y": 2.1745030635707616, - "heading": 2.878098250144675, - "angularVelocity": -2.181225405071048, - "velocityX": -0.9954952729880231, - "velocityY": 1.013949755079664, + "x": 15.570467933857678, + "y": 2.170168664476953, + "heading": 2.8324199256452296, + "angularVelocity": -2.5156179698799113, + "velocityX": -1.0115087648950551, + "velocityY": 0.9720645215752571, "moduleForcesX": [ - -62.904518048583384, - -18.765520932194924, - -107.7608463249948, - -100.67752020321787 + -60.10508416922476, + -12.632263453369584, + -108.31270835066015, + -105.28692632471801 ], "moduleForcesY": [ - 96.69530558377407, - 113.77796058506848, - 41.059685679799614, - 55.80693345276965 + 98.45078742590746, + 114.60669150976062, + 39.55592248262243, + 46.40569830412261 ], - "timestamp": 8.817186981411885 + "timestamp": 9.038958575803399 }, { - "x": 15.515115418351767, - "y": 2.2365113766993776, - "heading": 2.748238313390357, - "angularVelocity": -2.6929770998345632, - "velocityX": -1.2375626142343545, - "velocityY": 1.2859005743292333, + "x": 15.509173235477315, + "y": 2.231318730757613, + "heading": 2.6823266470561213, + "angularVelocity": -3.0660664299475155, + "velocityX": -1.2521121452208077, + "velocityY": 1.249157638351185, "moduleForcesX": [ - -59.32922192701663, - -22.65425748350358, - -103.41216352884263, - -99.73769034374713 + -56.107596300781445, + -19.19352006993177, + -102.46843648837859, + -101.40533999140591 ], "moduleForcesY": [ - 98.89044870030654, - 113.0169064497809, - 50.96198665871155, - 57.464013291731035 + 100.7295111846094, + 113.62114180098361, + 52.787569948269265, + 54.3761343490552 ], - "timestamp": 8.865408682503325 + "timestamp": 9.087911617760705 }, { - "x": 15.443945120311788, - "y": 2.312397535168875, - "heading": 2.598049453482882, - "angularVelocity": -3.1145491865307253, - "velocityX": -1.475897706408575, - "velocityY": 1.5736931039740272, + "x": 15.43629756865313, + "y": 2.3072905794447975, + "heading": 2.5143967135906133, + "angularVelocity": -3.430428973381599, + "velocityX": -1.4886851543897108, + "velocityY": 1.5519331516069275, "moduleForcesX": [ - -57.02616538718774, - -32.46022038133978, - -96.42189325761598, - -94.82880396936186 + -55.566033052317195, + -37.364595107963666, + -91.32795604295461, + -90.23982224737182 ], "moduleForcesY": [ - 100.1682414386154, - 110.51663143062801, - 63.10043038238431, - 65.20814728614427 + 100.91772810006313, + 108.8790331542822, + 70.17696973257495, + 71.3402088109634 ], - "timestamp": 8.913630383594766 + "timestamp": 9.136864659718011 }, { - "x": 15.361397570597198, - "y": 2.4030627345914812, - "heading": 2.4379497025502035, - "angularVelocity": -3.3200767975623116, - "velocityX": -1.711834046626805, - "velocityY": 1.8801742238557955, + "x": 15.352292498894688, + "y": 2.3990896446839507, + "heading": 2.351450276494965, + "angularVelocity": -3.328627406602441, + "velocityX": -1.7160337008704416, + "velocityY": 1.8752474120484843, "moduleForcesX": [ - -60.19075395749284, - -52.99761897342073, - -83.00503571063983, - -81.71816250502042 + -71.99046256530353, + -72.9535224518983, + -58.21609003135491, + -60.635080354255095 ], "moduleForcesY": [ - 98.14890485863737, - 102.13208160331287, - 79.7649281328897, - 80.96099716076799 + 89.5505221976233, + 88.84114044999198, + 99.07653572080291, + 97.67708800954779 ], - "timestamp": 8.961852084686207 + "timestamp": 9.185817701675317 }, { - "x": 15.268296814292313, - "y": 2.508757545140913, - "heading": 2.2929332529509288, - "angularVelocity": -3.007286062436612, - "velocityX": -1.9306817096382098, - "velocityY": 2.1918515555684537, + "x": 15.260507627409444, + "y": 2.505421301762789, + "heading": 2.227820518874649, + "angularVelocity": -2.5254765113093023, + "velocityX": -1.8749574656677745, + "velocityY": 2.17211541550255, "moduleForcesX": [ - -85.6509418331789, - -83.21974573343564, - -39.29014814005921, - -49.62182640039944 + -103.96409482483048, + -88.63793057016247, + 27.03297066939857, + -18.83203285938997 ], "moduleForcesY": [ - 76.33230295247037, - 79.26870386093083, - 107.83989683014454, - 103.68667351103075 + 46.94680786578636, + 72.95986689454536, + 111.23995258444597, + 113.31276031147173 ], - "timestamp": 9.010073785777648 + "timestamp": 9.234770743632623 }, { - "x": 15.167273163864417, - "y": 2.6272614661882616, - "heading": 2.192483841142394, - "angularVelocity": -2.0830748301072206, - "velocityX": -2.094983132932844, - "velocityY": 2.457481141584662, + "x": 15.160614493792021, + "y": 2.625256965891475, + "heading": 2.148185511483945, + "angularVelocity": -1.6267632042183744, + "velocityX": -2.040590934152655, + "velocityY": 2.447971757052899, "moduleForcesX": [ - -111.50990385741927, - -93.77065830212739, - 31.47024486109391, - -19.72183059871059 + -109.76906836848089, + -91.60388970860063, + 28.057909186627626, + -18.87138570625826 ], "moduleForcesY": [ - 23.807930537003042, - 66.15966523066265, - 109.83338652042386, - 113.0865344229725 + 28.563607965062683, + 68.5617497423252, + 110.07521153624224, + 112.87874340021123 ], - "timestamp": 9.058295486869088 + "timestamp": 9.28372378558993 }, { - "x": 15.057713599974441, - "y": 2.758409518264657, - "heading": 2.1346911830057307, - "angularVelocity": -1.19847821268423, - "velocityX": -2.271997076217241, - "velocityY": 2.7196894574022785, + "x": 15.051627946447192, + "y": 2.757792536125906, + "heading": 2.111350366896993, + "angularVelocity": -0.7524587464672408, + "velocityX": -2.226348823013889, + "velocityY": 2.707402133469893, "moduleForcesX": [ - -111.33690202203812, - -94.29329121436452, - 20.64874218877548, - -23.524890313415185 + -110.18950347500598, + -94.4259270542439, + 14.699834174267496, + -25.62143661919158 ], "moduleForcesY": [ - 21.14398791701492, - 64.60956935693724, - 111.26982412256345, - 111.83418988380888 + 18.184454461784757, + 62.64193597534585, + 109.9317151220563, + 110.2619692224848 ], - "timestamp": 9.10651718796053 + "timestamp": 9.332676827547235 }, { - "x": 14.939123021885464, - "y": 2.9015305147589396, - "heading": 2.118515084109538, - "angularVelocity": -0.33545268064100403, - "velocityX": -2.459278196430613, - "velocityY": 2.9679790064412654, + "x": 14.932668002427238, + "y": 2.8984574184284, + "heading": 2.110069243770664, + "angularVelocity": -0.02617044978437293, + "velocityX": -2.430082774514228, + "velocityY": 2.8734656045941884, "moduleForcesX": [ - -109.90734646465863, - -95.44964108875479, - 12.323649647426928, - -27.56680498190866 + -92.36401865218923, + -91.86525255334118, + -13.775378324438481, + -38.39021742122913 ], "moduleForcesY": [ - 14.22484679740834, - 60.09889909493547, - 108.94658536069632, - 109.19219744802825 + -7.300594232715907, + 39.18020348444654, + 72.06842144476734, + 88.73734095010511 ], - "timestamp": 9.15473888905197 + "timestamp": 9.381629869504541 }, { - "x": 14.831414608923223, - "y": 3.042823929898297, - "heading": 2.079454334080419, - "angularVelocity": -0.810024307418132, - "velocityX": -2.2336087388953505, - "velocityY": 2.9300794443445275, + "x": 14.823742433714235, + "y": 3.0397405651206304, + "heading": 2.0918846184637117, + "angularVelocity": -0.37147079282243645, + "velocityX": -2.2251031673879456, + "velocityY": 2.886095348476168, "moduleForcesX": [ - 78.58895661845102, - 86.9590857830952, - 44.49000954099232, - 55.78006427224323 + 66.0958843630111, + 75.77307715908528, + 41.70517572547554, + 54.2660783742387 ], "moduleForcesY": [ - 25.485604518307493, - -12.094864031659714, - -7.044135345916485, - -50.98884566344755 + 27.97723606877112, + 0.7831305877592326, + 9.942344895823817, + -24.048273238894506 ], - "timestamp": 9.20296059014341 + "timestamp": 9.430582911461848 }, { - "x": 14.733793356735978, - "y": 3.1721894754099615, - "heading": 2.0031780174103724, - "angularVelocity": -1.5817840296717673, - "velocityX": -2.024425724885401, - "velocityY": 2.682724636079386, + "x": 14.72599195439228, + "y": 3.1702342553440688, + "heading": 2.0336869133387605, + "angularVelocity": -1.1888475730620756, + "velocityX": -1.9968213498878276, + "velocityY": 2.665691140060036, "moduleForcesX": [ - 111.37255677304942, - 95.99744403653128, - 7.645693964257517, - 31.382888958151483 + 111.27282203862381, + 101.22591211394963, + 14.318118907425358, + 38.061187531246006 ], "moduleForcesY": [ - -13.253824008375226, - -60.24311649694943, - -109.35760318563327, - -108.50694531086866 + 4.4785198846546805, + -49.58576299828389, + -105.25159638909281, + -105.37871989926775 ], - "timestamp": 9.251182291234851 + "timestamp": 9.479535953419154 }, { - "x": 14.645878240653719, - "y": 3.288248837696076, - "heading": 1.8939909192803934, - "angularVelocity": -2.2642730484130293, - "velocityX": -1.8231442295150284, - "velocityY": 2.4067869788756644, + "x": 14.638748196164602, + "y": 3.2878829961076765, + "heading": 1.9394014366639316, + "angularVelocity": -1.926039177648179, + "velocityX": -1.78219278598079, + "velocityY": 2.4032978556606244, "moduleForcesX": [ - 109.70942329970316, - 89.71754326673916, - 12.019633647312192, - 25.644712508023197 + 111.93956922977851, + 94.27122591142299, + 13.09747450250458, + 29.72774244507937 ], "moduleForcesY": [ - -30.590752966210594, - -71.02373862357852, - -112.0983625887034, - -111.31663378024953 + -18.973143563334187, + -64.43873357870562, + -111.06555752369113, + -109.98053661348601 ], - "timestamp": 9.299403992326292 + "timestamp": 9.52848899537646 }, { - "x": 14.567227788945956, - "y": 3.3902029354711787, - "heading": 1.7550450964686277, - "angularVelocity": -2.881396128027259, - "velocityX": -1.631017776801797, - "velocityY": 2.1142783325244223, + "x": 14.561389703577776, + "y": 3.3914450724763703, + "heading": 1.8130509208960486, + "angularVelocity": -2.5810554506107266, + "velocityX": -1.5802591523046463, + "velocityY": 2.115539141839674, "moduleForcesX": [ - 107.14229823866029, - 83.56953629253546, - 16.512015162582642, - 19.08365462270342 + 108.89813742754394, + 86.94044286405637, + 15.945707139726329, + 22.521649867339463 ], "moduleForcesY": [ - -40.388808530169484, - -78.71040904165837, - -112.40665921116027, - -113.04273071952844 + -34.72614750544731, + -74.77427759019352, + -112.13240268428117, + -112.25694546017392 ], - "timestamp": 9.347625693417733 + "timestamp": 9.577442037333766 }, { - "x": 14.49719619180086, - "y": 3.4776074509889465, - "heading": 1.5874267428579882, - "angularVelocity": -3.475994206276373, - "velocityX": -1.4522838381893535, - "velocityY": 1.812555624116751, + "x": 14.493202146414575, + "y": 3.4801843218782924, + "heading": 1.6568085525977703, + "angularVelocity": -3.1916784340907887, + "velocityX": -1.392917670422911, + "velocityY": 1.8127422902937624, "moduleForcesX": [ - 106.14720313378764, - 77.64221219396602, - 18.40490708195517, - 8.33801716568237 + 106.45822211595201, + 80.10960219573016, + 17.65679408253046, + 13.149875929102251 ], "moduleForcesY": [ - -43.736432029436294, - -84.81783816234795, - -112.32150159790282, - -114.52616360787027 + -42.63111245871026, + -82.37686544045971, + -112.34316617829377, + -113.98755478600889 ], - "timestamp": 9.395847394509174 + "timestamp": 9.626395079291072 }, { - "x": 14.436617373792393, - "y": 3.5501556245447876, - "heading": 1.3983005141839007, - "angularVelocity": -3.9220148686885814, - "velocityX": -1.2562563459466622, - "velocityY": 1.5044714705993272, + "x": 14.433222849775504, + "y": 3.5537494938016434, + "heading": 1.4705951628332716, + "angularVelocity": -3.803918659986439, + "velocityX": -1.2252414608224262, + "velocityY": 1.502770185148768, "moduleForcesX": [ - 101.15910205833607, - 70.91594042910839, - 49.12014885114002, - 9.707383087632545 + 106.15263304237581, + 73.3443765179212, + 17.473283255487672, + -2.41364200971868 ], "moduleForcesY": [ - -54.64864966949359, - -90.63705631390815, - -103.10697098452282, - -114.50246275576043 + -43.97011401143013, + -88.63358939438082, + -112.21755339050702, + -114.84297204095257 ], - "timestamp": 9.444069095600614 + "timestamp": 9.675348121248378 }, { - "x": 14.387392259795076, - "y": 3.6078010779952034, - "heading": 1.2154463058080842, - "angularVelocity": -3.7919485260189636, - "velocityX": -1.0208083266074082, - "velocityY": 1.1954255479520526, + "x": 14.384281474280659, + "y": 3.6117067421179105, + "heading": 1.27402659735858, + "angularVelocity": -4.015451494232434, + "velocityX": -0.9997616805356296, + "velocityY": 1.1839355841171237, "moduleForcesX": [ - 54.314455652099966, - 71.44382936842365, - 69.05779006643577, - 82.5202984339565 + 86.3744676805752, + 67.41409192129979, + 66.76192995299246, + 41.0763147581172 ], "moduleForcesY": [ - -101.45774094468416, - -90.14981383751505, - -92.14633676825393, - -80.27412481999961 + -75.94459361481906, + -93.25513893468546, + -93.38866768134871, + -107.35908537611219 ], - "timestamp": 9.492290796692055 + "timestamp": 9.724301163205684 }, { - "x": 14.349211618513907, - "y": 3.651400600452789, - "heading": 1.0506438733831094, - "angularVelocity": -3.4175988962410613, - "velocityX": -0.7917730071108346, - "velocityY": 0.9041473334777183, + "x": 14.346752541400093, + "y": 3.654620410688194, + "heading": 1.0910815045741515, + "angularVelocity": -3.737154739923585, + "velocityX": -0.7666312731561086, + "velocityY": 0.8766292521816487, "moduleForcesX": [ - 18.55584251040697, - 90.7960685839383, - 63.853520232036196, - 96.57736445012137 + 32.49392465624227, + 80.55920555280773, + 65.3512771133556, + 92.09950834270302 ], "moduleForcesY": [ - -113.64992224377941, - -70.53849669010278, - -95.98904481306886, - -62.92180680397959 + -110.42446436365066, + -82.02909062557538, + -94.9088970754182, + -69.20864919843588 ], - "timestamp": 9.540512497783496 + "timestamp": 9.77325420516299 }, { - "x": 14.32169543229896, - "y": 3.682483763115444, - "heading": 0.9151656588315976, - "angularVelocity": -2.8094864238532335, - "velocityX": -0.5706183231232216, - "velocityY": 0.6445886801818389, + "x": 14.320188407757405, + "y": 3.6843861833792286, + "heading": 0.9370514938584996, + "angularVelocity": -3.146484969207519, + "velocityX": -0.5426452081556838, + "velocityY": 0.6080474573529125, "moduleForcesX": [ - -6.332456186499789, - 110.7185031174238, - 57.28231604872361, - 98.83176021702745 + -5.385270543258571, + 108.75425048231756, + 57.78740711133415, + 98.73724209082938 ], "moduleForcesY": [ - -115.02092054012307, - -31.162381403626863, - -100.11057776943015, - -59.44262986998 + -115.0420177801382, + -37.2349168657311, + -99.80030517652864, + -59.5613318859354 ], - "timestamp": 9.588734198874937 + "timestamp": 9.822207247120296 }, { - "x": 14.304035283172022, - "y": 3.7023940350495996, - "heading": 0.8190216834517414, - "angularVelocity": -1.9937906213126355, - "velocityX": -0.3662282484280051, - "velocityY": 0.4128902855666648, + "x": 14.303469101351862, + "y": 3.703097894493808, + "heading": 0.8266449121513226, + "angularVelocity": -2.2553569153774875, + "velocityX": -0.3415376396905139, + "velocityY": 0.3822379645701155, "moduleForcesX": [ - -24.884078394615464, - 115.10010865685537, - 51.72593444923851, - 98.81097200345768 + -31.6917140615662, + 114.57748285872601, + 51.062756198166554, + 99.39891925787309 ], "moduleForcesY": [ - -112.50306629791396, - 2.2494262109702245, - -103.12309638155044, - -59.542919825583255 + -110.7628666047164, + 10.74305716248206, + -103.44652639596045, + -58.54303770810003 ], - "timestamp": 9.636955899966377 + "timestamp": 9.871160289077602 }, { "x": 14.295448303222656, "y": 3.712002992630005, - "heading": 0.7688022564378523, - "angularVelocity": -1.0414279437936045, - "velocityX": -0.17807293718407954, - "velocityY": 0.19926625073189186, + "heading": 0.7688022564378524, + "angularVelocity": -1.1815947160937619, + "velocityX": -0.1638467765895081, + "velocityY": 0.18191102693290262, "moduleForcesX": [ - -38.582698455325584, - 113.1869774052545, - 48.251824048408935, - 98.7737574928677 + -49.71533486003576, + 109.59554076263647, + 46.816698420140504, + 99.47986509579346 ], "moduleForcesY": [ - -108.59855539761742, - 21.4261400418289, - -104.81345448783509, - -59.64383290029868 + -103.9680438500685, + 35.442271926549225, + -105.4606645383995, + -58.45523278739201 ], - "timestamp": 9.685177601057818 + "timestamp": 9.920113331034909 }, { "x": 14.295448303222656, "y": 3.712002992630005, "heading": 0.7688022564378523, - "angularVelocity": 5.898913315314164e-24, - "velocityX": 1.6143876828462686e-23, - "velocityY": -7.539437488938966e-24, + "angularVelocity": -5.838715201828975e-18, + "velocityX": 3.298801988973473e-17, + "velocityY": -5.0573065053666e-17, "moduleForcesX": [ - -47.48175193227343, - 110.17194913173417, - 47.45736232942377, - 99.60618042375738 + -60.020043156793854, + 103.80869334005449, + 45.863956482431625, + 100.46070860174449 ], "moduleForcesY": [ - -105.04769902960695, - 33.78870027617788, - -105.1895227540307, - -58.26901613919841 + -98.42521384623716, + 50.03039404179523, + -105.89459694294194, + -56.78405771323294 ], - "timestamp": 9.733399302149259 + "timestamp": 9.969066372992215 } ], "eventMarkers": [ @@ -3183,7 +3225,7 @@ } }, { - "timestamp": 4.411219951795512, + "timestamp": 4.524495592990685, "command": { "type": "named", "data": { @@ -3192,7 +3234,7 @@ } }, { - "timestamp": 7.772599897886376, + "timestamp": 7.9618738652359164, "command": { "type": "named", "data": {