From 9b51818f2e93b5c440b6baa604bb4ce3ce1400aa Mon Sep 17 00:00:00 2001 From: Mihir Patankar Date: Fri, 12 Apr 2024 23:58:22 -0400 Subject: [PATCH] adjust autos (from drive practice yesterday) --- ChoreoProject.chor | 6309 +++++++++-------- src/main/deploy/choreo/3PieceAmpSide.1.traj | 1114 +-- src/main/deploy/choreo/3PieceAmpSide.2.traj | 416 +- src/main/deploy/choreo/3PieceAmpSide.3.traj | 590 +- src/main/deploy/choreo/3PieceAmpSide.4.traj | 588 +- src/main/deploy/choreo/3PieceAmpSide.traj | 2698 +++---- .../choreo/3PieceSourceSideLower.1.traj | 984 +-- .../choreo/3PieceSourceSideLower.2.traj | 786 +- .../choreo/3PieceSourceSideLower.3.traj | 950 +-- .../choreo/3PieceSourceSideLower.4.traj | 804 ++- .../deploy/choreo/3PieceSourceSideLower.traj | 3514 ++++----- 11 files changed, 9438 insertions(+), 9315 deletions(-) diff --git a/ChoreoProject.chor b/ChoreoProject.chor index f6909af..86cb47b 100644 --- a/ChoreoProject.chor +++ b/ChoreoProject.chor @@ -81,7 +81,7 @@ { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, + "heading": -0.4182234468320189, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, @@ -90,10 +90,10 @@ { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.1882215588380072, + "heading": -0.2551830834264048, "isInitialGuess": false, "translationConstrained": true, - "headingConstrained": false, + "headingConstrained": true, "controlIntervalCount": 18 }, { @@ -111,1414 +111,1414 @@ "x": 0.660783052444458, "y": 6.694385051727295, "heading": 1.0498621745809171, - "angularVelocity": 2.975965783776085e-24, - "velocityX": -7.418307455922956e-25, - "velocityY": -5.74149655283962e-25, + "angularVelocity": 5.036142496978594e-25, + "velocityX": 4.0909648611784826e-25, + "velocityY": -1.2650073502903171e-25, "timestamp": 0 }, { - "x": 0.6757749956355112, - "y": 6.7030690975147875, - "heading": 1.049862156272713, - "angularVelocity": -2.7160773495894344e-7, - "velocityX": 0.2224100034263669, - "velocityY": 0.12883044104006075, - "timestamp": 0.06740678458744168 - }, - { - "x": 0.7057588818438879, - "y": 6.720437189007701, - "heading": 1.0498621183971346, - "angularVelocity": -5.618956424511116e-7, - "velocityX": 0.44482000427539625, - "velocityY": 0.25766088086256306, - "timestamp": 0.13481356917488335 - }, - { - "x": 0.7507347108263656, - "y": 6.746489326091134, - "heading": 1.0498620591913437, - "angularVelocity": -8.783357826024073e-7, - "velocityX": 0.6672300015161533, - "velocityY": 0.3864913189804834, - "timestamp": 0.20222035376232503 - }, - { - "x": 0.8107024822181115, - "y": 6.781225508592738, - "heading": 1.0498619760110848, - "angularVelocity": -0.0000012340042572456138, - "velocityX": 0.889639993344503, - "velocityY": 0.5153217545415306, - "timestamp": 0.2696271383497667 - }, - { - "x": 0.8856621954110708, - "y": 6.82464573622526, - "heading": 1.0498618644492663, - "angularVelocity": -0.0000016550532570780867, - "velocityX": 1.1120499761521767, - "velocityY": 0.6441521858411218, - "timestamp": 0.33703392293720835 - }, - { - "x": 0.9756138491891349, - "y": 6.876750008414199, - "heading": 1.049861715691714, - "angularVelocity": -0.0000022068631981896758, - "velocityX": 1.3344599409185074, - "velocityY": 0.7729826086177988, - "timestamp": 0.40444070752465 - }, - { - "x": 1.080557439903982, - "y": 6.937538323436046, - "heading": 1.0498615032959615, - "angularVelocity": -0.000003150955112011347, - "velocityX": 1.5568698515608894, - "velocityY": 0.9018130058257152, - "timestamp": 0.47184749211209165 - }, - { - "x": 1.1972134624219284, - "y": 7.00511102725867, - "heading": 1.0334113148085255, - "angularVelocity": -0.2440435126540754, - "velocityX": 1.7306273134363406, - "velocityY": 1.002461461946278, - "timestamp": 0.5392542766995333 - }, - { - "x": 1.3138694823179202, - "y": 7.072683735607794, - "heading": 0.9724412548974013, - "angularVelocity": -0.9045092461283692, - "velocityX": 1.7306272745388522, - "velocityY": 1.0024615290982395, - "timestamp": 0.606661061286975 - }, - { - "x": 1.430525502226175, - "y": 7.140256443935745, - "heading": 0.8706390523679578, - "angularVelocity": -1.5102664094203053, - "velocityX": 1.7306272747207776, - "velocityY": 1.0024615287841676, - "timestamp": 0.6740678458744166 - }, - { - "x": 1.547181522136343, - "y": 7.207829152260394, - "heading": 0.7338713337275233, - "angularVelocity": -2.0289903972947423, - "velocityX": 1.7306272747491633, - "velocityY": 1.0024615287351624, - "timestamp": 0.7414746304618582 - }, - { - "x": 1.6638375420295233, - "y": 7.27540186061437, - "heading": 0.5723504105376668, - "angularVelocity": -2.396211659975084, - "velocityX": 1.730627274497144, - "velocityY": 1.0024615291702423, - "timestamp": 0.8088814150492999 - }, - { - "x": 1.780493561897231, - "y": 7.342974569012322, - "heading": 0.4041720655827993, - "angularVelocity": -2.4949765217876934, - "velocityX": 1.7306272741192532, - "velocityY": 1.0024615298226245, - "timestamp": 0.8762881996367415 - }, - { - "x": 1.8971495817456219, - "y": 7.41054727744362, - "heading": 0.25128074546081974, - "angularVelocity": -2.26818889311721, - "velocityX": 1.730627273832679, - "velocityY": 1.0024615303173605, - "timestamp": 0.9436949842241832 - }, - { - "x": 2.013805601595548, - "y": 7.47811998587227, - "heading": 0.1281466559461925, - "angularVelocity": -1.8267313931121394, - "velocityX": 1.730627273855457, - "velocityY": 1.0024615302780377, - "timestamp": 1.0111017688116248 - }, - { - "x": 2.1304616214625116, - "y": 7.545692694271506, - "heading": 0.04279406558189714, - "angularVelocity": -1.2662314466813642, - "velocityX": 1.7306272741082105, - "velocityY": 1.00246152984169, - "timestamp": 1.0785085533990666 - }, - { - "x": 2.2471176982189394, - "y": 7.613265304457943, - "heading": 0.0000053749809852541795, - "angularVelocity": -0.6347831433111215, - "velocityX": 1.7306281180805858, - "velocityY": 1.0024600728251583, - "timestamp": 1.1459153379865084 - }, - { - "x": 2.365737917103605, - "y": 7.677327317867433, - "heading": 0.0000017799981215852186, - "angularVelocity": -0.00005333265613649712, - "velocityX": 1.7597667595431528, - "velocityY": 0.9503793097620272, - "timestamp": 1.2133221225739501 - }, - { - "x": 2.4915943391699567, - "y": 7.725647695571818, - "heading": 7.919893506038426e-7, - "angularVelocity": -0.000014657408405228224, - "velocityX": 1.867118018410863, - "velocityY": 0.7168473915515575, - "timestamp": 1.2807289071613919 - }, - { - "x": 2.622608453293523, - "y": 7.757428188688913, - "heading": 3.1614094305550046e-7, - "angularVelocity": -0.000007059354788405022, - "velocityX": 1.9436339372279638, - "velocityY": 0.47147321017617505, - "timestamp": 1.3481356917488336 - }, - { - "x": 2.7566164600311245, - "y": 7.772143891506238, - "heading": 8.293455771499583e-8, - "angularVelocity": -0.000003459687133392096, - "velocityX": 1.9880492380372032, - "velocityY": 0.2183118940829424, - "timestamp": 1.4155424763362754 + "x": 0.6757749919218088, + "y": 6.703069104575789, + "heading": 1.049862128706329, + "angularVelocity": -6.805633230382436e-7, + "velocityX": 0.2224099351379215, + "velocityY": 0.12883053814923912, + "timestamp": 0.06740678858637275 + }, + { + "x": 0.705758870441161, + "y": 6.720437210067111, + "heading": 1.0498620338020643, + "angularVelocity": -0.0000014079333376652512, + "velocityX": 0.4448198638173059, + "velocityY": 0.25766107324734056, + "timestamp": 0.1348135771727455 + }, + { + "x": 0.750734687393026, + "y": 6.746489367913325, + "heading": 1.049861885451002, + "angularVelocity": -0.000002200832664302106, + "velocityX": 0.6672297834547413, + "velocityY": 0.3864916040738485, + "timestamp": 0.20222036575911825 + }, + { + "x": 0.8107024418631711, + "y": 6.781225577682529, + "heading": 1.0498616770274682, + "angularVelocity": -0.000003092025867532283, + "velocityX": 0.8896396895292586, + "velocityY": 0.5153221284929648, + "timestamp": 0.269627154345491 + }, + { + "x": 0.8856621323278759, + "y": 6.82464583865489, + "heading": 1.0498613974886852, + "angularVelocity": -0.0000041470419969153815, + "velocityX": 1.1120495729989293, + "velocityY": 0.6441526422330909, + "timestamp": 0.33703394293186373 + }, + { + "x": 0.9756137557397047, + "y": 6.8767501493907295, + "heading": 1.0498610247491444, + "angularVelocity": -0.000005529703292486692, + "velocityX": 1.334459411258968, + "velocityY": 0.7729831346152221, + "timestamp": 0.40444073151823645 + }, + { + "x": 1.0805573029563829, + "y": 6.937538505571021, + "heading": 1.049860492552681, + "angularVelocity": -0.000007895294742633066, + "velocityX": 1.556869113890614, + "velocityY": 0.9018135629232547, + "timestamp": 0.4718475201046092 + }, + { + "x": 1.1972133032133725, + "y": 7.005111257740716, + "heading": 1.0334106168225663, + "angularVelocity": -0.2440388583271016, + "velocityX": 1.7306268805182825, + "velocityY": 1.0024621197182535, + "timestamp": 0.5392543086909819 + }, + { + "x": 1.3138692969010544, + "y": 7.072684021251592, + "heading": 0.9724418882550508, + "angularVelocity": -0.9044894415848371, + "velocityX": 1.7306267830606272, + "velocityY": 1.0024622879680827, + "timestamp": 0.6066610972773546 + }, + { + "x": 1.4305252906191748, + "y": 7.140256784709921, + "heading": 0.8706420088958982, + "angularVelocity": -1.5102318548926246, + "velocityX": 1.7306267835121878, + "velocityY": 1.0024622871885176, + "timestamp": 0.6740678858637273 + }, + { + "x": 1.5471812843420916, + "y": 7.207829548159968, + "heading": 0.7338773790646791, + "angularVelocity": -2.028944453509658, + "velocityX": 1.7306267835833422, + "velocityY": 1.0024622870656754, + "timestamp": 0.7414746744501001 + }, + { + "x": 1.6638372780224426, + "y": 7.2754023116835, + "heading": 0.5723600050127189, + "angularVelocity": -2.396158865289915, + "velocityX": 1.7306267829518702, + "velocityY": 1.002462288155831, + "timestamp": 0.8088814630364728 + }, + { + "x": 1.780493271638965, + "y": 7.3429750753172245, + "heading": 0.40418447555722015, + "angularVelocity": -2.4949346049916663, + "velocityX": 1.7306267820049508, + "velocityY": 1.0024622897905686, + "timestamp": 0.8762882516228455 + }, + { + "x": 1.8971492652070823, + "y": 7.410547839034513, + "heading": 0.25129496131963275, + "angularVelocity": -2.26816196771754, + "velocityX": 1.7306267812868497, + "velocityY": 1.0024622910302834, + "timestamp": 0.9436950402092182 + }, + { + "x": 2.013805258779043, + "y": 7.478120602745167, + "heading": 0.12816045902008172, + "angularVelocity": -1.8267374085292716, + "velocityX": 1.7306267813438676, + "velocityY": 1.0024622909318521, + "timestamp": 1.011101828795591 + }, + { + "x": 2.1304612523991975, + "y": 7.545693366372621, + "heading": 0.04280584220849794, + "angularVelocity": -1.266261434517286, + "velocityX": 1.7306267820588324, + "velocityY": 1.0024622896975566, + "timestamp": 1.0785086173819638 + }, + { + "x": 2.247117388567763, + "y": 7.613265883907332, + "heading": 0.000013466426965438275, + "angularVelocity": -0.6348377764162405, + "velocityX": 1.7306288968074217, + "velocityY": 1.002458638837633, + "timestamp": 1.1459154059683365 + }, + { + "x": 2.365737851453118, + "y": 7.677327455956403, + "heading": 0.000004459976492377945, + "angularVelocity": -0.00013361340396034107, + "velocityX": 1.759770274968055, + "velocityY": 0.9503727056657639, + "timestamp": 1.2133221945547092 + }, + { + "x": 2.491594313865089, + "y": 7.725647742212638, + "heading": 0.000001984433687850704, + "angularVelocity": -0.000036725422712508624, + "velocityX": 1.8671185061828453, + "velocityY": 0.7168459923634953, + "timestamp": 1.280728983141082 + }, + { + "x": 2.622608441209736, + "y": 7.7574282007435205, + "heading": 7.92136305089401e-7, + "angularVelocity": -0.00001768809058799076, + "velocityX": 1.9436340180599136, + "velocityY": 0.4714726691089775, + "timestamp": 1.3481357717274547 + }, + { + "x": 2.7566164536261604, + "y": 7.772143891629413, + "heading": 2.0780523669770732e-7, + "angularVelocity": -0.000008668727299520462, + "velocityX": 1.9880492043425424, + "velocityY": 0.2183117041251145, + "timestamp": 1.4155425603138274 }, { "x": 2.8914051055908203, "y": 7.769551753997803, - "heading": -1.0848168375526677e-23, - "angularVelocity": -0.0000012303592023056844, - "velocityX": 1.9996302506440553, - "velocityY": -0.03845514252460355, - "timestamp": 1.4829492609237171 - }, - { - "x": 2.9864482888367814, - "y": 7.767723966507321, - "heading": -4.197390937938893e-8, - "angularVelocity": -9.569459118940512e-7, - "velocityX": 2.1668504793904355, - "velocityY": -0.04167097591548553, - "timestamp": 1.526811624363163 - }, - { - "x": 3.0888261462817113, - "y": 7.765755124968672, - "heading": -7.1955269378711e-8, - "angularVelocity": -6.835327065928114e-7, - "velocityX": 2.334070702466078, - "velocityY": -0.04488680919731284, - "timestamp": 1.570673987802609 - }, - { - "x": 3.1985386775939677, - "y": 7.763645229388232, - "heading": -8.99440850277704e-8, - "angularVelocity": -4.1011961596400926e-7, - "velocityX": 2.501290917980737, - "velocityY": -0.048102642333733917, - "timestamp": 1.614536351242055 - }, - { - "x": 3.315585882309251, - "y": 7.7613942797749305, - "heading": -9.594036346771443e-8, - "angularVelocity": -1.3670668814329107e-7, - "velocityX": 2.6685111229100227, - "velocityY": -0.05131847526658634, - "timestamp": 1.658398714681501 - }, - { - "x": 3.4399677597311125, - "y": 7.759002276142162, - "heading": -8.994411556657709e-8, - "angularVelocity": 1.3670599190158685e-7, - "velocityX": 2.8357313119612524, - "velocityY": -0.05453430789408585, - "timestamp": 1.7022610781209468 - }, - { - "x": 3.571684308698804, - "y": 7.756469218512247, - "heading": -7.195535972468811e-8, - "angularVelocity": 4.1011825244490774e-7, - "velocityX": 3.0029514745490706, - "velocityY": -0.05775014001266415, - "timestamp": 1.7461234415603928 - }, - { - "x": 3.710735526890833, - "y": 7.753795106929833, - "heading": -4.197413327831008e-8, - "angularVelocity": 6.835296617741198e-7, - "velocityX": 3.1701715842101277, - "velocityY": -0.060965971113401206, - "timestamp": 1.7899858049998387 - }, - { - "x": 3.857121407342745, - "y": 7.7509799415288505, - "heading": -5.486954628378907e-13, - "angularVelocity": 9.569385069911643e-7, - "velocityX": 3.3373915350914642, - "velocityY": -0.06418179916062534, - "timestamp": 1.8338481684392847 - }, - { - "x": 4.00874003287894, - "y": 7.748064144544636, - "heading": -4.703910632575431e-13, - "angularVelocity": 1.7852298290809937e-12, - "velocityX": 3.4566907400124736, - "velocityY": -0.06647605727501009, - "timestamp": 1.8777105318787306 - }, - { - "x": 4.160358658415212, - "y": 7.745148347560415, - "heading": -3.920667535801572e-13, - "angularVelocity": 1.7856837512018541e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 1.9215728953181765 - }, - { - "x": 4.311977283951483, - "y": 7.742232550576195, - "heading": -3.137296429210842e-13, - "angularVelocity": 1.7859755955231185e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 1.9654352587576225 - }, - { - "x": 4.463595909487755, - "y": 7.739316753591974, - "heading": -2.354583223670877e-13, - "angularVelocity": 1.7844756739521518e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 2.0092976221970686 - }, - { - "x": 4.615214535024027, - "y": 7.736400956607756, - "heading": -1.571841611983832e-13, - "angularVelocity": 1.7845404359596027e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 2.0531599856365146 - }, - { - "x": 4.7668331605602985, - "y": 7.7334851596235366, - "heading": -7.889094544923358e-14, - "angularVelocity": 1.7849748535092055e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504377, - "timestamp": 2.0970223490759605 + "heading": -8.09802518102299e-24, + "angularVelocity": -0.000003082853241575703, + "velocityX": 1.9996302270348674, + "velocityY": -0.03845514207057226, + "timestamp": 1.4829493489002001 + }, + { + "x": 2.9864482996127166, + "y": 7.767723966300088, + "heading": -1.0517201217515276e-7, + "angularVelocity": -0.0000023977731499342787, + "velocityX": 2.1668504195789944, + "velocityY": -0.04167097476524414, + "timestamp": 1.526811718523463 + }, + { + "x": 3.0888261669051587, + "y": 7.76575512457206, + "heading": -1.802948176200958e-7, + "angularVelocity": -0.0000017126937301878197, + "velocityX": 2.3340705979128114, + "velocityY": -0.04488680718663573, + "timestamp": 1.570674088146726 + }, + { + "x": 3.1985387066370827, + "y": 7.7636452288297, + "heading": -2.2536845598951497e-7, + "angularVelocity": -0.0000010276152145121185, + "velocityX": 2.5012907572995546, + "velocityY": -0.04810263924365375, + "timestamp": 1.614536457769989 + }, + { + "x": 3.315585917645001, + "y": 7.761394279095385, + "heading": -2.4039298339678027e-7, + "angularVelocity": -3.4253797814190234e-7, + "velocityX": 2.668510890160408, + "velocityY": -0.05131847079054902, + "timestamp": 1.658398827393252 + }, + { + "x": 3.4399677981836816, + "y": 7.759002275402676, + "heading": -2.2536848500409826e-7, + "angularVelocity": 3.4253731665043406e-7, + "velocityX": 2.835730983232458, + "velocityY": -0.05453430157226078, + "timestamp": 1.702261197016515 + }, + { + "x": 3.5716843453444107, + "y": 7.756469217807512, + "heading": -1.8029510454250157e-7, + "angularVelocity": 0.0000010276093345784838, + "velocityX": 3.0029510099899284, + "velocityY": -0.057750131078668464, + "timestamp": 1.7461235666397779 + }, + { + "x": 3.7107355533097754, + "y": 7.753795106421767, + "heading": -1.0517313285100412e-7, + "angularVelocity": 0.0000017126747217883014, + "velocityX": 3.1701709041186272, + "velocityY": -0.06096595803447545, + "timestamp": 1.7899859362630408 + }, + { + "x": 3.8571214046276947, + "y": 7.750979941581066, + "heading": -3.445312029122533e-12, + "angularVelocity": 0.000002397720151516781, + "velocityX": 3.337390400364549, + "velocityY": -0.06418177733854838, + "timestamp": 1.8338483058863038 + }, + { + "x": 4.008740030563312, + "y": 7.748064144589167, + "heading": -2.953693080850903e-12, + "angularVelocity": 1.1208216804044482e-11, + "velocityX": 3.456690261786607, + "velocityY": -0.06647604807818788, + "timestamp": 1.8777106755095667 + }, + { + "x": 4.160358656499413, + "y": 7.745148347597258, + "heading": -2.46204265095573e-12, + "angularVelocity": 1.1208934540541933e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9215730451328297 + }, + { + "x": 4.311977282435513, + "y": 7.742232550605349, + "heading": -1.970393895641841e-12, + "angularVelocity": 1.1208896362456744e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9654354147560926 + }, + { + "x": 4.463595908371613, + "y": 7.739316753613441, + "heading": -1.478772239262654e-12, + "angularVelocity": 1.1208278545067146e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839953, + "timestamp": 2.0092977843793554 + }, + { + "x": 4.615214534307714, + "y": 7.736400956621532, + "heading": -9.871132742331443e-13, + "angularVelocity": 1.1209129129534961e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 2.0531601540026183 + }, + { + "x": 4.766833160243814, + "y": 7.733485159629623, + "heading": -4.955367585470695e-13, + "angularVelocity": 1.120724940109933e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839952, + "timestamp": 2.0970225236258813 }, { "x": 4.91845178604126, "y": 7.730569362640381, - "heading": 5.742950127566998e-24, - "angularVelocity": 1.7986022474514431e-12, - "velocityX": 3.4566907387532364, - "velocityY": -0.06647605725079353, - "timestamp": 2.1408847125154065 - }, - { - "x": 5.071687527083371, - "y": 7.720097857990775, - "heading": 3.552307758225259e-17, - "angularVelocity": 7.99612526154235e-16, - "velocityX": 3.449285538872868, - "velocityY": -0.2357100850786492, - "timestamp": 2.185310069394438 - }, - { - "x": 5.224226446138744, - "y": 7.702133366681443, - "heading": 1.1687426346130352e-17, - "angularVelocity": -5.365325775763386e-16, - "velocityX": 3.433600307831658, - "velocityY": -0.4043747213612299, - "timestamp": 2.2297354262734697 - }, - { - "x": 5.375702981258678, - "y": 7.676722658421986, - "heading": 1.8432338772239766e-17, - "angularVelocity": 1.5182573422018895e-16, - "velocityX": 3.409686398972496, - "velocityY": -0.5719865870441906, - "timestamp": 2.2741607831525013 - }, - { - "x": 5.5270900407895756, - "y": 7.6507842121855125, - "heading": 3.519048582614132e-18, - "angularVelocity": -3.3569319949738625e-16, - "velocityX": 3.407672333237922, - "velocityY": -0.5838657932923826, - "timestamp": 2.318586140031533 - }, - { - "x": 5.678477093548375, - "y": 7.624845726424425, - "heading": 1.979250750682756e-17, - "angularVelocity": 3.6631014509556794e-16, - "velocityX": 3.407672180800267, - "velocityY": -0.5838666829782966, - "timestamp": 2.3630114969105644 - }, - { - "x": 5.829864146306661, - "y": 7.598907240660332, - "heading": 2.235165581095298e-17, - "angularVelocity": 5.760557672346472e-17, - "velocityX": 3.4076721807886727, - "velocityY": -0.5838666830459646, - "timestamp": 2.407436853789596 - }, - { - "x": 5.981251199064948, - "y": 7.5729687548962525, - "heading": 3.836313874494924e-18, - "angularVelocity": -4.167741856705319e-16, - "velocityX": 3.407672180788725, - "velocityY": -0.5838666830456585, - "timestamp": 2.4518622106686276 - }, - { - "x": 6.132638251823235, - "y": 7.547030269132175, - "heading": 3.1462079050077135e-17, - "angularVelocity": 6.218467811271862e-16, - "velocityX": 3.4076721807887362, - "velocityY": -0.5838666830455942, - "timestamp": 2.4962875675476592 - }, - { - "x": 6.284025304586505, - "y": 7.521091783397172, - "heading": 3.2166739769244493e-17, - "angularVelocity": 1.586167830118919e-17, - "velocityX": 3.407672180900869, - "velocityY": -0.5838666823911463, - "timestamp": 2.540712924426691 - }, - { - "x": 6.435412424183849, - "y": 7.495153687734749, - "heading": 4.825864229864178e-17, - "angularVelocity": 3.6222337106316937e-16, - "velocityX": 3.407673685313662, - "velocityY": -0.5838579019871705, - "timestamp": 2.5851382813057224 - }, - { - "x": 6.587407958314221, - "y": 7.473058385360328, - "heading": 2.4338261444680897e-17, - "angularVelocity": -5.384398130784151e-16, - "velocityX": 3.4213688939910836, - "velocityY": -0.4973579038337588, - "timestamp": 2.629563638184754 - }, - { - "x": 6.740303266652504, - "y": 7.458434117170091, - "heading": 6.5930603358426486e-18, - "angularVelocity": -3.9943857191878257e-16, - "velocityX": 3.4416225119949053, - "velocityY": -0.32918741047050454, - "timestamp": 2.6739889950637856 - }, - { - "x": 6.890285169623974, - "y": 7.45074846175788, - "heading": 2.2969898357742947e-18, - "angularVelocity": -9.670311735916258e-17, - "velocityX": 3.3760427266766593, - "velocityY": -0.1730015457870095, - "timestamp": 2.718414351942817 - }, - { - "x": 7.0329931824089815, - "y": 7.444992685922663, - "heading": 4.687721405017099e-19, - "angularVelocity": -4.115257194619888e-17, - "velocityX": 3.212309879098902, - "velocityY": -0.1295605987114418, - "timestamp": 2.762839708821849 - }, - { - "x": 7.168350397458885, - "y": 7.44084929349212, - "heading": 2.6761389089681093e-19, - "angularVelocity": -4.528005257897493e-18, - "velocityX": 3.046845868193575, - "velocityY": -0.09326638482216276, - "timestamp": 2.8072650657008804 + "heading": 5.035858981265476e-24, + "angularVelocity": 1.1297537338117902e-11, + "velocityX": 3.4566902586364923, + "velocityY": -0.06647604801760763, + "timestamp": 2.140884893249144 + }, + { + "x": 5.07168754119456, + "y": 7.72009798657163, + "heading": -1.2237883220746723e-17, + "angularVelocity": -2.754707452373014e-16, + "velocityX": 3.4492852675356476, + "velocityY": -0.23570715051872318, + "timestamp": 2.1853102577139336 + }, + { + "x": 5.224226523742201, + "y": 7.702133987621307, + "heading": -3.220999671007562e-17, + "angularVelocity": -4.4956555179430785e-16, + "velocityX": 3.433601150724158, + "velocityY": -0.4043635694775183, + "timestamp": 2.229735622178723 + }, + { + "x": 5.375704105653677, + "y": 7.6767294867936675, + "heading": -8.086584933587513e-18, + "angularVelocity": 5.430098788639561e-16, + "velocityX": 3.4097093796840374, + "velocityY": -0.5718467621751168, + "timestamp": 2.2741609866435124 + }, + { + "x": 5.527091031475673, + "y": 7.65079022745198, + "heading": 1.237593714278334e-17, + "angularVelocity": 4.606044840123949e-16, + "velocityX": 3.4076687416257836, + "velocityY": -0.5838839963203132, + "timestamp": 2.318586351108302 + }, + { + "x": 5.678477940102667, + "y": 7.624850867756873, + "heading": -5.299489627912929e-18, + "angularVelocity": -3.9786790685233107e-16, + "velocityX": 3.4076683545720687, + "velocityY": -0.5838862552420002, + "timestamp": 2.363011715573091 + }, + { + "x": 5.82986484872645, + "y": 7.598911508043026, + "heading": -6.861733443062272e-18, + "angularVelocity": -3.51655824113109e-17, + "velocityX": 3.4076683544997888, + "velocityY": -0.5838862556638376, + "timestamp": 2.4074370800378806 + }, + { + "x": 5.981251757350232, + "y": 7.572972148329175, + "heading": 1.300275398298883e-18, + "angularVelocity": 1.8372407158846258e-16, + "velocityX": 3.4076683544997755, + "velocityY": -0.5838862556639163, + "timestamp": 2.45186244450267 + }, + { + "x": 6.13263866597402, + "y": 7.547032788615358, + "heading": 2.03304825021732e-17, + "angularVelocity": 4.2836355611375324e-16, + "velocityX": 3.407668354499907, + "velocityY": -0.5838862556631488, + "timestamp": 2.4962878089674594 + }, + { + "x": 6.284025574629089, + "y": 7.521093429084101, + "heading": 9.540525391081043e-18, + "angularVelocity": -2.428783025456181e-16, + "velocityX": 3.407668355204027, + "velocityY": -0.5838862515537734, + "timestamp": 2.540713173432249 + }, + { + "x": 6.435412650788291, + "y": 7.495155047156986, + "heading": 3.1121659748942844e-18, + "angularVelocity": -1.4470020659857382e-16, + "velocityX": 3.407672125665691, + "velocityY": -0.5838642460136346, + "timestamp": 2.585138537897038 + }, + { + "x": 6.587408261478287, + "y": 7.473060233149462, + "heading": 4.012412418719246e-18, + "angularVelocity": 2.0264244415020296e-17, + "velocityX": 3.4213700331139205, + "velocityY": -0.49734682593400187, + "timestamp": 2.6295639023618276 + }, + { + "x": 6.740303543651052, + "y": 7.458435646449454, + "heading": -2.1084051336842118e-18, + "angularVelocity": -1.377775427669848e-16, + "velocityX": 3.4416213353510248, + "velocityY": -0.3291945238085493, + "timestamp": 2.673989266826617 + }, + { + "x": 6.890285316295548, + "y": 7.450749433084636, + "heading": -1.4822341121773416e-18, + "angularVelocity": 1.40948989157144e-17, + "velocityX": 3.3760392165914315, + "velocityY": -0.17301407557185516, + "timestamp": 2.7184146312914064 + }, + { + "x": 7.032993253879116, + "y": 7.444993241304835, + "heading": -9.121457386741735e-19, + "angularVelocity": 1.2832497387232803e-17, + "velocityX": 3.212307637828718, + "velocityY": -0.1295699393611814, + "timestamp": 2.7628399957561958 + }, + { + "x": 7.168350422821424, + "y": 7.440849530732545, + "heading": -4.3340581409719474e-19, + "angularVelocity": 1.0776274550871163e-17, + "velocityX": 3.046844310069511, + "velocityY": -0.09327353016031785, + "timestamp": 2.807265360220985 }, { "x": 7.296333312988281, "y": 7.438207149505615, - "heading": 7.559167432305897e-29, - "angularVelocity": -6.0238996273513066e-18, - "velocityX": 2.8808528399195232, - "velocityY": -0.05947378191468168, - "timestamp": 2.851690422579912 - }, - { - "x": 7.47698763720858, - "y": 7.437583087682088, - "heading": -1.531352149638582e-19, - "angularVelocity": -2.223548537046582e-18, - "velocityX": 2.6231305334964707, - "velocityY": -0.009061480433138841, - "timestamp": 2.9205601650168234 - }, - { - "x": 7.639661701569886, - "y": 7.4389085950358504, - "heading": -4.350947127069071e-19, - "angularVelocity": -4.094098333593456e-18, - "velocityX": 2.3620541997862787, - "velocityY": 0.019246585029358436, - "timestamp": 2.9894299074537347 - }, - { - "x": 7.784283052035784, - "y": 7.4413250266907465, - "heading": -6.244717594872043e-19, - "angularVelocity": -2.7497859013586165e-18, - "velocityX": 2.099925821537363, - "velocityY": 0.03508698550905259, - "timestamp": 3.058299649890646 - }, - { - "x": 7.910826913450658, - "y": 7.444284600874366, - "heading": -6.382122914459642e-19, - "angularVelocity": -1.9951478654456663e-19, - "velocityX": 1.8374377039495369, - "velocityY": 0.0429735044577886, - "timestamp": 3.1271693923275574 - }, - { - "x": 8.019285873686528, - "y": 7.44740842176458, - "heading": -6.221500958287316e-19, - "angularVelocity": 2.3322572505666016e-19, - "velocityX": 1.5748419610429636, - "velocityY": 0.04535839368175477, - "timestamp": 3.1960391347644688 - }, - { - "x": 8.109659540281728, - "y": 7.450419143488216, - "heading": -5.560566789743302e-19, - "angularVelocity": 9.596872953609165e-19, - "velocityX": 1.3122405195284144, - "velocityY": 0.0437161751605761, - "timestamp": 3.26490887720138 - }, - { - "x": 8.181950475423811, - "y": 7.453105106505567, - "heading": -4.47336306829622e-19, - "angularVelocity": 1.578637704959947e-18, - "velocityX": 1.0496762813989922, - "velocityY": 0.03900062527185011, - "timestamp": 3.3337786196382915 - }, - { - "x": 8.236162443619715, - "y": 7.455299536082291, - "heading": -3.01857697105088e-19, - "angularVelocity": 2.112373367083251e-18, - "velocityX": 0.787166704530166, - "velocityY": 0.03186347878002744, - "timestamp": 3.402648362075203 - }, - { - "x": 8.272299611573594, - "y": 7.456867665427121, - "heading": -9.747000653236463e-20, - "angularVelocity": 2.9677429207323664e-18, - "velocityX": 0.5247176288917162, - "velocityY": 0.022769496288837482, - "timestamp": 3.471518104512114 + "heading": -1.2424191874750213e-28, + "angularVelocity": 9.755818981171634e-18, + "velocityX": 2.880851777103443, + "velocityY": -0.05947911196145459, + "timestamp": 2.8516907246857746 + }, + { + "x": 7.476987619873736, + "y": 7.437582893575528, + "heading": 6.306246828045357e-19, + "angularVelocity": 9.156773444569897e-18, + "velocityX": 2.623130055966497, + "velocityY": -0.009064298112001053, + "timestamp": 2.9205604730516797 + }, + { + "x": 7.639661681076791, + "y": 7.438908313736393, + "heading": 7.717197233455447e-19, + "angularVelocity": 2.04872304504038e-18, + "velocityX": 2.362053950578807, + "velocityY": 0.019245317317299903, + "timestamp": 2.9894302214175847 + }, + { + "x": 7.78428303377631, + "y": 7.4413247257119215, + "heading": 8.357244621441239e-19, + "angularVelocity": 9.29359266725832e-19, + "velocityX": 2.0999256731873923, + "velocityY": 0.0350866967407844, + "timestamp": 3.05829996978349 + }, + { + "x": 7.91082689918953, + "y": 7.4442843222063875, + "heading": 7.220816869988264e-19, + "angularVelocity": -1.6501116644010886e-18, + "velocityX": 1.8374376038212434, + "velocityY": 0.042973824715339615, + "timestamp": 3.127169718149395 + }, + { + "x": 8.019285863587411, + "y": 7.447408189663725, + "heading": 5.712912024628398e-19, + "angularVelocity": -2.1895024749108468e-18, + "velocityX": 1.5748418858979918, + "velocityY": 0.04535906593908385, + "timestamp": 3.1960394665153 + }, + { + "x": 8.109659533807191, + "y": 7.450418969222921, + "heading": 4.341547519848611e-19, + "angularVelocity": -1.9912436692380873e-18, + "velocityX": 1.312240459187152, + "velocityY": 0.04371701117883307, + "timestamp": 3.264909214881205 + }, + { + "x": 8.181950471768632, + "y": 7.4531049914429115, + "heading": 2.769074151229353e-19, + "angularVelocity": -2.283257025771601e-18, + "velocityX": 1.0496762319699213, + "velocityY": 0.03900148154629361, + "timestamp": 3.33377896324711 + }, + { + "x": 8.236162441930201, + "y": 7.455299473800812, + "heading": 8.002361823653196e-20, + "angularVelocity": -2.858784902160653e-18, + "velocityX": 0.7871666653047966, + "velocityY": 0.03186424242820522, + "timestamp": 3.4026487116130153 + }, + { + "x": 8.27229961106123, + "y": 7.456867643223532, + "heading": 9.595707199020635e-21, + "angularVelocity": -1.0226247759898425e-18, + "velocityX": 0.5247176008111963, + "velocityY": 0.02277007626611394, + "timestamp": 3.4715184599789204 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1045131718008824e-26, - "angularVelocity": 1.4152803834514588e-18, - "velocityX": 0.26232944363751326, - "velocityY": 0.012061606851017839, - "timestamp": 3.5403878469490255 + "heading": -2.737879233354451e-29, + "angularVelocity": -1.3933123630808857e-19, + "velocityX": 0.26232942849316815, + "velocityY": 0.012061928212380262, + "timestamp": 3.5403882083448255 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1306207039452228e-26, - "angularVelocity": -3.8332378282330285e-27, - "velocityX": -4.271268903147259e-26, - "velocityY": 9.33461667545086e-25, - "timestamp": 3.609257589385937 - }, - { - "x": 8.25852915676906, - "y": 7.450262882472062, - "heading": 0.0018141392967689516, - "angularVelocity": 0.019588444800635294, - "velocityX": -0.3437650196234689, - "velocityY": -0.08028553880386623, - "timestamp": 3.701870316696995 - }, - { - "x": 8.194855122144773, - "y": 7.435392004605689, - "heading": 0.005442043995568049, - "angularVelocity": 0.03917285241599744, - "velocityX": -0.6875300671194481, - "velocityY": -0.1605705640913233, - "timestamp": 3.794483044008053 - }, - { - "x": 8.099344051833308, - "y": 7.4130857844004225, - "heading": 0.01088220163958325, - "angularVelocity": 0.05874092904902104, - "velocityX": -1.0312952990863984, - "velocityY": -0.24085480314543678, - "timestamp": 3.8870957713191108 - }, - { - "x": 7.971995914574251, - "y": 7.383344320455178, - "heading": 0.01813202895682406, - "angularVelocity": 0.0782811124100776, - "velocityX": -1.3750608685924206, - "velocityY": -0.32113797756275486, - "timestamp": 3.9797084986301687 - }, - { - "x": 7.812810665453445, - "y": 7.3461677377771615, - "heading": 0.027187966537864438, - "angularVelocity": 0.09778286250683688, - "velocityX": -1.7188269230658824, - "velocityY": -0.40141980219577883, - "timestamp": 4.072321225941227 - }, - { - "x": 7.621788246652196, - "y": 7.301556188492674, - "heading": 0.038045600726663804, - "angularVelocity": 0.11723695548163543, - "velocityX": -2.0625936018454802, - "velocityY": -0.4816999842219491, - "timestamp": 4.1649339532522855 - }, - { - "x": 7.3989285885055995, - "y": 7.24950985264102, - "heading": 0.05069981285452632, - "angularVelocity": 0.13663577885316824, - "velocityX": -2.4063610328424803, - "velocityY": -0.5619782222463336, - "timestamp": 4.257546680563344 - }, - { - "x": 7.144231611178116, - "y": 7.1900289391025325, - "heading": 0.06514495528961611, - "angularVelocity": 0.15597362106152987, - "velocityX": -2.7501293258758435, - "velocityY": -0.6422542048536093, - "timestamp": 4.350159407874402 - }, - { - "x": 6.857697229070099, - "y": 7.12311368717437, - "heading": 0.08137504890112211, - "angularVelocity": 0.17524690269614907, - "velocityX": -3.0938985431843946, - "velocityY": -0.7225276036134316, - "timestamp": 4.442772135185461 - }, - { - "x": 6.545887160996467, - "y": 7.050327089936167, - "heading": 0.08137505141561512, - "angularVelocity": 2.71506205393572e-8, - "velocityX": -3.366816604227146, - "velocityY": -0.785924347025588, - "timestamp": 4.535384862496519 - }, - { - "x": 6.234077092414379, - "y": 6.9775404948760125, - "heading": 0.08137505393005692, - "angularVelocity": 2.7150067532220807e-8, - "velocityX": -3.3668166097172856, - "velocityY": -0.7859243235077903, - "timestamp": 4.627997589807578 - }, - { - "x": 5.922267023832287, - "y": 6.9047538998158755, - "heading": 0.08137505644449868, - "angularVelocity": 2.715006702984009e-8, - "velocityX": -3.3668166097173295, - "velocityY": -0.7859243235076002, - "timestamp": 4.720610317118636 - }, - { - "x": 5.610456955250197, - "y": 6.831967304755725, - "heading": 0.08137505895894045, - "angularVelocity": 2.71500672556719e-8, - "velocityX": -3.366816609717297, - "velocityY": -0.7859243235077401, - "timestamp": 4.813223044429694 - }, - { - "x": 5.298646887042485, - "y": 6.75918070809191, - "heading": 0.08137506147343254, - "angularVelocity": 2.715061065119022e-8, - "velocityX": -3.366816605674904, - "velocityY": -0.7859243408235568, - "timestamp": 4.905835771740753 - }, - { - "x": 5.012107215632439, - "y": 6.692280233597882, - "heading": 0.09728582681634514, - "angularVelocity": 0.17179890717906565, - "velocityX": -3.0939556552270235, - "velocityY": -0.7223680420222418, - "timestamp": 4.998448499051811 - }, - { - "x": 4.757405114771201, - "y": 6.6328136487695275, - "heading": 0.11142133507965439, - "angularVelocity": 0.15263029902825728, - "velocityX": -2.7501846480103254, - "velocityY": -0.6420994884280228, - "timestamp": 5.09106122636287 - }, - { - "x": 4.53454065727504, - "y": 6.5807807676396815, - "heading": 0.12378505010124977, - "angularVelocity": 0.13349909219355338, - "velocityX": -2.406412854548884, - "velocityY": -0.5618329428425411, - "timestamp": 5.183673953673928 - }, - { - "x": 4.343513899404853, - "y": 6.5361814286666275, - "heading": 0.1343795579504313, - "angularVelocity": 0.11439580883519145, - "velocityX": -2.062640453601866, - "velocityY": -0.48156814152830624, - "timestamp": 5.276286680984986 - }, - { - "x": 4.184324884988457, - "y": 6.499015496112839, - "heading": 0.14320671190518078, - "angularVelocity": 0.09531253652753087, - "velocityX": -1.7188675794173347, - "velocityY": -0.4013048058606475, - "timestamp": 5.368899408296045 - }, - { - "x": 4.056973646858879, - "y": 6.4692828606598525, - "heading": 0.150267758880007, - "angularVelocity": 0.07624272796880596, - "velocityX": -1.3750943507132014, - "velocityY": -0.32104265057569514, - "timestamp": 5.461512135607103 - }, - { - "x": 3.9614602077127334, - "y": 6.4469834398128185, - "heading": 0.15556344152537638, - "angularVelocity": 0.057180938291372996, - "velocityX": -1.0313208769389124, - "velocityY": -0.240781386041431, - "timestamp": 5.554124862918162 - }, - { - "x": 3.897784580685345, - "y": 6.432117178185927, - "heading": 0.15909407498952677, - "angularVelocity": 0.03812255147493982, - "velocityX": -0.6875472613339806, - "velocityY": -0.16052071954387456, - "timestamp": 5.64673759022922 + "heading": -7.734690041039287e-29, + "angularVelocity": -1.1060203570884526e-28, + "velocityX": -8.232857746308476e-27, + "velocityY": 9.915594313558478e-27, + "timestamp": 3.6092579567107306 + }, + { + "x": 8.258529155042611, + "y": 7.450262882094732, + "heading": 0.0018141437015229199, + "angularVelocity": 0.019588491140668917, + "velocityX": -0.34376501683789845, + "velocityY": -0.0802855378738891, + "timestamp": 3.7018706897944167 + }, + { + "x": 8.19485511722891, + "y": 7.435392003543495, + "heading": 0.005442056461770318, + "angularVelocity": 0.03917293701902922, + "velocityX": -0.6875300587033178, + "velocityY": -0.16057056147775478, + "timestamp": 3.794483422878103 + }, + { + "x": 8.099344042603773, + "y": 7.413085782435483, + "heading": 0.010882224859340402, + "angularVelocity": 0.05874104150078671, + "velocityX": -1.0312952813824383, + "velocityY": -0.24085479788027828, + "timestamp": 3.887096155961789 + }, + { + "x": 7.9719959003584435, + "y": 7.383344317488874, + "heading": 0.018132064338159094, + "angularVelocity": 0.07828123884722897, + "velocityX": -1.3750608367237869, + "velocityY": -0.3211379683583422, + "timestamp": 3.979708889045475 + }, + { + "x": 7.8128106462112585, + "y": 7.346167733877292, + "heading": 0.027188013699287764, + "angularVelocity": 0.09778298360923647, + "velocityX": -1.7188268702030736, + "velocityY": -0.4014197872552755, + "timestamp": 4.072321622129161 + }, + { + "x": 7.621788223292644, + "y": 7.301556183975714, + "heading": 0.038045656619278445, + "angularVelocity": 0.11723704245051889, + "velocityX": -2.0625935177402037, + "velocityY": -0.481699960860308, + "timestamp": 4.164934355212847 + }, + { + "x": 7.3989285635202835, + "y": 7.24950984823631, + "heading": 0.050699870016136385, + "angularVelocity": 0.1366357840387178, + "velocityX": -2.406360900406452, + "velocityY": -0.5619781860057411, + "timestamp": 4.257547088296533 + }, + { + "x": 7.144231590225439, + "y": 7.190028936362276, + "heading": 0.06514499751032955, + "angularVelocity": 0.15597345001297352, + "velocityX": -2.750129110914985, + "velocityY": -0.6422541468491951, + "timestamp": 4.3501598213802195 + }, + { + "x": 6.857697227315765, + "y": 7.123113690113179, + "heading": 0.08137503414778206, + "angularVelocity": 0.17524627658690128, + "velocityX": -3.093898143042135, + "velocityY": -0.7225274972571053, + "timestamp": 4.442772554463906 + }, + { + "x": 6.545887160381392, + "y": 7.050327089705259, + "heading": 0.08137504044908753, + "angularVelocity": 6.803929929105723e-8, + "velocityX": -3.366816382069384, + "velocityY": -0.7859243322637903, + "timestamp": 4.535385287547592 + }, + { + "x": 6.234077092172867, + "y": 6.977540494754869, + "heading": 0.0813750467500712, + "angularVelocity": 6.80358247192299e-8, + "velocityX": -3.3668163958272355, + "velocityY": -0.7859242733352659, + "timestamp": 4.627998020631278 + }, + { + "x": 5.922267023964316, + "y": 6.904753899804592, + "heading": 0.08137505305105486, + "angularVelocity": 6.803582445105601e-8, + "velocityX": -3.3668163958275135, + "velocityY": -0.7859242733340743, + "timestamp": 4.720610753714964 + }, + { + "x": 5.610456955755783, + "y": 6.831967304854232, + "heading": 0.08137505935203854, + "angularVelocity": 6.803582480789322e-8, + "velocityX": -3.366816395827309, + "velocityY": -0.7859242733349515, + "timestamp": 4.81322348679865 + }, + { + "x": 5.298646888485436, + "y": 6.759180705885576, + "heading": 0.08137506565333762, + "angularVelocity": 6.803923039402274e-8, + "velocityX": -3.366816385697099, + "velocityY": -0.7859243167231056, + "timestamp": 4.905836219882336 + }, + { + "x": 5.012107236392116, + "y": 6.692280236782266, + "heading": 0.09728577795318676, + "angularVelocity": 0.17179832373019394, + "velocityX": -3.0939552538029402, + "velocityY": -0.7223679387893466, + "timestamp": 4.998448952966022 + }, + { + "x": 4.757405139637452, + "y": 6.632813653440834, + "heading": 0.1114212737800766, + "angularVelocity": 0.15263015523056464, + "velocityX": -2.75018443224769, + "velocityY": -0.642099432350162, + "timestamp": 5.091061686049708 + }, + { + "x": 4.534540680564304, + "y": 6.580780772308004, + "heading": 0.12378499174610678, + "angularVelocity": 0.1334991156654254, + "velocityX": -2.4064127215829467, + "velocityY": -0.561832907855257, + "timestamp": 5.1836744191333946 + }, + { + "x": 4.343513918608397, + "y": 6.536181432644826, + "heading": 0.13437950942576468, + "angularVelocity": 0.11439590785086255, + "velocityX": -2.0626403691519735, + "velocityY": -0.4815681189634867, + "timestamp": 5.276287152217081 + }, + { + "x": 4.184324899185163, + "y": 6.499015499114029, + "heading": 0.14320667584584268, + "angularVelocity": 0.0953126651828929, + "velocityX": -1.7188675263409952, + "velocityY": -0.4013047913963752, + "timestamp": 5.368899885300767 + }, + { + "x": 4.056973656080411, + "y": 6.469282862636605, + "heading": 0.15026773537457858, + "angularVelocity": 0.07624285876927316, + "velocityX": -1.3750943187226343, + "velocityY": -0.32104264162636753, + "timestamp": 5.461512618384453 + }, + { + "x": 3.9614602126260823, + "y": 6.446983440876931, + "heading": 0.1555634289688374, + "angularVelocity": 0.05718105294952869, + "velocityX": -1.0313208591740977, + "velocityY": -0.24078138088770026, + "timestamp": 5.554125351468139 + }, + { + "x": 3.8977845824113757, + "y": 6.432117178562742, + "heading": 0.15909407056957425, + "angularVelocity": 0.03812263695475346, + "velocityX": -0.6875472528941416, + "velocityY": -0.1605207169596795, + "timestamp": 5.646738084551825 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.0190635029136793, - "velocityX": -0.3437736032117534, - "velocityY": -0.08026035624657629, - "timestamp": 5.7393503175402785 + "angularVelocity": 0.019063549450541617, + "velocityX": -0.3437736004211391, + "velocityY": -0.08026035531260044, + "timestamp": 5.739350817635511 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.4674835450480263e-24, - "velocityX": -3.539044961968101e-24, - "velocityY": -4.5145885950878316e-23, - "timestamp": 5.831963044851337 - }, - { - "x": 3.8806166186713504, - "y": 6.424668213553014, - "heading": 0.1586413129313925, - "angularVelocity": -0.03571634624153653, - "velocityX": 0.2361975091798944, - "velocityY": -0.0002549437180240986, - "timestamp": 5.894071443064048 - }, - { - "x": 3.9099562715140928, - "y": 6.424636752755811, - "heading": 0.15420447411308597, - "angularVelocity": -0.07143701892151703, - "velocityX": 0.47239429267292826, - "velocityY": -0.0005065465880378765, - "timestamp": 5.956179841276759 - }, - { - "x": 3.953965706205972, - "y": 6.4245899872222205, - "heading": 0.14754993112617998, - "angularVelocity": -0.10714401237841124, - "velocityX": 0.7085907213571107, - "velocityY": -0.0007529663449016913, - "timestamp": 6.01828823948947 - }, - { - "x": 4.012644921986535, - "y": 6.424528354667972, - "heading": 0.13867953686775064, - "angularVelocity": -0.14282117255785207, - "velocityX": 0.9447871377973178, - "velocityY": -0.0009923384924064732, - "timestamp": 6.080396637702181 - }, - { - "x": 4.085993936769769, - "y": 6.424452410018094, - "heading": 0.1275959867324694, - "angularVelocity": -0.17845493450534605, - "velocityX": 1.1809838426685173, - "velocityY": -0.0012227758574291183, - "timestamp": 6.142505035914892 - }, - { - "x": 4.174012783702118, - "y": 6.424362826752711, - "heading": 0.11430261193472518, - "angularVelocity": -0.21403506096255565, - "velocityX": 1.41718108122671, - "velocityY": -0.0014423695983334034, - "timestamp": 6.204613434127603 - }, - { - "x": 4.276701506889125, - "y": 6.424260398085293, - "heading": 0.09880312708922008, - "angularVelocity": -0.24955537884622275, - "velocityX": 1.6533790299230773, - "velocityY": -0.0016491919026409437, - "timestamp": 6.266721832340314 - }, - { - "x": 4.394060156308242, - "y": 6.424146037859453, - "heading": 0.0811013325151301, - "angularVelocity": -0.285014508238714, - "velocityX": 1.8895777833004581, - "velocityY": -0.00184130051861914, - "timestamp": 6.3288302305530255 - }, - { - "x": 4.5260887819403175, - "y": 6.424020781052808, - "heading": 0.06120077232953886, - "angularVelocity": -0.32041657421972447, - "velocityX": 2.1257773414136287, - "velocityY": -0.0020167450819892417, - "timestamp": 6.390938628765737 - }, - { - "x": 4.67278742718424, - "y": 6.42388578380628, - "heading": 0.039104350634045465, - "angularVelocity": -0.35577188160314316, - "velocityX": 2.3619775982871833, - "velocityY": -0.002173574756587449, - "timestamp": 6.453047026978448 - }, - { - "x": 4.834156121702719, - "y": 6.423742323007339, - "heading": 0.01481391117601343, - "angularVelocity": -0.3910975030275518, - "velocityX": 2.598178332756533, - "velocityY": -0.002309845416548714, - "timestamp": 6.515155425191159 - }, - { - "x": 5.01019487412182, - "y": 6.423591795858401, - "heading": -0.011670204418812183, - "angularVelocity": -0.42641762397610067, - "velocityX": 2.834379206113114, - "velocityY": -0.00242361988508825, - "timestamp": 6.57726382340387 - }, - { - "x": 5.200903666238017, - "y": 6.4234357217300895, - "heading": -0.04034956205797238, - "angularVelocity": -0.46176295741742135, - "velocityX": 3.070579786376913, - "velocityY": -0.002512931146224344, - "timestamp": 6.639372221616581 - }, - { - "x": 5.406282460203223, - "y": 6.423275763679671, - "heading": -0.07122760819917923, - "angularVelocity": -0.4971637818681904, - "velocityX": 3.3067797572530786, - "velocityY": -0.002575465718348354, - "timestamp": 6.701480619829292 - }, - { - "x": 5.621011656414587, - "y": 6.423161504545189, - "heading": -0.07122761549725261, - "angularVelocity": -1.1750541962036517e-7, - "velocityX": 3.457329481851291, - "velocityY": -0.0018396728585792982, - "timestamp": 6.763589018042003 - }, - { - "x": 5.835740853133477, - "y": 6.42304819932464, - "heading": -0.07122762278700305, - "angularVelocity": -1.1737141255802722e-7, - "velocityX": 3.4573294900228966, - "velocityY": -0.0018243140027767927, - "timestamp": 6.825697416254714 - }, - { - "x": 6.050170082146955, - "y": 6.411701548446128, - "heading": -0.07122763011063167, - "angularVelocity": -1.1791688138484013e-7, - "velocityX": 3.452499745349952, - "velocityY": -0.18269108856505184, - "timestamp": 6.887805814467425 + "angularVelocity": -9.999505736171943e-25, + "velocityX": -5.156111906167998e-25, + "velocityY": -7.69774068808886e-24, + "timestamp": 5.831963550719197 + }, + { + "x": 3.8805908200661583, + "y": 6.424671235221358, + "heading": 0.15744018373663873, + "angularVelocity": -0.0550052976874839, + "velocityX": 0.23556676380826952, + "velocityY": -0.00020610376336075096, + "timestamp": 5.894128731048805 + }, + { + "x": 3.9098813602559557, + "y": 6.424646814464556, + "heading": 0.1506499345999589, + "angularVelocity": -0.10922913921711586, + "velocityX": 0.47117276961950644, + "velocityY": -0.0003928365794473002, + "timestamp": 5.956293911378412 + }, + { + "x": 3.9538212666067056, + "y": 6.424612381558881, + "heading": 0.14054735001329138, + "angularVelocity": -0.1625119485393969, + "velocityX": 0.7068250444666143, + "velocityY": -0.0005538937632522526, + "timestamp": 6.01845909170802 + }, + { + "x": 4.012413923406757, + "y": 6.424569899192806, + "heading": 0.1272024405085879, + "angularVelocity": -0.21466855615872318, + "velocityX": 0.9425317595699895, + "velocityY": -0.0006833787957962723, + "timestamp": 6.080624272037627 + }, + { + "x": 4.085663316044443, + "y": 6.4245216623134365, + "heading": 0.11069894640828985, + "angularVelocity": -0.2654781022558683, + "velocityX": 1.1783025843295045, + "velocityY": -0.0007759469065193845, + "timestamp": 6.142789452367235 + }, + { + "x": 4.173574156900502, + "y": 6.4244702509624405, + "heading": 0.09113759111571623, + "angularVelocity": -0.3146673940115171, + "velocityX": 1.414149213272517, + "velocityY": -0.0008270120141812696, + "timestamp": 6.204954632696842 + }, + { + "x": 4.276152059818016, + "y": 6.424418464281491, + "heading": 0.0686410579111913, + "angularVelocity": -0.36188318099047606, + "velocityX": 1.650086147480532, + "velocityY": -0.0008330496376791236, + "timestamp": 6.26711981302645 + }, + { + "x": 4.39340378630487, + "y": 6.424369226491044, + "heading": 0.04336192483995491, + "angularVelocity": -0.40664457075815247, + "velocityX": 1.886131848490915, + "velocityY": -0.0007920477377600693, + "timestamp": 6.329284993356057 + }, + { + "x": 4.525337595489836, + "y": 6.424325450771935, + "heading": 0.015495928724554285, + "angularVelocity": -0.4482573036489503, + "velocityX": 2.122310407296116, + "velocityY": -0.000704183899678652, + "timestamp": 6.391450173685665 + }, + { + "x": 4.671963731284715, + "y": 6.424289841531667, + "heading": -0.014694474575960468, + "angularVelocity": -0.4856481255333208, + "velocityX": 2.3586537514642383, + "velocityY": -0.0005728164879388929, + "timestamp": 6.453615354015272 + }, + { + "x": 4.833295019214238, + "y": 6.424264622086766, + "heading": -0.04683458533303072, + "angularVelocity": -0.5170114618289433, + "velocityX": 2.595203409273861, + "velocityY": -0.00040568441636908034, + "timestamp": 6.51578053434488 + }, + { + "x": 5.009347081398109, + "y": 6.424251287994793, + "heading": -0.08033775965322806, + "angularVelocity": -0.5389379415061509, + "velocityX": 2.832004367242584, + "velocityY": -0.00021449454344913397, + "timestamp": 6.577945714674487 + }, + { + "x": 5.200134146051008, + "y": 6.424251504702917, + "heading": -0.1141370339338056, + "angularVelocity": -0.5437010574306965, + "velocityX": 3.069034202769489, + "velocityY": 0.0000034860049153566075, + "timestamp": 6.640110895004095 + }, + { + "x": 5.405613054428805, + "y": 6.424281444650923, + "heading": -0.1455833954142087, + "angularVelocity": -0.5058516892200839, + "velocityX": 3.3053697791645313, + "velocityY": 0.0004816192577199728, + "timestamp": 6.702276075333702 + }, + { + "x": 5.620478420069855, + "y": 6.42365674720977, + "heading": -0.14578823417625966, + "angularVelocity": -0.003295072273013325, + "velocityX": 3.456361977907994, + "velocityY": -0.0100489926650518, + "timestamp": 6.76444125566331 + }, + { + "x": 5.8354039344878705, + "y": 6.423689815718493, + "heading": -0.1457882693852108, + "angularVelocity": -5.663773666898463e-7, + "velocityX": 3.4573295416896364, + "velocityY": 0.0005319458344337396, + "timestamp": 6.826606435992917 + }, + { + "x": 6.050013195110809, + "y": 6.4120346435837465, + "heading": -0.14578830470722368, + "angularVelocity": -5.68196097923049e-7, + "velocityX": 3.4522422276434255, + "velocityY": -0.1874871442976483, + "timestamp": 6.888771616322525 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.07122763763060004, - "angularVelocity": -1.2107812437469553e-7, - "velocityX": 3.431893533353283, - "velocityY": -0.41861352112758443, - "timestamp": 6.949914212680136 - }, - { - "x": 6.495461876785666, - "y": 6.33939114897125, - "heading": -0.07122764440367134, - "angularVelocity": -9.892307155851706e-8, - "velocityX": 3.390520591116758, - "velocityY": -0.6763880965782562, - "timestamp": 7.018382277747724 - }, - { - "x": 6.723447879429968, - "y": 6.275695179020453, - "heading": -0.07122765108654068, - "angularVelocity": -9.760564039519094e-8, - "velocityX": 3.3298151834617853, - "velocityY": -0.9303018843590676, - "timestamp": 7.086850342815312 - }, - { - "x": 6.944519208686096, - "y": 6.205139076086503, - "heading": -0.08666821845477282, - "angularVelocity": -0.2255148784033862, - "velocityX": 3.228823963958949, - "velocityY": -1.0304965222005587, - "timestamp": 7.1553184078829 - }, - { - "x": 7.1486388975511135, - "y": 6.139973659962488, - "heading": -0.10579300445072114, - "angularVelocity": -0.2793241780247401, - "velocityX": 2.981239336375635, - "velocityY": -0.9517636588632731, - "timestamp": 7.223786472950488 - }, - { - "x": 7.335725393832166, - "y": 6.080229656966579, - "heading": -0.12505884329720646, - "angularVelocity": -0.281384304163806, - "velocityX": 2.732463610536854, - "velocityY": -0.8725820269191563, - "timestamp": 7.292254538018076 - }, - { - "x": 7.5057852138832075, - "y": 6.025913583564621, - "heading": -0.14350814844977783, - "angularVelocity": -0.26945854442299977, - "velocityX": 2.483783058323149, - "velocityY": -0.7933052197158056, - "timestamp": 7.360722603085664 - }, - { - "x": 7.6588255623664905, - "y": 5.9770279139396525, - "heading": -0.16069404228282516, - "angularVelocity": -0.2510059809063169, - "velocityX": 2.2352077327175954, - "velocityY": -0.7139922762051272, - "timestamp": 7.429190668153252 - }, - { - "x": 7.794851760455932, - "y": 5.9335736928791425, - "heading": -0.17635851781824094, - "angularVelocity": -0.22878513537592668, - "velocityX": 1.986710124715299, - "velocityY": -0.6346640732086548, - "timestamp": 7.49765873322084 - }, - { - "x": 7.913867698117727, - "y": 5.89555133346312, - "heading": -0.19033378635994255, - "angularVelocity": -0.20411367734587052, - "velocityX": 1.7382693310276776, - "velocityY": -0.5553298370340779, - "timestamp": 7.566126798288428 - }, - { - "x": 8.01587629682425, - "y": 5.862960943042519, - "heading": -0.20250190574704874, - "angularVelocity": -0.1777196328696382, - "velocityX": 1.489871206464301, - "velocityY": -0.47599403296165327, - "timestamp": 7.634594863356016 - }, - { - "x": 8.100879820230139, - "y": 5.835802482072584, - "heading": -0.21277523505977824, - "angularVelocity": -0.15004556215497408, - "velocityX": 1.2415061433673837, - "velocityY": -0.39665880645416857, - "timestamp": 7.703062928423604 - }, - { - "x": 8.168880075700757, - "y": 5.814075851441944, - "heading": -0.22108585453563723, - "angularVelocity": -0.12137949959087135, - "velocityX": 0.9931674774727836, - "velocityY": -0.3173250275028427, - "timestamp": 7.771530993491192 - }, - { - "x": 8.219878547444269, - "y": 5.7977809449089115, - "heading": -0.22737935642919127, - "angularVelocity": -0.09191879290500574, - "velocityX": 0.7448504889567138, - "velocityY": -0.23799280024852099, - "timestamp": 7.83999905855878 - }, - { - "x": 8.25387648706495, - "y": 5.786917682739713, - "heading": -0.23161096372628168, - "angularVelocity": -0.061804102290801306, - "velocityX": 0.49655178055813515, - "velocityY": -0.15866173753377388, - "timestamp": 7.908467123626368 + "heading": -0.14578834092456064, + "angularVelocity": -5.825984377491133e-7, + "velocityX": 3.4312825298390877, + "velocityY": -0.42358938340430125, + "timestamp": 6.950936796652132 + }, + { + "x": 6.49569885410855, + "y": 6.338969209681391, + "heading": -0.14578837085914265, + "angularVelocity": -4.366235413031805e-7, + "velocityX": 3.389467737301255, + "velocityY": -0.6816428759355991, + "timestamp": 7.019496045412968 + }, + { + "x": 6.723883016534425, + "y": 6.274812198093867, + "heading": -0.14578840022622835, + "angularVelocity": -4.28346084046259e-7, + "velocityX": 3.328276878031172, + "velocityY": -0.9357893026414394, + "timestamp": 7.088055294173803 + }, + { + "x": 6.944379070760873, + "y": 6.204658250666653, + "heading": -0.16522808025100505, + "angularVelocity": -0.28354569771601223, + "velocityX": 3.2161387152247607, + "velocityY": -1.023260153738583, + "timestamp": 7.156614542934639 + }, + { + "x": 7.148638930902927, + "y": 6.139545447418234, + "heading": -0.19715028206546042, + "angularVelocity": -0.465614813339248, + "velocityX": 2.979318820347672, + "velocityY": -0.949730407279711, + "timestamp": 7.225173791695474 + }, + { + "x": 7.3358170328874195, + "y": 6.0798421831912135, + "heading": -0.22994658912328278, + "angularVelocity": -0.4783644460899831, + "velocityX": 2.7301655920625914, + "velocityY": -0.870827281601222, + "timestamp": 7.29373304045631 + }, + { + "x": 7.5059237430887356, + "y": 6.025569482278596, + "heading": -0.26160545834967963, + "angularVelocity": -0.4617738641920779, + "velocityX": 2.481163566927677, + "velocityY": -0.7916174971803536, + "timestamp": 7.362292289217145 + }, + { + "x": 7.658979831941821, + "y": 5.976731413281962, + "heading": -0.291240609478123, + "angularVelocity": -0.43225606557947815, + "velocityX": 2.232464497780769, + "velocityY": -0.7123483684455512, + "timestamp": 7.430851537977981 + }, + { + "x": 7.795001086268662, + "y": 5.933327606851567, + "heading": -0.3183467386103757, + "angularVelocity": -0.39536794265075353, + "velocityX": 1.9839956940214167, + "velocityY": -0.633084627018105, + "timestamp": 7.4994107867388164 + }, + { + "x": 7.91399908186447, + "y": 5.895356201186841, + "heading": -0.34259459104051004, + "angularVelocity": -0.3536773355659347, + "velocityX": 1.7356957339326504, + "velocityY": -0.5538480416724806, + "timestamp": 7.567970035499652 + }, + { + "x": 8.015982502141213, + "y": 5.862814866579216, + "heading": -0.36375111540905714, + "angularVelocity": -0.3085874590363489, + "velocityX": 1.4875224294318823, + "velocityY": -0.4746454372792861, + "timestamp": 7.6365292842604875 + }, + { + "x": 8.100958056756967, + "y": 5.835701248475415, + "heading": -0.3816420491863885, + "angularVelocity": -0.26095580247302225, + "velocityX": 1.2394469914947026, + "velocityY": -0.39547717622147305, + "timestamp": 7.705088533021323 + }, + { + "x": 8.168931078031942, + "y": 5.814013189562108, + "heading": -0.3961322011943633, + "angularVelocity": -0.211352257643937, + "velocityX": 0.9914493303754669, + "velocityY": -0.31634038157220884, + "timestamp": 7.7736477817821585 + }, + { + "x": 8.219905912133822, + "y": 5.797748853681938, + "heading": -0.4071141507461263, + "angularVelocity": -0.16018188282769613, + "velocityX": 0.7435150621282579, + "velocityY": -0.237230368974835, + "timestamp": 7.842207030542994 + }, + { + "x": 8.253886183057102, + "y": 5.786906800693844, + "heading": -0.4145013188137657, + "angularVelocity": -0.10774867288013994, + "velocityX": 0.49563365318977964, + "velocityY": -0.1581413621656758, + "timestamp": 7.91076627930383 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": -0.03113870887356968, - "velocityX": 0.24826888316598922, - "velocityY": -0.07933112088153889, - "timestamp": 7.976935188693956 + "heading": -0.4182234468320189, + "angularVelocity": -0.05429067683103692, + "velocityX": 0.2477972609352767, + "velocityY": -0.07906688591998655, + "timestamp": 7.979325528064665 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": 3.36795253902191e-24, - "velocityX": 6.840104022345504e-25, - "velocityY": -2.7903197660258634e-25, - "timestamp": 8.045403253761544 - }, - { - "x": 8.25588746118901, - "y": 5.78629800647406, - "heading": -0.23128058254556338, - "angularVelocity": 0.03826965100123797, - "velocityX": -0.23293117405014754, - "velocityY": 0.07478612947192548, - "timestamp": 8.10974636276755 - }, - { - "x": 8.225910832159517, - "y": 5.795922404411104, - "heading": -0.2264010507485791, - "angularVelocity": 0.07583612095164204, - "velocityX": -0.4658871710208216, - "velocityY": 0.14957931137808628, - "timestamp": 8.174089471773557 - }, - { - "x": 8.18094329667614, - "y": 5.810359801198624, - "heading": -0.2191564862983393, - "angularVelocity": 0.11259270125668563, - "velocityX": -0.6988710396194479, - "velocityY": 0.22438139857638179, - "timestamp": 8.238432580779564 - }, - { - "x": 8.120982799778487, - "y": 5.829610864577548, - "heading": -0.20960792096845732, - "angularVelocity": 0.14840074527624142, - "velocityX": -0.9318868457546265, - "velocityY": 0.29919386359037625, - "timestamp": 8.302775689785571 - }, - { - "x": 8.046026937871678, - "y": 5.8536763244448125, - "heading": -0.19782824103540664, - "angularVelocity": 0.18307601412220878, - "velocityX": -1.1649400077918135, - "velocityY": 0.3740176724288817, - "timestamp": 8.367118798791578 - }, - { - "x": 7.956072840637482, - "y": 5.882556928320405, - "heading": -0.18390654809481916, - "angularVelocity": 0.21636649449574452, - "velocityX": -1.398037779396045, - "velocityY": 0.44885309898369946, - "timestamp": 8.431461907797585 - }, - { - "x": 7.851117008381534, - "y": 5.916253378394258, - "heading": -0.16795492330897657, - "angularVelocity": 0.24791504532914582, - "velocityX": -1.6311899421295915, - "velocityY": 0.5236994387496536, - "timestamp": 8.495805016803592 - }, - { - "x": 7.731155087211633, - "y": 5.954766238569468, - "heading": -0.1501194492315059, - "angularVelocity": 0.2771932278840516, - "velocityX": -1.8644097716617982, - "velocityY": 0.5985545425169684, - "timestamp": 8.560148125809599 - }, - { - "x": 7.59618156695547, - "y": 5.998095789487358, - "heading": -0.13059931402796102, - "angularVelocity": 0.3033756917422545, - "velocityX": -2.0977152385278854, - "velocityY": 0.6734140079218763, - "timestamp": 8.624491234815606 - }, - { - "x": 7.446189432123703, - "y": 6.046241786918251, - "heading": -0.10968278786227058, - "angularVelocity": 0.32507795300562, - "velocityX": -2.331129737883228, - "velocityY": 0.7482696775873314, - "timestamp": 8.688834343821613 - }, - { - "x": 7.28117009063335, - "y": 6.099203028154522, - "heading": -0.08782351563109066, - "angularVelocity": 0.33972981052468115, - "velocityX": -2.5646777726414474, - "velocityY": 0.8231066551559874, - "timestamp": 8.75317745282762 - }, - { - "x": 7.101115905345124, - "y": 6.156976525213083, - "heading": -0.0658352910964324, - "angularVelocity": 0.34173394593980894, - "velocityX": -2.7983445013733177, - "velocityY": 0.8978971944480737, - "timestamp": 8.817520561833627 - }, - { - "x": 6.906047579451745, - "y": 6.219555700669507, - "heading": -0.04559053086240348, - "angularVelocity": 0.31463758196916874, - "velocityX": -3.031689467712312, - "velocityY": 0.9725855095155665, - "timestamp": 8.881863670839634 - }, - { - "x": 6.696779607755081, - "y": 6.28666337072034, - "heading": -0.03685580053222356, - "angularVelocity": 0.1357523822693175, - "velocityX": -3.2523758166103667, - "velocityY": 1.0429659226532966, - "timestamp": 8.94620677984564 - }, - { - "x": 6.481807673364994, - "y": 6.343877480354193, - "heading": -0.03685579080558635, - "angularVelocity": 1.511682814166473e-7, - "velocityX": -3.341024978603622, - "velocityY": 0.8892033741874479, - "timestamp": 9.010549888851648 + "heading": -0.4182234468320189, + "angularVelocity": 1.2149869731922202e-24, + "velocityX": 1.6200325032236621e-24, + "velocityY": -9.81678651755837e-25, + "timestamp": 8.0478847768255 + }, + { + "x": 8.255885275596246, + "y": 5.786297415399053, + "heading": -0.4161957197256105, + "angularVelocity": 0.03152694238731417, + "velocityX": -0.233058706268173, + "velocityY": 0.07480697540219873, + "timestamp": 8.112202054457356 + }, + { + "x": 8.225904877332317, + "y": 5.795920588198962, + "heading": -0.4121767719087599, + "angularVelocity": 0.06248628618665337, + "velocityX": -0.46613288633782896, + "velocityY": 0.14962033771067135, + "timestamp": 8.176519332089212 + }, + { + "x": 8.180932637466617, + "y": 5.810356062930585, + "heading": -0.4062099213750387, + "angularVelocity": 0.09277212521143607, + "velocityX": -0.6992248664987879, + "velocityY": 0.22444163159780386, + "timestamp": 8.240836609721068 + }, + { + "x": 8.120967221795235, + "y": 5.8296044401602, + "heading": -0.3983469021562322, + "angularVelocity": 0.12225360755804271, + "velocityX": -0.9323375907577511, + "velocityY": 0.29927226304244037, + "timestamp": 8.305153887352924 + }, + { + "x": 8.046007053762992, + "y": 5.853666398213901, + "heading": -0.38865015214844967, + "angularVelocity": 0.15076431038150498, + "velocityX": -1.16547482717328, + "velocityY": 0.3741134410481226, + "timestamp": 8.36947116498478 + }, + { + "x": 7.95605024235754, + "y": 5.882542674483832, + "heading": -0.37719620256520386, + "angularVelocity": 0.17808511188559348, + "velocityX": -1.398641464900824, + "velocityY": 0.44896608396916854, + "timestamp": 8.433788442616637 + }, + { + "x": 7.851094482525453, + "y": 5.916234036378714, + "heading": -0.3640809123745278, + "angularVelocity": 0.20391550565536098, + "velocityX": -1.6318439414186696, + "velocityY": 0.5238306585009168, + "timestamp": 8.498105720248493 + }, + { + "x": 7.731136916910522, + "y": 5.954741232958676, + "heading": -0.349427957292727, + "angularVelocity": 0.22782299906523523, + "velocityX": -1.8650908438872864, + "velocityY": 0.5987068793609814, + "timestamp": 8.562422997880349 + }, + { + "x": 7.596173948111591, + "y": 5.998064906716331, + "heading": -0.33340347371338613, + "angularVelocity": 0.24914741682729602, + "velocityX": -2.0983936784675863, + "velocityY": 0.6735930896459054, + "timestamp": 8.626740275512205 + }, + { + "x": 7.446201013798343, + "y": 6.046205411855825, + "heading": -0.31624349903105253, + "angularVelocity": 0.26680194364810067, + "velocityX": -2.331767447802665, + "velocityY": 0.7484848070691726, + "timestamp": 8.691057553144061 + }, + { + "x": 7.281212494788232, + "y": 6.099162371697227, + "heading": -0.2983118341454104, + "angularVelocity": 0.27880012254686504, + "velocityX": -2.56522858374831, + "velocityY": 0.82337066790236, + "timestamp": 8.755374830775917 + }, + { + "x": 7.101203008664871, + "y": 6.1569332933758485, + "heading": -0.28024668313688234, + "angularVelocity": 0.280875554340636, + "velocityX": -2.7987734050827355, + "velocityY": 0.8982177698703966, + "timestamp": 8.819692108407773 + }, + { + "x": 6.9061821193945345, + "y": 6.219506729950283, + "heading": -0.26348073873693967, + "angularVelocity": 0.26067559164908854, + "velocityX": -3.0321695266179045, + "velocityY": 0.9728868956891804, + "timestamp": 8.88400938603963 + }, + { + "x": 6.696607254404851, + "y": 6.286709539594328, + "heading": -0.25518312367209683, + "angularVelocity": 0.12901066976648753, + "velocityX": -3.258453602300528, + "velocityY": 1.0448640259419284, + "timestamp": 8.948326663671486 + }, + { + "x": 6.4817199239739445, + "y": 6.3438942094131185, + "heading": -0.2551831038227718, + "angularVelocity": 3.086157524298735e-7, + "velocityX": -3.3410513992973323, + "velocityY": 0.8891027718260752, + "timestamp": 9.012643941303342 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.03685578092347688, - "angularVelocity": 1.535845813935868e-7, - "velocityX": -3.3956733580359946, - "velocityY": 0.6500253635647798, - "timestamp": 9.074892997857654 - }, - { - "x": 6.037947373246119, - "y": 6.41213150954562, - "heading": -0.03685577219409298, - "angularVelocity": 1.3300204704480323e-7, - "velocityX": -3.4337993949471355, - "velocityY": 0.40268147161399886, - "timestamp": 9.140526453156646 - }, - { - "x": 5.811253837433788, - "y": 6.422188591577065, - "heading": -0.03685576369032069, - "angularVelocity": 1.295645985289539e-7, - "velocityX": -3.453932674725614, - "velocityY": 0.1532310311201851, - "timestamp": 9.206159908455637 - }, - { - "x": 5.5843374246066, - "y": 6.422402330529617, - "heading": -0.036855755226474385, - "angularVelocity": 1.2895628100949306e-7, - "velocityX": -3.4573284583826145, - "velocityY": 0.003256554931891515, - "timestamp": 9.271793363754629 - }, - { - "x": 5.357421124392654, - "y": 6.422695719883416, - "heading": -0.036855660140139614, - "angularVelocity": 0.0000014487479646455729, - "velocityX": -3.457326742592384, - "velocityY": 0.004470118973044206, - "timestamp": 9.33742681905362 - }, - { - "x": 5.144263768203255, - "y": 6.422952100628831, - "heading": -0.014977306551592268, - "angularVelocity": 0.3333414870340277, - "velocityX": -3.24769365285379, - "velocityY": 0.003906250924130374, - "timestamp": 9.403060274352612 - }, - { - "x": 4.9475144604587005, - "y": 6.423195621457961, - "heading": 0.008467722873920253, - "angularVelocity": 0.3572115671605153, - "velocityX": -2.997698458023694, - "velocityY": 0.003710315539856156, - "timestamp": 9.468693729651603 - }, - { - "x": 4.7671901020112575, - "y": 6.4234252651818, - "heading": 0.031563837809847756, - "angularVelocity": 0.351895459879624, - "velocityX": -2.7474457595745863, - "velocityY": 0.003498882129429363, - "timestamp": 9.534327184950595 - }, - { - "x": 4.603282473031131, - "y": 6.423639886537377, - "heading": 0.05353860692981436, - "angularVelocity": 0.33481048681439957, - "velocityX": -2.4973182995386867, - "velocityY": 0.0032699993410297092, - "timestamp": 9.599960640249586 - }, - { - "x": 4.455783456484323, - "y": 6.42383812523004, - "heading": 0.07396862253695916, - "angularVelocity": 0.31127441811613105, - "velocityX": -2.2473145117056283, - "velocityY": 0.003020390923493434, - "timestamp": 9.665594095548578 - }, - { - "x": 4.3246865966511425, - "y": 6.424018569277829, - "heading": 0.09258438097284048, - "angularVelocity": 0.28363215605635267, - "velocityX": -1.9974090840710925, - "velocityY": 0.00274926936219822, - "timestamp": 9.731227550847569 - }, - { - "x": 4.2099868313745406, - "y": 6.424179849937859, - "heading": 0.10919817149890491, - "angularVelocity": 0.2531299083734149, - "velocityX": -1.74758078413044, - "velocityY": 0.0024572934534053846, - "timestamp": 9.79686100614656 - }, - { - "x": 4.1116801359818504, - "y": 6.424320695943855, - "heading": 0.12367125117094976, - "angularVelocity": 0.2205137548543349, - "velocityX": -1.4978138046344804, - "velocityY": 0.0021459483636000858, - "timestamp": 9.862494461445552 - }, - { - "x": 4.029763255877016, - "y": 6.424439966413886, - "heading": 0.13589682908173525, - "angularVelocity": 0.18627052095752253, - "velocityX": -1.2480964125942142, - "velocityY": 0.0018172206458870563, - "timestamp": 9.928127916744543 - }, - { - "x": 3.96423352032589, - "y": 6.424536671966407, - "heading": 0.14579041449268346, - "angularVelocity": 0.15073997500022146, - "velocityX": -0.9984197122124082, - "velocityY": 0.001473418580201188, - "timestamp": 9.993761372043535 - }, - { - "x": 3.9150887131755114, - "y": 6.424609988913992, - "heading": 0.15328395817373033, - "angularVelocity": 0.11417262197929685, - "velocityX": -0.7487767774300566, - "velocityY": 0.001117066704044862, - "timestamp": 10.059394827342526 - }, - { - "x": 3.8823269815488697, - "y": 6.42465926920727, - "heading": 0.15832209310095952, - "angularVelocity": 0.07676168966387754, - "velocityX": -0.4991620733267284, - "velocityY": 0.0007508410619806591, - "timestamp": 10.125028282641518 + "heading": -0.2551830834264048, + "angularVelocity": 3.1712111825091784e-7, + "velocityX": -3.395672821911929, + "velocityY": 0.6500263273718765, + "timestamp": 9.076961218935198 + }, + { + "x": 6.037162237236338, + "y": 6.412166410916887, + "heading": -0.25518303828533845, + "angularVelocity": 6.854074958240057e-7, + "velocityX": -3.4338993409830967, + "velocityY": 0.4018251187344374, + "timestamp": 9.142821406624625 + }, + { + "x": 5.8096806134973695, + "y": 6.422145044657871, + "heading": -0.2551829940595105, + "angularVelocity": 6.715108093540807e-7, + "velocityX": -3.4540081302483707, + "velocityY": 0.15151237934575548, + "timestamp": 9.208681594314053 + }, + { + "x": 5.5819802469231306, + "y": 6.422071707013465, + "heading": -0.25518294988305257, + "angularVelocity": 6.707611912611386e-7, + "velocityX": -3.457329451412868, + "velocityY": -0.0011135353083337968, + "timestamp": 9.27454178200348 + }, + { + "x": 5.357973256918571, + "y": 6.423240614393437, + "heading": -0.2430314751768064, + "angularVelocity": 0.18450410077098406, + "velocityX": -3.4012504042790286, + "velocityY": 0.017748315347736767, + "timestamp": 9.340401969692907 + }, + { + "x": 5.144457161392198, + "y": 6.423376601690841, + "heading": -0.1958139855508891, + "angularVelocity": 0.7169352424043682, + "velocityX": -3.241960021936682, + "velocityY": 0.0020647875776692963, + "timestamp": 9.406262157382335 + }, + { + "x": 4.947462840354243, + "y": 6.423510104020051, + "heading": -0.14701489396398695, + "angularVelocity": 0.7409497801163326, + "velocityX": -2.991098688739039, + "velocityY": 0.002027056616322834, + "timestamp": 9.472122345071762 + }, + { + "x": 4.766993522305038, + "y": 6.423644398305699, + "heading": -0.09964051366094051, + "angularVelocity": 0.719317420206062, + "velocityX": -2.74018833502617, + "velocityY": 0.002039081429309675, + "timestamp": 9.53798253276119 + }, + { + "x": 4.60301308935793, + "y": 6.423783110988961, + "heading": -0.05492917751371649, + "angularVelocity": 0.6788826105091881, + "velocityX": -2.4898263837385226, + "velocityY": 0.0021061689638151486, + "timestamp": 9.603842720450617 + }, + { + "x": 4.455491999512653, + "y": 6.4239249853365035, + "heading": -0.013574200580991685, + "angularVelocity": 0.6279207269760504, + "velocityX": -2.2399129887228693, + "velocityY": 0.0021541746618076994, + "timestamp": 9.669702908140044 + }, + { + "x": 4.324407720523135, + "y": 6.424066362703545, + "heading": 0.023974314912572615, + "angularVelocity": 0.570124635396258, + "velocityX": -1.9903417161162953, + "velocityY": 0.0021466286690262756, + "timestamp": 9.735563095829471 + }, + { + "x": 4.2097428344188135, + "y": 6.424202667515828, + "heading": 0.05739701354466356, + "angularVelocity": 0.5074795533486763, + "velocityX": -1.7410349123971218, + "velocityY": 0.002069608621913246, + "timestamp": 9.801423283518899 + }, + { + "x": 4.11148358029628, + "y": 6.424329194128387, + "heading": 0.08645394614427561, + "angularVelocity": 0.4411911599255325, + "velocityX": -1.4919370498287492, + "velocityY": 0.001921139568510551, + "timestamp": 9.867283471208326 + }, + { + "x": 4.029618879443776, + "y": 6.4244415432031925, + "heading": 0.11095800828046558, + "angularVelocity": 0.3720618327378889, + "velocityX": -1.2430074028720826, + "velocityY": 0.00170587237520769, + "timestamp": 9.933143658897754 + }, + { + "x": 3.964139686055167, + "y": 6.424535880555734, + "heading": 0.13075995126873372, + "angularVelocity": 0.3006663613175029, + "velocityX": -0.994215104539091, + "velocityY": 0.0014323881520982617, + "timestamp": 9.99900384658718 + }, + { + "x": 3.91503854489554, + "y": 6.424609101274365, + "heading": 0.14573933177166642, + "angularVelocity": 0.22744211683042614, + "velocityX": -0.7455360041056982, + "velocityY": 0.0011117599448221096, + "timestamp": 10.064864034276608 + }, + { + "x": 3.882309280386553, + "y": 6.424658939920723, + "heading": 0.15579869857714623, + "angularVelocity": 0.1527382043445731, + "velocityX": -0.496950671676277, + "velocityY": 0.000756734046866559, + "timestamp": 10.130724221966036 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.038661759828822626, - "velocityX": -0.24957107255583263, - "velocityY": 0.0003775283746879617, - "timestamp": 10.19066173794051 + "angularVelocity": 0.07684307602012863, + "velocityX": -0.2484431224119383, + "velocityY": 0.0003812284649235306, + "timestamp": 10.196584409655463 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.109695162138055e-26, - "velocityX": 1.5462924583542684e-27, - "velocityY": -8.002962968658591e-26, - "timestamp": 10.2562951932395 + "angularVelocity": 3.773099570003496e-26, + "velocityX": -4.36512163919617e-27, + "velocityY": 1.07464594312406e-25, + "timestamp": 10.26244459734489 } ], "trajectoryWaypoints": [ @@ -1534,7 +1534,7 @@ "controlIntervalCount": 22 }, { - "timestamp": 1.4829492609237171, + "timestamp": 1.4829493489002001, "isStopPoint": false, "x": 2.8914051055908203, "y": 7.769551753997803, @@ -1545,7 +1545,7 @@ "controlIntervalCount": 15 }, { - "timestamp": 2.1408847125154065, + "timestamp": 2.140884893249144, "isStopPoint": false, "x": 4.91845178604126, "y": 7.730569362640381, @@ -1556,7 +1556,7 @@ "controlIntervalCount": 16 }, { - "timestamp": 2.851690422579912, + "timestamp": 2.8516907246857746, "isStopPoint": false, "x": 7.296333312988281, "y": 7.438207149505615, @@ -1567,7 +1567,7 @@ "controlIntervalCount": 11 }, { - "timestamp": 3.609257589385937, + "timestamp": 3.6092579567107306, "isStopPoint": true, "x": 8.290366172790527, "y": 7.457698345184326, @@ -1578,7 +1578,7 @@ "controlIntervalCount": 24 }, { - "timestamp": 5.831963044851337, + "timestamp": 5.831963550719197, "isStopPoint": true, "x": 3.8659467697143555, "y": 6.424684047698975, @@ -1589,7 +1589,7 @@ "controlIntervalCount": 18 }, { - "timestamp": 6.949914212680136, + "timestamp": 6.950936796652132, "isStopPoint": false, "x": 6.263319492340088, "y": 6.385702133178711, @@ -1600,29 +1600,29 @@ "controlIntervalCount": 16 }, { - "timestamp": 8.045403253761544, + "timestamp": 8.0478847768255, "isStopPoint": true, "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, + "heading": -0.4182234468320189, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, "controlIntervalCount": 16 }, { - "timestamp": 9.074892997857654, + "timestamp": 9.076961218935198, "isStopPoint": false, "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.1882215588380072, + "heading": -0.2551830834264048, "isInitialGuess": false, "translationConstrained": true, - "headingConstrained": false, + "headingConstrained": true, "controlIntervalCount": 18 }, { - "timestamp": 10.2562951932395, + "timestamp": 10.26244459734489, "isStopPoint": true, "x": 3.8659467697143555, "y": 6.424684047698975, @@ -1638,8 +1638,7 @@ "scope": [ "first" ], - "type": "StopPoint", - "direction": 0 + "type": "StopPoint" }, { "scope": [ @@ -5405,25 +5404,25 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 19 + "controlIntervalCount": 20 }, { - "x": 7.384688854217529, - "y": 2.3971612453460693, - "heading": 0, + "x": 7.432769298553467, + "y": 1.9417921304702759, + "heading": 0.5633166974965059, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 10 + "controlIntervalCount": 11 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": 0, + "heading": 0.601472494720935, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 21 + "controlIntervalCount": 23 }, { "x": 4.645580768585205, @@ -5449,1819 +5448,1855 @@ "x": 0.6476043462753296, "y": 4.391018867492676, "heading": -1.0516500181249593, - "angularVelocity": -1.0131588317285796e-24, - "velocityX": -7.195760422140643e-25, - "velocityY": 3.68543968667644e-24, + "angularVelocity": 1.4837621687026506e-24, + "velocityX": 1.2605777337321822e-24, + "velocityY": -5.078976570788486e-24, "timestamp": 0 }, { - "x": 0.6591914533996168, - "y": 4.382126456198724, - "heading": -1.040727167766298, - "angularVelocity": 0.17178522537716917, - "velocityX": 0.1822320862646183, - "velocityY": -0.1398522206309347, - "timestamp": 0.06358434105540359 - }, - { - "x": 0.6823705688244482, - "y": 4.364325443623157, - "heading": -1.0189895299826641, - "angularVelocity": 0.3418709295845801, - "velocityX": 0.364541254027222, - "velocityY": -0.27995906350677474, - "timestamp": 0.12716868211080717 - }, - { - "x": 0.7171462629990519, - "y": 4.337595981630138, - "heading": -0.9865639713670495, - "angularVelocity": 0.5099613847906508, - "velocityX": 0.5469223018966605, - "velocityY": -0.4203780608456431, - "timestamp": 0.19075302316621076 - }, - { - "x": 0.7635267836330776, - "y": 4.301915006000565, - "heading": -0.943615852299556, - "angularVelocity": 0.6754511937156207, - "velocityX": 0.7294330626720272, - "velocityY": -0.5611597924477026, - "timestamp": 0.25433736422161435 - }, - { - "x": 0.8215286683730939, - "y": 4.257255375739588, - "heading": -0.8903806097169653, - "angularVelocity": 0.8372382523584655, - "velocityX": 0.912203913373529, - "velocityY": -0.7023683743464803, - "timestamp": 0.3179217052770179 - }, - { - "x": 0.8911812541678331, - "y": 4.203582879820058, - "heading": -0.8272094806907175, - "angularVelocity": 0.9935013554863164, - "velocityX": 1.0954361504516998, - "velocityY": -0.8441149979483671, - "timestamp": 0.38150604633242147 - }, - { - "x": 0.9725299828211558, - "y": 4.140850923917802, - "heading": -0.75462709933033, - "angularVelocity": 1.1415134631519366, - "velocityX": 1.2793830572599652, - "velocityY": -0.9865944171316399, - "timestamp": 0.445090387387825 - }, - { - "x": 1.0656375296619247, - "y": 4.068994254029578, - "heading": -0.6733936884757168, - "angularVelocity": 1.2775694377933589, - "velocityX": 1.4643156679038403, - "velocityY": -1.130100095330278, - "timestamp": 0.5086747284432286 - }, - { - "x": 1.1705832794462367, - "y": 3.987925697121121, - "heading": -0.5845665618376034, - "angularVelocity": 1.396996888915067, - "velocityX": 1.6504967739284813, - "velocityY": -1.2749767562711483, - "timestamp": 0.5722590694986321 - }, - { - "x": 1.287465328455322, - "y": 3.897542804343646, - "heading": -0.48958951482473, - "angularVelocity": 1.4937175637334361, - "velocityX": 1.8382206541582515, - "velocityY": -1.4214646448678434, - "timestamp": 0.6358434105540357 - }, - { - "x": 1.416410446947234, - "y": 3.797751405129375, - "heading": -0.3905846134253379, - "angularVelocity": 1.5570642041115932, - "velocityX": 2.0279382683160483, - "velocityY": -1.5694335674143292, - "timestamp": 0.6994277516094393 - }, - { - "x": 1.5575332696620845, - "y": 3.6885069096807293, - "heading": -0.2916586370436419, - "angularVelocity": 1.5558229391022207, - "velocityX": 2.2194587593804664, - "velocityY": -1.7181037600665896, - "timestamp": 0.7630120926648428 - }, - { - "x": 1.7097613444570134, - "y": 3.570777493688783, - "heading": -0.20742198100348744, - "angularVelocity": 1.3248019031408336, - "velocityX": 2.394112642643988, - "velocityY": -1.8515473155468265, - "timestamp": 0.8265964337202464 - }, - { - "x": 1.8711613775924387, - "y": 3.448808413688974, - "heading": -0.15383975328764557, - "angularVelocity": 0.8426953370351598, - "velocityX": 2.538361339544133, - "velocityY": -1.9182251160475614, - "timestamp": 0.8901807747756499 - }, - { - "x": 2.0417383028773095, - "y": 3.3225570909899145, - "heading": -0.1305932032652052, - "angularVelocity": 0.36560180756115246, - "velocityX": 2.6826876311612624, - "velocityY": -1.985572557700191, - "timestamp": 0.9537651158310535 - }, - { - "x": 2.215389362271695, - "y": 3.1877556827532114, - "heading": -0.13059307027477257, - "angularVelocity": 0.0000020915595006631527, - "velocityX": 2.7310349767260567, - "velocityY": -2.120040972340114, - "timestamp": 1.0173494568864572 - }, - { - "x": 2.38903992841347, - "y": 3.05295363910863, - "heading": -0.13059293728967952, - "angularVelocity": 0.000002091475524120011, - "velocityX": 2.7310272192719025, - "velocityY": -2.120050965490433, - "timestamp": 1.0809337979418607 - }, - { - "x": 2.5626904945233253, - "y": 2.918151595422929, - "heading": -0.13059280430458975, - "angularVelocity": 0.000002091475473085295, - "velocityX": 2.731027218769898, - "velocityY": -2.1200509661371285, - "timestamp": 1.1445181389972643 - }, - { - "x": 2.7363410606331784, - "y": 2.7833495517372238, - "heading": -0.13059267131950322, - "angularVelocity": 0.0000020914754220002734, - "velocityX": 2.7310272187698588, - "velocityY": -2.120050966137197, - "timestamp": 1.2081024800526678 - }, - { - "x": 2.909991626743031, - "y": 2.6485475080515166, - "heading": -0.13059253833441983, - "angularVelocity": 0.0000020914753719975214, - "velocityX": 2.731027218769853, - "velocityY": -2.1200509661372235, - "timestamp": 1.2716868211080714 - }, - { - "x": 3.0836421928528828, - "y": 2.5137454643658077, - "heading": -0.13059240534933972, - "angularVelocity": 0.0000020914753210405788, - "velocityX": 2.7310272187698468, - "velocityY": -2.12005096613725, - "timestamp": 1.335271162163475 - }, - { - "x": 3.2572927589627345, - "y": 2.3789434206800975, - "heading": -0.13059227236426274, - "angularVelocity": 0.0000020914752714762697, - "velocityX": 2.73102721876984, - "velocityY": -2.1200509661372764, - "timestamp": 1.3988555032188785 - }, - { - "x": 3.4309433250725863, - "y": 2.2441413769943854, - "heading": -0.13059213937918893, - "angularVelocity": 0.000002091475221449109, - "velocityX": 2.731027218769834, - "velocityY": -2.1200509661373035, - "timestamp": 1.462439844274282 - }, - { - "x": 3.604593891182437, - "y": 2.1093393333086716, - "heading": -0.13059200639411836, - "angularVelocity": 0.000002091475170968491, - "velocityX": 2.7310272187698277, - "velocityY": -2.12005096613733, - "timestamp": 1.5260241853296856 - }, - { - "x": 3.7782444572922893, - "y": 1.9745372896229578, - "heading": -0.13059187340905104, - "angularVelocity": 0.0000020914751195693144, - "velocityX": 2.731027218769846, - "velocityY": -2.120050966137325, - "timestamp": 1.5896085263850892 - }, - { - "x": 3.951895023426439, - "y": 1.8397352459685434, - "heading": -0.13059174042398683, - "angularVelocity": 0.0000020914750705889236, - "velocityX": 2.731027219151981, - "velocityY": -2.12005096564508, - "timestamp": 1.6531928674404928 - }, - { - "x": 4.125545965030262, - "y": 1.7049336859915973, - "heading": -0.13059160743887335, - "angularVelocity": 0.0000020914758454008564, - "velocityX": 2.7310331242170753, - "velocityY": -2.1200433587805536, - "timestamp": 1.7167772084958963 - }, - { - "x": 4.303592186821453, - "y": 1.5759931847530522, - "heading": -0.13059147325010556, - "angularVelocity": 0.000002110405888729409, - "velocityX": 2.8001583225664275, - "velocityY": -2.0278656521138467, - "timestamp": 1.7803615495512999 - }, - { - "x": 4.490236730845761, - "y": 1.4598470551473188, - "heading": -0.130591333138394, - "angularVelocity": 0.000002203556870291448, - "velocityX": 2.935385362595435, - "velocityY": -1.826646744746956, - "timestamp": 1.8439458906067034 + "x": 0.6591914533996294, + "y": 4.3821264561987325, + "heading": -1.0407271677663157, + "angularVelocity": 0.1717852253768825, + "velocityX": 0.1822320862648084, + "velocityY": -0.1398522206307734, + "timestamp": 0.06358434105540607 + }, + { + "x": 0.682370568824486, + "y": 4.364325443623188, + "heading": -1.0189895299827134, + "angularVelocity": 0.341870929584073, + "velocityX": 0.36454125402760434, + "velocityY": -0.2799590635064334, + "timestamp": 0.12716868211081214 + }, + { + "x": 0.7171462629991276, + "y": 4.337595981630201, + "heading": -0.9865639713671387, + "angularVelocity": 0.509961384790003, + "velocityX": 0.5469223018972373, + "velocityY": -0.42037806084509965, + "timestamp": 0.19075302316621823 + }, + { + "x": 0.7635267836332045, + "y": 4.301915006000676, + "heading": -0.9436158522996869, + "angularVelocity": 0.6754511937149356, + "velocityX": 0.7294330626728007, + "velocityY": -0.5611597924469304, + "timestamp": 0.2543373642216243 + }, + { + "x": 0.821528668373285, + "y": 4.257255375739764, + "heading": -0.8903806097171314, + "angularVelocity": 0.8372382523578797, + "velocityX": 0.9122039133745026, + "velocityY": -0.7023683743454452, + "timestamp": 0.31792170527703034 + }, + { + "x": 0.891181254168102, + "y": 4.203582879820318, + "heading": -0.8272094806909008, + "angularVelocity": 0.9935013554860082, + "velocityX": 1.0954361504528793, + "velocityY": -0.8441149979470245, + "timestamp": 0.3815060463324364 + }, + { + "x": 0.9725299828215167, + "y": 4.140850923918169, + "heading": -0.7546270993304982, + "angularVelocity": 1.1415134631521273, + "velocityX": 1.279383057261364, + "velocityY": -0.986594417129931, + "timestamp": 0.44509038738784246 + }, + { + "x": 1.065637529662394, + "y": 4.068994254030079, + "heading": -0.673393688475822, + "angularVelocity": 1.2775694377943008, + "velocityX": 1.464315667905486, + "velocityY": -1.1301000953281266, + "timestamp": 0.5086747284432486 + }, + { + "x": 1.1705832794468332, + "y": 3.9879256971217893, + "heading": -0.584566561837581, + "angularVelocity": 1.3969968889170195, + "velocityX": 1.6504967739304255, + "velocityY": -1.2749767562684577, + "timestamp": 0.5722590694986547 + }, + { + "x": 1.2874653284560715, + "y": 3.897542804344524, + "heading": -0.4895895148245002, + "angularVelocity": 1.4937175637366416, + "velocityX": 1.8382206541605852, + "velocityY": -1.42146464486449, + "timestamp": 0.6358434105540608 + }, + { + "x": 1.4164104469481729, + "y": 3.7977514051305152, + "heading": -0.3905846134248042, + "angularVelocity": 1.557064204116311, + "velocityX": 2.0279382683189424, + "velocityY": -1.5694335674101274, + "timestamp": 0.6994277516094669 + }, + { + "x": 1.5575332696632753, + "y": 3.688506909682212, + "heading": -0.2916586370426824, + "angularVelocity": 1.5558229391088563, + "velocityX": 2.2194587593843385, + "velocityY": -1.718103760061147, + "timestamp": 0.763012092664873 + }, + { + "x": 1.7097613444585642, + "y": 3.5707774936908128, + "heading": -0.20742198100231668, + "angularVelocity": 1.324801903144104, + "velocityX": 2.394112642649561, + "velocityY": -1.8515473155381532, + "timestamp": 0.8265964337202791 + }, + { + "x": 1.8711613775944314, + "y": 3.4488084136916637, + "heading": -0.15383975328628857, + "angularVelocity": 0.8426953370380558, + "velocityX": 2.538361339550979, + "velocityY": -1.9182251160370993, + "timestamp": 0.8901807747756852 + }, + { + "x": 2.0417383028799354, + "y": 3.3225570909935143, + "heading": -0.13059320326371432, + "angularVelocity": 0.3656018075632435, + "velocityX": 2.682687631171131, + "velocityY": -1.9855725576858096, + "timestamp": 0.9537651158310914 + }, + { + "x": 2.2153893622715715, + "y": 3.187755682753254, + "heading": -0.13059307027328165, + "angularVelocity": 0.0000020915595014550256, + "velocityX": 2.731034976682693, + "velocityY": -2.120040972395975, + "timestamp": 1.0173494568864974 + }, + { + "x": 2.389039928413357, + "y": 3.0529536391086727, + "heading": -0.13059293728818866, + "angularVelocity": 0.000002091475523406473, + "velocityX": 2.7310272192719673, + "velocityY": -2.1200509654903494, + "timestamp": 1.0809337979419034 + }, + { + "x": 2.562690494523223, + "y": 2.918151595422971, + "heading": -0.13059280430309889, + "angularVelocity": 0.000002091475472778544, + "velocityX": 2.7310272187699582, + "velocityY": -2.1200509661370504, + "timestamp": 1.1445181389973094 + }, + { + "x": 2.7363410606330874, + "y": 2.7833495517372655, + "heading": -0.1305926713180123, + "angularVelocity": 0.0000020914754223957298, + "velocityX": 2.7310272187699196, + "velocityY": -2.1200509661371187, + "timestamp": 1.2081024800527154 + }, + { + "x": 2.9099916267429506, + "y": 2.648547508051558, + "heading": -0.13059253833292897, + "angularVelocity": 0.000002091475371640255, + "velocityX": 2.731027218769913, + "velocityY": -2.120050966137146, + "timestamp": 1.2716868211081214 + }, + { + "x": 3.0836421928528135, + "y": 2.513745464365849, + "heading": -0.1305924053478488, + "angularVelocity": 0.000002091475321590614, + "velocityX": 2.7310272187699067, + "velocityY": -2.120050966137172, + "timestamp": 1.3352711621635274 + }, + { + "x": 3.257292758962676, + "y": 2.3789434206801383, + "heading": -0.13059227236277188, + "angularVelocity": 0.000002091475271021181, + "velocityX": 2.7310272187699005, + "velocityY": -2.1200509661371987, + "timestamp": 1.3988555032189334 + }, + { + "x": 3.430943325072538, + "y": 2.244141376994426, + "heading": -0.1305921393776981, + "angularVelocity": 0.0000020914752212008574, + "velocityX": 2.7310272187698943, + "velocityY": -2.1200509661372253, + "timestamp": 1.4624398442743394 + }, + { + "x": 3.6045938911823994, + "y": 2.1093393333087116, + "heading": -0.13059200639262752, + "angularVelocity": 0.0000020914751708183746, + "velocityX": 2.731027218769888, + "velocityY": -2.120050966137252, + "timestamp": 1.5260241853297454 + }, + { + "x": 3.7782444572922627, + "y": 1.9745372896229973, + "heading": -0.13059187340756015, + "angularVelocity": 0.000002091475120575094, + "velocityX": 2.7310272187699067, + "velocityY": -2.1200509661372466, + "timestamp": 1.5896085263851514 + }, + { + "x": 3.951895023426423, + "y": 1.8397352459685825, + "heading": -0.13059174042249597, + "angularVelocity": 0.0000020914750700807474, + "velocityX": 2.731027219152042, + "velocityY": -2.1200509656450026, + "timestamp": 1.6531928674405574 + }, + { + "x": 4.125545965030257, + "y": 1.7049336859916362, + "heading": -0.13059160743738255, + "angularVelocity": 0.0000020914758451630756, + "velocityX": 2.731033124217136, + "velocityY": -2.1200433587804755, + "timestamp": 1.7167772084959634 + }, + { + "x": 4.303592186821449, + "y": 1.5759931847530775, + "heading": -0.13059147324861473, + "angularVelocity": 0.0000021104058890338206, + "velocityX": 2.800158322566331, + "velocityY": -2.0278656521139804, + "timestamp": 1.7803615495513694 + }, + { + "x": 4.4902367308457585, + "y": 1.459847055147331, + "heading": -0.13059133313690313, + "angularVelocity": 0.0000022035568702526466, + "velocityX": 2.9353853625953525, + "velocityY": -1.8266467447470887, + "timestamp": 1.8439458906067754 }, { "x": 4.6845622062683105, "y": 1.3570671081542969, - "heading": -0.1305911820170352, - "angularVelocity": 0.0000023767071620557534, - "velocityX": 3.056184466128632, - "velocityY": -1.616434884549102, - "timestamp": 1.907530231662107 - }, - { - "x": 4.83206708447035, - "y": 1.2885914794569848, - "heading": -0.13059103262448568, - "angularVelocity": 0.0000031760307779027524, - "velocityX": 3.13589957828876, - "velocityY": -1.4557667364792974, - "timestamp": 1.954567732232368 - }, - { - "x": 4.982924581891179, - "y": 1.2278574954319794, - "heading": -0.13059088660040227, - "angularVelocity": 0.0000031044184242488255, - "velocityX": 3.2071750325145314, - "velocityY": -1.2911822118244922, - "timestamp": 2.0016052328026293 - }, - { - "x": 5.13672864917333, - "y": 1.1750284268224314, - "heading": -0.13059074139304624, - "angularVelocity": 0.000003087055099940033, - "velocityX": 3.269818026415093, - "velocityY": -1.1231266110884432, - "timestamp": 2.0486427333728905 - }, - { - "x": 5.293065104212699, - "y": 1.1302454562937732, - "heading": -0.13059059472423634, - "angularVelocity": 0.000003118125073070688, - "velocityX": 3.3236556607816676, - "velocityY": -0.9520695186974223, - "timestamp": 2.0956802339431517 - }, - { - "x": 5.450482773711638, - "y": 1.0894253766985498, - "heading": -0.13059044674776243, - "angularVelocity": 0.0000031459255302142065, - "velocityX": 3.346641883401104, - "velocityY": -0.8678199117797415, - "timestamp": 2.142717734513413 - }, - { - "x": 5.6079006554403685, - "y": 1.0486061155506479, - "heading": -0.1305902987709771, - "angularVelocity": 0.000003145932150679596, - "velocityX": 3.3466463953285848, - "velocityY": -0.8678025118900388, - "timestamp": 2.189755235083674 - }, - { - "x": 5.765318537202432, - "y": 1.0077868545312842, - "heading": -0.13059015079419933, - "angularVelocity": 0.0000031459319897448254, - "velocityX": 3.3466463960372055, - "velocityY": -0.8678025091573679, - "timestamp": 2.2367927356539354 - }, - { - "x": 5.9227364189645, - "y": 0.9669675935119412, - "heading": -0.13059000281742925, - "angularVelocity": 0.0000031459318269023195, - "velocityX": 3.346646396037345, - "velocityY": -0.8678025091569279, - "timestamp": 2.2838302362241967 - }, - { - "x": 6.080154300726611, - "y": 0.9261483324927562, - "heading": -0.13058985484066676, - "angularVelocity": 0.000003145931664971049, - "velocityX": 3.346646396038242, - "velocityY": -0.867802509153567, - "timestamp": 2.330867736794458 - }, - { - "x": 6.237572182748926, - "y": 0.8853290724770341, - "heading": -0.13058970686391144, - "angularVelocity": 0.0000031459315122386572, - "velocityX": 3.3466464015700863, - "velocityY": -0.8678024878203159, - "timestamp": 2.377905237364719 - }, - { - "x": 6.394991721452043, - "y": 0.8445162019222677, - "heading": -0.13058955888394272, - "angularVelocity": 0.0000031459998284529575, - "velocityX": 3.3466816219959403, - "velocityY": -0.8676666502252415, - "timestamp": 2.4249427379349804 - }, - { - "x": 6.554152816051068, - "y": 0.8111344074726671, - "heading": -0.13058937107407412, - "angularVelocity": 0.000003992768882684273, - "velocityX": 3.3837064612155903, - "velocityY": -0.7096846993334062, - "timestamp": 2.4719802385052416 - }, - { - "x": 6.711882769952025, - "y": 0.7851880682804044, - "heading": -0.12042377120885606, - "angularVelocity": 0.21611692249747513, - "velocityX": 3.35328093518389, - "velocityY": -0.551609649273476, - "timestamp": 2.519017739075503 - }, - { - "x": 6.866725553620077, - "y": 0.7651062041845456, - "heading": -0.09663025977922159, - "angularVelocity": 0.5058413210985454, - "velocityX": 3.2919007555845554, - "velocityY": -0.42693306090662936, - "timestamp": 2.566055239645764 - }, - { - "x": 7.014982029149136, - "y": 0.7495960675805906, - "heading": -0.0669452251457697, - "angularVelocity": 0.631092942302719, - "velocityX": 3.1518782616352006, - "velocityY": -0.3297398121906415, - "timestamp": 2.6130927402160253 - }, - { - "x": 7.155468637798723, - "y": 0.7371442919133843, - "heading": -0.039841575624683864, - "angularVelocity": 0.5762136421470871, - "velocityX": 2.9866937432132143, - "velocityY": -0.26472018105228134, - "timestamp": 2.6601302407862866 - }, - { - "x": 7.288217565103697, - "y": 0.7273449805476783, - "heading": -0.01722296703020818, - "angularVelocity": 0.4808633179964505, - "velocityX": 2.8221934774506603, - "velocityY": -0.20832976342075163, - "timestamp": 2.707167741356548 + "heading": -0.13059118201554434, + "angularVelocity": 0.0000023767071623724323, + "velocityX": 3.0561844661285633, + "velocityY": -1.6164348845492313, + "timestamp": 1.9075302316621814 + }, + { + "x": 4.832067084470335, + "y": 1.2885914794569837, + "heading": -0.1305910326229948, + "angularVelocity": 0.0000031760307778025535, + "velocityX": 3.1358995782886923, + "velocityY": -1.4557667364794429, + "timestamp": 1.9545677322324386 + }, + { + "x": 4.982924581891149, + "y": 1.2278574954319752, + "heading": -0.13059088659891144, + "angularVelocity": 0.000003104418423448367, + "velocityX": 3.207175032514466, + "velocityY": -1.2911822118246548, + "timestamp": 2.001605232802696 + }, + { + "x": 5.136728649173284, + "y": 1.1750284268224231, + "heading": -0.13059074139155538, + "angularVelocity": 0.00000308705510077957, + "velocityX": 3.269818026415032, + "velocityY": -1.1231266110886224, + "timestamp": 2.048642733372953 + }, + { + "x": 5.293065104212638, + "y": 1.1302454562937592, + "heading": -0.1305905947227455, + "angularVelocity": 0.0000031181250722314943, + "velocityX": 3.3236556607816112, + "velocityY": -0.9520695186976181, + "timestamp": 2.0956802339432103 + }, + { + "x": 5.450482773711564, + "y": 1.0894253766985387, + "heading": -0.13059044674627163, + "angularVelocity": 0.0000031459255294965824, + "velocityX": 3.3466418834011025, + "velocityY": -0.8678199117797456, + "timestamp": 2.1427177345134676 + }, + { + "x": 5.607900655440282, + "y": 1.04860611555064, + "heading": -0.1305902987694863, + "angularVelocity": 0.0000031459321514570608, + "velocityX": 3.346646395328584, + "velocityY": -0.8678025118900428, + "timestamp": 2.189755235083725 + }, + { + "x": 5.765318537202331, + "y": 1.0077868545312796, + "heading": -0.13059015079270853, + "angularVelocity": 0.0000031459319896246793, + "velocityX": 3.346646396037204, + "velocityY": -0.867802509157372, + "timestamp": 2.236792735653982 + }, + { + "x": 5.922736418964388, + "y": 0.9669675935119395, + "heading": -0.1305900028159384, + "angularVelocity": 0.0000031459318275019883, + "velocityX": 3.3466463960373436, + "velocityY": -0.867802509156932, + "timestamp": 2.2838302362242393 + }, + { + "x": 6.080154300726486, + "y": 0.9261483324927575, + "heading": -0.13058985483917593, + "angularVelocity": 0.0000031459316651066595, + "velocityX": 3.3466463960382407, + "velocityY": -0.867802509153571, + "timestamp": 2.3308677367944965 + }, + { + "x": 6.237572182748789, + "y": 0.8853290724770384, + "heading": -0.1305897068624206, + "angularVelocity": 0.0000031459315124739283, + "velocityX": 3.346646401570085, + "velocityY": -0.86780248782032, + "timestamp": 2.377905237364754 + }, + { + "x": 6.394991721451892, + "y": 0.844516201922275, + "heading": -0.1305895588824519, + "angularVelocity": 0.0000031459998283836956, + "velocityX": 3.3466816219959377, + "velocityY": -0.8676666502252512, + "timestamp": 2.424942737935011 + }, + { + "x": 6.554152816050896, + "y": 0.8111344074726426, + "heading": -0.1305893710725833, + "angularVelocity": 0.000003992768882659048, + "velocityX": 3.3837064612154375, + "velocityY": -0.7096846993341356, + "timestamp": 2.4719802385052683 + }, + { + "x": 6.711882769951912, + "y": 0.7851880682804085, + "heading": -0.12042377120760904, + "angularVelocity": 0.21611692249230904, + "velocityX": 3.3532809351853774, + "velocityY": -0.5516096492729113, + "timestamp": 2.5190177390755255 + }, + { + "x": 6.866725553620017, + "y": 0.7651062041845728, + "heading": -0.09663025977821411, + "angularVelocity": 0.5058413210934933, + "velocityX": 3.29190075558594, + "velocityY": -0.4269330609061741, + "timestamp": 2.5660552396457827 + }, + { + "x": 7.014982029149098, + "y": 0.7495960675806145, + "heading": -0.06694522514508651, + "angularVelocity": 0.6310929422958753, + "velocityX": 3.151878261635918, + "velocityY": -0.3297398121907379, + "timestamp": 2.61309274021604 + }, + { + "x": 7.155468637798704, + "y": 0.7371442919133998, + "heading": -0.03984157562428539, + "angularVelocity": 0.5762136421410802, + "velocityX": 2.9866937432138485, + "velocityY": -0.26472018105247963, + "timestamp": 2.6601302407862972 + }, + { + "x": 7.28821756510369, + "y": 0.727344980547685, + "heading": -0.017222967030039466, + "angularVelocity": 0.48086331799160453, + "velocityX": 2.8221934774511723, + "velocityY": -0.20832976342095313, + "timestamp": 2.7071677413565545 }, { "x": 7.413279056549072, "y": 0.72, - "heading": 6.339387425155692e-24, - "angularVelocity": 0.36615395846728294, - "velocityX": 2.6587614122601657, - "velocityY": -0.1561515909355554, - "timestamp": 2.754205241926809 - }, - { - "x": 7.584141987680613, - "y": 0.7142363916829177, - "heading": 0.012496138017673028, - "angularVelocity": 0.17655403361368305, - "velocityX": 2.414069022258432, - "velocityY": -0.08143222290847654, - "timestamp": 2.8249832228197054 - }, - { - "x": 7.736548147209623, - "y": 0.711851622188137, - "heading": 0.017397146839460656, - "angularVelocity": 0.06924482388391391, - "velocityX": 2.153299057225679, - "velocityY": -0.03369366383013129, - "timestamp": 2.8957612037126017 - }, - { - "x": 7.870091367183984, - "y": 0.7115747244873084, - "heading": 0.017828194306038627, - "angularVelocity": 0.006090135111797648, - "velocityX": 1.8867904719752233, - "velocityY": -0.00391220118651861, + "heading": -8.89059623238174e-24, + "angularVelocity": 0.3661539584637254, + "velocityX": 2.6587614122605316, + "velocityY": -0.15615159093571299, + "timestamp": 2.7542052419268117 + }, + { + "x": 7.584141987680618, + "y": 0.7142363916829146, + "heading": 0.012496138017563933, + "angularVelocity": 0.17655403361214328, + "velocityX": 2.4140690222585377, + "velocityY": -0.0814322229085219, + "timestamp": 2.824983222819707 + }, + { + "x": 7.7365481472096285, + "y": 0.7118516221881321, + "heading": 0.017397146839313638, + "angularVelocity": 0.0692448238833787, + "velocityX": 2.153299057225703, + "velocityY": -0.03369366383015727, + "timestamp": 2.8957612037126026 + }, + { + "x": 7.8700913671839885, + "y": 0.7115747244873029, + "heading": 0.01782819430589125, + "angularVelocity": 0.006090135111792666, + "velocityX": 1.8867904719752229, + "velocityY": -0.00391220118652886, "timestamp": 2.966539184605498 }, { - "x": 7.984616283222687, - "y": 0.7125587164394659, - "heading": 0.015661834277452328, - "angularVelocity": -0.030607824654739903, - "velocityX": 1.6180867918796034, - "velocityY": 0.01390251515717133, - "timestamp": 3.0373171654983944 + "x": 7.98461628322269, + "y": 0.7125587164394606, + "heading": 0.01566183427732483, + "angularVelocity": -0.03060782465445932, + "velocityX": 1.6180867918795971, + "velocityY": 0.013902515157174911, + "timestamp": 3.0373171654983935 }, { "x": 8.08006227999561, - "y": 0.714207810245489, - "heading": 0.012151433911586507, - "angularVelocity": -0.049597351062866286, - "velocityX": 1.3485266967046678, - "velocityY": 0.023299531651214074, - "timestamp": 3.1080951463912907 + "y": 0.7142078102454845, + "heading": 0.012151433911488669, + "angularVelocity": -0.04959735106244768, + "velocityX": 1.3485266967046623, + "velocityY": 0.023299531651227553, + "timestamp": 3.108095146391289 }, { "x": 8.15640902937787, - "y": 0.7160816946030871, - "heading": 0.00820427926993306, - "angularVelocity": -0.05576811590071236, - "velocityX": 1.0786793917982935, - "velocityY": 0.02647552719021178, - "timestamp": 3.178873127284187 + "y": 0.716081694603084, + "heading": 0.008204279269867538, + "angularVelocity": -0.055768115900256314, + "velocityX": 1.0786793917982904, + "velocityY": 0.02647552719023059, + "timestamp": 3.1788731272841844 }, { "x": 8.213654764882792, - "y": 0.71784200041228, - "heading": 0.0045134929539951294, - "angularVelocity": -0.0521459678473021, - "velocityX": 0.8088071287530355, - "velocityY": 0.02487081133123372, - "timestamp": 3.2496511081770834 + "y": 0.7178420004122783, + "heading": 0.004513492953959301, + "angularVelocity": -0.05214596784688299, + "velocityX": 0.8088071287530345, + "velocityY": 0.02487081133125343, + "timestamp": 3.24965110817708 }, { "x": 8.251806612817116, - "y": 0.7192206370589295, - "heading": 0.0016291300859072085, - "angularVelocity": -0.040752262662771335, - "velocityX": 0.5390355510714089, - "velocityY": 0.019478326864616948, - "timestamp": 3.3204290890699797 + "y": 0.7192206370589289, + "heading": 0.0016291300858943402, + "angularVelocity": -0.04075226266244733, + "velocityX": 0.5390355510714093, + "velocityY": 0.019478326864633543, + "timestamp": 3.3204290890699752 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -4.056080746895066e-24, - "angularVelocity": -0.023017470481002632, - "velocityX": 0.26942444144984345, - "velocityY": 0.011011375730678513, - "timestamp": 3.391207069962876 + "heading": 5.577770790961069e-24, + "angularVelocity": -0.02301747048082103, + "velocityX": 0.2694244414498442, + "velocityY": 0.011011375730688399, + "timestamp": 3.3912070699628707 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -1.9991825038559772e-24, - "angularVelocity": 6.550650295244866e-25, - "velocityX": -3.4098418734015305e-26, - "velocityY": 1.7181985071097e-25, - "timestamp": 3.4619850508557724 - }, - { - "x": 8.25196066732055, - "y": 0.7219205807616909, - "heading": -0.005612553081760066, - "angularVelocity": -0.07909055712036753, - "velocityX": -0.2665486996342892, - "velocityY": 0.027064296804682322, - "timestamp": 3.5329486814851325 - }, - { - "x": 8.21412399288685, - "y": 0.7257596347584204, - "heading": -0.016744431402723248, - "angularVelocity": -0.15686737307881685, - "velocityX": -0.5331840281864679, - "velocityY": 0.05409889492239708, - "timestamp": 3.6039123121144927 - }, - { - "x": 8.157358520801719, - "y": 0.7315141378055798, - "heading": -0.033282470488275456, - "angularVelocity": -0.23304950632993487, - "velocityX": -0.7999234478519905, - "velocityY": 0.08109087706088317, - "timestamp": 3.674875942743853 - }, - { - "x": 8.081655397928103, - "y": 0.7391803054783095, - "heading": -0.055089458667278546, - "angularVelocity": -0.3072980903823823, - "velocityX": -1.066787623494219, - "velocityY": 0.10802953012324953, - "timestamp": 3.745839573373213 - }, - { - "x": 7.987003995494799, - "y": 0.748753815449985, - "heading": -0.08199800345549389, - "angularVelocity": -0.3791878255039894, - "velocityX": -1.3338015768621518, - "velocityY": 0.13490727414550616, - "timestamp": 3.8168032040025732 - }, - { - "x": 7.8733914694677685, - "y": 0.7602301364715836, - "heading": -0.11380071054386168, - "angularVelocity": -0.44815501696174403, - "velocityX": -1.6009965248314793, - "velocityY": 0.16172116505057207, - "timestamp": 3.8877668346319334 - }, - { - "x": 7.74080211111102, - "y": 0.7736050364848951, - "heading": -0.15023345295494694, - "angularVelocity": -0.5134002035686684, - "velocityX": -1.868412835995617, - "velocityY": 0.18847541895323702, - "timestamp": 3.9587304652612936 - }, - { - "x": 7.589216359418635, - "y": 0.7888753993182606, - "heading": -0.19094489906072787, - "angularVelocity": -0.5736945213304409, - "velocityX": -2.1361047954847603, - "velocityY": 0.2151857606204215, - "timestamp": 4.029694095890654 - }, - { - "x": 7.418609301999379, - "y": 0.8060405691564864, - "heading": -0.2354360929047945, - "angularVelocity": -0.6269576887411831, - "velocityX": -2.4041478135515395, - "velocityY": 0.24188686071994714, - "timestamp": 4.100657726520014 - }, - { - "x": 7.228948719447248, - "y": 0.8251044625017263, - "heading": -0.28292522744133536, - "angularVelocity": -0.6692038459048766, - "velocityX": -2.672644858642023, - "velocityY": 0.2686431510925627, - "timestamp": 4.171621357149374 - }, - { - "x": 7.020195878786293, - "y": 0.8460771849141498, - "heading": -0.33198004179541496, - "angularVelocity": -0.691266976041442, - "velocityX": -2.9416877181955665, - "velocityY": 0.29554184624463653, - "timestamp": 4.242584987778734 - }, - { - "x": 6.7923582844879515, - "y": 0.868949065573254, - "heading": -0.379053692427792, - "angularVelocity": -0.6633489607971249, - "velocityX": -3.2106248267979276, - "velocityY": 0.3223042628492752, - "timestamp": 4.3135486184080944 - }, - { - "x": 6.551577901314172, - "y": 0.8947450109840207, - "heading": -0.38936079053254913, - "angularVelocity": -0.1452447967127084, - "velocityX": -3.3930110542309384, - "velocityY": 0.3635093805374453, - "timestamp": 4.384512249037455 - }, - { - "x": 6.307465319785258, - "y": 0.9193021232357074, - "heading": -0.38936083584908904, - "angularVelocity": -6.385882391179967e-7, - "velocityX": -3.4399674786074925, - "velocityY": 0.3460520837772146, - "timestamp": 4.455475879666815 - }, - { - "x": 6.0633527302184325, - "y": 0.9438591555860323, - "heading": -0.38936088116543593, - "angularVelocity": -6.385855192726227e-7, - "velocityX": -3.4399675918755674, - "velocityY": 0.34605095782916134, - "timestamp": 4.526439510296175 - }, - { - "x": 5.819240162083019, - "y": 0.9684164009773654, - "heading": -0.38936092648177834, - "angularVelocity": -6.38585455697529e-7, - "velocityX": -3.4399672898699727, - "velocityY": 0.3460539599445595, - "timestamp": 4.597403140925535 - }, - { - "x": 5.575592141235637, - "y": 0.9972199796568127, - "heading": -0.38936097177673723, - "angularVelocity": -6.382841249552677e-7, - "velocityX": -3.433421017026949, - "velocityY": 0.4058921228239739, - "timestamp": 4.668366771554895 - }, - { - "x": 5.334942567663047, - "y": 1.044988031266676, - "heading": -0.389361017575543, - "angularVelocity": -6.453841966108095e-7, - "velocityX": -3.391167721244301, - "velocityY": 0.6731342687263799, - "timestamp": 4.7393304021842555 - }, - { - "x": 5.098765706313627, - "y": 1.1114296874515797, - "heading": -0.3893610653343458, - "angularVelocity": -6.730039375535028e-7, - "velocityX": -3.3281394885636724, - "velocityY": 0.9362775776217799, - "timestamp": 4.810294032813616 - }, - { - "x": 4.868508287372395, - "y": 1.1961381502837038, - "heading": -0.38936111679255236, - "angularVelocity": -7.251349187747336e-7, - "velocityX": -3.24472433131074, - "velocityY": 1.1936884018033496, - "timestamp": 4.881257663442976 + "heading": 2.68750083227073e-24, + "angularVelocity": -1.0022200251051524e-24, + "velocityX": 6.790628726650556e-26, + "velocityY": 3.41370039560792e-26, + "timestamp": 3.461985050855766 + }, + { + "x": 8.251549516655441, + "y": 0.7219586831033024, + "heading": -0.0006660755390764362, + "angularVelocity": -0.009331396835267377, + "velocityX": -0.2707537344882418, + "velocityY": 0.027440204960520992, + "timestamp": 3.5333650972555772 + }, + { + "x": 8.212896688696702, + "y": 0.7258760442658929, + "heading": -0.001998229790486319, + "angularVelocity": -0.018662838126333965, + "velocityX": -0.5415074647365562, + "velocityY": 0.054880339256839474, + "timestamp": 3.6047451436553883 + }, + { + "x": 8.154917446658368, + "y": 0.7317520758923975, + "heading": -0.003996392789209819, + "angularVelocity": -0.027993299241239875, + "velocityX": -0.812261198508941, + "velocityY": 0.08232036714563006, + "timestamp": 3.6761251900551994 + }, + { + "x": 8.077611789765818, + "y": 0.7395867678254814, + "heading": -0.006660425114458462, + "angularVelocity": -0.03732180713818774, + "velocityX": -1.0830149431334009, + "velocityY": 0.10976025273506382, + "timestamp": 3.7475052364550105 + }, + { + "x": 7.980979716767329, + "y": 0.749380107333022, + "heading": -0.00999012297038977, + "angularVelocity": -0.04664745995374023, + "velocityX": -1.353768705293865, + "velocityY": 0.13719995995360584, + "timestamp": 3.8188852828548217 + }, + { + "x": 7.86502122600115, + "y": 0.7611320790926304, + "heading": -0.013985224659649345, + "angularVelocity": -0.0559694465156602, + "velocityX": -1.6245224907346907, + "velocityY": 0.1646394525128738, + "timestamp": 3.8902653292546328 + }, + { + "x": 7.729736315496098, + "y": 0.7748426651724982, + "heading": -0.018645418435560536, + "angularVelocity": -0.06528706565709827, + "velocityX": -1.8952763037908287, + "velocityY": 0.1920786938561615, + "timestamp": 3.961645375654444 + }, + { + "x": 7.575124983133034, + "y": 0.790511845006039, + "heading": -0.023970351697693893, + "angularVelocity": -0.07459974503669481, + "velocityX": -2.1660301465350793, + "velocityY": 0.21951764707149618, + "timestamp": 4.033025422054255 + }, + { + "x": 7.401187226935479, + "y": 0.8081395953535565, + "heading": -0.029959641438283554, + "angularVelocity": -0.08390705866234215, + "velocityX": -2.4367840169688693, + "velocityY": 0.24695627470990408, + "timestamp": 4.1044054684540665 + }, + { + "x": 7.207923045694123, + "y": 0.8277258902299445, + "heading": -0.03661288565920585, + "angularVelocity": -0.09320874048829283, + "velocityX": -2.7075379043444587, + "velocityY": 0.2743945383095141, + "timestamp": 4.175785514853878 + }, + { + "x": 6.995332440744312, + "y": 0.8492707007132015, + "heading": -0.04392967465186433, + "angularVelocity": -0.10250468249454428, + "velocityX": -2.9782917730125558, + "velocityY": 0.3018323967258469, + "timestamp": 4.24716556125369 + }, + { + "x": 6.763415424631655, + "y": 0.872773994034365, + "heading": -0.05190959463777978, + "angularVelocity": -0.11179482766400335, + "velocityX": -3.249045465922667, + "velocityY": 0.32926979606482365, + "timestamp": 4.318545607653501 + }, + { + "x": 6.517888285888531, + "y": 0.8976525425650798, + "heading": -0.051909598739256456, + "angularVelocity": -5.745970870698805e-8, + "velocityX": -3.439716715339282, + "velocityY": 0.348536457812958, + "timestamp": 4.389925654053313 + }, + { + "x": 6.272361147029228, + "y": 0.9225310899511409, + "heading": -0.051909602840455864, + "angularVelocity": -5.7455824331798554e-8, + "velocityX": -3.439716716966896, + "velocityY": 0.3485364417769111, + "timestamp": 4.461305700453124 + }, + { + "x": 6.026834008173439, + "y": 0.94740963737188, + "heading": -0.051909606941655285, + "angularVelocity": -5.7455824691381894e-8, + "velocityX": -3.4397167169176694, + "velocityY": 0.34853644226273583, + "timestamp": 4.532685746852936 + }, + { + "x": 5.7813069462957465, + "y": 0.9722889444800497, + "heading": -0.05190961104285578, + "angularVelocity": -5.745583959865336e-8, + "velocityX": -3.4397156384916827, + "velocityY": 0.348547085116991, + "timestamp": 4.604065793252747 + }, + { + "x": 5.537158225945976, + "y": 1.0082600487060158, + "heading": -0.05190961517853181, + "angularVelocity": -5.793882502411163e-8, + "velocityX": -3.42040573891272, + "velocityY": 0.5039378095173286, + "timestamp": 4.675445839652559 + }, + { + "x": 5.296595540867912, + "y": 1.0633246680240616, + "heading": -0.051909619464878404, + "angularVelocity": -6.004964723504615e-8, + "velocityX": -3.3701671154797745, + "velocityY": 0.7714287408783704, + "timestamp": 4.74682588605237 + }, + { + "x": 5.061109922350585, + "y": 1.137142081975634, + "heading": -0.05190979783691868, + "angularVelocity": -0.0000024989061968370985, + "velocityX": -3.299039863302041, + "velocityY": 1.0341463430565587, + "timestamp": 4.818205932452182 + }, + { + "x": 4.843667300844079, + "y": 1.2172452033533754, + "heading": -0.059561850749452576, + "angularVelocity": -0.10720156820399783, + "velocityX": -3.0462661832492475, + "velocityY": 1.1222060704341816, + "timestamp": 4.8895859788519935 }, { "x": 4.645580768585205, "y": 1.29859459400177, - "heading": -0.38936117353879, - "angularVelocity": -7.996524018828314e-7, - "velocityX": -3.1414333907396923, - "velocityY": 1.4437880757988777, - "timestamp": 4.952221294072336 - }, - { - "x": 4.461481911069297, - "y": 1.3986076661601012, - "heading": -0.38936122478670326, - "angularVelocity": -8.456865275865798e-7, - "velocityX": -3.0379758656861, - "velocityY": 1.6504029605065766, - "timestamp": 5.012820477757534 - }, - { - "x": 4.284474827324454, - "y": 1.510694673133237, - "heading": -0.38936127163806794, - "angularVelocity": -7.731352441209964e-7, - "velocityX": -2.9209483194421555, - "velocityY": 1.8496454928404518, - "timestamp": 5.073419661442731 - }, - { - "x": 4.115350163635107, - "y": 1.6343549075731951, - "heading": -0.3893613156320879, - "angularVelocity": -7.259837067576087e-7, - "velocityX": -2.790873629056165, - "velocityY": 2.0406254163810633, - "timestamp": 5.134018845127929 - }, - { - "x": 3.9548633143870395, - "y": 1.769035927298024, - "heading": -0.3893613579702014, - "angularVelocity": -6.986581485390433e-7, - "velocityX": -2.648333516863359, - "velocityY": 2.2224890094968055, - "timestamp": 5.194618028813126 - }, - { - "x": 3.8037308739642373, - "y": 1.9141358636408468, - "heading": -0.38936139966415195, - "angularVelocity": -6.880282549201409e-7, - "velocityX": -2.493968255544679, - "velocityY": 2.3944206426375816, - "timestamp": 5.255217212498324 - }, - { - "x": 3.661588245211325, - "y": 2.068052981661263, - "heading": -0.38936144155211244, - "angularVelocity": -6.91229781197439e-7, - "velocityX": -2.345619529981126, - "velocityY": 2.539920650086488, - "timestamp": 5.315816396183521 - }, - { - "x": 3.5194491358842597, - "y": 2.221973349800809, - "heading": -0.38936148344023264, - "angularVelocity": -6.91232416307412e-7, - "velocityX": -2.345561452864688, - "velocityY": 2.5399742831378225, - "timestamp": 5.376415579868719 - }, - { - "x": 3.377309938767793, - "y": 2.375893636870205, - "heading": -0.3893615253289459, - "angularVelocity": -6.912422042008341e-7, - "velocityX": -2.3455629015541897, - "velocityY": 2.539972945328553, - "timestamp": 5.4370147635539166 - }, - { - "x": 3.237376278676051, - "y": 2.5255432272973435, - "heading": -0.4037390696912898, - "angularVelocity": -0.23725640327158354, - "velocityX": -2.3091674108792377, - "velocityY": 2.46949845404756, - "timestamp": 5.497613947239114 - }, - { - "x": 3.105303617904582, - "y": 2.668822904326165, - "heading": -0.44298006467609385, - "angularVelocity": -0.6475498942139972, - "velocityX": -2.1794462027337684, - "velocityY": 2.3643829556044245, - "timestamp": 5.558213130924312 - }, - { - "x": 2.9827030369168717, - "y": 2.801822488594932, - "heading": -0.4839708463152926, - "angularVelocity": -0.6764246504068283, - "velocityX": -2.0231391502664464, - "velocityY": 2.194742176060946, - "timestamp": 5.618812314609509 - }, - { - "x": 2.869593703886996, - "y": 2.924535645165437, - "heading": -0.5240655796457002, - "angularVelocity": -0.6616381755023828, - "velocityX": -1.866515787035351, - "velocityY": 2.0249968581751787, - "timestamp": 5.679411498294707 - }, - { - "x": 2.7659536958829163, - "y": 3.0369758685439536, - "heading": -0.5621961207653314, - "angularVelocity": -0.6292253261646749, - "velocityX": -1.7102541932325803, - "velocityY": 1.8554742249107699, - "timestamp": 5.740010681979904 - }, - { - "x": 2.6717655880666005, - "y": 3.13915624073865, - "heading": -0.5977862389011358, - "angularVelocity": -0.5873035901059204, - "velocityX": -1.5542801418845433, - "velocityY": 1.686167469276597, - "timestamp": 5.800609865665102 - }, - { - "x": 2.587017347476756, - "y": 3.2310880524733365, - "heading": -0.6304747734177004, - "angularVelocity": -0.5394220273061133, - "velocityX": -1.3985046569289994, - "velocityY": 1.5170470317266471, - "timestamp": 5.8612090493502995 - }, - { - "x": 2.5117006571972906, - "y": 3.3127809668412036, - "heading": -0.6600126072321035, - "angularVelocity": -0.48742956617777783, - "velocityX": -1.2428664166620311, - "velocityY": 1.3480860533080463, - "timestamp": 5.921808233035497 - }, - { - "x": 2.4458096085005643, - "y": 3.3842432936093614, - "heading": -0.6862159260863127, - "angularVelocity": -0.43240382560813195, - "velocityX": -1.0873256814649452, - "velocityY": 1.1792622016064225, - "timestamp": 5.982407416720695 - }, - { - "x": 2.3893398364344187, - "y": 3.445482204596666, - "heading": -0.7089422053012937, - "angularVelocity": -0.3750261609634924, - "velocityX": -0.9318569761516383, - "velocityY": 1.010556698344825, - "timestamp": 6.043006600405892 - }, - { - "x": 2.34228795390179, - "y": 3.4965038869924845, - "heading": -0.7280767545715167, - "angularVelocity": -0.3157558915252676, - "velocityX": -0.7764441642820773, - "velocityY": 0.8419532952930199, - "timestamp": 6.10360578409109 - }, - { - "x": 2.304651173054735, - "y": 3.5373136514659973, - "heading": -0.7435246612107332, - "angularVelocity": -0.2549193850442921, - "velocityX": -0.621077357123682, - "velocityY": 0.6734375282266625, - "timestamp": 6.164204967776287 - }, - { - "x": 2.27642704429132, - "y": 3.567916009656823, - "heading": -0.7552056856738262, - "angularVelocity": -0.19275877582400947, - "velocityX": -0.4657509729839714, - "velocityY": 0.504996211661866, - "timestamp": 6.224804151461485 - }, - { - "x": 2.257613270327787, - "y": 3.5883147313045463, - "heading": -0.7630508468581061, - "angularVelocity": -0.12945984924539836, - "velocityX": -0.31046249832782574, - "velocityY": 0.33661710285886326, - "timestamp": 6.2854033351466825 + "heading": -0.06951316932259947, + "angularVelocity": -0.13941317041751372, + "velocityX": -2.7750967146947323, + "velocityY": 1.13966570143067, + "timestamp": 4.960966025251805 + }, + { + "x": 4.474092871614693, + "y": 1.385887514867849, + "heading": -0.08242444337490663, + "angularVelocity": -0.2012909785735536, + "velocityX": -2.6735523121009726, + "velocityY": 1.3609251412750347, + "timestamp": 5.025108363591072 + }, + { + "x": 4.3102265492062894, + "y": 1.4867635843508433, + "heading": -0.10022801616986421, + "angularVelocity": -0.27756351352189995, + "velocityX": -2.554729475898846, + "velocityY": 1.5726908637073918, + "timestamp": 5.0892507019303395 + }, + { + "x": 4.155003391680842, + "y": 1.6004909974861876, + "heading": -0.12448541502532746, + "angularVelocity": -0.37818076926286603, + "velocityX": -2.419979713000573, + "velocityY": 1.7730475077757013, + "timestamp": 5.153393040269607 + }, + { + "x": 4.00926290540325, + "y": 1.7261407641347544, + "heading": -0.1583340022250027, + "angularVelocity": -0.5277105274934034, + "velocityX": -2.2721417717378642, + "velocityY": 1.958920892218929, + "timestamp": 5.217535378608874 + }, + { + "x": 3.8730404280351673, + "y": 1.8620509915016963, + "heading": -0.21028223642363456, + "angularVelocity": -0.8098899345368795, + "velocityX": -2.1237529047906247, + "velocityY": 2.1188848253095043, + "timestamp": 5.281677716948141 + }, + { + "x": 3.741564544573194, + "y": 2.0025580918468195, + "heading": -0.2996033949603487, + "angularVelocity": -1.3925460288689253, + "velocityX": -2.049751955822999, + "velocityY": 2.1905515761202894, + "timestamp": 5.345820055287408 + }, + { + "x": 3.6100546633718698, + "y": 2.1430333719703096, + "heading": -0.3901784541639511, + "angularVelocity": -1.4120947497193557, + "velocityX": -2.050281991681201, + "velocityY": 2.1900554884743153, + "timestamp": 5.409962393626675 + }, + { + "x": 3.4785072023626884, + "y": 2.2834734612659138, + "heading": -0.4827580204171881, + "angularVelocity": -1.4433456691827582, + "velocityX": -2.0508678731571766, + "velocityY": 2.1895068519762364, + "timestamp": 5.474104731965943 + }, + { + "x": 3.346919123497923, + "y": 2.423875493587476, + "heading": -0.5782456610362502, + "angularVelocity": -1.488683498159982, + "velocityX": -2.051501118789228, + "velocityY": 2.188913531323639, + "timestamp": 5.53824707030521 + }, + { + "x": 3.2152861692168586, + "y": 2.5642354541414827, + "heading": -0.6777971832870476, + "angularVelocity": -1.552040739834588, + "velocityX": -2.052200741183146, + "velocityY": 2.1882576187291725, + "timestamp": 5.602389408644477 + }, + { + "x": 3.0838454699327147, + "y": 2.704775469009889, + "heading": -0.7323199293584344, + "angularVelocity": -0.8500274153243377, + "velocityX": -2.049203423001438, + "velocityY": 2.1910647242863015, + "timestamp": 5.666531746983744 + }, + { + "x": 2.9552905266702094, + "y": 2.842272453022611, + "heading": -0.7381340958895165, + "angularVelocity": -0.0906447548003214, + "velocityX": -2.0042135442980085, + "velocityY": 2.143622879562956, + "timestamp": 5.730674085323011 + }, + { + "x": 2.837445531451434, + "y": 2.968312162646033, + "heading": -0.7431823028036986, + "angularVelocity": -0.07870319425338904, + "velocityX": -1.837241957027799, + "velocityY": 1.965000230530428, + "timestamp": 5.794816423662279 + }, + { + "x": 2.7303126070394907, + "y": 3.082893932918914, + "heading": -0.747653667364265, + "angularVelocity": -0.06971003359615609, + "velocityX": -1.6702372751876633, + "velocityY": 1.7863672145350264, + "timestamp": 5.858958762001546 + }, + { + "x": 2.6338923756777755, + "y": 3.1860176221630003, + "heading": -0.751611677644213, + "angularVelocity": -0.061706672728596555, + "velocityX": -1.5032228923697837, + "velocityY": 1.6077319897293985, + "timestamp": 5.923101100340813 + }, + { + "x": 2.5481851332942993, + "y": 3.277683175661144, + "heading": -0.7550881872685589, + "angularVelocity": -0.05419992027664412, + "velocityX": -1.3362038959375901, + "velocityY": 1.4290959118655384, + "timestamp": 5.98724343868008 + }, + { + "x": 2.473191052958317, + "y": 3.3578905661578986, + "heading": -0.7581023488644949, + "angularVelocity": -0.04699176353679586, + "velocityX": -1.1691822012991828, + "velocityY": 1.2504594090803822, + "timestamp": 6.051385777019347 + }, + { + "x": 2.4089102482733002, + "y": 3.4266397779362934, + "heading": -0.7606669459018931, + "angularVelocity": -0.039982905266614695, + "velocityX": -1.0021587355455739, + "velocityY": 1.0718226612625237, + "timestamp": 6.1155281153586145 + }, + { + "x": 2.3553427994564915, + "y": 3.4839308009572485, + "heading": -0.7627911121209714, + "angularVelocity": -0.03311644498900487, + "velocityX": -0.8351340191789587, + "velocityY": 0.893185756932122, + "timestamp": 6.179670453697882 + }, + { + "x": 2.312488766021362, + "y": 3.5297636282468714, + "heading": -0.7644816934670975, + "angularVelocity": -0.026356715235171243, + "velocityX": -0.6681083749778789, + "velocityY": 0.714548743876462, + "timestamp": 6.243812792037149 + }, + { + "x": 2.280348193682581, + "y": 3.5641382545710476, + "heading": -0.7657440057178361, + "angularVelocity": -0.019679860189406772, + "velocityX": -0.501082018070189, + "velocityY": 0.5359116492192578, + "timestamp": 6.307955130376416 + }, + { + "x": 2.2589211184357674, + "y": 3.587054675697436, + "heading": -0.7665822895031111, + "angularVelocity": -0.013069117948915103, + "velocityX": -0.3340550999790392, + "velocityY": 0.35727448857846106, + "timestamp": 6.372097468715683 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.06516842144952234, - "velocityX": -0.15521168163475207, - "velocityY": 0.1682886803086901, - "timestamp": 6.34600251883188 + "angularVelocity": -0.006512243047323657, + "velocityX": -0.1670277322411552, + "velocityY": 0.17863727070052132, + "timestamp": 6.4362398070549505 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -1.08140020207294e-26, - "velocityX": -4.402093490094888e-26, - "velocityY": -5.469457631744455e-26, - "timestamp": 6.406601702517078 - }, - { - "x": 2.252899820442669, - "y": 3.5841608935822804, - "heading": -0.7653000327270449, - "angularVelocity": 0.026996951430568503, - "velocityX": 0.07451701159836764, - "velocityY": -0.2279220907181283, - "timestamp": 6.469570563179999 - }, - { - "x": 2.2625314508292247, - "y": 3.5555407678837927, - "heading": -0.7618779142230176, - "angularVelocity": 0.05434620331382998, - "velocityX": 0.15295862566284854, - "velocityY": -0.4545123636855086, - "timestamp": 6.53253942384292 - }, - { - "x": 2.2773902485258666, - "y": 3.5127562657015337, - "heading": -0.7567066671704831, - "angularVelocity": 0.08212387834388286, - "velocityX": 0.23597056608952433, - "velocityY": -0.6794549199689205, - "timestamp": 6.595508284505841 - }, - { - "x": 2.297815121315827, - "y": 3.4559381539319545, - "heading": -0.7497538991928868, - "angularVelocity": 0.11041597234568314, - "velocityX": 0.32436465540161463, - "velocityY": -0.9023207847722199, - "timestamp": 6.658477145168762 - }, - { - "x": 2.324210222453492, - "y": 3.3852548429790676, - "heading": -0.740981041700234, - "angularVelocity": 0.13932056893350495, - "velocityX": 0.4191770481438562, - "velocityY": -1.1225121466189798, - "timestamp": 6.721446005831683 - }, - { - "x": 2.3570643106323765, - "y": 3.300928786576667, - "heading": -0.7303424220044314, - "angularVelocity": 0.16895048733297416, - "velocityX": 0.5217513519063973, - "velocityY": -1.33917075066368, - "timestamp": 6.784414866494604 - }, - { - "x": 2.396977578495247, - "y": 3.2032627196422863, - "heading": -0.7177841287199045, - "angularVelocity": 0.19943656518978173, - "velocityX": 0.6338572342372608, - "velocityY": -1.551021662233946, - "timestamp": 6.847383727157525 - }, - { - "x": 2.4446988674908763, - "y": 3.0926833438789934, - "heading": -0.7032425794761846, - "angularVelocity": 0.2309323861132317, - "velocityX": 0.7578553668151423, - "velocityY": -1.756096181495744, - "timestamp": 6.910352587820446 - }, - { - "x": 2.5011759621015535, - "y": 2.969817102943244, - "heading": -0.6866424992704774, - "angularVelocity": 0.2636236392233503, - "velocityX": 0.8969051371757456, - "velocityY": -1.9512222333744542, - "timestamp": 6.973321448483367 - }, - { - "x": 2.567616640888744, - "y": 2.8356262439165043, - "heading": -0.6678933195188701, - "angularVelocity": 0.2977531998232215, - "velocityX": 1.0551354762928686, - "velocityY": -2.131066968879719, - "timestamp": 7.036290309146288 - }, - { - "x": 2.645534264440632, - "y": 2.691654750192989, - "heading": -0.646881125730223, - "angularVelocity": 0.33369182112294454, - "velocityX": 1.2373992911987053, - "velocityY": -2.28639191193581, - "timestamp": 7.099259169809209 - }, - { - "x": 2.736669367471753, - "y": 2.540436142692156, - "heading": -0.6234515269375929, - "angularVelocity": 0.37208230458625247, - "velocityX": 1.4473043036140854, - "velocityY": -2.4014823503052147, - "timestamp": 7.16222803047213 - }, - { - "x": 2.8425129383801573, - "y": 2.3859371382768275, - "heading": -0.5973967555496894, - "angularVelocity": 0.41377231719940855, - "velocityX": 1.6808875020781504, - "velocityY": -2.453577892132726, - "timestamp": 7.2251968911350515 - }, - { - "x": 2.963311384732838, - "y": 2.2333153163785404, - "heading": -0.5685648668222174, - "angularVelocity": 0.45787534384355805, - "velocityX": 1.9183838659449153, - "velocityY": -2.4237666092656225, - "timestamp": 7.2881657517979725 - }, - { - "x": 3.0976033560224936, - "y": 2.0874389211680247, - "heading": -0.5371913209271666, - "angularVelocity": 0.4982390591914446, - "velocityX": 2.1326727191164423, - "velocityY": -2.316643396033605, - "timestamp": 7.351134612460894 - }, - { - "x": 3.243098632839074, - "y": 1.9516892209576022, - "heading": -0.5039062126583729, - "angularVelocity": 0.5285963239349766, - "velocityX": 2.3105909061215564, - "velocityY": -2.155822715883417, - "timestamp": 7.414103473123815 - }, - { - "x": 3.3976251134783033, - "y": 1.8280561952151033, - "heading": -0.46938250382851276, - "angularVelocity": 0.5482663727182444, - "velocityX": 2.454014238345947, - "velocityY": -1.9633994396741585, - "timestamp": 7.477072333786736 - }, - { - "x": 3.5594390798942475, - "y": 1.7176676369691386, - "heading": -0.4341632224479872, - "angularVelocity": 0.5593126667648981, - "velocityX": 2.569745819003335, - "velocityY": -1.7530658341888512, - "timestamp": 7.540041194449657 - }, - { - "x": 3.7272023835124437, - "y": 1.6211781420495261, - "heading": -0.39865477290597295, - "angularVelocity": 0.5639049074128062, - "velocityX": 2.6642264422767874, - "velocityY": -1.53233668044482, - "timestamp": 7.603010055112578 - }, - { - "x": 3.899888221446412, - "y": 1.5389840565105595, - "heading": -0.3631603025642866, - "angularVelocity": 0.5636829056141273, - "velocityX": 2.742400547127167, - "velocityY": -1.3053132083643786, - "timestamp": 7.665978915775499 - }, - { - "x": 4.076696851523407, - "y": 1.4713359142845162, - "heading": -0.3279103897160568, - "angularVelocity": 0.5597991209802323, - "velocityX": 2.807874054184828, - "velocityY": -1.0743110406296095, - "timestamp": 7.72894777643842 - }, - { - "x": 4.256993589599204, - "y": 1.4183982591672766, - "heading": -0.2930847973848664, - "angularVelocity": 0.5530605439665741, - "velocityX": 2.863268227782371, - "velocityY": -0.8406957750215746, - "timestamp": 7.791916637101341 - }, - { - "x": 4.44026531147135, - "y": 1.3802827225820995, - "heading": -0.2588270299037879, - "angularVelocity": 0.5440429939563951, - "velocityX": 2.9105135449920296, - "velocityY": -0.6053077058073763, - "timestamp": 7.854885497764262 + "angularVelocity": 1.4318885213105956e-25, + "velocityX": -3.1664598929952935e-25, + "velocityY": -8.517319099705152e-26, + "timestamp": 6.500382145394218 + }, + { + "x": 2.254662845986897, + "y": 3.5873395415687703, + "heading": -0.7560028105976356, + "angularVelocity": 0.18270874766778025, + "velocityX": 0.10724881682251722, + "velocityY": -0.18563544290641987, + "timestamp": 6.560571871079167 + }, + { + "x": 2.267640389134434, + "y": 3.5649741905137224, + "heading": -0.7343324319976283, + "angularVelocity": 0.3600345134223772, + "velocityX": 0.2156106046315132, + "velocityY": -0.3715808769774839, + "timestamp": 6.620761596764117 + }, + { + "x": 2.2872156815111926, + "y": 3.5313939684851823, + "heading": -0.7023698583511744, + "angularVelocity": 0.5310303923589071, + "velocityX": 0.3252264760138822, + "velocityY": -0.5579062148298977, + "timestamp": 6.680951322449067 + }, + { + "x": 2.313473905100035, + "y": 3.486574818355693, + "heading": -0.6605397935243593, + "angularVelocity": 0.6949701855390652, + "velocityX": 0.4362575720362232, + "velocityY": -0.7446312409544028, + "timestamp": 6.741141048134017 + }, + { + "x": 2.3465132166718874, + "y": 3.4304964860969096, + "heading": -0.6092924367494605, + "angularVelocity": 0.851430309603703, + "velocityX": 0.54891945752984, + "velocityY": -0.9316927701633545, + "timestamp": 6.801330773818966 + }, + { + "x": 2.3864518087256505, + "y": 3.3631500739334586, + "heading": -0.5490846408400017, + "angularVelocity": 1.0003002210809777, + "velocityX": 0.6635450087081837, + "velocityY": -1.118902128179834, + "timestamp": 6.861520499503916 + }, + { + "x": 2.4334407524616903, + "y": 3.284548274129898, + "heading": -0.48037214659109057, + "angularVelocity": 1.1415983951907667, + "velocityX": 0.7806804766313955, + "velocityY": -1.3059006152476056, + "timestamp": 6.921710225188866 + }, + { + "x": 2.4876845583004745, + "y": 3.194738200368583, + "heading": -0.4036330691658326, + "angularVelocity": 1.2749531012474145, + "velocityX": 0.9012137075139995, + "velocityY": -1.4921163494149543, + "timestamp": 6.9818999508738155 + }, + { + "x": 2.549471334765238, + "y": 3.093817881877023, + "heading": -0.3194506455237171, + "angularVelocity": 1.3986178319328149, + "velocityX": 1.0265336112042236, + "velocityY": -1.6767034131340948, + "timestamp": 7.042089676558765 + }, + { + "x": 2.619215453459605, + "y": 2.98196209624742, + "heading": -0.22869362474666396, + "angularVelocity": 1.5078490513829745, + "velocityX": 1.1587379390866084, + "velocityY": -1.858386699003879, + "timestamp": 7.102279402243715 + }, + { + "x": 2.6975187688111633, + "y": 2.859476881700614, + "heading": -0.13286180386406954, + "angularVelocity": 1.592162446198965, + "velocityX": 1.3009415553980122, + "velocityY": -2.0349854257174798, + "timestamp": 7.162469127928665 + }, + { + "x": 2.7852562883718943, + "y": 2.726945932671376, + "heading": -0.034753273861128454, + "angularVelocity": 1.6299879902505128, + "velocityX": 1.4576826619874292, + "velocityY": -2.201886576505485, + "timestamp": 7.2226588536136145 + }, + { + "x": 2.883617018333608, + "y": 2.5856822162797477, + "heading": 0.06025595074389153, + "angularVelocity": 1.5784957237108086, + "velocityX": 1.6341780734566165, + "velocityY": -2.3469739192871995, + "timestamp": 7.282848579298564 + }, + { + "x": 2.993618091797967, + "y": 2.439544726598588, + "heading": 0.14260766445208392, + "angularVelocity": 1.3682021768838868, + "velocityX": 1.8275722677344666, + "velocityY": -2.427947428205354, + "timestamp": 7.343038304983514 + }, + { + "x": 3.1145276346410644, + "y": 2.293581984129882, + "heading": 0.20384383077417081, + "angularVelocity": 1.017385702048459, + "velocityX": 2.008807009288801, + "velocityY": -2.425044155089132, + "timestamp": 7.403228030668464 + }, + { + "x": 3.2468175816396365, + "y": 2.1505705427004553, + "heading": 0.24757858696307516, + "angularVelocity": 0.7266149777426218, + "velocityX": 2.197882537146209, + "velocityY": -2.3760108523834984, + "timestamp": 7.463417756353413 + }, + { + "x": 3.390280853000983, + "y": 2.013955912336661, + "heading": 0.2801226137384155, + "angularVelocity": 0.5406907309344624, + "velocityX": 2.3835176141568395, + "velocityY": -2.269733394016016, + "timestamp": 7.523607482038363 + }, + { + "x": 3.544035674658465, + "y": 1.8860535950620219, + "heading": 0.3061151888137327, + "angularVelocity": 0.43184405277687576, + "velocityX": 2.55450278112711, + "velocityY": -2.1249858812136204, + "timestamp": 7.583797207723313 + }, + { + "x": 3.7070451600522367, + "y": 1.7682529006317282, + "heading": 0.3281829520976596, + "angularVelocity": 0.36663671470170595, + "velocityX": 2.7082609787426026, + "velocityY": -1.9571561938476998, + "timestamp": 7.643986933408263 + }, + { + "x": 3.8782577243031593, + "y": 1.6615213018872745, + "heading": 0.34797198576359334, + "angularVelocity": 0.328777601837151, + "velocityX": 2.844548007198066, + "velocityY": -1.7732527857514622, + "timestamp": 7.704176659093212 + }, + { + "x": 4.056668173911873, + "y": 1.5665668328609006, + "heading": 0.3664586508169338, + "angularVelocity": 0.30713987882425087, + "velocityX": 2.964134618964106, + "velocityY": -1.5775860073427241, + "timestamp": 7.764366384778162 + }, + { + "x": 4.241342350555325, + "y": 1.4839195959237403, + "heading": 0.38411092010286374, + "angularVelocity": 0.2932771180637541, + "velocityX": 3.0682010017804235, + "velocityY": -1.3731120385854438, + "timestamp": 7.824556110463112 + }, + { + "x": 4.431417064671585, + "y": 1.4139831463989663, + "heading": 0.40101516097721396, + "angularVelocity": 0.2808492758852529, + "velocityX": 3.1579262399560672, + "velocityY": -1.1619333487386434, + "timestamp": 7.884745836148062 }, { "x": 4.626090049743652, "y": 1.3570671081542969, - "heading": -0.2252540457724002, - "angularVelocity": 0.5331680417580931, - "velocityX": 2.9510576547834098, - "velocityY": -0.36868404769268887, - "timestamp": 7.917854358427183 - }, - { - "x": 4.7795228983991676, - "y": 1.3480834353037912, - "heading": -0.19832188482827373, - "angularVelocity": 0.5230176690450782, - "velocityX": 2.9796380255277914, - "velocityY": -0.17446129345071068, - "timestamp": 7.969348146377596 - }, - { - "x": 4.934335051267773, - "y": 1.3491130117158807, - "heading": -0.172056740336727, - "angularVelocity": 0.5100643308050932, - "velocityX": 3.006423862577084, - "velocityY": 0.01999418673726334, - "timestamp": 8.02084193432801 - }, - { - "x": 5.090413948118965, - "y": 1.360168884425071, - "heading": -0.14663402653796817, - "angularVelocity": 0.49370447991202765, - "velocityX": 3.0310238004143737, - "velocityY": 0.21470303796327495, - "timestamp": 8.072335722278423 - }, - { - "x": 5.247619566908618, - "y": 1.3812649191155169, - "heading": -0.12227147866608945, - "angularVelocity": 0.47311625035895943, - "velocityX": 3.0529045356119044, - "velocityY": 0.40968115825467694, - "timestamp": 8.123829510228836 - }, - { - "x": 5.4057731675659, - "y": 1.4124150256360237, - "heading": -0.09924657329539176, - "angularVelocity": 0.44713947618050653, - "velocityX": 3.071314171130302, - "velocityY": 0.6049294052809526, - "timestamp": 8.175323298179249 - }, - { - "x": 5.5646390861224075, - "y": 1.45363107671834, - "heading": -0.07792489052125452, - "angularVelocity": 0.4140632030152733, - "velocityX": 3.0851472552279695, - "velocityY": 0.800408218599227, - "timestamp": 8.226817086129662 - }, - { - "x": 5.723893474298032, - "y": 1.5049174237552059, - "heading": -0.05880915750982748, - "angularVelocity": 0.3712240596833731, - "velocityX": 3.092691264604229, - "velocityY": 0.9959715351733922, - "timestamp": 8.278310874080075 - }, - { - "x": 5.883066591645663, - "y": 1.5662557379507007, - "heading": -0.042630346143135614, - "angularVelocity": 0.3141895752992888, - "velocityX": 3.0911129999002838, - "velocityY": 1.1911789098631071, - "timestamp": 8.329804662030488 - }, - { - "x": 6.041427156723219, - "y": 1.6375588012052558, - "heading": -0.030529304649750223, - "angularVelocity": 0.23500002573200407, - "velocityX": 3.0753333825442057, - "velocityY": 1.3846925249161675, - "timestamp": 8.381298449980902 - }, - { - "x": 6.197735616366119, - "y": 1.7185102905390748, - "heading": -0.02440648394476851, - "angularVelocity": 0.11890406491124374, - "velocityX": 3.03548186809291, - "velocityY": 1.5720632052117265, - "timestamp": 8.432792237931315 - }, - { - "x": 6.350878760533044, - "y": 1.8088430675496858, - "heading": -0.02370516902673881, - "angularVelocity": 0.013619408203277727, - "velocityX": 2.974012017030059, - "velocityY": 1.7542461062992514, - "timestamp": 8.484286025881728 - }, - { - "x": 6.49883867677636, - "y": 1.9078525669236166, - "heading": -0.023705030592543242, - "angularVelocity": 0.00000268836690944849, - "velocityX": 2.87335467310732, - "velocityY": 1.9227464770949503, - "timestamp": 8.535779813832141 - }, - { - "x": 6.6368843214415145, - "y": 2.005708147416312, - "heading": -0.02031833183947682, - "angularVelocity": 0.06576907405467476, - "velocityX": 2.6808213215560657, - "velocityY": 1.900337582213362, - "timestamp": 8.587273601782554 - }, - { - "x": 6.769983495130022, - "y": 2.0947496708967734, - "heading": -0.01623761727675861, - "angularVelocity": 0.07924673490029181, - "velocityX": 2.5847617544989827, - "velocityY": 1.7291701975043279, - "timestamp": 8.638767389732967 - }, - { - "x": 6.899277502176466, - "y": 2.174423732821602, - "heading": -0.012170511581318438, - "angularVelocity": 0.07898245317195698, - "velocityX": 2.5108661101209155, - "velocityY": 1.5472557971760095, - "timestamp": 8.69026117768338 - }, - { - "x": 7.025204876144901, - "y": 2.244564567879159, - "heading": -0.008393313807594099, - "angularVelocity": 0.07335249403989616, - "velocityX": 2.4454867078277336, - "velocityY": 1.3621222646331712, - "timestamp": 8.741754965633794 - }, - { - "x": 7.147995814523978, - "y": 2.305094760936356, - "heading": -0.0050511985797586055, - "angularVelocity": 0.06490327010034411, - "velocityX": 2.3845776989123575, - "velocityY": 1.1754853442804831, - "timestamp": 8.793248753584207 - }, - { - "x": 7.267791877830481, - "y": 2.3559698887494838, - "heading": -0.002233336230350155, - "angularVelocity": 0.05472237451480506, - "velocityX": 2.3264177694960773, - "velocityY": 0.987985732611455, - "timestamp": 8.84474254153462 - }, - { - "x": 7.384688854217529, - "y": 2.3971612453460693, - "heading": 1.0925161153472216e-27, - "angularVelocity": 0.04337098355438129, - "velocityX": 2.2701180285982674, - "velocityY": 0.7999286561759968, - "timestamp": 8.896236329485033 - }, - { - "x": 7.544023620191157, - "y": 2.435966203020954, - "heading": 0.0019011246470178535, - "angularVelocity": 0.026160817083458833, - "velocityX": 2.192558848895233, - "velocityY": 0.5339836087320412, - "timestamp": 8.968907020195987 - }, - { - "x": 7.693524178473687, - "y": 2.4572035222971533, - "heading": 0.002758770210903803, - "angularVelocity": 0.011801808342475038, - "velocityX": 2.0572332094264283, - "velocityY": 0.2922405039559972, - "timestamp": 9.04157771090694 - }, - { - "x": 7.829036837050654, - "y": 2.463958358878795, - "heading": 0.0028691396117968893, - "angularVelocity": 0.0015187608623685705, - "velocityX": 1.8647498358859305, - "velocityY": 0.09295131937728546, - "timestamp": 9.114248401617894 - }, - { - "x": 7.947320999686337, - "y": 2.4602902191152674, - "heading": 0.0025271461142305205, - "angularVelocity": -0.0047060719283190024, - "velocityX": 1.627673570713082, - "velocityY": -0.05047619236368362, - "timestamp": 9.186919092328848 - }, - { - "x": 8.046460357109755, - "y": 2.4503798577507845, - "heading": 0.001958139051774138, - "angularVelocity": -0.007829938822511021, - "velocityX": 1.3642275373127128, - "velocityY": -0.13637356776890003, - "timestamp": 9.259589783039802 - }, - { - "x": 8.125632240809198, - "y": 2.437861956883479, - "heading": 0.0013192069681426308, - "angularVelocity": -0.008792156471621461, - "velocityX": 1.0894610044969755, - "velocityY": -0.17225515190292298, - "timestamp": 9.332260473750756 - }, - { - "x": 8.184669067426317, - "y": 2.4256259475095856, - "heading": 0.0007241468388369009, - "angularVelocity": -0.008188447412349163, - "velocityX": 0.8123884063788063, - "velocityY": -0.16837612597576837, - "timestamp": 9.40493116446171 - }, - { - "x": 8.22372517511611, - "y": 2.4158933838582373, - "heading": 0.00026082496046711366, - "angularVelocity": -0.006375636089832219, - "velocityX": 0.5374396102156157, - "velocityY": -0.13392694573469127, - "timestamp": 9.477601855172663 + "heading": 0.41697492722531376, + "angularVelocity": 0.26515765052058465, + "velocityX": 3.2343225169531657, + "velocityY": -0.9456105273279376, + "timestamp": 7.944935561833011 + }, + { + "x": 4.771095590246596, + "y": 1.3224217071642599, + "heading": 0.4280403505516019, + "angularVelocity": 0.2504578977864778, + "velocityX": 3.2820961088293013, + "velocityY": -0.7841737314576779, + "timestamp": 7.989116334026994 + }, + { + "x": 4.917956708237317, + "y": 1.2949736641198544, + "heading": 0.43814957517205777, + "angularVelocity": 0.22881502786030425, + "velocityX": 3.3240957705742336, + "velocityY": -0.6212667113171019, + "timestamp": 8.033297106220976 + }, + { + "x": 5.066406183363406, + "y": 1.2747799857702726, + "heading": 0.4470279058701966, + "angularVelocity": 0.20095462929342126, + "velocityX": 3.3600470918502436, + "velocityY": -0.45706938441270734, + "timestamp": 8.077477878414959 + }, + { + "x": 5.21616079891639, + "y": 1.2618903010738838, + "heading": 0.45444388098508137, + "angularVelocity": 0.16785526251835975, + "velocityX": 3.389588006643782, + "velocityY": -0.2917487417330471, + "timestamp": 8.121658650608941 + }, + { + "x": 5.366915459547734, + "y": 1.25634723736205, + "heading": 0.46022561365529296, + "angularVelocity": 0.13086536027088905, + "velocityX": 3.4122233076740254, + "velocityY": -0.12546326006925063, + "timestamp": 8.165839422802923 + }, + { + "x": 5.518334246127743, + "y": 1.2581861921582334, + "heading": 0.4642859914379861, + "angularVelocity": 0.09190373053837578, + "velocityX": 3.427255320825579, + "velocityY": 0.041623419077170896, + "timestamp": 8.210020194996906 + }, + { + "x": 5.670036777042452, + "y": 1.2674335281135962, + "heading": 0.46666317405037006, + "angularVelocity": 0.05380581855714505, + "velocityX": 3.4336776697481812, + "velocityY": 0.20930679787037068, + "timestamp": 8.254200967190888 + }, + { + "x": 5.821577538212164, + "y": 1.284100828351401, + "heading": 0.4675873844825302, + "angularVelocity": 0.020918838360320994, + "velocityX": 3.4300161279288752, + "velocityY": 0.3772523523270378, + "timestamp": 8.29838173938487 + }, + { + "x": 5.972415606183977, + "y": 1.3081694677842932, + "heading": 0.467591351779606, + "angularVelocity": 0.00008979691569104718, + "velocityX": 3.414111172831806, + "velocityY": 0.544776341328194, + "timestamp": 8.342562511578853 + }, + { + "x": 6.121903298527153, + "y": 1.3395574928087577, + "heading": 0.46759157023044867, + "angularVelocity": 0.000004944477695120892, + "velocityX": 3.3835463917839124, + "velocityY": 0.7104453694618647, + "timestamp": 8.386743283772836 + }, + { + "x": 6.269684547080798, + "y": 1.3781901650520143, + "heading": 0.46759176450370754, + "angularVelocity": 0.0000043972354751028654, + "velocityX": 3.3449222640289906, + "velocityY": 0.8744227482859289, + "timestamp": 8.430924055966818 + }, + { + "x": 6.415408472766336, + "y": 1.423975753200933, + "heading": 0.4675919413300162, + "angularVelocity": 0.000004002336308335113, + "velocityX": 3.2983562407129146, + "velocityY": 1.036323854818335, + "timestamp": 8.4751048281608 + }, + { + "x": 6.5587290836787195, + "y": 1.476805540848842, + "heading": 0.4675921046539949, + "angularVelocity": 0.0000036967207824585226, + "velocityX": 3.243958939493236, + "velocityY": 1.1957642436839244, + "timestamp": 8.519285600354783 + }, + { + "x": 6.6993060573570675, + "y": 1.5365540678009835, + "heading": 0.46759241978399874, + "angularVelocity": 0.000007132740968196116, + "velocityX": 3.1818586841606873, + "velocityY": 1.352364931282918, + "timestamp": 8.563466372548765 + }, + { + "x": 6.836206251960683, + "y": 1.6027005176579716, + "heading": 0.47022361687585157, + "angularVelocity": 0.059555253590862826, + "velocityX": 3.0986374344598233, + "velocityY": 1.4971773142977605, + "timestamp": 8.607647144742748 + }, + { + "x": 6.968107168767895, + "y": 1.6730618727776314, + "heading": 0.48242555808722076, + "angularVelocity": 0.27618216263388745, + "velocityX": 2.9854823774487342, + "velocityY": 1.592578663196003, + "timestamp": 8.65182791693673 + }, + { + "x": 7.094292994493853, + "y": 1.7449092475770878, + "heading": 0.5050066138251464, + "angularVelocity": 0.5111059543907503, + "velocityX": 2.8561254016095394, + "velocityY": 1.6262136497750488, + "timestamp": 8.696008689130712 + }, + { + "x": 7.213566146886095, + "y": 1.8140035101921348, + "heading": 0.5272178489693323, + "angularVelocity": 0.5027353312582225, + "velocityX": 2.699662012890034, + "velocityY": 1.5638989357559931, + "timestamp": 8.740189461324695 + }, + { + "x": 7.326317415042033, + "y": 1.87970672983894, + "heading": 0.5469886414915726, + "angularVelocity": 0.44749766788668743, + "velocityX": 2.552043854301269, + "velocityY": 1.4871451172995578, + "timestamp": 8.784370233518677 + }, + { + "x": 7.432769298553467, + "y": 1.941792130470276, + "heading": 0.5633166974965059, + "angularVelocity": 0.3695738031296167, + "velocityX": 2.409461813932093, + "velocityY": 1.405258386130975, + "timestamp": 8.82855100571266 + }, + { + "x": 7.579701459580911, + "y": 2.027179132105106, + "heading": 0.5787605568170214, + "angularVelocity": 0.23108320735340232, + "velocityX": 2.198514913204677, + "velocityY": 1.2776276832472448, + "timestamp": 8.895383466181745 + }, + { + "x": 7.712165331896003, + "y": 2.1039708729412734, + "heading": 0.5887351557050889, + "angularVelocity": 0.14924781787259772, + "velocityX": 1.9820289629523165, + "velocityY": 1.1490186100763133, + "timestamp": 8.96221592665083 + }, + { + "x": 7.830026910442582, + "y": 2.172172632129026, + "heading": 0.5950957258261598, + "angularVelocity": 0.09517186822731284, + "velocityX": 1.7635379233284407, + "velocityY": 1.0204885277162767, + "timestamp": 9.029048387119914 + }, + { + "x": 7.933222174835435, + "y": 2.231800820984951, + "heading": 0.5989654042474855, + "angularVelocity": 0.05790118146429404, + "velocityX": 1.54408896019307, + "velocityY": 0.8922040044224955, + "timestamp": 9.095880847589 + }, + { + "x": 8.021715394731531, + "y": 2.28287256797719, + "heading": 0.6011062262493081, + "angularVelocity": 0.032032667760495764, + "velocityX": 1.3241053714763598, + "velocityY": 0.7641757707822818, + "timestamp": 9.162713308058084 + }, + { + "x": 8.095484569673351, + "y": 2.3254034695687893, + "heading": 0.6020727831826357, + "angularVelocity": 0.014462387386960431, + "velocityX": 1.103792594557322, + "velocityY": 0.6363809037267617, + "timestamp": 9.229545768527169 + }, + { + "x": 8.154515205691396, + "y": 2.359407222237499, + "heading": 0.6022883195935687, + "angularVelocity": 0.003225025824578962, + "velocityX": 0.8832629474318238, + "velocityY": 0.5087909741769772, + "timestamp": 9.296378228996254 + }, + { + "x": 8.198797270954351, + "y": 2.3848957424596233, + "heading": 0.6020871548762373, + "angularVelocity": -0.00300998520658142, + "velocityX": 0.6625831961317433, + "velocityY": 0.38137934834697124, + "timestamp": 9.363210689465339 + }, + { + "x": 8.22832355571237, + "y": 2.401879399345903, + "heading": 0.6017403922656039, + "angularVelocity": -0.005188535753427844, + "velocityX": 0.44179556686643673, + "velocityY": 0.2541228733324269, + "timestamp": 9.430043149934423 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.641597245625212e-27, - "angularVelocity": -0.003589135563669573, - "velocityX": 0.2664560763556175, - "velocityY": -0.07604349651378031, - "timestamp": 9.550272545883617 + "heading": 0.601472494720935, + "angularVelocity": -0.004008494417063559, + "velocityX": 0.220928070177263, + "velocityY": 0.12700192446944059, + "timestamp": 9.496875610403508 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.361709629410748e-27, - "angularVelocity": -2.7031559762411205e-27, - "velocityX": -9.369534952913017e-27, - "velocityY": 1.2495007628787807e-26, - "timestamp": 9.62294323659457 - }, - { - "x": 8.226158676304896, - "y": 2.39881983179468, - "heading": -0.006877427807321125, - "angularVelocity": -0.09330877742815909, - "velocityX": -0.22969661496110166, - "velocityY": -0.156668386301737, - "timestamp": 9.696649355106478 - }, - { - "x": 8.192214379382103, - "y": 2.375824029071353, - "heading": -0.02042318457451623, - "angularVelocity": -0.1837806282663857, - "velocityX": -0.46053567340288404, - "velocityY": -0.31199313147403995, - "timestamp": 9.770355473618386 - }, - { - "x": 8.141157712275694, - "y": 2.3414994370245448, - "heading": -0.04041111919819324, - "angularVelocity": -0.2711841978281327, - "velocityX": -0.6927059535519965, - "velocityY": -0.4656952874443208, - "timestamp": 9.844061592130293 - }, - { - "x": 8.072871873312724, - "y": 2.2959933778891304, - "heading": -0.06658143602528521, - "angularVelocity": -0.3550630172292133, - "velocityX": -0.9264609280969917, - "velocityY": -0.6173986645092744, - "timestamp": 9.9177677106422 - }, - { - "x": 7.987214671186942, - "y": 2.2394915863103373, - "heading": -0.09861576889513941, - "angularVelocity": -0.4346224372767477, - "velocityX": -1.162145068213624, - "velocityY": -0.7665821063371371, - "timestamp": 9.991473829154108 - }, - { - "x": 7.884008802473217, - "y": 2.172234906435376, - "heading": -0.13609803770657058, - "angularVelocity": -0.5085367343740341, - "velocityX": -1.4002347538766595, - "velocityY": -0.912497920564022, - "timestamp": 10.065179947666016 - }, - { - "x": 7.763027309866044, - "y": 2.094546996792591, - "heading": -0.17845040239942064, - "angularVelocity": -0.5746112473146674, - "velocityX": -1.641403658878437, - "velocityY": -1.0540225317961092, - "timestamp": 10.138886066177923 - }, - { - "x": 7.62397118691996, - "y": 2.006883956661221, - "heading": -0.2248232665285972, - "angularVelocity": -0.629158949968104, - "velocityX": -1.886629302336939, - "velocityY": -1.1893590640946199, - "timestamp": 10.21259218468983 - }, - { - "x": 7.466434514515364, - "y": 1.9099324511701785, - "heading": -0.27389375566621527, - "angularVelocity": -0.6657586931496106, - "velocityX": -2.1373622106982135, - "velocityY": -1.3153793395778879, - "timestamp": 10.286298303201738 - }, - { - "x": 7.289854840689643, - "y": 1.804830584603728, - "heading": -0.3234648033769676, - "angularVelocity": -0.6725499688705452, - "velocityX": -2.3957261268234205, - "velocityY": -1.4259585050523371, - "timestamp": 10.360004421713645 - }, - { - "x": 7.09349466770107, - "y": 1.6937580255692442, - "heading": -0.36961157284527874, - "angularVelocity": -0.6260914344696605, - "velocityX": -2.6640959658844117, - "velocityY": -1.5069652462643142, - "timestamp": 10.433710540225553 - }, - { - "x": 6.877068006621772, - "y": 1.582017096134685, - "heading": -0.404526427119755, - "angularVelocity": -0.47370360805033435, - "velocityX": -2.9363459296032848, - "velocityY": -1.5160332912729142, - "timestamp": 10.50741665873746 - }, - { - "x": 6.6462528315178435, - "y": 1.4799569127662018, - "heading": -0.41206265680654897, - "angularVelocity": -0.10224700254126708, - "velocityX": -3.1315605781986564, - "velocityY": -1.3846907886214979, - "timestamp": 10.581122777249368 - }, - { - "x": 6.4056948947586605, - "y": 1.3958836435808737, - "heading": -0.41206291975932646, - "angularVelocity": -0.000003567584113860408, - "velocityX": -3.263744470824617, - "velocityY": -1.1406552248677344, - "timestamp": 10.654828895761275 - }, - { - "x": 6.159103024623084, - "y": 1.3316270436788393, - "heading": -0.4120630054756099, - "angularVelocity": -0.000001162946648180674, - "velocityX": -3.3456092264000836, - "velocityY": -0.8717946515071634, - "timestamp": 10.728535014273183 - }, - { - "x": 5.9081067866465835, - "y": 1.287611751699688, - "heading": -0.4120631078550631, - "angularVelocity": -0.0000013890224484364198, - "velocityX": -3.405365023202921, - "velocityY": -0.5971728381279531, - "timestamp": 10.80224113278509 - }, - { - "x": 5.654364802463367, - "y": 1.264128631365538, - "heading": -0.41206324014800777, - "angularVelocity": -0.0000017948705930666049, - "velocityX": -3.4426176456737716, - "velocityY": -0.3186047618333884, - "timestamp": 10.875947251296997 - }, - { - "x": 5.399553844443695, - "y": 1.2613328653452982, - "heading": -0.41206343250085, - "angularVelocity": -0.0000026097269279134345, - "velocityX": -3.457120835612934, - "velocityY": -0.03793126102262585, - "timestamp": 10.949653369808905 - }, - { - "x": 5.145357769299496, - "y": 1.2792429283311064, - "heading": -0.4120637802864744, - "angularVelocity": -0.000004718544828723013, - "velocityX": -3.4487784769609244, - "velocityY": 0.24299289322791767, - "timestamp": 11.023359488320812 - }, - { - "x": 4.893457071523925, - "y": 1.3177403844081093, - "heading": -0.41206670780497134, - "angularVelocity": -0.00003971879887349745, - "velocityX": -3.4176361862668707, - "velocityY": 0.5223101806776501, - "timestamp": 11.09706560683272 + "heading": 0.601472494720935, + "angularVelocity": 2.0480668095758719e-22, + "velocityX": 1.6959236187935907e-23, + "velocityY": -2.878465592599261e-23, + "timestamp": 9.563708070872593 + }, + { + "x": 8.225716112229817, + "y": 2.403169142964958, + "heading": 0.6014724848808553, + "angularVelocity": -1.401208853680834e-7, + "velocityX": -0.24738269796567666, + "velocityY": -0.10249969625322676, + "timestamp": 9.633933717783428 + }, + { + "x": 8.190970892472077, + "y": 2.3887729281095678, + "heading": 0.6014724652007141, + "angularVelocity": -2.802415057039817e-7, + "velocityX": -0.49476539250476237, + "velocityY": -0.20499939108669155, + "timestamp": 9.704159364694263 + }, + { + "x": 8.138853063244545, + "y": 2.3671786059959783, + "heading": 0.6014724356805342, + "angularVelocity": -4.203618073354203e-7, + "velocityX": -0.7421480829319401, + "velocityY": -0.30749908421644245, + "timestamp": 9.774385011605098 + }, + { + "x": 8.069362624900151, + "y": 2.3383861767704226, + "heading": 0.6014723963203429, + "angularVelocity": -5.604817189302354e-7, + "velocityX": -0.9895307683334543, + "velocityY": -0.40999877526387724, + "timestamp": 9.844610658515933 + }, + { + "x": 7.982499577880061, + "y": 2.3023956406156896, + "heading": 0.6014723471201746, + "angularVelocity": -7.006011425140131e-7, + "velocityX": -1.2369134474528922, + "velocityY": -0.5124984637084178, + "timestamp": 9.914836305426768 + }, + { + "x": 7.878263922751481, + "y": 2.259206997766796, + "heading": 0.601472288080073, + "angularVelocity": -8.407199383581404e-7, + "velocityX": -1.484296118495379, + "velocityY": -0.6149981488063821, + "timestamp": 9.985061952337603 + }, + { + "x": 7.756655660270691, + "y": 2.2088202485370934, + "heading": 0.6014722192000971, + "angularVelocity": -9.808378971745156e-7, + "velocityX": -1.7316787787686057, + "velocityY": -0.7174978294422485, + "timestamp": 10.055287599248437 + }, + { + "x": 7.617674791496479, + "y": 2.1512353933652784, + "heading": 0.6014721404803293, + "angularVelocity": -0.0000011209546846231955, + "velocityX": -1.979061423964885, + "velocityY": -0.8199975038311836, + "timestamp": 10.125513246159272 + }, + { + "x": 7.461321318017023, + "y": 2.0864524329093923, + "heading": 0.6014720519208926, + "angularVelocity": -0.0000012610697164822291, + "velocityX": -2.226444046545777, + "velocityY": -0.9224971688497368, + "timestamp": 10.195738893070107 + }, + { + "x": 7.287595242479287, + "y": 2.014471368266166, + "heading": 0.6014719535219923, + "angularVelocity": -0.0000014011818267188707, + "velocityX": -2.4738266314344535, + "velocityY": -1.0249968182510263, + "timestamp": 10.265964539980942 + }, + { + "x": 7.096496570177163, + "y": 1.935292201629055, + "heading": 0.6014718452840377, + "angularVelocity": -0.0000015412881098024927, + "velocityX": -2.7212091409390613, + "velocityY": -1.1274964364179387, + "timestamp": 10.336190186891777 + }, + { + "x": 6.8880253169921275, + "y": 1.8489149395783349, + "heading": 0.601471727208249, + "angularVelocity": -0.0000016813770192107404, + "velocityX": -2.9685914242944573, + "velocityY": -1.2299959608829605, + "timestamp": 10.406415833802612 + }, + { + "x": 6.663723389677425, + "y": 1.7559784504804536, + "heading": 0.6014717272081879, + "angularVelocity": -8.702352256817885e-13, + "velocityX": -3.1940172455726326, + "velocityY": -1.3233981200042444, + "timestamp": 10.476641480713447 + }, + { + "x": 6.439421272188231, + "y": 1.6630424203676835, + "heading": 0.6014717272081268, + "angularVelocity": -8.703596574297939e-13, + "velocityX": -3.1940199536216154, + "velocityY": -1.3233915841426174, + "timestamp": 10.546867127624282 + }, + { + "x": 6.212032631338727, + "y": 1.577936888330409, + "heading": 0.6014717272080651, + "angularVelocity": -8.787789669679053e-13, + "velocityX": -3.237971465584607, + "velocityY": -1.2118867647503735, + "timestamp": 10.617092774535116 + }, + { + "x": 5.978739653450143, + "y": 1.510684142319498, + "heading": 0.6014717272080008, + "angularVelocity": -9.15623540134239e-13, + "velocityX": -3.32204811419955, + "velocityY": -0.9576664504963734, + "timestamp": 10.687318421445951 + }, + { + "x": 5.7409415584912775, + "y": 1.4616883276374903, + "heading": 0.601471727201828, + "angularVelocity": -8.790086201060278e-11, + "velocityX": -3.386200133703241, + "velocityY": -0.6976911831686963, + "timestamp": 10.757544068356786 + }, + { + "x": 5.516819527735436, + "y": 1.4255992428677315, + "heading": 0.6014714661772929, + "angularVelocity": -0.000003716940268980297, + "velocityX": -3.1914555524195745, + "velocityY": -0.513901777445793, + "timestamp": 10.827769715267621 + }, + { + "x": 5.308884526984856, + "y": 1.3990809310343755, + "heading": 0.6014711092836408, + "angularVelocity": -0.0000050820984614807965, + "velocityX": -2.9609552905164764, + "velocityY": -0.3776157714435294, + "timestamp": 10.897995362178456 + }, + { + "x": 5.1176297142242815, + "y": 1.3812454338123161, + "heading": 0.6014706963446639, + "angularVelocity": -0.000005880173340714845, + "velocityX": -2.7234325516916758, + "velocityY": -0.253974124933375, + "timestamp": 10.96822100908929 + }, + { + "x": 4.943259966846924, + "y": 1.3716872939772524, + "heading": 0.6014702453730658, + "angularVelocity": -0.000006421750712363147, + "velocityX": -2.482992397332454, + "velocityY": -0.13610611301593797, + "timestamp": 11.038446656000126 + }, + { + "x": 4.785886935464025, + "y": 1.3701747617379714, + "heading": 0.6014697666441067, + "angularVelocity": -0.00000681701031230746, + "velocityX": -2.240962359274736, + "velocityY": -0.021538174524779245, + "timestamp": 11.10867230291096 }, { "x": 4.645580768585205, "y": 1.3765579462051392, - "heading": -0.4122949138101138, - "angularVelocity": -0.0030961609395507624, - "velocityX": -3.363035633177095, - "velocityY": 0.7980010748704317, - "timestamp": 11.170771725344627 - }, - { - "x": 4.443925231966549, - "y": 1.439020065928105, - "heading": -0.4125273897788825, - "angularVelocity": -0.003806087702589553, - "velocityX": -3.3014967617877016, - "velocityY": 1.0226274440941339, - "timestamp": 11.231851759998202 - }, - { - "x": 4.246892810528237, - "y": 1.5149356606131386, - "heading": -0.41260940539586727, - "angularVelocity": -0.0013427565562128022, - "velocityX": -3.2258072962108524, - "velocityY": 1.242887223551879, - "timestamp": 11.292931794651777 - }, - { - "x": 4.05539885725619, - "y": 1.6039545655503569, - "heading": -0.41261007048157244, - "angularVelocity": -0.000010888757822699568, - "velocityX": -3.1351317064264514, - "velocityY": 1.4574141197218358, - "timestamp": 11.354011829305351 - }, - { - "x": 3.870332686379004, - "y": 1.705664249073373, - "heading": -0.4126103244982615, - "angularVelocity": -0.000004158751555602436, - "velocityX": -3.029896297977233, - "velocityY": 1.6651870631685113, - "timestamp": 11.415091863958926 - }, - { - "x": 3.6925342411729205, - "y": 1.8196030932877822, - "heading": -0.4126105942683028, - "angularVelocity": -0.000004416664836793854, - "velocityX": -2.910909370213978, - "velocityY": 1.8654024160371316, - "timestamp": 11.4761718986125 - }, - { - "x": 3.5229313973486467, - "y": 1.9451682176450034, - "heading": -0.41310298698073444, - "angularVelocity": -0.00806143472616382, - "velocityX": -2.7767312966701, - "velocityY": 2.0557474315360964, - "timestamp": 11.537251933266075 - }, - { - "x": 3.3629080056368847, - "y": 2.081177909355995, - "heading": -0.41684782301867235, - "angularVelocity": -0.061310312922665575, - "velocityX": -2.6198968716923905, - "velocityY": 2.226745490279982, - "timestamp": 11.59833196791965 - }, - { - "x": 3.2138348018272307, - "y": 2.225828798378681, - "heading": -0.42779633021695374, - "angularVelocity": -0.17924854267646892, - "velocityX": -2.4406208125969044, - "velocityY": 2.368218843409276, - "timestamp": 11.659412002573225 - }, - { - "x": 3.076632646241407, - "y": 2.3767820823282975, - "heading": -0.45028005155414713, - "angularVelocity": -0.3681026290294955, - "velocityX": -2.2462684634019734, - "velocityY": 2.4714014130111956, - "timestamp": 11.7204920372268 - }, - { - "x": 2.953317405786702, - "y": 2.527452693090262, - "heading": -0.479539871258463, - "angularVelocity": -0.4790406533046003, - "velocityX": -2.018912418012011, - "velocityY": 2.466773498353727, - "timestamp": 11.781572071880374 - }, - { - "x": 2.8431421656158986, - "y": 2.6728620421564, - "heading": -0.5117573524705473, - "angularVelocity": -0.5274633748132465, - "velocityX": -1.8037848340407943, - "velocityY": 2.3806363223408726, - "timestamp": 11.842652106533949 - }, - { - "x": 2.7447582014328504, - "y": 2.8103234089599436, - "heading": -0.5448138902366748, - "angularVelocity": -0.541200376745252, - "velocityX": -1.6107385128552993, - "velocityY": 2.250512259581694, - "timestamp": 11.903732141187524 - }, - { - "x": 2.657040568190158, - "y": 2.9383742562516337, - "heading": -0.5774389967679732, - "angularVelocity": -0.5341370010075654, - "velocityX": -1.436109749121744, - "velocityY": 2.0964435927050773, - "timestamp": 11.964812175841098 - }, - { - "x": 2.579139377940474, - "y": 3.0561477275760893, - "heading": -0.6087739702949048, - "angularVelocity": -0.5130149926183435, - "velocityX": -1.2753953184786753, - "velocityY": 1.9281827849710216, - "timestamp": 12.025892210494673 - }, - { - "x": 2.5104135669776086, - "y": 3.1630880849973138, - "heading": -0.6382063942290674, - "angularVelocity": -0.4818665231788694, - "velocityX": -1.12517635840673, - "velocityY": 1.7508234569242558, - "timestamp": 12.086972245148248 - }, - { - "x": 2.450370390547826, - "y": 3.258815753261752, - "heading": -0.6652836730357979, - "angularVelocity": -0.4433081768912526, - "velocityX": -0.9830245966677624, - "velocityY": 1.5672497372893452, - "timestamp": 12.148052279801822 - }, - { - "x": 2.3986225657417113, - "y": 3.3430581424304706, - "heading": -0.6896607419023619, - "angularVelocity": -0.39910044263764155, - "velocityX": -0.8472134159649896, - "velocityY": 1.3792131855607757, - "timestamp": 12.209132314455397 - }, - { - "x": 2.354859160136495, - "y": 3.415611519736344, - "heading": -0.7110667492722108, - "angularVelocity": -0.35045833702054285, - "velocityX": -0.7164928090402631, - "velocityY": 1.1878411287317068, - "timestamp": 12.270212349108972 - }, - { - "x": 2.318825720632345, - "y": 3.4763186343010504, - "heading": -0.7292831614478376, - "angularVelocity": -0.2982384060347082, - "velocityX": -0.589938098570508, - "velocityY": 0.993894566514525, - "timestamp": 12.331292383762547 - }, - { - "x": 2.2903104575974997, - "y": 3.5250548695238315, - "heading": -0.7441289784624036, - "angularVelocity": -0.2430551504884782, - "velocityX": -0.4668507998820613, - "velocityY": 0.7979077860580311, - "timestamp": 12.392372418416121 - }, - { - "x": 2.269134426765791, - "y": 3.56171927991662, - "heading": -0.7554504777477656, - "angularVelocity": -0.18535515491394047, - "velocityX": -0.34669316990097204, - "velocityY": 0.6002683299172502, - "timestamp": 12.453452453069696 - }, - { - "x": 2.255144398175998, - "y": 3.586228565361257, - "heading": -0.7631138906211655, - "angularVelocity": -0.12546510356230606, - "velocityX": -0.22904421500642305, - "velocityY": 0.4012650874159682, - "timestamp": 12.51453248772327 + "heading": 0.6014692668007987, + "angularVelocity": -0.000007117674667444465, + "velocityX": -1.997933419637491, + "velocityY": 0.09089534590222227, + "timestamp": 11.178897949821796 + }, + { + "x": 4.4852918274531035, + "y": 1.4093136530981196, + "heading": 0.6014686169682122, + "angularVelocity": -0.00000794408595037517, + "velocityX": -1.9595033424539408, + "velocityY": 0.400432598081353, + "timestamp": 11.26069874988135 + }, + { + "x": 4.332045122157961, + "y": 1.4665930457792093, + "heading": 0.6014678756495806, + "angularVelocity": -0.000009062486322055742, + "velocityX": -1.8734132818208915, + "velocityY": 0.7002302256137938, + "timestamp": 11.342499549940904 + }, + { + "x": 4.189567990618789, + "y": 1.5470029255462814, + "heading": 0.6014669872102968, + "angularVelocity": -0.00001086100971182791, + "velocityX": -1.7417571886270768, + "velocityY": 0.9829962507522065, + "timestamp": 11.424300350000458 + }, + { + "x": 4.061325777655998, + "y": 1.6485874554715532, + "heading": 0.6014657443656565, + "angularVelocity": -0.00001519355115434508, + "velocityX": -1.567737881162854, + "velocityY": 1.2418525228520432, + "timestamp": 11.506101150060012 + }, + { + "x": 3.9499181722494128, + "y": 1.7683949151806115, + "heading": 0.5999046298375316, + "angularVelocity": -0.019084343025843265, + "velocityX": -1.3619378456625928, + "velocityY": 1.4646245467261332, + "timestamp": 11.587901950119566 + }, + { + "x": 3.8385139180743773, + "y": 1.888205491074706, + "heading": 0.5540381787699103, + "angularVelocity": -0.5607090766132972, + "velocityX": -1.361896877462441, + "velocityY": 1.4646626415251267, + "timestamp": 11.66970275017912 + }, + { + "x": 3.7271096639847774, + "y": 2.0080160670482403, + "heading": 0.4697368355238526, + "angularVelocity": -1.0305686886275442, + "velocityX": -1.361896876418011, + "velocityY": 1.4646626424962754, + "timestamp": 11.751503550238674 + }, + { + "x": 3.6157054099517287, + "y": 2.1278266430743598, + "heading": 0.3537615125967293, + "angularVelocity": -1.4177773670023999, + "velocityX": -1.3618968757266772, + "velocityY": 1.4646626431391025, + "timestamp": 11.833304350298228 + }, + { + "x": 3.504301155997762, + "y": 2.247637219174011, + "heading": 0.2137130812750941, + "angularVelocity": -1.7120667673137158, + "velocityX": -1.3618968747599156, + "velocityY": 1.4646626440380324, + "timestamp": 11.915105150357782 + }, + { + "x": 3.3928969021094617, + "y": 2.367447795334722, + "heading": 0.057794482937139194, + "angularVelocity": -1.9060766914802987, + "velocityX": -1.3618968739571615, + "velocityY": 1.4646626447844622, + "timestamp": 11.996905950417336 + }, + { + "x": 3.281492648234104, + "y": 2.487258371507466, + "heading": -0.105452505167902, + "angularVelocity": -1.995664932203507, + "velocityX": -1.3618968737989476, + "velocityY": 1.464662644931575, + "timestamp": 12.07870675047689 + }, + { + "x": 3.1700883943158846, + "y": 2.6070689476403572, + "heading": -0.26730664929832215, + "angularVelocity": -1.978637666289151, + "velocityX": -1.3618968743229085, + "velocityY": 1.4646626444443769, + "timestamp": 12.160507550536444 + }, + { + "x": 3.058684140329769, + "y": 2.7268795237101155, + "heading": -0.41916927419219197, + "angularVelocity": -1.8564931490072147, + "velocityX": -1.3618968751529306, + "velocityY": 1.4646626436725918, + "timestamp": 12.242308350595998 + }, + { + "x": 2.947279886280209, + "y": 2.846690099720882, + "heading": -0.5526625850121627, + "angularVelocity": -1.6319316036369287, + "velocityX": -1.3618968759285288, + "velocityY": 1.464662642951413, + "timestamp": 12.324109150655552 + }, + { + "x": 2.835875632186779, + "y": 2.966500675690855, + "heading": -0.65985673738226, + "angularVelocity": -1.3104291436276523, + "velocityX": -1.3618968764648283, + "velocityY": 1.464662642452743, + "timestamp": 12.405909950715106 + }, + { + "x": 2.7244713780717897, + "y": 3.086311251640782, + "heading": -0.7334716118848168, + "angularVelocity": -0.899928539194763, + "velocityX": -1.3618968767283959, + "velocityY": 1.4646626422076685, + "timestamp": 12.48771075077466 + }, + { + "x": 2.613067124142982, + "y": 3.2061218277638193, + "heading": -0.7669996227711985, + "angularVelocity": -0.4098738748517434, + "velocityX": -1.361896874452356, + "velocityY": 1.4646626443239155, + "timestamp": 12.569511550834214 + }, + { + "x": 2.5088215468762853, + "y": 3.3182335485748182, + "heading": -0.7669997571492978, + "angularVelocity": -0.0000016427479828891154, + "velocityX": -1.2743833457717078, + "velocityY": 1.3705455292537272, + "timestamp": 12.651312350893768 + }, + { + "x": 2.421950224540146, + "y": 3.411659991166572, + "heading": -0.7669998477403924, + "angularVelocity": -0.0000011074597615269072, + "velocityX": -1.06198621862983, + "velocityY": 1.1421213792986926, + "timestamp": 12.733113150953322 + }, + { + "x": 2.352453163850527, + "y": 3.4864011482861903, + "heading": -0.7669999126210906, + "angularVelocity": -7.931548110988282e-7, + "velocityX": -0.8495890093864996, + "velocityY": 0.9136971406783939, + "timestamp": 12.814913951012876 + }, + { + "x": 2.300330367046085, + "y": 3.5424570175160435, + "heading": -0.7669999578169298, + "angularVelocity": -5.525109684504957e-7, + "velocityX": -0.6371917727760005, + "velocityY": 0.6852728725029872, + "timestamp": 12.89671475107243 + }, + { + "x": 2.2655818352461483, + "y": 3.5798275976473137, + "heading": -0.7669999863406792, + "angularVelocity": -3.486976819494124e-7, + "velocityX": -0.4247945224819143, + "velocityY": 0.4568485895500231, + "timestamp": 12.978515551131984 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.0636232346768501, - "velocityX": -0.1135695009511221, - "velocityY": 0.20111846142733134, - "timestamp": 12.575612522376845 + "angularVelocity": -1.6698272956598662e-7, + "velocityX": -0.21239726397767503, + "velocityY": 0.2284242977305235, + "timestamp": 13.060316351191538 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -2.127821535251409e-28, - "velocityX": -9.407606964048783e-27, - "velocityY": -7.092605634329165e-27, - "timestamp": 12.63669255703042 + "angularVelocity": -2.381764007243456e-23, + "velocityX": 2.799365906238757e-23, + "velocityY": -7.174872988733629e-24, + "timestamp": 13.142117151251092 } ], "trajectoryWaypoints": [ @@ -7277,7 +7312,7 @@ "controlIntervalCount": 30 }, { - "timestamp": 1.907530231662107, + "timestamp": 1.9075302316621814, "isStopPoint": false, "x": 4.6845622062683105, "y": 1.3570671081542969, @@ -7288,7 +7323,7 @@ "controlIntervalCount": 18 }, { - "timestamp": 2.754205241926809, + "timestamp": 2.7542052419268117, "isStopPoint": false, "x": 7.413279056549072, "y": 0.72, @@ -7299,7 +7334,7 @@ "controlIntervalCount": 10 }, { - "timestamp": 3.4619850508557724, + "timestamp": 3.461985050855766, "isStopPoint": true, "x": 8.270875930786133, "y": 0.72, @@ -7310,7 +7345,7 @@ "controlIntervalCount": 21 }, { - "timestamp": 4.952221294072336, + "timestamp": 4.960966025251805, "isStopPoint": false, "x": 4.645580768585205, "y": 1.29859459400177, @@ -7321,7 +7356,7 @@ "controlIntervalCount": 24 }, { - "timestamp": 6.406601702517078, + "timestamp": 6.500382145394218, "isStopPoint": true, "x": 2.2482075691223145, "y": 3.598512887954712, @@ -7332,7 +7367,7 @@ "controlIntervalCount": 24 }, { - "timestamp": 7.917854358427183, + "timestamp": 7.944935561833011, "isStopPoint": false, "x": 4.626090049743652, "y": 1.3570671081542969, @@ -7340,32 +7375,32 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 19 + "controlIntervalCount": 20 }, { - "timestamp": 8.896236329485033, + "timestamp": 8.82855100571266, "isStopPoint": false, - "x": 7.384688854217529, - "y": 2.3971612453460693, - "heading": 0, + "x": 7.432769298553467, + "y": 1.9417921304702759, + "heading": 0.5633166974965059, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 10 + "controlIntervalCount": 11 }, { - "timestamp": 9.62294323659457, + "timestamp": 9.563708070872593, "isStopPoint": true, "x": 8.243088722229004, "y": 2.410367250442505, - "heading": 0, + "heading": 0.601472494720935, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 21 + "controlIntervalCount": 23 }, { - "timestamp": 11.170771725344627, + "timestamp": 11.178897949821796, "isStopPoint": false, "x": 4.645580768585205, "y": 1.3765579462051392, @@ -7376,7 +7411,7 @@ "controlIntervalCount": 24 }, { - "timestamp": 12.63669255703042, + "timestamp": 13.142117151251092, "isStopPoint": true, "x": 2.2482075691223145, "y": 3.598512887954712, @@ -7423,6 +7458,22 @@ 5 ], "type": "StopPoint" + }, + { + "scope": [ + 9, + 10 + ], + "type": "MaxVelocity", + "velocity": 2 + }, + { + "scope": [ + 4, + 5 + ], + "type": "MaxVelocity", + "velocity": 3 } ], "usesControlIntervalGuessing": true, diff --git a/src/main/deploy/choreo/3PieceAmpSide.1.traj b/src/main/deploy/choreo/3PieceAmpSide.1.traj index 8a5f4e1..6bc9e37 100644 --- a/src/main/deploy/choreo/3PieceAmpSide.1.traj +++ b/src/main/deploy/choreo/3PieceAmpSide.1.traj @@ -4,586 +4,586 @@ "x": 0.660783052444458, "y": 6.694385051727295, "heading": 1.0498621745809171, - "angularVelocity": 2.975965783776085e-24, - "velocityX": -7.418307455922956e-25, - "velocityY": -5.74149655283962e-25, + "angularVelocity": 5.036142496978594e-25, + "velocityX": 4.0909648611784826e-25, + "velocityY": -1.2650073502903171e-25, "timestamp": 0 }, { - "x": 0.6757749956355112, - "y": 6.7030690975147875, - "heading": 1.049862156272713, - "angularVelocity": -2.7160773495894344e-7, - "velocityX": 0.2224100034263669, - "velocityY": 0.12883044104006075, - "timestamp": 0.06740678458744168 - }, - { - "x": 0.7057588818438879, - "y": 6.720437189007701, - "heading": 1.0498621183971346, - "angularVelocity": -5.618956424511116e-7, - "velocityX": 0.44482000427539625, - "velocityY": 0.25766088086256306, - "timestamp": 0.13481356917488335 - }, - { - "x": 0.7507347108263656, - "y": 6.746489326091134, - "heading": 1.0498620591913437, - "angularVelocity": -8.783357826024073e-7, - "velocityX": 0.6672300015161533, - "velocityY": 0.3864913189804834, - "timestamp": 0.20222035376232503 - }, - { - "x": 0.8107024822181115, - "y": 6.781225508592738, - "heading": 1.0498619760110848, - "angularVelocity": -0.0000012340042572456138, - "velocityX": 0.889639993344503, - "velocityY": 0.5153217545415306, - "timestamp": 0.2696271383497667 - }, - { - "x": 0.8856621954110708, - "y": 6.82464573622526, - "heading": 1.0498618644492663, - "angularVelocity": -0.0000016550532570780867, - "velocityX": 1.1120499761521767, - "velocityY": 0.6441521858411218, - "timestamp": 0.33703392293720835 - }, - { - "x": 0.9756138491891349, - "y": 6.876750008414199, - "heading": 1.049861715691714, - "angularVelocity": -0.0000022068631981896758, - "velocityX": 1.3344599409185074, - "velocityY": 0.7729826086177988, - "timestamp": 0.40444070752465 - }, - { - "x": 1.080557439903982, - "y": 6.937538323436046, - "heading": 1.0498615032959615, - "angularVelocity": -0.000003150955112011347, - "velocityX": 1.5568698515608894, - "velocityY": 0.9018130058257152, - "timestamp": 0.47184749211209165 - }, - { - "x": 1.1972134624219284, - "y": 7.00511102725867, - "heading": 1.0334113148085255, - "angularVelocity": -0.2440435126540754, - "velocityX": 1.7306273134363406, - "velocityY": 1.002461461946278, - "timestamp": 0.5392542766995333 - }, - { - "x": 1.3138694823179202, - "y": 7.072683735607794, - "heading": 0.9724412548974013, - "angularVelocity": -0.9045092461283692, - "velocityX": 1.7306272745388522, - "velocityY": 1.0024615290982395, - "timestamp": 0.606661061286975 - }, - { - "x": 1.430525502226175, - "y": 7.140256443935745, - "heading": 0.8706390523679578, - "angularVelocity": -1.5102664094203053, - "velocityX": 1.7306272747207776, - "velocityY": 1.0024615287841676, - "timestamp": 0.6740678458744166 - }, - { - "x": 1.547181522136343, - "y": 7.207829152260394, - "heading": 0.7338713337275233, - "angularVelocity": -2.0289903972947423, - "velocityX": 1.7306272747491633, - "velocityY": 1.0024615287351624, - "timestamp": 0.7414746304618582 - }, - { - "x": 1.6638375420295233, - "y": 7.27540186061437, - "heading": 0.5723504105376668, - "angularVelocity": -2.396211659975084, - "velocityX": 1.730627274497144, - "velocityY": 1.0024615291702423, - "timestamp": 0.8088814150492999 - }, - { - "x": 1.780493561897231, - "y": 7.342974569012322, - "heading": 0.4041720655827993, - "angularVelocity": -2.4949765217876934, - "velocityX": 1.7306272741192532, - "velocityY": 1.0024615298226245, - "timestamp": 0.8762881996367415 - }, - { - "x": 1.8971495817456219, - "y": 7.41054727744362, - "heading": 0.25128074546081974, - "angularVelocity": -2.26818889311721, - "velocityX": 1.730627273832679, - "velocityY": 1.0024615303173605, - "timestamp": 0.9436949842241832 - }, - { - "x": 2.013805601595548, - "y": 7.47811998587227, - "heading": 0.1281466559461925, - "angularVelocity": -1.8267313931121394, - "velocityX": 1.730627273855457, - "velocityY": 1.0024615302780377, - "timestamp": 1.0111017688116248 - }, - { - "x": 2.1304616214625116, - "y": 7.545692694271506, - "heading": 0.04279406558189714, - "angularVelocity": -1.2662314466813642, - "velocityX": 1.7306272741082105, - "velocityY": 1.00246152984169, - "timestamp": 1.0785085533990666 - }, - { - "x": 2.2471176982189394, - "y": 7.613265304457943, - "heading": 0.0000053749809852541795, - "angularVelocity": -0.6347831433111215, - "velocityX": 1.7306281180805858, - "velocityY": 1.0024600728251583, - "timestamp": 1.1459153379865084 - }, - { - "x": 2.365737917103605, - "y": 7.677327317867433, - "heading": 0.0000017799981215852186, - "angularVelocity": -0.00005333265613649712, - "velocityX": 1.7597667595431528, - "velocityY": 0.9503793097620272, - "timestamp": 1.2133221225739501 - }, - { - "x": 2.4915943391699567, - "y": 7.725647695571818, - "heading": 7.919893506038426e-7, - "angularVelocity": -0.000014657408405228224, - "velocityX": 1.867118018410863, - "velocityY": 0.7168473915515575, - "timestamp": 1.2807289071613919 - }, - { - "x": 2.622608453293523, - "y": 7.757428188688913, - "heading": 3.1614094305550046e-7, - "angularVelocity": -0.000007059354788405022, - "velocityX": 1.9436339372279638, - "velocityY": 0.47147321017617505, - "timestamp": 1.3481356917488336 - }, - { - "x": 2.7566164600311245, - "y": 7.772143891506238, - "heading": 8.293455771499583e-8, - "angularVelocity": -0.000003459687133392096, - "velocityX": 1.9880492380372032, - "velocityY": 0.2183118940829424, - "timestamp": 1.4155424763362754 + "x": 0.6757749919218088, + "y": 6.703069104575789, + "heading": 1.049862128706329, + "angularVelocity": -6.805633230382436e-7, + "velocityX": 0.2224099351379215, + "velocityY": 0.12883053814923912, + "timestamp": 0.06740678858637275 + }, + { + "x": 0.705758870441161, + "y": 6.720437210067111, + "heading": 1.0498620338020643, + "angularVelocity": -0.0000014079333376652512, + "velocityX": 0.4448198638173059, + "velocityY": 0.25766107324734056, + "timestamp": 0.1348135771727455 + }, + { + "x": 0.750734687393026, + "y": 6.746489367913325, + "heading": 1.049861885451002, + "angularVelocity": -0.000002200832664302106, + "velocityX": 0.6672297834547413, + "velocityY": 0.3864916040738485, + "timestamp": 0.20222036575911825 + }, + { + "x": 0.8107024418631711, + "y": 6.781225577682529, + "heading": 1.0498616770274682, + "angularVelocity": -0.000003092025867532283, + "velocityX": 0.8896396895292586, + "velocityY": 0.5153221284929648, + "timestamp": 0.269627154345491 + }, + { + "x": 0.8856621323278759, + "y": 6.82464583865489, + "heading": 1.0498613974886852, + "angularVelocity": -0.0000041470419969153815, + "velocityX": 1.1120495729989293, + "velocityY": 0.6441526422330909, + "timestamp": 0.33703394293186373 + }, + { + "x": 0.9756137557397047, + "y": 6.8767501493907295, + "heading": 1.0498610247491444, + "angularVelocity": -0.000005529703292486692, + "velocityX": 1.334459411258968, + "velocityY": 0.7729831346152221, + "timestamp": 0.40444073151823645 + }, + { + "x": 1.0805573029563829, + "y": 6.937538505571021, + "heading": 1.049860492552681, + "angularVelocity": -0.000007895294742633066, + "velocityX": 1.556869113890614, + "velocityY": 0.9018135629232547, + "timestamp": 0.4718475201046092 + }, + { + "x": 1.1972133032133725, + "y": 7.005111257740716, + "heading": 1.0334106168225663, + "angularVelocity": -0.2440388583271016, + "velocityX": 1.7306268805182825, + "velocityY": 1.0024621197182535, + "timestamp": 0.5392543086909819 + }, + { + "x": 1.3138692969010544, + "y": 7.072684021251592, + "heading": 0.9724418882550508, + "angularVelocity": -0.9044894415848371, + "velocityX": 1.7306267830606272, + "velocityY": 1.0024622879680827, + "timestamp": 0.6066610972773546 + }, + { + "x": 1.4305252906191748, + "y": 7.140256784709921, + "heading": 0.8706420088958982, + "angularVelocity": -1.5102318548926246, + "velocityX": 1.7306267835121878, + "velocityY": 1.0024622871885176, + "timestamp": 0.6740678858637273 + }, + { + "x": 1.5471812843420916, + "y": 7.207829548159968, + "heading": 0.7338773790646791, + "angularVelocity": -2.028944453509658, + "velocityX": 1.7306267835833422, + "velocityY": 1.0024622870656754, + "timestamp": 0.7414746744501001 + }, + { + "x": 1.6638372780224426, + "y": 7.2754023116835, + "heading": 0.5723600050127189, + "angularVelocity": -2.396158865289915, + "velocityX": 1.7306267829518702, + "velocityY": 1.002462288155831, + "timestamp": 0.8088814630364728 + }, + { + "x": 1.780493271638965, + "y": 7.3429750753172245, + "heading": 0.40418447555722015, + "angularVelocity": -2.4949346049916663, + "velocityX": 1.7306267820049508, + "velocityY": 1.0024622897905686, + "timestamp": 0.8762882516228455 + }, + { + "x": 1.8971492652070823, + "y": 7.410547839034513, + "heading": 0.25129496131963275, + "angularVelocity": -2.26816196771754, + "velocityX": 1.7306267812868497, + "velocityY": 1.0024622910302834, + "timestamp": 0.9436950402092182 + }, + { + "x": 2.013805258779043, + "y": 7.478120602745167, + "heading": 0.12816045902008172, + "angularVelocity": -1.8267374085292716, + "velocityX": 1.7306267813438676, + "velocityY": 1.0024622909318521, + "timestamp": 1.011101828795591 + }, + { + "x": 2.1304612523991975, + "y": 7.545693366372621, + "heading": 0.04280584220849794, + "angularVelocity": -1.266261434517286, + "velocityX": 1.7306267820588324, + "velocityY": 1.0024622896975566, + "timestamp": 1.0785086173819638 + }, + { + "x": 2.247117388567763, + "y": 7.613265883907332, + "heading": 0.000013466426965438275, + "angularVelocity": -0.6348377764162405, + "velocityX": 1.7306288968074217, + "velocityY": 1.002458638837633, + "timestamp": 1.1459154059683365 + }, + { + "x": 2.365737851453118, + "y": 7.677327455956403, + "heading": 0.000004459976492377945, + "angularVelocity": -0.00013361340396034107, + "velocityX": 1.759770274968055, + "velocityY": 0.9503727056657639, + "timestamp": 1.2133221945547092 + }, + { + "x": 2.491594313865089, + "y": 7.725647742212638, + "heading": 0.000001984433687850704, + "angularVelocity": -0.000036725422712508624, + "velocityX": 1.8671185061828453, + "velocityY": 0.7168459923634953, + "timestamp": 1.280728983141082 + }, + { + "x": 2.622608441209736, + "y": 7.7574282007435205, + "heading": 7.92136305089401e-7, + "angularVelocity": -0.00001768809058799076, + "velocityX": 1.9436340180599136, + "velocityY": 0.4714726691089775, + "timestamp": 1.3481357717274547 + }, + { + "x": 2.7566164536261604, + "y": 7.772143891629413, + "heading": 2.0780523669770732e-7, + "angularVelocity": -0.000008668727299520462, + "velocityX": 1.9880492043425424, + "velocityY": 0.2183117041251145, + "timestamp": 1.4155425603138274 }, { "x": 2.8914051055908203, "y": 7.769551753997803, - "heading": -1.0848168375526677e-23, - "angularVelocity": -0.0000012303592023056844, - "velocityX": 1.9996302506440553, - "velocityY": -0.03845514252460355, - "timestamp": 1.4829492609237171 - }, - { - "x": 2.9864482888367814, - "y": 7.767723966507321, - "heading": -4.197390937938893e-8, - "angularVelocity": -9.569459118940512e-7, - "velocityX": 2.1668504793904355, - "velocityY": -0.04167097591548553, - "timestamp": 1.526811624363163 - }, - { - "x": 3.0888261462817113, - "y": 7.765755124968672, - "heading": -7.1955269378711e-8, - "angularVelocity": -6.835327065928114e-7, - "velocityX": 2.334070702466078, - "velocityY": -0.04488680919731284, - "timestamp": 1.570673987802609 - }, - { - "x": 3.1985386775939677, - "y": 7.763645229388232, - "heading": -8.99440850277704e-8, - "angularVelocity": -4.1011961596400926e-7, - "velocityX": 2.501290917980737, - "velocityY": -0.048102642333733917, - "timestamp": 1.614536351242055 - }, - { - "x": 3.315585882309251, - "y": 7.7613942797749305, - "heading": -9.594036346771443e-8, - "angularVelocity": -1.3670668814329107e-7, - "velocityX": 2.6685111229100227, - "velocityY": -0.05131847526658634, - "timestamp": 1.658398714681501 - }, - { - "x": 3.4399677597311125, - "y": 7.759002276142162, - "heading": -8.994411556657709e-8, - "angularVelocity": 1.3670599190158685e-7, - "velocityX": 2.8357313119612524, - "velocityY": -0.05453430789408585, - "timestamp": 1.7022610781209468 - }, - { - "x": 3.571684308698804, - "y": 7.756469218512247, - "heading": -7.195535972468811e-8, - "angularVelocity": 4.1011825244490774e-7, - "velocityX": 3.0029514745490706, - "velocityY": -0.05775014001266415, - "timestamp": 1.7461234415603928 - }, - { - "x": 3.710735526890833, - "y": 7.753795106929833, - "heading": -4.197413327831008e-8, - "angularVelocity": 6.835296617741198e-7, - "velocityX": 3.1701715842101277, - "velocityY": -0.060965971113401206, - "timestamp": 1.7899858049998387 - }, - { - "x": 3.857121407342745, - "y": 7.7509799415288505, - "heading": -5.486954628378907e-13, - "angularVelocity": 9.569385069911643e-7, - "velocityX": 3.3373915350914642, - "velocityY": -0.06418179916062534, - "timestamp": 1.8338481684392847 - }, - { - "x": 4.00874003287894, - "y": 7.748064144544636, - "heading": -4.703910632575431e-13, - "angularVelocity": 1.7852298290809937e-12, - "velocityX": 3.4566907400124736, - "velocityY": -0.06647605727501009, - "timestamp": 1.8777105318787306 - }, - { - "x": 4.160358658415212, - "y": 7.745148347560415, - "heading": -3.920667535801572e-13, - "angularVelocity": 1.7856837512018541e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 1.9215728953181765 - }, - { - "x": 4.311977283951483, - "y": 7.742232550576195, - "heading": -3.137296429210842e-13, - "angularVelocity": 1.7859755955231185e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 1.9654352587576225 - }, - { - "x": 4.463595909487755, - "y": 7.739316753591974, - "heading": -2.354583223670877e-13, - "angularVelocity": 1.7844756739521518e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 2.0092976221970686 - }, - { - "x": 4.615214535024027, - "y": 7.736400956607756, - "heading": -1.571841611983832e-13, - "angularVelocity": 1.7845404359596027e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 2.0531599856365146 - }, - { - "x": 4.7668331605602985, - "y": 7.7334851596235366, - "heading": -7.889094544923358e-14, - "angularVelocity": 1.7849748535092055e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504377, - "timestamp": 2.0970223490759605 + "heading": -8.09802518102299e-24, + "angularVelocity": -0.000003082853241575703, + "velocityX": 1.9996302270348674, + "velocityY": -0.03845514207057226, + "timestamp": 1.4829493489002001 + }, + { + "x": 2.9864482996127166, + "y": 7.767723966300088, + "heading": -1.0517201217515276e-7, + "angularVelocity": -0.0000023977731499342787, + "velocityX": 2.1668504195789944, + "velocityY": -0.04167097476524414, + "timestamp": 1.526811718523463 + }, + { + "x": 3.0888261669051587, + "y": 7.76575512457206, + "heading": -1.802948176200958e-7, + "angularVelocity": -0.0000017126937301878197, + "velocityX": 2.3340705979128114, + "velocityY": -0.04488680718663573, + "timestamp": 1.570674088146726 + }, + { + "x": 3.1985387066370827, + "y": 7.7636452288297, + "heading": -2.2536845598951497e-7, + "angularVelocity": -0.0000010276152145121185, + "velocityX": 2.5012907572995546, + "velocityY": -0.04810263924365375, + "timestamp": 1.614536457769989 + }, + { + "x": 3.315585917645001, + "y": 7.761394279095385, + "heading": -2.4039298339678027e-7, + "angularVelocity": -3.4253797814190234e-7, + "velocityX": 2.668510890160408, + "velocityY": -0.05131847079054902, + "timestamp": 1.658398827393252 + }, + { + "x": 3.4399677981836816, + "y": 7.759002275402676, + "heading": -2.2536848500409826e-7, + "angularVelocity": 3.4253731665043406e-7, + "velocityX": 2.835730983232458, + "velocityY": -0.05453430157226078, + "timestamp": 1.702261197016515 + }, + { + "x": 3.5716843453444107, + "y": 7.756469217807512, + "heading": -1.8029510454250157e-7, + "angularVelocity": 0.0000010276093345784838, + "velocityX": 3.0029510099899284, + "velocityY": -0.057750131078668464, + "timestamp": 1.7461235666397779 + }, + { + "x": 3.7107355533097754, + "y": 7.753795106421767, + "heading": -1.0517313285100412e-7, + "angularVelocity": 0.0000017126747217883014, + "velocityX": 3.1701709041186272, + "velocityY": -0.06096595803447545, + "timestamp": 1.7899859362630408 + }, + { + "x": 3.8571214046276947, + "y": 7.750979941581066, + "heading": -3.445312029122533e-12, + "angularVelocity": 0.000002397720151516781, + "velocityX": 3.337390400364549, + "velocityY": -0.06418177733854838, + "timestamp": 1.8338483058863038 + }, + { + "x": 4.008740030563312, + "y": 7.748064144589167, + "heading": -2.953693080850903e-12, + "angularVelocity": 1.1208216804044482e-11, + "velocityX": 3.456690261786607, + "velocityY": -0.06647604807818788, + "timestamp": 1.8777106755095667 + }, + { + "x": 4.160358656499413, + "y": 7.745148347597258, + "heading": -2.46204265095573e-12, + "angularVelocity": 1.1208934540541933e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9215730451328297 + }, + { + "x": 4.311977282435513, + "y": 7.742232550605349, + "heading": -1.970393895641841e-12, + "angularVelocity": 1.1208896362456744e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9654354147560926 + }, + { + "x": 4.463595908371613, + "y": 7.739316753613441, + "heading": -1.478772239262654e-12, + "angularVelocity": 1.1208278545067146e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839953, + "timestamp": 2.0092977843793554 + }, + { + "x": 4.615214534307714, + "y": 7.736400956621532, + "heading": -9.871132742331443e-13, + "angularVelocity": 1.1209129129534961e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 2.0531601540026183 + }, + { + "x": 4.766833160243814, + "y": 7.733485159629623, + "heading": -4.955367585470695e-13, + "angularVelocity": 1.120724940109933e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839952, + "timestamp": 2.0970225236258813 }, { "x": 4.91845178604126, "y": 7.730569362640381, - "heading": 5.742950127566998e-24, - "angularVelocity": 1.7986022474514431e-12, - "velocityX": 3.4566907387532364, - "velocityY": -0.06647605725079353, - "timestamp": 2.1408847125154065 - }, - { - "x": 5.071687527083371, - "y": 7.720097857990775, - "heading": 3.552307758225259e-17, - "angularVelocity": 7.99612526154235e-16, - "velocityX": 3.449285538872868, - "velocityY": -0.2357100850786492, - "timestamp": 2.185310069394438 - }, - { - "x": 5.224226446138744, - "y": 7.702133366681443, - "heading": 1.1687426346130352e-17, - "angularVelocity": -5.365325775763386e-16, - "velocityX": 3.433600307831658, - "velocityY": -0.4043747213612299, - "timestamp": 2.2297354262734697 - }, - { - "x": 5.375702981258678, - "y": 7.676722658421986, - "heading": 1.8432338772239766e-17, - "angularVelocity": 1.5182573422018895e-16, - "velocityX": 3.409686398972496, - "velocityY": -0.5719865870441906, - "timestamp": 2.2741607831525013 - }, - { - "x": 5.5270900407895756, - "y": 7.6507842121855125, - "heading": 3.519048582614132e-18, - "angularVelocity": -3.3569319949738625e-16, - "velocityX": 3.407672333237922, - "velocityY": -0.5838657932923826, - "timestamp": 2.318586140031533 - }, - { - "x": 5.678477093548375, - "y": 7.624845726424425, - "heading": 1.979250750682756e-17, - "angularVelocity": 3.6631014509556794e-16, - "velocityX": 3.407672180800267, - "velocityY": -0.5838666829782966, - "timestamp": 2.3630114969105644 - }, - { - "x": 5.829864146306661, - "y": 7.598907240660332, - "heading": 2.235165581095298e-17, - "angularVelocity": 5.760557672346472e-17, - "velocityX": 3.4076721807886727, - "velocityY": -0.5838666830459646, - "timestamp": 2.407436853789596 - }, - { - "x": 5.981251199064948, - "y": 7.5729687548962525, - "heading": 3.836313874494924e-18, - "angularVelocity": -4.167741856705319e-16, - "velocityX": 3.407672180788725, - "velocityY": -0.5838666830456585, - "timestamp": 2.4518622106686276 - }, - { - "x": 6.132638251823235, - "y": 7.547030269132175, - "heading": 3.1462079050077135e-17, - "angularVelocity": 6.218467811271862e-16, - "velocityX": 3.4076721807887362, - "velocityY": -0.5838666830455942, - "timestamp": 2.4962875675476592 - }, - { - "x": 6.284025304586505, - "y": 7.521091783397172, - "heading": 3.2166739769244493e-17, - "angularVelocity": 1.586167830118919e-17, - "velocityX": 3.407672180900869, - "velocityY": -0.5838666823911463, - "timestamp": 2.540712924426691 - }, - { - "x": 6.435412424183849, - "y": 7.495153687734749, - "heading": 4.825864229864178e-17, - "angularVelocity": 3.6222337106316937e-16, - "velocityX": 3.407673685313662, - "velocityY": -0.5838579019871705, - "timestamp": 2.5851382813057224 - }, - { - "x": 6.587407958314221, - "y": 7.473058385360328, - "heading": 2.4338261444680897e-17, - "angularVelocity": -5.384398130784151e-16, - "velocityX": 3.4213688939910836, - "velocityY": -0.4973579038337588, - "timestamp": 2.629563638184754 - }, - { - "x": 6.740303266652504, - "y": 7.458434117170091, - "heading": 6.5930603358426486e-18, - "angularVelocity": -3.9943857191878257e-16, - "velocityX": 3.4416225119949053, - "velocityY": -0.32918741047050454, - "timestamp": 2.6739889950637856 - }, - { - "x": 6.890285169623974, - "y": 7.45074846175788, - "heading": 2.2969898357742947e-18, - "angularVelocity": -9.670311735916258e-17, - "velocityX": 3.3760427266766593, - "velocityY": -0.1730015457870095, - "timestamp": 2.718414351942817 - }, - { - "x": 7.0329931824089815, - "y": 7.444992685922663, - "heading": 4.687721405017099e-19, - "angularVelocity": -4.115257194619888e-17, - "velocityX": 3.212309879098902, - "velocityY": -0.1295605987114418, - "timestamp": 2.762839708821849 - }, - { - "x": 7.168350397458885, - "y": 7.44084929349212, - "heading": 2.6761389089681093e-19, - "angularVelocity": -4.528005257897493e-18, - "velocityX": 3.046845868193575, - "velocityY": -0.09326638482216276, - "timestamp": 2.8072650657008804 + "heading": 5.035858981265476e-24, + "angularVelocity": 1.1297537338117902e-11, + "velocityX": 3.4566902586364923, + "velocityY": -0.06647604801760763, + "timestamp": 2.140884893249144 + }, + { + "x": 5.07168754119456, + "y": 7.72009798657163, + "heading": -1.2237883220746723e-17, + "angularVelocity": -2.754707452373014e-16, + "velocityX": 3.4492852675356476, + "velocityY": -0.23570715051872318, + "timestamp": 2.1853102577139336 + }, + { + "x": 5.224226523742201, + "y": 7.702133987621307, + "heading": -3.220999671007562e-17, + "angularVelocity": -4.4956555179430785e-16, + "velocityX": 3.433601150724158, + "velocityY": -0.4043635694775183, + "timestamp": 2.229735622178723 + }, + { + "x": 5.375704105653677, + "y": 7.6767294867936675, + "heading": -8.086584933587513e-18, + "angularVelocity": 5.430098788639561e-16, + "velocityX": 3.4097093796840374, + "velocityY": -0.5718467621751168, + "timestamp": 2.2741609866435124 + }, + { + "x": 5.527091031475673, + "y": 7.65079022745198, + "heading": 1.237593714278334e-17, + "angularVelocity": 4.606044840123949e-16, + "velocityX": 3.4076687416257836, + "velocityY": -0.5838839963203132, + "timestamp": 2.318586351108302 + }, + { + "x": 5.678477940102667, + "y": 7.624850867756873, + "heading": -5.299489627912929e-18, + "angularVelocity": -3.9786790685233107e-16, + "velocityX": 3.4076683545720687, + "velocityY": -0.5838862552420002, + "timestamp": 2.363011715573091 + }, + { + "x": 5.82986484872645, + "y": 7.598911508043026, + "heading": -6.861733443062272e-18, + "angularVelocity": -3.51655824113109e-17, + "velocityX": 3.4076683544997888, + "velocityY": -0.5838862556638376, + "timestamp": 2.4074370800378806 + }, + { + "x": 5.981251757350232, + "y": 7.572972148329175, + "heading": 1.300275398298883e-18, + "angularVelocity": 1.8372407158846258e-16, + "velocityX": 3.4076683544997755, + "velocityY": -0.5838862556639163, + "timestamp": 2.45186244450267 + }, + { + "x": 6.13263866597402, + "y": 7.547032788615358, + "heading": 2.03304825021732e-17, + "angularVelocity": 4.2836355611375324e-16, + "velocityX": 3.407668354499907, + "velocityY": -0.5838862556631488, + "timestamp": 2.4962878089674594 + }, + { + "x": 6.284025574629089, + "y": 7.521093429084101, + "heading": 9.540525391081043e-18, + "angularVelocity": -2.428783025456181e-16, + "velocityX": 3.407668355204027, + "velocityY": -0.5838862515537734, + "timestamp": 2.540713173432249 + }, + { + "x": 6.435412650788291, + "y": 7.495155047156986, + "heading": 3.1121659748942844e-18, + "angularVelocity": -1.4470020659857382e-16, + "velocityX": 3.407672125665691, + "velocityY": -0.5838642460136346, + "timestamp": 2.585138537897038 + }, + { + "x": 6.587408261478287, + "y": 7.473060233149462, + "heading": 4.012412418719246e-18, + "angularVelocity": 2.0264244415020296e-17, + "velocityX": 3.4213700331139205, + "velocityY": -0.49734682593400187, + "timestamp": 2.6295639023618276 + }, + { + "x": 6.740303543651052, + "y": 7.458435646449454, + "heading": -2.1084051336842118e-18, + "angularVelocity": -1.377775427669848e-16, + "velocityX": 3.4416213353510248, + "velocityY": -0.3291945238085493, + "timestamp": 2.673989266826617 + }, + { + "x": 6.890285316295548, + "y": 7.450749433084636, + "heading": -1.4822341121773416e-18, + "angularVelocity": 1.40948989157144e-17, + "velocityX": 3.3760392165914315, + "velocityY": -0.17301407557185516, + "timestamp": 2.7184146312914064 + }, + { + "x": 7.032993253879116, + "y": 7.444993241304835, + "heading": -9.121457386741735e-19, + "angularVelocity": 1.2832497387232803e-17, + "velocityX": 3.212307637828718, + "velocityY": -0.1295699393611814, + "timestamp": 2.7628399957561958 + }, + { + "x": 7.168350422821424, + "y": 7.440849530732545, + "heading": -4.3340581409719474e-19, + "angularVelocity": 1.0776274550871163e-17, + "velocityX": 3.046844310069511, + "velocityY": -0.09327353016031785, + "timestamp": 2.807265360220985 }, { "x": 7.296333312988281, "y": 7.438207149505615, - "heading": 7.559167432305897e-29, - "angularVelocity": -6.0238996273513066e-18, - "velocityX": 2.8808528399195232, - "velocityY": -0.05947378191468168, - "timestamp": 2.851690422579912 - }, - { - "x": 7.47698763720858, - "y": 7.437583087682088, - "heading": -1.531352149638582e-19, - "angularVelocity": -2.223548537046582e-18, - "velocityX": 2.6231305334964707, - "velocityY": -0.009061480433138841, - "timestamp": 2.9205601650168234 - }, - { - "x": 7.639661701569886, - "y": 7.4389085950358504, - "heading": -4.350947127069071e-19, - "angularVelocity": -4.094098333593456e-18, - "velocityX": 2.3620541997862787, - "velocityY": 0.019246585029358436, - "timestamp": 2.9894299074537347 - }, - { - "x": 7.784283052035784, - "y": 7.4413250266907465, - "heading": -6.244717594872043e-19, - "angularVelocity": -2.7497859013586165e-18, - "velocityX": 2.099925821537363, - "velocityY": 0.03508698550905259, - "timestamp": 3.058299649890646 - }, - { - "x": 7.910826913450658, - "y": 7.444284600874366, - "heading": -6.382122914459642e-19, - "angularVelocity": -1.9951478654456663e-19, - "velocityX": 1.8374377039495369, - "velocityY": 0.0429735044577886, - "timestamp": 3.1271693923275574 - }, - { - "x": 8.019285873686528, - "y": 7.44740842176458, - "heading": -6.221500958287316e-19, - "angularVelocity": 2.3322572505666016e-19, - "velocityX": 1.5748419610429636, - "velocityY": 0.04535839368175477, - "timestamp": 3.1960391347644688 - }, - { - "x": 8.109659540281728, - "y": 7.450419143488216, - "heading": -5.560566789743302e-19, - "angularVelocity": 9.596872953609165e-19, - "velocityX": 1.3122405195284144, - "velocityY": 0.0437161751605761, - "timestamp": 3.26490887720138 - }, - { - "x": 8.181950475423811, - "y": 7.453105106505567, - "heading": -4.47336306829622e-19, - "angularVelocity": 1.578637704959947e-18, - "velocityX": 1.0496762813989922, - "velocityY": 0.03900062527185011, - "timestamp": 3.3337786196382915 - }, - { - "x": 8.236162443619715, - "y": 7.455299536082291, - "heading": -3.01857697105088e-19, - "angularVelocity": 2.112373367083251e-18, - "velocityX": 0.787166704530166, - "velocityY": 0.03186347878002744, - "timestamp": 3.402648362075203 - }, - { - "x": 8.272299611573594, - "y": 7.456867665427121, - "heading": -9.747000653236463e-20, - "angularVelocity": 2.9677429207323664e-18, - "velocityX": 0.5247176288917162, - "velocityY": 0.022769496288837482, - "timestamp": 3.471518104512114 + "heading": -1.2424191874750213e-28, + "angularVelocity": 9.755818981171634e-18, + "velocityX": 2.880851777103443, + "velocityY": -0.05947911196145459, + "timestamp": 2.8516907246857746 + }, + { + "x": 7.476987619873736, + "y": 7.437582893575528, + "heading": 6.306246828045357e-19, + "angularVelocity": 9.156773444569897e-18, + "velocityX": 2.623130055966497, + "velocityY": -0.009064298112001053, + "timestamp": 2.9205604730516797 + }, + { + "x": 7.639661681076791, + "y": 7.438908313736393, + "heading": 7.717197233455447e-19, + "angularVelocity": 2.04872304504038e-18, + "velocityX": 2.362053950578807, + "velocityY": 0.019245317317299903, + "timestamp": 2.9894302214175847 + }, + { + "x": 7.78428303377631, + "y": 7.4413247257119215, + "heading": 8.357244621441239e-19, + "angularVelocity": 9.29359266725832e-19, + "velocityX": 2.0999256731873923, + "velocityY": 0.0350866967407844, + "timestamp": 3.05829996978349 + }, + { + "x": 7.91082689918953, + "y": 7.4442843222063875, + "heading": 7.220816869988264e-19, + "angularVelocity": -1.6501116644010886e-18, + "velocityX": 1.8374376038212434, + "velocityY": 0.042973824715339615, + "timestamp": 3.127169718149395 + }, + { + "x": 8.019285863587411, + "y": 7.447408189663725, + "heading": 5.712912024628398e-19, + "angularVelocity": -2.1895024749108468e-18, + "velocityX": 1.5748418858979918, + "velocityY": 0.04535906593908385, + "timestamp": 3.1960394665153 + }, + { + "x": 8.109659533807191, + "y": 7.450418969222921, + "heading": 4.341547519848611e-19, + "angularVelocity": -1.9912436692380873e-18, + "velocityX": 1.312240459187152, + "velocityY": 0.04371701117883307, + "timestamp": 3.264909214881205 + }, + { + "x": 8.181950471768632, + "y": 7.4531049914429115, + "heading": 2.769074151229353e-19, + "angularVelocity": -2.283257025771601e-18, + "velocityX": 1.0496762319699213, + "velocityY": 0.03900148154629361, + "timestamp": 3.33377896324711 + }, + { + "x": 8.236162441930201, + "y": 7.455299473800812, + "heading": 8.002361823653196e-20, + "angularVelocity": -2.858784902160653e-18, + "velocityX": 0.7871666653047966, + "velocityY": 0.03186424242820522, + "timestamp": 3.4026487116130153 + }, + { + "x": 8.27229961106123, + "y": 7.456867643223532, + "heading": 9.595707199020635e-21, + "angularVelocity": -1.0226247759898425e-18, + "velocityX": 0.5247176008111963, + "velocityY": 0.02277007626611394, + "timestamp": 3.4715184599789204 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1045131718008824e-26, - "angularVelocity": 1.4152803834514588e-18, - "velocityX": 0.26232944363751326, - "velocityY": 0.012061606851017839, - "timestamp": 3.5403878469490255 + "heading": -2.737879233354451e-29, + "angularVelocity": -1.3933123630808857e-19, + "velocityX": 0.26232942849316815, + "velocityY": 0.012061928212380262, + "timestamp": 3.5403882083448255 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1306207039452228e-26, - "angularVelocity": -3.8332378282330285e-27, - "velocityX": -4.271268903147259e-26, - "velocityY": 9.33461667545086e-25, - "timestamp": 3.609257589385937 + "heading": -7.734690041039287e-29, + "angularVelocity": -1.1060203570884526e-28, + "velocityX": -8.232857746308476e-27, + "velocityY": 9.915594313558478e-27, + "timestamp": 3.6092579567107306 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceAmpSide.2.traj b/src/main/deploy/choreo/3PieceAmpSide.2.traj index 0919e89..e894036 100644 --- a/src/main/deploy/choreo/3PieceAmpSide.2.traj +++ b/src/main/deploy/choreo/3PieceAmpSide.2.traj @@ -3,227 +3,227 @@ { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1306207039452228e-26, - "angularVelocity": -3.8332378282330285e-27, - "velocityX": -4.271268903147259e-26, - "velocityY": 9.33461667545086e-25, + "heading": -7.734690041039287e-29, + "angularVelocity": -1.1060203570884526e-28, + "velocityX": -8.232857746308476e-27, + "velocityY": 9.915594313558478e-27, "timestamp": 0 }, { - "x": 8.25852915676906, - "y": 7.450262882472062, - "heading": 0.0018141392967689516, - "angularVelocity": 0.019588444800635294, - "velocityX": -0.3437650196234689, - "velocityY": -0.08028553880386623, - "timestamp": 0.09261272731105796 - }, - { - "x": 8.194855122144773, - "y": 7.435392004605689, - "heading": 0.005442043995568049, - "angularVelocity": 0.03917285241599744, - "velocityX": -0.6875300671194481, - "velocityY": -0.1605705640913233, - "timestamp": 0.18522545462211593 - }, - { - "x": 8.099344051833308, - "y": 7.4130857844004225, - "heading": 0.01088220163958325, - "angularVelocity": 0.05874092904902104, - "velocityX": -1.0312952990863984, - "velocityY": -0.24085480314543678, - "timestamp": 0.2778381819331739 - }, - { - "x": 7.971995914574251, - "y": 7.383344320455178, - "heading": 0.01813202895682406, - "angularVelocity": 0.0782811124100776, - "velocityX": -1.3750608685924206, - "velocityY": -0.32113797756275486, - "timestamp": 0.37045090924423185 - }, - { - "x": 7.812810665453445, - "y": 7.3461677377771615, - "heading": 0.027187966537864438, - "angularVelocity": 0.09778286250683688, - "velocityX": -1.7188269230658824, - "velocityY": -0.40141980219577883, - "timestamp": 0.46306363655529026 - }, - { - "x": 7.621788246652196, - "y": 7.301556188492674, - "heading": 0.038045600726663804, - "angularVelocity": 0.11723695548163543, - "velocityX": -2.0625936018454802, - "velocityY": -0.4816999842219491, - "timestamp": 0.5556763638663487 - }, - { - "x": 7.3989285885055995, - "y": 7.24950985264102, - "heading": 0.05069981285452632, - "angularVelocity": 0.13663577885316824, - "velocityX": -2.4063610328424803, - "velocityY": -0.5619782222463336, - "timestamp": 0.6482890911774071 - }, - { - "x": 7.144231611178116, - "y": 7.1900289391025325, - "heading": 0.06514495528961611, - "angularVelocity": 0.15597362106152987, - "velocityX": -2.7501293258758435, - "velocityY": -0.6422542048536093, - "timestamp": 0.7409018184884655 - }, - { - "x": 6.857697229070099, - "y": 7.12311368717437, - "heading": 0.08137504890112211, - "angularVelocity": 0.17524690269614907, - "velocityX": -3.0938985431843946, - "velocityY": -0.7225276036134316, - "timestamp": 0.8335145457995239 - }, - { - "x": 6.545887160996467, - "y": 7.050327089936167, - "heading": 0.08137505141561512, - "angularVelocity": 2.71506205393572e-8, - "velocityX": -3.366816604227146, - "velocityY": -0.785924347025588, - "timestamp": 0.9261272731105823 - }, - { - "x": 6.234077092414379, - "y": 6.9775404948760125, - "heading": 0.08137505393005692, - "angularVelocity": 2.7150067532220807e-8, - "velocityX": -3.3668166097172856, - "velocityY": -0.7859243235077903, - "timestamp": 1.0187400004216407 - }, - { - "x": 5.922267023832287, - "y": 6.9047538998158755, - "heading": 0.08137505644449868, - "angularVelocity": 2.715006702984009e-8, - "velocityX": -3.3668166097173295, - "velocityY": -0.7859243235076002, - "timestamp": 1.111352727732699 - }, - { - "x": 5.610456955250197, - "y": 6.831967304755725, - "heading": 0.08137505895894045, - "angularVelocity": 2.71500672556719e-8, - "velocityX": -3.366816609717297, - "velocityY": -0.7859243235077401, - "timestamp": 1.2039654550437575 - }, - { - "x": 5.298646887042485, - "y": 6.75918070809191, - "heading": 0.08137506147343254, - "angularVelocity": 2.715061065119022e-8, - "velocityX": -3.366816605674904, - "velocityY": -0.7859243408235568, - "timestamp": 1.296578182354816 - }, - { - "x": 5.012107215632439, - "y": 6.692280233597882, - "heading": 0.09728582681634514, - "angularVelocity": 0.17179890717906565, - "velocityX": -3.0939556552270235, - "velocityY": -0.7223680420222418, - "timestamp": 1.3891909096658743 - }, - { - "x": 4.757405114771201, - "y": 6.6328136487695275, - "heading": 0.11142133507965439, - "angularVelocity": 0.15263029902825728, - "velocityX": -2.7501846480103254, - "velocityY": -0.6420994884280228, - "timestamp": 1.4818036369769327 - }, - { - "x": 4.53454065727504, - "y": 6.5807807676396815, - "heading": 0.12378505010124977, - "angularVelocity": 0.13349909219355338, - "velocityX": -2.406412854548884, - "velocityY": -0.5618329428425411, - "timestamp": 1.5744163642879911 - }, - { - "x": 4.343513899404853, - "y": 6.5361814286666275, - "heading": 0.1343795579504313, - "angularVelocity": 0.11439580883519145, - "velocityX": -2.062640453601866, - "velocityY": -0.48156814152830624, - "timestamp": 1.6670290915990496 - }, - { - "x": 4.184324884988457, - "y": 6.499015496112839, - "heading": 0.14320671190518078, - "angularVelocity": 0.09531253652753087, - "velocityX": -1.7188675794173347, - "velocityY": -0.4013048058606475, - "timestamp": 1.759641818910108 - }, - { - "x": 4.056973646858879, - "y": 6.4692828606598525, - "heading": 0.150267758880007, - "angularVelocity": 0.07624272796880596, - "velocityX": -1.3750943507132014, - "velocityY": -0.32104265057569514, - "timestamp": 1.8522545462211664 - }, - { - "x": 3.9614602077127334, - "y": 6.4469834398128185, - "heading": 0.15556344152537638, - "angularVelocity": 0.057180938291372996, - "velocityX": -1.0313208769389124, - "velocityY": -0.240781386041431, - "timestamp": 1.9448672735322248 - }, - { - "x": 3.897784580685345, - "y": 6.432117178185927, - "heading": 0.15909407498952677, - "angularVelocity": 0.03812255147493982, - "velocityX": -0.6875472613339806, - "velocityY": -0.16052071954387456, - "timestamp": 2.037480000843283 + "x": 8.258529155042611, + "y": 7.450262882094732, + "heading": 0.0018141437015229199, + "angularVelocity": 0.019588491140668917, + "velocityX": -0.34376501683789845, + "velocityY": -0.0802855378738891, + "timestamp": 0.09261273308368612 + }, + { + "x": 8.19485511722891, + "y": 7.435392003543495, + "heading": 0.005442056461770318, + "angularVelocity": 0.03917293701902922, + "velocityX": -0.6875300587033178, + "velocityY": -0.16057056147775478, + "timestamp": 0.18522546616737223 + }, + { + "x": 8.099344042603773, + "y": 7.413085782435483, + "heading": 0.010882224859340402, + "angularVelocity": 0.05874104150078671, + "velocityX": -1.0312952813824383, + "velocityY": -0.24085479788027828, + "timestamp": 0.27783819925105835 + }, + { + "x": 7.9719959003584435, + "y": 7.383344317488874, + "heading": 0.018132064338159094, + "angularVelocity": 0.07828123884722897, + "velocityX": -1.3750608367237869, + "velocityY": -0.3211379683583422, + "timestamp": 0.37045093233474446 + }, + { + "x": 7.8128106462112585, + "y": 7.346167733877292, + "heading": 0.027188013699287764, + "angularVelocity": 0.09778298360923647, + "velocityX": -1.7188268702030736, + "velocityY": -0.4014197872552755, + "timestamp": 0.4630636654184306 + }, + { + "x": 7.621788223292644, + "y": 7.301556183975714, + "heading": 0.038045656619278445, + "angularVelocity": 0.11723704245051889, + "velocityX": -2.0625935177402037, + "velocityY": -0.481699960860308, + "timestamp": 0.5556763985021167 + }, + { + "x": 7.3989285635202835, + "y": 7.24950984823631, + "heading": 0.050699870016136385, + "angularVelocity": 0.1366357840387178, + "velocityX": -2.406360900406452, + "velocityY": -0.5619781860057411, + "timestamp": 0.6482891315858028 + }, + { + "x": 7.144231590225439, + "y": 7.190028936362276, + "heading": 0.06514499751032955, + "angularVelocity": 0.15597345001297352, + "velocityX": -2.750129110914985, + "velocityY": -0.6422541468491951, + "timestamp": 0.7409018646694889 + }, + { + "x": 6.857697227315765, + "y": 7.123113690113179, + "heading": 0.08137503414778206, + "angularVelocity": 0.17524627658690128, + "velocityX": -3.093898143042135, + "velocityY": -0.7225274972571053, + "timestamp": 0.833514597753175 + }, + { + "x": 6.545887160381392, + "y": 7.050327089705259, + "heading": 0.08137504044908753, + "angularVelocity": 6.803929929105723e-8, + "velocityX": -3.366816382069384, + "velocityY": -0.7859243322637903, + "timestamp": 0.9261273308368612 + }, + { + "x": 6.234077092172867, + "y": 6.977540494754869, + "heading": 0.0813750467500712, + "angularVelocity": 6.80358247192299e-8, + "velocityX": -3.3668163958272355, + "velocityY": -0.7859242733352659, + "timestamp": 1.0187400639205473 + }, + { + "x": 5.922267023964316, + "y": 6.904753899804592, + "heading": 0.08137505305105486, + "angularVelocity": 6.803582445105601e-8, + "velocityX": -3.3668163958275135, + "velocityY": -0.7859242733340743, + "timestamp": 1.1113527970042334 + }, + { + "x": 5.610456955755783, + "y": 6.831967304854232, + "heading": 0.08137505935203854, + "angularVelocity": 6.803582480789322e-8, + "velocityX": -3.366816395827309, + "velocityY": -0.7859242733349515, + "timestamp": 1.2039655300879195 + }, + { + "x": 5.298646888485436, + "y": 6.759180705885576, + "heading": 0.08137506565333762, + "angularVelocity": 6.803923039402274e-8, + "velocityX": -3.366816385697099, + "velocityY": -0.7859243167231056, + "timestamp": 1.2965782631716056 + }, + { + "x": 5.012107236392116, + "y": 6.692280236782266, + "heading": 0.09728577795318676, + "angularVelocity": 0.17179832373019394, + "velocityX": -3.0939552538029402, + "velocityY": -0.7223679387893466, + "timestamp": 1.3891909962552917 + }, + { + "x": 4.757405139637452, + "y": 6.632813653440834, + "heading": 0.1114212737800766, + "angularVelocity": 0.15263015523056464, + "velocityX": -2.75018443224769, + "velocityY": -0.642099432350162, + "timestamp": 1.4818037293389779 + }, + { + "x": 4.534540680564304, + "y": 6.580780772308004, + "heading": 0.12378499174610678, + "angularVelocity": 0.1334991156654254, + "velocityX": -2.4064127215829467, + "velocityY": -0.561832907855257, + "timestamp": 1.574416462422664 + }, + { + "x": 4.343513918608397, + "y": 6.536181432644826, + "heading": 0.13437950942576468, + "angularVelocity": 0.11439590785086255, + "velocityX": -2.0626403691519735, + "velocityY": -0.4815681189634867, + "timestamp": 1.66702919550635 + }, + { + "x": 4.184324899185163, + "y": 6.499015499114029, + "heading": 0.14320667584584268, + "angularVelocity": 0.0953126651828929, + "velocityX": -1.7188675263409952, + "velocityY": -0.4013047913963752, + "timestamp": 1.7596419285900362 + }, + { + "x": 4.056973656080411, + "y": 6.469282862636605, + "heading": 0.15026773537457858, + "angularVelocity": 0.07624285876927316, + "velocityX": -1.3750943187226343, + "velocityY": -0.32104264162636753, + "timestamp": 1.8522546616737223 + }, + { + "x": 3.9614602126260823, + "y": 6.446983440876931, + "heading": 0.1555634289688374, + "angularVelocity": 0.05718105294952869, + "velocityX": -1.0313208591740977, + "velocityY": -0.24078138088770026, + "timestamp": 1.9448673947574084 + }, + { + "x": 3.8977845824113757, + "y": 6.432117178562742, + "heading": 0.15909407056957425, + "angularVelocity": 0.03812263695475346, + "velocityX": -0.6875472528941416, + "velocityY": -0.1605207169596795, + "timestamp": 2.0374801278410946 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.0190635029136793, - "velocityX": -0.3437736032117534, - "velocityY": -0.08026035624657629, - "timestamp": 2.1300927281543416 + "angularVelocity": 0.019063549450541617, + "velocityX": -0.3437736004211391, + "velocityY": -0.08026035531260044, + "timestamp": 2.1300928609247807 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.4674835450480263e-24, - "velocityX": -3.539044961968101e-24, - "velocityY": -4.5145885950878316e-23, - "timestamp": 2.2227054554654 + "angularVelocity": -9.999505736171943e-25, + "velocityX": -5.156111906167998e-25, + "velocityY": -7.69774068808886e-24, + "timestamp": 2.222705594008467 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceAmpSide.3.traj b/src/main/deploy/choreo/3PieceAmpSide.3.traj index 4948f79..c24e9ed 100644 --- a/src/main/deploy/choreo/3PieceAmpSide.3.traj +++ b/src/main/deploy/choreo/3PieceAmpSide.3.traj @@ -4,316 +4,316 @@ "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.4674835450480263e-24, - "velocityX": -3.539044961968101e-24, - "velocityY": -4.5145885950878316e-23, + "angularVelocity": -9.999505736171943e-25, + "velocityX": -5.156111906167998e-25, + "velocityY": -7.69774068808886e-24, "timestamp": 0 }, { - "x": 3.8806166186713504, - "y": 6.424668213553014, - "heading": 0.1586413129313925, - "angularVelocity": -0.03571634624153653, - "velocityX": 0.2361975091798944, - "velocityY": -0.0002549437180240986, - "timestamp": 0.06210839821271108 - }, - { - "x": 3.9099562715140928, - "y": 6.424636752755811, - "heading": 0.15420447411308597, - "angularVelocity": -0.07143701892151703, - "velocityX": 0.47239429267292826, - "velocityY": -0.0005065465880378765, - "timestamp": 0.12421679642542216 - }, - { - "x": 3.953965706205972, - "y": 6.4245899872222205, - "heading": 0.14754993112617998, - "angularVelocity": -0.10714401237841124, - "velocityX": 0.7085907213571107, - "velocityY": -0.0007529663449016913, - "timestamp": 0.18632519463813324 - }, - { - "x": 4.012644921986535, - "y": 6.424528354667972, - "heading": 0.13867953686775064, - "angularVelocity": -0.14282117255785207, - "velocityX": 0.9447871377973178, - "velocityY": -0.0009923384924064732, - "timestamp": 0.24843359285084432 - }, - { - "x": 4.085993936769769, - "y": 6.424452410018094, - "heading": 0.1275959867324694, - "angularVelocity": -0.17845493450534605, - "velocityX": 1.1809838426685173, - "velocityY": -0.0012227758574291183, - "timestamp": 0.3105419910635554 - }, - { - "x": 4.174012783702118, - "y": 6.424362826752711, - "heading": 0.11430261193472518, - "angularVelocity": -0.21403506096255565, - "velocityX": 1.41718108122671, - "velocityY": -0.0014423695983334034, - "timestamp": 0.3726503892762665 - }, - { - "x": 4.276701506889125, - "y": 6.424260398085293, - "heading": 0.09880312708922008, - "angularVelocity": -0.24955537884622275, - "velocityX": 1.6533790299230773, - "velocityY": -0.0016491919026409437, - "timestamp": 0.43475878748897756 - }, - { - "x": 4.394060156308242, - "y": 6.424146037859453, - "heading": 0.0811013325151301, - "angularVelocity": -0.285014508238714, - "velocityX": 1.8895777833004581, - "velocityY": -0.00184130051861914, - "timestamp": 0.49686718570168864 - }, - { - "x": 4.5260887819403175, - "y": 6.424020781052808, - "heading": 0.06120077232953886, - "angularVelocity": -0.32041657421972447, - "velocityX": 2.1257773414136287, - "velocityY": -0.0020167450819892417, - "timestamp": 0.5589755839143997 - }, - { - "x": 4.67278742718424, - "y": 6.42388578380628, - "heading": 0.039104350634045465, - "angularVelocity": -0.35577188160314316, - "velocityX": 2.3619775982871833, - "velocityY": -0.002173574756587449, - "timestamp": 0.6210839821271108 - }, - { - "x": 4.834156121702719, - "y": 6.423742323007339, - "heading": 0.01481391117601343, - "angularVelocity": -0.3910975030275518, - "velocityX": 2.598178332756533, - "velocityY": -0.002309845416548714, - "timestamp": 0.6831923803398219 - }, - { - "x": 5.01019487412182, - "y": 6.423591795858401, - "heading": -0.011670204418812183, - "angularVelocity": -0.42641762397610067, - "velocityX": 2.834379206113114, - "velocityY": -0.00242361988508825, - "timestamp": 0.745300778552533 - }, - { - "x": 5.200903666238017, - "y": 6.4234357217300895, - "heading": -0.04034956205797238, - "angularVelocity": -0.46176295741742135, - "velocityX": 3.070579786376913, - "velocityY": -0.002512931146224344, - "timestamp": 0.807409176765244 - }, - { - "x": 5.406282460203223, - "y": 6.423275763679671, - "heading": -0.07122760819917923, - "angularVelocity": -0.4971637818681904, - "velocityX": 3.3067797572530786, - "velocityY": -0.002575465718348354, - "timestamp": 0.8695175749779551 - }, - { - "x": 5.621011656414587, - "y": 6.423161504545189, - "heading": -0.07122761549725261, - "angularVelocity": -1.1750541962036517e-7, - "velocityX": 3.457329481851291, - "velocityY": -0.0018396728585792982, - "timestamp": 0.9316259731906662 - }, - { - "x": 5.835740853133477, - "y": 6.42304819932464, - "heading": -0.07122762278700305, - "angularVelocity": -1.1737141255802722e-7, - "velocityX": 3.4573294900228966, - "velocityY": -0.0018243140027767927, - "timestamp": 0.9937343714033773 - }, - { - "x": 6.050170082146955, - "y": 6.411701548446128, - "heading": -0.07122763011063167, - "angularVelocity": -1.1791688138484013e-7, - "velocityX": 3.452499745349952, - "velocityY": -0.18269108856505184, - "timestamp": 1.0558427696160884 + "x": 3.8805908200661583, + "y": 6.424671235221358, + "heading": 0.15744018373663873, + "angularVelocity": -0.0550052976874839, + "velocityX": 0.23556676380826952, + "velocityY": -0.00020610376336075096, + "timestamp": 0.062165180329607495 + }, + { + "x": 3.9098813602559557, + "y": 6.424646814464556, + "heading": 0.1506499345999589, + "angularVelocity": -0.10922913921711586, + "velocityX": 0.47117276961950644, + "velocityY": -0.0003928365794473002, + "timestamp": 0.12433036065921499 + }, + { + "x": 3.9538212666067056, + "y": 6.424612381558881, + "heading": 0.14054735001329138, + "angularVelocity": -0.1625119485393969, + "velocityX": 0.7068250444666143, + "velocityY": -0.0005538937632522526, + "timestamp": 0.18649554098882248 + }, + { + "x": 4.012413923406757, + "y": 6.424569899192806, + "heading": 0.1272024405085879, + "angularVelocity": -0.21466855615872318, + "velocityX": 0.9425317595699895, + "velocityY": -0.0006833787957962723, + "timestamp": 0.24866072131842998 + }, + { + "x": 4.085663316044443, + "y": 6.4245216623134365, + "heading": 0.11069894640828985, + "angularVelocity": -0.2654781022558683, + "velocityX": 1.1783025843295045, + "velocityY": -0.0007759469065193845, + "timestamp": 0.3108259016480375 + }, + { + "x": 4.173574156900502, + "y": 6.4244702509624405, + "heading": 0.09113759111571623, + "angularVelocity": -0.3146673940115171, + "velocityX": 1.414149213272517, + "velocityY": -0.0008270120141812696, + "timestamp": 0.37299108197764497 + }, + { + "x": 4.276152059818016, + "y": 6.424418464281491, + "heading": 0.0686410579111913, + "angularVelocity": -0.36188318099047606, + "velocityX": 1.650086147480532, + "velocityY": -0.0008330496376791236, + "timestamp": 0.43515626230725246 + }, + { + "x": 4.39340378630487, + "y": 6.424369226491044, + "heading": 0.04336192483995491, + "angularVelocity": -0.40664457075815247, + "velocityX": 1.886131848490915, + "velocityY": -0.0007920477377600693, + "timestamp": 0.49732144263685996 + }, + { + "x": 4.525337595489836, + "y": 6.424325450771935, + "heading": 0.015495928724554285, + "angularVelocity": -0.4482573036489503, + "velocityX": 2.122310407296116, + "velocityY": -0.000704183899678652, + "timestamp": 0.5594866229664675 + }, + { + "x": 4.671963731284715, + "y": 6.424289841531667, + "heading": -0.014694474575960468, + "angularVelocity": -0.4856481255333208, + "velocityX": 2.3586537514642383, + "velocityY": -0.0005728164879388929, + "timestamp": 0.621651803296075 + }, + { + "x": 4.833295019214238, + "y": 6.424264622086766, + "heading": -0.04683458533303072, + "angularVelocity": -0.5170114618289433, + "velocityX": 2.595203409273861, + "velocityY": -0.00040568441636908034, + "timestamp": 0.6838169836256824 + }, + { + "x": 5.009347081398109, + "y": 6.424251287994793, + "heading": -0.08033775965322806, + "angularVelocity": -0.5389379415061509, + "velocityX": 2.832004367242584, + "velocityY": -0.00021449454344913397, + "timestamp": 0.7459821639552899 + }, + { + "x": 5.200134146051008, + "y": 6.424251504702917, + "heading": -0.1141370339338056, + "angularVelocity": -0.5437010574306965, + "velocityX": 3.069034202769489, + "velocityY": 0.0000034860049153566075, + "timestamp": 0.8081473442848974 + }, + { + "x": 5.405613054428805, + "y": 6.424281444650923, + "heading": -0.1455833954142087, + "angularVelocity": -0.5058516892200839, + "velocityX": 3.3053697791645313, + "velocityY": 0.0004816192577199728, + "timestamp": 0.8703125246145049 + }, + { + "x": 5.620478420069855, + "y": 6.42365674720977, + "heading": -0.14578823417625966, + "angularVelocity": -0.003295072273013325, + "velocityX": 3.456361977907994, + "velocityY": -0.0100489926650518, + "timestamp": 0.9324777049441124 + }, + { + "x": 5.8354039344878705, + "y": 6.423689815718493, + "heading": -0.1457882693852108, + "angularVelocity": -5.663773666898463e-7, + "velocityX": 3.4573295416896364, + "velocityY": 0.0005319458344337396, + "timestamp": 0.9946428852737199 + }, + { + "x": 6.050013195110809, + "y": 6.4120346435837465, + "heading": -0.14578830470722368, + "angularVelocity": -5.68196097923049e-7, + "velocityX": 3.4522422276434255, + "velocityY": -0.1874871442976483, + "timestamp": 1.0568080656033274 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.07122763763060004, - "angularVelocity": -1.2107812437469553e-7, - "velocityX": 3.431893533353283, - "velocityY": -0.41861352112758443, - "timestamp": 1.1179511678287994 - }, - { - "x": 6.495461876785666, - "y": 6.33939114897125, - "heading": -0.07122764440367134, - "angularVelocity": -9.892307155851706e-8, - "velocityX": 3.390520591116758, - "velocityY": -0.6763880965782562, - "timestamp": 1.1864192328963874 - }, - { - "x": 6.723447879429968, - "y": 6.275695179020453, - "heading": -0.07122765108654068, - "angularVelocity": -9.760564039519094e-8, - "velocityX": 3.3298151834617853, - "velocityY": -0.9303018843590676, - "timestamp": 1.2548872979639754 - }, - { - "x": 6.944519208686096, - "y": 6.205139076086503, - "heading": -0.08666821845477282, - "angularVelocity": -0.2255148784033862, - "velocityX": 3.228823963958949, - "velocityY": -1.0304965222005587, - "timestamp": 1.3233553630315633 - }, - { - "x": 7.1486388975511135, - "y": 6.139973659962488, - "heading": -0.10579300445072114, - "angularVelocity": -0.2793241780247401, - "velocityX": 2.981239336375635, - "velocityY": -0.9517636588632731, - "timestamp": 1.3918234280991513 - }, - { - "x": 7.335725393832166, - "y": 6.080229656966579, - "heading": -0.12505884329720646, - "angularVelocity": -0.281384304163806, - "velocityX": 2.732463610536854, - "velocityY": -0.8725820269191563, - "timestamp": 1.4602914931667392 - }, - { - "x": 7.5057852138832075, - "y": 6.025913583564621, - "heading": -0.14350814844977783, - "angularVelocity": -0.26945854442299977, - "velocityX": 2.483783058323149, - "velocityY": -0.7933052197158056, - "timestamp": 1.5287595582343272 - }, - { - "x": 7.6588255623664905, - "y": 5.9770279139396525, - "heading": -0.16069404228282516, - "angularVelocity": -0.2510059809063169, - "velocityX": 2.2352077327175954, - "velocityY": -0.7139922762051272, - "timestamp": 1.5972276233019151 - }, - { - "x": 7.794851760455932, - "y": 5.9335736928791425, - "heading": -0.17635851781824094, - "angularVelocity": -0.22878513537592668, - "velocityX": 1.986710124715299, - "velocityY": -0.6346640732086548, - "timestamp": 1.665695688369503 - }, - { - "x": 7.913867698117727, - "y": 5.89555133346312, - "heading": -0.19033378635994255, - "angularVelocity": -0.20411367734587052, - "velocityX": 1.7382693310276776, - "velocityY": -0.5553298370340779, - "timestamp": 1.734163753437091 - }, - { - "x": 8.01587629682425, - "y": 5.862960943042519, - "heading": -0.20250190574704874, - "angularVelocity": -0.1777196328696382, - "velocityX": 1.489871206464301, - "velocityY": -0.47599403296165327, - "timestamp": 1.802631818504679 - }, - { - "x": 8.100879820230139, - "y": 5.835802482072584, - "heading": -0.21277523505977824, - "angularVelocity": -0.15004556215497408, - "velocityX": 1.2415061433673837, - "velocityY": -0.39665880645416857, - "timestamp": 1.871099883572267 - }, - { - "x": 8.168880075700757, - "y": 5.814075851441944, - "heading": -0.22108585453563723, - "angularVelocity": -0.12137949959087135, - "velocityX": 0.9931674774727836, - "velocityY": -0.3173250275028427, - "timestamp": 1.939567948639855 - }, - { - "x": 8.219878547444269, - "y": 5.7977809449089115, - "heading": -0.22737935642919127, - "angularVelocity": -0.09191879290500574, - "velocityX": 0.7448504889567138, - "velocityY": -0.23799280024852099, - "timestamp": 2.008036013707443 - }, - { - "x": 8.25387648706495, - "y": 5.786917682739713, - "heading": -0.23161096372628168, - "angularVelocity": -0.061804102290801306, - "velocityX": 0.49655178055813515, - "velocityY": -0.15866173753377388, - "timestamp": 2.076504078775031 + "heading": -0.14578834092456064, + "angularVelocity": -5.825984377491133e-7, + "velocityX": 3.4312825298390877, + "velocityY": -0.42358938340430125, + "timestamp": 1.118973245932935 + }, + { + "x": 6.49569885410855, + "y": 6.338969209681391, + "heading": -0.14578837085914265, + "angularVelocity": -4.366235413031805e-7, + "velocityX": 3.389467737301255, + "velocityY": -0.6816428759355991, + "timestamp": 1.1875324946937704 + }, + { + "x": 6.723883016534425, + "y": 6.274812198093867, + "heading": -0.14578840022622835, + "angularVelocity": -4.28346084046259e-7, + "velocityX": 3.328276878031172, + "velocityY": -0.9357893026414394, + "timestamp": 1.256091743454606 + }, + { + "x": 6.944379070760873, + "y": 6.204658250666653, + "heading": -0.16522808025100505, + "angularVelocity": -0.28354569771601223, + "velocityX": 3.2161387152247607, + "velocityY": -1.023260153738583, + "timestamp": 1.3246509922154415 + }, + { + "x": 7.148638930902927, + "y": 6.139545447418234, + "heading": -0.19715028206546042, + "angularVelocity": -0.465614813339248, + "velocityX": 2.979318820347672, + "velocityY": -0.949730407279711, + "timestamp": 1.393210240976277 + }, + { + "x": 7.3358170328874195, + "y": 6.0798421831912135, + "heading": -0.22994658912328278, + "angularVelocity": -0.4783644460899831, + "velocityX": 2.7301655920625914, + "velocityY": -0.870827281601222, + "timestamp": 1.4617694897371125 + }, + { + "x": 7.5059237430887356, + "y": 6.025569482278596, + "heading": -0.26160545834967963, + "angularVelocity": -0.4617738641920779, + "velocityX": 2.481163566927677, + "velocityY": -0.7916174971803536, + "timestamp": 1.530328738497948 + }, + { + "x": 7.658979831941821, + "y": 5.976731413281962, + "heading": -0.291240609478123, + "angularVelocity": -0.43225606557947815, + "velocityX": 2.232464497780769, + "velocityY": -0.7123483684455512, + "timestamp": 1.5988879872587836 + }, + { + "x": 7.795001086268662, + "y": 5.933327606851567, + "heading": -0.3183467386103757, + "angularVelocity": -0.39536794265075353, + "velocityX": 1.9839956940214167, + "velocityY": -0.633084627018105, + "timestamp": 1.667447236019619 + }, + { + "x": 7.91399908186447, + "y": 5.895356201186841, + "heading": -0.34259459104051004, + "angularVelocity": -0.3536773355659347, + "velocityX": 1.7356957339326504, + "velocityY": -0.5538480416724806, + "timestamp": 1.7360064847804546 + }, + { + "x": 8.015982502141213, + "y": 5.862814866579216, + "heading": -0.36375111540905714, + "angularVelocity": -0.3085874590363489, + "velocityX": 1.4875224294318823, + "velocityY": -0.4746454372792861, + "timestamp": 1.8045657335412901 + }, + { + "x": 8.100958056756967, + "y": 5.835701248475415, + "heading": -0.3816420491863885, + "angularVelocity": -0.26095580247302225, + "velocityX": 1.2394469914947026, + "velocityY": -0.39547717622147305, + "timestamp": 1.8731249823021257 + }, + { + "x": 8.168931078031942, + "y": 5.814013189562108, + "heading": -0.3961322011943633, + "angularVelocity": -0.211352257643937, + "velocityX": 0.9914493303754669, + "velocityY": -0.31634038157220884, + "timestamp": 1.9416842310629612 + }, + { + "x": 8.219905912133822, + "y": 5.797748853681938, + "heading": -0.4071141507461263, + "angularVelocity": -0.16018188282769613, + "velocityX": 0.7435150621282579, + "velocityY": -0.237230368974835, + "timestamp": 2.0102434798237967 + }, + { + "x": 8.253886183057102, + "y": 5.786906800693844, + "heading": -0.4145013188137657, + "angularVelocity": -0.10774867288013994, + "velocityX": 0.49563365318977964, + "velocityY": -0.1581413621656758, + "timestamp": 2.078802728584632 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": -0.03113870887356968, - "velocityX": 0.24826888316598922, - "velocityY": -0.07933112088153889, - "timestamp": 2.144972143842619 + "heading": -0.4182234468320189, + "angularVelocity": -0.05429067683103692, + "velocityX": 0.2477972609352767, + "velocityY": -0.07906688591998655, + "timestamp": 2.1473619773454677 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": 3.36795253902191e-24, - "velocityX": 6.840104022345504e-25, - "velocityY": -2.7903197660258634e-25, - "timestamp": 2.2134402089102068 + "heading": -0.4182234468320189, + "angularVelocity": 1.2149869731922202e-24, + "velocityX": 1.6200325032236621e-24, + "velocityY": -9.81678651755837e-25, + "timestamp": 2.2159212261063024 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceAmpSide.4.traj b/src/main/deploy/choreo/3PieceAmpSide.4.traj index 017297f..db1d01f 100644 --- a/src/main/deploy/choreo/3PieceAmpSide.4.traj +++ b/src/main/deploy/choreo/3PieceAmpSide.4.traj @@ -3,317 +3,317 @@ { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": 3.36795253902191e-24, - "velocityX": 6.840104022345504e-25, - "velocityY": -2.7903197660258634e-25, + "heading": -0.4182234468320189, + "angularVelocity": 1.2149869731922202e-24, + "velocityX": 1.6200325032236621e-24, + "velocityY": -9.81678651755837e-25, "timestamp": 0 }, { - "x": 8.25588746118901, - "y": 5.78629800647406, - "heading": -0.23128058254556338, - "angularVelocity": 0.03826965100123797, - "velocityX": -0.23293117405014754, - "velocityY": 0.07478612947192548, - "timestamp": 0.06434310900600693 - }, - { - "x": 8.225910832159517, - "y": 5.795922404411104, - "heading": -0.2264010507485791, - "angularVelocity": 0.07583612095164204, - "velocityX": -0.4658871710208216, - "velocityY": 0.14957931137808628, - "timestamp": 0.12868621801201385 - }, - { - "x": 8.18094329667614, - "y": 5.810359801198624, - "heading": -0.2191564862983393, - "angularVelocity": 0.11259270125668563, - "velocityX": -0.6988710396194479, - "velocityY": 0.22438139857638179, - "timestamp": 0.19302932701802078 - }, - { - "x": 8.120982799778487, - "y": 5.829610864577548, - "heading": -0.20960792096845732, - "angularVelocity": 0.14840074527624142, - "velocityX": -0.9318868457546265, - "velocityY": 0.29919386359037625, - "timestamp": 0.2573724360240277 - }, - { - "x": 8.046026937871678, - "y": 5.8536763244448125, - "heading": -0.19782824103540664, - "angularVelocity": 0.18307601412220878, - "velocityX": -1.1649400077918135, - "velocityY": 0.3740176724288817, - "timestamp": 0.32171554503003463 - }, - { - "x": 7.956072840637482, - "y": 5.882556928320405, - "heading": -0.18390654809481916, - "angularVelocity": 0.21636649449574452, - "velocityX": -1.398037779396045, - "velocityY": 0.44885309898369946, - "timestamp": 0.38605865403604156 - }, - { - "x": 7.851117008381534, - "y": 5.916253378394258, - "heading": -0.16795492330897657, - "angularVelocity": 0.24791504532914582, - "velocityX": -1.6311899421295915, - "velocityY": 0.5236994387496536, - "timestamp": 0.4504017630420485 - }, - { - "x": 7.731155087211633, - "y": 5.954766238569468, - "heading": -0.1501194492315059, - "angularVelocity": 0.2771932278840516, - "velocityX": -1.8644097716617982, - "velocityY": 0.5985545425169684, - "timestamp": 0.5147448720480554 - }, - { - "x": 7.59618156695547, - "y": 5.998095789487358, - "heading": -0.13059931402796102, - "angularVelocity": 0.3033756917422545, - "velocityX": -2.0977152385278854, - "velocityY": 0.6734140079218763, - "timestamp": 0.5790879810540623 - }, - { - "x": 7.446189432123703, - "y": 6.046241786918251, - "heading": -0.10968278786227058, - "angularVelocity": 0.32507795300562, - "velocityX": -2.331129737883228, - "velocityY": 0.7482696775873314, - "timestamp": 0.6434310900600693 - }, - { - "x": 7.28117009063335, - "y": 6.099203028154522, - "heading": -0.08782351563109066, - "angularVelocity": 0.33972981052468115, - "velocityX": -2.5646777726414474, - "velocityY": 0.8231066551559874, - "timestamp": 0.7077741990660762 - }, - { - "x": 7.101115905345124, - "y": 6.156976525213083, - "heading": -0.0658352910964324, - "angularVelocity": 0.34173394593980894, - "velocityX": -2.7983445013733177, - "velocityY": 0.8978971944480737, - "timestamp": 0.7721173080720831 - }, - { - "x": 6.906047579451745, - "y": 6.219555700669507, - "heading": -0.04559053086240348, - "angularVelocity": 0.31463758196916874, - "velocityX": -3.031689467712312, - "velocityY": 0.9725855095155665, - "timestamp": 0.83646041707809 - }, - { - "x": 6.696779607755081, - "y": 6.28666337072034, - "heading": -0.03685580053222356, - "angularVelocity": 0.1357523822693175, - "velocityX": -3.2523758166103667, - "velocityY": 1.0429659226532966, - "timestamp": 0.900803526084097 - }, - { - "x": 6.481807673364994, - "y": 6.343877480354193, - "heading": -0.03685579080558635, - "angularVelocity": 1.511682814166473e-7, - "velocityX": -3.341024978603622, - "velocityY": 0.8892033741874479, - "timestamp": 0.9651466350901039 + "x": 8.255885275596246, + "y": 5.786297415399053, + "heading": -0.4161957197256105, + "angularVelocity": 0.03152694238731417, + "velocityX": -0.233058706268173, + "velocityY": 0.07480697540219873, + "timestamp": 0.06431727763185613 + }, + { + "x": 8.225904877332317, + "y": 5.795920588198962, + "heading": -0.4121767719087599, + "angularVelocity": 0.06248628618665337, + "velocityX": -0.46613288633782896, + "velocityY": 0.14962033771067135, + "timestamp": 0.12863455526371226 + }, + { + "x": 8.180932637466617, + "y": 5.810356062930585, + "heading": -0.4062099213750387, + "angularVelocity": 0.09277212521143607, + "velocityX": -0.6992248664987879, + "velocityY": 0.22444163159780386, + "timestamp": 0.1929518328955684 + }, + { + "x": 8.120967221795235, + "y": 5.8296044401602, + "heading": -0.3983469021562322, + "angularVelocity": 0.12225360755804271, + "velocityX": -0.9323375907577511, + "velocityY": 0.29927226304244037, + "timestamp": 0.2572691105274245 + }, + { + "x": 8.046007053762992, + "y": 5.853666398213901, + "heading": -0.38865015214844967, + "angularVelocity": 0.15076431038150498, + "velocityX": -1.16547482717328, + "velocityY": 0.3741134410481226, + "timestamp": 0.32158638815928065 + }, + { + "x": 7.95605024235754, + "y": 5.882542674483832, + "heading": -0.37719620256520386, + "angularVelocity": 0.17808511188559348, + "velocityX": -1.398641464900824, + "velocityY": 0.44896608396916854, + "timestamp": 0.3859036657911368 + }, + { + "x": 7.851094482525453, + "y": 5.916234036378714, + "heading": -0.3640809123745278, + "angularVelocity": 0.20391550565536098, + "velocityX": -1.6318439414186696, + "velocityY": 0.5238306585009168, + "timestamp": 0.4502209434229929 + }, + { + "x": 7.731136916910522, + "y": 5.954741232958676, + "heading": -0.349427957292727, + "angularVelocity": 0.22782299906523523, + "velocityX": -1.8650908438872864, + "velocityY": 0.5987068793609814, + "timestamp": 0.514538221054849 + }, + { + "x": 7.596173948111591, + "y": 5.998064906716331, + "heading": -0.33340347371338613, + "angularVelocity": 0.24914741682729602, + "velocityX": -2.0983936784675863, + "velocityY": 0.6735930896459054, + "timestamp": 0.5788554986867052 + }, + { + "x": 7.446201013798343, + "y": 6.046205411855825, + "heading": -0.31624349903105253, + "angularVelocity": 0.26680194364810067, + "velocityX": -2.331767447802665, + "velocityY": 0.7484848070691726, + "timestamp": 0.6431727763185613 + }, + { + "x": 7.281212494788232, + "y": 6.099162371697227, + "heading": -0.2983118341454104, + "angularVelocity": 0.27880012254686504, + "velocityX": -2.56522858374831, + "velocityY": 0.82337066790236, + "timestamp": 0.7074900539504174 + }, + { + "x": 7.101203008664871, + "y": 6.1569332933758485, + "heading": -0.28024668313688234, + "angularVelocity": 0.280875554340636, + "velocityX": -2.7987734050827355, + "velocityY": 0.8982177698703966, + "timestamp": 0.7718073315822735 + }, + { + "x": 6.9061821193945345, + "y": 6.219506729950283, + "heading": -0.26348073873693967, + "angularVelocity": 0.26067559164908854, + "velocityX": -3.0321695266179045, + "velocityY": 0.9728868956891804, + "timestamp": 0.8361246092141297 + }, + { + "x": 6.696607254404851, + "y": 6.286709539594328, + "heading": -0.25518312367209683, + "angularVelocity": 0.12901066976648753, + "velocityX": -3.258453602300528, + "velocityY": 1.0448640259419284, + "timestamp": 0.9004418868459858 + }, + { + "x": 6.4817199239739445, + "y": 6.3438942094131185, + "heading": -0.2551831038227718, + "angularVelocity": 3.086157524298735e-7, + "velocityX": -3.3410513992973323, + "velocityY": 0.8891027718260752, + "timestamp": 0.9647591644778419 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.03685578092347688, - "angularVelocity": 1.535845813935868e-7, - "velocityX": -3.3956733580359946, - "velocityY": 0.6500253635647798, - "timestamp": 1.0294897440961108 - }, - { - "x": 6.037947373246119, - "y": 6.41213150954562, - "heading": -0.03685577219409298, - "angularVelocity": 1.3300204704480323e-7, - "velocityX": -3.4337993949471355, - "velocityY": 0.40268147161399886, - "timestamp": 1.0951231993951023 - }, - { - "x": 5.811253837433788, - "y": 6.422188591577065, - "heading": -0.03685576369032069, - "angularVelocity": 1.295645985289539e-7, - "velocityX": -3.453932674725614, - "velocityY": 0.1532310311201851, - "timestamp": 1.1607566546940937 - }, - { - "x": 5.5843374246066, - "y": 6.422402330529617, - "heading": -0.036855755226474385, - "angularVelocity": 1.2895628100949306e-7, - "velocityX": -3.4573284583826145, - "velocityY": 0.003256554931891515, - "timestamp": 1.2263901099930852 - }, - { - "x": 5.357421124392654, - "y": 6.422695719883416, - "heading": -0.036855660140139614, - "angularVelocity": 0.0000014487479646455729, - "velocityX": -3.457326742592384, - "velocityY": 0.004470118973044206, - "timestamp": 1.2920235652920766 - }, - { - "x": 5.144263768203255, - "y": 6.422952100628831, - "heading": -0.014977306551592268, - "angularVelocity": 0.3333414870340277, - "velocityX": -3.24769365285379, - "velocityY": 0.003906250924130374, - "timestamp": 1.357657020591068 - }, - { - "x": 4.9475144604587005, - "y": 6.423195621457961, - "heading": 0.008467722873920253, - "angularVelocity": 0.3572115671605153, - "velocityX": -2.997698458023694, - "velocityY": 0.003710315539856156, - "timestamp": 1.4232904758900595 - }, - { - "x": 4.7671901020112575, - "y": 6.4234252651818, - "heading": 0.031563837809847756, - "angularVelocity": 0.351895459879624, - "velocityX": -2.7474457595745863, - "velocityY": 0.003498882129429363, - "timestamp": 1.488923931189051 - }, - { - "x": 4.603282473031131, - "y": 6.423639886537377, - "heading": 0.05353860692981436, - "angularVelocity": 0.33481048681439957, - "velocityX": -2.4973182995386867, - "velocityY": 0.0032699993410297092, - "timestamp": 1.5545573864880424 - }, - { - "x": 4.455783456484323, - "y": 6.42383812523004, - "heading": 0.07396862253695916, - "angularVelocity": 0.31127441811613105, - "velocityX": -2.2473145117056283, - "velocityY": 0.003020390923493434, - "timestamp": 1.6201908417870339 - }, - { - "x": 4.3246865966511425, - "y": 6.424018569277829, - "heading": 0.09258438097284048, - "angularVelocity": 0.28363215605635267, - "velocityX": -1.9974090840710925, - "velocityY": 0.00274926936219822, - "timestamp": 1.6858242970860253 - }, - { - "x": 4.2099868313745406, - "y": 6.424179849937859, - "heading": 0.10919817149890491, - "angularVelocity": 0.2531299083734149, - "velocityX": -1.74758078413044, - "velocityY": 0.0024572934534053846, - "timestamp": 1.7514577523850168 - }, - { - "x": 4.1116801359818504, - "y": 6.424320695943855, - "heading": 0.12367125117094976, - "angularVelocity": 0.2205137548543349, - "velocityX": -1.4978138046344804, - "velocityY": 0.0021459483636000858, - "timestamp": 1.8170912076840082 - }, - { - "x": 4.029763255877016, - "y": 6.424439966413886, - "heading": 0.13589682908173525, - "angularVelocity": 0.18627052095752253, - "velocityX": -1.2480964125942142, - "velocityY": 0.0018172206458870563, - "timestamp": 1.8827246629829997 - }, - { - "x": 3.96423352032589, - "y": 6.424536671966407, - "heading": 0.14579041449268346, - "angularVelocity": 0.15073997500022146, - "velocityX": -0.9984197122124082, - "velocityY": 0.001473418580201188, - "timestamp": 1.9483581182819911 - }, - { - "x": 3.9150887131755114, - "y": 6.424609988913992, - "heading": 0.15328395817373033, - "angularVelocity": 0.11417262197929685, - "velocityX": -0.7487767774300566, - "velocityY": 0.001117066704044862, - "timestamp": 2.0139915735809826 - }, - { - "x": 3.8823269815488697, - "y": 6.42465926920727, - "heading": 0.15832209310095952, - "angularVelocity": 0.07676168966387754, - "velocityX": -0.4991620733267284, - "velocityY": 0.0007508410619806591, - "timestamp": 2.079625028879974 + "heading": -0.2551830834264048, + "angularVelocity": 3.1712111825091784e-7, + "velocityX": -3.395672821911929, + "velocityY": 0.6500263273718765, + "timestamp": 1.029076442109698 + }, + { + "x": 6.037162237236338, + "y": 6.412166410916887, + "heading": -0.25518303828533845, + "angularVelocity": 6.854074958240057e-7, + "velocityX": -3.4338993409830967, + "velocityY": 0.4018251187344374, + "timestamp": 1.0949366297991254 + }, + { + "x": 5.8096806134973695, + "y": 6.422145044657871, + "heading": -0.2551829940595105, + "angularVelocity": 6.715108093540807e-7, + "velocityX": -3.4540081302483707, + "velocityY": 0.15151237934575548, + "timestamp": 1.1607968174885528 + }, + { + "x": 5.5819802469231306, + "y": 6.422071707013465, + "heading": -0.25518294988305257, + "angularVelocity": 6.707611912611386e-7, + "velocityX": -3.457329451412868, + "velocityY": -0.0011135353083337968, + "timestamp": 1.2266570051779802 + }, + { + "x": 5.357973256918571, + "y": 6.423240614393437, + "heading": -0.2430314751768064, + "angularVelocity": 0.18450410077098406, + "velocityX": -3.4012504042790286, + "velocityY": 0.017748315347736767, + "timestamp": 1.2925171928674075 + }, + { + "x": 5.144457161392198, + "y": 6.423376601690841, + "heading": -0.1958139855508891, + "angularVelocity": 0.7169352424043682, + "velocityX": -3.241960021936682, + "velocityY": 0.0020647875776692963, + "timestamp": 1.3583773805568349 + }, + { + "x": 4.947462840354243, + "y": 6.423510104020051, + "heading": -0.14701489396398695, + "angularVelocity": 0.7409497801163326, + "velocityX": -2.991098688739039, + "velocityY": 0.002027056616322834, + "timestamp": 1.4242375682462622 + }, + { + "x": 4.766993522305038, + "y": 6.423644398305699, + "heading": -0.09964051366094051, + "angularVelocity": 0.719317420206062, + "velocityX": -2.74018833502617, + "velocityY": 0.002039081429309675, + "timestamp": 1.4900977559356896 + }, + { + "x": 4.60301308935793, + "y": 6.423783110988961, + "heading": -0.05492917751371649, + "angularVelocity": 0.6788826105091881, + "velocityX": -2.4898263837385226, + "velocityY": 0.0021061689638151486, + "timestamp": 1.555957943625117 + }, + { + "x": 4.455491999512653, + "y": 6.4239249853365035, + "heading": -0.013574200580991685, + "angularVelocity": 0.6279207269760504, + "velocityX": -2.2399129887228693, + "velocityY": 0.0021541746618076994, + "timestamp": 1.6218181313145443 + }, + { + "x": 4.324407720523135, + "y": 6.424066362703545, + "heading": 0.023974314912572615, + "angularVelocity": 0.570124635396258, + "velocityX": -1.9903417161162953, + "velocityY": 0.0021466286690262756, + "timestamp": 1.6876783190039717 + }, + { + "x": 4.2097428344188135, + "y": 6.424202667515828, + "heading": 0.05739701354466356, + "angularVelocity": 0.5074795533486763, + "velocityX": -1.7410349123971218, + "velocityY": 0.002069608621913246, + "timestamp": 1.753538506693399 + }, + { + "x": 4.11148358029628, + "y": 6.424329194128387, + "heading": 0.08645394614427561, + "angularVelocity": 0.4411911599255325, + "velocityX": -1.4919370498287492, + "velocityY": 0.001921139568510551, + "timestamp": 1.8193986943828264 + }, + { + "x": 4.029618879443776, + "y": 6.4244415432031925, + "heading": 0.11095800828046558, + "angularVelocity": 0.3720618327378889, + "velocityX": -1.2430074028720826, + "velocityY": 0.00170587237520769, + "timestamp": 1.8852588820722538 + }, + { + "x": 3.964139686055167, + "y": 6.424535880555734, + "heading": 0.13075995126873372, + "angularVelocity": 0.3006663613175029, + "velocityX": -0.994215104539091, + "velocityY": 0.0014323881520982617, + "timestamp": 1.9511190697616811 + }, + { + "x": 3.91503854489554, + "y": 6.424609101274365, + "heading": 0.14573933177166642, + "angularVelocity": 0.22744211683042614, + "velocityX": -0.7455360041056982, + "velocityY": 0.0011117599448221096, + "timestamp": 2.0169792574511085 + }, + { + "x": 3.882309280386553, + "y": 6.424658939920723, + "heading": 0.15579869857714623, + "angularVelocity": 0.1527382043445731, + "velocityX": -0.496950671676277, + "velocityY": 0.000756734046866559, + "timestamp": 2.082839445140536 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.038661759828822626, - "velocityX": -0.24957107255583263, - "velocityY": 0.0003775283746879617, - "timestamp": 2.1452584841789655 + "angularVelocity": 0.07684307602012863, + "velocityX": -0.2484431224119383, + "velocityY": 0.0003812284649235306, + "timestamp": 2.1486996328299632 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.109695162138055e-26, - "velocityX": 1.5462924583542684e-27, - "velocityY": -8.002962968658591e-26, - "timestamp": 2.210891939477957 + "angularVelocity": 3.773099570003496e-26, + "velocityX": -4.36512163919617e-27, + "velocityY": 1.07464594312406e-25, + "timestamp": 2.2145598205193906 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceAmpSide.traj b/src/main/deploy/choreo/3PieceAmpSide.traj index f84a639..8ba9362 100644 --- a/src/main/deploy/choreo/3PieceAmpSide.traj +++ b/src/main/deploy/choreo/3PieceAmpSide.traj @@ -4,1414 +4,1414 @@ "x": 0.660783052444458, "y": 6.694385051727295, "heading": 1.0498621745809171, - "angularVelocity": 2.975965783776085e-24, - "velocityX": -7.418307455922956e-25, - "velocityY": -5.74149655283962e-25, + "angularVelocity": 5.036142496978594e-25, + "velocityX": 4.0909648611784826e-25, + "velocityY": -1.2650073502903171e-25, "timestamp": 0 }, { - "x": 0.6757749956355112, - "y": 6.7030690975147875, - "heading": 1.049862156272713, - "angularVelocity": -2.7160773495894344e-7, - "velocityX": 0.2224100034263669, - "velocityY": 0.12883044104006075, - "timestamp": 0.06740678458744168 - }, - { - "x": 0.7057588818438879, - "y": 6.720437189007701, - "heading": 1.0498621183971346, - "angularVelocity": -5.618956424511116e-7, - "velocityX": 0.44482000427539625, - "velocityY": 0.25766088086256306, - "timestamp": 0.13481356917488335 - }, - { - "x": 0.7507347108263656, - "y": 6.746489326091134, - "heading": 1.0498620591913437, - "angularVelocity": -8.783357826024073e-7, - "velocityX": 0.6672300015161533, - "velocityY": 0.3864913189804834, - "timestamp": 0.20222035376232503 - }, - { - "x": 0.8107024822181115, - "y": 6.781225508592738, - "heading": 1.0498619760110848, - "angularVelocity": -0.0000012340042572456138, - "velocityX": 0.889639993344503, - "velocityY": 0.5153217545415306, - "timestamp": 0.2696271383497667 - }, - { - "x": 0.8856621954110708, - "y": 6.82464573622526, - "heading": 1.0498618644492663, - "angularVelocity": -0.0000016550532570780867, - "velocityX": 1.1120499761521767, - "velocityY": 0.6441521858411218, - "timestamp": 0.33703392293720835 - }, - { - "x": 0.9756138491891349, - "y": 6.876750008414199, - "heading": 1.049861715691714, - "angularVelocity": -0.0000022068631981896758, - "velocityX": 1.3344599409185074, - "velocityY": 0.7729826086177988, - "timestamp": 0.40444070752465 - }, - { - "x": 1.080557439903982, - "y": 6.937538323436046, - "heading": 1.0498615032959615, - "angularVelocity": -0.000003150955112011347, - "velocityX": 1.5568698515608894, - "velocityY": 0.9018130058257152, - "timestamp": 0.47184749211209165 - }, - { - "x": 1.1972134624219284, - "y": 7.00511102725867, - "heading": 1.0334113148085255, - "angularVelocity": -0.2440435126540754, - "velocityX": 1.7306273134363406, - "velocityY": 1.002461461946278, - "timestamp": 0.5392542766995333 - }, - { - "x": 1.3138694823179202, - "y": 7.072683735607794, - "heading": 0.9724412548974013, - "angularVelocity": -0.9045092461283692, - "velocityX": 1.7306272745388522, - "velocityY": 1.0024615290982395, - "timestamp": 0.606661061286975 - }, - { - "x": 1.430525502226175, - "y": 7.140256443935745, - "heading": 0.8706390523679578, - "angularVelocity": -1.5102664094203053, - "velocityX": 1.7306272747207776, - "velocityY": 1.0024615287841676, - "timestamp": 0.6740678458744166 - }, - { - "x": 1.547181522136343, - "y": 7.207829152260394, - "heading": 0.7338713337275233, - "angularVelocity": -2.0289903972947423, - "velocityX": 1.7306272747491633, - "velocityY": 1.0024615287351624, - "timestamp": 0.7414746304618582 - }, - { - "x": 1.6638375420295233, - "y": 7.27540186061437, - "heading": 0.5723504105376668, - "angularVelocity": -2.396211659975084, - "velocityX": 1.730627274497144, - "velocityY": 1.0024615291702423, - "timestamp": 0.8088814150492999 - }, - { - "x": 1.780493561897231, - "y": 7.342974569012322, - "heading": 0.4041720655827993, - "angularVelocity": -2.4949765217876934, - "velocityX": 1.7306272741192532, - "velocityY": 1.0024615298226245, - "timestamp": 0.8762881996367415 - }, - { - "x": 1.8971495817456219, - "y": 7.41054727744362, - "heading": 0.25128074546081974, - "angularVelocity": -2.26818889311721, - "velocityX": 1.730627273832679, - "velocityY": 1.0024615303173605, - "timestamp": 0.9436949842241832 - }, - { - "x": 2.013805601595548, - "y": 7.47811998587227, - "heading": 0.1281466559461925, - "angularVelocity": -1.8267313931121394, - "velocityX": 1.730627273855457, - "velocityY": 1.0024615302780377, - "timestamp": 1.0111017688116248 - }, - { - "x": 2.1304616214625116, - "y": 7.545692694271506, - "heading": 0.04279406558189714, - "angularVelocity": -1.2662314466813642, - "velocityX": 1.7306272741082105, - "velocityY": 1.00246152984169, - "timestamp": 1.0785085533990666 - }, - { - "x": 2.2471176982189394, - "y": 7.613265304457943, - "heading": 0.0000053749809852541795, - "angularVelocity": -0.6347831433111215, - "velocityX": 1.7306281180805858, - "velocityY": 1.0024600728251583, - "timestamp": 1.1459153379865084 - }, - { - "x": 2.365737917103605, - "y": 7.677327317867433, - "heading": 0.0000017799981215852186, - "angularVelocity": -0.00005333265613649712, - "velocityX": 1.7597667595431528, - "velocityY": 0.9503793097620272, - "timestamp": 1.2133221225739501 - }, - { - "x": 2.4915943391699567, - "y": 7.725647695571818, - "heading": 7.919893506038426e-7, - "angularVelocity": -0.000014657408405228224, - "velocityX": 1.867118018410863, - "velocityY": 0.7168473915515575, - "timestamp": 1.2807289071613919 - }, - { - "x": 2.622608453293523, - "y": 7.757428188688913, - "heading": 3.1614094305550046e-7, - "angularVelocity": -0.000007059354788405022, - "velocityX": 1.9436339372279638, - "velocityY": 0.47147321017617505, - "timestamp": 1.3481356917488336 - }, - { - "x": 2.7566164600311245, - "y": 7.772143891506238, - "heading": 8.293455771499583e-8, - "angularVelocity": -0.000003459687133392096, - "velocityX": 1.9880492380372032, - "velocityY": 0.2183118940829424, - "timestamp": 1.4155424763362754 + "x": 0.6757749919218088, + "y": 6.703069104575789, + "heading": 1.049862128706329, + "angularVelocity": -6.805633230382436e-7, + "velocityX": 0.2224099351379215, + "velocityY": 0.12883053814923912, + "timestamp": 0.06740678858637275 + }, + { + "x": 0.705758870441161, + "y": 6.720437210067111, + "heading": 1.0498620338020643, + "angularVelocity": -0.0000014079333376652512, + "velocityX": 0.4448198638173059, + "velocityY": 0.25766107324734056, + "timestamp": 0.1348135771727455 + }, + { + "x": 0.750734687393026, + "y": 6.746489367913325, + "heading": 1.049861885451002, + "angularVelocity": -0.000002200832664302106, + "velocityX": 0.6672297834547413, + "velocityY": 0.3864916040738485, + "timestamp": 0.20222036575911825 + }, + { + "x": 0.8107024418631711, + "y": 6.781225577682529, + "heading": 1.0498616770274682, + "angularVelocity": -0.000003092025867532283, + "velocityX": 0.8896396895292586, + "velocityY": 0.5153221284929648, + "timestamp": 0.269627154345491 + }, + { + "x": 0.8856621323278759, + "y": 6.82464583865489, + "heading": 1.0498613974886852, + "angularVelocity": -0.0000041470419969153815, + "velocityX": 1.1120495729989293, + "velocityY": 0.6441526422330909, + "timestamp": 0.33703394293186373 + }, + { + "x": 0.9756137557397047, + "y": 6.8767501493907295, + "heading": 1.0498610247491444, + "angularVelocity": -0.000005529703292486692, + "velocityX": 1.334459411258968, + "velocityY": 0.7729831346152221, + "timestamp": 0.40444073151823645 + }, + { + "x": 1.0805573029563829, + "y": 6.937538505571021, + "heading": 1.049860492552681, + "angularVelocity": -0.000007895294742633066, + "velocityX": 1.556869113890614, + "velocityY": 0.9018135629232547, + "timestamp": 0.4718475201046092 + }, + { + "x": 1.1972133032133725, + "y": 7.005111257740716, + "heading": 1.0334106168225663, + "angularVelocity": -0.2440388583271016, + "velocityX": 1.7306268805182825, + "velocityY": 1.0024621197182535, + "timestamp": 0.5392543086909819 + }, + { + "x": 1.3138692969010544, + "y": 7.072684021251592, + "heading": 0.9724418882550508, + "angularVelocity": -0.9044894415848371, + "velocityX": 1.7306267830606272, + "velocityY": 1.0024622879680827, + "timestamp": 0.6066610972773546 + }, + { + "x": 1.4305252906191748, + "y": 7.140256784709921, + "heading": 0.8706420088958982, + "angularVelocity": -1.5102318548926246, + "velocityX": 1.7306267835121878, + "velocityY": 1.0024622871885176, + "timestamp": 0.6740678858637273 + }, + { + "x": 1.5471812843420916, + "y": 7.207829548159968, + "heading": 0.7338773790646791, + "angularVelocity": -2.028944453509658, + "velocityX": 1.7306267835833422, + "velocityY": 1.0024622870656754, + "timestamp": 0.7414746744501001 + }, + { + "x": 1.6638372780224426, + "y": 7.2754023116835, + "heading": 0.5723600050127189, + "angularVelocity": -2.396158865289915, + "velocityX": 1.7306267829518702, + "velocityY": 1.002462288155831, + "timestamp": 0.8088814630364728 + }, + { + "x": 1.780493271638965, + "y": 7.3429750753172245, + "heading": 0.40418447555722015, + "angularVelocity": -2.4949346049916663, + "velocityX": 1.7306267820049508, + "velocityY": 1.0024622897905686, + "timestamp": 0.8762882516228455 + }, + { + "x": 1.8971492652070823, + "y": 7.410547839034513, + "heading": 0.25129496131963275, + "angularVelocity": -2.26816196771754, + "velocityX": 1.7306267812868497, + "velocityY": 1.0024622910302834, + "timestamp": 0.9436950402092182 + }, + { + "x": 2.013805258779043, + "y": 7.478120602745167, + "heading": 0.12816045902008172, + "angularVelocity": -1.8267374085292716, + "velocityX": 1.7306267813438676, + "velocityY": 1.0024622909318521, + "timestamp": 1.011101828795591 + }, + { + "x": 2.1304612523991975, + "y": 7.545693366372621, + "heading": 0.04280584220849794, + "angularVelocity": -1.266261434517286, + "velocityX": 1.7306267820588324, + "velocityY": 1.0024622896975566, + "timestamp": 1.0785086173819638 + }, + { + "x": 2.247117388567763, + "y": 7.613265883907332, + "heading": 0.000013466426965438275, + "angularVelocity": -0.6348377764162405, + "velocityX": 1.7306288968074217, + "velocityY": 1.002458638837633, + "timestamp": 1.1459154059683365 + }, + { + "x": 2.365737851453118, + "y": 7.677327455956403, + "heading": 0.000004459976492377945, + "angularVelocity": -0.00013361340396034107, + "velocityX": 1.759770274968055, + "velocityY": 0.9503727056657639, + "timestamp": 1.2133221945547092 + }, + { + "x": 2.491594313865089, + "y": 7.725647742212638, + "heading": 0.000001984433687850704, + "angularVelocity": -0.000036725422712508624, + "velocityX": 1.8671185061828453, + "velocityY": 0.7168459923634953, + "timestamp": 1.280728983141082 + }, + { + "x": 2.622608441209736, + "y": 7.7574282007435205, + "heading": 7.92136305089401e-7, + "angularVelocity": -0.00001768809058799076, + "velocityX": 1.9436340180599136, + "velocityY": 0.4714726691089775, + "timestamp": 1.3481357717274547 + }, + { + "x": 2.7566164536261604, + "y": 7.772143891629413, + "heading": 2.0780523669770732e-7, + "angularVelocity": -0.000008668727299520462, + "velocityX": 1.9880492043425424, + "velocityY": 0.2183117041251145, + "timestamp": 1.4155425603138274 }, { "x": 2.8914051055908203, "y": 7.769551753997803, - "heading": -1.0848168375526677e-23, - "angularVelocity": -0.0000012303592023056844, - "velocityX": 1.9996302506440553, - "velocityY": -0.03845514252460355, - "timestamp": 1.4829492609237171 - }, - { - "x": 2.9864482888367814, - "y": 7.767723966507321, - "heading": -4.197390937938893e-8, - "angularVelocity": -9.569459118940512e-7, - "velocityX": 2.1668504793904355, - "velocityY": -0.04167097591548553, - "timestamp": 1.526811624363163 - }, - { - "x": 3.0888261462817113, - "y": 7.765755124968672, - "heading": -7.1955269378711e-8, - "angularVelocity": -6.835327065928114e-7, - "velocityX": 2.334070702466078, - "velocityY": -0.04488680919731284, - "timestamp": 1.570673987802609 - }, - { - "x": 3.1985386775939677, - "y": 7.763645229388232, - "heading": -8.99440850277704e-8, - "angularVelocity": -4.1011961596400926e-7, - "velocityX": 2.501290917980737, - "velocityY": -0.048102642333733917, - "timestamp": 1.614536351242055 - }, - { - "x": 3.315585882309251, - "y": 7.7613942797749305, - "heading": -9.594036346771443e-8, - "angularVelocity": -1.3670668814329107e-7, - "velocityX": 2.6685111229100227, - "velocityY": -0.05131847526658634, - "timestamp": 1.658398714681501 - }, - { - "x": 3.4399677597311125, - "y": 7.759002276142162, - "heading": -8.994411556657709e-8, - "angularVelocity": 1.3670599190158685e-7, - "velocityX": 2.8357313119612524, - "velocityY": -0.05453430789408585, - "timestamp": 1.7022610781209468 - }, - { - "x": 3.571684308698804, - "y": 7.756469218512247, - "heading": -7.195535972468811e-8, - "angularVelocity": 4.1011825244490774e-7, - "velocityX": 3.0029514745490706, - "velocityY": -0.05775014001266415, - "timestamp": 1.7461234415603928 - }, - { - "x": 3.710735526890833, - "y": 7.753795106929833, - "heading": -4.197413327831008e-8, - "angularVelocity": 6.835296617741198e-7, - "velocityX": 3.1701715842101277, - "velocityY": -0.060965971113401206, - "timestamp": 1.7899858049998387 - }, - { - "x": 3.857121407342745, - "y": 7.7509799415288505, - "heading": -5.486954628378907e-13, - "angularVelocity": 9.569385069911643e-7, - "velocityX": 3.3373915350914642, - "velocityY": -0.06418179916062534, - "timestamp": 1.8338481684392847 - }, - { - "x": 4.00874003287894, - "y": 7.748064144544636, - "heading": -4.703910632575431e-13, - "angularVelocity": 1.7852298290809937e-12, - "velocityX": 3.4566907400124736, - "velocityY": -0.06647605727501009, - "timestamp": 1.8777105318787306 - }, - { - "x": 4.160358658415212, - "y": 7.745148347560415, - "heading": -3.920667535801572e-13, - "angularVelocity": 1.7856837512018541e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 1.9215728953181765 - }, - { - "x": 4.311977283951483, - "y": 7.742232550576195, - "heading": -3.137296429210842e-13, - "angularVelocity": 1.7859755955231185e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 1.9654352587576225 - }, - { - "x": 4.463595909487755, - "y": 7.739316753591974, - "heading": -2.354583223670877e-13, - "angularVelocity": 1.7844756739521518e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504378, - "timestamp": 2.0092976221970686 - }, - { - "x": 4.615214535024027, - "y": 7.736400956607756, - "heading": -1.571841611983832e-13, - "angularVelocity": 1.7845404359596027e-12, - "velocityX": 3.4566907400142255, - "velocityY": -0.06647605727504377, - "timestamp": 2.0531599856365146 - }, - { - "x": 4.7668331605602985, - "y": 7.7334851596235366, - "heading": -7.889094544923358e-14, - "angularVelocity": 1.7849748535092055e-12, - "velocityX": 3.456690740014226, - "velocityY": -0.06647605727504377, - "timestamp": 2.0970223490759605 + "heading": -8.09802518102299e-24, + "angularVelocity": -0.000003082853241575703, + "velocityX": 1.9996302270348674, + "velocityY": -0.03845514207057226, + "timestamp": 1.4829493489002001 + }, + { + "x": 2.9864482996127166, + "y": 7.767723966300088, + "heading": -1.0517201217515276e-7, + "angularVelocity": -0.0000023977731499342787, + "velocityX": 2.1668504195789944, + "velocityY": -0.04167097476524414, + "timestamp": 1.526811718523463 + }, + { + "x": 3.0888261669051587, + "y": 7.76575512457206, + "heading": -1.802948176200958e-7, + "angularVelocity": -0.0000017126937301878197, + "velocityX": 2.3340705979128114, + "velocityY": -0.04488680718663573, + "timestamp": 1.570674088146726 + }, + { + "x": 3.1985387066370827, + "y": 7.7636452288297, + "heading": -2.2536845598951497e-7, + "angularVelocity": -0.0000010276152145121185, + "velocityX": 2.5012907572995546, + "velocityY": -0.04810263924365375, + "timestamp": 1.614536457769989 + }, + { + "x": 3.315585917645001, + "y": 7.761394279095385, + "heading": -2.4039298339678027e-7, + "angularVelocity": -3.4253797814190234e-7, + "velocityX": 2.668510890160408, + "velocityY": -0.05131847079054902, + "timestamp": 1.658398827393252 + }, + { + "x": 3.4399677981836816, + "y": 7.759002275402676, + "heading": -2.2536848500409826e-7, + "angularVelocity": 3.4253731665043406e-7, + "velocityX": 2.835730983232458, + "velocityY": -0.05453430157226078, + "timestamp": 1.702261197016515 + }, + { + "x": 3.5716843453444107, + "y": 7.756469217807512, + "heading": -1.8029510454250157e-7, + "angularVelocity": 0.0000010276093345784838, + "velocityX": 3.0029510099899284, + "velocityY": -0.057750131078668464, + "timestamp": 1.7461235666397779 + }, + { + "x": 3.7107355533097754, + "y": 7.753795106421767, + "heading": -1.0517313285100412e-7, + "angularVelocity": 0.0000017126747217883014, + "velocityX": 3.1701709041186272, + "velocityY": -0.06096595803447545, + "timestamp": 1.7899859362630408 + }, + { + "x": 3.8571214046276947, + "y": 7.750979941581066, + "heading": -3.445312029122533e-12, + "angularVelocity": 0.000002397720151516781, + "velocityX": 3.337390400364549, + "velocityY": -0.06418177733854838, + "timestamp": 1.8338483058863038 + }, + { + "x": 4.008740030563312, + "y": 7.748064144589167, + "heading": -2.953693080850903e-12, + "angularVelocity": 1.1208216804044482e-11, + "velocityX": 3.456690261786607, + "velocityY": -0.06647604807818788, + "timestamp": 1.8777106755095667 + }, + { + "x": 4.160358656499413, + "y": 7.745148347597258, + "heading": -2.46204265095573e-12, + "angularVelocity": 1.1208934540541933e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9215730451328297 + }, + { + "x": 4.311977282435513, + "y": 7.742232550605349, + "heading": -1.970393895641841e-12, + "angularVelocity": 1.1208896362456744e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 1.9654354147560926 + }, + { + "x": 4.463595908371613, + "y": 7.739316753613441, + "heading": -1.478772239262654e-12, + "angularVelocity": 1.1208278545067146e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839953, + "timestamp": 2.0092977843793554 + }, + { + "x": 4.615214534307714, + "y": 7.736400956621532, + "heading": -9.871132742331443e-13, + "angularVelocity": 1.1209129129534961e-11, + "velocityX": 3.4566902617976116, + "velocityY": -0.06647604807839952, + "timestamp": 2.0531601540026183 + }, + { + "x": 4.766833160243814, + "y": 7.733485159629623, + "heading": -4.955367585470695e-13, + "angularVelocity": 1.120724940109933e-11, + "velocityX": 3.456690261797612, + "velocityY": -0.06647604807839952, + "timestamp": 2.0970225236258813 }, { "x": 4.91845178604126, "y": 7.730569362640381, - "heading": 5.742950127566998e-24, - "angularVelocity": 1.7986022474514431e-12, - "velocityX": 3.4566907387532364, - "velocityY": -0.06647605725079353, - "timestamp": 2.1408847125154065 - }, - { - "x": 5.071687527083371, - "y": 7.720097857990775, - "heading": 3.552307758225259e-17, - "angularVelocity": 7.99612526154235e-16, - "velocityX": 3.449285538872868, - "velocityY": -0.2357100850786492, - "timestamp": 2.185310069394438 - }, - { - "x": 5.224226446138744, - "y": 7.702133366681443, - "heading": 1.1687426346130352e-17, - "angularVelocity": -5.365325775763386e-16, - "velocityX": 3.433600307831658, - "velocityY": -0.4043747213612299, - "timestamp": 2.2297354262734697 - }, - { - "x": 5.375702981258678, - "y": 7.676722658421986, - "heading": 1.8432338772239766e-17, - "angularVelocity": 1.5182573422018895e-16, - "velocityX": 3.409686398972496, - "velocityY": -0.5719865870441906, - "timestamp": 2.2741607831525013 - }, - { - "x": 5.5270900407895756, - "y": 7.6507842121855125, - "heading": 3.519048582614132e-18, - "angularVelocity": -3.3569319949738625e-16, - "velocityX": 3.407672333237922, - "velocityY": -0.5838657932923826, - "timestamp": 2.318586140031533 - }, - { - "x": 5.678477093548375, - "y": 7.624845726424425, - "heading": 1.979250750682756e-17, - "angularVelocity": 3.6631014509556794e-16, - "velocityX": 3.407672180800267, - "velocityY": -0.5838666829782966, - "timestamp": 2.3630114969105644 - }, - { - "x": 5.829864146306661, - "y": 7.598907240660332, - "heading": 2.235165581095298e-17, - "angularVelocity": 5.760557672346472e-17, - "velocityX": 3.4076721807886727, - "velocityY": -0.5838666830459646, - "timestamp": 2.407436853789596 - }, - { - "x": 5.981251199064948, - "y": 7.5729687548962525, - "heading": 3.836313874494924e-18, - "angularVelocity": -4.167741856705319e-16, - "velocityX": 3.407672180788725, - "velocityY": -0.5838666830456585, - "timestamp": 2.4518622106686276 - }, - { - "x": 6.132638251823235, - "y": 7.547030269132175, - "heading": 3.1462079050077135e-17, - "angularVelocity": 6.218467811271862e-16, - "velocityX": 3.4076721807887362, - "velocityY": -0.5838666830455942, - "timestamp": 2.4962875675476592 - }, - { - "x": 6.284025304586505, - "y": 7.521091783397172, - "heading": 3.2166739769244493e-17, - "angularVelocity": 1.586167830118919e-17, - "velocityX": 3.407672180900869, - "velocityY": -0.5838666823911463, - "timestamp": 2.540712924426691 - }, - { - "x": 6.435412424183849, - "y": 7.495153687734749, - "heading": 4.825864229864178e-17, - "angularVelocity": 3.6222337106316937e-16, - "velocityX": 3.407673685313662, - "velocityY": -0.5838579019871705, - "timestamp": 2.5851382813057224 - }, - { - "x": 6.587407958314221, - "y": 7.473058385360328, - "heading": 2.4338261444680897e-17, - "angularVelocity": -5.384398130784151e-16, - "velocityX": 3.4213688939910836, - "velocityY": -0.4973579038337588, - "timestamp": 2.629563638184754 - }, - { - "x": 6.740303266652504, - "y": 7.458434117170091, - "heading": 6.5930603358426486e-18, - "angularVelocity": -3.9943857191878257e-16, - "velocityX": 3.4416225119949053, - "velocityY": -0.32918741047050454, - "timestamp": 2.6739889950637856 - }, - { - "x": 6.890285169623974, - "y": 7.45074846175788, - "heading": 2.2969898357742947e-18, - "angularVelocity": -9.670311735916258e-17, - "velocityX": 3.3760427266766593, - "velocityY": -0.1730015457870095, - "timestamp": 2.718414351942817 - }, - { - "x": 7.0329931824089815, - "y": 7.444992685922663, - "heading": 4.687721405017099e-19, - "angularVelocity": -4.115257194619888e-17, - "velocityX": 3.212309879098902, - "velocityY": -0.1295605987114418, - "timestamp": 2.762839708821849 - }, - { - "x": 7.168350397458885, - "y": 7.44084929349212, - "heading": 2.6761389089681093e-19, - "angularVelocity": -4.528005257897493e-18, - "velocityX": 3.046845868193575, - "velocityY": -0.09326638482216276, - "timestamp": 2.8072650657008804 + "heading": 5.035858981265476e-24, + "angularVelocity": 1.1297537338117902e-11, + "velocityX": 3.4566902586364923, + "velocityY": -0.06647604801760763, + "timestamp": 2.140884893249144 + }, + { + "x": 5.07168754119456, + "y": 7.72009798657163, + "heading": -1.2237883220746723e-17, + "angularVelocity": -2.754707452373014e-16, + "velocityX": 3.4492852675356476, + "velocityY": -0.23570715051872318, + "timestamp": 2.1853102577139336 + }, + { + "x": 5.224226523742201, + "y": 7.702133987621307, + "heading": -3.220999671007562e-17, + "angularVelocity": -4.4956555179430785e-16, + "velocityX": 3.433601150724158, + "velocityY": -0.4043635694775183, + "timestamp": 2.229735622178723 + }, + { + "x": 5.375704105653677, + "y": 7.6767294867936675, + "heading": -8.086584933587513e-18, + "angularVelocity": 5.430098788639561e-16, + "velocityX": 3.4097093796840374, + "velocityY": -0.5718467621751168, + "timestamp": 2.2741609866435124 + }, + { + "x": 5.527091031475673, + "y": 7.65079022745198, + "heading": 1.237593714278334e-17, + "angularVelocity": 4.606044840123949e-16, + "velocityX": 3.4076687416257836, + "velocityY": -0.5838839963203132, + "timestamp": 2.318586351108302 + }, + { + "x": 5.678477940102667, + "y": 7.624850867756873, + "heading": -5.299489627912929e-18, + "angularVelocity": -3.9786790685233107e-16, + "velocityX": 3.4076683545720687, + "velocityY": -0.5838862552420002, + "timestamp": 2.363011715573091 + }, + { + "x": 5.82986484872645, + "y": 7.598911508043026, + "heading": -6.861733443062272e-18, + "angularVelocity": -3.51655824113109e-17, + "velocityX": 3.4076683544997888, + "velocityY": -0.5838862556638376, + "timestamp": 2.4074370800378806 + }, + { + "x": 5.981251757350232, + "y": 7.572972148329175, + "heading": 1.300275398298883e-18, + "angularVelocity": 1.8372407158846258e-16, + "velocityX": 3.4076683544997755, + "velocityY": -0.5838862556639163, + "timestamp": 2.45186244450267 + }, + { + "x": 6.13263866597402, + "y": 7.547032788615358, + "heading": 2.03304825021732e-17, + "angularVelocity": 4.2836355611375324e-16, + "velocityX": 3.407668354499907, + "velocityY": -0.5838862556631488, + "timestamp": 2.4962878089674594 + }, + { + "x": 6.284025574629089, + "y": 7.521093429084101, + "heading": 9.540525391081043e-18, + "angularVelocity": -2.428783025456181e-16, + "velocityX": 3.407668355204027, + "velocityY": -0.5838862515537734, + "timestamp": 2.540713173432249 + }, + { + "x": 6.435412650788291, + "y": 7.495155047156986, + "heading": 3.1121659748942844e-18, + "angularVelocity": -1.4470020659857382e-16, + "velocityX": 3.407672125665691, + "velocityY": -0.5838642460136346, + "timestamp": 2.585138537897038 + }, + { + "x": 6.587408261478287, + "y": 7.473060233149462, + "heading": 4.012412418719246e-18, + "angularVelocity": 2.0264244415020296e-17, + "velocityX": 3.4213700331139205, + "velocityY": -0.49734682593400187, + "timestamp": 2.6295639023618276 + }, + { + "x": 6.740303543651052, + "y": 7.458435646449454, + "heading": -2.1084051336842118e-18, + "angularVelocity": -1.377775427669848e-16, + "velocityX": 3.4416213353510248, + "velocityY": -0.3291945238085493, + "timestamp": 2.673989266826617 + }, + { + "x": 6.890285316295548, + "y": 7.450749433084636, + "heading": -1.4822341121773416e-18, + "angularVelocity": 1.40948989157144e-17, + "velocityX": 3.3760392165914315, + "velocityY": -0.17301407557185516, + "timestamp": 2.7184146312914064 + }, + { + "x": 7.032993253879116, + "y": 7.444993241304835, + "heading": -9.121457386741735e-19, + "angularVelocity": 1.2832497387232803e-17, + "velocityX": 3.212307637828718, + "velocityY": -0.1295699393611814, + "timestamp": 2.7628399957561958 + }, + { + "x": 7.168350422821424, + "y": 7.440849530732545, + "heading": -4.3340581409719474e-19, + "angularVelocity": 1.0776274550871163e-17, + "velocityX": 3.046844310069511, + "velocityY": -0.09327353016031785, + "timestamp": 2.807265360220985 }, { "x": 7.296333312988281, "y": 7.438207149505615, - "heading": 7.559167432305897e-29, - "angularVelocity": -6.0238996273513066e-18, - "velocityX": 2.8808528399195232, - "velocityY": -0.05947378191468168, - "timestamp": 2.851690422579912 - }, - { - "x": 7.47698763720858, - "y": 7.437583087682088, - "heading": -1.531352149638582e-19, - "angularVelocity": -2.223548537046582e-18, - "velocityX": 2.6231305334964707, - "velocityY": -0.009061480433138841, - "timestamp": 2.9205601650168234 - }, - { - "x": 7.639661701569886, - "y": 7.4389085950358504, - "heading": -4.350947127069071e-19, - "angularVelocity": -4.094098333593456e-18, - "velocityX": 2.3620541997862787, - "velocityY": 0.019246585029358436, - "timestamp": 2.9894299074537347 - }, - { - "x": 7.784283052035784, - "y": 7.4413250266907465, - "heading": -6.244717594872043e-19, - "angularVelocity": -2.7497859013586165e-18, - "velocityX": 2.099925821537363, - "velocityY": 0.03508698550905259, - "timestamp": 3.058299649890646 - }, - { - "x": 7.910826913450658, - "y": 7.444284600874366, - "heading": -6.382122914459642e-19, - "angularVelocity": -1.9951478654456663e-19, - "velocityX": 1.8374377039495369, - "velocityY": 0.0429735044577886, - "timestamp": 3.1271693923275574 - }, - { - "x": 8.019285873686528, - "y": 7.44740842176458, - "heading": -6.221500958287316e-19, - "angularVelocity": 2.3322572505666016e-19, - "velocityX": 1.5748419610429636, - "velocityY": 0.04535839368175477, - "timestamp": 3.1960391347644688 - }, - { - "x": 8.109659540281728, - "y": 7.450419143488216, - "heading": -5.560566789743302e-19, - "angularVelocity": 9.596872953609165e-19, - "velocityX": 1.3122405195284144, - "velocityY": 0.0437161751605761, - "timestamp": 3.26490887720138 - }, - { - "x": 8.181950475423811, - "y": 7.453105106505567, - "heading": -4.47336306829622e-19, - "angularVelocity": 1.578637704959947e-18, - "velocityX": 1.0496762813989922, - "velocityY": 0.03900062527185011, - "timestamp": 3.3337786196382915 - }, - { - "x": 8.236162443619715, - "y": 7.455299536082291, - "heading": -3.01857697105088e-19, - "angularVelocity": 2.112373367083251e-18, - "velocityX": 0.787166704530166, - "velocityY": 0.03186347878002744, - "timestamp": 3.402648362075203 - }, - { - "x": 8.272299611573594, - "y": 7.456867665427121, - "heading": -9.747000653236463e-20, - "angularVelocity": 2.9677429207323664e-18, - "velocityX": 0.5247176288917162, - "velocityY": 0.022769496288837482, - "timestamp": 3.471518104512114 + "heading": -1.2424191874750213e-28, + "angularVelocity": 9.755818981171634e-18, + "velocityX": 2.880851777103443, + "velocityY": -0.05947911196145459, + "timestamp": 2.8516907246857746 + }, + { + "x": 7.476987619873736, + "y": 7.437582893575528, + "heading": 6.306246828045357e-19, + "angularVelocity": 9.156773444569897e-18, + "velocityX": 2.623130055966497, + "velocityY": -0.009064298112001053, + "timestamp": 2.9205604730516797 + }, + { + "x": 7.639661681076791, + "y": 7.438908313736393, + "heading": 7.717197233455447e-19, + "angularVelocity": 2.04872304504038e-18, + "velocityX": 2.362053950578807, + "velocityY": 0.019245317317299903, + "timestamp": 2.9894302214175847 + }, + { + "x": 7.78428303377631, + "y": 7.4413247257119215, + "heading": 8.357244621441239e-19, + "angularVelocity": 9.29359266725832e-19, + "velocityX": 2.0999256731873923, + "velocityY": 0.0350866967407844, + "timestamp": 3.05829996978349 + }, + { + "x": 7.91082689918953, + "y": 7.4442843222063875, + "heading": 7.220816869988264e-19, + "angularVelocity": -1.6501116644010886e-18, + "velocityX": 1.8374376038212434, + "velocityY": 0.042973824715339615, + "timestamp": 3.127169718149395 + }, + { + "x": 8.019285863587411, + "y": 7.447408189663725, + "heading": 5.712912024628398e-19, + "angularVelocity": -2.1895024749108468e-18, + "velocityX": 1.5748418858979918, + "velocityY": 0.04535906593908385, + "timestamp": 3.1960394665153 + }, + { + "x": 8.109659533807191, + "y": 7.450418969222921, + "heading": 4.341547519848611e-19, + "angularVelocity": -1.9912436692380873e-18, + "velocityX": 1.312240459187152, + "velocityY": 0.04371701117883307, + "timestamp": 3.264909214881205 + }, + { + "x": 8.181950471768632, + "y": 7.4531049914429115, + "heading": 2.769074151229353e-19, + "angularVelocity": -2.283257025771601e-18, + "velocityX": 1.0496762319699213, + "velocityY": 0.03900148154629361, + "timestamp": 3.33377896324711 + }, + { + "x": 8.236162441930201, + "y": 7.455299473800812, + "heading": 8.002361823653196e-20, + "angularVelocity": -2.858784902160653e-18, + "velocityX": 0.7871666653047966, + "velocityY": 0.03186424242820522, + "timestamp": 3.4026487116130153 + }, + { + "x": 8.27229961106123, + "y": 7.456867643223532, + "heading": 9.595707199020635e-21, + "angularVelocity": -1.0226247759898425e-18, + "velocityX": 0.5247176008111963, + "velocityY": 0.02277007626611394, + "timestamp": 3.4715184599789204 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1045131718008824e-26, - "angularVelocity": 1.4152803834514588e-18, - "velocityX": 0.26232944363751326, - "velocityY": 0.012061606851017839, - "timestamp": 3.5403878469490255 + "heading": -2.737879233354451e-29, + "angularVelocity": -1.3933123630808857e-19, + "velocityX": 0.26232942849316815, + "velocityY": 0.012061928212380262, + "timestamp": 3.5403882083448255 }, { "x": 8.290366172790527, "y": 7.457698345184326, - "heading": -1.1306207039452228e-26, - "angularVelocity": -3.8332378282330285e-27, - "velocityX": -4.271268903147259e-26, - "velocityY": 9.33461667545086e-25, - "timestamp": 3.609257589385937 - }, - { - "x": 8.25852915676906, - "y": 7.450262882472062, - "heading": 0.0018141392967689516, - "angularVelocity": 0.019588444800635294, - "velocityX": -0.3437650196234689, - "velocityY": -0.08028553880386623, - "timestamp": 3.701870316696995 - }, - { - "x": 8.194855122144773, - "y": 7.435392004605689, - "heading": 0.005442043995568049, - "angularVelocity": 0.03917285241599744, - "velocityX": -0.6875300671194481, - "velocityY": -0.1605705640913233, - "timestamp": 3.794483044008053 - }, - { - "x": 8.099344051833308, - "y": 7.4130857844004225, - "heading": 0.01088220163958325, - "angularVelocity": 0.05874092904902104, - "velocityX": -1.0312952990863984, - "velocityY": -0.24085480314543678, - "timestamp": 3.8870957713191108 - }, - { - "x": 7.971995914574251, - "y": 7.383344320455178, - "heading": 0.01813202895682406, - "angularVelocity": 0.0782811124100776, - "velocityX": -1.3750608685924206, - "velocityY": -0.32113797756275486, - "timestamp": 3.9797084986301687 - }, - { - "x": 7.812810665453445, - "y": 7.3461677377771615, - "heading": 0.027187966537864438, - "angularVelocity": 0.09778286250683688, - "velocityX": -1.7188269230658824, - "velocityY": -0.40141980219577883, - "timestamp": 4.072321225941227 - }, - { - "x": 7.621788246652196, - "y": 7.301556188492674, - "heading": 0.038045600726663804, - "angularVelocity": 0.11723695548163543, - "velocityX": -2.0625936018454802, - "velocityY": -0.4816999842219491, - "timestamp": 4.1649339532522855 - }, - { - "x": 7.3989285885055995, - "y": 7.24950985264102, - "heading": 0.05069981285452632, - "angularVelocity": 0.13663577885316824, - "velocityX": -2.4063610328424803, - "velocityY": -0.5619782222463336, - "timestamp": 4.257546680563344 - }, - { - "x": 7.144231611178116, - "y": 7.1900289391025325, - "heading": 0.06514495528961611, - "angularVelocity": 0.15597362106152987, - "velocityX": -2.7501293258758435, - "velocityY": -0.6422542048536093, - "timestamp": 4.350159407874402 - }, - { - "x": 6.857697229070099, - "y": 7.12311368717437, - "heading": 0.08137504890112211, - "angularVelocity": 0.17524690269614907, - "velocityX": -3.0938985431843946, - "velocityY": -0.7225276036134316, - "timestamp": 4.442772135185461 - }, - { - "x": 6.545887160996467, - "y": 7.050327089936167, - "heading": 0.08137505141561512, - "angularVelocity": 2.71506205393572e-8, - "velocityX": -3.366816604227146, - "velocityY": -0.785924347025588, - "timestamp": 4.535384862496519 - }, - { - "x": 6.234077092414379, - "y": 6.9775404948760125, - "heading": 0.08137505393005692, - "angularVelocity": 2.7150067532220807e-8, - "velocityX": -3.3668166097172856, - "velocityY": -0.7859243235077903, - "timestamp": 4.627997589807578 - }, - { - "x": 5.922267023832287, - "y": 6.9047538998158755, - "heading": 0.08137505644449868, - "angularVelocity": 2.715006702984009e-8, - "velocityX": -3.3668166097173295, - "velocityY": -0.7859243235076002, - "timestamp": 4.720610317118636 - }, - { - "x": 5.610456955250197, - "y": 6.831967304755725, - "heading": 0.08137505895894045, - "angularVelocity": 2.71500672556719e-8, - "velocityX": -3.366816609717297, - "velocityY": -0.7859243235077401, - "timestamp": 4.813223044429694 - }, - { - "x": 5.298646887042485, - "y": 6.75918070809191, - "heading": 0.08137506147343254, - "angularVelocity": 2.715061065119022e-8, - "velocityX": -3.366816605674904, - "velocityY": -0.7859243408235568, - "timestamp": 4.905835771740753 - }, - { - "x": 5.012107215632439, - "y": 6.692280233597882, - "heading": 0.09728582681634514, - "angularVelocity": 0.17179890717906565, - "velocityX": -3.0939556552270235, - "velocityY": -0.7223680420222418, - "timestamp": 4.998448499051811 - }, - { - "x": 4.757405114771201, - "y": 6.6328136487695275, - "heading": 0.11142133507965439, - "angularVelocity": 0.15263029902825728, - "velocityX": -2.7501846480103254, - "velocityY": -0.6420994884280228, - "timestamp": 5.09106122636287 - }, - { - "x": 4.53454065727504, - "y": 6.5807807676396815, - "heading": 0.12378505010124977, - "angularVelocity": 0.13349909219355338, - "velocityX": -2.406412854548884, - "velocityY": -0.5618329428425411, - "timestamp": 5.183673953673928 - }, - { - "x": 4.343513899404853, - "y": 6.5361814286666275, - "heading": 0.1343795579504313, - "angularVelocity": 0.11439580883519145, - "velocityX": -2.062640453601866, - "velocityY": -0.48156814152830624, - "timestamp": 5.276286680984986 - }, - { - "x": 4.184324884988457, - "y": 6.499015496112839, - "heading": 0.14320671190518078, - "angularVelocity": 0.09531253652753087, - "velocityX": -1.7188675794173347, - "velocityY": -0.4013048058606475, - "timestamp": 5.368899408296045 - }, - { - "x": 4.056973646858879, - "y": 6.4692828606598525, - "heading": 0.150267758880007, - "angularVelocity": 0.07624272796880596, - "velocityX": -1.3750943507132014, - "velocityY": -0.32104265057569514, - "timestamp": 5.461512135607103 - }, - { - "x": 3.9614602077127334, - "y": 6.4469834398128185, - "heading": 0.15556344152537638, - "angularVelocity": 0.057180938291372996, - "velocityX": -1.0313208769389124, - "velocityY": -0.240781386041431, - "timestamp": 5.554124862918162 - }, - { - "x": 3.897784580685345, - "y": 6.432117178185927, - "heading": 0.15909407498952677, - "angularVelocity": 0.03812255147493982, - "velocityX": -0.6875472613339806, - "velocityY": -0.16052071954387456, - "timestamp": 5.64673759022922 + "heading": -7.734690041039287e-29, + "angularVelocity": -1.1060203570884526e-28, + "velocityX": -8.232857746308476e-27, + "velocityY": 9.915594313558478e-27, + "timestamp": 3.6092579567107306 + }, + { + "x": 8.258529155042611, + "y": 7.450262882094732, + "heading": 0.0018141437015229199, + "angularVelocity": 0.019588491140668917, + "velocityX": -0.34376501683789845, + "velocityY": -0.0802855378738891, + "timestamp": 3.7018706897944167 + }, + { + "x": 8.19485511722891, + "y": 7.435392003543495, + "heading": 0.005442056461770318, + "angularVelocity": 0.03917293701902922, + "velocityX": -0.6875300587033178, + "velocityY": -0.16057056147775478, + "timestamp": 3.794483422878103 + }, + { + "x": 8.099344042603773, + "y": 7.413085782435483, + "heading": 0.010882224859340402, + "angularVelocity": 0.05874104150078671, + "velocityX": -1.0312952813824383, + "velocityY": -0.24085479788027828, + "timestamp": 3.887096155961789 + }, + { + "x": 7.9719959003584435, + "y": 7.383344317488874, + "heading": 0.018132064338159094, + "angularVelocity": 0.07828123884722897, + "velocityX": -1.3750608367237869, + "velocityY": -0.3211379683583422, + "timestamp": 3.979708889045475 + }, + { + "x": 7.8128106462112585, + "y": 7.346167733877292, + "heading": 0.027188013699287764, + "angularVelocity": 0.09778298360923647, + "velocityX": -1.7188268702030736, + "velocityY": -0.4014197872552755, + "timestamp": 4.072321622129161 + }, + { + "x": 7.621788223292644, + "y": 7.301556183975714, + "heading": 0.038045656619278445, + "angularVelocity": 0.11723704245051889, + "velocityX": -2.0625935177402037, + "velocityY": -0.481699960860308, + "timestamp": 4.164934355212847 + }, + { + "x": 7.3989285635202835, + "y": 7.24950984823631, + "heading": 0.050699870016136385, + "angularVelocity": 0.1366357840387178, + "velocityX": -2.406360900406452, + "velocityY": -0.5619781860057411, + "timestamp": 4.257547088296533 + }, + { + "x": 7.144231590225439, + "y": 7.190028936362276, + "heading": 0.06514499751032955, + "angularVelocity": 0.15597345001297352, + "velocityX": -2.750129110914985, + "velocityY": -0.6422541468491951, + "timestamp": 4.3501598213802195 + }, + { + "x": 6.857697227315765, + "y": 7.123113690113179, + "heading": 0.08137503414778206, + "angularVelocity": 0.17524627658690128, + "velocityX": -3.093898143042135, + "velocityY": -0.7225274972571053, + "timestamp": 4.442772554463906 + }, + { + "x": 6.545887160381392, + "y": 7.050327089705259, + "heading": 0.08137504044908753, + "angularVelocity": 6.803929929105723e-8, + "velocityX": -3.366816382069384, + "velocityY": -0.7859243322637903, + "timestamp": 4.535385287547592 + }, + { + "x": 6.234077092172867, + "y": 6.977540494754869, + "heading": 0.0813750467500712, + "angularVelocity": 6.80358247192299e-8, + "velocityX": -3.3668163958272355, + "velocityY": -0.7859242733352659, + "timestamp": 4.627998020631278 + }, + { + "x": 5.922267023964316, + "y": 6.904753899804592, + "heading": 0.08137505305105486, + "angularVelocity": 6.803582445105601e-8, + "velocityX": -3.3668163958275135, + "velocityY": -0.7859242733340743, + "timestamp": 4.720610753714964 + }, + { + "x": 5.610456955755783, + "y": 6.831967304854232, + "heading": 0.08137505935203854, + "angularVelocity": 6.803582480789322e-8, + "velocityX": -3.366816395827309, + "velocityY": -0.7859242733349515, + "timestamp": 4.81322348679865 + }, + { + "x": 5.298646888485436, + "y": 6.759180705885576, + "heading": 0.08137506565333762, + "angularVelocity": 6.803923039402274e-8, + "velocityX": -3.366816385697099, + "velocityY": -0.7859243167231056, + "timestamp": 4.905836219882336 + }, + { + "x": 5.012107236392116, + "y": 6.692280236782266, + "heading": 0.09728577795318676, + "angularVelocity": 0.17179832373019394, + "velocityX": -3.0939552538029402, + "velocityY": -0.7223679387893466, + "timestamp": 4.998448952966022 + }, + { + "x": 4.757405139637452, + "y": 6.632813653440834, + "heading": 0.1114212737800766, + "angularVelocity": 0.15263015523056464, + "velocityX": -2.75018443224769, + "velocityY": -0.642099432350162, + "timestamp": 5.091061686049708 + }, + { + "x": 4.534540680564304, + "y": 6.580780772308004, + "heading": 0.12378499174610678, + "angularVelocity": 0.1334991156654254, + "velocityX": -2.4064127215829467, + "velocityY": -0.561832907855257, + "timestamp": 5.1836744191333946 + }, + { + "x": 4.343513918608397, + "y": 6.536181432644826, + "heading": 0.13437950942576468, + "angularVelocity": 0.11439590785086255, + "velocityX": -2.0626403691519735, + "velocityY": -0.4815681189634867, + "timestamp": 5.276287152217081 + }, + { + "x": 4.184324899185163, + "y": 6.499015499114029, + "heading": 0.14320667584584268, + "angularVelocity": 0.0953126651828929, + "velocityX": -1.7188675263409952, + "velocityY": -0.4013047913963752, + "timestamp": 5.368899885300767 + }, + { + "x": 4.056973656080411, + "y": 6.469282862636605, + "heading": 0.15026773537457858, + "angularVelocity": 0.07624285876927316, + "velocityX": -1.3750943187226343, + "velocityY": -0.32104264162636753, + "timestamp": 5.461512618384453 + }, + { + "x": 3.9614602126260823, + "y": 6.446983440876931, + "heading": 0.1555634289688374, + "angularVelocity": 0.05718105294952869, + "velocityX": -1.0313208591740977, + "velocityY": -0.24078138088770026, + "timestamp": 5.554125351468139 + }, + { + "x": 3.8977845824113757, + "y": 6.432117178562742, + "heading": 0.15909407056957425, + "angularVelocity": 0.03812263695475346, + "velocityX": -0.6875472528941416, + "velocityY": -0.1605207169596795, + "timestamp": 5.646738084551825 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.0190635029136793, - "velocityX": -0.3437736032117534, - "velocityY": -0.08026035624657629, - "timestamp": 5.7393503175402785 + "angularVelocity": 0.019063549450541617, + "velocityX": -0.3437736004211391, + "velocityY": -0.08026035531260044, + "timestamp": 5.739350817635511 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.4674835450480263e-24, - "velocityX": -3.539044961968101e-24, - "velocityY": -4.5145885950878316e-23, - "timestamp": 5.831963044851337 - }, - { - "x": 3.8806166186713504, - "y": 6.424668213553014, - "heading": 0.1586413129313925, - "angularVelocity": -0.03571634624153653, - "velocityX": 0.2361975091798944, - "velocityY": -0.0002549437180240986, - "timestamp": 5.894071443064048 - }, - { - "x": 3.9099562715140928, - "y": 6.424636752755811, - "heading": 0.15420447411308597, - "angularVelocity": -0.07143701892151703, - "velocityX": 0.47239429267292826, - "velocityY": -0.0005065465880378765, - "timestamp": 5.956179841276759 - }, - { - "x": 3.953965706205972, - "y": 6.4245899872222205, - "heading": 0.14754993112617998, - "angularVelocity": -0.10714401237841124, - "velocityX": 0.7085907213571107, - "velocityY": -0.0007529663449016913, - "timestamp": 6.01828823948947 - }, - { - "x": 4.012644921986535, - "y": 6.424528354667972, - "heading": 0.13867953686775064, - "angularVelocity": -0.14282117255785207, - "velocityX": 0.9447871377973178, - "velocityY": -0.0009923384924064732, - "timestamp": 6.080396637702181 - }, - { - "x": 4.085993936769769, - "y": 6.424452410018094, - "heading": 0.1275959867324694, - "angularVelocity": -0.17845493450534605, - "velocityX": 1.1809838426685173, - "velocityY": -0.0012227758574291183, - "timestamp": 6.142505035914892 - }, - { - "x": 4.174012783702118, - "y": 6.424362826752711, - "heading": 0.11430261193472518, - "angularVelocity": -0.21403506096255565, - "velocityX": 1.41718108122671, - "velocityY": -0.0014423695983334034, - "timestamp": 6.204613434127603 - }, - { - "x": 4.276701506889125, - "y": 6.424260398085293, - "heading": 0.09880312708922008, - "angularVelocity": -0.24955537884622275, - "velocityX": 1.6533790299230773, - "velocityY": -0.0016491919026409437, - "timestamp": 6.266721832340314 - }, - { - "x": 4.394060156308242, - "y": 6.424146037859453, - "heading": 0.0811013325151301, - "angularVelocity": -0.285014508238714, - "velocityX": 1.8895777833004581, - "velocityY": -0.00184130051861914, - "timestamp": 6.3288302305530255 - }, - { - "x": 4.5260887819403175, - "y": 6.424020781052808, - "heading": 0.06120077232953886, - "angularVelocity": -0.32041657421972447, - "velocityX": 2.1257773414136287, - "velocityY": -0.0020167450819892417, - "timestamp": 6.390938628765737 - }, - { - "x": 4.67278742718424, - "y": 6.42388578380628, - "heading": 0.039104350634045465, - "angularVelocity": -0.35577188160314316, - "velocityX": 2.3619775982871833, - "velocityY": -0.002173574756587449, - "timestamp": 6.453047026978448 - }, - { - "x": 4.834156121702719, - "y": 6.423742323007339, - "heading": 0.01481391117601343, - "angularVelocity": -0.3910975030275518, - "velocityX": 2.598178332756533, - "velocityY": -0.002309845416548714, - "timestamp": 6.515155425191159 - }, - { - "x": 5.01019487412182, - "y": 6.423591795858401, - "heading": -0.011670204418812183, - "angularVelocity": -0.42641762397610067, - "velocityX": 2.834379206113114, - "velocityY": -0.00242361988508825, - "timestamp": 6.57726382340387 - }, - { - "x": 5.200903666238017, - "y": 6.4234357217300895, - "heading": -0.04034956205797238, - "angularVelocity": -0.46176295741742135, - "velocityX": 3.070579786376913, - "velocityY": -0.002512931146224344, - "timestamp": 6.639372221616581 - }, - { - "x": 5.406282460203223, - "y": 6.423275763679671, - "heading": -0.07122760819917923, - "angularVelocity": -0.4971637818681904, - "velocityX": 3.3067797572530786, - "velocityY": -0.002575465718348354, - "timestamp": 6.701480619829292 - }, - { - "x": 5.621011656414587, - "y": 6.423161504545189, - "heading": -0.07122761549725261, - "angularVelocity": -1.1750541962036517e-7, - "velocityX": 3.457329481851291, - "velocityY": -0.0018396728585792982, - "timestamp": 6.763589018042003 - }, - { - "x": 5.835740853133477, - "y": 6.42304819932464, - "heading": -0.07122762278700305, - "angularVelocity": -1.1737141255802722e-7, - "velocityX": 3.4573294900228966, - "velocityY": -0.0018243140027767927, - "timestamp": 6.825697416254714 - }, - { - "x": 6.050170082146955, - "y": 6.411701548446128, - "heading": -0.07122763011063167, - "angularVelocity": -1.1791688138484013e-7, - "velocityX": 3.452499745349952, - "velocityY": -0.18269108856505184, - "timestamp": 6.887805814467425 + "angularVelocity": -9.999505736171943e-25, + "velocityX": -5.156111906167998e-25, + "velocityY": -7.69774068808886e-24, + "timestamp": 5.831963550719197 + }, + { + "x": 3.8805908200661583, + "y": 6.424671235221358, + "heading": 0.15744018373663873, + "angularVelocity": -0.0550052976874839, + "velocityX": 0.23556676380826952, + "velocityY": -0.00020610376336075096, + "timestamp": 5.894128731048805 + }, + { + "x": 3.9098813602559557, + "y": 6.424646814464556, + "heading": 0.1506499345999589, + "angularVelocity": -0.10922913921711586, + "velocityX": 0.47117276961950644, + "velocityY": -0.0003928365794473002, + "timestamp": 5.956293911378412 + }, + { + "x": 3.9538212666067056, + "y": 6.424612381558881, + "heading": 0.14054735001329138, + "angularVelocity": -0.1625119485393969, + "velocityX": 0.7068250444666143, + "velocityY": -0.0005538937632522526, + "timestamp": 6.01845909170802 + }, + { + "x": 4.012413923406757, + "y": 6.424569899192806, + "heading": 0.1272024405085879, + "angularVelocity": -0.21466855615872318, + "velocityX": 0.9425317595699895, + "velocityY": -0.0006833787957962723, + "timestamp": 6.080624272037627 + }, + { + "x": 4.085663316044443, + "y": 6.4245216623134365, + "heading": 0.11069894640828985, + "angularVelocity": -0.2654781022558683, + "velocityX": 1.1783025843295045, + "velocityY": -0.0007759469065193845, + "timestamp": 6.142789452367235 + }, + { + "x": 4.173574156900502, + "y": 6.4244702509624405, + "heading": 0.09113759111571623, + "angularVelocity": -0.3146673940115171, + "velocityX": 1.414149213272517, + "velocityY": -0.0008270120141812696, + "timestamp": 6.204954632696842 + }, + { + "x": 4.276152059818016, + "y": 6.424418464281491, + "heading": 0.0686410579111913, + "angularVelocity": -0.36188318099047606, + "velocityX": 1.650086147480532, + "velocityY": -0.0008330496376791236, + "timestamp": 6.26711981302645 + }, + { + "x": 4.39340378630487, + "y": 6.424369226491044, + "heading": 0.04336192483995491, + "angularVelocity": -0.40664457075815247, + "velocityX": 1.886131848490915, + "velocityY": -0.0007920477377600693, + "timestamp": 6.329284993356057 + }, + { + "x": 4.525337595489836, + "y": 6.424325450771935, + "heading": 0.015495928724554285, + "angularVelocity": -0.4482573036489503, + "velocityX": 2.122310407296116, + "velocityY": -0.000704183899678652, + "timestamp": 6.391450173685665 + }, + { + "x": 4.671963731284715, + "y": 6.424289841531667, + "heading": -0.014694474575960468, + "angularVelocity": -0.4856481255333208, + "velocityX": 2.3586537514642383, + "velocityY": -0.0005728164879388929, + "timestamp": 6.453615354015272 + }, + { + "x": 4.833295019214238, + "y": 6.424264622086766, + "heading": -0.04683458533303072, + "angularVelocity": -0.5170114618289433, + "velocityX": 2.595203409273861, + "velocityY": -0.00040568441636908034, + "timestamp": 6.51578053434488 + }, + { + "x": 5.009347081398109, + "y": 6.424251287994793, + "heading": -0.08033775965322806, + "angularVelocity": -0.5389379415061509, + "velocityX": 2.832004367242584, + "velocityY": -0.00021449454344913397, + "timestamp": 6.577945714674487 + }, + { + "x": 5.200134146051008, + "y": 6.424251504702917, + "heading": -0.1141370339338056, + "angularVelocity": -0.5437010574306965, + "velocityX": 3.069034202769489, + "velocityY": 0.0000034860049153566075, + "timestamp": 6.640110895004095 + }, + { + "x": 5.405613054428805, + "y": 6.424281444650923, + "heading": -0.1455833954142087, + "angularVelocity": -0.5058516892200839, + "velocityX": 3.3053697791645313, + "velocityY": 0.0004816192577199728, + "timestamp": 6.702276075333702 + }, + { + "x": 5.620478420069855, + "y": 6.42365674720977, + "heading": -0.14578823417625966, + "angularVelocity": -0.003295072273013325, + "velocityX": 3.456361977907994, + "velocityY": -0.0100489926650518, + "timestamp": 6.76444125566331 + }, + { + "x": 5.8354039344878705, + "y": 6.423689815718493, + "heading": -0.1457882693852108, + "angularVelocity": -5.663773666898463e-7, + "velocityX": 3.4573295416896364, + "velocityY": 0.0005319458344337396, + "timestamp": 6.826606435992917 + }, + { + "x": 6.050013195110809, + "y": 6.4120346435837465, + "heading": -0.14578830470722368, + "angularVelocity": -5.68196097923049e-7, + "velocityX": 3.4522422276434255, + "velocityY": -0.1874871442976483, + "timestamp": 6.888771616322525 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.07122763763060004, - "angularVelocity": -1.2107812437469553e-7, - "velocityX": 3.431893533353283, - "velocityY": -0.41861352112758443, - "timestamp": 6.949914212680136 - }, - { - "x": 6.495461876785666, - "y": 6.33939114897125, - "heading": -0.07122764440367134, - "angularVelocity": -9.892307155851706e-8, - "velocityX": 3.390520591116758, - "velocityY": -0.6763880965782562, - "timestamp": 7.018382277747724 - }, - { - "x": 6.723447879429968, - "y": 6.275695179020453, - "heading": -0.07122765108654068, - "angularVelocity": -9.760564039519094e-8, - "velocityX": 3.3298151834617853, - "velocityY": -0.9303018843590676, - "timestamp": 7.086850342815312 - }, - { - "x": 6.944519208686096, - "y": 6.205139076086503, - "heading": -0.08666821845477282, - "angularVelocity": -0.2255148784033862, - "velocityX": 3.228823963958949, - "velocityY": -1.0304965222005587, - "timestamp": 7.1553184078829 - }, - { - "x": 7.1486388975511135, - "y": 6.139973659962488, - "heading": -0.10579300445072114, - "angularVelocity": -0.2793241780247401, - "velocityX": 2.981239336375635, - "velocityY": -0.9517636588632731, - "timestamp": 7.223786472950488 - }, - { - "x": 7.335725393832166, - "y": 6.080229656966579, - "heading": -0.12505884329720646, - "angularVelocity": -0.281384304163806, - "velocityX": 2.732463610536854, - "velocityY": -0.8725820269191563, - "timestamp": 7.292254538018076 - }, - { - "x": 7.5057852138832075, - "y": 6.025913583564621, - "heading": -0.14350814844977783, - "angularVelocity": -0.26945854442299977, - "velocityX": 2.483783058323149, - "velocityY": -0.7933052197158056, - "timestamp": 7.360722603085664 - }, - { - "x": 7.6588255623664905, - "y": 5.9770279139396525, - "heading": -0.16069404228282516, - "angularVelocity": -0.2510059809063169, - "velocityX": 2.2352077327175954, - "velocityY": -0.7139922762051272, - "timestamp": 7.429190668153252 - }, - { - "x": 7.794851760455932, - "y": 5.9335736928791425, - "heading": -0.17635851781824094, - "angularVelocity": -0.22878513537592668, - "velocityX": 1.986710124715299, - "velocityY": -0.6346640732086548, - "timestamp": 7.49765873322084 - }, - { - "x": 7.913867698117727, - "y": 5.89555133346312, - "heading": -0.19033378635994255, - "angularVelocity": -0.20411367734587052, - "velocityX": 1.7382693310276776, - "velocityY": -0.5553298370340779, - "timestamp": 7.566126798288428 - }, - { - "x": 8.01587629682425, - "y": 5.862960943042519, - "heading": -0.20250190574704874, - "angularVelocity": -0.1777196328696382, - "velocityX": 1.489871206464301, - "velocityY": -0.47599403296165327, - "timestamp": 7.634594863356016 - }, - { - "x": 8.100879820230139, - "y": 5.835802482072584, - "heading": -0.21277523505977824, - "angularVelocity": -0.15004556215497408, - "velocityX": 1.2415061433673837, - "velocityY": -0.39665880645416857, - "timestamp": 7.703062928423604 - }, - { - "x": 8.168880075700757, - "y": 5.814075851441944, - "heading": -0.22108585453563723, - "angularVelocity": -0.12137949959087135, - "velocityX": 0.9931674774727836, - "velocityY": -0.3173250275028427, - "timestamp": 7.771530993491192 - }, - { - "x": 8.219878547444269, - "y": 5.7977809449089115, - "heading": -0.22737935642919127, - "angularVelocity": -0.09191879290500574, - "velocityX": 0.7448504889567138, - "velocityY": -0.23799280024852099, - "timestamp": 7.83999905855878 - }, - { - "x": 8.25387648706495, - "y": 5.786917682739713, - "heading": -0.23161096372628168, - "angularVelocity": -0.061804102290801306, - "velocityX": 0.49655178055813515, - "velocityY": -0.15866173753377388, - "timestamp": 7.908467123626368 + "heading": -0.14578834092456064, + "angularVelocity": -5.825984377491133e-7, + "velocityX": 3.4312825298390877, + "velocityY": -0.42358938340430125, + "timestamp": 6.950936796652132 + }, + { + "x": 6.49569885410855, + "y": 6.338969209681391, + "heading": -0.14578837085914265, + "angularVelocity": -4.366235413031805e-7, + "velocityX": 3.389467737301255, + "velocityY": -0.6816428759355991, + "timestamp": 7.019496045412968 + }, + { + "x": 6.723883016534425, + "y": 6.274812198093867, + "heading": -0.14578840022622835, + "angularVelocity": -4.28346084046259e-7, + "velocityX": 3.328276878031172, + "velocityY": -0.9357893026414394, + "timestamp": 7.088055294173803 + }, + { + "x": 6.944379070760873, + "y": 6.204658250666653, + "heading": -0.16522808025100505, + "angularVelocity": -0.28354569771601223, + "velocityX": 3.2161387152247607, + "velocityY": -1.023260153738583, + "timestamp": 7.156614542934639 + }, + { + "x": 7.148638930902927, + "y": 6.139545447418234, + "heading": -0.19715028206546042, + "angularVelocity": -0.465614813339248, + "velocityX": 2.979318820347672, + "velocityY": -0.949730407279711, + "timestamp": 7.225173791695474 + }, + { + "x": 7.3358170328874195, + "y": 6.0798421831912135, + "heading": -0.22994658912328278, + "angularVelocity": -0.4783644460899831, + "velocityX": 2.7301655920625914, + "velocityY": -0.870827281601222, + "timestamp": 7.29373304045631 + }, + { + "x": 7.5059237430887356, + "y": 6.025569482278596, + "heading": -0.26160545834967963, + "angularVelocity": -0.4617738641920779, + "velocityX": 2.481163566927677, + "velocityY": -0.7916174971803536, + "timestamp": 7.362292289217145 + }, + { + "x": 7.658979831941821, + "y": 5.976731413281962, + "heading": -0.291240609478123, + "angularVelocity": -0.43225606557947815, + "velocityX": 2.232464497780769, + "velocityY": -0.7123483684455512, + "timestamp": 7.430851537977981 + }, + { + "x": 7.795001086268662, + "y": 5.933327606851567, + "heading": -0.3183467386103757, + "angularVelocity": -0.39536794265075353, + "velocityX": 1.9839956940214167, + "velocityY": -0.633084627018105, + "timestamp": 7.4994107867388164 + }, + { + "x": 7.91399908186447, + "y": 5.895356201186841, + "heading": -0.34259459104051004, + "angularVelocity": -0.3536773355659347, + "velocityX": 1.7356957339326504, + "velocityY": -0.5538480416724806, + "timestamp": 7.567970035499652 + }, + { + "x": 8.015982502141213, + "y": 5.862814866579216, + "heading": -0.36375111540905714, + "angularVelocity": -0.3085874590363489, + "velocityX": 1.4875224294318823, + "velocityY": -0.4746454372792861, + "timestamp": 7.6365292842604875 + }, + { + "x": 8.100958056756967, + "y": 5.835701248475415, + "heading": -0.3816420491863885, + "angularVelocity": -0.26095580247302225, + "velocityX": 1.2394469914947026, + "velocityY": -0.39547717622147305, + "timestamp": 7.705088533021323 + }, + { + "x": 8.168931078031942, + "y": 5.814013189562108, + "heading": -0.3961322011943633, + "angularVelocity": -0.211352257643937, + "velocityX": 0.9914493303754669, + "velocityY": -0.31634038157220884, + "timestamp": 7.7736477817821585 + }, + { + "x": 8.219905912133822, + "y": 5.797748853681938, + "heading": -0.4071141507461263, + "angularVelocity": -0.16018188282769613, + "velocityX": 0.7435150621282579, + "velocityY": -0.237230368974835, + "timestamp": 7.842207030542994 + }, + { + "x": 8.253886183057102, + "y": 5.786906800693844, + "heading": -0.4145013188137657, + "angularVelocity": -0.10774867288013994, + "velocityX": 0.49563365318977964, + "velocityY": -0.1581413621656758, + "timestamp": 7.91076627930383 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": -0.03113870887356968, - "velocityX": 0.24826888316598922, - "velocityY": -0.07933112088153889, - "timestamp": 7.976935188693956 + "heading": -0.4182234468320189, + "angularVelocity": -0.05429067683103692, + "velocityX": 0.2477972609352767, + "velocityY": -0.07906688591998655, + "timestamp": 7.979325528064665 }, { "x": 8.270874977111816, "y": 5.7814860343933105, - "heading": -0.2337429708715579, - "angularVelocity": 3.36795253902191e-24, - "velocityX": 6.840104022345504e-25, - "velocityY": -2.7903197660258634e-25, - "timestamp": 8.045403253761544 - }, - { - "x": 8.25588746118901, - "y": 5.78629800647406, - "heading": -0.23128058254556338, - "angularVelocity": 0.03826965100123797, - "velocityX": -0.23293117405014754, - "velocityY": 0.07478612947192548, - "timestamp": 8.10974636276755 - }, - { - "x": 8.225910832159517, - "y": 5.795922404411104, - "heading": -0.2264010507485791, - "angularVelocity": 0.07583612095164204, - "velocityX": -0.4658871710208216, - "velocityY": 0.14957931137808628, - "timestamp": 8.174089471773557 - }, - { - "x": 8.18094329667614, - "y": 5.810359801198624, - "heading": -0.2191564862983393, - "angularVelocity": 0.11259270125668563, - "velocityX": -0.6988710396194479, - "velocityY": 0.22438139857638179, - "timestamp": 8.238432580779564 - }, - { - "x": 8.120982799778487, - "y": 5.829610864577548, - "heading": -0.20960792096845732, - "angularVelocity": 0.14840074527624142, - "velocityX": -0.9318868457546265, - "velocityY": 0.29919386359037625, - "timestamp": 8.302775689785571 - }, - { - "x": 8.046026937871678, - "y": 5.8536763244448125, - "heading": -0.19782824103540664, - "angularVelocity": 0.18307601412220878, - "velocityX": -1.1649400077918135, - "velocityY": 0.3740176724288817, - "timestamp": 8.367118798791578 - }, - { - "x": 7.956072840637482, - "y": 5.882556928320405, - "heading": -0.18390654809481916, - "angularVelocity": 0.21636649449574452, - "velocityX": -1.398037779396045, - "velocityY": 0.44885309898369946, - "timestamp": 8.431461907797585 - }, - { - "x": 7.851117008381534, - "y": 5.916253378394258, - "heading": -0.16795492330897657, - "angularVelocity": 0.24791504532914582, - "velocityX": -1.6311899421295915, - "velocityY": 0.5236994387496536, - "timestamp": 8.495805016803592 - }, - { - "x": 7.731155087211633, - "y": 5.954766238569468, - "heading": -0.1501194492315059, - "angularVelocity": 0.2771932278840516, - "velocityX": -1.8644097716617982, - "velocityY": 0.5985545425169684, - "timestamp": 8.560148125809599 - }, - { - "x": 7.59618156695547, - "y": 5.998095789487358, - "heading": -0.13059931402796102, - "angularVelocity": 0.3033756917422545, - "velocityX": -2.0977152385278854, - "velocityY": 0.6734140079218763, - "timestamp": 8.624491234815606 - }, - { - "x": 7.446189432123703, - "y": 6.046241786918251, - "heading": -0.10968278786227058, - "angularVelocity": 0.32507795300562, - "velocityX": -2.331129737883228, - "velocityY": 0.7482696775873314, - "timestamp": 8.688834343821613 - }, - { - "x": 7.28117009063335, - "y": 6.099203028154522, - "heading": -0.08782351563109066, - "angularVelocity": 0.33972981052468115, - "velocityX": -2.5646777726414474, - "velocityY": 0.8231066551559874, - "timestamp": 8.75317745282762 - }, - { - "x": 7.101115905345124, - "y": 6.156976525213083, - "heading": -0.0658352910964324, - "angularVelocity": 0.34173394593980894, - "velocityX": -2.7983445013733177, - "velocityY": 0.8978971944480737, - "timestamp": 8.817520561833627 - }, - { - "x": 6.906047579451745, - "y": 6.219555700669507, - "heading": -0.04559053086240348, - "angularVelocity": 0.31463758196916874, - "velocityX": -3.031689467712312, - "velocityY": 0.9725855095155665, - "timestamp": 8.881863670839634 - }, - { - "x": 6.696779607755081, - "y": 6.28666337072034, - "heading": -0.03685580053222356, - "angularVelocity": 0.1357523822693175, - "velocityX": -3.2523758166103667, - "velocityY": 1.0429659226532966, - "timestamp": 8.94620677984564 - }, - { - "x": 6.481807673364994, - "y": 6.343877480354193, - "heading": -0.03685579080558635, - "angularVelocity": 1.511682814166473e-7, - "velocityX": -3.341024978603622, - "velocityY": 0.8892033741874479, - "timestamp": 9.010549888851648 + "heading": -0.4182234468320189, + "angularVelocity": 1.2149869731922202e-24, + "velocityX": 1.6200325032236621e-24, + "velocityY": -9.81678651755837e-25, + "timestamp": 8.0478847768255 + }, + { + "x": 8.255885275596246, + "y": 5.786297415399053, + "heading": -0.4161957197256105, + "angularVelocity": 0.03152694238731417, + "velocityX": -0.233058706268173, + "velocityY": 0.07480697540219873, + "timestamp": 8.112202054457356 + }, + { + "x": 8.225904877332317, + "y": 5.795920588198962, + "heading": -0.4121767719087599, + "angularVelocity": 0.06248628618665337, + "velocityX": -0.46613288633782896, + "velocityY": 0.14962033771067135, + "timestamp": 8.176519332089212 + }, + { + "x": 8.180932637466617, + "y": 5.810356062930585, + "heading": -0.4062099213750387, + "angularVelocity": 0.09277212521143607, + "velocityX": -0.6992248664987879, + "velocityY": 0.22444163159780386, + "timestamp": 8.240836609721068 + }, + { + "x": 8.120967221795235, + "y": 5.8296044401602, + "heading": -0.3983469021562322, + "angularVelocity": 0.12225360755804271, + "velocityX": -0.9323375907577511, + "velocityY": 0.29927226304244037, + "timestamp": 8.305153887352924 + }, + { + "x": 8.046007053762992, + "y": 5.853666398213901, + "heading": -0.38865015214844967, + "angularVelocity": 0.15076431038150498, + "velocityX": -1.16547482717328, + "velocityY": 0.3741134410481226, + "timestamp": 8.36947116498478 + }, + { + "x": 7.95605024235754, + "y": 5.882542674483832, + "heading": -0.37719620256520386, + "angularVelocity": 0.17808511188559348, + "velocityX": -1.398641464900824, + "velocityY": 0.44896608396916854, + "timestamp": 8.433788442616637 + }, + { + "x": 7.851094482525453, + "y": 5.916234036378714, + "heading": -0.3640809123745278, + "angularVelocity": 0.20391550565536098, + "velocityX": -1.6318439414186696, + "velocityY": 0.5238306585009168, + "timestamp": 8.498105720248493 + }, + { + "x": 7.731136916910522, + "y": 5.954741232958676, + "heading": -0.349427957292727, + "angularVelocity": 0.22782299906523523, + "velocityX": -1.8650908438872864, + "velocityY": 0.5987068793609814, + "timestamp": 8.562422997880349 + }, + { + "x": 7.596173948111591, + "y": 5.998064906716331, + "heading": -0.33340347371338613, + "angularVelocity": 0.24914741682729602, + "velocityX": -2.0983936784675863, + "velocityY": 0.6735930896459054, + "timestamp": 8.626740275512205 + }, + { + "x": 7.446201013798343, + "y": 6.046205411855825, + "heading": -0.31624349903105253, + "angularVelocity": 0.26680194364810067, + "velocityX": -2.331767447802665, + "velocityY": 0.7484848070691726, + "timestamp": 8.691057553144061 + }, + { + "x": 7.281212494788232, + "y": 6.099162371697227, + "heading": -0.2983118341454104, + "angularVelocity": 0.27880012254686504, + "velocityX": -2.56522858374831, + "velocityY": 0.82337066790236, + "timestamp": 8.755374830775917 + }, + { + "x": 7.101203008664871, + "y": 6.1569332933758485, + "heading": -0.28024668313688234, + "angularVelocity": 0.280875554340636, + "velocityX": -2.7987734050827355, + "velocityY": 0.8982177698703966, + "timestamp": 8.819692108407773 + }, + { + "x": 6.9061821193945345, + "y": 6.219506729950283, + "heading": -0.26348073873693967, + "angularVelocity": 0.26067559164908854, + "velocityX": -3.0321695266179045, + "velocityY": 0.9728868956891804, + "timestamp": 8.88400938603963 + }, + { + "x": 6.696607254404851, + "y": 6.286709539594328, + "heading": -0.25518312367209683, + "angularVelocity": 0.12901066976648753, + "velocityX": -3.258453602300528, + "velocityY": 1.0448640259419284, + "timestamp": 8.948326663671486 + }, + { + "x": 6.4817199239739445, + "y": 6.3438942094131185, + "heading": -0.2551831038227718, + "angularVelocity": 3.086157524298735e-7, + "velocityX": -3.3410513992973323, + "velocityY": 0.8891027718260752, + "timestamp": 9.012643941303342 }, { "x": 6.263319492340088, "y": 6.385702133178711, - "heading": -0.03685578092347688, - "angularVelocity": 1.535845813935868e-7, - "velocityX": -3.3956733580359946, - "velocityY": 0.6500253635647798, - "timestamp": 9.074892997857654 - }, - { - "x": 6.037947373246119, - "y": 6.41213150954562, - "heading": -0.03685577219409298, - "angularVelocity": 1.3300204704480323e-7, - "velocityX": -3.4337993949471355, - "velocityY": 0.40268147161399886, - "timestamp": 9.140526453156646 - }, - { - "x": 5.811253837433788, - "y": 6.422188591577065, - "heading": -0.03685576369032069, - "angularVelocity": 1.295645985289539e-7, - "velocityX": -3.453932674725614, - "velocityY": 0.1532310311201851, - "timestamp": 9.206159908455637 - }, - { - "x": 5.5843374246066, - "y": 6.422402330529617, - "heading": -0.036855755226474385, - "angularVelocity": 1.2895628100949306e-7, - "velocityX": -3.4573284583826145, - "velocityY": 0.003256554931891515, - "timestamp": 9.271793363754629 - }, - { - "x": 5.357421124392654, - "y": 6.422695719883416, - "heading": -0.036855660140139614, - "angularVelocity": 0.0000014487479646455729, - "velocityX": -3.457326742592384, - "velocityY": 0.004470118973044206, - "timestamp": 9.33742681905362 - }, - { - "x": 5.144263768203255, - "y": 6.422952100628831, - "heading": -0.014977306551592268, - "angularVelocity": 0.3333414870340277, - "velocityX": -3.24769365285379, - "velocityY": 0.003906250924130374, - "timestamp": 9.403060274352612 - }, - { - "x": 4.9475144604587005, - "y": 6.423195621457961, - "heading": 0.008467722873920253, - "angularVelocity": 0.3572115671605153, - "velocityX": -2.997698458023694, - "velocityY": 0.003710315539856156, - "timestamp": 9.468693729651603 - }, - { - "x": 4.7671901020112575, - "y": 6.4234252651818, - "heading": 0.031563837809847756, - "angularVelocity": 0.351895459879624, - "velocityX": -2.7474457595745863, - "velocityY": 0.003498882129429363, - "timestamp": 9.534327184950595 - }, - { - "x": 4.603282473031131, - "y": 6.423639886537377, - "heading": 0.05353860692981436, - "angularVelocity": 0.33481048681439957, - "velocityX": -2.4973182995386867, - "velocityY": 0.0032699993410297092, - "timestamp": 9.599960640249586 - }, - { - "x": 4.455783456484323, - "y": 6.42383812523004, - "heading": 0.07396862253695916, - "angularVelocity": 0.31127441811613105, - "velocityX": -2.2473145117056283, - "velocityY": 0.003020390923493434, - "timestamp": 9.665594095548578 - }, - { - "x": 4.3246865966511425, - "y": 6.424018569277829, - "heading": 0.09258438097284048, - "angularVelocity": 0.28363215605635267, - "velocityX": -1.9974090840710925, - "velocityY": 0.00274926936219822, - "timestamp": 9.731227550847569 - }, - { - "x": 4.2099868313745406, - "y": 6.424179849937859, - "heading": 0.10919817149890491, - "angularVelocity": 0.2531299083734149, - "velocityX": -1.74758078413044, - "velocityY": 0.0024572934534053846, - "timestamp": 9.79686100614656 - }, - { - "x": 4.1116801359818504, - "y": 6.424320695943855, - "heading": 0.12367125117094976, - "angularVelocity": 0.2205137548543349, - "velocityX": -1.4978138046344804, - "velocityY": 0.0021459483636000858, - "timestamp": 9.862494461445552 - }, - { - "x": 4.029763255877016, - "y": 6.424439966413886, - "heading": 0.13589682908173525, - "angularVelocity": 0.18627052095752253, - "velocityX": -1.2480964125942142, - "velocityY": 0.0018172206458870563, - "timestamp": 9.928127916744543 - }, - { - "x": 3.96423352032589, - "y": 6.424536671966407, - "heading": 0.14579041449268346, - "angularVelocity": 0.15073997500022146, - "velocityX": -0.9984197122124082, - "velocityY": 0.001473418580201188, - "timestamp": 9.993761372043535 - }, - { - "x": 3.9150887131755114, - "y": 6.424609988913992, - "heading": 0.15328395817373033, - "angularVelocity": 0.11417262197929685, - "velocityX": -0.7487767774300566, - "velocityY": 0.001117066704044862, - "timestamp": 10.059394827342526 - }, - { - "x": 3.8823269815488697, - "y": 6.42465926920727, - "heading": 0.15832209310095952, - "angularVelocity": 0.07676168966387754, - "velocityX": -0.4991620733267284, - "velocityY": 0.0007508410619806591, - "timestamp": 10.125028282641518 + "heading": -0.2551830834264048, + "angularVelocity": 3.1712111825091784e-7, + "velocityX": -3.395672821911929, + "velocityY": 0.6500263273718765, + "timestamp": 9.076961218935198 + }, + { + "x": 6.037162237236338, + "y": 6.412166410916887, + "heading": -0.25518303828533845, + "angularVelocity": 6.854074958240057e-7, + "velocityX": -3.4338993409830967, + "velocityY": 0.4018251187344374, + "timestamp": 9.142821406624625 + }, + { + "x": 5.8096806134973695, + "y": 6.422145044657871, + "heading": -0.2551829940595105, + "angularVelocity": 6.715108093540807e-7, + "velocityX": -3.4540081302483707, + "velocityY": 0.15151237934575548, + "timestamp": 9.208681594314053 + }, + { + "x": 5.5819802469231306, + "y": 6.422071707013465, + "heading": -0.25518294988305257, + "angularVelocity": 6.707611912611386e-7, + "velocityX": -3.457329451412868, + "velocityY": -0.0011135353083337968, + "timestamp": 9.27454178200348 + }, + { + "x": 5.357973256918571, + "y": 6.423240614393437, + "heading": -0.2430314751768064, + "angularVelocity": 0.18450410077098406, + "velocityX": -3.4012504042790286, + "velocityY": 0.017748315347736767, + "timestamp": 9.340401969692907 + }, + { + "x": 5.144457161392198, + "y": 6.423376601690841, + "heading": -0.1958139855508891, + "angularVelocity": 0.7169352424043682, + "velocityX": -3.241960021936682, + "velocityY": 0.0020647875776692963, + "timestamp": 9.406262157382335 + }, + { + "x": 4.947462840354243, + "y": 6.423510104020051, + "heading": -0.14701489396398695, + "angularVelocity": 0.7409497801163326, + "velocityX": -2.991098688739039, + "velocityY": 0.002027056616322834, + "timestamp": 9.472122345071762 + }, + { + "x": 4.766993522305038, + "y": 6.423644398305699, + "heading": -0.09964051366094051, + "angularVelocity": 0.719317420206062, + "velocityX": -2.74018833502617, + "velocityY": 0.002039081429309675, + "timestamp": 9.53798253276119 + }, + { + "x": 4.60301308935793, + "y": 6.423783110988961, + "heading": -0.05492917751371649, + "angularVelocity": 0.6788826105091881, + "velocityX": -2.4898263837385226, + "velocityY": 0.0021061689638151486, + "timestamp": 9.603842720450617 + }, + { + "x": 4.455491999512653, + "y": 6.4239249853365035, + "heading": -0.013574200580991685, + "angularVelocity": 0.6279207269760504, + "velocityX": -2.2399129887228693, + "velocityY": 0.0021541746618076994, + "timestamp": 9.669702908140044 + }, + { + "x": 4.324407720523135, + "y": 6.424066362703545, + "heading": 0.023974314912572615, + "angularVelocity": 0.570124635396258, + "velocityX": -1.9903417161162953, + "velocityY": 0.0021466286690262756, + "timestamp": 9.735563095829471 + }, + { + "x": 4.2097428344188135, + "y": 6.424202667515828, + "heading": 0.05739701354466356, + "angularVelocity": 0.5074795533486763, + "velocityX": -1.7410349123971218, + "velocityY": 0.002069608621913246, + "timestamp": 9.801423283518899 + }, + { + "x": 4.11148358029628, + "y": 6.424329194128387, + "heading": 0.08645394614427561, + "angularVelocity": 0.4411911599255325, + "velocityX": -1.4919370498287492, + "velocityY": 0.001921139568510551, + "timestamp": 9.867283471208326 + }, + { + "x": 4.029618879443776, + "y": 6.4244415432031925, + "heading": 0.11095800828046558, + "angularVelocity": 0.3720618327378889, + "velocityX": -1.2430074028720826, + "velocityY": 0.00170587237520769, + "timestamp": 9.933143658897754 + }, + { + "x": 3.964139686055167, + "y": 6.424535880555734, + "heading": 0.13075995126873372, + "angularVelocity": 0.3006663613175029, + "velocityX": -0.994215104539091, + "velocityY": 0.0014323881520982617, + "timestamp": 9.99900384658718 + }, + { + "x": 3.91503854489554, + "y": 6.424609101274365, + "heading": 0.14573933177166642, + "angularVelocity": 0.22744211683042614, + "velocityX": -0.7455360041056982, + "velocityY": 0.0011117599448221096, + "timestamp": 10.064864034276608 + }, + { + "x": 3.882309280386553, + "y": 6.424658939920723, + "heading": 0.15579869857714623, + "angularVelocity": 0.1527382043445731, + "velocityX": -0.496950671676277, + "velocityY": 0.000756734046866559, + "timestamp": 10.130724221966036 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 0.038661759828822626, - "velocityX": -0.24957107255583263, - "velocityY": 0.0003775283746879617, - "timestamp": 10.19066173794051 + "angularVelocity": 0.07684307602012863, + "velocityX": -0.2484431224119383, + "velocityY": 0.0003812284649235306, + "timestamp": 10.196584409655463 }, { "x": 3.865946769714355, "y": 6.424684047698975, "heading": 0.1608595979864649, - "angularVelocity": 1.109695162138055e-26, - "velocityX": 1.5462924583542684e-27, - "velocityY": -8.002962968658591e-26, - "timestamp": 10.2562951932395 + "angularVelocity": 3.773099570003496e-26, + "velocityX": -4.36512163919617e-27, + "velocityY": 1.07464594312406e-25, + "timestamp": 10.26244459734489 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceSourceSideLower.1.traj b/src/main/deploy/choreo/3PieceSourceSideLower.1.traj index e7daaf4..c3bf183 100644 --- a/src/main/deploy/choreo/3PieceSourceSideLower.1.traj +++ b/src/main/deploy/choreo/3PieceSourceSideLower.1.traj @@ -4,532 +4,532 @@ "x": 0.6476043462753296, "y": 4.391018867492676, "heading": -1.0516500181249593, - "angularVelocity": -1.0131588317285796e-24, - "velocityX": -7.195760422140643e-25, - "velocityY": 3.68543968667644e-24, + "angularVelocity": 1.4837621687026506e-24, + "velocityX": 1.2605777337321822e-24, + "velocityY": -5.078976570788486e-24, "timestamp": 0 }, { - "x": 0.6591914533996168, - "y": 4.382126456198724, - "heading": -1.040727167766298, - "angularVelocity": 0.17178522537716917, - "velocityX": 0.1822320862646183, - "velocityY": -0.1398522206309347, - "timestamp": 0.06358434105540359 - }, - { - "x": 0.6823705688244482, - "y": 4.364325443623157, - "heading": -1.0189895299826641, - "angularVelocity": 0.3418709295845801, - "velocityX": 0.364541254027222, - "velocityY": -0.27995906350677474, - "timestamp": 0.12716868211080717 - }, - { - "x": 0.7171462629990519, - "y": 4.337595981630138, - "heading": -0.9865639713670495, - "angularVelocity": 0.5099613847906508, - "velocityX": 0.5469223018966605, - "velocityY": -0.4203780608456431, - "timestamp": 0.19075302316621076 - }, - { - "x": 0.7635267836330776, - "y": 4.301915006000565, - "heading": -0.943615852299556, - "angularVelocity": 0.6754511937156207, - "velocityX": 0.7294330626720272, - "velocityY": -0.5611597924477026, - "timestamp": 0.25433736422161435 - }, - { - "x": 0.8215286683730939, - "y": 4.257255375739588, - "heading": -0.8903806097169653, - "angularVelocity": 0.8372382523584655, - "velocityX": 0.912203913373529, - "velocityY": -0.7023683743464803, - "timestamp": 0.3179217052770179 - }, - { - "x": 0.8911812541678331, - "y": 4.203582879820058, - "heading": -0.8272094806907175, - "angularVelocity": 0.9935013554863164, - "velocityX": 1.0954361504516998, - "velocityY": -0.8441149979483671, - "timestamp": 0.38150604633242147 - }, - { - "x": 0.9725299828211558, - "y": 4.140850923917802, - "heading": -0.75462709933033, - "angularVelocity": 1.1415134631519366, - "velocityX": 1.2793830572599652, - "velocityY": -0.9865944171316399, - "timestamp": 0.445090387387825 - }, - { - "x": 1.0656375296619247, - "y": 4.068994254029578, - "heading": -0.6733936884757168, - "angularVelocity": 1.2775694377933589, - "velocityX": 1.4643156679038403, - "velocityY": -1.130100095330278, - "timestamp": 0.5086747284432286 - }, - { - "x": 1.1705832794462367, - "y": 3.987925697121121, - "heading": -0.5845665618376034, - "angularVelocity": 1.396996888915067, - "velocityX": 1.6504967739284813, - "velocityY": -1.2749767562711483, - "timestamp": 0.5722590694986321 - }, - { - "x": 1.287465328455322, - "y": 3.897542804343646, - "heading": -0.48958951482473, - "angularVelocity": 1.4937175637334361, - "velocityX": 1.8382206541582515, - "velocityY": -1.4214646448678434, - "timestamp": 0.6358434105540357 - }, - { - "x": 1.416410446947234, - "y": 3.797751405129375, - "heading": -0.3905846134253379, - "angularVelocity": 1.5570642041115932, - "velocityX": 2.0279382683160483, - "velocityY": -1.5694335674143292, - "timestamp": 0.6994277516094393 - }, - { - "x": 1.5575332696620845, - "y": 3.6885069096807293, - "heading": -0.2916586370436419, - "angularVelocity": 1.5558229391022207, - "velocityX": 2.2194587593804664, - "velocityY": -1.7181037600665896, - "timestamp": 0.7630120926648428 - }, - { - "x": 1.7097613444570134, - "y": 3.570777493688783, - "heading": -0.20742198100348744, - "angularVelocity": 1.3248019031408336, - "velocityX": 2.394112642643988, - "velocityY": -1.8515473155468265, - "timestamp": 0.8265964337202464 - }, - { - "x": 1.8711613775924387, - "y": 3.448808413688974, - "heading": -0.15383975328764557, - "angularVelocity": 0.8426953370351598, - "velocityX": 2.538361339544133, - "velocityY": -1.9182251160475614, - "timestamp": 0.8901807747756499 - }, - { - "x": 2.0417383028773095, - "y": 3.3225570909899145, - "heading": -0.1305932032652052, - "angularVelocity": 0.36560180756115246, - "velocityX": 2.6826876311612624, - "velocityY": -1.985572557700191, - "timestamp": 0.9537651158310535 - }, - { - "x": 2.215389362271695, - "y": 3.1877556827532114, - "heading": -0.13059307027477257, - "angularVelocity": 0.0000020915595006631527, - "velocityX": 2.7310349767260567, - "velocityY": -2.120040972340114, - "timestamp": 1.0173494568864572 - }, - { - "x": 2.38903992841347, - "y": 3.05295363910863, - "heading": -0.13059293728967952, - "angularVelocity": 0.000002091475524120011, - "velocityX": 2.7310272192719025, - "velocityY": -2.120050965490433, - "timestamp": 1.0809337979418607 - }, - { - "x": 2.5626904945233253, - "y": 2.918151595422929, - "heading": -0.13059280430458975, - "angularVelocity": 0.000002091475473085295, - "velocityX": 2.731027218769898, - "velocityY": -2.1200509661371285, - "timestamp": 1.1445181389972643 - }, - { - "x": 2.7363410606331784, - "y": 2.7833495517372238, - "heading": -0.13059267131950322, - "angularVelocity": 0.0000020914754220002734, - "velocityX": 2.7310272187698588, - "velocityY": -2.120050966137197, - "timestamp": 1.2081024800526678 - }, - { - "x": 2.909991626743031, - "y": 2.6485475080515166, - "heading": -0.13059253833441983, - "angularVelocity": 0.0000020914753719975214, - "velocityX": 2.731027218769853, - "velocityY": -2.1200509661372235, - "timestamp": 1.2716868211080714 - }, - { - "x": 3.0836421928528828, - "y": 2.5137454643658077, - "heading": -0.13059240534933972, - "angularVelocity": 0.0000020914753210405788, - "velocityX": 2.7310272187698468, - "velocityY": -2.12005096613725, - "timestamp": 1.335271162163475 - }, - { - "x": 3.2572927589627345, - "y": 2.3789434206800975, - "heading": -0.13059227236426274, - "angularVelocity": 0.0000020914752714762697, - "velocityX": 2.73102721876984, - "velocityY": -2.1200509661372764, - "timestamp": 1.3988555032188785 - }, - { - "x": 3.4309433250725863, - "y": 2.2441413769943854, - "heading": -0.13059213937918893, - "angularVelocity": 0.000002091475221449109, - "velocityX": 2.731027218769834, - "velocityY": -2.1200509661373035, - "timestamp": 1.462439844274282 - }, - { - "x": 3.604593891182437, - "y": 2.1093393333086716, - "heading": -0.13059200639411836, - "angularVelocity": 0.000002091475170968491, - "velocityX": 2.7310272187698277, - "velocityY": -2.12005096613733, - "timestamp": 1.5260241853296856 - }, - { - "x": 3.7782444572922893, - "y": 1.9745372896229578, - "heading": -0.13059187340905104, - "angularVelocity": 0.0000020914751195693144, - "velocityX": 2.731027218769846, - "velocityY": -2.120050966137325, - "timestamp": 1.5896085263850892 - }, - { - "x": 3.951895023426439, - "y": 1.8397352459685434, - "heading": -0.13059174042398683, - "angularVelocity": 0.0000020914750705889236, - "velocityX": 2.731027219151981, - "velocityY": -2.12005096564508, - "timestamp": 1.6531928674404928 - }, - { - "x": 4.125545965030262, - "y": 1.7049336859915973, - "heading": -0.13059160743887335, - "angularVelocity": 0.0000020914758454008564, - "velocityX": 2.7310331242170753, - "velocityY": -2.1200433587805536, - "timestamp": 1.7167772084958963 - }, - { - "x": 4.303592186821453, - "y": 1.5759931847530522, - "heading": -0.13059147325010556, - "angularVelocity": 0.000002110405888729409, - "velocityX": 2.8001583225664275, - "velocityY": -2.0278656521138467, - "timestamp": 1.7803615495512999 - }, - { - "x": 4.490236730845761, - "y": 1.4598470551473188, - "heading": -0.130591333138394, - "angularVelocity": 0.000002203556870291448, - "velocityX": 2.935385362595435, - "velocityY": -1.826646744746956, - "timestamp": 1.8439458906067034 + "x": 0.6591914533996294, + "y": 4.3821264561987325, + "heading": -1.0407271677663157, + "angularVelocity": 0.1717852253768825, + "velocityX": 0.1822320862648084, + "velocityY": -0.1398522206307734, + "timestamp": 0.06358434105540607 + }, + { + "x": 0.682370568824486, + "y": 4.364325443623188, + "heading": -1.0189895299827134, + "angularVelocity": 0.341870929584073, + "velocityX": 0.36454125402760434, + "velocityY": -0.2799590635064334, + "timestamp": 0.12716868211081214 + }, + { + "x": 0.7171462629991276, + "y": 4.337595981630201, + "heading": -0.9865639713671387, + "angularVelocity": 0.509961384790003, + "velocityX": 0.5469223018972373, + "velocityY": -0.42037806084509965, + "timestamp": 0.19075302316621823 + }, + { + "x": 0.7635267836332045, + "y": 4.301915006000676, + "heading": -0.9436158522996869, + "angularVelocity": 0.6754511937149356, + "velocityX": 0.7294330626728007, + "velocityY": -0.5611597924469304, + "timestamp": 0.2543373642216243 + }, + { + "x": 0.821528668373285, + "y": 4.257255375739764, + "heading": -0.8903806097171314, + "angularVelocity": 0.8372382523578797, + "velocityX": 0.9122039133745026, + "velocityY": -0.7023683743454452, + "timestamp": 0.31792170527703034 + }, + { + "x": 0.891181254168102, + "y": 4.203582879820318, + "heading": -0.8272094806909008, + "angularVelocity": 0.9935013554860082, + "velocityX": 1.0954361504528793, + "velocityY": -0.8441149979470245, + "timestamp": 0.3815060463324364 + }, + { + "x": 0.9725299828215167, + "y": 4.140850923918169, + "heading": -0.7546270993304982, + "angularVelocity": 1.1415134631521273, + "velocityX": 1.279383057261364, + "velocityY": -0.986594417129931, + "timestamp": 0.44509038738784246 + }, + { + "x": 1.065637529662394, + "y": 4.068994254030079, + "heading": -0.673393688475822, + "angularVelocity": 1.2775694377943008, + "velocityX": 1.464315667905486, + "velocityY": -1.1301000953281266, + "timestamp": 0.5086747284432486 + }, + { + "x": 1.1705832794468332, + "y": 3.9879256971217893, + "heading": -0.584566561837581, + "angularVelocity": 1.3969968889170195, + "velocityX": 1.6504967739304255, + "velocityY": -1.2749767562684577, + "timestamp": 0.5722590694986547 + }, + { + "x": 1.2874653284560715, + "y": 3.897542804344524, + "heading": -0.4895895148245002, + "angularVelocity": 1.4937175637366416, + "velocityX": 1.8382206541605852, + "velocityY": -1.42146464486449, + "timestamp": 0.6358434105540608 + }, + { + "x": 1.4164104469481729, + "y": 3.7977514051305152, + "heading": -0.3905846134248042, + "angularVelocity": 1.557064204116311, + "velocityX": 2.0279382683189424, + "velocityY": -1.5694335674101274, + "timestamp": 0.6994277516094669 + }, + { + "x": 1.5575332696632753, + "y": 3.688506909682212, + "heading": -0.2916586370426824, + "angularVelocity": 1.5558229391088563, + "velocityX": 2.2194587593843385, + "velocityY": -1.718103760061147, + "timestamp": 0.763012092664873 + }, + { + "x": 1.7097613444585642, + "y": 3.5707774936908128, + "heading": -0.20742198100231668, + "angularVelocity": 1.324801903144104, + "velocityX": 2.394112642649561, + "velocityY": -1.8515473155381532, + "timestamp": 0.8265964337202791 + }, + { + "x": 1.8711613775944314, + "y": 3.4488084136916637, + "heading": -0.15383975328628857, + "angularVelocity": 0.8426953370380558, + "velocityX": 2.538361339550979, + "velocityY": -1.9182251160370993, + "timestamp": 0.8901807747756852 + }, + { + "x": 2.0417383028799354, + "y": 3.3225570909935143, + "heading": -0.13059320326371432, + "angularVelocity": 0.3656018075632435, + "velocityX": 2.682687631171131, + "velocityY": -1.9855725576858096, + "timestamp": 0.9537651158310914 + }, + { + "x": 2.2153893622715715, + "y": 3.187755682753254, + "heading": -0.13059307027328165, + "angularVelocity": 0.0000020915595014550256, + "velocityX": 2.731034976682693, + "velocityY": -2.120040972395975, + "timestamp": 1.0173494568864974 + }, + { + "x": 2.389039928413357, + "y": 3.0529536391086727, + "heading": -0.13059293728818866, + "angularVelocity": 0.000002091475523406473, + "velocityX": 2.7310272192719673, + "velocityY": -2.1200509654903494, + "timestamp": 1.0809337979419034 + }, + { + "x": 2.562690494523223, + "y": 2.918151595422971, + "heading": -0.13059280430309889, + "angularVelocity": 0.000002091475472778544, + "velocityX": 2.7310272187699582, + "velocityY": -2.1200509661370504, + "timestamp": 1.1445181389973094 + }, + { + "x": 2.7363410606330874, + "y": 2.7833495517372655, + "heading": -0.1305926713180123, + "angularVelocity": 0.0000020914754223957298, + "velocityX": 2.7310272187699196, + "velocityY": -2.1200509661371187, + "timestamp": 1.2081024800527154 + }, + { + "x": 2.9099916267429506, + "y": 2.648547508051558, + "heading": -0.13059253833292897, + "angularVelocity": 0.000002091475371640255, + "velocityX": 2.731027218769913, + "velocityY": -2.120050966137146, + "timestamp": 1.2716868211081214 + }, + { + "x": 3.0836421928528135, + "y": 2.513745464365849, + "heading": -0.1305924053478488, + "angularVelocity": 0.000002091475321590614, + "velocityX": 2.7310272187699067, + "velocityY": -2.120050966137172, + "timestamp": 1.3352711621635274 + }, + { + "x": 3.257292758962676, + "y": 2.3789434206801383, + "heading": -0.13059227236277188, + "angularVelocity": 0.000002091475271021181, + "velocityX": 2.7310272187699005, + "velocityY": -2.1200509661371987, + "timestamp": 1.3988555032189334 + }, + { + "x": 3.430943325072538, + "y": 2.244141376994426, + "heading": -0.1305921393776981, + "angularVelocity": 0.0000020914752212008574, + "velocityX": 2.7310272187698943, + "velocityY": -2.1200509661372253, + "timestamp": 1.4624398442743394 + }, + { + "x": 3.6045938911823994, + "y": 2.1093393333087116, + "heading": -0.13059200639262752, + "angularVelocity": 0.0000020914751708183746, + "velocityX": 2.731027218769888, + "velocityY": -2.120050966137252, + "timestamp": 1.5260241853297454 + }, + { + "x": 3.7782444572922627, + "y": 1.9745372896229973, + "heading": -0.13059187340756015, + "angularVelocity": 0.000002091475120575094, + "velocityX": 2.7310272187699067, + "velocityY": -2.1200509661372466, + "timestamp": 1.5896085263851514 + }, + { + "x": 3.951895023426423, + "y": 1.8397352459685825, + "heading": -0.13059174042249597, + "angularVelocity": 0.0000020914750700807474, + "velocityX": 2.731027219152042, + "velocityY": -2.1200509656450026, + "timestamp": 1.6531928674405574 + }, + { + "x": 4.125545965030257, + "y": 1.7049336859916362, + "heading": -0.13059160743738255, + "angularVelocity": 0.0000020914758451630756, + "velocityX": 2.731033124217136, + "velocityY": -2.1200433587804755, + "timestamp": 1.7167772084959634 + }, + { + "x": 4.303592186821449, + "y": 1.5759931847530775, + "heading": -0.13059147324861473, + "angularVelocity": 0.0000021104058890338206, + "velocityX": 2.800158322566331, + "velocityY": -2.0278656521139804, + "timestamp": 1.7803615495513694 + }, + { + "x": 4.4902367308457585, + "y": 1.459847055147331, + "heading": -0.13059133313690313, + "angularVelocity": 0.0000022035568702526466, + "velocityX": 2.9353853625953525, + "velocityY": -1.8266467447470887, + "timestamp": 1.8439458906067754 }, { "x": 4.6845622062683105, "y": 1.3570671081542969, - "heading": -0.1305911820170352, - "angularVelocity": 0.0000023767071620557534, - "velocityX": 3.056184466128632, - "velocityY": -1.616434884549102, - "timestamp": 1.907530231662107 - }, - { - "x": 4.83206708447035, - "y": 1.2885914794569848, - "heading": -0.13059103262448568, - "angularVelocity": 0.0000031760307779027524, - "velocityX": 3.13589957828876, - "velocityY": -1.4557667364792974, - "timestamp": 1.954567732232368 - }, - { - "x": 4.982924581891179, - "y": 1.2278574954319794, - "heading": -0.13059088660040227, - "angularVelocity": 0.0000031044184242488255, - "velocityX": 3.2071750325145314, - "velocityY": -1.2911822118244922, - "timestamp": 2.0016052328026293 - }, - { - "x": 5.13672864917333, - "y": 1.1750284268224314, - "heading": -0.13059074139304624, - "angularVelocity": 0.000003087055099940033, - "velocityX": 3.269818026415093, - "velocityY": -1.1231266110884432, - "timestamp": 2.0486427333728905 - }, - { - "x": 5.293065104212699, - "y": 1.1302454562937732, - "heading": -0.13059059472423634, - "angularVelocity": 0.000003118125073070688, - "velocityX": 3.3236556607816676, - "velocityY": -0.9520695186974223, - "timestamp": 2.0956802339431517 - }, - { - "x": 5.450482773711638, - "y": 1.0894253766985498, - "heading": -0.13059044674776243, - "angularVelocity": 0.0000031459255302142065, - "velocityX": 3.346641883401104, - "velocityY": -0.8678199117797415, - "timestamp": 2.142717734513413 - }, - { - "x": 5.6079006554403685, - "y": 1.0486061155506479, - "heading": -0.1305902987709771, - "angularVelocity": 0.000003145932150679596, - "velocityX": 3.3466463953285848, - "velocityY": -0.8678025118900388, - "timestamp": 2.189755235083674 - }, - { - "x": 5.765318537202432, - "y": 1.0077868545312842, - "heading": -0.13059015079419933, - "angularVelocity": 0.0000031459319897448254, - "velocityX": 3.3466463960372055, - "velocityY": -0.8678025091573679, - "timestamp": 2.2367927356539354 - }, - { - "x": 5.9227364189645, - "y": 0.9669675935119412, - "heading": -0.13059000281742925, - "angularVelocity": 0.0000031459318269023195, - "velocityX": 3.346646396037345, - "velocityY": -0.8678025091569279, - "timestamp": 2.2838302362241967 - }, - { - "x": 6.080154300726611, - "y": 0.9261483324927562, - "heading": -0.13058985484066676, - "angularVelocity": 0.000003145931664971049, - "velocityX": 3.346646396038242, - "velocityY": -0.867802509153567, - "timestamp": 2.330867736794458 - }, - { - "x": 6.237572182748926, - "y": 0.8853290724770341, - "heading": -0.13058970686391144, - "angularVelocity": 0.0000031459315122386572, - "velocityX": 3.3466464015700863, - "velocityY": -0.8678024878203159, - "timestamp": 2.377905237364719 - }, - { - "x": 6.394991721452043, - "y": 0.8445162019222677, - "heading": -0.13058955888394272, - "angularVelocity": 0.0000031459998284529575, - "velocityX": 3.3466816219959403, - "velocityY": -0.8676666502252415, - "timestamp": 2.4249427379349804 - }, - { - "x": 6.554152816051068, - "y": 0.8111344074726671, - "heading": -0.13058937107407412, - "angularVelocity": 0.000003992768882684273, - "velocityX": 3.3837064612155903, - "velocityY": -0.7096846993334062, - "timestamp": 2.4719802385052416 - }, - { - "x": 6.711882769952025, - "y": 0.7851880682804044, - "heading": -0.12042377120885606, - "angularVelocity": 0.21611692249747513, - "velocityX": 3.35328093518389, - "velocityY": -0.551609649273476, - "timestamp": 2.519017739075503 - }, - { - "x": 6.866725553620077, - "y": 0.7651062041845456, - "heading": -0.09663025977922159, - "angularVelocity": 0.5058413210985454, - "velocityX": 3.2919007555845554, - "velocityY": -0.42693306090662936, - "timestamp": 2.566055239645764 - }, - { - "x": 7.014982029149136, - "y": 0.7495960675805906, - "heading": -0.0669452251457697, - "angularVelocity": 0.631092942302719, - "velocityX": 3.1518782616352006, - "velocityY": -0.3297398121906415, - "timestamp": 2.6130927402160253 - }, - { - "x": 7.155468637798723, - "y": 0.7371442919133843, - "heading": -0.039841575624683864, - "angularVelocity": 0.5762136421470871, - "velocityX": 2.9866937432132143, - "velocityY": -0.26472018105228134, - "timestamp": 2.6601302407862866 - }, - { - "x": 7.288217565103697, - "y": 0.7273449805476783, - "heading": -0.01722296703020818, - "angularVelocity": 0.4808633179964505, - "velocityX": 2.8221934774506603, - "velocityY": -0.20832976342075163, - "timestamp": 2.707167741356548 + "heading": -0.13059118201554434, + "angularVelocity": 0.0000023767071623724323, + "velocityX": 3.0561844661285633, + "velocityY": -1.6164348845492313, + "timestamp": 1.9075302316621814 + }, + { + "x": 4.832067084470335, + "y": 1.2885914794569837, + "heading": -0.1305910326229948, + "angularVelocity": 0.0000031760307778025535, + "velocityX": 3.1358995782886923, + "velocityY": -1.4557667364794429, + "timestamp": 1.9545677322324386 + }, + { + "x": 4.982924581891149, + "y": 1.2278574954319752, + "heading": -0.13059088659891144, + "angularVelocity": 0.000003104418423448367, + "velocityX": 3.207175032514466, + "velocityY": -1.2911822118246548, + "timestamp": 2.001605232802696 + }, + { + "x": 5.136728649173284, + "y": 1.1750284268224231, + "heading": -0.13059074139155538, + "angularVelocity": 0.00000308705510077957, + "velocityX": 3.269818026415032, + "velocityY": -1.1231266110886224, + "timestamp": 2.048642733372953 + }, + { + "x": 5.293065104212638, + "y": 1.1302454562937592, + "heading": -0.1305905947227455, + "angularVelocity": 0.0000031181250722314943, + "velocityX": 3.3236556607816112, + "velocityY": -0.9520695186976181, + "timestamp": 2.0956802339432103 + }, + { + "x": 5.450482773711564, + "y": 1.0894253766985387, + "heading": -0.13059044674627163, + "angularVelocity": 0.0000031459255294965824, + "velocityX": 3.3466418834011025, + "velocityY": -0.8678199117797456, + "timestamp": 2.1427177345134676 + }, + { + "x": 5.607900655440282, + "y": 1.04860611555064, + "heading": -0.1305902987694863, + "angularVelocity": 0.0000031459321514570608, + "velocityX": 3.346646395328584, + "velocityY": -0.8678025118900428, + "timestamp": 2.189755235083725 + }, + { + "x": 5.765318537202331, + "y": 1.0077868545312796, + "heading": -0.13059015079270853, + "angularVelocity": 0.0000031459319896246793, + "velocityX": 3.346646396037204, + "velocityY": -0.867802509157372, + "timestamp": 2.236792735653982 + }, + { + "x": 5.922736418964388, + "y": 0.9669675935119395, + "heading": -0.1305900028159384, + "angularVelocity": 0.0000031459318275019883, + "velocityX": 3.3466463960373436, + "velocityY": -0.867802509156932, + "timestamp": 2.2838302362242393 + }, + { + "x": 6.080154300726486, + "y": 0.9261483324927575, + "heading": -0.13058985483917593, + "angularVelocity": 0.0000031459316651066595, + "velocityX": 3.3466463960382407, + "velocityY": -0.867802509153571, + "timestamp": 2.3308677367944965 + }, + { + "x": 6.237572182748789, + "y": 0.8853290724770384, + "heading": -0.1305897068624206, + "angularVelocity": 0.0000031459315124739283, + "velocityX": 3.346646401570085, + "velocityY": -0.86780248782032, + "timestamp": 2.377905237364754 + }, + { + "x": 6.394991721451892, + "y": 0.844516201922275, + "heading": -0.1305895588824519, + "angularVelocity": 0.0000031459998283836956, + "velocityX": 3.3466816219959377, + "velocityY": -0.8676666502252512, + "timestamp": 2.424942737935011 + }, + { + "x": 6.554152816050896, + "y": 0.8111344074726426, + "heading": -0.1305893710725833, + "angularVelocity": 0.000003992768882659048, + "velocityX": 3.3837064612154375, + "velocityY": -0.7096846993341356, + "timestamp": 2.4719802385052683 + }, + { + "x": 6.711882769951912, + "y": 0.7851880682804085, + "heading": -0.12042377120760904, + "angularVelocity": 0.21611692249230904, + "velocityX": 3.3532809351853774, + "velocityY": -0.5516096492729113, + "timestamp": 2.5190177390755255 + }, + { + "x": 6.866725553620017, + "y": 0.7651062041845728, + "heading": -0.09663025977821411, + "angularVelocity": 0.5058413210934933, + "velocityX": 3.29190075558594, + "velocityY": -0.4269330609061741, + "timestamp": 2.5660552396457827 + }, + { + "x": 7.014982029149098, + "y": 0.7495960675806145, + "heading": -0.06694522514508651, + "angularVelocity": 0.6310929422958753, + "velocityX": 3.151878261635918, + "velocityY": -0.3297398121907379, + "timestamp": 2.61309274021604 + }, + { + "x": 7.155468637798704, + "y": 0.7371442919133998, + "heading": -0.03984157562428539, + "angularVelocity": 0.5762136421410802, + "velocityX": 2.9866937432138485, + "velocityY": -0.26472018105247963, + "timestamp": 2.6601302407862972 + }, + { + "x": 7.28821756510369, + "y": 0.727344980547685, + "heading": -0.017222967030039466, + "angularVelocity": 0.48086331799160453, + "velocityX": 2.8221934774511723, + "velocityY": -0.20832976342095313, + "timestamp": 2.7071677413565545 }, { "x": 7.413279056549072, "y": 0.72, - "heading": 6.339387425155692e-24, - "angularVelocity": 0.36615395846728294, - "velocityX": 2.6587614122601657, - "velocityY": -0.1561515909355554, - "timestamp": 2.754205241926809 - }, - { - "x": 7.584141987680613, - "y": 0.7142363916829177, - "heading": 0.012496138017673028, - "angularVelocity": 0.17655403361368305, - "velocityX": 2.414069022258432, - "velocityY": -0.08143222290847654, - "timestamp": 2.8249832228197054 - }, - { - "x": 7.736548147209623, - "y": 0.711851622188137, - "heading": 0.017397146839460656, - "angularVelocity": 0.06924482388391391, - "velocityX": 2.153299057225679, - "velocityY": -0.03369366383013129, - "timestamp": 2.8957612037126017 - }, - { - "x": 7.870091367183984, - "y": 0.7115747244873084, - "heading": 0.017828194306038627, - "angularVelocity": 0.006090135111797648, - "velocityX": 1.8867904719752233, - "velocityY": -0.00391220118651861, + "heading": -8.89059623238174e-24, + "angularVelocity": 0.3661539584637254, + "velocityX": 2.6587614122605316, + "velocityY": -0.15615159093571299, + "timestamp": 2.7542052419268117 + }, + { + "x": 7.584141987680618, + "y": 0.7142363916829146, + "heading": 0.012496138017563933, + "angularVelocity": 0.17655403361214328, + "velocityX": 2.4140690222585377, + "velocityY": -0.0814322229085219, + "timestamp": 2.824983222819707 + }, + { + "x": 7.7365481472096285, + "y": 0.7118516221881321, + "heading": 0.017397146839313638, + "angularVelocity": 0.0692448238833787, + "velocityX": 2.153299057225703, + "velocityY": -0.03369366383015727, + "timestamp": 2.8957612037126026 + }, + { + "x": 7.8700913671839885, + "y": 0.7115747244873029, + "heading": 0.01782819430589125, + "angularVelocity": 0.006090135111792666, + "velocityX": 1.8867904719752229, + "velocityY": -0.00391220118652886, "timestamp": 2.966539184605498 }, { - "x": 7.984616283222687, - "y": 0.7125587164394659, - "heading": 0.015661834277452328, - "angularVelocity": -0.030607824654739903, - "velocityX": 1.6180867918796034, - "velocityY": 0.01390251515717133, - "timestamp": 3.0373171654983944 + "x": 7.98461628322269, + "y": 0.7125587164394606, + "heading": 0.01566183427732483, + "angularVelocity": -0.03060782465445932, + "velocityX": 1.6180867918795971, + "velocityY": 0.013902515157174911, + "timestamp": 3.0373171654983935 }, { "x": 8.08006227999561, - "y": 0.714207810245489, - "heading": 0.012151433911586507, - "angularVelocity": -0.049597351062866286, - "velocityX": 1.3485266967046678, - "velocityY": 0.023299531651214074, - "timestamp": 3.1080951463912907 + "y": 0.7142078102454845, + "heading": 0.012151433911488669, + "angularVelocity": -0.04959735106244768, + "velocityX": 1.3485266967046623, + "velocityY": 0.023299531651227553, + "timestamp": 3.108095146391289 }, { "x": 8.15640902937787, - "y": 0.7160816946030871, - "heading": 0.00820427926993306, - "angularVelocity": -0.05576811590071236, - "velocityX": 1.0786793917982935, - "velocityY": 0.02647552719021178, - "timestamp": 3.178873127284187 + "y": 0.716081694603084, + "heading": 0.008204279269867538, + "angularVelocity": -0.055768115900256314, + "velocityX": 1.0786793917982904, + "velocityY": 0.02647552719023059, + "timestamp": 3.1788731272841844 }, { "x": 8.213654764882792, - "y": 0.71784200041228, - "heading": 0.0045134929539951294, - "angularVelocity": -0.0521459678473021, - "velocityX": 0.8088071287530355, - "velocityY": 0.02487081133123372, - "timestamp": 3.2496511081770834 + "y": 0.7178420004122783, + "heading": 0.004513492953959301, + "angularVelocity": -0.05214596784688299, + "velocityX": 0.8088071287530345, + "velocityY": 0.02487081133125343, + "timestamp": 3.24965110817708 }, { "x": 8.251806612817116, - "y": 0.7192206370589295, - "heading": 0.0016291300859072085, - "angularVelocity": -0.040752262662771335, - "velocityX": 0.5390355510714089, - "velocityY": 0.019478326864616948, - "timestamp": 3.3204290890699797 + "y": 0.7192206370589289, + "heading": 0.0016291300858943402, + "angularVelocity": -0.04075226266244733, + "velocityX": 0.5390355510714093, + "velocityY": 0.019478326864633543, + "timestamp": 3.3204290890699752 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -4.056080746895066e-24, - "angularVelocity": -0.023017470481002632, - "velocityX": 0.26942444144984345, - "velocityY": 0.011011375730678513, - "timestamp": 3.391207069962876 + "heading": 5.577770790961069e-24, + "angularVelocity": -0.02301747048082103, + "velocityX": 0.2694244414498442, + "velocityY": 0.011011375730688399, + "timestamp": 3.3912070699628707 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -1.9991825038559772e-24, - "angularVelocity": 6.550650295244866e-25, - "velocityX": -3.4098418734015305e-26, - "velocityY": 1.7181985071097e-25, - "timestamp": 3.4619850508557724 + "heading": 2.68750083227073e-24, + "angularVelocity": -1.0022200251051524e-24, + "velocityX": 6.790628726650556e-26, + "velocityY": 3.41370039560792e-26, + "timestamp": 3.461985050855766 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceSourceSideLower.2.traj b/src/main/deploy/choreo/3PieceSourceSideLower.2.traj index 6c280b4..367001e 100644 --- a/src/main/deploy/choreo/3PieceSourceSideLower.2.traj +++ b/src/main/deploy/choreo/3PieceSourceSideLower.2.traj @@ -3,416 +3,416 @@ { "x": 8.270875930786133, "y": 0.72, - "heading": -1.9991825038559772e-24, - "angularVelocity": 6.550650295244866e-25, - "velocityX": -3.4098418734015305e-26, - "velocityY": 1.7181985071097e-25, + "heading": 2.68750083227073e-24, + "angularVelocity": -1.0022200251051524e-24, + "velocityX": 6.790628726650556e-26, + "velocityY": 3.41370039560792e-26, "timestamp": 0 }, { - "x": 8.25196066732055, - "y": 0.7219205807616909, - "heading": -0.005612553081760066, - "angularVelocity": -0.07909055712036753, - "velocityX": -0.2665486996342892, - "velocityY": 0.027064296804682322, - "timestamp": 0.07096363062936017 - }, - { - "x": 8.21412399288685, - "y": 0.7257596347584204, - "heading": -0.016744431402723248, - "angularVelocity": -0.15686737307881685, - "velocityX": -0.5331840281864679, - "velocityY": 0.05409889492239708, - "timestamp": 0.14192726125872035 - }, - { - "x": 8.157358520801719, - "y": 0.7315141378055798, - "heading": -0.033282470488275456, - "angularVelocity": -0.23304950632993487, - "velocityX": -0.7999234478519905, - "velocityY": 0.08109087706088317, - "timestamp": 0.21289089188808052 - }, - { - "x": 8.081655397928103, - "y": 0.7391803054783095, - "heading": -0.055089458667278546, - "angularVelocity": -0.3072980903823823, - "velocityX": -1.066787623494219, - "velocityY": 0.10802953012324953, - "timestamp": 0.2838545225174407 - }, - { - "x": 7.987003995494799, - "y": 0.748753815449985, - "heading": -0.08199800345549389, - "angularVelocity": -0.3791878255039894, - "velocityX": -1.3338015768621518, - "velocityY": 0.13490727414550616, - "timestamp": 0.3548181531468009 - }, - { - "x": 7.8733914694677685, - "y": 0.7602301364715836, - "heading": -0.11380071054386168, - "angularVelocity": -0.44815501696174403, - "velocityX": -1.6009965248314793, - "velocityY": 0.16172116505057207, - "timestamp": 0.42578178377616105 - }, - { - "x": 7.74080211111102, - "y": 0.7736050364848951, - "heading": -0.15023345295494694, - "angularVelocity": -0.5134002035686684, - "velocityX": -1.868412835995617, - "velocityY": 0.18847541895323702, - "timestamp": 0.4967454144055212 - }, - { - "x": 7.589216359418635, - "y": 0.7888753993182606, - "heading": -0.19094489906072787, - "angularVelocity": -0.5736945213304409, - "velocityX": -2.1361047954847603, - "velocityY": 0.2151857606204215, - "timestamp": 0.5677090450348814 - }, - { - "x": 7.418609301999379, - "y": 0.8060405691564864, - "heading": -0.2354360929047945, - "angularVelocity": -0.6269576887411831, - "velocityX": -2.4041478135515395, - "velocityY": 0.24188686071994714, - "timestamp": 0.6386726756642416 - }, - { - "x": 7.228948719447248, - "y": 0.8251044625017263, - "heading": -0.28292522744133536, - "angularVelocity": -0.6692038459048766, - "velocityX": -2.672644858642023, - "velocityY": 0.2686431510925627, - "timestamp": 0.7096363062936017 - }, - { - "x": 7.020195878786293, - "y": 0.8460771849141498, - "heading": -0.33198004179541496, - "angularVelocity": -0.691266976041442, - "velocityX": -2.9416877181955665, - "velocityY": 0.29554184624463653, - "timestamp": 0.7805999369229619 - }, - { - "x": 6.7923582844879515, - "y": 0.868949065573254, - "heading": -0.379053692427792, - "angularVelocity": -0.6633489607971249, - "velocityX": -3.2106248267979276, - "velocityY": 0.3223042628492752, - "timestamp": 0.8515635675523221 - }, - { - "x": 6.551577901314172, - "y": 0.8947450109840207, - "heading": -0.38936079053254913, - "angularVelocity": -0.1452447967127084, - "velocityX": -3.3930110542309384, - "velocityY": 0.3635093805374453, - "timestamp": 0.9225271981816823 - }, - { - "x": 6.307465319785258, - "y": 0.9193021232357074, - "heading": -0.38936083584908904, - "angularVelocity": -6.385882391179967e-7, - "velocityX": -3.4399674786074925, - "velocityY": 0.3460520837772146, - "timestamp": 0.9934908288110424 - }, - { - "x": 6.0633527302184325, - "y": 0.9438591555860323, - "heading": -0.38936088116543593, - "angularVelocity": -6.385855192726227e-7, - "velocityX": -3.4399675918755674, - "velocityY": 0.34605095782916134, - "timestamp": 1.0644544594404026 - }, - { - "x": 5.819240162083019, - "y": 0.9684164009773654, - "heading": -0.38936092648177834, - "angularVelocity": -6.38585455697529e-7, - "velocityX": -3.4399672898699727, - "velocityY": 0.3460539599445595, - "timestamp": 1.1354180900697628 - }, - { - "x": 5.575592141235637, - "y": 0.9972199796568127, - "heading": -0.38936097177673723, - "angularVelocity": -6.382841249552677e-7, - "velocityX": -3.433421017026949, - "velocityY": 0.4058921228239739, - "timestamp": 1.206381720699123 - }, - { - "x": 5.334942567663047, - "y": 1.044988031266676, - "heading": -0.389361017575543, - "angularVelocity": -6.453841966108095e-7, - "velocityX": -3.391167721244301, - "velocityY": 0.6731342687263799, - "timestamp": 1.2773453513284831 - }, - { - "x": 5.098765706313627, - "y": 1.1114296874515797, - "heading": -0.3893610653343458, - "angularVelocity": -6.730039375535028e-7, - "velocityX": -3.3281394885636724, - "velocityY": 0.9362775776217799, - "timestamp": 1.3483089819578433 - }, - { - "x": 4.868508287372395, - "y": 1.1961381502837038, - "heading": -0.38936111679255236, - "angularVelocity": -7.251349187747336e-7, - "velocityX": -3.24472433131074, - "velocityY": 1.1936884018033496, - "timestamp": 1.4192726125872035 + "x": 8.251549516655441, + "y": 0.7219586831033024, + "heading": -0.0006660755390764362, + "angularVelocity": -0.009331396835267377, + "velocityX": -0.2707537344882418, + "velocityY": 0.027440204960520992, + "timestamp": 0.0713800463998111 + }, + { + "x": 8.212896688696702, + "y": 0.7258760442658929, + "heading": -0.001998229790486319, + "angularVelocity": -0.018662838126333965, + "velocityX": -0.5415074647365562, + "velocityY": 0.054880339256839474, + "timestamp": 0.1427600927996222 + }, + { + "x": 8.154917446658368, + "y": 0.7317520758923975, + "heading": -0.003996392789209819, + "angularVelocity": -0.027993299241239875, + "velocityX": -0.812261198508941, + "velocityY": 0.08232036714563006, + "timestamp": 0.2141401391994333 + }, + { + "x": 8.077611789765818, + "y": 0.7395867678254814, + "heading": -0.006660425114458462, + "angularVelocity": -0.03732180713818774, + "velocityX": -1.0830149431334009, + "velocityY": 0.10976025273506382, + "timestamp": 0.2855201855992444 + }, + { + "x": 7.980979716767329, + "y": 0.749380107333022, + "heading": -0.00999012297038977, + "angularVelocity": -0.04664745995374023, + "velocityX": -1.353768705293865, + "velocityY": 0.13719995995360584, + "timestamp": 0.3569002319990555 + }, + { + "x": 7.86502122600115, + "y": 0.7611320790926304, + "heading": -0.013985224659649345, + "angularVelocity": -0.0559694465156602, + "velocityX": -1.6245224907346907, + "velocityY": 0.1646394525128738, + "timestamp": 0.4282802783988666 + }, + { + "x": 7.729736315496098, + "y": 0.7748426651724982, + "heading": -0.018645418435560536, + "angularVelocity": -0.06528706565709827, + "velocityX": -1.8952763037908287, + "velocityY": 0.1920786938561615, + "timestamp": 0.4996603247986777 + }, + { + "x": 7.575124983133034, + "y": 0.790511845006039, + "heading": -0.023970351697693893, + "angularVelocity": -0.07459974503669481, + "velocityX": -2.1660301465350793, + "velocityY": 0.21951764707149618, + "timestamp": 0.5710403711984888 + }, + { + "x": 7.401187226935479, + "y": 0.8081395953535565, + "heading": -0.029959641438283554, + "angularVelocity": -0.08390705866234215, + "velocityX": -2.4367840169688693, + "velocityY": 0.24695627470990408, + "timestamp": 0.6424204175983004 + }, + { + "x": 7.207923045694123, + "y": 0.8277258902299445, + "heading": -0.03661288565920585, + "angularVelocity": -0.09320874048829283, + "velocityX": -2.7075379043444587, + "velocityY": 0.2743945383095141, + "timestamp": 0.7138004639981119 + }, + { + "x": 6.995332440744312, + "y": 0.8492707007132015, + "heading": -0.04392967465186433, + "angularVelocity": -0.10250468249454428, + "velocityX": -2.9782917730125558, + "velocityY": 0.3018323967258469, + "timestamp": 0.7851805103979235 + }, + { + "x": 6.763415424631655, + "y": 0.872773994034365, + "heading": -0.05190959463777978, + "angularVelocity": -0.11179482766400335, + "velocityX": -3.249045465922667, + "velocityY": 0.32926979606482365, + "timestamp": 0.856560556797735 + }, + { + "x": 6.517888285888531, + "y": 0.8976525425650798, + "heading": -0.051909598739256456, + "angularVelocity": -5.745970870698805e-8, + "velocityX": -3.439716715339282, + "velocityY": 0.348536457812958, + "timestamp": 0.9279406031975466 + }, + { + "x": 6.272361147029228, + "y": 0.9225310899511409, + "heading": -0.051909602840455864, + "angularVelocity": -5.7455824331798554e-8, + "velocityX": -3.439716716966896, + "velocityY": 0.3485364417769111, + "timestamp": 0.9993206495973581 + }, + { + "x": 6.026834008173439, + "y": 0.94740963737188, + "heading": -0.051909606941655285, + "angularVelocity": -5.7455824691381894e-8, + "velocityX": -3.4397167169176694, + "velocityY": 0.34853644226273583, + "timestamp": 1.0707006959971697 + }, + { + "x": 5.7813069462957465, + "y": 0.9722889444800497, + "heading": -0.05190961104285578, + "angularVelocity": -5.745583959865336e-8, + "velocityX": -3.4397156384916827, + "velocityY": 0.348547085116991, + "timestamp": 1.1420807423969812 + }, + { + "x": 5.537158225945976, + "y": 1.0082600487060158, + "heading": -0.05190961517853181, + "angularVelocity": -5.793882502411163e-8, + "velocityX": -3.42040573891272, + "velocityY": 0.5039378095173286, + "timestamp": 1.2134607887967928 + }, + { + "x": 5.296595540867912, + "y": 1.0633246680240616, + "heading": -0.051909619464878404, + "angularVelocity": -6.004964723504615e-8, + "velocityX": -3.3701671154797745, + "velocityY": 0.7714287408783704, + "timestamp": 1.2848408351966043 + }, + { + "x": 5.061109922350585, + "y": 1.137142081975634, + "heading": -0.05190979783691868, + "angularVelocity": -0.0000024989061968370985, + "velocityX": -3.299039863302041, + "velocityY": 1.0341463430565587, + "timestamp": 1.3562208815964159 + }, + { + "x": 4.843667300844079, + "y": 1.2172452033533754, + "heading": -0.059561850749452576, + "angularVelocity": -0.10720156820399783, + "velocityX": -3.0462661832492475, + "velocityY": 1.1222060704341816, + "timestamp": 1.4276009279962274 }, { "x": 4.645580768585205, "y": 1.29859459400177, - "heading": -0.38936117353879, - "angularVelocity": -7.996524018828314e-7, - "velocityX": -3.1414333907396923, - "velocityY": 1.4437880757988777, - "timestamp": 1.4902362432165637 - }, - { - "x": 4.461481911069297, - "y": 1.3986076661601012, - "heading": -0.38936122478670326, - "angularVelocity": -8.456865275865798e-7, - "velocityX": -3.0379758656861, - "velocityY": 1.6504029605065766, - "timestamp": 1.5508354269017612 - }, - { - "x": 4.284474827324454, - "y": 1.510694673133237, - "heading": -0.38936127163806794, - "angularVelocity": -7.731352441209964e-7, - "velocityX": -2.9209483194421555, - "velocityY": 1.8496454928404518, - "timestamp": 1.6114346105869588 - }, - { - "x": 4.115350163635107, - "y": 1.6343549075731951, - "heading": -0.3893613156320879, - "angularVelocity": -7.259837067576087e-7, - "velocityX": -2.790873629056165, - "velocityY": 2.0406254163810633, - "timestamp": 1.6720337942721564 - }, - { - "x": 3.9548633143870395, - "y": 1.769035927298024, - "heading": -0.3893613579702014, - "angularVelocity": -6.986581485390433e-7, - "velocityX": -2.648333516863359, - "velocityY": 2.2224890094968055, - "timestamp": 1.732632977957354 - }, - { - "x": 3.8037308739642373, - "y": 1.9141358636408468, - "heading": -0.38936139966415195, - "angularVelocity": -6.880282549201409e-7, - "velocityX": -2.493968255544679, - "velocityY": 2.3944206426375816, - "timestamp": 1.7932321616425515 - }, - { - "x": 3.661588245211325, - "y": 2.068052981661263, - "heading": -0.38936144155211244, - "angularVelocity": -6.91229781197439e-7, - "velocityX": -2.345619529981126, - "velocityY": 2.539920650086488, - "timestamp": 1.853831345327749 - }, - { - "x": 3.5194491358842597, - "y": 2.221973349800809, - "heading": -0.38936148344023264, - "angularVelocity": -6.91232416307412e-7, - "velocityX": -2.345561452864688, - "velocityY": 2.5399742831378225, - "timestamp": 1.9144305290129466 - }, - { - "x": 3.377309938767793, - "y": 2.375893636870205, - "heading": -0.3893615253289459, - "angularVelocity": -6.912422042008341e-7, - "velocityX": -2.3455629015541897, - "velocityY": 2.539972945328553, - "timestamp": 1.9750297126981442 - }, - { - "x": 3.237376278676051, - "y": 2.5255432272973435, - "heading": -0.4037390696912898, - "angularVelocity": -0.23725640327158354, - "velocityX": -2.3091674108792377, - "velocityY": 2.46949845404756, - "timestamp": 2.0356288963833418 - }, - { - "x": 3.105303617904582, - "y": 2.668822904326165, - "heading": -0.44298006467609385, - "angularVelocity": -0.6475498942139972, - "velocityX": -2.1794462027337684, - "velocityY": 2.3643829556044245, - "timestamp": 2.0962280800685393 - }, - { - "x": 2.9827030369168717, - "y": 2.801822488594932, - "heading": -0.4839708463152926, - "angularVelocity": -0.6764246504068283, - "velocityX": -2.0231391502664464, - "velocityY": 2.194742176060946, - "timestamp": 2.156827263753737 - }, - { - "x": 2.869593703886996, - "y": 2.924535645165437, - "heading": -0.5240655796457002, - "angularVelocity": -0.6616381755023828, - "velocityX": -1.866515787035351, - "velocityY": 2.0249968581751787, - "timestamp": 2.2174264474389345 - }, - { - "x": 2.7659536958829163, - "y": 3.0369758685439536, - "heading": -0.5621961207653314, - "angularVelocity": -0.6292253261646749, - "velocityX": -1.7102541932325803, - "velocityY": 1.8554742249107699, - "timestamp": 2.278025631124132 - }, - { - "x": 2.6717655880666005, - "y": 3.13915624073865, - "heading": -0.5977862389011358, - "angularVelocity": -0.5873035901059204, - "velocityX": -1.5542801418845433, - "velocityY": 1.686167469276597, - "timestamp": 2.3386248148093296 - }, - { - "x": 2.587017347476756, - "y": 3.2310880524733365, - "heading": -0.6304747734177004, - "angularVelocity": -0.5394220273061133, - "velocityX": -1.3985046569289994, - "velocityY": 1.5170470317266471, - "timestamp": 2.399223998494527 - }, - { - "x": 2.5117006571972906, - "y": 3.3127809668412036, - "heading": -0.6600126072321035, - "angularVelocity": -0.48742956617777783, - "velocityX": -1.2428664166620311, - "velocityY": 1.3480860533080463, - "timestamp": 2.4598231821797247 - }, - { - "x": 2.4458096085005643, - "y": 3.3842432936093614, - "heading": -0.6862159260863127, - "angularVelocity": -0.43240382560813195, - "velocityX": -1.0873256814649452, - "velocityY": 1.1792622016064225, - "timestamp": 2.5204223658649223 - }, - { - "x": 2.3893398364344187, - "y": 3.445482204596666, - "heading": -0.7089422053012937, - "angularVelocity": -0.3750261609634924, - "velocityX": -0.9318569761516383, - "velocityY": 1.010556698344825, - "timestamp": 2.58102154955012 - }, - { - "x": 2.34228795390179, - "y": 3.4965038869924845, - "heading": -0.7280767545715167, - "angularVelocity": -0.3157558915252676, - "velocityX": -0.7764441642820773, - "velocityY": 0.8419532952930199, - "timestamp": 2.6416207332353174 - }, - { - "x": 2.304651173054735, - "y": 3.5373136514659973, - "heading": -0.7435246612107332, - "angularVelocity": -0.2549193850442921, - "velocityX": -0.621077357123682, - "velocityY": 0.6734375282266625, - "timestamp": 2.702219916920515 - }, - { - "x": 2.27642704429132, - "y": 3.567916009656823, - "heading": -0.7552056856738262, - "angularVelocity": -0.19275877582400947, - "velocityX": -0.4657509729839714, - "velocityY": 0.504996211661866, - "timestamp": 2.7628191006057126 - }, - { - "x": 2.257613270327787, - "y": 3.5883147313045463, - "heading": -0.7630508468581061, - "angularVelocity": -0.12945984924539836, - "velocityX": -0.31046249832782574, - "velocityY": 0.33661710285886326, - "timestamp": 2.82341828429091 + "heading": -0.06951316932259947, + "angularVelocity": -0.13941317041751372, + "velocityX": -2.7750967146947323, + "velocityY": 1.13966570143067, + "timestamp": 1.498980974396039 + }, + { + "x": 4.474092871614693, + "y": 1.385887514867849, + "heading": -0.08242444337490663, + "angularVelocity": -0.2012909785735536, + "velocityX": -2.6735523121009726, + "velocityY": 1.3609251412750347, + "timestamp": 1.5631233127353061 + }, + { + "x": 4.3102265492062894, + "y": 1.4867635843508433, + "heading": -0.10022801616986421, + "angularVelocity": -0.27756351352189995, + "velocityX": -2.554729475898846, + "velocityY": 1.5726908637073918, + "timestamp": 1.6272656510745733 + }, + { + "x": 4.155003391680842, + "y": 1.6004909974861876, + "heading": -0.12448541502532746, + "angularVelocity": -0.37818076926286603, + "velocityX": -2.419979713000573, + "velocityY": 1.7730475077757013, + "timestamp": 1.6914079894138405 + }, + { + "x": 4.00926290540325, + "y": 1.7261407641347544, + "heading": -0.1583340022250027, + "angularVelocity": -0.5277105274934034, + "velocityX": -2.2721417717378642, + "velocityY": 1.958920892218929, + "timestamp": 1.7555503277531077 + }, + { + "x": 3.8730404280351673, + "y": 1.8620509915016963, + "heading": -0.21028223642363456, + "angularVelocity": -0.8098899345368795, + "velocityX": -2.1237529047906247, + "velocityY": 2.1188848253095043, + "timestamp": 1.819692666092375 + }, + { + "x": 3.741564544573194, + "y": 2.0025580918468195, + "heading": -0.2996033949603487, + "angularVelocity": -1.3925460288689253, + "velocityX": -2.049751955822999, + "velocityY": 2.1905515761202894, + "timestamp": 1.883835004431642 + }, + { + "x": 3.6100546633718698, + "y": 2.1430333719703096, + "heading": -0.3901784541639511, + "angularVelocity": -1.4120947497193557, + "velocityX": -2.050281991681201, + "velocityY": 2.1900554884743153, + "timestamp": 1.9479773427709093 + }, + { + "x": 3.4785072023626884, + "y": 2.2834734612659138, + "heading": -0.4827580204171881, + "angularVelocity": -1.4433456691827582, + "velocityX": -2.0508678731571766, + "velocityY": 2.1895068519762364, + "timestamp": 2.0121196811101765 + }, + { + "x": 3.346919123497923, + "y": 2.423875493587476, + "heading": -0.5782456610362502, + "angularVelocity": -1.488683498159982, + "velocityX": -2.051501118789228, + "velocityY": 2.188913531323639, + "timestamp": 2.0762620194494437 + }, + { + "x": 3.2152861692168586, + "y": 2.5642354541414827, + "heading": -0.6777971832870476, + "angularVelocity": -1.552040739834588, + "velocityX": -2.052200741183146, + "velocityY": 2.1882576187291725, + "timestamp": 2.140404357788711 + }, + { + "x": 3.0838454699327147, + "y": 2.704775469009889, + "heading": -0.7323199293584344, + "angularVelocity": -0.8500274153243377, + "velocityX": -2.049203423001438, + "velocityY": 2.1910647242863015, + "timestamp": 2.204546696127978 + }, + { + "x": 2.9552905266702094, + "y": 2.842272453022611, + "heading": -0.7381340958895165, + "angularVelocity": -0.0906447548003214, + "velocityX": -2.0042135442980085, + "velocityY": 2.143622879562956, + "timestamp": 2.2686890344672452 + }, + { + "x": 2.837445531451434, + "y": 2.968312162646033, + "heading": -0.7431823028036986, + "angularVelocity": -0.07870319425338904, + "velocityX": -1.837241957027799, + "velocityY": 1.965000230530428, + "timestamp": 2.3328313728065124 + }, + { + "x": 2.7303126070394907, + "y": 3.082893932918914, + "heading": -0.747653667364265, + "angularVelocity": -0.06971003359615609, + "velocityX": -1.6702372751876633, + "velocityY": 1.7863672145350264, + "timestamp": 2.3969737111457796 + }, + { + "x": 2.6338923756777755, + "y": 3.1860176221630003, + "heading": -0.751611677644213, + "angularVelocity": -0.061706672728596555, + "velocityX": -1.5032228923697837, + "velocityY": 1.6077319897293985, + "timestamp": 2.461116049485047 + }, + { + "x": 2.5481851332942993, + "y": 3.277683175661144, + "heading": -0.7550881872685589, + "angularVelocity": -0.05419992027664412, + "velocityX": -1.3362038959375901, + "velocityY": 1.4290959118655384, + "timestamp": 2.525258387824314 + }, + { + "x": 2.473191052958317, + "y": 3.3578905661578986, + "heading": -0.7581023488644949, + "angularVelocity": -0.04699176353679586, + "velocityX": -1.1691822012991828, + "velocityY": 1.2504594090803822, + "timestamp": 2.589400726163581 + }, + { + "x": 2.4089102482733002, + "y": 3.4266397779362934, + "heading": -0.7606669459018931, + "angularVelocity": -0.039982905266614695, + "velocityX": -1.0021587355455739, + "velocityY": 1.0718226612625237, + "timestamp": 2.6535430645028484 + }, + { + "x": 2.3553427994564915, + "y": 3.4839308009572485, + "heading": -0.7627911121209714, + "angularVelocity": -0.03311644498900487, + "velocityX": -0.8351340191789587, + "velocityY": 0.893185756932122, + "timestamp": 2.7176854028421156 + }, + { + "x": 2.312488766021362, + "y": 3.5297636282468714, + "heading": -0.7644816934670975, + "angularVelocity": -0.026356715235171243, + "velocityX": -0.6681083749778789, + "velocityY": 0.714548743876462, + "timestamp": 2.7818277411813828 + }, + { + "x": 2.280348193682581, + "y": 3.5641382545710476, + "heading": -0.7657440057178361, + "angularVelocity": -0.019679860189406772, + "velocityX": -0.501082018070189, + "velocityY": 0.5359116492192578, + "timestamp": 2.84597007952065 + }, + { + "x": 2.2589211184357674, + "y": 3.587054675697436, + "heading": -0.7665822895031111, + "angularVelocity": -0.013069117948915103, + "velocityX": -0.3340550999790392, + "velocityY": 0.35727448857846106, + "timestamp": 2.910112417859917 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.06516842144952234, - "velocityX": -0.15521168163475207, - "velocityY": 0.1682886803086901, - "timestamp": 2.8840174679761077 + "angularVelocity": -0.006512243047323657, + "velocityX": -0.1670277322411552, + "velocityY": 0.17863727070052132, + "timestamp": 2.9742547561991843 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -1.08140020207294e-26, - "velocityX": -4.402093490094888e-26, - "velocityY": -5.469457631744455e-26, - "timestamp": 2.9446166516613053 + "angularVelocity": 1.4318885213105956e-25, + "velocityX": -3.1664598929952935e-25, + "velocityY": -8.517319099705152e-26, + "timestamp": 3.0383970945384515 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceSourceSideLower.3.traj b/src/main/deploy/choreo/3PieceSourceSideLower.3.traj index bb8e286..6bd0e7b 100644 --- a/src/main/deploy/choreo/3PieceSourceSideLower.3.traj +++ b/src/main/deploy/choreo/3PieceSourceSideLower.3.traj @@ -4,487 +4,505 @@ "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -1.08140020207294e-26, - "velocityX": -4.402093490094888e-26, - "velocityY": -5.469457631744455e-26, + "angularVelocity": 1.4318885213105956e-25, + "velocityX": -3.1664598929952935e-25, + "velocityY": -8.517319099705152e-26, "timestamp": 0 }, { - "x": 2.252899820442669, - "y": 3.5841608935822804, - "heading": -0.7653000327270449, - "angularVelocity": 0.026996951430568503, - "velocityX": 0.07451701159836764, - "velocityY": -0.2279220907181283, - "timestamp": 0.06296886066292107 - }, - { - "x": 2.2625314508292247, - "y": 3.5555407678837927, - "heading": -0.7618779142230176, - "angularVelocity": 0.05434620331382998, - "velocityX": 0.15295862566284854, - "velocityY": -0.4545123636855086, - "timestamp": 0.12593772132584213 - }, - { - "x": 2.2773902485258666, - "y": 3.5127562657015337, - "heading": -0.7567066671704831, - "angularVelocity": 0.08212387834388286, - "velocityX": 0.23597056608952433, - "velocityY": -0.6794549199689205, - "timestamp": 0.1889065819887632 - }, - { - "x": 2.297815121315827, - "y": 3.4559381539319545, - "heading": -0.7497538991928868, - "angularVelocity": 0.11041597234568314, - "velocityX": 0.32436465540161463, - "velocityY": -0.9023207847722199, - "timestamp": 0.25187544265168427 - }, - { - "x": 2.324210222453492, - "y": 3.3852548429790676, - "heading": -0.740981041700234, - "angularVelocity": 0.13932056893350495, - "velocityX": 0.4191770481438562, - "velocityY": -1.1225121466189798, - "timestamp": 0.31484430331460533 - }, - { - "x": 2.3570643106323765, - "y": 3.300928786576667, - "heading": -0.7303424220044314, - "angularVelocity": 0.16895048733297416, - "velocityX": 0.5217513519063973, - "velocityY": -1.33917075066368, - "timestamp": 0.3778131639775264 - }, - { - "x": 2.396977578495247, - "y": 3.2032627196422863, - "heading": -0.7177841287199045, - "angularVelocity": 0.19943656518978173, - "velocityX": 0.6338572342372608, - "velocityY": -1.551021662233946, - "timestamp": 0.44078202464044747 - }, - { - "x": 2.4446988674908763, - "y": 3.0926833438789934, - "heading": -0.7032425794761846, - "angularVelocity": 0.2309323861132317, - "velocityX": 0.7578553668151423, - "velocityY": -1.756096181495744, - "timestamp": 0.5037508853033685 - }, - { - "x": 2.5011759621015535, - "y": 2.969817102943244, - "heading": -0.6866424992704774, - "angularVelocity": 0.2636236392233503, - "velocityX": 0.8969051371757456, - "velocityY": -1.9512222333744542, - "timestamp": 0.5667197459662896 - }, - { - "x": 2.567616640888744, - "y": 2.8356262439165043, - "heading": -0.6678933195188701, - "angularVelocity": 0.2977531998232215, - "velocityX": 1.0551354762928686, - "velocityY": -2.131066968879719, - "timestamp": 0.6296886066292107 - }, - { - "x": 2.645534264440632, - "y": 2.691654750192989, - "heading": -0.646881125730223, - "angularVelocity": 0.33369182112294454, - "velocityX": 1.2373992911987053, - "velocityY": -2.28639191193581, - "timestamp": 0.6926574672921317 - }, - { - "x": 2.736669367471753, - "y": 2.540436142692156, - "heading": -0.6234515269375929, - "angularVelocity": 0.37208230458625247, - "velocityX": 1.4473043036140854, - "velocityY": -2.4014823503052147, - "timestamp": 0.7556263279550528 - }, - { - "x": 2.8425129383801573, - "y": 2.3859371382768275, - "heading": -0.5973967555496894, - "angularVelocity": 0.41377231719940855, - "velocityX": 1.6808875020781504, - "velocityY": -2.453577892132726, - "timestamp": 0.8185951886179739 - }, - { - "x": 2.963311384732838, - "y": 2.2333153163785404, - "heading": -0.5685648668222174, - "angularVelocity": 0.45787534384355805, - "velocityX": 1.9183838659449153, - "velocityY": -2.4237666092656225, - "timestamp": 0.8815640492808949 - }, - { - "x": 3.0976033560224936, - "y": 2.0874389211680247, - "heading": -0.5371913209271666, - "angularVelocity": 0.4982390591914446, - "velocityX": 2.1326727191164423, - "velocityY": -2.316643396033605, - "timestamp": 0.944532909943816 - }, - { - "x": 3.243098632839074, - "y": 1.9516892209576022, - "heading": -0.5039062126583729, - "angularVelocity": 0.5285963239349766, - "velocityX": 2.3105909061215564, - "velocityY": -2.155822715883417, - "timestamp": 1.007501770606737 - }, - { - "x": 3.3976251134783033, - "y": 1.8280561952151033, - "heading": -0.46938250382851276, - "angularVelocity": 0.5482663727182444, - "velocityX": 2.454014238345947, - "velocityY": -1.9633994396741585, - "timestamp": 1.0704706312696581 - }, - { - "x": 3.5594390798942475, - "y": 1.7176676369691386, - "heading": -0.4341632224479872, - "angularVelocity": 0.5593126667648981, - "velocityX": 2.569745819003335, - "velocityY": -1.7530658341888512, - "timestamp": 1.1334394919325792 - }, - { - "x": 3.7272023835124437, - "y": 1.6211781420495261, - "heading": -0.39865477290597295, - "angularVelocity": 0.5639049074128062, - "velocityX": 2.6642264422767874, - "velocityY": -1.53233668044482, - "timestamp": 1.1964083525955003 - }, - { - "x": 3.899888221446412, - "y": 1.5389840565105595, - "heading": -0.3631603025642866, - "angularVelocity": 0.5636829056141273, - "velocityX": 2.742400547127167, - "velocityY": -1.3053132083643786, - "timestamp": 1.2593772132584213 - }, - { - "x": 4.076696851523407, - "y": 1.4713359142845162, - "heading": -0.3279103897160568, - "angularVelocity": 0.5597991209802323, - "velocityX": 2.807874054184828, - "velocityY": -1.0743110406296095, - "timestamp": 1.3223460739213424 - }, - { - "x": 4.256993589599204, - "y": 1.4183982591672766, - "heading": -0.2930847973848664, - "angularVelocity": 0.5530605439665741, - "velocityX": 2.863268227782371, - "velocityY": -0.8406957750215746, - "timestamp": 1.3853149345842635 - }, - { - "x": 4.44026531147135, - "y": 1.3802827225820995, - "heading": -0.2588270299037879, - "angularVelocity": 0.5440429939563951, - "velocityX": 2.9105135449920296, - "velocityY": -0.6053077058073763, - "timestamp": 1.4482837952471845 + "x": 2.254662845986897, + "y": 3.5873395415687703, + "heading": -0.7560028105976356, + "angularVelocity": 0.18270874766778025, + "velocityX": 0.10724881682251722, + "velocityY": -0.18563544290641987, + "timestamp": 0.060189725684949735 + }, + { + "x": 2.267640389134434, + "y": 3.5649741905137224, + "heading": -0.7343324319976283, + "angularVelocity": 0.3600345134223772, + "velocityX": 0.2156106046315132, + "velocityY": -0.3715808769774839, + "timestamp": 0.12037945136989947 + }, + { + "x": 2.2872156815111926, + "y": 3.5313939684851823, + "heading": -0.7023698583511744, + "angularVelocity": 0.5310303923589071, + "velocityX": 0.3252264760138822, + "velocityY": -0.5579062148298977, + "timestamp": 0.1805691770548492 + }, + { + "x": 2.313473905100035, + "y": 3.486574818355693, + "heading": -0.6605397935243593, + "angularVelocity": 0.6949701855390652, + "velocityX": 0.4362575720362232, + "velocityY": -0.7446312409544028, + "timestamp": 0.24075890273979894 + }, + { + "x": 2.3465132166718874, + "y": 3.4304964860969096, + "heading": -0.6092924367494605, + "angularVelocity": 0.851430309603703, + "velocityX": 0.54891945752984, + "velocityY": -0.9316927701633545, + "timestamp": 0.3009486284247487 + }, + { + "x": 2.3864518087256505, + "y": 3.3631500739334586, + "heading": -0.5490846408400017, + "angularVelocity": 1.0003002210809777, + "velocityX": 0.6635450087081837, + "velocityY": -1.118902128179834, + "timestamp": 0.3611383541096984 + }, + { + "x": 2.4334407524616903, + "y": 3.284548274129898, + "heading": -0.48037214659109057, + "angularVelocity": 1.1415983951907667, + "velocityX": 0.7806804766313955, + "velocityY": -1.3059006152476056, + "timestamp": 0.42132807979464815 + }, + { + "x": 2.4876845583004745, + "y": 3.194738200368583, + "heading": -0.4036330691658326, + "angularVelocity": 1.2749531012474145, + "velocityX": 0.9012137075139995, + "velocityY": -1.4921163494149543, + "timestamp": 0.4815178054795979 + }, + { + "x": 2.549471334765238, + "y": 3.093817881877023, + "heading": -0.3194506455237171, + "angularVelocity": 1.3986178319328149, + "velocityX": 1.0265336112042236, + "velocityY": -1.6767034131340948, + "timestamp": 0.5417075311645476 + }, + { + "x": 2.619215453459605, + "y": 2.98196209624742, + "heading": -0.22869362474666396, + "angularVelocity": 1.5078490513829745, + "velocityX": 1.1587379390866084, + "velocityY": -1.858386699003879, + "timestamp": 0.6018972568494974 + }, + { + "x": 2.6975187688111633, + "y": 2.859476881700614, + "heading": -0.13286180386406954, + "angularVelocity": 1.592162446198965, + "velocityX": 1.3009415553980122, + "velocityY": -2.0349854257174798, + "timestamp": 0.6620869825344471 + }, + { + "x": 2.7852562883718943, + "y": 2.726945932671376, + "heading": -0.034753273861128454, + "angularVelocity": 1.6299879902505128, + "velocityX": 1.4576826619874292, + "velocityY": -2.201886576505485, + "timestamp": 0.7222767082193968 + }, + { + "x": 2.883617018333608, + "y": 2.5856822162797477, + "heading": 0.06025595074389153, + "angularVelocity": 1.5784957237108086, + "velocityX": 1.6341780734566165, + "velocityY": -2.3469739192871995, + "timestamp": 0.7824664339043466 + }, + { + "x": 2.993618091797967, + "y": 2.439544726598588, + "heading": 0.14260766445208392, + "angularVelocity": 1.3682021768838868, + "velocityX": 1.8275722677344666, + "velocityY": -2.427947428205354, + "timestamp": 0.8426561595892963 + }, + { + "x": 3.1145276346410644, + "y": 2.293581984129882, + "heading": 0.20384383077417081, + "angularVelocity": 1.017385702048459, + "velocityX": 2.008807009288801, + "velocityY": -2.425044155089132, + "timestamp": 0.902845885274246 + }, + { + "x": 3.2468175816396365, + "y": 2.1505705427004553, + "heading": 0.24757858696307516, + "angularVelocity": 0.7266149777426218, + "velocityX": 2.197882537146209, + "velocityY": -2.3760108523834984, + "timestamp": 0.9630356109591958 + }, + { + "x": 3.390280853000983, + "y": 2.013955912336661, + "heading": 0.2801226137384155, + "angularVelocity": 0.5406907309344624, + "velocityX": 2.3835176141568395, + "velocityY": -2.269733394016016, + "timestamp": 1.0232253366441455 + }, + { + "x": 3.544035674658465, + "y": 1.8860535950620219, + "heading": 0.3061151888137327, + "angularVelocity": 0.43184405277687576, + "velocityX": 2.55450278112711, + "velocityY": -2.1249858812136204, + "timestamp": 1.0834150623290952 + }, + { + "x": 3.7070451600522367, + "y": 1.7682529006317282, + "heading": 0.3281829520976596, + "angularVelocity": 0.36663671470170595, + "velocityX": 2.7082609787426026, + "velocityY": -1.9571561938476998, + "timestamp": 1.143604788014045 + }, + { + "x": 3.8782577243031593, + "y": 1.6615213018872745, + "heading": 0.34797198576359334, + "angularVelocity": 0.328777601837151, + "velocityX": 2.844548007198066, + "velocityY": -1.7732527857514622, + "timestamp": 1.2037945136989947 + }, + { + "x": 4.056668173911873, + "y": 1.5665668328609006, + "heading": 0.3664586508169338, + "angularVelocity": 0.30713987882425087, + "velocityX": 2.964134618964106, + "velocityY": -1.5775860073427241, + "timestamp": 1.2639842393839444 + }, + { + "x": 4.241342350555325, + "y": 1.4839195959237403, + "heading": 0.38411092010286374, + "angularVelocity": 0.2932771180637541, + "velocityX": 3.0682010017804235, + "velocityY": -1.3731120385854438, + "timestamp": 1.3241739650688942 + }, + { + "x": 4.431417064671585, + "y": 1.4139831463989663, + "heading": 0.40101516097721396, + "angularVelocity": 0.2808492758852529, + "velocityX": 3.1579262399560672, + "velocityY": -1.1619333487386434, + "timestamp": 1.384363690753844 }, { "x": 4.626090049743652, "y": 1.3570671081542969, - "heading": -0.2252540457724002, - "angularVelocity": 0.5331680417580931, - "velocityX": 2.9510576547834098, - "velocityY": -0.36868404769268887, - "timestamp": 1.5112526559101056 - }, - { - "x": 4.7795228983991676, - "y": 1.3480834353037912, - "heading": -0.19832188482827373, - "angularVelocity": 0.5230176690450782, - "velocityX": 2.9796380255277914, - "velocityY": -0.17446129345071068, - "timestamp": 1.5627464438605188 - }, - { - "x": 4.934335051267773, - "y": 1.3491130117158807, - "heading": -0.172056740336727, - "angularVelocity": 0.5100643308050932, - "velocityX": 3.006423862577084, - "velocityY": 0.01999418673726334, - "timestamp": 1.614240231810932 - }, - { - "x": 5.090413948118965, - "y": 1.360168884425071, - "heading": -0.14663402653796817, - "angularVelocity": 0.49370447991202765, - "velocityX": 3.0310238004143737, - "velocityY": 0.21470303796327495, - "timestamp": 1.665734019761345 - }, - { - "x": 5.247619566908618, - "y": 1.3812649191155169, - "heading": -0.12227147866608945, - "angularVelocity": 0.47311625035895943, - "velocityX": 3.0529045356119044, - "velocityY": 0.40968115825467694, - "timestamp": 1.7172278077117582 - }, - { - "x": 5.4057731675659, - "y": 1.4124150256360237, - "heading": -0.09924657329539176, - "angularVelocity": 0.44713947618050653, - "velocityX": 3.071314171130302, - "velocityY": 0.6049294052809526, - "timestamp": 1.7687215956621714 - }, - { - "x": 5.5646390861224075, - "y": 1.45363107671834, - "heading": -0.07792489052125452, - "angularVelocity": 0.4140632030152733, - "velocityX": 3.0851472552279695, - "velocityY": 0.800408218599227, - "timestamp": 1.8202153836125845 - }, - { - "x": 5.723893474298032, - "y": 1.5049174237552059, - "heading": -0.05880915750982748, - "angularVelocity": 0.3712240596833731, - "velocityX": 3.092691264604229, - "velocityY": 0.9959715351733922, - "timestamp": 1.8717091715629977 - }, - { - "x": 5.883066591645663, - "y": 1.5662557379507007, - "heading": -0.042630346143135614, - "angularVelocity": 0.3141895752992888, - "velocityX": 3.0911129999002838, - "velocityY": 1.1911789098631071, - "timestamp": 1.9232029595134108 - }, - { - "x": 6.041427156723219, - "y": 1.6375588012052558, - "heading": -0.030529304649750223, - "angularVelocity": 0.23500002573200407, - "velocityX": 3.0753333825442057, - "velocityY": 1.3846925249161675, - "timestamp": 1.974696747463824 - }, - { - "x": 6.197735616366119, - "y": 1.7185102905390748, - "heading": -0.02440648394476851, - "angularVelocity": 0.11890406491124374, - "velocityX": 3.03548186809291, - "velocityY": 1.5720632052117265, - "timestamp": 2.026190535414237 - }, - { - "x": 6.350878760533044, - "y": 1.8088430675496858, - "heading": -0.02370516902673881, - "angularVelocity": 0.013619408203277727, - "velocityX": 2.974012017030059, - "velocityY": 1.7542461062992514, - "timestamp": 2.0776843233646503 - }, - { - "x": 6.49883867677636, - "y": 1.9078525669236166, - "heading": -0.023705030592543242, - "angularVelocity": 0.00000268836690944849, - "velocityX": 2.87335467310732, - "velocityY": 1.9227464770949503, - "timestamp": 2.1291781113150634 - }, - { - "x": 6.6368843214415145, - "y": 2.005708147416312, - "heading": -0.02031833183947682, - "angularVelocity": 0.06576907405467476, - "velocityX": 2.6808213215560657, - "velocityY": 1.900337582213362, - "timestamp": 2.1806718992654766 - }, - { - "x": 6.769983495130022, - "y": 2.0947496708967734, - "heading": -0.01623761727675861, - "angularVelocity": 0.07924673490029181, - "velocityX": 2.5847617544989827, - "velocityY": 1.7291701975043279, - "timestamp": 2.2321656872158897 - }, - { - "x": 6.899277502176466, - "y": 2.174423732821602, - "heading": -0.012170511581318438, - "angularVelocity": 0.07898245317195698, - "velocityX": 2.5108661101209155, - "velocityY": 1.5472557971760095, - "timestamp": 2.283659475166303 - }, - { - "x": 7.025204876144901, - "y": 2.244564567879159, - "heading": -0.008393313807594099, - "angularVelocity": 0.07335249403989616, - "velocityX": 2.4454867078277336, - "velocityY": 1.3621222646331712, - "timestamp": 2.335153263116716 - }, - { - "x": 7.147995814523978, - "y": 2.305094760936356, - "heading": -0.0050511985797586055, - "angularVelocity": 0.06490327010034411, - "velocityX": 2.3845776989123575, - "velocityY": 1.1754853442804831, - "timestamp": 2.386647051067129 - }, - { - "x": 7.267791877830481, - "y": 2.3559698887494838, - "heading": -0.002233336230350155, - "angularVelocity": 0.05472237451480506, - "velocityX": 2.3264177694960773, - "velocityY": 0.987985732611455, - "timestamp": 2.4381408390175423 - }, - { - "x": 7.384688854217529, - "y": 2.3971612453460693, - "heading": 1.0925161153472216e-27, - "angularVelocity": 0.04337098355438129, - "velocityX": 2.2701180285982674, - "velocityY": 0.7999286561759968, - "timestamp": 2.4896346269679555 - }, - { - "x": 7.544023620191157, - "y": 2.435966203020954, - "heading": 0.0019011246470178535, - "angularVelocity": 0.026160817083458833, - "velocityX": 2.192558848895233, - "velocityY": 0.5339836087320412, - "timestamp": 2.5623053176789092 - }, - { - "x": 7.693524178473687, - "y": 2.4572035222971533, - "heading": 0.002758770210903803, - "angularVelocity": 0.011801808342475038, - "velocityX": 2.0572332094264283, - "velocityY": 0.2922405039559972, - "timestamp": 2.634976008389863 - }, - { - "x": 7.829036837050654, - "y": 2.463958358878795, - "heading": 0.0028691396117968893, - "angularVelocity": 0.0015187608623685705, - "velocityX": 1.8647498358859305, - "velocityY": 0.09295131937728546, - "timestamp": 2.707646699100817 - }, - { - "x": 7.947320999686337, - "y": 2.4602902191152674, - "heading": 0.0025271461142305205, - "angularVelocity": -0.0047060719283190024, - "velocityX": 1.627673570713082, - "velocityY": -0.05047619236368362, - "timestamp": 2.7803173898117706 - }, - { - "x": 8.046460357109755, - "y": 2.4503798577507845, - "heading": 0.001958139051774138, - "angularVelocity": -0.007829938822511021, - "velocityX": 1.3642275373127128, - "velocityY": -0.13637356776890003, - "timestamp": 2.8529880805227243 - }, - { - "x": 8.125632240809198, - "y": 2.437861956883479, - "heading": 0.0013192069681426308, - "angularVelocity": -0.008792156471621461, - "velocityX": 1.0894610044969755, - "velocityY": -0.17225515190292298, - "timestamp": 2.925658771233678 - }, - { - "x": 8.184669067426317, - "y": 2.4256259475095856, - "heading": 0.0007241468388369009, - "angularVelocity": -0.008188447412349163, - "velocityX": 0.8123884063788063, - "velocityY": -0.16837612597576837, - "timestamp": 2.998329461944632 - }, - { - "x": 8.22372517511611, - "y": 2.4158933838582373, - "heading": 0.00026082496046711366, - "angularVelocity": -0.006375636089832219, - "velocityX": 0.5374396102156157, - "velocityY": -0.13392694573469127, - "timestamp": 3.0710001526555857 + "heading": 0.41697492722531376, + "angularVelocity": 0.26515765052058465, + "velocityX": 3.2343225169531657, + "velocityY": -0.9456105273279376, + "timestamp": 1.4445534164387936 + }, + { + "x": 4.771095590246596, + "y": 1.3224217071642599, + "heading": 0.4280403505516019, + "angularVelocity": 0.2504578977864778, + "velocityX": 3.2820961088293013, + "velocityY": -0.7841737314576779, + "timestamp": 1.488734188632776 + }, + { + "x": 4.917956708237317, + "y": 1.2949736641198544, + "heading": 0.43814957517205777, + "angularVelocity": 0.22881502786030425, + "velocityX": 3.3240957705742336, + "velocityY": -0.6212667113171019, + "timestamp": 1.5329149608267585 + }, + { + "x": 5.066406183363406, + "y": 1.2747799857702726, + "heading": 0.4470279058701966, + "angularVelocity": 0.20095462929342126, + "velocityX": 3.3600470918502436, + "velocityY": -0.45706938441270734, + "timestamp": 1.577095733020741 + }, + { + "x": 5.21616079891639, + "y": 1.2618903010738838, + "heading": 0.45444388098508137, + "angularVelocity": 0.16785526251835975, + "velocityX": 3.389588006643782, + "velocityY": -0.2917487417330471, + "timestamp": 1.6212765052147233 + }, + { + "x": 5.366915459547734, + "y": 1.25634723736205, + "heading": 0.46022561365529296, + "angularVelocity": 0.13086536027088905, + "velocityX": 3.4122233076740254, + "velocityY": -0.12546326006925063, + "timestamp": 1.6654572774087057 + }, + { + "x": 5.518334246127743, + "y": 1.2581861921582334, + "heading": 0.4642859914379861, + "angularVelocity": 0.09190373053837578, + "velocityX": 3.427255320825579, + "velocityY": 0.041623419077170896, + "timestamp": 1.7096380496026882 + }, + { + "x": 5.670036777042452, + "y": 1.2674335281135962, + "heading": 0.46666317405037006, + "angularVelocity": 0.05380581855714505, + "velocityX": 3.4336776697481812, + "velocityY": 0.20930679787037068, + "timestamp": 1.7538188217966706 + }, + { + "x": 5.821577538212164, + "y": 1.284100828351401, + "heading": 0.4675873844825302, + "angularVelocity": 0.020918838360320994, + "velocityX": 3.4300161279288752, + "velocityY": 0.3772523523270378, + "timestamp": 1.797999593990653 + }, + { + "x": 5.972415606183977, + "y": 1.3081694677842932, + "heading": 0.467591351779606, + "angularVelocity": 0.00008979691569104718, + "velocityX": 3.414111172831806, + "velocityY": 0.544776341328194, + "timestamp": 1.8421803661846354 + }, + { + "x": 6.121903298527153, + "y": 1.3395574928087577, + "heading": 0.46759157023044867, + "angularVelocity": 0.000004944477695120892, + "velocityX": 3.3835463917839124, + "velocityY": 0.7104453694618647, + "timestamp": 1.8863611383786179 + }, + { + "x": 6.269684547080798, + "y": 1.3781901650520143, + "heading": 0.46759176450370754, + "angularVelocity": 0.0000043972354751028654, + "velocityX": 3.3449222640289906, + "velocityY": 0.8744227482859289, + "timestamp": 1.9305419105726003 + }, + { + "x": 6.415408472766336, + "y": 1.423975753200933, + "heading": 0.4675919413300162, + "angularVelocity": 0.000004002336308335113, + "velocityX": 3.2983562407129146, + "velocityY": 1.036323854818335, + "timestamp": 1.9747226827665827 + }, + { + "x": 6.5587290836787195, + "y": 1.476805540848842, + "heading": 0.4675921046539949, + "angularVelocity": 0.0000036967207824585226, + "velocityX": 3.243958939493236, + "velocityY": 1.1957642436839244, + "timestamp": 2.018903454960565 + }, + { + "x": 6.6993060573570675, + "y": 1.5365540678009835, + "heading": 0.46759241978399874, + "angularVelocity": 0.000007132740968196116, + "velocityX": 3.1818586841606873, + "velocityY": 1.352364931282918, + "timestamp": 2.0630842271545475 + }, + { + "x": 6.836206251960683, + "y": 1.6027005176579716, + "heading": 0.47022361687585157, + "angularVelocity": 0.059555253590862826, + "velocityX": 3.0986374344598233, + "velocityY": 1.4971773142977605, + "timestamp": 2.10726499934853 + }, + { + "x": 6.968107168767895, + "y": 1.6730618727776314, + "heading": 0.48242555808722076, + "angularVelocity": 0.27618216263388745, + "velocityX": 2.9854823774487342, + "velocityY": 1.592578663196003, + "timestamp": 2.1514457715425124 + }, + { + "x": 7.094292994493853, + "y": 1.7449092475770878, + "heading": 0.5050066138251464, + "angularVelocity": 0.5111059543907503, + "velocityX": 2.8561254016095394, + "velocityY": 1.6262136497750488, + "timestamp": 2.195626543736495 + }, + { + "x": 7.213566146886095, + "y": 1.8140035101921348, + "heading": 0.5272178489693323, + "angularVelocity": 0.5027353312582225, + "velocityX": 2.699662012890034, + "velocityY": 1.5638989357559931, + "timestamp": 2.239807315930477 + }, + { + "x": 7.326317415042033, + "y": 1.87970672983894, + "heading": 0.5469886414915726, + "angularVelocity": 0.44749766788668743, + "velocityX": 2.552043854301269, + "velocityY": 1.4871451172995578, + "timestamp": 2.2839880881244596 + }, + { + "x": 7.432769298553467, + "y": 1.941792130470276, + "heading": 0.5633166974965059, + "angularVelocity": 0.3695738031296167, + "velocityX": 2.409461813932093, + "velocityY": 1.405258386130975, + "timestamp": 2.328168860318442 + }, + { + "x": 7.579701459580911, + "y": 2.027179132105106, + "heading": 0.5787605568170214, + "angularVelocity": 0.23108320735340232, + "velocityX": 2.198514913204677, + "velocityY": 1.2776276832472448, + "timestamp": 2.395001320787527 + }, + { + "x": 7.712165331896003, + "y": 2.1039708729412734, + "heading": 0.5887351557050889, + "angularVelocity": 0.14924781787259772, + "velocityX": 1.9820289629523165, + "velocityY": 1.1490186100763133, + "timestamp": 2.461833781256612 + }, + { + "x": 7.830026910442582, + "y": 2.172172632129026, + "heading": 0.5950957258261598, + "angularVelocity": 0.09517186822731284, + "velocityX": 1.7635379233284407, + "velocityY": 1.0204885277162767, + "timestamp": 2.5286662417256967 + }, + { + "x": 7.933222174835435, + "y": 2.231800820984951, + "heading": 0.5989654042474855, + "angularVelocity": 0.05790118146429404, + "velocityX": 1.54408896019307, + "velocityY": 0.8922040044224955, + "timestamp": 2.5954987021947815 + }, + { + "x": 8.021715394731531, + "y": 2.28287256797719, + "heading": 0.6011062262493081, + "angularVelocity": 0.032032667760495764, + "velocityX": 1.3241053714763598, + "velocityY": 0.7641757707822818, + "timestamp": 2.6623311626638664 + }, + { + "x": 8.095484569673351, + "y": 2.3254034695687893, + "heading": 0.6020727831826357, + "angularVelocity": 0.014462387386960431, + "velocityX": 1.103792594557322, + "velocityY": 0.6363809037267617, + "timestamp": 2.7291636231329512 + }, + { + "x": 8.154515205691396, + "y": 2.359407222237499, + "heading": 0.6022883195935687, + "angularVelocity": 0.003225025824578962, + "velocityX": 0.8832629474318238, + "velocityY": 0.5087909741769772, + "timestamp": 2.795996083602036 + }, + { + "x": 8.198797270954351, + "y": 2.3848957424596233, + "heading": 0.6020871548762373, + "angularVelocity": -0.00300998520658142, + "velocityX": 0.6625831961317433, + "velocityY": 0.38137934834697124, + "timestamp": 2.862828544071121 + }, + { + "x": 8.22832355571237, + "y": 2.401879399345903, + "heading": 0.6017403922656039, + "angularVelocity": -0.005188535753427844, + "velocityX": 0.44179556686643673, + "velocityY": 0.2541228733324269, + "timestamp": 2.929661004540206 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.641597245625212e-27, - "angularVelocity": -0.003589135563669573, - "velocityX": 0.2664560763556175, - "velocityY": -0.07604349651378031, - "timestamp": 3.1436708433665395 + "heading": 0.601472494720935, + "angularVelocity": -0.004008494417063559, + "velocityX": 0.220928070177263, + "velocityY": 0.12700192446944059, + "timestamp": 2.9964934650092907 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.361709629410748e-27, - "angularVelocity": -2.7031559762411205e-27, - "velocityX": -9.369534952913017e-27, - "velocityY": 1.2495007628787807e-26, - "timestamp": 3.2163415340774932 + "heading": 0.601472494720935, + "angularVelocity": 2.0480668095758719e-22, + "velocityX": 1.6959236187935907e-23, + "velocityY": -2.878465592599261e-23, + "timestamp": 3.0633259254783756 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceSourceSideLower.4.traj b/src/main/deploy/choreo/3PieceSourceSideLower.4.traj index abed856..cbec533 100644 --- a/src/main/deploy/choreo/3PieceSourceSideLower.4.traj +++ b/src/main/deploy/choreo/3PieceSourceSideLower.4.traj @@ -3,416 +3,434 @@ { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.361709629410748e-27, - "angularVelocity": -2.7031559762411205e-27, - "velocityX": -9.369534952913017e-27, - "velocityY": 1.2495007628787807e-26, + "heading": 0.601472494720935, + "angularVelocity": 2.0480668095758719e-22, + "velocityX": 1.6959236187935907e-23, + "velocityY": -2.878465592599261e-23, "timestamp": 0 }, { - "x": 8.226158676304896, - "y": 2.39881983179468, - "heading": -0.006877427807321125, - "angularVelocity": -0.09330877742815909, - "velocityX": -0.22969661496110166, - "velocityY": -0.156668386301737, - "timestamp": 0.07370611851190745 - }, - { - "x": 8.192214379382103, - "y": 2.375824029071353, - "heading": -0.02042318457451623, - "angularVelocity": -0.1837806282663857, - "velocityX": -0.46053567340288404, - "velocityY": -0.31199313147403995, - "timestamp": 0.1474122370238149 - }, - { - "x": 8.141157712275694, - "y": 2.3414994370245448, - "heading": -0.04041111919819324, - "angularVelocity": -0.2711841978281327, - "velocityX": -0.6927059535519965, - "velocityY": -0.4656952874443208, - "timestamp": 0.22111835553572234 - }, - { - "x": 8.072871873312724, - "y": 2.2959933778891304, - "heading": -0.06658143602528521, - "angularVelocity": -0.3550630172292133, - "velocityX": -0.9264609280969917, - "velocityY": -0.6173986645092744, - "timestamp": 0.2948244740476298 - }, - { - "x": 7.987214671186942, - "y": 2.2394915863103373, - "heading": -0.09861576889513941, - "angularVelocity": -0.4346224372767477, - "velocityX": -1.162145068213624, - "velocityY": -0.7665821063371371, - "timestamp": 0.36853059255953724 - }, - { - "x": 7.884008802473217, - "y": 2.172234906435376, - "heading": -0.13609803770657058, - "angularVelocity": -0.5085367343740341, - "velocityX": -1.4002347538766595, - "velocityY": -0.912497920564022, - "timestamp": 0.4422367110714447 - }, - { - "x": 7.763027309866044, - "y": 2.094546996792591, - "heading": -0.17845040239942064, - "angularVelocity": -0.5746112473146674, - "velocityX": -1.641403658878437, - "velocityY": -1.0540225317961092, - "timestamp": 0.5159428295833521 - }, - { - "x": 7.62397118691996, - "y": 2.006883956661221, - "heading": -0.2248232665285972, - "angularVelocity": -0.629158949968104, - "velocityX": -1.886629302336939, - "velocityY": -1.1893590640946199, - "timestamp": 0.5896489480952596 - }, - { - "x": 7.466434514515364, - "y": 1.9099324511701785, - "heading": -0.27389375566621527, - "angularVelocity": -0.6657586931496106, - "velocityX": -2.1373622106982135, - "velocityY": -1.3153793395778879, - "timestamp": 0.663355066607167 - }, - { - "x": 7.289854840689643, - "y": 1.804830584603728, - "heading": -0.3234648033769676, - "angularVelocity": -0.6725499688705452, - "velocityX": -2.3957261268234205, - "velocityY": -1.4259585050523371, - "timestamp": 0.7370611851190745 - }, - { - "x": 7.09349466770107, - "y": 1.6937580255692442, - "heading": -0.36961157284527874, - "angularVelocity": -0.6260914344696605, - "velocityX": -2.6640959658844117, - "velocityY": -1.5069652462643142, - "timestamp": 0.8107673036309819 - }, - { - "x": 6.877068006621772, - "y": 1.582017096134685, - "heading": -0.404526427119755, - "angularVelocity": -0.47370360805033435, - "velocityX": -2.9363459296032848, - "velocityY": -1.5160332912729142, - "timestamp": 0.8844734221428894 - }, - { - "x": 6.6462528315178435, - "y": 1.4799569127662018, - "heading": -0.41206265680654897, - "angularVelocity": -0.10224700254126708, - "velocityX": -3.1315605781986564, - "velocityY": -1.3846907886214979, - "timestamp": 0.9581795406547968 - }, - { - "x": 6.4056948947586605, - "y": 1.3958836435808737, - "heading": -0.41206291975932646, - "angularVelocity": -0.000003567584113860408, - "velocityX": -3.263744470824617, - "velocityY": -1.1406552248677344, - "timestamp": 1.0318856591667043 - }, - { - "x": 6.159103024623084, - "y": 1.3316270436788393, - "heading": -0.4120630054756099, - "angularVelocity": -0.000001162946648180674, - "velocityX": -3.3456092264000836, - "velocityY": -0.8717946515071634, - "timestamp": 1.1055917776786117 - }, - { - "x": 5.9081067866465835, - "y": 1.287611751699688, - "heading": -0.4120631078550631, - "angularVelocity": -0.0000013890224484364198, - "velocityX": -3.405365023202921, - "velocityY": -0.5971728381279531, - "timestamp": 1.1792978961905192 - }, - { - "x": 5.654364802463367, - "y": 1.264128631365538, - "heading": -0.41206324014800777, - "angularVelocity": -0.0000017948705930666049, - "velocityX": -3.4426176456737716, - "velocityY": -0.3186047618333884, - "timestamp": 1.2530040147024266 - }, - { - "x": 5.399553844443695, - "y": 1.2613328653452982, - "heading": -0.41206343250085, - "angularVelocity": -0.0000026097269279134345, - "velocityX": -3.457120835612934, - "velocityY": -0.03793126102262585, - "timestamp": 1.326710133214334 - }, - { - "x": 5.145357769299496, - "y": 1.2792429283311064, - "heading": -0.4120637802864744, - "angularVelocity": -0.000004718544828723013, - "velocityX": -3.4487784769609244, - "velocityY": 0.24299289322791767, - "timestamp": 1.4004162517262415 - }, - { - "x": 4.893457071523925, - "y": 1.3177403844081093, - "heading": -0.41206670780497134, - "angularVelocity": -0.00003971879887349745, - "velocityX": -3.4176361862668707, - "velocityY": 0.5223101806776501, - "timestamp": 1.474122370238149 + "x": 8.225716112229817, + "y": 2.403169142964958, + "heading": 0.6014724848808553, + "angularVelocity": -1.401208853680834e-7, + "velocityX": -0.24738269796567666, + "velocityY": -0.10249969625322676, + "timestamp": 0.07022564691083488 + }, + { + "x": 8.190970892472077, + "y": 2.3887729281095678, + "heading": 0.6014724652007141, + "angularVelocity": -2.802415057039817e-7, + "velocityX": -0.49476539250476237, + "velocityY": -0.20499939108669155, + "timestamp": 0.14045129382166976 + }, + { + "x": 8.138853063244545, + "y": 2.3671786059959783, + "heading": 0.6014724356805342, + "angularVelocity": -4.203618073354203e-7, + "velocityX": -0.7421480829319401, + "velocityY": -0.30749908421644245, + "timestamp": 0.21067694073250465 + }, + { + "x": 8.069362624900151, + "y": 2.3383861767704226, + "heading": 0.6014723963203429, + "angularVelocity": -5.604817189302354e-7, + "velocityX": -0.9895307683334543, + "velocityY": -0.40999877526387724, + "timestamp": 0.28090258764333953 + }, + { + "x": 7.982499577880061, + "y": 2.3023956406156896, + "heading": 0.6014723471201746, + "angularVelocity": -7.006011425140131e-7, + "velocityX": -1.2369134474528922, + "velocityY": -0.5124984637084178, + "timestamp": 0.3511282345541744 + }, + { + "x": 7.878263922751481, + "y": 2.259206997766796, + "heading": 0.601472288080073, + "angularVelocity": -8.407199383581404e-7, + "velocityX": -1.484296118495379, + "velocityY": -0.6149981488063821, + "timestamp": 0.4213538814650093 + }, + { + "x": 7.756655660270691, + "y": 2.2088202485370934, + "heading": 0.6014722192000971, + "angularVelocity": -9.808378971745156e-7, + "velocityX": -1.7316787787686057, + "velocityY": -0.7174978294422485, + "timestamp": 0.4915795283758442 + }, + { + "x": 7.617674791496479, + "y": 2.1512353933652784, + "heading": 0.6014721404803293, + "angularVelocity": -0.0000011209546846231955, + "velocityX": -1.979061423964885, + "velocityY": -0.8199975038311836, + "timestamp": 0.5618051752866791 + }, + { + "x": 7.461321318017023, + "y": 2.0864524329093923, + "heading": 0.6014720519208926, + "angularVelocity": -0.0000012610697164822291, + "velocityX": -2.226444046545777, + "velocityY": -0.9224971688497368, + "timestamp": 0.6320308221975139 + }, + { + "x": 7.287595242479287, + "y": 2.014471368266166, + "heading": 0.6014719535219923, + "angularVelocity": -0.0000014011818267188707, + "velocityX": -2.4738266314344535, + "velocityY": -1.0249968182510263, + "timestamp": 0.7022564691083488 + }, + { + "x": 7.096496570177163, + "y": 1.935292201629055, + "heading": 0.6014718452840377, + "angularVelocity": -0.0000015412881098024927, + "velocityX": -2.7212091409390613, + "velocityY": -1.1274964364179387, + "timestamp": 0.7724821160191837 + }, + { + "x": 6.8880253169921275, + "y": 1.8489149395783349, + "heading": 0.601471727208249, + "angularVelocity": -0.0000016813770192107404, + "velocityX": -2.9685914242944573, + "velocityY": -1.2299959608829605, + "timestamp": 0.8427077629300186 + }, + { + "x": 6.663723389677425, + "y": 1.7559784504804536, + "heading": 0.6014717272081879, + "angularVelocity": -8.702352256817885e-13, + "velocityX": -3.1940172455726326, + "velocityY": -1.3233981200042444, + "timestamp": 0.9129334098408535 + }, + { + "x": 6.439421272188231, + "y": 1.6630424203676835, + "heading": 0.6014717272081268, + "angularVelocity": -8.703596574297939e-13, + "velocityX": -3.1940199536216154, + "velocityY": -1.3233915841426174, + "timestamp": 0.9831590567516884 + }, + { + "x": 6.212032631338727, + "y": 1.577936888330409, + "heading": 0.6014717272080651, + "angularVelocity": -8.787789669679053e-13, + "velocityX": -3.237971465584607, + "velocityY": -1.2118867647503735, + "timestamp": 1.0533847036625232 + }, + { + "x": 5.978739653450143, + "y": 1.510684142319498, + "heading": 0.6014717272080008, + "angularVelocity": -9.15623540134239e-13, + "velocityX": -3.32204811419955, + "velocityY": -0.9576664504963734, + "timestamp": 1.1236103505733581 + }, + { + "x": 5.7409415584912775, + "y": 1.4616883276374903, + "heading": 0.601471727201828, + "angularVelocity": -8.790086201060278e-11, + "velocityX": -3.386200133703241, + "velocityY": -0.6976911831686963, + "timestamp": 1.193835997484193 + }, + { + "x": 5.516819527735436, + "y": 1.4255992428677315, + "heading": 0.6014714661772929, + "angularVelocity": -0.000003716940268980297, + "velocityX": -3.1914555524195745, + "velocityY": -0.513901777445793, + "timestamp": 1.2640616443950279 + }, + { + "x": 5.308884526984856, + "y": 1.3990809310343755, + "heading": 0.6014711092836408, + "angularVelocity": -0.0000050820984614807965, + "velocityX": -2.9609552905164764, + "velocityY": -0.3776157714435294, + "timestamp": 1.3342872913058628 + }, + { + "x": 5.1176297142242815, + "y": 1.3812454338123161, + "heading": 0.6014706963446639, + "angularVelocity": -0.000005880173340714845, + "velocityX": -2.7234325516916758, + "velocityY": -0.253974124933375, + "timestamp": 1.4045129382166976 + }, + { + "x": 4.943259966846924, + "y": 1.3716872939772524, + "heading": 0.6014702453730658, + "angularVelocity": -0.000006421750712363147, + "velocityX": -2.482992397332454, + "velocityY": -0.13610611301593797, + "timestamp": 1.4747385851275325 + }, + { + "x": 4.785886935464025, + "y": 1.3701747617379714, + "heading": 0.6014697666441067, + "angularVelocity": -0.00000681701031230746, + "velocityX": -2.240962359274736, + "velocityY": -0.021538174524779245, + "timestamp": 1.5449642320383674 }, { "x": 4.645580768585205, "y": 1.3765579462051392, - "heading": -0.4122949138101138, - "angularVelocity": -0.0030961609395507624, - "velocityX": -3.363035633177095, - "velocityY": 0.7980010748704317, - "timestamp": 1.5478284887500564 - }, - { - "x": 4.443925231966549, - "y": 1.439020065928105, - "heading": -0.4125273897788825, - "angularVelocity": -0.003806087702589553, - "velocityX": -3.3014967617877016, - "velocityY": 1.0226274440941339, - "timestamp": 1.608908523403631 - }, - { - "x": 4.246892810528237, - "y": 1.5149356606131386, - "heading": -0.41260940539586727, - "angularVelocity": -0.0013427565562128022, - "velocityX": -3.2258072962108524, - "velocityY": 1.242887223551879, - "timestamp": 1.6699885580572058 - }, - { - "x": 4.05539885725619, - "y": 1.6039545655503569, - "heading": -0.41261007048157244, - "angularVelocity": -0.000010888757822699568, - "velocityX": -3.1351317064264514, - "velocityY": 1.4574141197218358, - "timestamp": 1.7310685927107805 - }, - { - "x": 3.870332686379004, - "y": 1.705664249073373, - "heading": -0.4126103244982615, - "angularVelocity": -0.000004158751555602436, - "velocityX": -3.029896297977233, - "velocityY": 1.6651870631685113, - "timestamp": 1.7921486273643552 - }, - { - "x": 3.6925342411729205, - "y": 1.8196030932877822, - "heading": -0.4126105942683028, - "angularVelocity": -0.000004416664836793854, - "velocityX": -2.910909370213978, - "velocityY": 1.8654024160371316, - "timestamp": 1.85322866201793 - }, - { - "x": 3.5229313973486467, - "y": 1.9451682176450034, - "heading": -0.41310298698073444, - "angularVelocity": -0.00806143472616382, - "velocityX": -2.7767312966701, - "velocityY": 2.0557474315360964, - "timestamp": 1.9143086966715046 - }, - { - "x": 3.3629080056368847, - "y": 2.081177909355995, - "heading": -0.41684782301867235, - "angularVelocity": -0.061310312922665575, - "velocityX": -2.6198968716923905, - "velocityY": 2.226745490279982, - "timestamp": 1.9753887313250793 - }, - { - "x": 3.2138348018272307, - "y": 2.225828798378681, - "heading": -0.42779633021695374, - "angularVelocity": -0.17924854267646892, - "velocityX": -2.4406208125969044, - "velocityY": 2.368218843409276, - "timestamp": 2.036468765978654 - }, - { - "x": 3.076632646241407, - "y": 2.3767820823282975, - "heading": -0.45028005155414713, - "angularVelocity": -0.3681026290294955, - "velocityX": -2.2462684634019734, - "velocityY": 2.4714014130111956, - "timestamp": 2.0975488006322287 - }, - { - "x": 2.953317405786702, - "y": 2.527452693090262, - "heading": -0.479539871258463, - "angularVelocity": -0.4790406533046003, - "velocityX": -2.018912418012011, - "velocityY": 2.466773498353727, - "timestamp": 2.1586288352858034 - }, - { - "x": 2.8431421656158986, - "y": 2.6728620421564, - "heading": -0.5117573524705473, - "angularVelocity": -0.5274633748132465, - "velocityX": -1.8037848340407943, - "velocityY": 2.3806363223408726, - "timestamp": 2.219708869939378 - }, - { - "x": 2.7447582014328504, - "y": 2.8103234089599436, - "heading": -0.5448138902366748, - "angularVelocity": -0.541200376745252, - "velocityX": -1.6107385128552993, - "velocityY": 2.250512259581694, - "timestamp": 2.280788904592953 - }, - { - "x": 2.657040568190158, - "y": 2.9383742562516337, - "heading": -0.5774389967679732, - "angularVelocity": -0.5341370010075654, - "velocityX": -1.436109749121744, - "velocityY": 2.0964435927050773, - "timestamp": 2.3418689392465275 - }, - { - "x": 2.579139377940474, - "y": 3.0561477275760893, - "heading": -0.6087739702949048, - "angularVelocity": -0.5130149926183435, - "velocityX": -1.2753953184786753, - "velocityY": 1.9281827849710216, - "timestamp": 2.402948973900102 - }, - { - "x": 2.5104135669776086, - "y": 3.1630880849973138, - "heading": -0.6382063942290674, - "angularVelocity": -0.4818665231788694, - "velocityX": -1.12517635840673, - "velocityY": 1.7508234569242558, - "timestamp": 2.464029008553677 - }, - { - "x": 2.450370390547826, - "y": 3.258815753261752, - "heading": -0.6652836730357979, - "angularVelocity": -0.4433081768912526, - "velocityX": -0.9830245966677624, - "velocityY": 1.5672497372893452, - "timestamp": 2.5251090432072516 - }, - { - "x": 2.3986225657417113, - "y": 3.3430581424304706, - "heading": -0.6896607419023619, - "angularVelocity": -0.39910044263764155, - "velocityX": -0.8472134159649896, - "velocityY": 1.3792131855607757, - "timestamp": 2.5861890778608263 - }, - { - "x": 2.354859160136495, - "y": 3.415611519736344, - "heading": -0.7110667492722108, - "angularVelocity": -0.35045833702054285, - "velocityX": -0.7164928090402631, - "velocityY": 1.1878411287317068, - "timestamp": 2.647269112514401 - }, - { - "x": 2.318825720632345, - "y": 3.4763186343010504, - "heading": -0.7292831614478376, - "angularVelocity": -0.2982384060347082, - "velocityX": -0.589938098570508, - "velocityY": 0.993894566514525, - "timestamp": 2.7083491471679757 - }, - { - "x": 2.2903104575974997, - "y": 3.5250548695238315, - "heading": -0.7441289784624036, - "angularVelocity": -0.2430551504884782, - "velocityX": -0.4668507998820613, - "velocityY": 0.7979077860580311, - "timestamp": 2.7694291818215504 - }, - { - "x": 2.269134426765791, - "y": 3.56171927991662, - "heading": -0.7554504777477656, - "angularVelocity": -0.18535515491394047, - "velocityX": -0.34669316990097204, - "velocityY": 0.6002683299172502, - "timestamp": 2.830509216475125 - }, - { - "x": 2.255144398175998, - "y": 3.586228565361257, - "heading": -0.7631138906211655, - "angularVelocity": -0.12546510356230606, - "velocityX": -0.22904421500642305, - "velocityY": 0.4012650874159682, - "timestamp": 2.8915892511287 + "heading": 0.6014692668007987, + "angularVelocity": -0.000007117674667444465, + "velocityX": -1.997933419637491, + "velocityY": 0.09089534590222227, + "timestamp": 1.6151898789492023 + }, + { + "x": 4.4852918274531035, + "y": 1.4093136530981196, + "heading": 0.6014686169682122, + "angularVelocity": -0.00000794408595037517, + "velocityX": -1.9595033424539408, + "velocityY": 0.400432598081353, + "timestamp": 1.6969906790087563 + }, + { + "x": 4.332045122157961, + "y": 1.4665930457792093, + "heading": 0.6014678756495806, + "angularVelocity": -0.000009062486322055742, + "velocityX": -1.8734132818208915, + "velocityY": 0.7002302256137938, + "timestamp": 1.7787914790683104 + }, + { + "x": 4.189567990618789, + "y": 1.5470029255462814, + "heading": 0.6014669872102968, + "angularVelocity": -0.00001086100971182791, + "velocityX": -1.7417571886270768, + "velocityY": 0.9829962507522065, + "timestamp": 1.8605922791278644 + }, + { + "x": 4.061325777655998, + "y": 1.6485874554715532, + "heading": 0.6014657443656565, + "angularVelocity": -0.00001519355115434508, + "velocityX": -1.567737881162854, + "velocityY": 1.2418525228520432, + "timestamp": 1.9423930791874184 + }, + { + "x": 3.9499181722494128, + "y": 1.7683949151806115, + "heading": 0.5999046298375316, + "angularVelocity": -0.019084343025843265, + "velocityX": -1.3619378456625928, + "velocityY": 1.4646245467261332, + "timestamp": 2.0241938792469725 + }, + { + "x": 3.8385139180743773, + "y": 1.888205491074706, + "heading": 0.5540381787699103, + "angularVelocity": -0.5607090766132972, + "velocityX": -1.361896877462441, + "velocityY": 1.4646626415251267, + "timestamp": 2.1059946793065265 + }, + { + "x": 3.7271096639847774, + "y": 2.0080160670482403, + "heading": 0.4697368355238526, + "angularVelocity": -1.0305686886275442, + "velocityX": -1.361896876418011, + "velocityY": 1.4646626424962754, + "timestamp": 2.1877954793660805 + }, + { + "x": 3.6157054099517287, + "y": 2.1278266430743598, + "heading": 0.3537615125967293, + "angularVelocity": -1.4177773670023999, + "velocityX": -1.3618968757266772, + "velocityY": 1.4646626431391025, + "timestamp": 2.2695962794256346 + }, + { + "x": 3.504301155997762, + "y": 2.247637219174011, + "heading": 0.2137130812750941, + "angularVelocity": -1.7120667673137158, + "velocityX": -1.3618968747599156, + "velocityY": 1.4646626440380324, + "timestamp": 2.3513970794851886 + }, + { + "x": 3.3928969021094617, + "y": 2.367447795334722, + "heading": 0.057794482937139194, + "angularVelocity": -1.9060766914802987, + "velocityX": -1.3618968739571615, + "velocityY": 1.4646626447844622, + "timestamp": 2.4331978795447426 + }, + { + "x": 3.281492648234104, + "y": 2.487258371507466, + "heading": -0.105452505167902, + "angularVelocity": -1.995664932203507, + "velocityX": -1.3618968737989476, + "velocityY": 1.464662644931575, + "timestamp": 2.5149986796042967 + }, + { + "x": 3.1700883943158846, + "y": 2.6070689476403572, + "heading": -0.26730664929832215, + "angularVelocity": -1.978637666289151, + "velocityX": -1.3618968743229085, + "velocityY": 1.4646626444443769, + "timestamp": 2.5967994796638507 + }, + { + "x": 3.058684140329769, + "y": 2.7268795237101155, + "heading": -0.41916927419219197, + "angularVelocity": -1.8564931490072147, + "velocityX": -1.3618968751529306, + "velocityY": 1.4646626436725918, + "timestamp": 2.6786002797234048 + }, + { + "x": 2.947279886280209, + "y": 2.846690099720882, + "heading": -0.5526625850121627, + "angularVelocity": -1.6319316036369287, + "velocityX": -1.3618968759285288, + "velocityY": 1.464662642951413, + "timestamp": 2.760401079782959 + }, + { + "x": 2.835875632186779, + "y": 2.966500675690855, + "heading": -0.65985673738226, + "angularVelocity": -1.3104291436276523, + "velocityX": -1.3618968764648283, + "velocityY": 1.464662642452743, + "timestamp": 2.842201879842513 + }, + { + "x": 2.7244713780717897, + "y": 3.086311251640782, + "heading": -0.7334716118848168, + "angularVelocity": -0.899928539194763, + "velocityX": -1.3618968767283959, + "velocityY": 1.4646626422076685, + "timestamp": 2.924002679902067 + }, + { + "x": 2.613067124142982, + "y": 3.2061218277638193, + "heading": -0.7669996227711985, + "angularVelocity": -0.4098738748517434, + "velocityX": -1.361896874452356, + "velocityY": 1.4646626443239155, + "timestamp": 3.005803479961621 + }, + { + "x": 2.5088215468762853, + "y": 3.3182335485748182, + "heading": -0.7669997571492978, + "angularVelocity": -0.0000016427479828891154, + "velocityX": -1.2743833457717078, + "velocityY": 1.3705455292537272, + "timestamp": 3.087604280021175 + }, + { + "x": 2.421950224540146, + "y": 3.411659991166572, + "heading": -0.7669998477403924, + "angularVelocity": -0.0000011074597615269072, + "velocityX": -1.06198621862983, + "velocityY": 1.1421213792986926, + "timestamp": 3.169405080080729 + }, + { + "x": 2.352453163850527, + "y": 3.4864011482861903, + "heading": -0.7669999126210906, + "angularVelocity": -7.931548110988282e-7, + "velocityX": -0.8495890093864996, + "velocityY": 0.9136971406783939, + "timestamp": 3.251205880140283 + }, + { + "x": 2.300330367046085, + "y": 3.5424570175160435, + "heading": -0.7669999578169298, + "angularVelocity": -5.525109684504957e-7, + "velocityX": -0.6371917727760005, + "velocityY": 0.6852728725029872, + "timestamp": 3.333006680199837 + }, + { + "x": 2.2655818352461483, + "y": 3.5798275976473137, + "heading": -0.7669999863406792, + "angularVelocity": -3.486976819494124e-7, + "velocityX": -0.4247945224819143, + "velocityY": 0.4568485895500231, + "timestamp": 3.414807480259391 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.0636232346768501, - "velocityX": -0.1135695009511221, - "velocityY": 0.20111846142733134, - "timestamp": 2.9526692857822745 + "angularVelocity": -1.6698272956598662e-7, + "velocityX": -0.21239726397767503, + "velocityY": 0.2284242977305235, + "timestamp": 3.496608280318945 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -2.127821535251409e-28, - "velocityX": -9.407606964048783e-27, - "velocityY": -7.092605634329165e-27, - "timestamp": 3.013749320435849 + "angularVelocity": -2.381764007243456e-23, + "velocityX": 2.799365906238757e-23, + "velocityY": -7.174872988733629e-24, + "timestamp": 3.578409080378499 } ], "eventMarkers": [] diff --git a/src/main/deploy/choreo/3PieceSourceSideLower.traj b/src/main/deploy/choreo/3PieceSourceSideLower.traj index b3ef7c9..adae522 100644 --- a/src/main/deploy/choreo/3PieceSourceSideLower.traj +++ b/src/main/deploy/choreo/3PieceSourceSideLower.traj @@ -4,1819 +4,1855 @@ "x": 0.6476043462753296, "y": 4.391018867492676, "heading": -1.0516500181249593, - "angularVelocity": -1.0131588317285796e-24, - "velocityX": -7.195760422140643e-25, - "velocityY": 3.68543968667644e-24, + "angularVelocity": 1.4837621687026506e-24, + "velocityX": 1.2605777337321822e-24, + "velocityY": -5.078976570788486e-24, "timestamp": 0 }, { - "x": 0.6591914533996168, - "y": 4.382126456198724, - "heading": -1.040727167766298, - "angularVelocity": 0.17178522537716917, - "velocityX": 0.1822320862646183, - "velocityY": -0.1398522206309347, - "timestamp": 0.06358434105540359 - }, - { - "x": 0.6823705688244482, - "y": 4.364325443623157, - "heading": -1.0189895299826641, - "angularVelocity": 0.3418709295845801, - "velocityX": 0.364541254027222, - "velocityY": -0.27995906350677474, - "timestamp": 0.12716868211080717 - }, - { - "x": 0.7171462629990519, - "y": 4.337595981630138, - "heading": -0.9865639713670495, - "angularVelocity": 0.5099613847906508, - "velocityX": 0.5469223018966605, - "velocityY": -0.4203780608456431, - "timestamp": 0.19075302316621076 - }, - { - "x": 0.7635267836330776, - "y": 4.301915006000565, - "heading": -0.943615852299556, - "angularVelocity": 0.6754511937156207, - "velocityX": 0.7294330626720272, - "velocityY": -0.5611597924477026, - "timestamp": 0.25433736422161435 - }, - { - "x": 0.8215286683730939, - "y": 4.257255375739588, - "heading": -0.8903806097169653, - "angularVelocity": 0.8372382523584655, - "velocityX": 0.912203913373529, - "velocityY": -0.7023683743464803, - "timestamp": 0.3179217052770179 - }, - { - "x": 0.8911812541678331, - "y": 4.203582879820058, - "heading": -0.8272094806907175, - "angularVelocity": 0.9935013554863164, - "velocityX": 1.0954361504516998, - "velocityY": -0.8441149979483671, - "timestamp": 0.38150604633242147 - }, - { - "x": 0.9725299828211558, - "y": 4.140850923917802, - "heading": -0.75462709933033, - "angularVelocity": 1.1415134631519366, - "velocityX": 1.2793830572599652, - "velocityY": -0.9865944171316399, - "timestamp": 0.445090387387825 - }, - { - "x": 1.0656375296619247, - "y": 4.068994254029578, - "heading": -0.6733936884757168, - "angularVelocity": 1.2775694377933589, - "velocityX": 1.4643156679038403, - "velocityY": -1.130100095330278, - "timestamp": 0.5086747284432286 - }, - { - "x": 1.1705832794462367, - "y": 3.987925697121121, - "heading": -0.5845665618376034, - "angularVelocity": 1.396996888915067, - "velocityX": 1.6504967739284813, - "velocityY": -1.2749767562711483, - "timestamp": 0.5722590694986321 - }, - { - "x": 1.287465328455322, - "y": 3.897542804343646, - "heading": -0.48958951482473, - "angularVelocity": 1.4937175637334361, - "velocityX": 1.8382206541582515, - "velocityY": -1.4214646448678434, - "timestamp": 0.6358434105540357 - }, - { - "x": 1.416410446947234, - "y": 3.797751405129375, - "heading": -0.3905846134253379, - "angularVelocity": 1.5570642041115932, - "velocityX": 2.0279382683160483, - "velocityY": -1.5694335674143292, - "timestamp": 0.6994277516094393 - }, - { - "x": 1.5575332696620845, - "y": 3.6885069096807293, - "heading": -0.2916586370436419, - "angularVelocity": 1.5558229391022207, - "velocityX": 2.2194587593804664, - "velocityY": -1.7181037600665896, - "timestamp": 0.7630120926648428 - }, - { - "x": 1.7097613444570134, - "y": 3.570777493688783, - "heading": -0.20742198100348744, - "angularVelocity": 1.3248019031408336, - "velocityX": 2.394112642643988, - "velocityY": -1.8515473155468265, - "timestamp": 0.8265964337202464 - }, - { - "x": 1.8711613775924387, - "y": 3.448808413688974, - "heading": -0.15383975328764557, - "angularVelocity": 0.8426953370351598, - "velocityX": 2.538361339544133, - "velocityY": -1.9182251160475614, - "timestamp": 0.8901807747756499 - }, - { - "x": 2.0417383028773095, - "y": 3.3225570909899145, - "heading": -0.1305932032652052, - "angularVelocity": 0.36560180756115246, - "velocityX": 2.6826876311612624, - "velocityY": -1.985572557700191, - "timestamp": 0.9537651158310535 - }, - { - "x": 2.215389362271695, - "y": 3.1877556827532114, - "heading": -0.13059307027477257, - "angularVelocity": 0.0000020915595006631527, - "velocityX": 2.7310349767260567, - "velocityY": -2.120040972340114, - "timestamp": 1.0173494568864572 - }, - { - "x": 2.38903992841347, - "y": 3.05295363910863, - "heading": -0.13059293728967952, - "angularVelocity": 0.000002091475524120011, - "velocityX": 2.7310272192719025, - "velocityY": -2.120050965490433, - "timestamp": 1.0809337979418607 - }, - { - "x": 2.5626904945233253, - "y": 2.918151595422929, - "heading": -0.13059280430458975, - "angularVelocity": 0.000002091475473085295, - "velocityX": 2.731027218769898, - "velocityY": -2.1200509661371285, - "timestamp": 1.1445181389972643 - }, - { - "x": 2.7363410606331784, - "y": 2.7833495517372238, - "heading": -0.13059267131950322, - "angularVelocity": 0.0000020914754220002734, - "velocityX": 2.7310272187698588, - "velocityY": -2.120050966137197, - "timestamp": 1.2081024800526678 - }, - { - "x": 2.909991626743031, - "y": 2.6485475080515166, - "heading": -0.13059253833441983, - "angularVelocity": 0.0000020914753719975214, - "velocityX": 2.731027218769853, - "velocityY": -2.1200509661372235, - "timestamp": 1.2716868211080714 - }, - { - "x": 3.0836421928528828, - "y": 2.5137454643658077, - "heading": -0.13059240534933972, - "angularVelocity": 0.0000020914753210405788, - "velocityX": 2.7310272187698468, - "velocityY": -2.12005096613725, - "timestamp": 1.335271162163475 - }, - { - "x": 3.2572927589627345, - "y": 2.3789434206800975, - "heading": -0.13059227236426274, - "angularVelocity": 0.0000020914752714762697, - "velocityX": 2.73102721876984, - "velocityY": -2.1200509661372764, - "timestamp": 1.3988555032188785 - }, - { - "x": 3.4309433250725863, - "y": 2.2441413769943854, - "heading": -0.13059213937918893, - "angularVelocity": 0.000002091475221449109, - "velocityX": 2.731027218769834, - "velocityY": -2.1200509661373035, - "timestamp": 1.462439844274282 - }, - { - "x": 3.604593891182437, - "y": 2.1093393333086716, - "heading": -0.13059200639411836, - "angularVelocity": 0.000002091475170968491, - "velocityX": 2.7310272187698277, - "velocityY": -2.12005096613733, - "timestamp": 1.5260241853296856 - }, - { - "x": 3.7782444572922893, - "y": 1.9745372896229578, - "heading": -0.13059187340905104, - "angularVelocity": 0.0000020914751195693144, - "velocityX": 2.731027218769846, - "velocityY": -2.120050966137325, - "timestamp": 1.5896085263850892 - }, - { - "x": 3.951895023426439, - "y": 1.8397352459685434, - "heading": -0.13059174042398683, - "angularVelocity": 0.0000020914750705889236, - "velocityX": 2.731027219151981, - "velocityY": -2.12005096564508, - "timestamp": 1.6531928674404928 - }, - { - "x": 4.125545965030262, - "y": 1.7049336859915973, - "heading": -0.13059160743887335, - "angularVelocity": 0.0000020914758454008564, - "velocityX": 2.7310331242170753, - "velocityY": -2.1200433587805536, - "timestamp": 1.7167772084958963 - }, - { - "x": 4.303592186821453, - "y": 1.5759931847530522, - "heading": -0.13059147325010556, - "angularVelocity": 0.000002110405888729409, - "velocityX": 2.8001583225664275, - "velocityY": -2.0278656521138467, - "timestamp": 1.7803615495512999 - }, - { - "x": 4.490236730845761, - "y": 1.4598470551473188, - "heading": -0.130591333138394, - "angularVelocity": 0.000002203556870291448, - "velocityX": 2.935385362595435, - "velocityY": -1.826646744746956, - "timestamp": 1.8439458906067034 + "x": 0.6591914533996294, + "y": 4.3821264561987325, + "heading": -1.0407271677663157, + "angularVelocity": 0.1717852253768825, + "velocityX": 0.1822320862648084, + "velocityY": -0.1398522206307734, + "timestamp": 0.06358434105540607 + }, + { + "x": 0.682370568824486, + "y": 4.364325443623188, + "heading": -1.0189895299827134, + "angularVelocity": 0.341870929584073, + "velocityX": 0.36454125402760434, + "velocityY": -0.2799590635064334, + "timestamp": 0.12716868211081214 + }, + { + "x": 0.7171462629991276, + "y": 4.337595981630201, + "heading": -0.9865639713671387, + "angularVelocity": 0.509961384790003, + "velocityX": 0.5469223018972373, + "velocityY": -0.42037806084509965, + "timestamp": 0.19075302316621823 + }, + { + "x": 0.7635267836332045, + "y": 4.301915006000676, + "heading": -0.9436158522996869, + "angularVelocity": 0.6754511937149356, + "velocityX": 0.7294330626728007, + "velocityY": -0.5611597924469304, + "timestamp": 0.2543373642216243 + }, + { + "x": 0.821528668373285, + "y": 4.257255375739764, + "heading": -0.8903806097171314, + "angularVelocity": 0.8372382523578797, + "velocityX": 0.9122039133745026, + "velocityY": -0.7023683743454452, + "timestamp": 0.31792170527703034 + }, + { + "x": 0.891181254168102, + "y": 4.203582879820318, + "heading": -0.8272094806909008, + "angularVelocity": 0.9935013554860082, + "velocityX": 1.0954361504528793, + "velocityY": -0.8441149979470245, + "timestamp": 0.3815060463324364 + }, + { + "x": 0.9725299828215167, + "y": 4.140850923918169, + "heading": -0.7546270993304982, + "angularVelocity": 1.1415134631521273, + "velocityX": 1.279383057261364, + "velocityY": -0.986594417129931, + "timestamp": 0.44509038738784246 + }, + { + "x": 1.065637529662394, + "y": 4.068994254030079, + "heading": -0.673393688475822, + "angularVelocity": 1.2775694377943008, + "velocityX": 1.464315667905486, + "velocityY": -1.1301000953281266, + "timestamp": 0.5086747284432486 + }, + { + "x": 1.1705832794468332, + "y": 3.9879256971217893, + "heading": -0.584566561837581, + "angularVelocity": 1.3969968889170195, + "velocityX": 1.6504967739304255, + "velocityY": -1.2749767562684577, + "timestamp": 0.5722590694986547 + }, + { + "x": 1.2874653284560715, + "y": 3.897542804344524, + "heading": -0.4895895148245002, + "angularVelocity": 1.4937175637366416, + "velocityX": 1.8382206541605852, + "velocityY": -1.42146464486449, + "timestamp": 0.6358434105540608 + }, + { + "x": 1.4164104469481729, + "y": 3.7977514051305152, + "heading": -0.3905846134248042, + "angularVelocity": 1.557064204116311, + "velocityX": 2.0279382683189424, + "velocityY": -1.5694335674101274, + "timestamp": 0.6994277516094669 + }, + { + "x": 1.5575332696632753, + "y": 3.688506909682212, + "heading": -0.2916586370426824, + "angularVelocity": 1.5558229391088563, + "velocityX": 2.2194587593843385, + "velocityY": -1.718103760061147, + "timestamp": 0.763012092664873 + }, + { + "x": 1.7097613444585642, + "y": 3.5707774936908128, + "heading": -0.20742198100231668, + "angularVelocity": 1.324801903144104, + "velocityX": 2.394112642649561, + "velocityY": -1.8515473155381532, + "timestamp": 0.8265964337202791 + }, + { + "x": 1.8711613775944314, + "y": 3.4488084136916637, + "heading": -0.15383975328628857, + "angularVelocity": 0.8426953370380558, + "velocityX": 2.538361339550979, + "velocityY": -1.9182251160370993, + "timestamp": 0.8901807747756852 + }, + { + "x": 2.0417383028799354, + "y": 3.3225570909935143, + "heading": -0.13059320326371432, + "angularVelocity": 0.3656018075632435, + "velocityX": 2.682687631171131, + "velocityY": -1.9855725576858096, + "timestamp": 0.9537651158310914 + }, + { + "x": 2.2153893622715715, + "y": 3.187755682753254, + "heading": -0.13059307027328165, + "angularVelocity": 0.0000020915595014550256, + "velocityX": 2.731034976682693, + "velocityY": -2.120040972395975, + "timestamp": 1.0173494568864974 + }, + { + "x": 2.389039928413357, + "y": 3.0529536391086727, + "heading": -0.13059293728818866, + "angularVelocity": 0.000002091475523406473, + "velocityX": 2.7310272192719673, + "velocityY": -2.1200509654903494, + "timestamp": 1.0809337979419034 + }, + { + "x": 2.562690494523223, + "y": 2.918151595422971, + "heading": -0.13059280430309889, + "angularVelocity": 0.000002091475472778544, + "velocityX": 2.7310272187699582, + "velocityY": -2.1200509661370504, + "timestamp": 1.1445181389973094 + }, + { + "x": 2.7363410606330874, + "y": 2.7833495517372655, + "heading": -0.1305926713180123, + "angularVelocity": 0.0000020914754223957298, + "velocityX": 2.7310272187699196, + "velocityY": -2.1200509661371187, + "timestamp": 1.2081024800527154 + }, + { + "x": 2.9099916267429506, + "y": 2.648547508051558, + "heading": -0.13059253833292897, + "angularVelocity": 0.000002091475371640255, + "velocityX": 2.731027218769913, + "velocityY": -2.120050966137146, + "timestamp": 1.2716868211081214 + }, + { + "x": 3.0836421928528135, + "y": 2.513745464365849, + "heading": -0.1305924053478488, + "angularVelocity": 0.000002091475321590614, + "velocityX": 2.7310272187699067, + "velocityY": -2.120050966137172, + "timestamp": 1.3352711621635274 + }, + { + "x": 3.257292758962676, + "y": 2.3789434206801383, + "heading": -0.13059227236277188, + "angularVelocity": 0.000002091475271021181, + "velocityX": 2.7310272187699005, + "velocityY": -2.1200509661371987, + "timestamp": 1.3988555032189334 + }, + { + "x": 3.430943325072538, + "y": 2.244141376994426, + "heading": -0.1305921393776981, + "angularVelocity": 0.0000020914752212008574, + "velocityX": 2.7310272187698943, + "velocityY": -2.1200509661372253, + "timestamp": 1.4624398442743394 + }, + { + "x": 3.6045938911823994, + "y": 2.1093393333087116, + "heading": -0.13059200639262752, + "angularVelocity": 0.0000020914751708183746, + "velocityX": 2.731027218769888, + "velocityY": -2.120050966137252, + "timestamp": 1.5260241853297454 + }, + { + "x": 3.7782444572922627, + "y": 1.9745372896229973, + "heading": -0.13059187340756015, + "angularVelocity": 0.000002091475120575094, + "velocityX": 2.7310272187699067, + "velocityY": -2.1200509661372466, + "timestamp": 1.5896085263851514 + }, + { + "x": 3.951895023426423, + "y": 1.8397352459685825, + "heading": -0.13059174042249597, + "angularVelocity": 0.0000020914750700807474, + "velocityX": 2.731027219152042, + "velocityY": -2.1200509656450026, + "timestamp": 1.6531928674405574 + }, + { + "x": 4.125545965030257, + "y": 1.7049336859916362, + "heading": -0.13059160743738255, + "angularVelocity": 0.0000020914758451630756, + "velocityX": 2.731033124217136, + "velocityY": -2.1200433587804755, + "timestamp": 1.7167772084959634 + }, + { + "x": 4.303592186821449, + "y": 1.5759931847530775, + "heading": -0.13059147324861473, + "angularVelocity": 0.0000021104058890338206, + "velocityX": 2.800158322566331, + "velocityY": -2.0278656521139804, + "timestamp": 1.7803615495513694 + }, + { + "x": 4.4902367308457585, + "y": 1.459847055147331, + "heading": -0.13059133313690313, + "angularVelocity": 0.0000022035568702526466, + "velocityX": 2.9353853625953525, + "velocityY": -1.8266467447470887, + "timestamp": 1.8439458906067754 }, { "x": 4.6845622062683105, "y": 1.3570671081542969, - "heading": -0.1305911820170352, - "angularVelocity": 0.0000023767071620557534, - "velocityX": 3.056184466128632, - "velocityY": -1.616434884549102, - "timestamp": 1.907530231662107 - }, - { - "x": 4.83206708447035, - "y": 1.2885914794569848, - "heading": -0.13059103262448568, - "angularVelocity": 0.0000031760307779027524, - "velocityX": 3.13589957828876, - "velocityY": -1.4557667364792974, - "timestamp": 1.954567732232368 - }, - { - "x": 4.982924581891179, - "y": 1.2278574954319794, - "heading": -0.13059088660040227, - "angularVelocity": 0.0000031044184242488255, - "velocityX": 3.2071750325145314, - "velocityY": -1.2911822118244922, - "timestamp": 2.0016052328026293 - }, - { - "x": 5.13672864917333, - "y": 1.1750284268224314, - "heading": -0.13059074139304624, - "angularVelocity": 0.000003087055099940033, - "velocityX": 3.269818026415093, - "velocityY": -1.1231266110884432, - "timestamp": 2.0486427333728905 - }, - { - "x": 5.293065104212699, - "y": 1.1302454562937732, - "heading": -0.13059059472423634, - "angularVelocity": 0.000003118125073070688, - "velocityX": 3.3236556607816676, - "velocityY": -0.9520695186974223, - "timestamp": 2.0956802339431517 - }, - { - "x": 5.450482773711638, - "y": 1.0894253766985498, - "heading": -0.13059044674776243, - "angularVelocity": 0.0000031459255302142065, - "velocityX": 3.346641883401104, - "velocityY": -0.8678199117797415, - "timestamp": 2.142717734513413 - }, - { - "x": 5.6079006554403685, - "y": 1.0486061155506479, - "heading": -0.1305902987709771, - "angularVelocity": 0.000003145932150679596, - "velocityX": 3.3466463953285848, - "velocityY": -0.8678025118900388, - "timestamp": 2.189755235083674 - }, - { - "x": 5.765318537202432, - "y": 1.0077868545312842, - "heading": -0.13059015079419933, - "angularVelocity": 0.0000031459319897448254, - "velocityX": 3.3466463960372055, - "velocityY": -0.8678025091573679, - "timestamp": 2.2367927356539354 - }, - { - "x": 5.9227364189645, - "y": 0.9669675935119412, - "heading": -0.13059000281742925, - "angularVelocity": 0.0000031459318269023195, - "velocityX": 3.346646396037345, - "velocityY": -0.8678025091569279, - "timestamp": 2.2838302362241967 - }, - { - "x": 6.080154300726611, - "y": 0.9261483324927562, - "heading": -0.13058985484066676, - "angularVelocity": 0.000003145931664971049, - "velocityX": 3.346646396038242, - "velocityY": -0.867802509153567, - "timestamp": 2.330867736794458 - }, - { - "x": 6.237572182748926, - "y": 0.8853290724770341, - "heading": -0.13058970686391144, - "angularVelocity": 0.0000031459315122386572, - "velocityX": 3.3466464015700863, - "velocityY": -0.8678024878203159, - "timestamp": 2.377905237364719 - }, - { - "x": 6.394991721452043, - "y": 0.8445162019222677, - "heading": -0.13058955888394272, - "angularVelocity": 0.0000031459998284529575, - "velocityX": 3.3466816219959403, - "velocityY": -0.8676666502252415, - "timestamp": 2.4249427379349804 - }, - { - "x": 6.554152816051068, - "y": 0.8111344074726671, - "heading": -0.13058937107407412, - "angularVelocity": 0.000003992768882684273, - "velocityX": 3.3837064612155903, - "velocityY": -0.7096846993334062, - "timestamp": 2.4719802385052416 - }, - { - "x": 6.711882769952025, - "y": 0.7851880682804044, - "heading": -0.12042377120885606, - "angularVelocity": 0.21611692249747513, - "velocityX": 3.35328093518389, - "velocityY": -0.551609649273476, - "timestamp": 2.519017739075503 - }, - { - "x": 6.866725553620077, - "y": 0.7651062041845456, - "heading": -0.09663025977922159, - "angularVelocity": 0.5058413210985454, - "velocityX": 3.2919007555845554, - "velocityY": -0.42693306090662936, - "timestamp": 2.566055239645764 - }, - { - "x": 7.014982029149136, - "y": 0.7495960675805906, - "heading": -0.0669452251457697, - "angularVelocity": 0.631092942302719, - "velocityX": 3.1518782616352006, - "velocityY": -0.3297398121906415, - "timestamp": 2.6130927402160253 - }, - { - "x": 7.155468637798723, - "y": 0.7371442919133843, - "heading": -0.039841575624683864, - "angularVelocity": 0.5762136421470871, - "velocityX": 2.9866937432132143, - "velocityY": -0.26472018105228134, - "timestamp": 2.6601302407862866 - }, - { - "x": 7.288217565103697, - "y": 0.7273449805476783, - "heading": -0.01722296703020818, - "angularVelocity": 0.4808633179964505, - "velocityX": 2.8221934774506603, - "velocityY": -0.20832976342075163, - "timestamp": 2.707167741356548 + "heading": -0.13059118201554434, + "angularVelocity": 0.0000023767071623724323, + "velocityX": 3.0561844661285633, + "velocityY": -1.6164348845492313, + "timestamp": 1.9075302316621814 + }, + { + "x": 4.832067084470335, + "y": 1.2885914794569837, + "heading": -0.1305910326229948, + "angularVelocity": 0.0000031760307778025535, + "velocityX": 3.1358995782886923, + "velocityY": -1.4557667364794429, + "timestamp": 1.9545677322324386 + }, + { + "x": 4.982924581891149, + "y": 1.2278574954319752, + "heading": -0.13059088659891144, + "angularVelocity": 0.000003104418423448367, + "velocityX": 3.207175032514466, + "velocityY": -1.2911822118246548, + "timestamp": 2.001605232802696 + }, + { + "x": 5.136728649173284, + "y": 1.1750284268224231, + "heading": -0.13059074139155538, + "angularVelocity": 0.00000308705510077957, + "velocityX": 3.269818026415032, + "velocityY": -1.1231266110886224, + "timestamp": 2.048642733372953 + }, + { + "x": 5.293065104212638, + "y": 1.1302454562937592, + "heading": -0.1305905947227455, + "angularVelocity": 0.0000031181250722314943, + "velocityX": 3.3236556607816112, + "velocityY": -0.9520695186976181, + "timestamp": 2.0956802339432103 + }, + { + "x": 5.450482773711564, + "y": 1.0894253766985387, + "heading": -0.13059044674627163, + "angularVelocity": 0.0000031459255294965824, + "velocityX": 3.3466418834011025, + "velocityY": -0.8678199117797456, + "timestamp": 2.1427177345134676 + }, + { + "x": 5.607900655440282, + "y": 1.04860611555064, + "heading": -0.1305902987694863, + "angularVelocity": 0.0000031459321514570608, + "velocityX": 3.346646395328584, + "velocityY": -0.8678025118900428, + "timestamp": 2.189755235083725 + }, + { + "x": 5.765318537202331, + "y": 1.0077868545312796, + "heading": -0.13059015079270853, + "angularVelocity": 0.0000031459319896246793, + "velocityX": 3.346646396037204, + "velocityY": -0.867802509157372, + "timestamp": 2.236792735653982 + }, + { + "x": 5.922736418964388, + "y": 0.9669675935119395, + "heading": -0.1305900028159384, + "angularVelocity": 0.0000031459318275019883, + "velocityX": 3.3466463960373436, + "velocityY": -0.867802509156932, + "timestamp": 2.2838302362242393 + }, + { + "x": 6.080154300726486, + "y": 0.9261483324927575, + "heading": -0.13058985483917593, + "angularVelocity": 0.0000031459316651066595, + "velocityX": 3.3466463960382407, + "velocityY": -0.867802509153571, + "timestamp": 2.3308677367944965 + }, + { + "x": 6.237572182748789, + "y": 0.8853290724770384, + "heading": -0.1305897068624206, + "angularVelocity": 0.0000031459315124739283, + "velocityX": 3.346646401570085, + "velocityY": -0.86780248782032, + "timestamp": 2.377905237364754 + }, + { + "x": 6.394991721451892, + "y": 0.844516201922275, + "heading": -0.1305895588824519, + "angularVelocity": 0.0000031459998283836956, + "velocityX": 3.3466816219959377, + "velocityY": -0.8676666502252512, + "timestamp": 2.424942737935011 + }, + { + "x": 6.554152816050896, + "y": 0.8111344074726426, + "heading": -0.1305893710725833, + "angularVelocity": 0.000003992768882659048, + "velocityX": 3.3837064612154375, + "velocityY": -0.7096846993341356, + "timestamp": 2.4719802385052683 + }, + { + "x": 6.711882769951912, + "y": 0.7851880682804085, + "heading": -0.12042377120760904, + "angularVelocity": 0.21611692249230904, + "velocityX": 3.3532809351853774, + "velocityY": -0.5516096492729113, + "timestamp": 2.5190177390755255 + }, + { + "x": 6.866725553620017, + "y": 0.7651062041845728, + "heading": -0.09663025977821411, + "angularVelocity": 0.5058413210934933, + "velocityX": 3.29190075558594, + "velocityY": -0.4269330609061741, + "timestamp": 2.5660552396457827 + }, + { + "x": 7.014982029149098, + "y": 0.7495960675806145, + "heading": -0.06694522514508651, + "angularVelocity": 0.6310929422958753, + "velocityX": 3.151878261635918, + "velocityY": -0.3297398121907379, + "timestamp": 2.61309274021604 + }, + { + "x": 7.155468637798704, + "y": 0.7371442919133998, + "heading": -0.03984157562428539, + "angularVelocity": 0.5762136421410802, + "velocityX": 2.9866937432138485, + "velocityY": -0.26472018105247963, + "timestamp": 2.6601302407862972 + }, + { + "x": 7.28821756510369, + "y": 0.727344980547685, + "heading": -0.017222967030039466, + "angularVelocity": 0.48086331799160453, + "velocityX": 2.8221934774511723, + "velocityY": -0.20832976342095313, + "timestamp": 2.7071677413565545 }, { "x": 7.413279056549072, "y": 0.72, - "heading": 6.339387425155692e-24, - "angularVelocity": 0.36615395846728294, - "velocityX": 2.6587614122601657, - "velocityY": -0.1561515909355554, - "timestamp": 2.754205241926809 - }, - { - "x": 7.584141987680613, - "y": 0.7142363916829177, - "heading": 0.012496138017673028, - "angularVelocity": 0.17655403361368305, - "velocityX": 2.414069022258432, - "velocityY": -0.08143222290847654, - "timestamp": 2.8249832228197054 - }, - { - "x": 7.736548147209623, - "y": 0.711851622188137, - "heading": 0.017397146839460656, - "angularVelocity": 0.06924482388391391, - "velocityX": 2.153299057225679, - "velocityY": -0.03369366383013129, - "timestamp": 2.8957612037126017 - }, - { - "x": 7.870091367183984, - "y": 0.7115747244873084, - "heading": 0.017828194306038627, - "angularVelocity": 0.006090135111797648, - "velocityX": 1.8867904719752233, - "velocityY": -0.00391220118651861, + "heading": -8.89059623238174e-24, + "angularVelocity": 0.3661539584637254, + "velocityX": 2.6587614122605316, + "velocityY": -0.15615159093571299, + "timestamp": 2.7542052419268117 + }, + { + "x": 7.584141987680618, + "y": 0.7142363916829146, + "heading": 0.012496138017563933, + "angularVelocity": 0.17655403361214328, + "velocityX": 2.4140690222585377, + "velocityY": -0.0814322229085219, + "timestamp": 2.824983222819707 + }, + { + "x": 7.7365481472096285, + "y": 0.7118516221881321, + "heading": 0.017397146839313638, + "angularVelocity": 0.0692448238833787, + "velocityX": 2.153299057225703, + "velocityY": -0.03369366383015727, + "timestamp": 2.8957612037126026 + }, + { + "x": 7.8700913671839885, + "y": 0.7115747244873029, + "heading": 0.01782819430589125, + "angularVelocity": 0.006090135111792666, + "velocityX": 1.8867904719752229, + "velocityY": -0.00391220118652886, "timestamp": 2.966539184605498 }, { - "x": 7.984616283222687, - "y": 0.7125587164394659, - "heading": 0.015661834277452328, - "angularVelocity": -0.030607824654739903, - "velocityX": 1.6180867918796034, - "velocityY": 0.01390251515717133, - "timestamp": 3.0373171654983944 + "x": 7.98461628322269, + "y": 0.7125587164394606, + "heading": 0.01566183427732483, + "angularVelocity": -0.03060782465445932, + "velocityX": 1.6180867918795971, + "velocityY": 0.013902515157174911, + "timestamp": 3.0373171654983935 }, { "x": 8.08006227999561, - "y": 0.714207810245489, - "heading": 0.012151433911586507, - "angularVelocity": -0.049597351062866286, - "velocityX": 1.3485266967046678, - "velocityY": 0.023299531651214074, - "timestamp": 3.1080951463912907 + "y": 0.7142078102454845, + "heading": 0.012151433911488669, + "angularVelocity": -0.04959735106244768, + "velocityX": 1.3485266967046623, + "velocityY": 0.023299531651227553, + "timestamp": 3.108095146391289 }, { "x": 8.15640902937787, - "y": 0.7160816946030871, - "heading": 0.00820427926993306, - "angularVelocity": -0.05576811590071236, - "velocityX": 1.0786793917982935, - "velocityY": 0.02647552719021178, - "timestamp": 3.178873127284187 + "y": 0.716081694603084, + "heading": 0.008204279269867538, + "angularVelocity": -0.055768115900256314, + "velocityX": 1.0786793917982904, + "velocityY": 0.02647552719023059, + "timestamp": 3.1788731272841844 }, { "x": 8.213654764882792, - "y": 0.71784200041228, - "heading": 0.0045134929539951294, - "angularVelocity": -0.0521459678473021, - "velocityX": 0.8088071287530355, - "velocityY": 0.02487081133123372, - "timestamp": 3.2496511081770834 + "y": 0.7178420004122783, + "heading": 0.004513492953959301, + "angularVelocity": -0.05214596784688299, + "velocityX": 0.8088071287530345, + "velocityY": 0.02487081133125343, + "timestamp": 3.24965110817708 }, { "x": 8.251806612817116, - "y": 0.7192206370589295, - "heading": 0.0016291300859072085, - "angularVelocity": -0.040752262662771335, - "velocityX": 0.5390355510714089, - "velocityY": 0.019478326864616948, - "timestamp": 3.3204290890699797 + "y": 0.7192206370589289, + "heading": 0.0016291300858943402, + "angularVelocity": -0.04075226266244733, + "velocityX": 0.5390355510714093, + "velocityY": 0.019478326864633543, + "timestamp": 3.3204290890699752 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -4.056080746895066e-24, - "angularVelocity": -0.023017470481002632, - "velocityX": 0.26942444144984345, - "velocityY": 0.011011375730678513, - "timestamp": 3.391207069962876 + "heading": 5.577770790961069e-24, + "angularVelocity": -0.02301747048082103, + "velocityX": 0.2694244414498442, + "velocityY": 0.011011375730688399, + "timestamp": 3.3912070699628707 }, { "x": 8.270875930786133, "y": 0.72, - "heading": -1.9991825038559772e-24, - "angularVelocity": 6.550650295244866e-25, - "velocityX": -3.4098418734015305e-26, - "velocityY": 1.7181985071097e-25, - "timestamp": 3.4619850508557724 - }, - { - "x": 8.25196066732055, - "y": 0.7219205807616909, - "heading": -0.005612553081760066, - "angularVelocity": -0.07909055712036753, - "velocityX": -0.2665486996342892, - "velocityY": 0.027064296804682322, - "timestamp": 3.5329486814851325 - }, - { - "x": 8.21412399288685, - "y": 0.7257596347584204, - "heading": -0.016744431402723248, - "angularVelocity": -0.15686737307881685, - "velocityX": -0.5331840281864679, - "velocityY": 0.05409889492239708, - "timestamp": 3.6039123121144927 - }, - { - "x": 8.157358520801719, - "y": 0.7315141378055798, - "heading": -0.033282470488275456, - "angularVelocity": -0.23304950632993487, - "velocityX": -0.7999234478519905, - "velocityY": 0.08109087706088317, - "timestamp": 3.674875942743853 - }, - { - "x": 8.081655397928103, - "y": 0.7391803054783095, - "heading": -0.055089458667278546, - "angularVelocity": -0.3072980903823823, - "velocityX": -1.066787623494219, - "velocityY": 0.10802953012324953, - "timestamp": 3.745839573373213 - }, - { - "x": 7.987003995494799, - "y": 0.748753815449985, - "heading": -0.08199800345549389, - "angularVelocity": -0.3791878255039894, - "velocityX": -1.3338015768621518, - "velocityY": 0.13490727414550616, - "timestamp": 3.8168032040025732 - }, - { - "x": 7.8733914694677685, - "y": 0.7602301364715836, - "heading": -0.11380071054386168, - "angularVelocity": -0.44815501696174403, - "velocityX": -1.6009965248314793, - "velocityY": 0.16172116505057207, - "timestamp": 3.8877668346319334 - }, - { - "x": 7.74080211111102, - "y": 0.7736050364848951, - "heading": -0.15023345295494694, - "angularVelocity": -0.5134002035686684, - "velocityX": -1.868412835995617, - "velocityY": 0.18847541895323702, - "timestamp": 3.9587304652612936 - }, - { - "x": 7.589216359418635, - "y": 0.7888753993182606, - "heading": -0.19094489906072787, - "angularVelocity": -0.5736945213304409, - "velocityX": -2.1361047954847603, - "velocityY": 0.2151857606204215, - "timestamp": 4.029694095890654 - }, - { - "x": 7.418609301999379, - "y": 0.8060405691564864, - "heading": -0.2354360929047945, - "angularVelocity": -0.6269576887411831, - "velocityX": -2.4041478135515395, - "velocityY": 0.24188686071994714, - "timestamp": 4.100657726520014 - }, - { - "x": 7.228948719447248, - "y": 0.8251044625017263, - "heading": -0.28292522744133536, - "angularVelocity": -0.6692038459048766, - "velocityX": -2.672644858642023, - "velocityY": 0.2686431510925627, - "timestamp": 4.171621357149374 - }, - { - "x": 7.020195878786293, - "y": 0.8460771849141498, - "heading": -0.33198004179541496, - "angularVelocity": -0.691266976041442, - "velocityX": -2.9416877181955665, - "velocityY": 0.29554184624463653, - "timestamp": 4.242584987778734 - }, - { - "x": 6.7923582844879515, - "y": 0.868949065573254, - "heading": -0.379053692427792, - "angularVelocity": -0.6633489607971249, - "velocityX": -3.2106248267979276, - "velocityY": 0.3223042628492752, - "timestamp": 4.3135486184080944 - }, - { - "x": 6.551577901314172, - "y": 0.8947450109840207, - "heading": -0.38936079053254913, - "angularVelocity": -0.1452447967127084, - "velocityX": -3.3930110542309384, - "velocityY": 0.3635093805374453, - "timestamp": 4.384512249037455 - }, - { - "x": 6.307465319785258, - "y": 0.9193021232357074, - "heading": -0.38936083584908904, - "angularVelocity": -6.385882391179967e-7, - "velocityX": -3.4399674786074925, - "velocityY": 0.3460520837772146, - "timestamp": 4.455475879666815 - }, - { - "x": 6.0633527302184325, - "y": 0.9438591555860323, - "heading": -0.38936088116543593, - "angularVelocity": -6.385855192726227e-7, - "velocityX": -3.4399675918755674, - "velocityY": 0.34605095782916134, - "timestamp": 4.526439510296175 - }, - { - "x": 5.819240162083019, - "y": 0.9684164009773654, - "heading": -0.38936092648177834, - "angularVelocity": -6.38585455697529e-7, - "velocityX": -3.4399672898699727, - "velocityY": 0.3460539599445595, - "timestamp": 4.597403140925535 - }, - { - "x": 5.575592141235637, - "y": 0.9972199796568127, - "heading": -0.38936097177673723, - "angularVelocity": -6.382841249552677e-7, - "velocityX": -3.433421017026949, - "velocityY": 0.4058921228239739, - "timestamp": 4.668366771554895 - }, - { - "x": 5.334942567663047, - "y": 1.044988031266676, - "heading": -0.389361017575543, - "angularVelocity": -6.453841966108095e-7, - "velocityX": -3.391167721244301, - "velocityY": 0.6731342687263799, - "timestamp": 4.7393304021842555 - }, - { - "x": 5.098765706313627, - "y": 1.1114296874515797, - "heading": -0.3893610653343458, - "angularVelocity": -6.730039375535028e-7, - "velocityX": -3.3281394885636724, - "velocityY": 0.9362775776217799, - "timestamp": 4.810294032813616 - }, - { - "x": 4.868508287372395, - "y": 1.1961381502837038, - "heading": -0.38936111679255236, - "angularVelocity": -7.251349187747336e-7, - "velocityX": -3.24472433131074, - "velocityY": 1.1936884018033496, - "timestamp": 4.881257663442976 + "heading": 2.68750083227073e-24, + "angularVelocity": -1.0022200251051524e-24, + "velocityX": 6.790628726650556e-26, + "velocityY": 3.41370039560792e-26, + "timestamp": 3.461985050855766 + }, + { + "x": 8.251549516655441, + "y": 0.7219586831033024, + "heading": -0.0006660755390764362, + "angularVelocity": -0.009331396835267377, + "velocityX": -0.2707537344882418, + "velocityY": 0.027440204960520992, + "timestamp": 3.5333650972555772 + }, + { + "x": 8.212896688696702, + "y": 0.7258760442658929, + "heading": -0.001998229790486319, + "angularVelocity": -0.018662838126333965, + "velocityX": -0.5415074647365562, + "velocityY": 0.054880339256839474, + "timestamp": 3.6047451436553883 + }, + { + "x": 8.154917446658368, + "y": 0.7317520758923975, + "heading": -0.003996392789209819, + "angularVelocity": -0.027993299241239875, + "velocityX": -0.812261198508941, + "velocityY": 0.08232036714563006, + "timestamp": 3.6761251900551994 + }, + { + "x": 8.077611789765818, + "y": 0.7395867678254814, + "heading": -0.006660425114458462, + "angularVelocity": -0.03732180713818774, + "velocityX": -1.0830149431334009, + "velocityY": 0.10976025273506382, + "timestamp": 3.7475052364550105 + }, + { + "x": 7.980979716767329, + "y": 0.749380107333022, + "heading": -0.00999012297038977, + "angularVelocity": -0.04664745995374023, + "velocityX": -1.353768705293865, + "velocityY": 0.13719995995360584, + "timestamp": 3.8188852828548217 + }, + { + "x": 7.86502122600115, + "y": 0.7611320790926304, + "heading": -0.013985224659649345, + "angularVelocity": -0.0559694465156602, + "velocityX": -1.6245224907346907, + "velocityY": 0.1646394525128738, + "timestamp": 3.8902653292546328 + }, + { + "x": 7.729736315496098, + "y": 0.7748426651724982, + "heading": -0.018645418435560536, + "angularVelocity": -0.06528706565709827, + "velocityX": -1.8952763037908287, + "velocityY": 0.1920786938561615, + "timestamp": 3.961645375654444 + }, + { + "x": 7.575124983133034, + "y": 0.790511845006039, + "heading": -0.023970351697693893, + "angularVelocity": -0.07459974503669481, + "velocityX": -2.1660301465350793, + "velocityY": 0.21951764707149618, + "timestamp": 4.033025422054255 + }, + { + "x": 7.401187226935479, + "y": 0.8081395953535565, + "heading": -0.029959641438283554, + "angularVelocity": -0.08390705866234215, + "velocityX": -2.4367840169688693, + "velocityY": 0.24695627470990408, + "timestamp": 4.1044054684540665 + }, + { + "x": 7.207923045694123, + "y": 0.8277258902299445, + "heading": -0.03661288565920585, + "angularVelocity": -0.09320874048829283, + "velocityX": -2.7075379043444587, + "velocityY": 0.2743945383095141, + "timestamp": 4.175785514853878 + }, + { + "x": 6.995332440744312, + "y": 0.8492707007132015, + "heading": -0.04392967465186433, + "angularVelocity": -0.10250468249454428, + "velocityX": -2.9782917730125558, + "velocityY": 0.3018323967258469, + "timestamp": 4.24716556125369 + }, + { + "x": 6.763415424631655, + "y": 0.872773994034365, + "heading": -0.05190959463777978, + "angularVelocity": -0.11179482766400335, + "velocityX": -3.249045465922667, + "velocityY": 0.32926979606482365, + "timestamp": 4.318545607653501 + }, + { + "x": 6.517888285888531, + "y": 0.8976525425650798, + "heading": -0.051909598739256456, + "angularVelocity": -5.745970870698805e-8, + "velocityX": -3.439716715339282, + "velocityY": 0.348536457812958, + "timestamp": 4.389925654053313 + }, + { + "x": 6.272361147029228, + "y": 0.9225310899511409, + "heading": -0.051909602840455864, + "angularVelocity": -5.7455824331798554e-8, + "velocityX": -3.439716716966896, + "velocityY": 0.3485364417769111, + "timestamp": 4.461305700453124 + }, + { + "x": 6.026834008173439, + "y": 0.94740963737188, + "heading": -0.051909606941655285, + "angularVelocity": -5.7455824691381894e-8, + "velocityX": -3.4397167169176694, + "velocityY": 0.34853644226273583, + "timestamp": 4.532685746852936 + }, + { + "x": 5.7813069462957465, + "y": 0.9722889444800497, + "heading": -0.05190961104285578, + "angularVelocity": -5.745583959865336e-8, + "velocityX": -3.4397156384916827, + "velocityY": 0.348547085116991, + "timestamp": 4.604065793252747 + }, + { + "x": 5.537158225945976, + "y": 1.0082600487060158, + "heading": -0.05190961517853181, + "angularVelocity": -5.793882502411163e-8, + "velocityX": -3.42040573891272, + "velocityY": 0.5039378095173286, + "timestamp": 4.675445839652559 + }, + { + "x": 5.296595540867912, + "y": 1.0633246680240616, + "heading": -0.051909619464878404, + "angularVelocity": -6.004964723504615e-8, + "velocityX": -3.3701671154797745, + "velocityY": 0.7714287408783704, + "timestamp": 4.74682588605237 + }, + { + "x": 5.061109922350585, + "y": 1.137142081975634, + "heading": -0.05190979783691868, + "angularVelocity": -0.0000024989061968370985, + "velocityX": -3.299039863302041, + "velocityY": 1.0341463430565587, + "timestamp": 4.818205932452182 + }, + { + "x": 4.843667300844079, + "y": 1.2172452033533754, + "heading": -0.059561850749452576, + "angularVelocity": -0.10720156820399783, + "velocityX": -3.0462661832492475, + "velocityY": 1.1222060704341816, + "timestamp": 4.8895859788519935 }, { "x": 4.645580768585205, "y": 1.29859459400177, - "heading": -0.38936117353879, - "angularVelocity": -7.996524018828314e-7, - "velocityX": -3.1414333907396923, - "velocityY": 1.4437880757988777, - "timestamp": 4.952221294072336 - }, - { - "x": 4.461481911069297, - "y": 1.3986076661601012, - "heading": -0.38936122478670326, - "angularVelocity": -8.456865275865798e-7, - "velocityX": -3.0379758656861, - "velocityY": 1.6504029605065766, - "timestamp": 5.012820477757534 - }, - { - "x": 4.284474827324454, - "y": 1.510694673133237, - "heading": -0.38936127163806794, - "angularVelocity": -7.731352441209964e-7, - "velocityX": -2.9209483194421555, - "velocityY": 1.8496454928404518, - "timestamp": 5.073419661442731 - }, - { - "x": 4.115350163635107, - "y": 1.6343549075731951, - "heading": -0.3893613156320879, - "angularVelocity": -7.259837067576087e-7, - "velocityX": -2.790873629056165, - "velocityY": 2.0406254163810633, - "timestamp": 5.134018845127929 - }, - { - "x": 3.9548633143870395, - "y": 1.769035927298024, - "heading": -0.3893613579702014, - "angularVelocity": -6.986581485390433e-7, - "velocityX": -2.648333516863359, - "velocityY": 2.2224890094968055, - "timestamp": 5.194618028813126 - }, - { - "x": 3.8037308739642373, - "y": 1.9141358636408468, - "heading": -0.38936139966415195, - "angularVelocity": -6.880282549201409e-7, - "velocityX": -2.493968255544679, - "velocityY": 2.3944206426375816, - "timestamp": 5.255217212498324 - }, - { - "x": 3.661588245211325, - "y": 2.068052981661263, - "heading": -0.38936144155211244, - "angularVelocity": -6.91229781197439e-7, - "velocityX": -2.345619529981126, - "velocityY": 2.539920650086488, - "timestamp": 5.315816396183521 - }, - { - "x": 3.5194491358842597, - "y": 2.221973349800809, - "heading": -0.38936148344023264, - "angularVelocity": -6.91232416307412e-7, - "velocityX": -2.345561452864688, - "velocityY": 2.5399742831378225, - "timestamp": 5.376415579868719 - }, - { - "x": 3.377309938767793, - "y": 2.375893636870205, - "heading": -0.3893615253289459, - "angularVelocity": -6.912422042008341e-7, - "velocityX": -2.3455629015541897, - "velocityY": 2.539972945328553, - "timestamp": 5.4370147635539166 - }, - { - "x": 3.237376278676051, - "y": 2.5255432272973435, - "heading": -0.4037390696912898, - "angularVelocity": -0.23725640327158354, - "velocityX": -2.3091674108792377, - "velocityY": 2.46949845404756, - "timestamp": 5.497613947239114 - }, - { - "x": 3.105303617904582, - "y": 2.668822904326165, - "heading": -0.44298006467609385, - "angularVelocity": -0.6475498942139972, - "velocityX": -2.1794462027337684, - "velocityY": 2.3643829556044245, - "timestamp": 5.558213130924312 - }, - { - "x": 2.9827030369168717, - "y": 2.801822488594932, - "heading": -0.4839708463152926, - "angularVelocity": -0.6764246504068283, - "velocityX": -2.0231391502664464, - "velocityY": 2.194742176060946, - "timestamp": 5.618812314609509 - }, - { - "x": 2.869593703886996, - "y": 2.924535645165437, - "heading": -0.5240655796457002, - "angularVelocity": -0.6616381755023828, - "velocityX": -1.866515787035351, - "velocityY": 2.0249968581751787, - "timestamp": 5.679411498294707 - }, - { - "x": 2.7659536958829163, - "y": 3.0369758685439536, - "heading": -0.5621961207653314, - "angularVelocity": -0.6292253261646749, - "velocityX": -1.7102541932325803, - "velocityY": 1.8554742249107699, - "timestamp": 5.740010681979904 - }, - { - "x": 2.6717655880666005, - "y": 3.13915624073865, - "heading": -0.5977862389011358, - "angularVelocity": -0.5873035901059204, - "velocityX": -1.5542801418845433, - "velocityY": 1.686167469276597, - "timestamp": 5.800609865665102 - }, - { - "x": 2.587017347476756, - "y": 3.2310880524733365, - "heading": -0.6304747734177004, - "angularVelocity": -0.5394220273061133, - "velocityX": -1.3985046569289994, - "velocityY": 1.5170470317266471, - "timestamp": 5.8612090493502995 - }, - { - "x": 2.5117006571972906, - "y": 3.3127809668412036, - "heading": -0.6600126072321035, - "angularVelocity": -0.48742956617777783, - "velocityX": -1.2428664166620311, - "velocityY": 1.3480860533080463, - "timestamp": 5.921808233035497 - }, - { - "x": 2.4458096085005643, - "y": 3.3842432936093614, - "heading": -0.6862159260863127, - "angularVelocity": -0.43240382560813195, - "velocityX": -1.0873256814649452, - "velocityY": 1.1792622016064225, - "timestamp": 5.982407416720695 - }, - { - "x": 2.3893398364344187, - "y": 3.445482204596666, - "heading": -0.7089422053012937, - "angularVelocity": -0.3750261609634924, - "velocityX": -0.9318569761516383, - "velocityY": 1.010556698344825, - "timestamp": 6.043006600405892 - }, - { - "x": 2.34228795390179, - "y": 3.4965038869924845, - "heading": -0.7280767545715167, - "angularVelocity": -0.3157558915252676, - "velocityX": -0.7764441642820773, - "velocityY": 0.8419532952930199, - "timestamp": 6.10360578409109 - }, - { - "x": 2.304651173054735, - "y": 3.5373136514659973, - "heading": -0.7435246612107332, - "angularVelocity": -0.2549193850442921, - "velocityX": -0.621077357123682, - "velocityY": 0.6734375282266625, - "timestamp": 6.164204967776287 - }, - { - "x": 2.27642704429132, - "y": 3.567916009656823, - "heading": -0.7552056856738262, - "angularVelocity": -0.19275877582400947, - "velocityX": -0.4657509729839714, - "velocityY": 0.504996211661866, - "timestamp": 6.224804151461485 - }, - { - "x": 2.257613270327787, - "y": 3.5883147313045463, - "heading": -0.7630508468581061, - "angularVelocity": -0.12945984924539836, - "velocityX": -0.31046249832782574, - "velocityY": 0.33661710285886326, - "timestamp": 6.2854033351466825 + "heading": -0.06951316932259947, + "angularVelocity": -0.13941317041751372, + "velocityX": -2.7750967146947323, + "velocityY": 1.13966570143067, + "timestamp": 4.960966025251805 + }, + { + "x": 4.474092871614693, + "y": 1.385887514867849, + "heading": -0.08242444337490663, + "angularVelocity": -0.2012909785735536, + "velocityX": -2.6735523121009726, + "velocityY": 1.3609251412750347, + "timestamp": 5.025108363591072 + }, + { + "x": 4.3102265492062894, + "y": 1.4867635843508433, + "heading": -0.10022801616986421, + "angularVelocity": -0.27756351352189995, + "velocityX": -2.554729475898846, + "velocityY": 1.5726908637073918, + "timestamp": 5.0892507019303395 + }, + { + "x": 4.155003391680842, + "y": 1.6004909974861876, + "heading": -0.12448541502532746, + "angularVelocity": -0.37818076926286603, + "velocityX": -2.419979713000573, + "velocityY": 1.7730475077757013, + "timestamp": 5.153393040269607 + }, + { + "x": 4.00926290540325, + "y": 1.7261407641347544, + "heading": -0.1583340022250027, + "angularVelocity": -0.5277105274934034, + "velocityX": -2.2721417717378642, + "velocityY": 1.958920892218929, + "timestamp": 5.217535378608874 + }, + { + "x": 3.8730404280351673, + "y": 1.8620509915016963, + "heading": -0.21028223642363456, + "angularVelocity": -0.8098899345368795, + "velocityX": -2.1237529047906247, + "velocityY": 2.1188848253095043, + "timestamp": 5.281677716948141 + }, + { + "x": 3.741564544573194, + "y": 2.0025580918468195, + "heading": -0.2996033949603487, + "angularVelocity": -1.3925460288689253, + "velocityX": -2.049751955822999, + "velocityY": 2.1905515761202894, + "timestamp": 5.345820055287408 + }, + { + "x": 3.6100546633718698, + "y": 2.1430333719703096, + "heading": -0.3901784541639511, + "angularVelocity": -1.4120947497193557, + "velocityX": -2.050281991681201, + "velocityY": 2.1900554884743153, + "timestamp": 5.409962393626675 + }, + { + "x": 3.4785072023626884, + "y": 2.2834734612659138, + "heading": -0.4827580204171881, + "angularVelocity": -1.4433456691827582, + "velocityX": -2.0508678731571766, + "velocityY": 2.1895068519762364, + "timestamp": 5.474104731965943 + }, + { + "x": 3.346919123497923, + "y": 2.423875493587476, + "heading": -0.5782456610362502, + "angularVelocity": -1.488683498159982, + "velocityX": -2.051501118789228, + "velocityY": 2.188913531323639, + "timestamp": 5.53824707030521 + }, + { + "x": 3.2152861692168586, + "y": 2.5642354541414827, + "heading": -0.6777971832870476, + "angularVelocity": -1.552040739834588, + "velocityX": -2.052200741183146, + "velocityY": 2.1882576187291725, + "timestamp": 5.602389408644477 + }, + { + "x": 3.0838454699327147, + "y": 2.704775469009889, + "heading": -0.7323199293584344, + "angularVelocity": -0.8500274153243377, + "velocityX": -2.049203423001438, + "velocityY": 2.1910647242863015, + "timestamp": 5.666531746983744 + }, + { + "x": 2.9552905266702094, + "y": 2.842272453022611, + "heading": -0.7381340958895165, + "angularVelocity": -0.0906447548003214, + "velocityX": -2.0042135442980085, + "velocityY": 2.143622879562956, + "timestamp": 5.730674085323011 + }, + { + "x": 2.837445531451434, + "y": 2.968312162646033, + "heading": -0.7431823028036986, + "angularVelocity": -0.07870319425338904, + "velocityX": -1.837241957027799, + "velocityY": 1.965000230530428, + "timestamp": 5.794816423662279 + }, + { + "x": 2.7303126070394907, + "y": 3.082893932918914, + "heading": -0.747653667364265, + "angularVelocity": -0.06971003359615609, + "velocityX": -1.6702372751876633, + "velocityY": 1.7863672145350264, + "timestamp": 5.858958762001546 + }, + { + "x": 2.6338923756777755, + "y": 3.1860176221630003, + "heading": -0.751611677644213, + "angularVelocity": -0.061706672728596555, + "velocityX": -1.5032228923697837, + "velocityY": 1.6077319897293985, + "timestamp": 5.923101100340813 + }, + { + "x": 2.5481851332942993, + "y": 3.277683175661144, + "heading": -0.7550881872685589, + "angularVelocity": -0.05419992027664412, + "velocityX": -1.3362038959375901, + "velocityY": 1.4290959118655384, + "timestamp": 5.98724343868008 + }, + { + "x": 2.473191052958317, + "y": 3.3578905661578986, + "heading": -0.7581023488644949, + "angularVelocity": -0.04699176353679586, + "velocityX": -1.1691822012991828, + "velocityY": 1.2504594090803822, + "timestamp": 6.051385777019347 + }, + { + "x": 2.4089102482733002, + "y": 3.4266397779362934, + "heading": -0.7606669459018931, + "angularVelocity": -0.039982905266614695, + "velocityX": -1.0021587355455739, + "velocityY": 1.0718226612625237, + "timestamp": 6.1155281153586145 + }, + { + "x": 2.3553427994564915, + "y": 3.4839308009572485, + "heading": -0.7627911121209714, + "angularVelocity": -0.03311644498900487, + "velocityX": -0.8351340191789587, + "velocityY": 0.893185756932122, + "timestamp": 6.179670453697882 + }, + { + "x": 2.312488766021362, + "y": 3.5297636282468714, + "heading": -0.7644816934670975, + "angularVelocity": -0.026356715235171243, + "velocityX": -0.6681083749778789, + "velocityY": 0.714548743876462, + "timestamp": 6.243812792037149 + }, + { + "x": 2.280348193682581, + "y": 3.5641382545710476, + "heading": -0.7657440057178361, + "angularVelocity": -0.019679860189406772, + "velocityX": -0.501082018070189, + "velocityY": 0.5359116492192578, + "timestamp": 6.307955130376416 + }, + { + "x": 2.2589211184357674, + "y": 3.587054675697436, + "heading": -0.7665822895031111, + "angularVelocity": -0.013069117948915103, + "velocityX": -0.3340550999790392, + "velocityY": 0.35727448857846106, + "timestamp": 6.372097468715683 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.06516842144952234, - "velocityX": -0.15521168163475207, - "velocityY": 0.1682886803086901, - "timestamp": 6.34600251883188 + "angularVelocity": -0.006512243047323657, + "velocityX": -0.1670277322411552, + "velocityY": 0.17863727070052132, + "timestamp": 6.4362398070549505 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -1.08140020207294e-26, - "velocityX": -4.402093490094888e-26, - "velocityY": -5.469457631744455e-26, - "timestamp": 6.406601702517078 - }, - { - "x": 2.252899820442669, - "y": 3.5841608935822804, - "heading": -0.7653000327270449, - "angularVelocity": 0.026996951430568503, - "velocityX": 0.07451701159836764, - "velocityY": -0.2279220907181283, - "timestamp": 6.469570563179999 - }, - { - "x": 2.2625314508292247, - "y": 3.5555407678837927, - "heading": -0.7618779142230176, - "angularVelocity": 0.05434620331382998, - "velocityX": 0.15295862566284854, - "velocityY": -0.4545123636855086, - "timestamp": 6.53253942384292 - }, - { - "x": 2.2773902485258666, - "y": 3.5127562657015337, - "heading": -0.7567066671704831, - "angularVelocity": 0.08212387834388286, - "velocityX": 0.23597056608952433, - "velocityY": -0.6794549199689205, - "timestamp": 6.595508284505841 - }, - { - "x": 2.297815121315827, - "y": 3.4559381539319545, - "heading": -0.7497538991928868, - "angularVelocity": 0.11041597234568314, - "velocityX": 0.32436465540161463, - "velocityY": -0.9023207847722199, - "timestamp": 6.658477145168762 - }, - { - "x": 2.324210222453492, - "y": 3.3852548429790676, - "heading": -0.740981041700234, - "angularVelocity": 0.13932056893350495, - "velocityX": 0.4191770481438562, - "velocityY": -1.1225121466189798, - "timestamp": 6.721446005831683 - }, - { - "x": 2.3570643106323765, - "y": 3.300928786576667, - "heading": -0.7303424220044314, - "angularVelocity": 0.16895048733297416, - "velocityX": 0.5217513519063973, - "velocityY": -1.33917075066368, - "timestamp": 6.784414866494604 - }, - { - "x": 2.396977578495247, - "y": 3.2032627196422863, - "heading": -0.7177841287199045, - "angularVelocity": 0.19943656518978173, - "velocityX": 0.6338572342372608, - "velocityY": -1.551021662233946, - "timestamp": 6.847383727157525 - }, - { - "x": 2.4446988674908763, - "y": 3.0926833438789934, - "heading": -0.7032425794761846, - "angularVelocity": 0.2309323861132317, - "velocityX": 0.7578553668151423, - "velocityY": -1.756096181495744, - "timestamp": 6.910352587820446 - }, - { - "x": 2.5011759621015535, - "y": 2.969817102943244, - "heading": -0.6866424992704774, - "angularVelocity": 0.2636236392233503, - "velocityX": 0.8969051371757456, - "velocityY": -1.9512222333744542, - "timestamp": 6.973321448483367 - }, - { - "x": 2.567616640888744, - "y": 2.8356262439165043, - "heading": -0.6678933195188701, - "angularVelocity": 0.2977531998232215, - "velocityX": 1.0551354762928686, - "velocityY": -2.131066968879719, - "timestamp": 7.036290309146288 - }, - { - "x": 2.645534264440632, - "y": 2.691654750192989, - "heading": -0.646881125730223, - "angularVelocity": 0.33369182112294454, - "velocityX": 1.2373992911987053, - "velocityY": -2.28639191193581, - "timestamp": 7.099259169809209 - }, - { - "x": 2.736669367471753, - "y": 2.540436142692156, - "heading": -0.6234515269375929, - "angularVelocity": 0.37208230458625247, - "velocityX": 1.4473043036140854, - "velocityY": -2.4014823503052147, - "timestamp": 7.16222803047213 - }, - { - "x": 2.8425129383801573, - "y": 2.3859371382768275, - "heading": -0.5973967555496894, - "angularVelocity": 0.41377231719940855, - "velocityX": 1.6808875020781504, - "velocityY": -2.453577892132726, - "timestamp": 7.2251968911350515 - }, - { - "x": 2.963311384732838, - "y": 2.2333153163785404, - "heading": -0.5685648668222174, - "angularVelocity": 0.45787534384355805, - "velocityX": 1.9183838659449153, - "velocityY": -2.4237666092656225, - "timestamp": 7.2881657517979725 - }, - { - "x": 3.0976033560224936, - "y": 2.0874389211680247, - "heading": -0.5371913209271666, - "angularVelocity": 0.4982390591914446, - "velocityX": 2.1326727191164423, - "velocityY": -2.316643396033605, - "timestamp": 7.351134612460894 - }, - { - "x": 3.243098632839074, - "y": 1.9516892209576022, - "heading": -0.5039062126583729, - "angularVelocity": 0.5285963239349766, - "velocityX": 2.3105909061215564, - "velocityY": -2.155822715883417, - "timestamp": 7.414103473123815 - }, - { - "x": 3.3976251134783033, - "y": 1.8280561952151033, - "heading": -0.46938250382851276, - "angularVelocity": 0.5482663727182444, - "velocityX": 2.454014238345947, - "velocityY": -1.9633994396741585, - "timestamp": 7.477072333786736 - }, - { - "x": 3.5594390798942475, - "y": 1.7176676369691386, - "heading": -0.4341632224479872, - "angularVelocity": 0.5593126667648981, - "velocityX": 2.569745819003335, - "velocityY": -1.7530658341888512, - "timestamp": 7.540041194449657 - }, - { - "x": 3.7272023835124437, - "y": 1.6211781420495261, - "heading": -0.39865477290597295, - "angularVelocity": 0.5639049074128062, - "velocityX": 2.6642264422767874, - "velocityY": -1.53233668044482, - "timestamp": 7.603010055112578 - }, - { - "x": 3.899888221446412, - "y": 1.5389840565105595, - "heading": -0.3631603025642866, - "angularVelocity": 0.5636829056141273, - "velocityX": 2.742400547127167, - "velocityY": -1.3053132083643786, - "timestamp": 7.665978915775499 - }, - { - "x": 4.076696851523407, - "y": 1.4713359142845162, - "heading": -0.3279103897160568, - "angularVelocity": 0.5597991209802323, - "velocityX": 2.807874054184828, - "velocityY": -1.0743110406296095, - "timestamp": 7.72894777643842 - }, - { - "x": 4.256993589599204, - "y": 1.4183982591672766, - "heading": -0.2930847973848664, - "angularVelocity": 0.5530605439665741, - "velocityX": 2.863268227782371, - "velocityY": -0.8406957750215746, - "timestamp": 7.791916637101341 - }, - { - "x": 4.44026531147135, - "y": 1.3802827225820995, - "heading": -0.2588270299037879, - "angularVelocity": 0.5440429939563951, - "velocityX": 2.9105135449920296, - "velocityY": -0.6053077058073763, - "timestamp": 7.854885497764262 + "angularVelocity": 1.4318885213105956e-25, + "velocityX": -3.1664598929952935e-25, + "velocityY": -8.517319099705152e-26, + "timestamp": 6.500382145394218 + }, + { + "x": 2.254662845986897, + "y": 3.5873395415687703, + "heading": -0.7560028105976356, + "angularVelocity": 0.18270874766778025, + "velocityX": 0.10724881682251722, + "velocityY": -0.18563544290641987, + "timestamp": 6.560571871079167 + }, + { + "x": 2.267640389134434, + "y": 3.5649741905137224, + "heading": -0.7343324319976283, + "angularVelocity": 0.3600345134223772, + "velocityX": 0.2156106046315132, + "velocityY": -0.3715808769774839, + "timestamp": 6.620761596764117 + }, + { + "x": 2.2872156815111926, + "y": 3.5313939684851823, + "heading": -0.7023698583511744, + "angularVelocity": 0.5310303923589071, + "velocityX": 0.3252264760138822, + "velocityY": -0.5579062148298977, + "timestamp": 6.680951322449067 + }, + { + "x": 2.313473905100035, + "y": 3.486574818355693, + "heading": -0.6605397935243593, + "angularVelocity": 0.6949701855390652, + "velocityX": 0.4362575720362232, + "velocityY": -0.7446312409544028, + "timestamp": 6.741141048134017 + }, + { + "x": 2.3465132166718874, + "y": 3.4304964860969096, + "heading": -0.6092924367494605, + "angularVelocity": 0.851430309603703, + "velocityX": 0.54891945752984, + "velocityY": -0.9316927701633545, + "timestamp": 6.801330773818966 + }, + { + "x": 2.3864518087256505, + "y": 3.3631500739334586, + "heading": -0.5490846408400017, + "angularVelocity": 1.0003002210809777, + "velocityX": 0.6635450087081837, + "velocityY": -1.118902128179834, + "timestamp": 6.861520499503916 + }, + { + "x": 2.4334407524616903, + "y": 3.284548274129898, + "heading": -0.48037214659109057, + "angularVelocity": 1.1415983951907667, + "velocityX": 0.7806804766313955, + "velocityY": -1.3059006152476056, + "timestamp": 6.921710225188866 + }, + { + "x": 2.4876845583004745, + "y": 3.194738200368583, + "heading": -0.4036330691658326, + "angularVelocity": 1.2749531012474145, + "velocityX": 0.9012137075139995, + "velocityY": -1.4921163494149543, + "timestamp": 6.9818999508738155 + }, + { + "x": 2.549471334765238, + "y": 3.093817881877023, + "heading": -0.3194506455237171, + "angularVelocity": 1.3986178319328149, + "velocityX": 1.0265336112042236, + "velocityY": -1.6767034131340948, + "timestamp": 7.042089676558765 + }, + { + "x": 2.619215453459605, + "y": 2.98196209624742, + "heading": -0.22869362474666396, + "angularVelocity": 1.5078490513829745, + "velocityX": 1.1587379390866084, + "velocityY": -1.858386699003879, + "timestamp": 7.102279402243715 + }, + { + "x": 2.6975187688111633, + "y": 2.859476881700614, + "heading": -0.13286180386406954, + "angularVelocity": 1.592162446198965, + "velocityX": 1.3009415553980122, + "velocityY": -2.0349854257174798, + "timestamp": 7.162469127928665 + }, + { + "x": 2.7852562883718943, + "y": 2.726945932671376, + "heading": -0.034753273861128454, + "angularVelocity": 1.6299879902505128, + "velocityX": 1.4576826619874292, + "velocityY": -2.201886576505485, + "timestamp": 7.2226588536136145 + }, + { + "x": 2.883617018333608, + "y": 2.5856822162797477, + "heading": 0.06025595074389153, + "angularVelocity": 1.5784957237108086, + "velocityX": 1.6341780734566165, + "velocityY": -2.3469739192871995, + "timestamp": 7.282848579298564 + }, + { + "x": 2.993618091797967, + "y": 2.439544726598588, + "heading": 0.14260766445208392, + "angularVelocity": 1.3682021768838868, + "velocityX": 1.8275722677344666, + "velocityY": -2.427947428205354, + "timestamp": 7.343038304983514 + }, + { + "x": 3.1145276346410644, + "y": 2.293581984129882, + "heading": 0.20384383077417081, + "angularVelocity": 1.017385702048459, + "velocityX": 2.008807009288801, + "velocityY": -2.425044155089132, + "timestamp": 7.403228030668464 + }, + { + "x": 3.2468175816396365, + "y": 2.1505705427004553, + "heading": 0.24757858696307516, + "angularVelocity": 0.7266149777426218, + "velocityX": 2.197882537146209, + "velocityY": -2.3760108523834984, + "timestamp": 7.463417756353413 + }, + { + "x": 3.390280853000983, + "y": 2.013955912336661, + "heading": 0.2801226137384155, + "angularVelocity": 0.5406907309344624, + "velocityX": 2.3835176141568395, + "velocityY": -2.269733394016016, + "timestamp": 7.523607482038363 + }, + { + "x": 3.544035674658465, + "y": 1.8860535950620219, + "heading": 0.3061151888137327, + "angularVelocity": 0.43184405277687576, + "velocityX": 2.55450278112711, + "velocityY": -2.1249858812136204, + "timestamp": 7.583797207723313 + }, + { + "x": 3.7070451600522367, + "y": 1.7682529006317282, + "heading": 0.3281829520976596, + "angularVelocity": 0.36663671470170595, + "velocityX": 2.7082609787426026, + "velocityY": -1.9571561938476998, + "timestamp": 7.643986933408263 + }, + { + "x": 3.8782577243031593, + "y": 1.6615213018872745, + "heading": 0.34797198576359334, + "angularVelocity": 0.328777601837151, + "velocityX": 2.844548007198066, + "velocityY": -1.7732527857514622, + "timestamp": 7.704176659093212 + }, + { + "x": 4.056668173911873, + "y": 1.5665668328609006, + "heading": 0.3664586508169338, + "angularVelocity": 0.30713987882425087, + "velocityX": 2.964134618964106, + "velocityY": -1.5775860073427241, + "timestamp": 7.764366384778162 + }, + { + "x": 4.241342350555325, + "y": 1.4839195959237403, + "heading": 0.38411092010286374, + "angularVelocity": 0.2932771180637541, + "velocityX": 3.0682010017804235, + "velocityY": -1.3731120385854438, + "timestamp": 7.824556110463112 + }, + { + "x": 4.431417064671585, + "y": 1.4139831463989663, + "heading": 0.40101516097721396, + "angularVelocity": 0.2808492758852529, + "velocityX": 3.1579262399560672, + "velocityY": -1.1619333487386434, + "timestamp": 7.884745836148062 }, { "x": 4.626090049743652, "y": 1.3570671081542969, - "heading": -0.2252540457724002, - "angularVelocity": 0.5331680417580931, - "velocityX": 2.9510576547834098, - "velocityY": -0.36868404769268887, - "timestamp": 7.917854358427183 - }, - { - "x": 4.7795228983991676, - "y": 1.3480834353037912, - "heading": -0.19832188482827373, - "angularVelocity": 0.5230176690450782, - "velocityX": 2.9796380255277914, - "velocityY": -0.17446129345071068, - "timestamp": 7.969348146377596 - }, - { - "x": 4.934335051267773, - "y": 1.3491130117158807, - "heading": -0.172056740336727, - "angularVelocity": 0.5100643308050932, - "velocityX": 3.006423862577084, - "velocityY": 0.01999418673726334, - "timestamp": 8.02084193432801 - }, - { - "x": 5.090413948118965, - "y": 1.360168884425071, - "heading": -0.14663402653796817, - "angularVelocity": 0.49370447991202765, - "velocityX": 3.0310238004143737, - "velocityY": 0.21470303796327495, - "timestamp": 8.072335722278423 - }, - { - "x": 5.247619566908618, - "y": 1.3812649191155169, - "heading": -0.12227147866608945, - "angularVelocity": 0.47311625035895943, - "velocityX": 3.0529045356119044, - "velocityY": 0.40968115825467694, - "timestamp": 8.123829510228836 - }, - { - "x": 5.4057731675659, - "y": 1.4124150256360237, - "heading": -0.09924657329539176, - "angularVelocity": 0.44713947618050653, - "velocityX": 3.071314171130302, - "velocityY": 0.6049294052809526, - "timestamp": 8.175323298179249 - }, - { - "x": 5.5646390861224075, - "y": 1.45363107671834, - "heading": -0.07792489052125452, - "angularVelocity": 0.4140632030152733, - "velocityX": 3.0851472552279695, - "velocityY": 0.800408218599227, - "timestamp": 8.226817086129662 - }, - { - "x": 5.723893474298032, - "y": 1.5049174237552059, - "heading": -0.05880915750982748, - "angularVelocity": 0.3712240596833731, - "velocityX": 3.092691264604229, - "velocityY": 0.9959715351733922, - "timestamp": 8.278310874080075 - }, - { - "x": 5.883066591645663, - "y": 1.5662557379507007, - "heading": -0.042630346143135614, - "angularVelocity": 0.3141895752992888, - "velocityX": 3.0911129999002838, - "velocityY": 1.1911789098631071, - "timestamp": 8.329804662030488 - }, - { - "x": 6.041427156723219, - "y": 1.6375588012052558, - "heading": -0.030529304649750223, - "angularVelocity": 0.23500002573200407, - "velocityX": 3.0753333825442057, - "velocityY": 1.3846925249161675, - "timestamp": 8.381298449980902 - }, - { - "x": 6.197735616366119, - "y": 1.7185102905390748, - "heading": -0.02440648394476851, - "angularVelocity": 0.11890406491124374, - "velocityX": 3.03548186809291, - "velocityY": 1.5720632052117265, - "timestamp": 8.432792237931315 - }, - { - "x": 6.350878760533044, - "y": 1.8088430675496858, - "heading": -0.02370516902673881, - "angularVelocity": 0.013619408203277727, - "velocityX": 2.974012017030059, - "velocityY": 1.7542461062992514, - "timestamp": 8.484286025881728 - }, - { - "x": 6.49883867677636, - "y": 1.9078525669236166, - "heading": -0.023705030592543242, - "angularVelocity": 0.00000268836690944849, - "velocityX": 2.87335467310732, - "velocityY": 1.9227464770949503, - "timestamp": 8.535779813832141 - }, - { - "x": 6.6368843214415145, - "y": 2.005708147416312, - "heading": -0.02031833183947682, - "angularVelocity": 0.06576907405467476, - "velocityX": 2.6808213215560657, - "velocityY": 1.900337582213362, - "timestamp": 8.587273601782554 - }, - { - "x": 6.769983495130022, - "y": 2.0947496708967734, - "heading": -0.01623761727675861, - "angularVelocity": 0.07924673490029181, - "velocityX": 2.5847617544989827, - "velocityY": 1.7291701975043279, - "timestamp": 8.638767389732967 - }, - { - "x": 6.899277502176466, - "y": 2.174423732821602, - "heading": -0.012170511581318438, - "angularVelocity": 0.07898245317195698, - "velocityX": 2.5108661101209155, - "velocityY": 1.5472557971760095, - "timestamp": 8.69026117768338 - }, - { - "x": 7.025204876144901, - "y": 2.244564567879159, - "heading": -0.008393313807594099, - "angularVelocity": 0.07335249403989616, - "velocityX": 2.4454867078277336, - "velocityY": 1.3621222646331712, - "timestamp": 8.741754965633794 - }, - { - "x": 7.147995814523978, - "y": 2.305094760936356, - "heading": -0.0050511985797586055, - "angularVelocity": 0.06490327010034411, - "velocityX": 2.3845776989123575, - "velocityY": 1.1754853442804831, - "timestamp": 8.793248753584207 - }, - { - "x": 7.267791877830481, - "y": 2.3559698887494838, - "heading": -0.002233336230350155, - "angularVelocity": 0.05472237451480506, - "velocityX": 2.3264177694960773, - "velocityY": 0.987985732611455, - "timestamp": 8.84474254153462 - }, - { - "x": 7.384688854217529, - "y": 2.3971612453460693, - "heading": 1.0925161153472216e-27, - "angularVelocity": 0.04337098355438129, - "velocityX": 2.2701180285982674, - "velocityY": 0.7999286561759968, - "timestamp": 8.896236329485033 - }, - { - "x": 7.544023620191157, - "y": 2.435966203020954, - "heading": 0.0019011246470178535, - "angularVelocity": 0.026160817083458833, - "velocityX": 2.192558848895233, - "velocityY": 0.5339836087320412, - "timestamp": 8.968907020195987 - }, - { - "x": 7.693524178473687, - "y": 2.4572035222971533, - "heading": 0.002758770210903803, - "angularVelocity": 0.011801808342475038, - "velocityX": 2.0572332094264283, - "velocityY": 0.2922405039559972, - "timestamp": 9.04157771090694 - }, - { - "x": 7.829036837050654, - "y": 2.463958358878795, - "heading": 0.0028691396117968893, - "angularVelocity": 0.0015187608623685705, - "velocityX": 1.8647498358859305, - "velocityY": 0.09295131937728546, - "timestamp": 9.114248401617894 - }, - { - "x": 7.947320999686337, - "y": 2.4602902191152674, - "heading": 0.0025271461142305205, - "angularVelocity": -0.0047060719283190024, - "velocityX": 1.627673570713082, - "velocityY": -0.05047619236368362, - "timestamp": 9.186919092328848 - }, - { - "x": 8.046460357109755, - "y": 2.4503798577507845, - "heading": 0.001958139051774138, - "angularVelocity": -0.007829938822511021, - "velocityX": 1.3642275373127128, - "velocityY": -0.13637356776890003, - "timestamp": 9.259589783039802 - }, - { - "x": 8.125632240809198, - "y": 2.437861956883479, - "heading": 0.0013192069681426308, - "angularVelocity": -0.008792156471621461, - "velocityX": 1.0894610044969755, - "velocityY": -0.17225515190292298, - "timestamp": 9.332260473750756 - }, - { - "x": 8.184669067426317, - "y": 2.4256259475095856, - "heading": 0.0007241468388369009, - "angularVelocity": -0.008188447412349163, - "velocityX": 0.8123884063788063, - "velocityY": -0.16837612597576837, - "timestamp": 9.40493116446171 - }, - { - "x": 8.22372517511611, - "y": 2.4158933838582373, - "heading": 0.00026082496046711366, - "angularVelocity": -0.006375636089832219, - "velocityX": 0.5374396102156157, - "velocityY": -0.13392694573469127, - "timestamp": 9.477601855172663 + "heading": 0.41697492722531376, + "angularVelocity": 0.26515765052058465, + "velocityX": 3.2343225169531657, + "velocityY": -0.9456105273279376, + "timestamp": 7.944935561833011 + }, + { + "x": 4.771095590246596, + "y": 1.3224217071642599, + "heading": 0.4280403505516019, + "angularVelocity": 0.2504578977864778, + "velocityX": 3.2820961088293013, + "velocityY": -0.7841737314576779, + "timestamp": 7.989116334026994 + }, + { + "x": 4.917956708237317, + "y": 1.2949736641198544, + "heading": 0.43814957517205777, + "angularVelocity": 0.22881502786030425, + "velocityX": 3.3240957705742336, + "velocityY": -0.6212667113171019, + "timestamp": 8.033297106220976 + }, + { + "x": 5.066406183363406, + "y": 1.2747799857702726, + "heading": 0.4470279058701966, + "angularVelocity": 0.20095462929342126, + "velocityX": 3.3600470918502436, + "velocityY": -0.45706938441270734, + "timestamp": 8.077477878414959 + }, + { + "x": 5.21616079891639, + "y": 1.2618903010738838, + "heading": 0.45444388098508137, + "angularVelocity": 0.16785526251835975, + "velocityX": 3.389588006643782, + "velocityY": -0.2917487417330471, + "timestamp": 8.121658650608941 + }, + { + "x": 5.366915459547734, + "y": 1.25634723736205, + "heading": 0.46022561365529296, + "angularVelocity": 0.13086536027088905, + "velocityX": 3.4122233076740254, + "velocityY": -0.12546326006925063, + "timestamp": 8.165839422802923 + }, + { + "x": 5.518334246127743, + "y": 1.2581861921582334, + "heading": 0.4642859914379861, + "angularVelocity": 0.09190373053837578, + "velocityX": 3.427255320825579, + "velocityY": 0.041623419077170896, + "timestamp": 8.210020194996906 + }, + { + "x": 5.670036777042452, + "y": 1.2674335281135962, + "heading": 0.46666317405037006, + "angularVelocity": 0.05380581855714505, + "velocityX": 3.4336776697481812, + "velocityY": 0.20930679787037068, + "timestamp": 8.254200967190888 + }, + { + "x": 5.821577538212164, + "y": 1.284100828351401, + "heading": 0.4675873844825302, + "angularVelocity": 0.020918838360320994, + "velocityX": 3.4300161279288752, + "velocityY": 0.3772523523270378, + "timestamp": 8.29838173938487 + }, + { + "x": 5.972415606183977, + "y": 1.3081694677842932, + "heading": 0.467591351779606, + "angularVelocity": 0.00008979691569104718, + "velocityX": 3.414111172831806, + "velocityY": 0.544776341328194, + "timestamp": 8.342562511578853 + }, + { + "x": 6.121903298527153, + "y": 1.3395574928087577, + "heading": 0.46759157023044867, + "angularVelocity": 0.000004944477695120892, + "velocityX": 3.3835463917839124, + "velocityY": 0.7104453694618647, + "timestamp": 8.386743283772836 + }, + { + "x": 6.269684547080798, + "y": 1.3781901650520143, + "heading": 0.46759176450370754, + "angularVelocity": 0.0000043972354751028654, + "velocityX": 3.3449222640289906, + "velocityY": 0.8744227482859289, + "timestamp": 8.430924055966818 + }, + { + "x": 6.415408472766336, + "y": 1.423975753200933, + "heading": 0.4675919413300162, + "angularVelocity": 0.000004002336308335113, + "velocityX": 3.2983562407129146, + "velocityY": 1.036323854818335, + "timestamp": 8.4751048281608 + }, + { + "x": 6.5587290836787195, + "y": 1.476805540848842, + "heading": 0.4675921046539949, + "angularVelocity": 0.0000036967207824585226, + "velocityX": 3.243958939493236, + "velocityY": 1.1957642436839244, + "timestamp": 8.519285600354783 + }, + { + "x": 6.6993060573570675, + "y": 1.5365540678009835, + "heading": 0.46759241978399874, + "angularVelocity": 0.000007132740968196116, + "velocityX": 3.1818586841606873, + "velocityY": 1.352364931282918, + "timestamp": 8.563466372548765 + }, + { + "x": 6.836206251960683, + "y": 1.6027005176579716, + "heading": 0.47022361687585157, + "angularVelocity": 0.059555253590862826, + "velocityX": 3.0986374344598233, + "velocityY": 1.4971773142977605, + "timestamp": 8.607647144742748 + }, + { + "x": 6.968107168767895, + "y": 1.6730618727776314, + "heading": 0.48242555808722076, + "angularVelocity": 0.27618216263388745, + "velocityX": 2.9854823774487342, + "velocityY": 1.592578663196003, + "timestamp": 8.65182791693673 + }, + { + "x": 7.094292994493853, + "y": 1.7449092475770878, + "heading": 0.5050066138251464, + "angularVelocity": 0.5111059543907503, + "velocityX": 2.8561254016095394, + "velocityY": 1.6262136497750488, + "timestamp": 8.696008689130712 + }, + { + "x": 7.213566146886095, + "y": 1.8140035101921348, + "heading": 0.5272178489693323, + "angularVelocity": 0.5027353312582225, + "velocityX": 2.699662012890034, + "velocityY": 1.5638989357559931, + "timestamp": 8.740189461324695 + }, + { + "x": 7.326317415042033, + "y": 1.87970672983894, + "heading": 0.5469886414915726, + "angularVelocity": 0.44749766788668743, + "velocityX": 2.552043854301269, + "velocityY": 1.4871451172995578, + "timestamp": 8.784370233518677 + }, + { + "x": 7.432769298553467, + "y": 1.941792130470276, + "heading": 0.5633166974965059, + "angularVelocity": 0.3695738031296167, + "velocityX": 2.409461813932093, + "velocityY": 1.405258386130975, + "timestamp": 8.82855100571266 + }, + { + "x": 7.579701459580911, + "y": 2.027179132105106, + "heading": 0.5787605568170214, + "angularVelocity": 0.23108320735340232, + "velocityX": 2.198514913204677, + "velocityY": 1.2776276832472448, + "timestamp": 8.895383466181745 + }, + { + "x": 7.712165331896003, + "y": 2.1039708729412734, + "heading": 0.5887351557050889, + "angularVelocity": 0.14924781787259772, + "velocityX": 1.9820289629523165, + "velocityY": 1.1490186100763133, + "timestamp": 8.96221592665083 + }, + { + "x": 7.830026910442582, + "y": 2.172172632129026, + "heading": 0.5950957258261598, + "angularVelocity": 0.09517186822731284, + "velocityX": 1.7635379233284407, + "velocityY": 1.0204885277162767, + "timestamp": 9.029048387119914 + }, + { + "x": 7.933222174835435, + "y": 2.231800820984951, + "heading": 0.5989654042474855, + "angularVelocity": 0.05790118146429404, + "velocityX": 1.54408896019307, + "velocityY": 0.8922040044224955, + "timestamp": 9.095880847589 + }, + { + "x": 8.021715394731531, + "y": 2.28287256797719, + "heading": 0.6011062262493081, + "angularVelocity": 0.032032667760495764, + "velocityX": 1.3241053714763598, + "velocityY": 0.7641757707822818, + "timestamp": 9.162713308058084 + }, + { + "x": 8.095484569673351, + "y": 2.3254034695687893, + "heading": 0.6020727831826357, + "angularVelocity": 0.014462387386960431, + "velocityX": 1.103792594557322, + "velocityY": 0.6363809037267617, + "timestamp": 9.229545768527169 + }, + { + "x": 8.154515205691396, + "y": 2.359407222237499, + "heading": 0.6022883195935687, + "angularVelocity": 0.003225025824578962, + "velocityX": 0.8832629474318238, + "velocityY": 0.5087909741769772, + "timestamp": 9.296378228996254 + }, + { + "x": 8.198797270954351, + "y": 2.3848957424596233, + "heading": 0.6020871548762373, + "angularVelocity": -0.00300998520658142, + "velocityX": 0.6625831961317433, + "velocityY": 0.38137934834697124, + "timestamp": 9.363210689465339 + }, + { + "x": 8.22832355571237, + "y": 2.401879399345903, + "heading": 0.6017403922656039, + "angularVelocity": -0.005188535753427844, + "velocityX": 0.44179556686643673, + "velocityY": 0.2541228733324269, + "timestamp": 9.430043149934423 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.641597245625212e-27, - "angularVelocity": -0.003589135563669573, - "velocityX": 0.2664560763556175, - "velocityY": -0.07604349651378031, - "timestamp": 9.550272545883617 + "heading": 0.601472494720935, + "angularVelocity": -0.004008494417063559, + "velocityX": 0.220928070177263, + "velocityY": 0.12700192446944059, + "timestamp": 9.496875610403508 }, { "x": 8.243088722229004, "y": 2.410367250442505, - "heading": -4.361709629410748e-27, - "angularVelocity": -2.7031559762411205e-27, - "velocityX": -9.369534952913017e-27, - "velocityY": 1.2495007628787807e-26, - "timestamp": 9.62294323659457 - }, - { - "x": 8.226158676304896, - "y": 2.39881983179468, - "heading": -0.006877427807321125, - "angularVelocity": -0.09330877742815909, - "velocityX": -0.22969661496110166, - "velocityY": -0.156668386301737, - "timestamp": 9.696649355106478 - }, - { - "x": 8.192214379382103, - "y": 2.375824029071353, - "heading": -0.02042318457451623, - "angularVelocity": -0.1837806282663857, - "velocityX": -0.46053567340288404, - "velocityY": -0.31199313147403995, - "timestamp": 9.770355473618386 - }, - { - "x": 8.141157712275694, - "y": 2.3414994370245448, - "heading": -0.04041111919819324, - "angularVelocity": -0.2711841978281327, - "velocityX": -0.6927059535519965, - "velocityY": -0.4656952874443208, - "timestamp": 9.844061592130293 - }, - { - "x": 8.072871873312724, - "y": 2.2959933778891304, - "heading": -0.06658143602528521, - "angularVelocity": -0.3550630172292133, - "velocityX": -0.9264609280969917, - "velocityY": -0.6173986645092744, - "timestamp": 9.9177677106422 - }, - { - "x": 7.987214671186942, - "y": 2.2394915863103373, - "heading": -0.09861576889513941, - "angularVelocity": -0.4346224372767477, - "velocityX": -1.162145068213624, - "velocityY": -0.7665821063371371, - "timestamp": 9.991473829154108 - }, - { - "x": 7.884008802473217, - "y": 2.172234906435376, - "heading": -0.13609803770657058, - "angularVelocity": -0.5085367343740341, - "velocityX": -1.4002347538766595, - "velocityY": -0.912497920564022, - "timestamp": 10.065179947666016 - }, - { - "x": 7.763027309866044, - "y": 2.094546996792591, - "heading": -0.17845040239942064, - "angularVelocity": -0.5746112473146674, - "velocityX": -1.641403658878437, - "velocityY": -1.0540225317961092, - "timestamp": 10.138886066177923 - }, - { - "x": 7.62397118691996, - "y": 2.006883956661221, - "heading": -0.2248232665285972, - "angularVelocity": -0.629158949968104, - "velocityX": -1.886629302336939, - "velocityY": -1.1893590640946199, - "timestamp": 10.21259218468983 - }, - { - "x": 7.466434514515364, - "y": 1.9099324511701785, - "heading": -0.27389375566621527, - "angularVelocity": -0.6657586931496106, - "velocityX": -2.1373622106982135, - "velocityY": -1.3153793395778879, - "timestamp": 10.286298303201738 - }, - { - "x": 7.289854840689643, - "y": 1.804830584603728, - "heading": -0.3234648033769676, - "angularVelocity": -0.6725499688705452, - "velocityX": -2.3957261268234205, - "velocityY": -1.4259585050523371, - "timestamp": 10.360004421713645 - }, - { - "x": 7.09349466770107, - "y": 1.6937580255692442, - "heading": -0.36961157284527874, - "angularVelocity": -0.6260914344696605, - "velocityX": -2.6640959658844117, - "velocityY": -1.5069652462643142, - "timestamp": 10.433710540225553 - }, - { - "x": 6.877068006621772, - "y": 1.582017096134685, - "heading": -0.404526427119755, - "angularVelocity": -0.47370360805033435, - "velocityX": -2.9363459296032848, - "velocityY": -1.5160332912729142, - "timestamp": 10.50741665873746 - }, - { - "x": 6.6462528315178435, - "y": 1.4799569127662018, - "heading": -0.41206265680654897, - "angularVelocity": -0.10224700254126708, - "velocityX": -3.1315605781986564, - "velocityY": -1.3846907886214979, - "timestamp": 10.581122777249368 - }, - { - "x": 6.4056948947586605, - "y": 1.3958836435808737, - "heading": -0.41206291975932646, - "angularVelocity": -0.000003567584113860408, - "velocityX": -3.263744470824617, - "velocityY": -1.1406552248677344, - "timestamp": 10.654828895761275 - }, - { - "x": 6.159103024623084, - "y": 1.3316270436788393, - "heading": -0.4120630054756099, - "angularVelocity": -0.000001162946648180674, - "velocityX": -3.3456092264000836, - "velocityY": -0.8717946515071634, - "timestamp": 10.728535014273183 - }, - { - "x": 5.9081067866465835, - "y": 1.287611751699688, - "heading": -0.4120631078550631, - "angularVelocity": -0.0000013890224484364198, - "velocityX": -3.405365023202921, - "velocityY": -0.5971728381279531, - "timestamp": 10.80224113278509 - }, - { - "x": 5.654364802463367, - "y": 1.264128631365538, - "heading": -0.41206324014800777, - "angularVelocity": -0.0000017948705930666049, - "velocityX": -3.4426176456737716, - "velocityY": -0.3186047618333884, - "timestamp": 10.875947251296997 - }, - { - "x": 5.399553844443695, - "y": 1.2613328653452982, - "heading": -0.41206343250085, - "angularVelocity": -0.0000026097269279134345, - "velocityX": -3.457120835612934, - "velocityY": -0.03793126102262585, - "timestamp": 10.949653369808905 - }, - { - "x": 5.145357769299496, - "y": 1.2792429283311064, - "heading": -0.4120637802864744, - "angularVelocity": -0.000004718544828723013, - "velocityX": -3.4487784769609244, - "velocityY": 0.24299289322791767, - "timestamp": 11.023359488320812 - }, - { - "x": 4.893457071523925, - "y": 1.3177403844081093, - "heading": -0.41206670780497134, - "angularVelocity": -0.00003971879887349745, - "velocityX": -3.4176361862668707, - "velocityY": 0.5223101806776501, - "timestamp": 11.09706560683272 + "heading": 0.601472494720935, + "angularVelocity": 2.0480668095758719e-22, + "velocityX": 1.6959236187935907e-23, + "velocityY": -2.878465592599261e-23, + "timestamp": 9.563708070872593 + }, + { + "x": 8.225716112229817, + "y": 2.403169142964958, + "heading": 0.6014724848808553, + "angularVelocity": -1.401208853680834e-7, + "velocityX": -0.24738269796567666, + "velocityY": -0.10249969625322676, + "timestamp": 9.633933717783428 + }, + { + "x": 8.190970892472077, + "y": 2.3887729281095678, + "heading": 0.6014724652007141, + "angularVelocity": -2.802415057039817e-7, + "velocityX": -0.49476539250476237, + "velocityY": -0.20499939108669155, + "timestamp": 9.704159364694263 + }, + { + "x": 8.138853063244545, + "y": 2.3671786059959783, + "heading": 0.6014724356805342, + "angularVelocity": -4.203618073354203e-7, + "velocityX": -0.7421480829319401, + "velocityY": -0.30749908421644245, + "timestamp": 9.774385011605098 + }, + { + "x": 8.069362624900151, + "y": 2.3383861767704226, + "heading": 0.6014723963203429, + "angularVelocity": -5.604817189302354e-7, + "velocityX": -0.9895307683334543, + "velocityY": -0.40999877526387724, + "timestamp": 9.844610658515933 + }, + { + "x": 7.982499577880061, + "y": 2.3023956406156896, + "heading": 0.6014723471201746, + "angularVelocity": -7.006011425140131e-7, + "velocityX": -1.2369134474528922, + "velocityY": -0.5124984637084178, + "timestamp": 9.914836305426768 + }, + { + "x": 7.878263922751481, + "y": 2.259206997766796, + "heading": 0.601472288080073, + "angularVelocity": -8.407199383581404e-7, + "velocityX": -1.484296118495379, + "velocityY": -0.6149981488063821, + "timestamp": 9.985061952337603 + }, + { + "x": 7.756655660270691, + "y": 2.2088202485370934, + "heading": 0.6014722192000971, + "angularVelocity": -9.808378971745156e-7, + "velocityX": -1.7316787787686057, + "velocityY": -0.7174978294422485, + "timestamp": 10.055287599248437 + }, + { + "x": 7.617674791496479, + "y": 2.1512353933652784, + "heading": 0.6014721404803293, + "angularVelocity": -0.0000011209546846231955, + "velocityX": -1.979061423964885, + "velocityY": -0.8199975038311836, + "timestamp": 10.125513246159272 + }, + { + "x": 7.461321318017023, + "y": 2.0864524329093923, + "heading": 0.6014720519208926, + "angularVelocity": -0.0000012610697164822291, + "velocityX": -2.226444046545777, + "velocityY": -0.9224971688497368, + "timestamp": 10.195738893070107 + }, + { + "x": 7.287595242479287, + "y": 2.014471368266166, + "heading": 0.6014719535219923, + "angularVelocity": -0.0000014011818267188707, + "velocityX": -2.4738266314344535, + "velocityY": -1.0249968182510263, + "timestamp": 10.265964539980942 + }, + { + "x": 7.096496570177163, + "y": 1.935292201629055, + "heading": 0.6014718452840377, + "angularVelocity": -0.0000015412881098024927, + "velocityX": -2.7212091409390613, + "velocityY": -1.1274964364179387, + "timestamp": 10.336190186891777 + }, + { + "x": 6.8880253169921275, + "y": 1.8489149395783349, + "heading": 0.601471727208249, + "angularVelocity": -0.0000016813770192107404, + "velocityX": -2.9685914242944573, + "velocityY": -1.2299959608829605, + "timestamp": 10.406415833802612 + }, + { + "x": 6.663723389677425, + "y": 1.7559784504804536, + "heading": 0.6014717272081879, + "angularVelocity": -8.702352256817885e-13, + "velocityX": -3.1940172455726326, + "velocityY": -1.3233981200042444, + "timestamp": 10.476641480713447 + }, + { + "x": 6.439421272188231, + "y": 1.6630424203676835, + "heading": 0.6014717272081268, + "angularVelocity": -8.703596574297939e-13, + "velocityX": -3.1940199536216154, + "velocityY": -1.3233915841426174, + "timestamp": 10.546867127624282 + }, + { + "x": 6.212032631338727, + "y": 1.577936888330409, + "heading": 0.6014717272080651, + "angularVelocity": -8.787789669679053e-13, + "velocityX": -3.237971465584607, + "velocityY": -1.2118867647503735, + "timestamp": 10.617092774535116 + }, + { + "x": 5.978739653450143, + "y": 1.510684142319498, + "heading": 0.6014717272080008, + "angularVelocity": -9.15623540134239e-13, + "velocityX": -3.32204811419955, + "velocityY": -0.9576664504963734, + "timestamp": 10.687318421445951 + }, + { + "x": 5.7409415584912775, + "y": 1.4616883276374903, + "heading": 0.601471727201828, + "angularVelocity": -8.790086201060278e-11, + "velocityX": -3.386200133703241, + "velocityY": -0.6976911831686963, + "timestamp": 10.757544068356786 + }, + { + "x": 5.516819527735436, + "y": 1.4255992428677315, + "heading": 0.6014714661772929, + "angularVelocity": -0.000003716940268980297, + "velocityX": -3.1914555524195745, + "velocityY": -0.513901777445793, + "timestamp": 10.827769715267621 + }, + { + "x": 5.308884526984856, + "y": 1.3990809310343755, + "heading": 0.6014711092836408, + "angularVelocity": -0.0000050820984614807965, + "velocityX": -2.9609552905164764, + "velocityY": -0.3776157714435294, + "timestamp": 10.897995362178456 + }, + { + "x": 5.1176297142242815, + "y": 1.3812454338123161, + "heading": 0.6014706963446639, + "angularVelocity": -0.000005880173340714845, + "velocityX": -2.7234325516916758, + "velocityY": -0.253974124933375, + "timestamp": 10.96822100908929 + }, + { + "x": 4.943259966846924, + "y": 1.3716872939772524, + "heading": 0.6014702453730658, + "angularVelocity": -0.000006421750712363147, + "velocityX": -2.482992397332454, + "velocityY": -0.13610611301593797, + "timestamp": 11.038446656000126 + }, + { + "x": 4.785886935464025, + "y": 1.3701747617379714, + "heading": 0.6014697666441067, + "angularVelocity": -0.00000681701031230746, + "velocityX": -2.240962359274736, + "velocityY": -0.021538174524779245, + "timestamp": 11.10867230291096 }, { "x": 4.645580768585205, "y": 1.3765579462051392, - "heading": -0.4122949138101138, - "angularVelocity": -0.0030961609395507624, - "velocityX": -3.363035633177095, - "velocityY": 0.7980010748704317, - "timestamp": 11.170771725344627 - }, - { - "x": 4.443925231966549, - "y": 1.439020065928105, - "heading": -0.4125273897788825, - "angularVelocity": -0.003806087702589553, - "velocityX": -3.3014967617877016, - "velocityY": 1.0226274440941339, - "timestamp": 11.231851759998202 - }, - { - "x": 4.246892810528237, - "y": 1.5149356606131386, - "heading": -0.41260940539586727, - "angularVelocity": -0.0013427565562128022, - "velocityX": -3.2258072962108524, - "velocityY": 1.242887223551879, - "timestamp": 11.292931794651777 - }, - { - "x": 4.05539885725619, - "y": 1.6039545655503569, - "heading": -0.41261007048157244, - "angularVelocity": -0.000010888757822699568, - "velocityX": -3.1351317064264514, - "velocityY": 1.4574141197218358, - "timestamp": 11.354011829305351 - }, - { - "x": 3.870332686379004, - "y": 1.705664249073373, - "heading": -0.4126103244982615, - "angularVelocity": -0.000004158751555602436, - "velocityX": -3.029896297977233, - "velocityY": 1.6651870631685113, - "timestamp": 11.415091863958926 - }, - { - "x": 3.6925342411729205, - "y": 1.8196030932877822, - "heading": -0.4126105942683028, - "angularVelocity": -0.000004416664836793854, - "velocityX": -2.910909370213978, - "velocityY": 1.8654024160371316, - "timestamp": 11.4761718986125 - }, - { - "x": 3.5229313973486467, - "y": 1.9451682176450034, - "heading": -0.41310298698073444, - "angularVelocity": -0.00806143472616382, - "velocityX": -2.7767312966701, - "velocityY": 2.0557474315360964, - "timestamp": 11.537251933266075 - }, - { - "x": 3.3629080056368847, - "y": 2.081177909355995, - "heading": -0.41684782301867235, - "angularVelocity": -0.061310312922665575, - "velocityX": -2.6198968716923905, - "velocityY": 2.226745490279982, - "timestamp": 11.59833196791965 - }, - { - "x": 3.2138348018272307, - "y": 2.225828798378681, - "heading": -0.42779633021695374, - "angularVelocity": -0.17924854267646892, - "velocityX": -2.4406208125969044, - "velocityY": 2.368218843409276, - "timestamp": 11.659412002573225 - }, - { - "x": 3.076632646241407, - "y": 2.3767820823282975, - "heading": -0.45028005155414713, - "angularVelocity": -0.3681026290294955, - "velocityX": -2.2462684634019734, - "velocityY": 2.4714014130111956, - "timestamp": 11.7204920372268 - }, - { - "x": 2.953317405786702, - "y": 2.527452693090262, - "heading": -0.479539871258463, - "angularVelocity": -0.4790406533046003, - "velocityX": -2.018912418012011, - "velocityY": 2.466773498353727, - "timestamp": 11.781572071880374 - }, - { - "x": 2.8431421656158986, - "y": 2.6728620421564, - "heading": -0.5117573524705473, - "angularVelocity": -0.5274633748132465, - "velocityX": -1.8037848340407943, - "velocityY": 2.3806363223408726, - "timestamp": 11.842652106533949 - }, - { - "x": 2.7447582014328504, - "y": 2.8103234089599436, - "heading": -0.5448138902366748, - "angularVelocity": -0.541200376745252, - "velocityX": -1.6107385128552993, - "velocityY": 2.250512259581694, - "timestamp": 11.903732141187524 - }, - { - "x": 2.657040568190158, - "y": 2.9383742562516337, - "heading": -0.5774389967679732, - "angularVelocity": -0.5341370010075654, - "velocityX": -1.436109749121744, - "velocityY": 2.0964435927050773, - "timestamp": 11.964812175841098 - }, - { - "x": 2.579139377940474, - "y": 3.0561477275760893, - "heading": -0.6087739702949048, - "angularVelocity": -0.5130149926183435, - "velocityX": -1.2753953184786753, - "velocityY": 1.9281827849710216, - "timestamp": 12.025892210494673 - }, - { - "x": 2.5104135669776086, - "y": 3.1630880849973138, - "heading": -0.6382063942290674, - "angularVelocity": -0.4818665231788694, - "velocityX": -1.12517635840673, - "velocityY": 1.7508234569242558, - "timestamp": 12.086972245148248 - }, - { - "x": 2.450370390547826, - "y": 3.258815753261752, - "heading": -0.6652836730357979, - "angularVelocity": -0.4433081768912526, - "velocityX": -0.9830245966677624, - "velocityY": 1.5672497372893452, - "timestamp": 12.148052279801822 - }, - { - "x": 2.3986225657417113, - "y": 3.3430581424304706, - "heading": -0.6896607419023619, - "angularVelocity": -0.39910044263764155, - "velocityX": -0.8472134159649896, - "velocityY": 1.3792131855607757, - "timestamp": 12.209132314455397 - }, - { - "x": 2.354859160136495, - "y": 3.415611519736344, - "heading": -0.7110667492722108, - "angularVelocity": -0.35045833702054285, - "velocityX": -0.7164928090402631, - "velocityY": 1.1878411287317068, - "timestamp": 12.270212349108972 - }, - { - "x": 2.318825720632345, - "y": 3.4763186343010504, - "heading": -0.7292831614478376, - "angularVelocity": -0.2982384060347082, - "velocityX": -0.589938098570508, - "velocityY": 0.993894566514525, - "timestamp": 12.331292383762547 - }, - { - "x": 2.2903104575974997, - "y": 3.5250548695238315, - "heading": -0.7441289784624036, - "angularVelocity": -0.2430551504884782, - "velocityX": -0.4668507998820613, - "velocityY": 0.7979077860580311, - "timestamp": 12.392372418416121 - }, - { - "x": 2.269134426765791, - "y": 3.56171927991662, - "heading": -0.7554504777477656, - "angularVelocity": -0.18535515491394047, - "velocityX": -0.34669316990097204, - "velocityY": 0.6002683299172502, - "timestamp": 12.453452453069696 - }, - { - "x": 2.255144398175998, - "y": 3.586228565361257, - "heading": -0.7631138906211655, - "angularVelocity": -0.12546510356230606, - "velocityX": -0.22904421500642305, - "velocityY": 0.4012650874159682, - "timestamp": 12.51453248772327 + "heading": 0.6014692668007987, + "angularVelocity": -0.000007117674667444465, + "velocityX": -1.997933419637491, + "velocityY": 0.09089534590222227, + "timestamp": 11.178897949821796 + }, + { + "x": 4.4852918274531035, + "y": 1.4093136530981196, + "heading": 0.6014686169682122, + "angularVelocity": -0.00000794408595037517, + "velocityX": -1.9595033424539408, + "velocityY": 0.400432598081353, + "timestamp": 11.26069874988135 + }, + { + "x": 4.332045122157961, + "y": 1.4665930457792093, + "heading": 0.6014678756495806, + "angularVelocity": -0.000009062486322055742, + "velocityX": -1.8734132818208915, + "velocityY": 0.7002302256137938, + "timestamp": 11.342499549940904 + }, + { + "x": 4.189567990618789, + "y": 1.5470029255462814, + "heading": 0.6014669872102968, + "angularVelocity": -0.00001086100971182791, + "velocityX": -1.7417571886270768, + "velocityY": 0.9829962507522065, + "timestamp": 11.424300350000458 + }, + { + "x": 4.061325777655998, + "y": 1.6485874554715532, + "heading": 0.6014657443656565, + "angularVelocity": -0.00001519355115434508, + "velocityX": -1.567737881162854, + "velocityY": 1.2418525228520432, + "timestamp": 11.506101150060012 + }, + { + "x": 3.9499181722494128, + "y": 1.7683949151806115, + "heading": 0.5999046298375316, + "angularVelocity": -0.019084343025843265, + "velocityX": -1.3619378456625928, + "velocityY": 1.4646245467261332, + "timestamp": 11.587901950119566 + }, + { + "x": 3.8385139180743773, + "y": 1.888205491074706, + "heading": 0.5540381787699103, + "angularVelocity": -0.5607090766132972, + "velocityX": -1.361896877462441, + "velocityY": 1.4646626415251267, + "timestamp": 11.66970275017912 + }, + { + "x": 3.7271096639847774, + "y": 2.0080160670482403, + "heading": 0.4697368355238526, + "angularVelocity": -1.0305686886275442, + "velocityX": -1.361896876418011, + "velocityY": 1.4646626424962754, + "timestamp": 11.751503550238674 + }, + { + "x": 3.6157054099517287, + "y": 2.1278266430743598, + "heading": 0.3537615125967293, + "angularVelocity": -1.4177773670023999, + "velocityX": -1.3618968757266772, + "velocityY": 1.4646626431391025, + "timestamp": 11.833304350298228 + }, + { + "x": 3.504301155997762, + "y": 2.247637219174011, + "heading": 0.2137130812750941, + "angularVelocity": -1.7120667673137158, + "velocityX": -1.3618968747599156, + "velocityY": 1.4646626440380324, + "timestamp": 11.915105150357782 + }, + { + "x": 3.3928969021094617, + "y": 2.367447795334722, + "heading": 0.057794482937139194, + "angularVelocity": -1.9060766914802987, + "velocityX": -1.3618968739571615, + "velocityY": 1.4646626447844622, + "timestamp": 11.996905950417336 + }, + { + "x": 3.281492648234104, + "y": 2.487258371507466, + "heading": -0.105452505167902, + "angularVelocity": -1.995664932203507, + "velocityX": -1.3618968737989476, + "velocityY": 1.464662644931575, + "timestamp": 12.07870675047689 + }, + { + "x": 3.1700883943158846, + "y": 2.6070689476403572, + "heading": -0.26730664929832215, + "angularVelocity": -1.978637666289151, + "velocityX": -1.3618968743229085, + "velocityY": 1.4646626444443769, + "timestamp": 12.160507550536444 + }, + { + "x": 3.058684140329769, + "y": 2.7268795237101155, + "heading": -0.41916927419219197, + "angularVelocity": -1.8564931490072147, + "velocityX": -1.3618968751529306, + "velocityY": 1.4646626436725918, + "timestamp": 12.242308350595998 + }, + { + "x": 2.947279886280209, + "y": 2.846690099720882, + "heading": -0.5526625850121627, + "angularVelocity": -1.6319316036369287, + "velocityX": -1.3618968759285288, + "velocityY": 1.464662642951413, + "timestamp": 12.324109150655552 + }, + { + "x": 2.835875632186779, + "y": 2.966500675690855, + "heading": -0.65985673738226, + "angularVelocity": -1.3104291436276523, + "velocityX": -1.3618968764648283, + "velocityY": 1.464662642452743, + "timestamp": 12.405909950715106 + }, + { + "x": 2.7244713780717897, + "y": 3.086311251640782, + "heading": -0.7334716118848168, + "angularVelocity": -0.899928539194763, + "velocityX": -1.3618968767283959, + "velocityY": 1.4646626422076685, + "timestamp": 12.48771075077466 + }, + { + "x": 2.613067124142982, + "y": 3.2061218277638193, + "heading": -0.7669996227711985, + "angularVelocity": -0.4098738748517434, + "velocityX": -1.361896874452356, + "velocityY": 1.4646626443239155, + "timestamp": 12.569511550834214 + }, + { + "x": 2.5088215468762853, + "y": 3.3182335485748182, + "heading": -0.7669997571492978, + "angularVelocity": -0.0000016427479828891154, + "velocityX": -1.2743833457717078, + "velocityY": 1.3705455292537272, + "timestamp": 12.651312350893768 + }, + { + "x": 2.421950224540146, + "y": 3.411659991166572, + "heading": -0.7669998477403924, + "angularVelocity": -0.0000011074597615269072, + "velocityX": -1.06198621862983, + "velocityY": 1.1421213792986926, + "timestamp": 12.733113150953322 + }, + { + "x": 2.352453163850527, + "y": 3.4864011482861903, + "heading": -0.7669999126210906, + "angularVelocity": -7.931548110988282e-7, + "velocityX": -0.8495890093864996, + "velocityY": 0.9136971406783939, + "timestamp": 12.814913951012876 + }, + { + "x": 2.300330367046085, + "y": 3.5424570175160435, + "heading": -0.7669999578169298, + "angularVelocity": -5.525109684504957e-7, + "velocityX": -0.6371917727760005, + "velocityY": 0.6852728725029872, + "timestamp": 12.89671475107243 + }, + { + "x": 2.2655818352461483, + "y": 3.5798275976473137, + "heading": -0.7669999863406792, + "angularVelocity": -3.486976819494124e-7, + "velocityX": -0.4247945224819143, + "velocityY": 0.4568485895500231, + "timestamp": 12.978515551131984 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -0.0636232346768501, - "velocityX": -0.1135695009511221, - "velocityY": 0.20111846142733134, - "timestamp": 12.575612522376845 + "angularVelocity": -1.6698272956598662e-7, + "velocityX": -0.21239726397767503, + "velocityY": 0.2284242977305235, + "timestamp": 13.060316351191538 }, { "x": 2.2482075691223145, "y": 3.598512887954712, "heading": -0.767, - "angularVelocity": -2.127821535251409e-28, - "velocityX": -9.407606964048783e-27, - "velocityY": -7.092605634329165e-27, - "timestamp": 12.63669255703042 + "angularVelocity": -2.381764007243456e-23, + "velocityX": 2.799365906238757e-23, + "velocityY": -7.174872988733629e-24, + "timestamp": 13.142117151251092 } ], "eventMarkers": []