diff --git a/Robot/Chreo_Auto_Project.chor b/Robot/Chreo_Auto_Project.chor index 2c083b0..beab836 100644 --- a/Robot/Chreo_Auto_Project.chor +++ b/Robot/Chreo_Auto_Project.chor @@ -343,7 +343,7 @@ { "name": "Marker", "target": "last", - "targetTimestamp": null, + "targetTimestamp": 1.345777924459432, "offset": 0, "command": { "type": "named", @@ -353,7 +353,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Amp Side Mid A": { "waypoints": [ @@ -462,2476 +462,2476 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": 2.138090744083086e-22, - "velocityX": 8.395290935795329e-21, - "velocityY": 1.2014410640329063e-20, + "angularVelocity": 3.3655423830458915e-22, + "velocityX": 6.379206572795731e-21, + "velocityY": 6.00570137114375e-21, "timestamp": 0 }, { - "x": 2.604589766672516, - "y": 6.860513178172266, - "heading": -2.671504019088023, - "angularVelocity": -0.021246762972301565, - "velocityX": 0.2842124016542836, - "velocityY": 0.054440081245398515, - "timestamp": 0.08743110370029157 - }, - { - "x": 2.6542901215482235, - "y": 6.8700203662565915, - "heading": -2.675220477646094, - "angularVelocity": -0.04250728174278654, - "velocityX": 0.5684516467512226, - "velocityY": 0.10873919785932558, - "timestamp": 0.17486220740058314 - }, - { - "x": 2.7288445568610946, - "y": 6.884260625866981, - "heading": -2.6807965298828265, - "angularVelocity": -0.06377652804025735, - "velocityX": 0.8527221109828285, - "velocityY": 0.1628740689263849, - "timestamp": 0.2622933111008747 - }, - { - "x": 2.8282562855247506, - "y": 6.903217009019292, - "heading": -2.688232564646954, - "angularVelocity": -0.08505022182514968, - "velocityX": 1.1370293231620792, - "velocityY": 0.21681509611603708, - "timestamp": 0.3497244148011663 - }, - { - "x": 2.952529143619552, - "y": 6.926869208476042, - "heading": -2.697528688552468, - "angularVelocity": -0.10632513501580529, - "velocityX": 1.4213804108066732, - "velocityY": 0.2705238577088996, - "timestamp": 0.43715551850145784 - }, - { - "x": 3.101667789963631, - "y": 6.955192446614957, - "heading": -2.7086848533162016, - "angularVelocity": -0.12759949596400413, - "velocityX": 1.705784784043409, - "velocityY": 0.32394922333368664, - "timestamp": 0.5245866222017495 - }, - { - "x": 3.2756780012561117, - "y": 6.988155814528643, - "heading": -2.721701033579155, - "angularVelocity": -0.14887356686668493, - "velocityX": 1.990255228722458, - "velocityY": 0.37702106594332374, - "timestamp": 0.6120177259020411 - }, - { - "x": 3.4745671276840473, - "y": 7.025719673404508, - "heading": -2.736577482795638, - "angularVelocity": -0.1701505366726105, - "velocityX": 2.2748097417335074, - "velocityY": 0.42963953657307824, - "timestamp": 0.6994488296023327 - }, - { - "x": 3.6983448349031947, - "y": 7.067831347797815, - "heading": -2.753315121465556, - "angularVelocity": -0.1914380347672825, - "velocityX": 2.5594748064286494, - "velocityY": 0.48165552773605236, - "timestamp": 0.7868799333026243 - }, - { - "x": 3.947024398434649, - "y": 7.1144174317493984, - "heading": -2.7719161751976173, - "angularVelocity": -0.2127509884334108, - "velocityX": 2.844291710921471, - "velocityY": 0.5328319325726028, - "timestamp": 0.8743110370029159 - }, - { - "x": 4.220625178803467, - "y": 7.165368564094144, - "heading": -2.792385350903891, - "angularVelocity": -0.2341177777698074, - "velocityX": 3.129330052914627, - "velocityY": 0.582757510638344, - "timestamp": 0.9617421407032075 - }, - { - "x": 4.519178004654404, - "y": 7.220504479528652, - "heading": -2.814732394345908, - "angularVelocity": -0.25559603500627764, - "velocityX": 3.4147209999127814, - "velocityY": 0.6306212903763969, - "timestamp": 1.0491732444034991 - }, - { - "x": 4.842739369959763, - "y": 7.2794721381065175, - "heading": -2.83897926425426, - "angularVelocity": -0.27732544691953914, - "velocityX": 3.700758101081589, - "velocityY": 0.6744471484656239, - "timestamp": 1.1366043481037906 - }, - { - "x": 5.191441788464345, - "y": 7.341270741000058, - "heading": -2.8651925381906103, - "angularVelocity": -0.2998163448354441, - "velocityX": 3.9883108384392805, - "velocityY": 0.7068262926816484, - "timestamp": 1.2240354518040821 - }, - { - "x": 5.561204157509806, - "y": 7.389060004842413, - "heading": -2.8942968081284857, - "angularVelocity": -0.33288233484553686, - "velocityX": 4.229185648999519, - "velocityY": 0.5465933954828472, - "timestamp": 1.3114665555043736 - }, - { - "x": 5.90676702099797, - "y": 7.429462102575199, - "heading": -2.9217646179534578, - "angularVelocity": -0.31416519593679304, - "velocityX": 3.9524019355026363, - "velocityY": 0.46210211266784756, - "timestamp": 1.3988976592046651 - }, - { - "x": 6.227776320980141, - "y": 7.463758279292559, - "heading": -2.9475006078951895, - "angularVelocity": -0.2943573722911377, - "velocityX": 3.671568656877204, - "velocityY": 0.39226516955480606, - "timestamp": 1.4863287629049566 - }, - { - "x": 6.524134980202349, - "y": 7.492353826396467, - "heading": -2.971474957941676, - "angularVelocity": -0.27420847995547176, - "velocityX": 3.3896250496631803, - "velocityY": 0.3270637781484755, - "timestamp": 1.5737598666052481 - }, - { - "x": 6.795798003981723, - "y": 7.515447318802456, - "heading": -2.9936725567296794, - "angularVelocity": -0.25388675023588664, - "velocityX": 3.107166812289346, - "velocityY": 0.26413360267248104, - "timestamp": 1.6611909703055396 - }, - { - "x": 7.042739486323945, - "y": 7.533156595046494, - "heading": -3.0140838093526265, - "angularVelocity": -0.23345527803143726, - "velocityX": 2.824412273105024, - "velocityY": 0.20255121455111968, - "timestamp": 1.7486220740058311 - }, - { - "x": 7.264942602620708, - "y": 7.545559665755271, - "heading": -3.032701765954018, - "angularVelocity": -0.21294431630661517, - "velocityX": 2.541465301164011, - "velocityY": 0.14186107899647651, - "timestamp": 1.8360531777061226 - }, - { - "x": 7.462395551623203, - "y": 7.5527119818078186, - "heading": -3.0495209788957442, - "angularVelocity": -0.19237104680025272, - "velocityX": 2.2583833515284413, - "velocityY": 0.08180516715270715, - "timestamp": 1.9234842814064141 - }, - { - "x": 7.635089599917891, - "y": 7.554654982123625, - "heading": -3.0645369861632634, - "angularVelocity": -0.17174674265800233, - "velocityX": 1.9752015128011309, - "velocityY": 0.02222321615047185, - "timestamp": 2.010915385106706 - }, - { - "x": 7.783018023947976, - "y": 7.551420808420136, - "heading": -3.077746062264594, - "angularVelocity": -0.15107982791352897, - "velocityX": 1.6919427728737597, - "velocityY": -0.03699111147646792, - "timestamp": 2.0983464888069974 - }, - { - "x": 7.9061754878102075, - "y": 7.5430351187739655, - "heading": -3.089145095467739, - "angularVelocity": -0.13037732249406989, - "velocityX": 1.4086230031409384, - "velocityY": -0.09591197287085713, - "timestamp": 2.185777592507289 - }, - { - "x": 8.004557653466987, - "y": 7.5295188704834, - "heading": -3.0987315280382326, - "angularVelocity": -0.1096455627891347, - "velocityX": 1.1252536167681009, - "velocityY": -0.1545931335477347, - "timestamp": 2.2732086962075804 - }, - { - "x": 8.0781609241493, - "y": 7.510889504584073, - "heading": -3.1065033281773795, - "angularVelocity": -0.08889056422972949, - "velocityX": 0.8418430920718916, - "velocityY": -0.21307481103277137, - "timestamp": 2.360639799907872 - }, - { - "x": 8.126982268554706, - "y": 7.48716176359185, - "heading": -3.1124589770111943, - "angularVelocity": -0.06811819343183008, - "velocityX": 0.5583978966199632, - "velocityY": -0.27138786985420976, - "timestamp": 2.4480709036081634 + "x": 2.6050610765354496, + "y": 6.860345987159577, + "heading": -2.6712752622193263, + "angularVelocity": -0.018473587950192584, + "velocityX": 0.28716640227144474, + "velocityY": 0.05208586613029278, + "timestamp": 0.08817296739659823 + }, + { + "x": 2.655702449187344, + "y": 6.869526965685582, + "heading": -2.674534004894112, + "angularVelocity": -0.03695852335476156, + "velocityX": 0.5743412538687886, + "velocityY": 0.10412464043213543, + "timestamp": 0.17634593479319646 + }, + { + "x": 2.7316657503038435, + "y": 6.883291516752998, + "heading": -2.6794232791182258, + "angularVelocity": -0.05545094339540405, + "velocityX": 0.861525968325646, + "velocityY": 0.156108515725732, + "timestamp": 0.2645189021897947 + }, + { + "x": 2.8329520075707495, + "y": 6.901633922922054, + "heading": -2.6859434576928263, + "angularVelocity": -0.07394759150242652, + "velocityX": 1.1487223381212155, + "velocityY": 0.2080275475651401, + "timestamp": 0.3526918695863929 + }, + { + "x": 2.9595624533624134, + "y": 6.9245473261835055, + "heading": -2.694094701532431, + "angularVelocity": -0.09244606459642621, + "velocityX": 1.4359326846988782, + "velocityY": 0.2598688003590563, + "timestamp": 0.44086483698299117 + }, + { + "x": 3.1114985918883113, + "y": 6.952023347160384, + "heading": -2.703877064931321, + "angularVelocity": -0.11094515346057994, + "velocityX": 1.7231600910344236, + "velocityY": 0.31161501975194, + "timestamp": 0.5290378043795894 + }, + { + "x": 3.2887622995138552, + "y": 6.984051514205735, + "heading": -2.715290645068638, + "angularVelocity": -0.12944534446685022, + "velocityX": 2.01040877787655, + "velocityY": 0.36324247658910663, + "timestamp": 0.6172107717761876 + }, + { + "x": 3.4913559816226885, + "y": 7.020618366869622, + "heading": -2.7283358019554202, + "angularVelocity": -0.14794961848233576, + "velocityX": 2.297684745003259, + "velocityY": 0.41471727382623713, + "timestamp": 0.7053837391727857 + }, + { + "x": 3.7192828323534473, + "y": 7.061705962999724, + "heading": -2.743013500900774, + "angularVelocity": -0.16646484040095605, + "velocityX": 2.5849969379566557, + "velocityY": 0.4659885829326004, + "timestamp": 0.7935567065693839 + }, + { + "x": 3.9725472979903476, + "y": 7.107289194770783, + "heading": -2.7593258915247603, + "angularVelocity": -0.18500444190126777, + "velocityX": 2.872359557751167, + "velocityY": 0.5169751355427069, + "timestamp": 0.8817296739659821 + }, + { + "x": 4.251155992007747, + "y": 7.157330430023032, + "heading": -2.777277407245389, + "angularVelocity": -0.2035943243225953, + "velocityX": 3.1597971832367806, + "velocityY": 0.5675348888641238, + "timestamp": 0.9699026413625803 + }, + { + "x": 4.555119788328324, + "y": 7.211767042055497, + "heading": -2.796877233287328, + "angularVelocity": -0.22228837954131203, + "velocityX": 3.447358133625697, + "velocityY": 0.6173843711940759, + "timestamp": 1.0580756087591785 + }, + { + "x": 4.884459882518826, + "y": 7.27047417558018, + "heading": -2.8181465130803445, + "angularVelocity": -0.24122222968121568, + "velocityX": 3.7351594702392714, + "velocityY": 0.665817826688542, + "timestamp": 1.1462485761557768 + }, + { + "x": 5.239235528324246, + "y": 7.333080725767244, + "heading": -2.8411535355871766, + "angularVelocity": -0.2609305684739806, + "velocityX": 4.023632823988497, + "velocityY": 0.7100424544573067, + "timestamp": 1.234421543552375 + }, + { + "x": 5.610187450691477, + "y": 7.375734987777251, + "heading": -2.8703104693697137, + "angularVelocity": -0.33067883097764283, + "velocityX": 4.20709354941754, + "velocityY": 0.4837566804137338, + "timestamp": 1.3225945109489734 + }, + { + "x": 5.955981368436564, + "y": 7.412973853213799, + "heading": -2.898024923168262, + "angularVelocity": -0.31431916852576924, + "velocityX": 3.9217679517319706, + "velocityY": 0.4223388021982916, + "timestamp": 1.4107674783455717 + }, + { + "x": 6.276537520123413, + "y": 7.4451838654734495, + "heading": -2.924223595532576, + "angularVelocity": -0.2971281690733325, + "velocityX": 3.635537752120799, + "velocityY": 0.3653048458125664, + "timestamp": 1.49894044574217 + }, + { + "x": 6.571830912097573, + "y": 7.47249273252466, + "heading": -2.9488824909824602, + "angularVelocity": -0.279665028613237, + "velocityX": 3.3490240908638538, + "velocityY": 0.30971926949419576, + "timestamp": 1.5871134131387683 + }, + { + "x": 6.841849345139681, + "y": 7.494964072142321, + "heading": -2.9719894022564435, + "angularVelocity": -0.2620634413952497, + "velocityX": 3.062372074057307, + "velocityY": 0.2548552042780421, + "timestamp": 1.6752863805353666 + }, + { + "x": 7.086585597012585, + "y": 7.512635968870317, + "heading": -2.993536590651642, + "angularVelocity": -0.24437408688175255, + "velocityX": 2.775638147371063, + "velocityY": 0.20042306899470433, + "timestamp": 1.763459347931965 + }, + { + "x": 7.306034895064365, + "y": 7.525533770781237, + "heading": -3.01351842580479, + "angularVelocity": -0.22662087647873794, + "velocityX": 2.4888500923951824, + "velocityY": 0.14627841493534438, + "timestamp": 1.8516323153285632 + }, + { + "x": 7.5001938519959825, + "y": 7.533675560070343, + "heading": -3.0319304290369935, + "angularVelocity": -0.20881687183541217, + "velocityX": 2.2020236208939075, + "velocityY": 0.09233883728199388, + "timestamp": 1.9398052827251615 + }, + { + "x": 7.669059939862971, + "y": 7.537074883806149, + "heading": -3.048768836452478, + "angularVelocity": -0.19097017955339882, + "velocityX": 1.9151684791035324, + "velocityY": 0.03855290159982452, + "timestamp": 2.02797825012176 + }, + { + "x": 7.812631200221533, + "y": 7.535742269192649, + "heading": -3.064030388112588, + "angularVelocity": -0.17308651518400572, + "velocityX": 1.6282911259273427, + "velocityY": -0.015113641435094947, + "timestamp": 2.116151217518358 + }, + { + "x": 7.930906071252784, + "y": 7.529686131887914, + "heading": -3.077712226044625, + "angularVelocity": -0.15517043756162383, + "velocityX": 1.3413960596251193, + "velocityY": -0.0686847395925208, + "timestamp": 2.204324184914956 + }, + { + "x": 8.023883278248142, + "y": 7.51891335359463, + "heading": -3.0898118478873737, + "angularVelocity": -0.13722597979860962, + "velocityX": 1.0544865364137177, + "velocityY": -0.12217778998892762, + "timestamp": 2.292497152311554 + }, + { + "x": 8.09156176085636, + "y": 7.503429666879887, + "heading": -3.100327089640208, + "angularVelocity": -0.11925697935896586, + "velocityX": 0.7675649873934917, + "velocityY": -0.17560582536707564, + "timestamp": 2.380670119708152 + }, + { + "x": 8.133940622858004, + "y": 7.483239921445362, + "heading": -3.1092561232896654, + "angularVelocity": -0.10126724678885639, + "velocityX": 0.48063327403995604, + "velocityY": -0.22897885860767764, + "timestamp": 2.46884308710475 }, { "x": 8.151019096374512, "y": 7.458348274230957, "heading": -3.116597461241803, - "angularVelocity": -0.047334232961245795, - "velocityX": 0.2749230743123512, - "velocityY": -0.32955650954222365, - "timestamp": 2.535502007308455 - }, - { - "x": 8.148432483672298, - "y": 7.421806810166393, - "heading": -3.118943939908983, - "angularVelocity": -0.02514099388324918, - "velocityX": -0.027713873999485883, - "velocityY": -0.3915180382340248, - "timestamp": 2.6288347799934333 - }, - { - "x": 8.117594384206546, - "y": 7.379509385872707, - "heading": -3.119220822186634, - "angularVelocity": -0.002966613652270148, - "velocityX": -0.33041019331803306, - "velocityY": -0.4531894111455441, - "timestamp": 2.7221675526784117 - }, - { - "x": 8.058498182340648, - "y": 7.331488492932785, - "heading": -3.1174309173732504, - "angularVelocity": 0.019177666771188435, - "velocityX": -0.6331773948831888, - "velocityY": -0.5145126578635241, - "timestamp": 2.81550032536339 - }, - { - "x": 7.971135845182134, - "y": 7.277783830019588, - "heading": -3.1135782415558078, - "angularVelocity": 0.04127891743285837, - "velocityX": -0.936030663670345, - "velocityY": -0.5754105591019291, - "timestamp": 2.9088330980483685 - }, - { - "x": 7.8554974161850275, - "y": 7.218444994953398, - "heading": -3.1076682424852238, - "angularVelocity": 0.06332179898406654, - "velocityX": -1.2389906103766541, - "velocityY": -0.6357770519308876, - "timestamp": 3.002165870733347 - }, - { - "x": 7.711570234789305, - "y": 7.153535709516692, - "heading": -3.099708151091067, - "angularVelocity": 0.08528720582451799, - "velocityX": -1.5420862067551742, - "velocityY": -0.6954608072749517, - "timestamp": 3.0954986434183254 - }, - { - "x": 7.539337668596006, - "y": 7.083140848637671, - "heading": -3.089707578332241, - "angularVelocity": 0.10714963748671837, - "velocityX": -1.8453600084787853, - "velocityY": -0.7542351829257374, - "timestamp": 3.188831416103304 - }, - { - "x": 7.338776909525806, - "y": 7.007379062900374, - "heading": -3.0776796181255017, - "angularVelocity": 0.12887177634094718, - "velocityX": -2.1488781839487765, - "velocityY": -0.811738294682546, - "timestamp": 3.282164188788282 - }, - { - "x": 7.109854784667936, - "y": 6.926427936059983, - "heading": -3.0636431064242595, - "angularVelocity": 0.1503921001963516, - "velocityX": -2.4527517855977448, - "velocityY": -0.8673387119187144, - "timestamp": 3.3754969614732606 - }, - { - "x": 6.8525187501181435, - "y": 6.840582358481015, - "heading": -3.0476279773679096, - "angularVelocity": 0.17159169920307685, - "velocityX": -2.757188361031195, - "velocityY": -0.9197795705557481, - "timestamp": 3.468829734158239 - }, - { - "x": 6.566673825053886, - "y": 6.750427785913005, - "heading": -3.0296914111518154, - "angularVelocity": 0.1921786495793364, - "velocityX": -3.0626425942477433, - "velocityY": -0.9659476513389746, - "timestamp": 3.5621625068432174 - }, - { - "x": 6.252112121252732, - "y": 6.657680588303757, - "heading": -3.009997409599457, - "angularVelocity": 0.2110084270059204, - "velocityX": -3.370324214655872, - "velocityY": -0.9937259436435488, - "timestamp": 3.655495279528196 - }, - { - "x": 5.924327501069443, - "y": 6.590553317899491, - "heading": -2.992729144054426, - "angularVelocity": 0.18501824223432767, - "velocityX": -3.511999169784069, - "velocityY": -0.7192250746780882, - "timestamp": 3.7488280522131743 - }, - { - "x": 5.623686963906954, - "y": 6.533138892879347, - "heading": -2.9778838065365383, - "angularVelocity": 0.15905814314543523, - "velocityX": -3.2211679618393605, - "velocityY": -0.6151582490100377, - "timestamp": 3.8421608248981527 - }, - { - "x": 5.350776487888487, - "y": 6.483614379242258, - "heading": -2.9652903356820435, - "angularVelocity": 0.13493085539204083, - "velocityX": -2.9240583791463015, - "velocityY": -0.5306229763927237, - "timestamp": 3.935493597583131 - }, - { - "x": 5.105761697875294, - "y": 6.441374025055136, - "heading": -2.9548920644835968, - "angularVelocity": 0.11141071779302807, - "velocityX": -2.625174233708662, - "velocityY": -0.4525779420450055, - "timestamp": 4.028826370268109 - }, - { - "x": 4.88871990253492, - "y": 6.40611581054929, - "heading": -2.9466608880442298, - "angularVelocity": 0.08819170589894769, - "velocityX": -2.325461776143144, - "velocityY": -0.37776885322857806, - "timestamp": 4.1221591429530875 - }, - { - "x": 4.699695738823262, - "y": 6.377658859572386, - "heading": -2.940580123655932, - "angularVelocity": 0.06515143837869165, - "velocityX": -2.0252710626058645, - "velocityY": -0.304897734828379, - "timestamp": 4.215491915638066 - }, - { - "x": 4.538718238992774, - "y": 6.35588274428126, - "heading": -2.9366387902452415, - "angularVelocity": 0.042228825923698476, - "velocityX": -1.724769287352341, - "velocityY": -0.2333169224986504, - "timestamp": 4.308824688323044 - }, - { - "x": 4.405807785111533, - "y": 6.340701529308257, - "heading": -2.9348291518927363, - "angularVelocity": 0.019389098817553782, - "velocityX": -1.4240491314861898, - "velocityY": -0.16265685178180805, - "timestamp": 4.402157461008023 - }, - { - "x": 4.300979468853507, - "y": 6.33205081523707, - "heading": -2.935145493541909, - "angularVelocity": -0.003389395172478266, - "velocityX": -1.1231672781419237, - "velocityY": -0.09268677895581871, - "timestamp": 4.495490233693001 - }, - { - "x": 4.22424491179168, - "y": 6.329880549721713, - "heading": -2.9375834532510026, - "angularVelocity": -0.026121153791524136, - "velocityX": -0.8221609071962866, - "velocityY": -0.023252984486819624, - "timestamp": 4.58882300637798 - }, - { - "x": 4.175613336776075, - "y": 6.334150718518695, - "heading": -2.9421396411976675, - "angularVelocity": -0.04881659266721974, - "velocityX": -0.5210557194068298, - "velocityY": 0.04575208336941216, - "timestamp": 4.682155779062958 + "angularVelocity": -0.08326064290335773, + "velocityX": 0.19369285191104127, + "velocityY": -0.28230474656073734, + "timestamp": 2.5570160545013483 + }, + { + "x": 8.140102729329666, + "y": 7.426125423374085, + "heading": -3.122657155923987, + "angularVelocity": -0.06387113314578731, + "velocityX": -0.11506202367581048, + "velocityY": -0.33963922365053295, + "timestamp": 2.6518898164612645 + }, + { + "x": 8.099892493103056, + "y": 7.388469206934611, + "heading": -3.1268746035962094, + "angularVelocity": -0.04445325646520159, + "velocityX": -0.4238288373512569, + "velocityY": -0.39690864641145623, + "timestamp": 2.746763578421181 + }, + { + "x": 8.03038702638155, + "y": 7.345387040589032, + "heading": -3.129247224498405, + "angularVelocity": -0.025008188282847746, + "velocityX": -0.7326099997054184, + "velocityY": -0.45409990555429286, + "timestamp": 2.841637340381097 + }, + { + "x": 7.93158466399431, + "y": 7.296887997756347, + "heading": -3.1297724840024768, + "angularVelocity": -0.005536404304212232, + "velocityX": -1.0414087134963954, + "velocityY": -0.5111955279392933, + "timestamp": 2.9365111023410133 + }, + { + "x": 7.803483324511263, + "y": 7.242983431199695, + "heading": -3.12844777249931, + "angularVelocity": 0.0139628857947746, + "velocityX": -1.35022936623056, + "velocityY": -0.5681714885452221, + "timestamp": 3.0313848643009296 + }, + { + "x": 7.646080334197257, + "y": 7.183687950924871, + "heading": -3.1252702011157885, + "angularVelocity": 0.03349262554660872, + "velocityX": -1.6590782009941545, + "velocityY": -0.6249934549857522, + "timestamp": 3.126258626260846 + }, + { + "x": 7.459372134789933, + "y": 7.119021056318589, + "heading": -3.1202362522670124, + "angularVelocity": 0.0530594417759311, + "velocityX": -1.967964540988761, + "velocityY": -0.681609891611587, + "timestamp": 3.221132388220762 + }, + { + "x": 7.243353760299336, + "y": 7.049010079509845, + "heading": -3.113341150659997, + "angularVelocity": 0.07267659113094418, + "velocityX": -2.276903224116522, + "velocityY": -0.7379382387969712, + "timestamp": 3.3160061501806783 + }, + { + "x": 6.998017798486094, + "y": 6.973696087603587, + "heading": -3.1045776181342863, + "angularVelocity": 0.09237045464069367, + "velocityX": -2.5859200346339737, + "velocityY": -0.7938337254727885, + "timestamp": 3.4108799121405946 + }, + { + "x": 6.7233519959559755, + "y": 6.893147709815927, + "heading": -3.093932999275366, + "angularVelocity": 0.11219771029441636, + "velocityX": -2.8950659998721515, + "velocityY": -0.849005838112451, + "timestamp": 3.505753674100511 + }, + { + "x": 6.419332224949389, + "y": 6.807502909527294, + "heading": -3.0813806824079646, + "angularVelocity": 0.13230546157434672, + "velocityX": -3.2044662794654784, + "velocityY": -0.9027237722987913, + "timestamp": 3.600627436060427 + }, + { + "x": 6.0858892119725905, + "y": 6.717181338233644, + "heading": -3.0668369094740004, + "angularVelocity": 0.15329604975619027, + "velocityX": -3.5145967239886153, + "velocityY": -0.9520184445917703, + "timestamp": 3.6955011980203434 + }, + { + "x": 5.764278765937413, + "y": 6.654175690194563, + "heading": -3.0473584875163273, + "angularVelocity": 0.20530883940179634, + "velocityX": -3.389877658388376, + "velocityY": -0.6640998178790448, + "timestamp": 3.7903749599802596 + }, + { + "x": 5.471788390267883, + "y": 6.59747295201529, + "heading": -3.029533854057239, + "angularVelocity": 0.18787737611395156, + "velocityX": -3.082942740197291, + "velocityY": -0.5976651184468632, + "timestamp": 3.885248721940176 + }, + { + "x": 5.208500110382171, + "y": 6.546679537535185, + "heading": -3.013443507342508, + "angularVelocity": 0.16959743539556021, + "velocityX": -2.7751432476868563, + "velocityY": -0.5353789438808637, + "timestamp": 3.980122483900092 + }, + { + "x": 4.974440418410986, + "y": 6.5016623079036036, + "heading": -2.999114209332587, + "angularVelocity": 0.15103541499677672, + "velocityX": -2.467064519588399, + "velocityY": -0.4744960956708154, + "timestamp": 4.074996245860008 + }, + { + "x": 4.7696223965133315, + "y": 6.46235431777243, + "heading": -2.986559323622326, + "angularVelocity": 0.13233253800523867, + "velocityX": -2.1588479013216424, + "velocityY": -0.41431887298598197, + "timestamp": 4.169870007819925 + }, + { + "x": 4.594053841274844, + "y": 6.4287152751902195, + "heading": -2.975786926655579, + "angularVelocity": 0.11354453269490751, + "velocityX": -1.8505491045318088, + "velocityY": -0.354566340443241, + "timestamp": 4.264743769779841 + }, + { + "x": 4.447739928323049, + "y": 6.400718265491756, + "heading": -2.966802484943942, + "angularVelocity": 0.09469890859217249, + "velocityX": -1.5421957549613354, + "velocityY": -0.29509749713827227, + "timestamp": 4.359617531739757 + }, + { + "x": 4.330684343492378, + "y": 6.378344037986267, + "heading": -2.9596099787157644, + "angularVelocity": 0.07581133160099555, + "velocityX": -1.2338035555091167, + "velocityY": -0.23583156231268904, + "timestamp": 4.4544912936996734 + }, + { + "x": 4.242889844841654, + "y": 6.361578141572037, + "heading": -2.9542124480151872, + "angularVelocity": 0.05689171156570921, + "velocityX": -0.9253822852288359, + "velocityY": -0.17671794675237118, + "timestamp": 4.54936505565959 + }, + { + "x": 4.184358573473123, + "y": 6.350409330356464, + "heading": -2.9506122877942356, + "angularVelocity": 0.037946847964903434, + "velocityX": -0.6169384470414571, + "velocityY": -0.1177228665212151, + "timestamp": 4.644238817619506 + }, + { + "x": 4.155092239379883, + "y": 6.3448286056518555, + "heading": -2.948811422950705, + "angularVelocity": 0.01898169532152746, + "velocityX": -0.30847658497620073, + "velocityY": -0.058822635355874404, + "timestamp": 4.739112579579422 }, { "x": 4.155092239379883, "y": 6.3448286056518555, "heading": -2.948811422950705, - "angularVelocity": -0.07148380532480915, - "velocityX": -0.21987022142217327, - "velocityY": 0.11440662080404759, - "timestamp": 4.775488551747936 - }, - { - "x": 4.1523733002027585, - "y": 6.352736136844345, - "heading": -2.9531733467821883, - "angularVelocity": -0.0840714214822575, - "velocityX": -0.05240464766826728, - "velocityY": 0.1524092151654666, - "timestamp": 4.827372102121875 - }, - { - "x": 4.158366785929934, - "y": 6.362507716377033, - "heading": -2.958190711819862, - "angularVelocity": -0.09670435044463713, - "velocityX": 0.11551803382727258, - "velocityY": 0.1883367553349982, - "timestamp": 4.8792556524958135 - }, - { - "x": 4.173097322502434, - "y": 6.374024196518687, - "heading": -2.9638660249161624, - "angularVelocity": -0.10938559630937192, - "velocityX": 0.2839153540251724, - "velocityY": 0.22196785028494526, - "timestamp": 4.931139202869752 - }, - { - "x": 4.196590311934801, - "y": 6.387153081322849, - "heading": -2.9702019538562587, - "angularVelocity": -0.12211826088291282, - "velocityX": 0.4528022709133544, - "velocityY": 0.2530452274283173, - "timestamp": 4.983022753243691 - }, - { - "x": 4.228871699685148, - "y": 6.401746260752157, - "heading": -2.9772013305250957, - "angularVelocity": -0.13490550701312382, - "velocityX": 0.6221892587860005, - "velocityY": 0.28126794184536924, - "timestamp": 5.034906303617629 - }, - { - "x": 4.269967592351735, - "y": 6.417637232054739, - "heading": -2.984867150661907, - "angularVelocity": -0.14775049281634614, - "velocityX": 0.7920794234472852, - "velocityY": 0.3062814936150427, - "timestamp": 5.086789853991568 - }, - { - "x": 4.319903648657689, - "y": 6.434637666385072, - "heading": -2.9932025678242957, - "angularVelocity": -0.16065626007305117, - "velocityX": 0.9624641325825063, - "velocityY": 0.3276652081017283, - "timestamp": 5.138673404365506 - }, - { - "x": 4.378704125067283, - "y": 6.452533134609333, - "heading": -3.0022108777762337, - "angularVelocity": -0.17362554965904736, - "velocityX": 1.1333163591504853, - "velocityY": 0.3449160301344857, - "timestamp": 5.190556954739445 - }, - { - "x": 4.446390391271482, - "y": 6.471077749304567, - "heading": -3.0118954871845838, - "angularVelocity": -0.1866604991090635, - "velocityX": 1.3045804636800333, - "velocityY": 0.3574276348009622, - "timestamp": 5.242440505113383 - }, - { - "x": 4.522978624713606, - "y": 6.489987409231171, - "heading": -3.022259856563219, - "angularVelocity": -0.19976214626671202, - "velocityX": 1.4761563711452288, - "velocityY": 0.3644634916137398, - "timestamp": 5.294324055487322 - }, - { - "x": 4.608476221898354, - "y": 6.508931252042045, - "heading": -3.0333074005444227, - "angularVelocity": -0.21292960681336567, - "velocityX": 1.647874838335918, - "velocityY": 0.3651223301863666, - "timestamp": 5.34620760586126 - }, - { - "x": 4.702876186716506, - "y": 6.527520848501598, - "heading": -3.0450413162822625, - "angularVelocity": -0.22615868908874204, - "velocityX": 1.8194584629961805, - "velocityY": 0.3582946102487687, - "timestamp": 5.398091156235199 - }, - { - "x": 4.80614831100124, - "y": 6.545296659635279, - "heading": -3.057464288154216, - "angularVelocity": -0.23943950987196802, - "velocityX": 1.9904598575159884, - "velocityY": 0.3426097675576714, - "timestamp": 5.4499747066091375 - }, - { - "x": 4.918225271137858, - "y": 6.561711461524763, - "heading": -3.070577974004793, - "angularVelocity": -0.2527522838368351, - "velocityX": 2.1601636612924295, - "velocityY": 0.31637776850615995, - "timestamp": 5.501858256983076 - }, - { - "x": 5.038980773812091, - "y": 6.57611113382983, - "heading": -3.0843820954085435, - "angularVelocity": -0.2660596914486556, - "velocityX": 2.3274332963707454, - "velocityY": 0.2775382987726222, - "timestamp": 5.553741807357015 - }, - { - "x": 5.168195744747027, - "y": 6.587715060112655, - "heading": -3.0988727967741583, - "angularVelocity": -0.2792927866573567, - "velocityX": 2.490480508825023, - "velocityY": 0.22365328122674002, - "timestamp": 5.605625357730953 - }, - { - "x": 5.30550815428385, - "y": 6.595602511169989, - "heading": -3.1140396624904128, - "angularVelocity": -0.2923251320879681, - "velocityX": 2.646549986405633, - "velocityY": 0.1520221920143693, - "timestamp": 5.657508908104892 - }, - { - "x": 5.450345178811565, - "y": 6.598718775503018, - "heading": -3.1298604289814644, - "angularVelocity": -0.30492837088108665, - "velocityX": 2.7915789009008614, - "velocityY": 0.06006266553790952, - "timestamp": 5.70939245847883 - }, - { - "x": 5.6018485220334355, - "y": 6.595923224272249, - "heading": -3.1462924963317724, - "angularVelocity": -0.3167105418167766, - "velocityX": 2.9200650712980316, - "velocityY": -0.05388126314836061, - "timestamp": 5.761276008852769 + "angularVelocity": 7.532394355764215e-22, + "velocityX": -1.0416622637345536e-20, + "velocityY": 4.974602571682824e-21, + "timestamp": 4.8339863415393385 + }, + { + "x": 4.162583214768669, + "y": 6.347447665147435, + "heading": -2.9495836761516045, + "angularVelocity": -0.01576998530593318, + "velocityX": 0.15297129448051064, + "velocityY": 0.05348314479313053, + "timestamp": 4.882956152602428 + }, + { + "x": 4.177602512253265, + "y": 6.35257626623424, + "heading": -2.9511334665493774, + "angularVelocity": -0.03164787374360031, + "velocityX": 0.3067052365230814, + "velocityY": 0.10472985244312193, + "timestamp": 4.931925963665517 + }, + { + "x": 4.200189635119117, + "y": 6.360092465931462, + "heading": -2.9534665854996804, + "angularVelocity": -0.04764402597545136, + "velocityX": 0.4612458650647525, + "velocityY": 0.15348639363829186, + "timestamp": 4.980895774728606 + }, + { + "x": 4.23038623992188, + "y": 6.369859774063522, + "heading": -2.9565893733664335, + "angularVelocity": -0.06376965315896455, + "velocityX": 0.6166371514862435, + "velocityY": 0.1994557038310018, + "timestamp": 5.029865585791695 + }, + { + "x": 4.268236035993276, + "y": 6.381724551550718, + "heading": -2.9605087652771482, + "angularVelocity": -0.08003690080946649, + "velocityX": 0.772921015003155, + "velocityY": 0.24228758963171887, + "timestamp": 5.078835396854784 + }, + { + "x": 4.313784526607596, + "y": 6.395512797793485, + "heading": -2.965232340164235, + "angularVelocity": -0.09645891590230844, + "velocityX": 0.930134089258357, + "velocityY": 0.2815662536455856, + "timestamp": 5.1278052079178735 + }, + { + "x": 4.367078495343951, + "y": 6.411026156284386, + "heading": -2.9707683712029516, + "angularVelocity": -0.11304987539332809, + "velocityX": 1.088302519029422, + "velocityY": 0.31679433010095004, + "timestamp": 5.176775018980963 + }, + { + "x": 4.428165084675981, + "y": 6.428036917409757, + "heading": -2.9771258738162327, + "angularVelocity": -0.1298249365326444, + "velocityX": 1.247433633209869, + "velocityY": 0.34737240671513037, + "timestamp": 5.225744830044052 + }, + { + "x": 4.49709022288104, + "y": 6.446281736854329, + "heading": -2.9843146438854973, + "angularVelocity": -0.14680003686359283, + "velocityX": 1.4075026370075427, + "velocityY": 0.3725727963513324, + "timestamp": 5.274714641107141 + }, + { + "x": 4.573896008655205, + "y": 6.465453722665752, + "heading": -2.9923452723182273, + "angularVelocity": -0.16399141141026485, + "velocityX": 1.5684313275216506, + "velocityY": 0.3915062238390777, + "timestamp": 5.32368445217023 + }, + { + "x": 4.658616427207793, + "y": 6.485192493152983, + "heading": -3.001229110020898, + "angularVelocity": -0.1814145799179313, + "velocityX": 1.7300540213120348, + "velocityY": 0.4030803888910354, + "timestamp": 5.372654263233319 + }, + { + "x": 4.751270399780848, + "y": 6.505071823127092, + "heading": -3.0109781343477864, + "angularVelocity": -0.19908233491709118, + "velocityX": 1.8920631009518674, + "velocityY": 0.4059507182598449, + "timestamp": 5.421624074296409 + }, + { + "x": 4.851850606754849, + "y": 6.524584700969826, + "heading": -3.021604623744328, + "angularVelocity": -0.2170008249133559, + "velocityX": 2.0539227085115646, + "velocityY": 0.39846749291304245, + "timestamp": 5.470593885359498 + }, + { + "x": 4.9603057580757115, + "y": 6.543126281504873, + "heading": -3.033120461060416, + "angularVelocity": -0.2351619715512455, + "velocityX": 2.214734934981403, + "velocityY": 0.3786328787578623, + "timestamp": 5.519563696422587 + }, + { + "x": 5.076513193637353, + "y": 6.559976852057536, + "heading": -3.0455357212182053, + "angularVelocity": -0.2535288556003304, + "velocityX": 2.373042350764386, + "velocityY": 0.3441011959583454, + "timestamp": 5.568533507485676 + }, + { + "x": 5.200238658586685, + "y": 6.574290291218965, + "heading": -3.058855907991928, + "angularVelocity": -0.2720081308167943, + "velocityX": 2.526566108044267, + "velocityY": 0.2922910840515189, + "timestamp": 5.617503318548765 + }, + { + "x": 5.331082896954063, + "y": 6.585098992297486, + "heading": -3.073076807020245, + "angularVelocity": -0.2904013456371353, + "velocityX": 2.671936761177355, + "velocityY": 0.22072172311622418, + "timestamp": 5.6664731296118545 + }, + { + "x": 5.468423843235409, + "y": 6.591351575529229, + "heading": -3.088175823348266, + "angularVelocity": -0.3083331546566214, + "velocityX": 2.804604373588566, + "velocityY": 0.12768240464901381, + "timestamp": 5.715442940674944 + }, + { + "x": 5.611379563022578, + "y": 6.591996238312479, + "heading": -3.104100231369373, + "angularVelocity": -0.32518826753468183, + "velocityX": 2.919262228784082, + "velocityY": 0.013164493986290755, + "timestamp": 5.764412751738033 }, { "x": 5.758828163146973, "y": 6.586098670959473, - "heading": -3.1632623831303452, - "angularVelocity": -0.32707643706465594, - "velocityX": 3.0256148621700416, - "velocityY": -0.1893577683479254, - "timestamp": 5.813159559226707 - }, - { - "x": 5.902695261238535, - "y": 6.570898320745469, - "heading": -3.17881147753637, - "angularVelocity": -0.334456883703837, - "velocityX": 3.0945430028757137, - "velocityY": -0.32695548891982595, - "timestamp": 5.859650138920662 - }, - { - "x": 6.049135676690236, - "y": 6.549021835593513, - "heading": -3.1946542371072635, - "angularVelocity": -0.34077354326802706, - "velocityX": 3.149894374639172, - "velocityY": -0.4705573751923071, - "timestamp": 5.906140718614616 - }, - { - "x": 6.197160957910471, - "y": 6.5201679684564, - "heading": -3.2107077631198266, - "angularVelocity": -0.3453070733521208, - "velocityX": 3.1839844156532195, - "velocityY": -0.6206390053008074, - "timestamp": 5.952631298308571 - }, - { - "x": 6.345163267243832, - "y": 6.484158835890345, - "heading": -3.2268259776118957, - "angularVelocity": -0.34669850533537744, - "velocityX": 3.1834902964784026, - "velocityY": -0.7745468609576753, - "timestamp": 5.9991218780025255 - }, - { - "x": 6.490686976954829, - "y": 6.44143753364954, - "heading": -3.2427755688515667, - "angularVelocity": -0.3430714640399521, - "velocityX": 3.1301762780540514, - "velocityY": -0.9189238448312944, - "timestamp": 6.04561245769648 - }, - { - "x": 6.631051195173747, - "y": 6.393759766983925, - "heading": -3.25832527798554, - "angularVelocity": -0.33447010633844293, - "velocityX": 3.0191969887862986, - "velocityY": -1.0255360758991645, - "timestamp": 6.092103037390435 - }, - { - "x": 6.764714286137434, - "y": 6.343577352526553, - "heading": -3.2733740999169187, - "angularVelocity": -0.32369615587598016, - "velocityX": 2.875057524418642, - "velocityY": -1.0794103835168365, - "timestamp": 6.138593617084389 - }, - { - "x": 6.8912461581954085, - "y": 6.2928282307057035, - "heading": -3.2878993621114248, - "angularVelocity": -0.3124345252333994, - "velocityX": 2.721666903078607, - "velocityY": -1.0916001081279028, - "timestamp": 6.185084196778344 - }, - { - "x": 7.010658039170415, - "y": 6.242772475916749, - "heading": -3.3018996360525708, - "angularVelocity": -0.3011421675812394, - "velocityX": 2.5685177892185584, - "velocityY": -1.0766859677480711, - "timestamp": 6.231574776472298 - }, - { - "x": 7.123076613613992, - "y": 6.194223053842943, - "heading": -3.315378698836471, - "angularVelocity": -0.2899310542615808, - "velocityX": 2.41809362635666, - "velocityY": -1.0442851518179614, - "timestamp": 6.278065356166253 - }, - { - "x": 7.228642675189584, - "y": 6.147727642667839, - "heading": -3.328341498218578, - "angularVelocity": -0.2788263658453163, - "velocityX": 2.2706978977360404, - "velocityY": -1.0001039238740794, - "timestamp": 6.324555935860207 - }, - { - "x": 7.3274843779409755, - "y": 6.1036734220962625, - "heading": -3.3407929863654613, - "angularVelocity": -0.2678281972143777, - "velocityX": 2.1260587285007455, - "velocityY": -0.9475945634918501, - "timestamp": 6.371046515554162 - }, - { - "x": 7.419712318737089, - "y": 6.062345928160032, - "heading": -3.352737769324828, - "angularVelocity": -0.25692910344415465, - "velocityX": 1.9837984684907406, - "velocityY": -0.8889433990345353, - "timestamp": 6.417537095248116 - }, - { - "x": 7.505420648253909, - "y": 6.023963255092294, - "heading": -3.364180022815759, - "angularVelocity": -0.24611982828036585, - "velocityX": 1.8435633644715703, - "velocityY": -0.8256010856481106, - "timestamp": 6.464027674942071 - }, - { - "x": 7.584689528763382, - "y": 5.988696855541549, - "heading": -3.3751234991855714, - "angularVelocity": -0.2353912651090335, - "velocityX": 1.7050525295940933, - "velocityY": -0.7585708714088366, - "timestamp": 6.510518254636025 - }, - { - "x": 7.657587578550974, - "y": 5.956684760340136, - "heading": -3.3855715636517316, - "angularVelocity": -0.22473508687006247, - "velocityX": 1.5680176557804868, - "velocityY": -0.688571650690245, - "timestamp": 6.55700883432998 - }, - { - "x": 7.724173959062888, - "y": 5.928040318491664, - "heading": -3.395527236991756, - "angularVelocity": -0.21414388475175317, - "velocityX": 1.4322553289343771, - "velocityY": -0.6161343230615005, - "timestamp": 6.6034994140239345 - }, - { - "x": 7.784500070286371, - "y": 5.902858177956981, - "heading": -3.4049932363871975, - "angularVelocity": -0.20361112848571972, - "velocityX": 1.2975986021384787, - "velocityY": -0.5416611429768321, - "timestamp": 6.649989993717889 - }, - { - "x": 7.838610905305163, - "y": 5.881218502530634, - "heading": -3.4139720117646606, - "angularVelocity": -0.19313106948912953, - "velocityX": 1.1639096646030658, - "velocityY": -0.4654636609997264, - "timestamp": 6.6964805734118436 - }, - { - "x": 7.886546129379081, - "y": 5.86319002330096, - "heading": -3.42246577716849, - "angularVelocity": -0.18269863399732386, - "velocityX": 1.0310739162529936, - "velocityY": -0.3877877915989518, - "timestamp": 6.742971153105798 - }, - { - "x": 7.928340942331937, - "y": 5.848832297421699, - "heading": -3.4304765375087274, - "angularVelocity": -0.1723093235871096, - "velocityX": 0.8989953067479537, - "velocityY": -0.30883086366694207, - "timestamp": 6.789461732799753 - }, - { - "x": 7.964026771943328, - "y": 5.8381974137160135, - "heading": -3.4380061112749485, - "angularVelocity": -0.16195912840381457, - "velocityX": 0.7675927004203498, - "velocityY": -0.228753519007396, - "timestamp": 6.835952312493707 - }, - { - "x": 7.99363183554634, - "y": 5.8313313033992795, - "heading": -3.4450561498298287, - "angularVelocity": -0.1516444535923259, - "velocityX": 0.6367970414200341, - "velocityY": -0.14768820612546799, - "timestamp": 6.882442892187662 - }, - { - "x": 8.01718159841729, - "y": 5.828274763168966, - "heading": -3.4516281538375715, - "angularVelocity": -0.14136205766857937, - "velocityX": 0.5065491337379875, - "velocityY": -0.06574536713534573, - "timestamp": 6.928933471881616 - }, - { - "x": 8.034699150840398, - "y": 5.829064264971731, - "heading": -3.457723487300717, - "angularVelocity": -0.13110900107658668, - "velocityX": 0.37679789192616997, - "velocityY": 0.01698197372375355, - "timestamp": 6.975424051575571 + "heading": -3.1207574004201586, + "angularVelocity": -0.3401517933023314, + "velocityX": 3.011010190225819, + "velocityY": -0.1204327160954054, + "timestamp": 5.813382562801122 + }, + { + "x": 5.902233426168296, + "y": 6.573896393326713, + "heading": -3.137173214129699, + "angularVelocity": -0.35185511132046066, + "velocityX": 3.0737358304074114, + "velocityY": -0.26154254859402304, + "timestamp": 5.86003760114328 + }, + { + "x": 6.047959669804794, + "y": 6.55487337569396, + "heading": -3.1540968828538256, + "angularVelocity": -0.3627404311622608, + "velocityX": 3.12348352535416, + "velocityY": -0.40773769154880374, + "timestamp": 5.906692639485438 + }, + { + "x": 6.195103135419279, + "y": 6.528785988145332, + "heading": -3.1714630452763988, + "angularVelocity": -0.37222480228637916, + "velocityX": 3.1538601369345067, + "velocityY": -0.5591547767533385, + "timestamp": 5.953347677827597 + }, + { + "x": 6.342273583838334, + "y": 6.495493098699492, + "heading": -3.189153294446043, + "angularVelocity": -0.37917124919944706, + "velocityX": 3.154438484001192, + "velocityY": -0.7135968724680373, + "timestamp": 6.000002716169755 + }, + { + "x": 6.487408197918111, + "y": 6.455287801316945, + "heading": -3.2069610000901583, + "angularVelocity": -0.3816888009718795, + "velocityX": 3.110802589323585, + "velocityY": -0.8617568179387292, + "timestamp": 6.046657754511913 + }, + { + "x": 6.628042592487971, + "y": 6.4094546101533805, + "heading": -3.2246122107652013, + "angularVelocity": -0.3783345015299816, + "velocityX": 3.014345279034542, + "velocityY": -0.9823845996531712, + "timestamp": 6.093312792854071 + }, + { + "x": 6.76234555654877, + "y": 6.36018205657845, + "heading": -3.2418944864102914, + "angularVelocity": -0.37042678045500493, + "velocityX": 2.878637952794035, + "velocityY": -1.0561035919331003, + "timestamp": 6.13996783119623 + }, + { + "x": 6.889571626411602, + "y": 6.309558361869554, + "heading": -3.2587010350854584, + "angularVelocity": -0.36023009030473874, + "velocityX": 2.726952423225606, + "velocityY": -1.0850638324982687, + "timestamp": 6.186622869538388 + }, + { + "x": 7.0095947472284355, + "y": 6.259078906708206, + "heading": -3.2749813089827535, + "angularVelocity": -0.34894996287215513, + "velocityX": 2.5725650450999407, + "velocityY": -1.0819722146864885, + "timestamp": 6.233277907880546 + }, + { + "x": 7.122504658549263, + "y": 6.209740963724178, + "heading": -3.2907092275270267, + "angularVelocity": -0.3371108266791727, + "velocityX": 2.420101136618307, + "velocityY": -1.0575051427928084, + "timestamp": 6.279932946222704 + }, + { + "x": 7.228443461182924, + "y": 6.162220474685008, + "heading": -3.305870367171903, + "angularVelocity": -0.3249625374581804, + "velocityX": 2.2706830044105364, + "velocityY": -1.0185499943363998, + "timestamp": 6.3265879845648625 + }, + { + "x": 7.327553022424126, + "y": 6.116993511470743, + "heading": -3.3204564150614004, + "angularVelocity": -0.3126360712111283, + "velocityX": 2.1243056433552177, + "velocityY": -0.969390762956412, + "timestamp": 6.373243022907021 + }, + { + "x": 7.419960559859087, + "y": 6.074408763951777, + "heading": -3.3344624883943017, + "angularVelocity": -0.30020494743105264, + "velocityX": 1.980655052885471, + "velocityY": -0.9127577434758154, + "timestamp": 6.419898061249179 + }, + { + "x": 7.505776426038997, + "y": 6.034730578891011, + "heading": -3.3478857294831443, + "angularVelocity": -0.28771257222851315, + "velocityX": 1.8393697493195704, + "velocityY": -0.8504587386634338, + "timestamp": 6.466553099591337 + }, + { + "x": 7.585095518792171, + "y": 5.998165283481503, + "heading": -3.3607245222151003, + "angularVelocity": -0.27518555740538053, + "velocityX": 1.7001184774828544, + "velocityY": -0.783737334890718, + "timestamp": 6.513208137933495 + }, + { + "x": 7.657999517022542, + "y": 5.964877896157417, + "heading": -3.372978032399648, + "angularVelocity": -0.26264066261575153, + "velocityX": 1.5626179041094987, + "velocityY": -0.7134789404729223, + "timestamp": 6.559863176275654 + }, + { + "x": 7.724559056876027, + "y": 5.93500312880336, + "heading": -3.3846459265015914, + "angularVelocity": -0.25008861886198047, + "velocityX": 1.4266313396926282, + "velocityY": -0.6403331433351711, + "timestamp": 6.606518214617812 + }, + { + "x": 7.784835607016778, + "y": 5.908652875091113, + "heading": -3.3957281933250307, + "angularVelocity": -0.2375363351362947, + "velocityX": 1.2919622892322207, + "velocityY": -0.5647890270499625, + "timestamp": 6.65317325295997 + }, + { + "x": 7.838883015534668, + "y": 5.885921459816752, + "heading": -3.406225027554339, + "angularVelocity": -0.22498822425835854, + "velocityX": 1.1584474140074106, + "velocityY": -0.4872231613583445, + "timestamp": 6.699828291302128 + }, + { + "x": 7.8867487658899655, + "y": 5.866889415616827, + "heading": -3.416136751780165, + "angularVelocity": -0.21244702776012941, + "velocityX": 1.025950295105533, + "velocityY": -0.40793116619792125, + "timestamp": 6.7464833296442865 + }, + { + "x": 7.928474992731514, + "y": 5.851626263091601, + "heading": -3.4254637632041343, + "angularVelocity": -0.19991434484667214, + "velocityX": 0.8943562865716137, + "velocityY": -0.32714907258866266, + "timestamp": 6.793138367986445 + }, + { + "x": 7.96409930505654, + "y": 5.840192599068134, + "heading": -3.4342064965877315, + "angularVelocity": -0.1873909805727762, + "velocityX": 0.7635683859857584, + "velocityY": -0.24506815190281384, + "timestamp": 6.839793406328603 + }, + { + "x": 7.993655456392744, + "y": 5.83264169349778, + "heading": -3.442365398135876, + "angularVelocity": -0.17487718021596504, + "velocityX": 0.6335039555523552, + "velocityY": -0.16184544775158413, + "timestamp": 6.886448444670761 + }, + { + "x": 8.017173893739177, + "y": 5.829020730205745, + "heading": -3.449940906881815, + "angularVelocity": -0.1623727900592901, + "velocityX": 0.5040921234262654, + "velocityY": -0.07761140962911499, + "timestamp": 6.9331034830129195 + }, + { + "x": 8.034682210183265, + "y": 5.82937178474551, + "heading": -3.4569334412987898, + "angularVelocity": -0.14987736942133326, + "velocityX": 0.37527171911607915, + "velocityY": 0.007524472216504663, + "timestamp": 6.979758521355078 }, { "x": 8.046205520629883, "y": 5.833732604980469, "heading": -3.463343389598174, - "angularVelocity": -0.12088260319515205, - "velocityX": 0.2474989528035481, - "velocityY": 0.10041475153610135, - "timestamp": 7.021914631269525 - }, - { - "x": 8.051419182584468, - "y": 5.8447906809115855, - "heading": -3.4693491742690163, - "angularVelocity": -0.10876684074758049, - "velocityX": 0.09442122397079034, - "velocityY": 0.20026558554682747, - "timestamp": 7.077131686665851 - }, - { - "x": 8.048120067651531, - "y": 5.861268574669593, - "heading": -3.474675084898529, - "angularVelocity": -0.0964540863558432, - "velocityX": -0.059748114224046904, - "velocityY": 0.2984203637759236, - "timestamp": 7.1323487420621765 - }, - { - "x": 8.036241609424145, - "y": 5.883060143584873, - "heading": -3.479308784103769, - "angularVelocity": -0.0839178976854301, - "velocityX": -0.21512299310652097, - "velocityY": 0.39465286149124257, - "timestamp": 7.187565797458502 - }, - { - "x": 8.015709993867125, - "y": 5.910044148075149, - "heading": -3.483236224053585, - "angularVelocity": -0.07112729792681803, - "velocityX": -0.37183466973481016, - "velocityY": 0.4886896683750097, - "timestamp": 7.242782852854828 - }, - { - "x": 7.986443029902223, - "y": 5.942080890750444, - "heading": -3.4864413312001137, - "angularVelocity": -0.05804560064864295, - "velocityX": -0.5300348552604761, - "velocityY": 0.5801965071362207, - "timestamp": 7.297999908251153 - }, - { - "x": 7.948348824180798, - "y": 5.979007815148917, - "heading": -3.488905604522003, - "angularVelocity": -0.04462884346514799, - "velocityX": -0.6898992611612746, - "velocityY": 0.6687593920651365, - "timestamp": 7.353216963647479 - }, - { - "x": 7.901324248569515, - "y": 6.020633645713137, - "heading": -3.4906075967346855, - "angularVelocity": -0.03082366852897056, - "velocityX": -0.85163135327951, - "velocityY": 0.7538582103925403, - "timestamp": 7.4084340190438045 - }, - { - "x": 7.845253222549627, - "y": 6.066730442605587, - "heading": -3.491522234596702, - "angularVelocity": -0.016564408504792263, - "velocityX": -1.0154657038017145, - "velocityY": 0.8348289593058718, - "timestamp": 7.46365107444013 - }, - { - "x": 7.780004916702429, - "y": 6.117022615205706, - "heading": -3.491619914397988, - "angularVelocity": -0.0017690150368460669, - "velocityX": -1.1816694204149643, - "velocityY": 0.9108086666183527, - "timestamp": 7.518868129836456 - }, - { - "x": 7.70543218188968, - "y": 6.171171408690927, - "heading": -3.4908652785924956, - "angularVelocity": 0.013666715837632718, - "velocityX": -1.3505380588931304, - "velocityY": 0.9806534067519966, - "timestamp": 7.574085185232781 - }, - { - "x": 7.621370970218071, - "y": 6.228752526262233, - "heading": -3.4892155354501093, - "angularVelocity": 0.02987741976722745, - "velocityX": -1.5223776615440932, - "velocityY": 1.042813984882243, - "timestamp": 7.629302240629107 - }, - { - "x": 7.527642587861271, - "y": 6.289223211041998, - "heading": -3.4866181253772446, - "angularVelocity": 0.04703999614288995, - "velocityX": -1.69745347128809, - "velocityY": 1.0951450479517597, - "timestamp": 7.6845192960254325 - }, - { - "x": 7.424063129042053, - "y": 6.3518731983485806, - "heading": -3.4830074891516145, - "angularVelocity": 0.06538987274337808, - "velocityX": -1.875859878361262, - "velocityY": 1.134612971606443, - "timestamp": 7.739736351421758 - }, - { - "x": 7.310470238938363, - "y": 6.415752089641368, - "heading": -3.478300789900097, - "angularVelocity": 0.08523995381019685, - "velocityX": -2.0572065875002874, - "velocityY": 1.1568688484796892, - "timestamp": 7.794953406818084 - }, - { - "x": 7.186789890037512, - "y": 6.479567879571034, - "heading": -3.4723932719177033, - "angularVelocity": 0.10698719698092815, - "velocityX": -2.2398939605366954, - "velocityY": 1.1557260609357407, - "timestamp": 7.850170462214409 - }, - { - "x": 7.053186773651001, - "y": 6.541573247740791, - "heading": -3.465157679667485, - "angularVelocity": 0.13103908200616907, - "velocityX": -2.419598716873995, - "velocityY": 1.1229386957473142, - "timestamp": 7.905387517610735 - }, - { - "x": 6.910343930776152, - "y": 6.59953553576051, - "heading": -3.456464119078635, - "angularVelocity": 0.15744339364805293, - "velocityX": -2.5869333641495382, - "velocityY": 1.0497171137375771, - "timestamp": 7.9606045730070605 - }, - { - "x": 6.759778343764309, - "y": 6.651011215266716, - "heading": -3.4462520027321037, - "angularVelocity": 0.18494496443594796, - "velocityX": -2.726794935570973, - "velocityY": 0.9322423866454576, - "timestamp": 8.015821628403387 - }, - { - "x": 6.603790713499927, - "y": 6.6939811250265135, - "heading": -3.434630215078176, - "angularVelocity": 0.21047460011242525, - "velocityX": -2.824990017029447, - "velocityY": 0.7781999502033666, - "timestamp": 8.071038683799713 - }, - { - "x": 6.444871386080698, - "y": 6.727297088370096, - "heading": -3.421861790963788, - "angularVelocity": 0.2312405835976036, - "velocityX": -2.8780840680215385, - "velocityY": 0.6033636365513104, - "timestamp": 8.12625573919604 - }, - { - "x": 6.285143890283095, - "y": 6.750554272686326, - "heading": -3.4082408981262526, - "angularVelocity": 0.24667908746256292, - "velocityX": -2.892720277297344, - "velocityY": 0.42119566408057085, - "timestamp": 8.181472794592366 - }, - { - "x": 6.126216972903622, - "y": 6.763750889103841, - "heading": -3.3940156098665684, - "angularVelocity": 0.25762489791570925, - "velocityX": -2.8782215248306717, - "velocityY": 0.23899529452983848, - "timestamp": 8.236689849988693 - }, - { - "x": 5.969266867293909, - "y": 6.767049973704876, - "heading": -3.3793756191034694, - "angularVelocity": 0.2651353039023758, - "velocityX": -2.8424207789276137, - "velocityY": 0.059747564902821196, - "timestamp": 8.29190690538502 - }, - { - "x": 5.815157493846427, - "y": 6.760663715506681, - "heading": -3.3644631758659895, - "angularVelocity": 0.2700695125888956, - "velocityX": -2.7909741354613375, - "velocityY": -0.11565734812110663, - "timestamp": 8.347123960781346 - }, - { - "x": 5.664535976276008, - "y": 6.744805721319696, - "heading": -3.3493860812399614, - "angularVelocity": 0.2730514062695079, - "velocityX": -2.7278078573606983, - "velocityY": -0.28719376781615824, - "timestamp": 8.402341016177672 - }, - { - "x": 5.5178985721714335, - "y": 6.719673719283003, - "heading": -3.3342277061260854, - "angularVelocity": 0.27452342405938374, - "velocityX": -2.6556541824273316, - "velocityY": -0.45514926242091686, - "timestamp": 8.457558071573999 + "angularVelocity": -0.1373902696719508, + "velocityX": 0.24698962547429237, + "velocityY": 0.09346943845543118, + "timestamp": 7.026413559697236 + }, + { + "x": 8.051468196812584, + "y": 5.844685972106404, + "heading": -3.4701603161303347, + "angularVelocity": -0.1225082198013852, + "velocityX": 0.09457650562789995, + "velocityY": 0.1968449419395451, + "timestamp": 7.082058205772521 + }, + { + "x": 8.048184809934325, + "y": 5.861294321662854, + "heading": -3.4761375108001347, + "angularVelocity": -0.10741724660649189, + "velocityX": -0.059006339510488656, + "velocityY": 0.2984716541098781, + "timestamp": 7.137702851847806 + }, + { + "x": 8.036283303334299, + "y": 5.883447036443524, + "heading": -3.4812616846530076, + "angularVelocity": -0.09208745520530746, + "velocityX": -0.21388412793432043, + "velocityY": 0.3981104444567551, + "timestamp": 7.1933474979230905 + }, + { + "x": 8.015683562895257, + "y": 5.911017346008104, + "heading": -3.485517607433818, + "angularVelocity": -0.07648395813412644, + "velocityX": -0.3702016616508371, + "velocityY": 0.4954710202896893, + "timestamp": 7.248992143998375 + }, + { + "x": 7.986296123840878, + "y": 5.943858632575643, + "heading": -3.488887756801902, + "angularVelocity": -0.06056556390931846, + "velocityX": -0.5281269830455628, + "velocityY": 0.5901967014599441, + "timestamp": 7.30463679007366 + }, + { + "x": 7.948020645133899, + "y": 5.981799561635306, + "heading": -3.491351870321391, + "angularVelocity": -0.044283029784292674, + "velocityX": -0.6878555513713837, + "velocityY": 0.6818432991438246, + "timestamp": 7.360281436148945 + }, + { + "x": 7.900744135928116, + "y": 6.024637551422569, + "heading": -3.4928863660328324, + "angularVelocity": -0.027576700000313138, + "velocityX": -0.8496146986328078, + "velocityY": 0.7698492632930963, + "timestamp": 7.41592608222423 + }, + { + "x": 7.844338959231667, + "y": 6.072129847299749, + "heading": -3.493463582743254, + "angularVelocity": -0.010373265913863132, + "velocityX": -1.0136676333628925, + "velocityY": 0.8534926399374545, + "timestamp": 7.471570728299515 + }, + { + "x": 7.778660742221798, + "y": 6.123981070303483, + "heading": -3.493050769497451, + "angularVelocity": 0.00741874151278994, + "velocityX": -1.1803151182057858, + "velocityY": 0.9318277078010678, + "timestamp": 7.5272153743748 + }, + { + "x": 7.703546574545105, + "y": 6.179825467361639, + "heading": -3.491608722205396, + "angularVelocity": 0.025915292732810263, + "velocityX": -1.3498902944780617, + "velocityY": 1.0035897610455067, + "timestamp": 7.5828600204500844 + }, + { + "x": 7.618814473494392, + "y": 6.239201054727309, + "heading": -3.489089922616978, + "angularVelocity": 0.04526580302101711, + "velocityX": -1.5227359148996, + "velocityY": 1.06704942080748, + "timestamp": 7.638504666525369 + }, + { + "x": 7.5242665108900155, + "y": 6.301511231764772, + "heading": -3.485435989576966, + "angularVelocity": 0.0656654916102557, + "velocityX": -1.6991385384401072, + "velocityY": 1.119787462627769, + "timestamp": 7.694149312600654 + }, + { + "x": 7.4197013507482, + "y": 6.365967240446262, + "heading": -3.480574261391913, + "angularVelocity": 0.08737099663595954, + "velocityX": -1.8791594073640787, + "velocityY": 1.1583505912551633, + "timestamp": 7.749793958675939 + }, + { + "x": 7.30494971575777, + "y": 6.431503283367323, + "heading": -3.4744136439159683, + "angularVelocity": 0.11071357103447453, + "velocityX": -2.062222389467215, + "velocityY": 1.1777600819384002, + "timestamp": 7.805438604751224 + }, + { + "x": 7.179962559798994, + "y": 6.496661814894046, + "heading": -3.466841472829506, + "angularVelocity": 0.13608085630049782, + "velocityX": -2.2461667882598197, + "velocityY": 1.1709757563839487, + "timestamp": 7.861083250826509 + }, + { + "x": 7.0450043650642655, + "y": 6.559483047956268, + "heading": -3.4577292994416897, + "angularVelocity": 0.16375651622417847, + "velocityX": -2.425358129731578, + "velocityY": 1.1289717428919859, + "timestamp": 7.916727896901794 + }, + { + "x": 6.900979989447752, + "y": 6.617542454098851, + "heading": -3.4469716329246967, + "angularVelocity": 0.1933279708965771, + "velocityX": -2.588288106310453, + "velocityY": 1.0433960899676162, + "timestamp": 7.972372542977078 + }, + { + "x": 6.749698748781295, + "y": 6.668375124023075, + "heading": -3.4345853306759078, + "angularVelocity": 0.22259647823135656, + "velocityX": -2.718702540793954, + "velocityY": 0.9135231061663974, + "timestamp": 8.028017189052363 + }, + { + "x": 6.593622281446755, + "y": 6.710155384191086, + "heading": -3.4207896059713114, + "angularVelocity": 0.2479254641305738, + "velocityX": -2.8048784266392115, + "velocityY": 0.7508406129762251, + "timestamp": 8.083661835127648 + }, + { + "x": 6.43518641122628, + "y": 6.741964154206405, + "heading": -3.4059237330536236, + "angularVelocity": 0.26715729124370924, + "velocityX": -2.8472796826871427, + "velocityY": 0.5716411597313928, + "timestamp": 8.139306481202933 + }, + { + "x": 6.276365829184199, + "y": 6.7635314295136775, + "heading": -3.3903129196471515, + "angularVelocity": 0.28054475151753555, + "velocityX": -2.854193408422522, + "velocityY": 0.38758940578205786, + "timestamp": 8.194951127278218 + }, + { + "x": 6.1186300644231135, + "y": 6.774906528048223, + "heading": -3.3742151723731513, + "angularVelocity": 0.2892955281307887, + "velocityX": -2.8346979608366234, + "velocityY": 0.2044239533692823, + "timestamp": 8.250595773353503 + }, + { + "x": 5.963053116486022, + "y": 6.776261296768168, + "heading": -3.3578237831063493, + "angularVelocity": 0.29457262149938523, + "velocityX": -2.795901473191203, + "velocityY": 0.024346793725904915, + "timestamp": 8.306240419428788 + }, + { + "x": 5.8104290835439985, + "y": 6.767800149453071, + "heading": -3.3412831833352663, + "angularVelocity": 0.2972541104620299, + "velocityX": -2.742834103671541, + "velocityY": -0.15205680890934775, + "timestamp": 8.361885065504072 + }, + { + "x": 5.661358014830183, + "y": 6.749723919281858, + "heading": -3.3247031677966823, + "angularVelocity": 0.2979624583495684, + "velocityX": -2.678983140842141, + "velocityY": -0.3248512021579965, + "timestamp": 8.417529711579357 + }, + { + "x": 5.516304135655185, + "y": 6.722217125506872, + "heading": -3.3081691225058854, + "angularVelocity": 0.2971363187111854, + "velocityX": -2.606789500983575, + "velocityY": -0.49432956654573584, + "timestamp": 8.473174357654642 }, { "x": 5.375634670257568, "y": 6.6854448318481445, - "heading": -3.3190539711882665, - "angularVelocity": 0.27480159579151087, - "velocityX": -2.5764485428053243, - "velocityY": -0.619897008074366, - "timestamp": 8.512775126970325 - }, - { - "x": 5.258727665904114, - "y": 6.650123372593305, - "heading": -3.3062547426441777, - "angularVelocity": 0.27422216432360225, - "velocityX": -2.504720628119257, - "velocityY": -0.7567586570210144, - "timestamp": 8.559449795211165 - }, - { - "x": 5.145593525293582, - "y": 6.608655391628734, - "heading": -3.293517807854288, - "angularVelocity": 0.2728875270021734, - "velocityX": -2.423887407763944, - "velocityY": -0.888447256884578, - "timestamp": 8.606124463452005 - }, - { - "x": 5.036709373339286, - "y": 6.561360633601731, - "heading": -3.280882894662897, - "angularVelocity": 0.27070172467418824, - "velocityX": -2.3328318348714934, - "velocityY": -1.0132853603364422, - "timestamp": 8.652799131692845 - }, - { - "x": 4.932601329245533, - "y": 6.508662017990669, - "heading": -3.2683939898435894, - "angularVelocity": 0.26757351021469256, - "velocityX": -2.2305042117612404, - "velocityY": -1.1290624571585341, - "timestamp": 8.699473799933685 - }, - { - "x": 4.833831275235675, - "y": 6.451113923616155, - "heading": -3.256098455639155, - "angularVelocity": 0.26343056454070557, - "velocityX": -2.116138319402874, - "velocityY": -1.232962044369908, - "timestamp": 8.746148468174525 - }, - { - "x": 4.740968002070127, - "y": 6.38942823102359, - "heading": -3.2440453255997848, - "angularVelocity": 0.25823708006184887, - "velocityX": -1.9895861430953543, - "velocityY": -1.321609663603138, - "timestamp": 8.792823136415365 - }, - { - "x": 4.654539547896897, - "y": 6.324486679853536, - "heading": -3.2322829510253057, - "angularVelocity": 0.25200767392252327, - "velocityX": -1.8517208033972823, - "velocityY": -1.3913661010927205, - "timestamp": 8.839497804656204 - }, - { - "x": 4.574972065691894, - "y": 6.257324316824639, - "heading": -3.220856603386505, - "angularVelocity": 0.24480833114529404, - "velocityX": -1.7047251797149867, - "velocityY": -1.4389467683485437, - "timestamp": 8.886172472897044 - }, - { - "x": 4.502533427208671, - "y": 6.189074788052417, - "heading": -3.209806687720587, - "angularVelocity": 0.23674331457271136, - "velocityX": -1.5519904310715604, - "velocityY": -1.4622391833629367, - "timestamp": 8.932847141137884 - }, - { - "x": 4.4373056272084614, - "y": 6.120887020764479, - "heading": -3.199167672698052, - "angularVelocity": 0.22793981025506352, - "velocityX": -1.397498953043142, - "velocityY": -1.4609159498700834, - "timestamp": 8.979521809378724 - }, - { - "x": 4.37919780834056, - "y": 6.053841192884822, - "heading": -3.1889674291924752, - "angularVelocity": 0.2185391753176214, - "velocityX": -1.2449540844739644, - "velocityY": -1.4364500146782433, - "timestamp": 9.026196477619564 - }, - { - "x": 4.327989641671973, - "y": 5.988891000938848, - "heading": -3.179226926397484, - "angularVelocity": 0.20868927754838076, - "velocityX": -1.0971297407911678, - "velocityY": -1.3915512288343186, - "timestamp": 9.072871145860404 - }, - { - "x": 4.283383388011125, - "y": 5.926840968076357, - "heading": -3.169960503204579, - "angularVelocity": 0.1985321704932263, - "velocityX": -0.9556844288786528, - "velocityY": -1.3294156166748594, - "timestamp": 9.119545814101244 - }, - { - "x": 4.245047973877159, - "y": 5.8683507787998055, - "heading": -3.1611767340548393, - "angularVelocity": 0.18819135691367764, - "velocityX": -0.8213323324797336, - "velocityY": -1.2531463314263613, - "timestamp": 9.166220482342084 - }, - { - "x": 4.2126491469882685, - "y": 5.813953620815217, - "heading": -3.1528796247049495, - "angularVelocity": 0.1777647204063085, - "velocityX": -0.6941415570800369, - "velocityY": -1.1654535540328004, - "timestamp": 9.212895150582924 - }, - { - "x": 4.185866990370122, - "y": 5.764078548080203, - "heading": -3.1450698281525344, - "angularVelocity": 0.16732409349149657, - "velocityX": -0.5738049701810753, - "velocityY": -1.0685683394182859, - "timestamp": 9.259569818823763 - }, - { - "x": 4.164404474628658, - "y": 5.71907153950035, - "heading": -3.1377456899052736, - "angularVelocity": 0.15691891390568613, - "velocityX": -0.45983220771313277, - "velocityY": -0.9642705620877334, - "timestamp": 9.306244487064603 - }, - { - "x": 4.1479904974082915, - "y": 5.679213252595555, - "heading": -3.1309040597644757, - "angularVelocity": 0.14658122700509368, - "velocityX": -0.3516677855249456, - "velocityY": -0.8539597260579826, - "timestamp": 9.352919155305443 - }, - { - "x": 4.136379866864982, - "y": 5.644733200221981, - "heading": -3.1245408830189114, - "angularVelocity": 0.1363304118784621, - "velocityX": -0.24875657355287575, - "velocityY": -0.7387316005259564, - "timestamp": 9.399593823546283 - }, - { - "x": 4.1293517622446805, - "y": 5.615820774762028, - "heading": -3.118651612951779, - "angularVelocity": 0.12617700969494677, - "velocityX": -0.1505764236831326, - "velocityY": -0.619445762544374, - "timestamp": 9.446268491787123 + "heading": -3.2917489862090847, + "angularVelocity": 0.2950892395754448, + "velocityX": -2.527996407907734, + "velocityY": -0.6608415409629179, + "timestamp": 8.528819003729927 + }, + { + "x": 5.247302186313446, + "y": 6.642723250226847, + "heading": -3.2764342569191007, + "angularVelocity": 0.29222750886394533, + "velocityX": -2.4487721186061138, + "velocityY": -0.8151904702673559, + "timestamp": 8.581225874491414 + }, + { + "x": 5.123684691215023, + "y": 6.592227601868027, + "heading": -3.261343469002182, + "angularVelocity": 0.287954378837072, + "velocityX": -2.35880321229308, + "velocityY": -0.96353107188246, + "timestamp": 8.633632745252902 + }, + { + "x": 5.005442832506228, + "y": 6.534399403999677, + "heading": -3.2465629258898607, + "angularVelocity": 0.2820344526882774, + "velocityX": -2.2562281813568914, + "velocityY": -1.1034468768710974, + "timestamp": 8.686039616014389 + }, + { + "x": 4.893338332381132, + "y": 6.4698636715273565, + "heading": -3.2321912465960825, + "angularVelocity": 0.2742327310322778, + "velocityX": -2.139118373148127, + "velocityY": -1.2314364802667634, + "timestamp": 8.738446486775876 + }, + { + "x": 4.788214065335871, + "y": 6.399503311235688, + "heading": -3.218336699236444, + "angularVelocity": 0.26436509484973597, + "velocityX": -2.005925282654272, + "velocityY": -1.3425789265665398, + "timestamp": 8.790853357537364 + }, + { + "x": 4.690926811703409, + "y": 6.324536430026673, + "heading": -3.2051106978803485, + "angularVelocity": 0.25237151472541847, + "velocityX": -1.8563835661021135, + "velocityY": -1.4304781056324285, + "timestamp": 8.84326022829885 + }, + { + "x": 4.602213375050993, + "y": 6.246550389883575, + "heading": -3.1926184281535104, + "angularVelocity": 0.23837083850498517, + "velocityX": -1.692782556244718, + "velocityY": -1.488088088640642, + "timestamp": 8.895667099060338 + }, + { + "x": 4.522516933607232, + "y": 6.167421361715161, + "heading": -3.180950391265689, + "angularVelocity": 0.2226432663939251, + "velocityX": -1.5207250554316514, + "velocityY": -1.5098979774721726, + "timestamp": 8.948073969821825 + }, + { + "x": 4.451873293775449, + "y": 6.089098032772841, + "heading": -3.1701771256978444, + "angularVelocity": 0.20556971655254663, + "velocityX": -1.3479843158980969, + "velocityY": -1.4945240538933033, + "timestamp": 9.000480840583313 + }, + { + "x": 4.389944797643215, + "y": 6.013352078757408, + "heading": -3.160345990530402, + "angularVelocity": 0.18759248595829828, + "velocityX": -1.1816865848388818, + "velocityY": -1.4453439580502128, + "timestamp": 9.0528877113448 + }, + { + "x": 4.3361645159835325, + "y": 5.941631275114407, + "heading": -3.15148070753079, + "angularVelocity": 0.16916260923037685, + "velocityX": -1.0262066953863092, + "velocityY": -1.3685381821291336, + "timestamp": 9.105294582106287 + }, + { + "x": 4.289884639082712, + "y": 5.875042815583236, + "heading": -3.1435850366687292, + "angularVelocity": 0.150660986762505, + "velocityX": -0.8830879659167057, + "velocityY": -1.2706055248790982, + "timestamp": 9.157701452867775 + }, + { + "x": 4.2504715009741, + "y": 5.814408213255479, + "heading": -3.1366488915258626, + "angularVelocity": 0.13235182795847486, + "velocityX": -0.7520605129809926, + "velocityY": -1.1569971922902238, + "timestamp": 9.210108323629262 + }, + { + "x": 4.217349104588903, + "y": 5.760333428471323, + "heading": -3.130654197761707, + "angularVelocity": 0.11438755409455087, + "velocityX": -0.6320239293802175, + "velocityY": -1.0318262471777937, + "timestamp": 9.26251519439075 + }, + { + "x": 4.19001158999409, + "y": 5.71326891600178, + "heading": -3.125579181017236, + "angularVelocity": 0.09683876695421119, + "velocityX": -0.5216398956394738, + "velocityY": -0.8980599640024567, + "timestamp": 9.314922065152237 + }, + { + "x": 4.168021099523672, + "y": 5.673554367501423, + "heading": -3.121401048080275, + "angularVelocity": 0.07972490775067456, + "velocityX": -0.4196108287117665, + "velocityY": -0.7578118655682702, + "timestamp": 9.367328935913724 + }, + { + "x": 4.1510001991687515, + "y": 5.641450291339017, + "heading": -3.1180974896766025, + "angularVelocity": 0.06303674223762575, + "velocityX": -0.32478375654951874, + "velocityY": -0.6125928851680192, + "timestamp": 9.419735806675211 + }, + { + "x": 4.138623122411169, + "y": 5.617159927154894, + "heading": -3.1156474380074726, + "angularVelocity": 0.046750581241157815, + "velocityX": -0.2361727876085765, + "velocityY": -0.463495794180744, + "timestamp": 9.472142677436699 + }, + { + "x": 4.130607560354345, + "y": 5.600844466363652, + "heading": -3.114031389790168, + "angularVelocity": 0.030836571499560275, + "velocityX": -0.1529486866961616, + "velocityY": -0.3113229344582824, + "timestamp": 9.524549548198186 }, { "x": 4.126707553863525, "y": 5.5926337242126465, "heading": -3.1132314898410027, - "angularVelocity": 0.11612558407074823, - "velocityX": -0.05665189450327197, - "velocityY": -0.4967801898395365, - "timestamp": 9.492943160027963 - }, - { - "x": 4.126202452000023, - "y": 5.576200893396058, - "heading": -3.1101415344409413, - "angularVelocity": 0.10940744816134937, - "velocityX": -0.017884370093563993, - "velocityY": -0.5818446718274068, - "timestamp": 9.521185802114859 - }, - { - "x": 4.126848340594801, - "y": 5.557391994422956, - "heading": -3.107243507448873, - "angularVelocity": 0.10261175222742301, - "velocityX": 0.022869269553109393, - "velocityY": -0.665975191528855, - "timestamp": 9.549428444201755 - }, - { - "x": 4.128704875969954, - "y": 5.536236876199957, - "heading": -3.1045395779376674, - "angularVelocity": 0.09573925494952655, - "velocityX": 0.06573518757349699, - "velocityY": -0.7490488374958029, - "timestamp": 9.577671086288651 - }, - { - "x": 4.131835486712304, - "y": 5.512769384210887, - "heading": -3.10203186538837, - "angularVelocity": 0.08879171224780506, - "velocityX": 0.11084695025055208, - "velocityY": -0.8309241011116071, - "timestamp": 9.605913728375548 - }, - { - "x": 4.136307565749363, - "y": 5.487027967716942, - "heading": -3.09972240427302, - "angularVelocity": 0.08177213407458436, - "velocityX": 0.1583449247878192, - "velocityY": -0.9114379743490315, - "timestamp": 9.634156370462444 - }, - { - "x": 4.142192630826981, - "y": 5.459056378613465, - "heading": -3.0976131001489353, - "angularVelocity": 0.07468508497167435, - "velocityX": 0.20837516049356766, - "velocityY": -0.9904027044429669, - "timestamp": 9.66239901254934 - }, - { - "x": 4.149566433458333, - "y": 5.428904470508613, - "heading": -3.095705676064946, - "angularVelocity": 0.0675370270996881, - "velocityX": 0.2610875642818267, - "velocityY": -1.0676022452886083, - "timestamp": 9.690641654636236 - }, - { - "x": 4.158508989800092, - "y": 5.396629103824818, - "heading": -3.0940016082871296, - "angularVelocity": 0.06033669840708298, - "velocityX": 0.3166331363136689, - "velocityY": -1.1427885034442629, - "timestamp": 9.718884296723132 - }, - { - "x": 4.169104499088999, - "y": 5.36229515746973, - "heading": -3.0925020508230623, - "angularVelocity": 0.05309550924639011, - "velocityX": 0.3751599887966468, - "velocityY": -1.2156775647777545, - "timestamp": 9.747126938810029 - }, - { - "x": 4.181441106637344, - "y": 5.3259766387957415, - "heading": -3.0912077490711503, - "angularVelocity": 0.045827927427253216, - "velocityX": 0.4368078422120931, - "velocityY": -1.2859462143182547, - "timestamp": 9.775369580896925 - }, - { - "x": 4.195610459906488, - "y": 5.287757869928078, - "heading": -3.0901189442549186, - "angularVelocity": 0.03855180449767203, - "velocityX": 0.5017006987359274, - "velocityY": -1.3532292322394428, - "timestamp": 9.803612222983821 - }, - { - "x": 4.2117069996895005, - "y": 5.247734708939476, - "heading": -3.089235272184188, - "angularVelocity": 0.03128857661446859, - "velocityX": 0.5699374631270886, - "velocityY": -1.4171181600312093, - "timestamp": 9.831854865070717 - }, - { - "x": 4.229826926929038, - "y": 5.206015738227041, - "heading": -3.0885556622564883, - "angularVelocity": 0.02406325603706172, - "velocityX": 0.6415804577980706, - "velocityY": -1.4771624617865668, - "timestamp": 9.860097507157613 - }, - { - "x": 4.250066793413857, - "y": 5.162723320699504, - "heading": -3.088078245188932, - "angularVelocity": 0.016904122004143384, - "velocityX": 0.7166421053152825, - "velocityY": -1.5328742046986106, - "timestamp": 9.88834014924451 - }, - { - "x": 4.272521686590209, - "y": 5.117994390534871, - "heading": -3.0878002801517295, - "angularVelocity": 0.00984203377102721, - "velocityX": 0.795070557041513, - "velocityY": -1.5837374572468441, - "timestamp": 9.916582791331406 - }, - { - "x": 4.297283019475378, - "y": 5.071980816631299, - "heading": -3.0877181128372237, - "angularVelocity": 0.0029093352616577084, - "velocityX": 0.8767357108086503, - "velocityY": -1.6292234190412864, - "timestamp": 9.944825433418302 - }, - { - "x": 4.324435997461225, - "y": 5.024849164870591, - "heading": -3.087827174498778, - "angularVelocity": -0.0038615955695118155, - "velocityX": 0.9614177704162753, - "velocityY": -1.6688117073358897, - "timestamp": 9.973068075505198 - }, - { - "x": 4.354056909275255, - "y": 4.976779703710972, - "heading": -3.088122027441298, - "angularVelocity": -0.010439991471521545, - "velocityX": 1.0488010194971473, - "velocityY": -1.7020171488106757, - "timestamp": 10.001310717592094 - }, - { - "x": 4.386210464798987, - "y": 4.927964557643445, - "heading": -3.08859645514647, - "angularVelocity": -0.016798276298381022, - "velocityX": 1.1384754806155697, - "velocityY": -1.7284199515517666, - "timestamp": 10.02955335967899 - }, - { - "x": 4.420947454648737, - "y": 4.878605015906615, - "heading": -3.0892435869039567, - "angularVelocity": -0.022913286777326337, - "velocityX": 1.229948308053933, - "velocityY": -1.7476956151964618, - "timestamp": 10.057796001765887 - }, - { - "x": 4.458303010660593, - "y": 4.828908134239048, - "heading": -3.0900560403399195, - "angularVelocity": -0.02876690620740358, - "velocityX": 1.322665064299653, - "velocityY": -1.7596399626728296, - "timestamp": 10.086038643852783 - }, - { - "x": 4.498295688268876, - "y": 4.779082893453277, - "heading": -3.0910260632840125, - "angularVelocity": -0.03434604103639958, - "velocityX": 1.4160388211993622, - "velocityY": -1.7641848320164313, - "timestamp": 10.11428128593968 - }, - { - "x": 4.540927477874527, - "y": 4.7293362618821755, - "heading": -3.0921456599273003, - "angularVelocity": -0.03964206464263729, - "velocityX": 1.5094830531252688, - "velocityY": -1.7614014800047542, - "timestamp": 10.142523928026575 - }, - { - "x": 4.586184711726668, - "y": 4.679869521543178, - "heading": -3.093406693575906, - "angularVelocity": -0.0446499886492845, - "velocityX": 1.6024433448150754, - "velocityY": -1.7514912445797743, - "timestamp": 10.170766570113472 - }, - { - "x": 4.634039705671291, - "y": 4.630875157025283, - "heading": -3.094800966167012, - "angularVelocity": -0.0493676401384937, - "velocityX": 1.6944234111449143, - "velocityY": -1.7347656202684976, - "timestamp": 10.199009212200368 - }, - { - "x": 4.684452894473009, - "y": 4.582534494245445, - "heading": -3.0963202800022835, - "angularVelocity": -0.05379503201566885, - "velocityX": 1.7850025732935824, - "velocityY": -1.7116197072180923, - "timestamp": 10.227251854287264 - }, - { - "x": 4.737375198235536, - "y": 4.535016149580233, - "heading": -3.0979564886356585, - "angularVelocity": -0.05793397899320715, - "velocityX": 1.8738439413599313, - "velocityY": -1.682503517872359, - "timestamp": 10.25549449637416 - }, - { - "x": 4.792750387303713, - "y": 4.4884752415165705, - "heading": -3.099701542316806, - "angularVelocity": -0.061787904820602965, - "velocityX": 1.96069436059847, - "velocityY": -1.6478949781138656, - "timestamp": 10.283737138461056 + "angularVelocity": 0.01526326486474834, + "velocityX": -0.0744178470141595, + "velocityY": -0.1566730093154095, + "timestamp": 9.576956418959673 + }, + { + "x": 4.126707553863525, + "y": 5.5926337242126465, + "heading": -3.1132314898410027, + "angularVelocity": 6.34380051935383e-30, + "velocityX": 9.034383342873221e-27, + "velocityY": -4.2893656784840804e-27, + "timestamp": 9.62936328972116 + }, + { + "x": 4.127361618163081, + "y": 5.589290222894501, + "heading": -3.1133058118000747, + "angularVelocity": -0.002316783638418587, + "velocityX": 0.020388664219920926, + "velocityY": -0.10422450169017787, + "timestamp": 9.66144309114909 + }, + { + "x": 4.128734349992625, + "y": 5.58261651038244, + "heading": -3.113455522105689, + "angularVelocity": -0.00466680898728499, + "velocityX": 0.042791157315218396, + "velocityY": -0.20803472013549282, + "timestamp": 9.69352289257702 + }, + { + "x": 4.130895677213884, + "y": 5.572628451087546, + "heading": -3.113681729122776, + "angularVelocity": -0.0070513845790317895, + "velocityX": 0.06737346009184561, + "velocityY": -0.311350408989694, + "timestamp": 9.72560269400495 + }, + { + "x": 4.133921430664805, + "y": 5.559345011471469, + "heading": -3.1139855796338396, + "angularVelocity": -0.009471707976318045, + "velocityX": 0.09431958167568807, + "velocityY": -0.4140748703173961, + "timestamp": 9.75768249543288 + }, + { + "x": 4.137893983879697, + "y": 5.54278890926221, + "heading": -3.114368252819973, + "angularVelocity": -0.011928789116523258, + "velocityX": 0.12383347271698328, + "velocityY": -0.5160911686580497, + "timestamp": 9.78976229686081 + }, + { + "x": 4.14290295369757, + "y": 5.522987413987094, + "heading": -3.114830950875775, + "angularVelocity": -0.014423345382647558, + "velocityX": 0.15614092341333877, + "velocityY": -0.6172574141271481, + "timestamp": 9.821842098288739 + }, + { + "x": 4.149045956059229, + "y": 5.4999733355974545, + "heading": -3.1153748850742073, + "angularVelocity": -0.016955659767858167, + "velocityX": 0.19149128386781503, + "velocityY": -0.7174008991714964, + "timestamp": 9.853921899716669 + }, + { + "x": 4.156429402683938, + "y": 5.473786245698353, + "heading": -3.1160012557676575, + "angularVelocity": -0.01952539185310932, + "velocityX": 0.23015873839794218, + "velocityY": -0.8163108477442936, + "timestamp": 9.886001701144599 + }, + { + "x": 4.165169310646326, + "y": 5.4444739837791545, + "heading": -3.116711224448415, + "angularVelocity": -0.02213133028121866, + "velocityX": 0.27244270766523915, + "velocityY": -0.9137295311834174, + "timestamp": 9.918081502572528 + }, + { + "x": 4.17539207591783, + "y": 5.412094507307328, + "heading": -3.1175058756504197, + "angularVelocity": -0.02477107608630567, + "velocityX": 0.31866672536831697, + "velocityY": -1.0093415492165811, + "timestamp": 9.950161304000458 + }, + { + "x": 4.187235130982154, + "y": 5.376718146511725, + "heading": -3.1183861662726913, + "angularVelocity": -0.027440650599082298, + "velocityX": 0.3691748245677717, + "velocityY": -1.1027612148747323, + "timestamp": 9.982241105428388 + }, + { + "x": 4.200847362955722, + "y": 5.33843031658447, + "heading": -3.119352860063593, + "angularVelocity": -0.030134032876520004, + "velocityX": 0.4243240720847195, + "velocityY": -1.193518295718653, + "timestamp": 10.014320906856318 + }, + { + "x": 4.2163891108304945, + "y": 5.297334712708628, + "heading": -3.1204064458854384, + "angularVelocity": -0.03284265409848758, + "velocityX": 0.4844714487927506, + "velocityY": -1.281042963067218, + "timestamp": 10.046400708284247 + }, + { + "x": 4.234031491286171, + "y": 5.253556953213796, + "heading": -3.1215470404870604, + "angularVelocity": -0.03555491464573967, + "velocityX": 0.5499529196061951, + "velocityY": -1.364651822835758, + "timestamp": 10.078480509712177 + }, + { + "x": 4.253954734090019, + "y": 5.207248526343466, + "heading": -3.1227742803836263, + "angularVelocity": -0.038255844548259026, + "velocityX": 0.6210525600854548, + "velocityY": -1.4435384512702805, + "timestamp": 10.110560311140107 + }, + { + "x": 4.276345168971491, + "y": 5.158590722055644, + "heading": -3.124087213275635, + "angularVelocity": -0.04092708912050639, + "velocityX": 0.6979605198546586, + "velocityY": -1.5167738614946593, + "timestamp": 10.142640112568037 + }, + { + "x": 4.301390546701751, + "y": 5.107797994402928, + "heading": -3.1254842063708126, + "angularVelocity": -0.04354743586290734, + "velocityX": 0.7807210959995424, + "velocityY": -1.5833242536375496, + "timestamp": 10.174719913995967 + }, + { + "x": 4.329273565068363, + "y": 5.0551199465792225, + "heading": -3.1269628942313124, + "angularVelocity": -0.046094046555177036, + "velocityX": 0.8691767755874421, + "velocityY": -1.6420939494295976, + "timestamp": 10.206799715423896 + }, + { + "x": 4.360163856491336, + "y": 5.00084097031078, + "heading": -3.128520187661993, + "angularVelocity": -0.048544360044720423, + "velocityX": 0.9629202815475943, + "velocityY": -1.6919985115988345, + "timestamp": 10.238879516851826 + }, + { + "x": 4.3942092464422435, + "y": 4.9452766723777355, + "heading": -3.130152353475603, + "angularVelocity": -0.050878301640261164, + "velocityX": 1.061271841953092, + "velocityY": -1.7320648962829983, + "timestamp": 10.270959318279756 + }, + { + "x": 4.431527630090928, + "y": 4.88876672478548, + "heading": -3.131855153972168, + "angularVelocity": -0.053080144538629505, + "velocityX": 1.1632984615732394, + "velocityY": -1.761542935956488, + "timestamp": 10.303039119707686 + }, + { + "x": 4.472201034372105, + "y": 4.831664641398759, + "heading": -3.1336240146211116, + "angularVelocity": -0.05513938896777467, + "velocityX": 1.267882046357295, + "velocityY": -1.780001148542263, + "timestamp": 10.335118921135615 + }, + { + "x": 4.516273089684364, + "y": 4.77432589666215, + "heading": -3.1354541821875874, + "angularVelocity": -0.057050464311241014, + "velocityX": 1.373825689391232, + "velocityY": -1.7873784183305264, + "timestamp": 10.367198722563545 + }, + { + "x": 4.563750284037316, + "y": 4.717096303849241, + "heading": -3.1373408479707163, + "angularVelocity": -0.05881164156728009, + "velocityX": 1.4799715783657519, + "velocityY": -1.783975905882153, + "timestamp": 10.399278523991475 + }, + { + "x": 4.6146064004753145, + "y": 4.660302391620251, + "heading": -3.1392792319137426, + "angularVelocity": -0.060423813638029025, + "velocityX": 1.5853002255095934, + "velocityY": -1.7703947562326396, + "timestamp": 10.431358325419405 + }, + { + "x": 4.668788898913788, + "y": 4.604244792379401, + "heading": -3.1412646382650102, + "angularVelocity": -0.06188960850422685, + "velocityX": 1.6889910793307523, + "velocityY": -1.747442214278986, + "timestamp": 10.463438126847334 + }, + { + "x": 4.726225895091368, + "y": 4.5491947921222655, + "heading": -3.1432924960907886, + "angularVelocity": -0.0632129170230195, + "velocityX": 1.7904411380668532, + "velocityY": -1.7160330739830774, + "timestamp": 10.495517928275264 + }, + { + "x": 4.786832692051615, + "y": 4.495393553809111, + "heading": -3.1453583927115, + "angularVelocity": -0.06439867233443626, + "velocityX": 1.8892510010202963, + "velocityY": -1.677106338517248, + "timestamp": 10.527597729703194 }, { "x": 4.850517272949219, "y": 4.443053245544434, - "heading": -3.1015475306172475, - "angularVelocity": -0.06536174252967485, - "velocityX": 2.0453782428630785, - "velocityY": -1.6082771517050376, - "timestamp": 10.311979780547953 - }, - { - "x": 4.945792762773265, - "y": 4.375552517193276, - "heading": -3.104637557561012, - "angularVelocity": -0.07048555688108925, - "velocityX": 2.1732968933870485, - "velocityY": -1.5397362269966697, - "timestamp": 10.35581893115547 - }, - { - "x": 5.046613542601896, - "y": 4.311170508357876, - "heading": -3.1079513748428638, - "angularVelocity": -0.07559036240275999, - "velocityX": 2.2997886234442926, - "velocityY": -1.4685961735845707, - "timestamp": 10.399658081762988 - }, - { - "x": 5.152902446465935, - "y": 4.250040627121963, - "heading": -3.1114878828795027, - "angularVelocity": -0.08067008570262957, - "velocityX": 2.4245201467432853, - "velocityY": -1.3944129936092113, - "timestamp": 10.443497232370506 - }, - { - "x": 5.264562389730376, - "y": 4.192320838235789, - "heading": -3.1152455876027774, - "angularVelocity": -0.08571572832048371, - "velocityX": 2.547037105351461, - "velocityY": -1.316626533276764, - "timestamp": 10.487336382978024 - }, - { - "x": 5.381468375232392, - "y": 4.1382004854773315, - "heading": -3.1192223904774794, - "angularVelocity": -0.09071350196324425, - "velocityX": 2.666702796061197, - "velocityY": -1.2345210162255122, - "timestamp": 10.531175533585541 - }, - { - "x": 5.503455043013129, - "y": 4.08790945524459, - "heading": -3.1234152290197748, - "angularVelocity": -0.09564141832566364, - "velocityX": 2.7825965168179527, - "velocityY": -1.147171638496956, - "timestamp": 10.575014684193059 - }, - { - "x": 5.630296567310867, - "y": 4.041730311926649, - "heading": -3.127819430009789, - "angularVelocity": -0.10046273545405592, - "velocityX": 2.8933390026946704, - "velocityY": -1.053376780297883, - "timestamp": 10.618853834800577 - }, - { - "x": 5.761673013159542, - "y": 4.00001345800068, - "heading": -3.132427482658239, - "angularVelocity": -0.10511272651483035, - "velocityX": 2.996783560540646, - "velocityY": -0.9515890100027304, - "timestamp": 10.662692985408095 - }, - { - "x": 5.897112457336204, - "y": 3.963192523243404, - "heading": -3.137226596457673, - "angularVelocity": -0.10947095764695358, - "velocityX": 3.08946323776255, - "velocityY": -0.8399098579013413, - "timestamp": 10.706532136015612 - }, - { - "x": 6.03589172673902, - "y": 3.931786771388618, - "heading": -3.142193739184528, - "angularVelocity": -0.11330380853690723, - "velocityX": 3.1656468585643007, - "velocityY": -0.7163859568346735, - "timestamp": 10.75037128662313 - }, - { - "x": 6.176882566019167, - "y": 3.906346629663003, - "heading": -3.147286302822329, - "angularVelocity": -0.11616474241011562, - "velocityX": 3.216094229160719, - "velocityY": -0.5803064469331211, - "timestamp": 10.794210437230648 - }, - { - "x": 6.318402928580952, - "y": 3.887246837030129, - "heading": -3.15243062411994, - "angularVelocity": -0.11734536883862791, - "velocityX": 3.22817300519314, - "velocityY": -0.43567889359605416, - "timestamp": 10.838049587838166 - }, - { - "x": 6.458344624342974, - "y": 3.8743105056536162, - "heading": -3.1575282040954695, - "angularVelocity": -0.11627916838916771, - "velocityX": 3.192162572101109, - "velocityY": -0.29508626871740457, - "timestamp": 10.881888738445683 - }, - { - "x": 6.594766808589048, - "y": 3.866674400680897, - "heading": -3.162494391138218, - "angularVelocity": -0.11328200875080248, - "velocityX": 3.111880188268938, - "velocityY": -0.1741846013642831, - "timestamp": 10.925727889053201 - }, - { - "x": 6.726364790951044, - "y": 3.863186213104212, - "heading": -3.1672811670327787, - "angularVelocity": -0.10918952188229065, - "velocityX": 3.0018369548297525, - "velocityY": -0.0795678640746057, - "timestamp": 10.969567039660719 - }, - { - "x": 6.85241037724519, - "y": 3.862804185416008, - "heading": -3.171865764529248, - "angularVelocity": -0.10457769899591095, - "velocityX": 2.87518313077287, - "velocityY": -0.008714304061773629, - "timestamp": 11.013406190268237 - }, - { - "x": 6.972520342290402, - "y": 3.864712411625189, - "heading": -3.176237050164369, - "angularVelocity": -0.09971191445417933, - "velocityX": 2.739787687050078, - "velocityY": 0.04352790103679518, - "timestamp": 11.057245340875754 - }, - { - "x": 7.086492438843414, - "y": 3.8682949024292745, - "heading": -3.1803889652599335, - "angularVelocity": -0.09470792745816826, - "velocityX": 2.5997788500370076, - "velocityY": 0.08171898301950821, - "timestamp": 11.101084491483272 - }, - { - "x": 7.194218018560886, - "y": 3.873084644688448, - "heading": -3.18431784696781, - "angularVelocity": -0.08962038847539197, - "velocityX": 2.4572916725033225, - "velocityY": 0.10925718661967229, - "timestamp": 11.14492364209079 - }, - { - "x": 7.295638116776633, - "y": 3.878721280840711, - "heading": -3.1880212870664604, - "angularVelocity": -0.0844779163676376, - "velocityX": 2.3134594719623562, - "velocityY": 0.1285753960592616, - "timestamp": 11.188762792698308 - }, - { - "x": 7.390721083197748, - "y": 3.8849209621060954, - "heading": -3.1914975975406707, - "angularVelocity": -0.07929693951721277, - "velocityX": 2.1689053073215674, - "velocityY": 0.14141882722337154, - "timestamp": 11.232601943305825 - }, - { - "x": 7.479450781979312, - "y": 3.8914556120813315, - "heading": -3.1947455356655263, - "angularVelocity": -0.0740876152901293, - "velocityX": 2.0239830733934867, - "velocityY": 0.14905968488621668, - "timestamp": 11.276441093913343 - }, - { - "x": 7.561820121690822, - "y": 3.898138635011677, - "heading": -3.1977641509162766, - "angularVelocity": -0.06885660896523792, - "velocityX": 1.8788990792486582, - "velocityY": 0.15244417005650296, - "timestamp": 11.32028024452086 - }, - { - "x": 7.63782737731302, - "y": 3.904814917700527, - "heading": -3.200552694085297, - "angularVelocity": -0.06360851271927202, - "velocityX": 1.7337757362744945, - "velocityY": 0.1522904206931706, - "timestamp": 11.364119395128379 - }, - { - "x": 7.707474032598791, - "y": 3.9113537003122296, - "heading": -3.203110560481528, - "angularVelocity": -0.05834662307057743, - "velocityX": 1.588686238684281, - "velocityY": 0.14915395305540546, - "timestamp": 11.407958545735896 - }, - { - "x": 7.770763480621882, - "y": 3.9176433914401314, - "heading": -3.2054372529156474, - "angularVelocity": -0.05307339220483149, - "velocityX": 1.443674139348821, - "velocityY": 0.1434720116776842, - "timestamp": 11.451797696343414 - }, - { - "x": 7.827700224514358, - "y": 3.9235877249027666, - "heading": -3.207532356731126, - "angularVelocity": -0.047790702749590255, - "velocityX": 1.298764759431989, - "velocityY": 0.13559417507546984, - "timestamp": 11.495636846950932 - }, - { - "x": 7.8782893780082945, - "y": 3.9291028602207745, - "heading": -3.2093955224644075, - "angularVelocity": -0.0425000417996671, - "velocityX": 1.1539720271236498, - "velocityY": 0.1258038817262506, - "timestamp": 11.53947599755845 - }, - { - "x": 7.922536350053699, - "y": 3.9341151592421566, - "heading": -3.2110264534997506, - "angularVelocity": -0.03720261484864023, - "velocityX": 1.0093026765399213, - "velocityY": 0.11433385346025998, - "timestamp": 11.583315148165967 - }, - { - "x": 7.960446644787287, - "y": 3.9385594558007666, - "heading": -3.212424897087272, - "angularVelocity": -0.03189942250572562, - "velocityX": 0.8647588789525155, - "velocityY": 0.10137734187413922, - "timestamp": 11.627154298773485 - }, - { - "x": 7.99202573502137, - "y": 3.9423776908019037, - "heading": -3.2135906376808516, - "angularVelocity": -0.026591313413353933, - "velocityX": 0.7203399198310967, - "velocityY": 0.08709646396484473, - "timestamp": 11.670993449381003 - }, - { - "x": 8.01727898323447, - "y": 3.9455178222713507, - "heading": -3.214523491909814, - "angularVelocity": -0.02127902151467548, - "velocityX": 0.5760432823889977, - "velocityY": 0.07162847422752046, - "timestamp": 11.71483259998852 - }, - { - "x": 8.036211593571213, - "y": 3.9479329451914285, - "heading": -3.2152233047220844, - "angularVelocity": -0.01596319277569034, - "velocityX": 0.43186535492534833, - "velocityY": 0.055090550035959585, - "timestamp": 11.758671750596038 - }, - { - "x": 8.048828584224365, - "y": 3.9495805734534923, - "heading": -3.2156899463805253, - "angularVelocity": -0.010644404646863087, - "velocityX": 0.28780189575545956, - "velocityY": 0.03758348962585016, - "timestamp": 11.802510901203556 + "heading": -3.1474581021699306, + "angularVelocity": -0.06545269499711938, + "velocityX": 1.9851924906916565, + "velocityY": -1.6315658431448485, + "timestamp": 10.559677531131124 + }, + { + "x": 4.9437621180180376, + "y": 4.374171818676806, + "heading": -3.150402741414032, + "angularVelocity": -0.06673056625500977, + "velocityX": 2.11308781687508, + "velocityY": -1.5609710522391966, + "timestamp": 10.603804824054857 + }, + { + "x": 5.042589175643495, + "y": 4.308514394194728, + "heading": -3.15340097541372, + "angularVelocity": -0.0679451151664831, + "velocityX": 2.239590309703874, + "velocityY": -1.4879096389519224, + "timestamp": 10.64793211697859 + }, + { + "x": 5.146923258079112, + "y": 4.246207789306398, + "heading": -3.15644944306721, + "angularVelocity": -0.06908349575757691, + "velocityX": 2.364388919482122, + "velocityY": -1.4119743306261106, + "timestamp": 10.692059409902322 + }, + { + "x": 5.256670681278472, + "y": 4.187401339376366, + "heading": -3.1595440333108304, + "angularVelocity": -0.07012871260806186, + "velocityX": 2.4870644883891004, + "velocityY": -1.3326548272895222, + "timestamp": 10.736186702826055 + }, + { + "x": 5.37171218426409, + "y": 4.1322729451563776, + "heading": -3.1626796182046615, + "angularVelocity": -0.07105772156135512, + "velocityX": 2.607037399381106, + "velocityY": -1.2493037883667124, + "timestamp": 10.780313995749788 + }, + { + "x": 5.491892080249721, + "y": 4.081037149777456, + "heading": -3.1658496518601376, + "angularVelocity": -0.07183838947372749, + "velocityX": 2.7234821812736496, + "velocityY": -1.1610908348145161, + "timestamp": 10.82444128867352 + }, + { + "x": 5.617001050441113, + "y": 4.033955830214484, + "heading": -3.1690455482470474, + "angularVelocity": -0.07242448324290972, + "velocityX": 2.8351834409516603, + "velocityY": -1.066943300699277, + "timestamp": 10.868568581597254 + }, + { + "x": 5.746747873958915, + "y": 3.99135176259693, + "heading": -3.172255686793518, + "angularVelocity": -0.07274723495997151, + "velocityX": 2.9402851369570526, + "velocityY": -0.9654811069237402, + "timestamp": 10.912695874520987 + }, + { + "x": 5.880711540503468, + "y": 3.953623523789422, + "heading": -3.1754637955644602, + "angularVelocity": -0.0727012367716988, + "velocityX": 3.0358460188366085, + "velocityY": -0.8549864790644365, + "timestamp": 10.95682316744472 + }, + { + "x": 6.018259312854991, + "y": 3.921253418671523, + "heading": -3.17864639066564, + "angularVelocity": -0.07212305333754412, + "velocityX": 3.1170679921211555, + "velocityY": -0.7335619969674041, + "timestamp": 11.000950460368452 + }, + { + "x": 6.1584140770218765, + "y": 3.894778972069645, + "heading": -3.1817693859537624, + "angularVelocity": -0.07077241954361635, + "velocityX": 3.1761468896158984, + "velocityY": -0.5999562821049207, + "timestamp": 11.045077753292185 + }, + { + "x": 6.299691207685043, + "y": 3.8746523574270517, + "heading": -3.1847868443417173, + "angularVelocity": -0.06838077271519878, + "velocityX": 3.2015816358220777, + "velocityY": -0.4561035429338189, + "timestamp": 11.089205046215918 + }, + { + "x": 6.440086926929617, + "y": 3.8609114265325597, + "heading": -3.1876514418180824, + "angularVelocity": -0.064916682773087, + "velocityX": 3.181607344171908, + "velocityY": -0.31139301742893755, + "timestamp": 11.13333233913965 + }, + { + "x": 6.577519585241789, + "y": 3.852895304317245, + "heading": -3.1903375774921936, + "angularVelocity": -0.06087243282188403, + "velocityX": 3.1144593109235577, + "velocityY": -0.1816590523504174, + "timestamp": 11.177459632063384 + }, + { + "x": 6.710430813156556, + "y": 3.849473711924821, + "heading": -3.1928462395413875, + "angularVelocity": -0.05685057666079069, + "velocityX": 3.0119959577960485, + "velocityY": -0.07753914110112503, + "timestamp": 11.221586924987117 + }, + { + "x": 6.837903774130578, + "y": 3.849513114724915, + "heading": -3.195189040331929, + "angularVelocity": -0.05309187659869676, + "velocityX": 2.888755519046643, + "velocityY": 0.0008929349045215606, + "timestamp": 11.26571421791085 + }, + { + "x": 6.959451864685314, + "y": 3.8520920843748097, + "heading": -3.1973778162141286, + "angularVelocity": -0.049601408497511906, + "velocityX": 2.754487812447785, + "velocityY": 0.0584438672535896, + "timestamp": 11.309841510834582 + }, + { + "x": 7.074821471996235, + "y": 3.8565095462953276, + "heading": -3.199422165983164, + "angularVelocity": -0.046328465527412294, + "velocityX": 2.6144728050804824, + "velocityY": 0.10010724945563003, + "timestamp": 11.353968803758315 + }, + { + "x": 7.183879110928512, + "y": 3.862235800907705, + "heading": -3.2013295566724143, + "angularVelocity": -0.043224738316652994, + "velocityX": 2.47143279604223, + "velocityY": 0.12976673240016404, + "timestamp": 11.398096096682048 + }, + { + "x": 7.286554059594033, + "y": 3.8688649864165408, + "heading": -3.203105828627542, + "angularVelocity": -0.04025336333678901, + "velocityX": 2.3267901079492375, + "velocityY": 0.15022869225839522, + "timestamp": 11.44222338960578 + }, + { + "x": 7.382809422368965, + "y": 3.876079871178506, + "heading": -3.2047556287978103, + "angularVelocity": -0.037387296182429475, + "velocityX": 2.1813113018578907, + "velocityY": 0.16350164000394588, + "timestamp": 11.486350682529514 + }, + { + "x": 7.472627119079689, + "y": 3.8836274243417246, + "heading": -3.2062827243266865, + "angularVelocity": -0.03460659894808434, + "velocityX": 2.0354227680805117, + "velocityY": 0.1710404754776865, + "timestamp": 11.530477975453246 + }, + { + "x": 7.55599980644016, + "y": 3.891302009366154, + "heading": -3.2076902226665296, + "angularVelocity": -0.0318963219039034, + "velocityX": 1.8893678228702142, + "velocityY": 0.17391923492097494, + "timestamp": 11.57460526837698 + }, + { + "x": 7.6329263709350945, + "y": 3.8989336935716974, + "heading": -3.2089807269793242, + "angularVelocity": -0.029245036966696142, + "velocityX": 1.743287643497406, + "velocityY": 0.17294702892229097, + "timestamp": 11.618732561300712 + }, + { + "x": 7.703409332939463, + "y": 3.9063799703337883, + "heading": -3.2101564476934303, + "angularVelocity": -0.026643844120189303, + "velocityX": 1.5972645801360887, + "velocityY": 0.16874537885115004, + "timestamp": 11.662859854224445 + }, + { + "x": 7.767453311384192, + "y": 3.9135197819904346, + "heading": -3.211219284147651, + "angularVelocity": -0.02408569354248682, + "velocityX": 1.4513461896567743, + "velocityY": 0.16180035491836087, + "timestamp": 11.706987147148178 + }, + { + "x": 7.825064096457434, + "y": 3.9202491201135516, + "heading": -3.2121708854927884, + "angularVelocity": -0.02156491554516941, + "velocityX": 1.3055590147533807, + "velocityY": 0.1524983219511668, + "timestamp": 11.75111444007191 + }, + { + "x": 7.876248081008777, + "y": 3.926477727608759, + "heading": -3.21301269693629, + "angularVelocity": -0.01907688842269266, + "velocityX": 1.1599167127656267, + "velocityY": 0.14115090871249011, + "timestamp": 11.795241732995644 + }, + { + "x": 7.921011908809607, + "y": 3.9321265849814897, + "heading": -3.213745995433236, + "angularVelocity": -0.01661779928837861, + "velocityX": 1.0144249700111274, + "velocityY": 0.12801277845196743, + "timestamp": 11.839369025919376 + }, + { + "x": 7.959362256636442, + "y": 3.9371259647519805, + "heading": -3.214371917641177, + "angularVelocity": -0.01418446876001787, + "velocityX": 0.8690845344425987, + "velocityY": 0.11329450413219869, + "timestamp": 11.88349631884311 + }, + { + "x": 7.991305700332075, + "y": 3.9414139044546914, + "heading": -3.2148914821093557, + "angularVelocity": -0.011774220301181082, + "velocityX": 0.7238931187290586, + "velocityY": 0.09717205426858692, + "timestamp": 11.927623611766842 + }, + { + "x": 8.0168486342553, + "y": 3.9449349928496713, + "heading": -3.215305607104995, + "angularVelocity": -0.009384781349602625, + "velocityX": 0.5788466101324847, + "velocityY": 0.07979389084813283, + "timestamp": 11.971750904690575 + }, + { + "x": 8.035997224984508, + "y": 3.9476393938744345, + "heading": -3.2156151250917477, + "angularVelocity": -0.007014207449519859, + "velocityX": 0.4339398467588367, + "velocityY": 0.061286356936450265, + "timestamp": 12.015878197614308 + }, + { + "x": 8.048757387107702, + "y": 3.949482053440674, + "heading": -3.2158207946062887, + "angularVelocity": -0.004660823289036077, + "velocityX": 0.2891671180747018, + "velocityY": 0.04175782025477947, + "timestamp": 12.06000549053804 }, { "x": 8.055134773254395, "y": 3.9504220485687256, "heading": -3.2159233100890603, - "angularVelocity": -0.005323180428930311, - "velocityX": 0.14384833972918967, - "velocityY": 0.019194603535245852, - "timestamp": 11.846350051811074 + "angularVelocity": -0.0023231763378057644, + "velocityX": 0.1445224876521085, + "velocityY": 0.02130189879710489, + "timestamp": 12.104132783461774 }, { "x": 8.055134773254395, "y": 3.9504220485687256, "heading": -3.2159233100890603, - "angularVelocity": -6.67822227879436e-24, - "velocityX": 2.8759643270288254e-22, - "velocityY": -3.633600230346585e-23, - "timestamp": 11.890189202418592 + "angularVelocity": -3.604262691063738e-28, + "velocityX": 6.313479362917307e-28, + "velocityY": -2.1122209046929412e-26, + "timestamp": 12.148260076385506 }, { "x": 8.049461022102024, - "y": 3.949818782258034, + "y": 3.9498187822580335, "heading": -3.2160337027243697, - "angularVelocity": -0.0026590767459743715, - "velocityX": -0.13666617985358623, - "velocityY": -0.014531145251617299, - "timestamp": 11.931704602632813 + "angularVelocity": -0.0026590767459743207, + "velocityX": -0.13666617985358606, + "velocityY": -0.014531145251617469, + "timestamp": 12.189775476599728 }, { - "x": 8.038111439942709, - "y": 3.948632147519207, + "x": 8.038111439942707, + "y": 3.9486321475192065, "heading": -3.216254752452189, - "angularVelocity": -0.005324523590736258, - "velocityX": -0.2733824580939108, - "velocityY": -0.028583001312859572, - "timestamp": 11.973220002847034 + "angularVelocity": -0.005324523590736178, + "velocityX": -0.27338245809391043, + "velocityY": -0.028583001312859898, + "timestamp": 12.231290876813949 }, { "x": 8.021083835373686, "y": 3.9468838801152724, - "heading": -3.2165867486967437, - "angularVelocity": -0.007996941926150615, - "velocityX": -0.4101515216319159, - "velocityY": -0.04211129833539491, - "timestamp": 12.014735403061255 + "heading": -3.216586748696743, + "angularVelocity": -0.007996941926150492, + "velocityX": -0.41015152163191543, + "velocityY": -0.0421112983353954, + "timestamp": 12.27280627702817 }, { - "x": 7.998375901501308, + "x": 7.998375901501307, "y": 3.9445978195464457, - "heading": -3.217030009033054, - "angularVelocity": -0.010677009833060662, - "velocityX": -0.5469761523483998, - "velocityY": -0.05506536266133637, - "timestamp": 12.056250803275477 - }, - { - "x": 7.969985213798721, - "y": 3.941800228532568, - "heading": -3.2175848829828544, - "angularVelocity": -0.013365496826158159, - "velocityX": -0.6838591837267317, - "velocityY": -0.06738682511649931, - "timestamp": 12.097766203489698 - }, - { - "x": 7.935909230970343, - "y": 3.9385201802867242, - "heading": -3.2182517565758397, - "angularVelocity": -0.01606328228908489, - "velocityX": -0.8208034284276452, - "velocityY": -0.07900798809402601, - "timestamp": 12.13928160370392 - }, - { - "x": 7.896145300692885, - "y": 3.9347900324583227, - "heading": -3.2190310578779004, - "angularVelocity": -0.018771378766420068, - "velocityX": -0.9578115608250078, - "velocityY": -0.0898497379081842, - "timestamp": 12.18079700391814 - }, - { - "x": 7.850690673153943, - "y": 3.9306460132603056, - "heading": -3.2199232637551667, - "angularVelocity": -0.02149096173137802, - "velocityX": -1.0948859291827262, - "velocityY": -0.09981884256525955, - "timestamp": 12.222312404132362 - }, - { - "x": 7.799542527002307, + "heading": -3.2170300090330537, + "angularVelocity": -0.010677009833060467, + "velocityX": -0.5469761523483992, + "velocityY": -0.055065362661337006, + "timestamp": 12.314321677242392 + }, + { + "x": 7.96998521379872, + "y": 3.9418002285325686, + "heading": -3.2175848829828535, + "angularVelocity": -0.013365496826157975, + "velocityX": -0.683859183726731, + "velocityY": -0.06738682511650008, + "timestamp": 12.355837077456613 + }, + { + "x": 7.935909230970341, + "y": 3.9385201802867247, + "heading": -3.218251756575839, + "angularVelocity": -0.01606328228908466, + "velocityX": -0.8208034284276444, + "velocityY": -0.07900798809402691, + "timestamp": 12.397352477670834 + }, + { + "x": 7.896145300692883, + "y": 3.9347900324583236, + "heading": -3.2190310578778996, + "angularVelocity": -0.01877137876641979, + "velocityX": -0.957811560825007, + "velocityY": -0.08984973790818522, + "timestamp": 12.438867877885055 + }, + { + "x": 7.8506906731539425, + "y": 3.930646013260306, + "heading": -3.2199232637551662, + "angularVelocity": -0.02149096173137775, + "velocityX": -1.094885929182725, + "velocityY": -0.0998188425652607, + "timestamp": 12.480383278099277 + }, + { + "x": 7.7995425270023055, "y": 3.926128954800206, - "heading": -3.2209289082374455, - "angularVelocity": -0.024223408110953828, - "velocityX": -1.2320282566881058, - "velocityY": -0.10880440599854417, - "timestamp": 12.263827804346583 + "heading": -3.220928908237445, + "angularVelocity": -0.024223408110953516, + "velocityX": -1.2320282566881047, + "velocityY": -0.10880440599854542, + "timestamp": 12.521898678313498 }, { - "x": 7.742698015104244, - "y": 3.9212852225051047, - "heading": -3.2220485929804368, - "angularVelocity": -0.02697034684030146, - "velocityX": -1.3692391643761666, - "velocityY": -0.11667314466696567, - "timestamp": 12.305343204560804 + "x": 7.742698015104242, + "y": 3.921285222505105, + "heading": -3.2220485929804363, + "angularVelocity": -0.026970346840301144, + "velocityX": -1.3692391643761652, + "velocityY": -0.116673144666967, + "timestamp": 12.56341407852772 }, { - "x": 7.680154342166579, + "x": 7.680154342166577, "y": 3.9161679101915414, - "heading": -3.2232830005246065, - "angularVelocity": -0.029733726226896906, - "velocityX": -1.5065174035402846, - "velocityY": -0.12326298884649987, - "timestamp": 12.346858604775026 + "heading": -3.223283000524606, + "angularVelocity": -0.02973372622689661, + "velocityX": -1.506517403540283, + "velocityY": -0.12326298884650128, + "timestamp": 12.60492947874194 }, { - "x": 7.6119088943213455, - "y": 3.910838401815779, - "heading": -3.224632911344616, - "angularVelocity": -0.03251590525548651, - "velocityX": -1.6438586041103576, - "velocityY": -0.12837425023635576, - "timestamp": 12.388374004989247 + "x": 7.611908894321344, + "y": 3.9108384018157785, + "heading": -3.2246329113446155, + "angularVelocity": -0.03251590525548623, + "velocityX": -1.6438586041103558, + "velocityY": -0.12837425023635723, + "timestamp": 12.646444878956162 }, { - "x": 7.537959455007088, - "y": 3.9053684501424586, - "heading": -3.226099226134968, - "angularVelocity": -0.03531977971513932, - "velocityX": -1.781253195986903, - "velocityY": -0.13175717071484946, - "timestamp": 12.429889405203468 + "x": 7.537959455007086, + "y": 3.905368450142458, + "heading": -3.2260992261349672, + "angularVelocity": -0.035319779715139006, + "velocityX": -1.781253195986901, + "velocityY": -0.13175717071485094, + "timestamp": 12.687960279170383 }, { - "x": 7.458304567583275, + "x": 7.458304567583274, "y": 3.8998430016438226, - "heading": -3.2276829954841744, - "angularVelocity": -0.03814896016982299, - "velocityX": -1.918682874614946, - "velocityY": -0.13309394755015685, - "timestamp": 12.47140480541769 + "heading": -3.227682995484174, + "angularVelocity": -0.03814896016982266, + "velocityX": -1.918682874614944, + "velocityY": -0.13309394755015833, + "timestamp": 12.729475679384604 }, { - "x": 7.372944154845319, + "x": 7.372944154845317, "y": 3.8943641280279326, - "heading": -3.2293854602252283, - "angularVelocity": -0.04100802912339145, - "velocityX": -2.0561144129044084, - "velocityY": -0.13197207753312612, - "timestamp": 12.51292020563191 + "heading": -3.229385460225228, + "angularVelocity": -0.04100802912339112, + "velocityX": -2.0561144129044058, + "velocityY": -0.13197207753312756, + "timestamp": 12.770991079598826 }, { - "x": 7.281880604712493, - "y": 3.889056649665367, - "heading": -3.231208107626954, - "angularVelocity": -0.04390292258585246, - "velocityX": -2.1934884323150885, - "velocityY": -0.12784360346230503, - "timestamp": 12.554435605846132 + "x": 7.281880604712491, + "y": 3.8890566496653665, + "heading": -3.2312081076269537, + "angularVelocity": -0.043902922585852135, + "velocityX": -2.193488432315086, + "velocityY": -0.1278436034623064, + "timestamp": 12.812506479813047 }, { - "x": 7.185120739461101, + "x": 7.185120739461099, "y": 3.8840764365077023, - "heading": -3.233152751779346, - "angularVelocity": -0.046841512844808565, - "velocityX": -2.3306981205072343, - "velocityY": -0.11996062020276857, - "timestamp": 12.595951006060353 + "heading": -3.2331527517793455, + "angularVelocity": -0.04684151284480821, + "velocityX": -2.330698120507232, + "velocityY": -0.11996062020276978, + "timestamp": 12.854021880027268 }, { "x": 7.082679550342636, "y": 3.879623112717479, - "heading": -3.235221652055951, - "angularVelocity": -0.049834525644205194, - "velocityX": -2.4675467077244044, - "velocityY": -0.10726920051942225, - "timestamp": 12.637466406274575 + "heading": -3.2352216520559507, + "angularVelocity": -0.049834525644204826, + "velocityX": -2.467546707724402, + "velocityY": -0.10726920051942324, + "timestamp": 12.89553728024149 }, { - "x": 6.974587692374974, + "x": 6.974587692374973, "y": 3.8759603104264273, - "heading": -3.2374176930686835, - "angularVelocity": -0.05289702138003147, - "velocityX": -2.60365689382502, - "velocityY": -0.08822755585039416, - "timestamp": 12.678981806488796 + "heading": -3.237417693068683, + "angularVelocity": -0.05289702138003111, + "velocityX": -2.6036568938250175, + "velocityY": -0.08822755585039478, + "timestamp": 12.93705268045571 }, { "x": 6.860907625972457, "y": 3.873449383506687, - "heading": -3.2397446641736134, - "angularVelocity": -0.056050793029157005, - "velocityX": -2.7382625680090227, - "velocityY": -0.060481818958357046, - "timestamp": 12.720497206703017 + "heading": -3.239744664173613, + "angularVelocity": -0.056050793029156644, + "velocityX": -2.7382625680090196, + "velocityY": -0.06048181895835718, + "timestamp": 12.978568080669932 }, { - "x": 6.74177148088028, - "y": 3.8726075802709827, - "heading": -3.2422076835623286, - "angularVelocity": -0.05932784884658806, - "velocityX": -2.869685573965975, - "velocityY": -0.020276890776945063, - "timestamp": 12.762012606917239 + "x": 6.741771480880281, + "y": 3.8726075802709823, + "heading": -3.242207683562328, + "angularVelocity": -0.059327848846587705, + "velocityX": -2.8696855739659712, + "velocityY": -0.020276890776944532, + "timestamp": 13.020083480884153 }, { - "x": 6.6174784673151565, - "y": 3.874207359068915, + "x": 6.617478467315157, + "y": 3.8742073590689143, "heading": -3.24481367151268, - "angularVelocity": -0.06277159648960273, - "velocityX": -2.9939013697029333, - "velocityY": 0.0385345869165934, - "timestamp": 12.80352800713146 + "angularVelocity": -0.0627715964896024, + "velocityX": -2.9939013697029293, + "velocityY": 0.03853458691659454, + "timestamp": 13.061598881098375 }, { - "x": 6.4887587158832485, - "y": 3.879406926640923, - "heading": -3.2475703091903396, - "angularVelocity": -0.06640036380319413, - "velocityX": -3.100530183202083, - "velocityY": 0.12524430802010658, - "timestamp": 12.845043407345681 + "x": 6.488758715883249, + "y": 3.879406926640922, + "heading": -3.247570309190339, + "angularVelocity": -0.06640036380319386, + "velocityX": -3.1005301832020784, + "velocityY": 0.12524430802010722, + "timestamp": 13.103114281312596 }, { "x": 6.357349625228428, - "y": 3.8896386087606305, + "y": 3.8896386087606296, "heading": -3.250472668687868, - "angularVelocity": -0.06991043040781324, - "velocityX": -3.1653094990471695, - "velocityY": 0.24645510020164924, - "timestamp": 12.886558807559902 + "angularVelocity": -0.06991043040781329, + "velocityX": -3.165309499047169, + "velocityY": 0.24645510020164774, + "timestamp": 13.144629681526817 }, { "x": 6.226097742502279, - "y": 3.905573882546097, + "y": 3.905573882546096, "heading": -3.253467220206788, - "angularVelocity": -0.07213110083169348, - "velocityX": -3.161522761406179, - "velocityY": 0.383840061838245, - "timestamp": 12.928074207774124 + "angularVelocity": -0.07213110083169395, + "velocityX": -3.161522761406181, + "velocityY": 0.38384006183824343, + "timestamp": 13.186145081741039 }, { "x": 6.097361671143063, - "y": 3.9266303810010146, + "y": 3.926630381001014, "heading": -3.256480660362481, - "angularVelocity": -0.07258607986779293, + "angularVelocity": -0.07258607986779345, "velocityX": -3.1009232885852347, - "velocityY": 0.5071972893496193, - "timestamp": 12.969589607988345 + "velocityY": 0.5071972893496168, + "timestamp": 13.22766048195526 }, { - "x": 5.972395859043094, - "y": 3.9519695662893874, + "x": 5.972395859043095, + "y": 3.951969566289386, "heading": -3.2594678160246513, - "angularVelocity": -0.0719529535246346, - "velocityX": -3.0101073687146878, - "velocityY": 0.6103562812262663, - "timestamp": 13.011105008202566 + "angularVelocity": -0.07195295352463506, + "velocityX": -3.0101073687146873, + "velocityY": 0.6103562812262632, + "timestamp": 13.269175882169481 }, { "x": 5.851830452160621, - "y": 3.98094091133554, + "y": 3.980940911335539, "heading": -3.2624048122101206, - "angularVelocity": -0.07074473979086844, - "velocityX": -2.9041128415082156, - "velocityY": 0.6978457366822637, - "timestamp": 13.052620408416788 + "angularVelocity": -0.07074473979086897, + "velocityX": -2.9041128415082147, + "velocityY": 0.6978457366822604, + "timestamp": 13.310691282383702 }, { - "x": 5.736009410595541, - "y": 4.013081963648901, + "x": 5.736009410595542, + "y": 4.0130819636489, "heading": -3.265278093679901, - "angularVelocity": -0.06921001495720346, - "velocityX": -2.7898331936447005, - "velocityY": 0.7741958923077217, - "timestamp": 13.094135808631009 + "angularVelocity": -0.06921001495720394, + "velocityX": -2.7898331936447, + "velocityY": 0.7741958923077186, + "timestamp": 13.352206682597924 }, { - "x": 5.625138940256401, - "y": 4.048059882088208, + "x": 5.625138940256402, + "y": 4.048059882088207, "heading": -3.2680792005517927, - "angularVelocity": -0.06747151315988424, - "velocityX": -2.6705865718996242, - "velocityY": 0.8425287546023715, - "timestamp": 13.13565120884523 + "angularVelocity": -0.06747151315988477, + "velocityX": -2.670586571899624, + "velocityY": 0.8425287546023689, + "timestamp": 13.393722082812145 }, { "x": 5.519352651225023, - "y": 4.085627588699354, + "y": 4.085627588699353, "heading": -3.270802426805142, - "angularVelocity": -0.0655955678928201, - "velocityX": -2.548121624397602, - "velocityY": 0.9049101397865453, - "timestamp": 13.177166609059451 + "angularVelocity": -0.06559556789282064, + "velocityX": -2.5481216243976026, + "velocityY": 0.9049101397865432, + "timestamp": 13.435237483026366 }, { "x": 5.41874256251759, "y": 4.125595879402791, - "heading": -3.2734436882617857, - "angularVelocity": -0.06362124520091712, - "velocityX": -2.4234401737254054, - "velocityY": 0.9627340817431456, - "timestamp": 13.218682009273673 + "heading": -3.2734436882617852, + "angularVelocity": -0.06362124520091768, + "velocityX": -2.4234401737254063, + "velocityY": 0.9627340817431439, + "timestamp": 13.476752883240588 }, { "x": 5.323375157332968, - "y": 4.167815854983862, - "heading": -3.2759999255233883, - "angularVelocity": -0.06157322941395978, - "velocityX": -2.2971573125278995, - "velocityY": 1.0169714217667107, - "timestamp": 13.260197409487894 + "y": 4.1678158549838615, + "heading": -3.275999925523388, + "angularVelocity": -0.06157322941396035, + "velocityX": -2.297157312527901, + "velocityY": 1.0169714217667094, + "timestamp": 13.518268283454809 }, { "x": 5.233300333220428, - "y": 4.212167583324044, + "y": 4.212167583324043, "heading": -3.2784687641766523, - "angularVelocity": -0.05946802007267365, - "velocityX": -2.1696725467597475, - "velocityY": 1.0683199032485298, - "timestamp": 13.301712809702115 + "angularVelocity": -0.059468020072674224, + "velocityX": -2.169672546759749, + "velocityY": 1.0683199032485289, + "timestamp": 13.55978368366903 }, { "x": 5.148556709289551, "y": 4.258552551269531, "heading": -3.2808483088426774, - "angularVelocity": -0.057317155892666005, - "velocityX": -2.0412575452385195, - "velocityY": 1.1172954543648586, - "timestamp": 13.343228209916337 + "angularVelocity": -0.05731715589266657, + "velocityX": -2.0412575452385213, + "velocityY": 1.117295454364858, + "timestamp": 13.601299083883251 }, { - "x": 5.093077041800994, - "y": 4.291207597300885, + "x": 5.093077041800993, + "y": 4.291207597300886, "heading": -3.28243411107928, - "angularVelocity": -0.05582003804977698, - "velocityX": -1.9528772748078769, - "velocityY": 1.1494534879032838, - "timestamp": 13.371637402958955 + "angularVelocity": -0.05582003804977755, + "velocityX": -1.9528772748078782, + "velocityY": 1.1494534879032836, + "timestamp": 13.62970827692587 }, { "x": 5.040173170230802, - "y": 4.324572617724137, + "y": 4.3245726177241375, "heading": -3.283974328628088, - "angularVelocity": -0.05421546280803395, - "velocityX": -1.8622095844407967, - "velocityY": 1.1744444966528669, - "timestamp": 13.400046596001573 + "angularVelocity": -0.054215462808034555, + "velocityX": -1.8622095844407982, + "velocityY": 1.174444496652867, + "timestamp": 13.658117469968488 }, { - "x": 4.98989479951463, - "y": 4.358433126349112, + "x": 4.989894799514629, + "y": 4.358433126349113, "heading": -3.2854661326260484, - "angularVelocity": -0.05251131194477776, - "velocityX": -1.7697922866287699, - "velocityY": 1.1918856186509867, - "timestamp": 13.428455789044191 + "angularVelocity": -0.05251131194477834, + "velocityX": -1.7697922866287714, + "velocityY": 1.1918856186509874, + "timestamp": 13.686526663011106 }, { - "x": 4.9422741836993005, - "y": 4.392567638374272, + "x": 4.9422741836993, + "y": 4.392567638374273, "heading": -3.286906936138998, - "angularVelocity": -0.050716101326364144, - "velocityX": -1.6762396504502126, - "velocityY": 1.2015305036631476, - "timestamp": 13.45686498208681 + "angularVelocity": -0.0507161013263647, + "velocityX": -1.676239650450214, + "velocityY": 1.2015305036631485, + "timestamp": 13.714935856053724 }, { - "x": 4.897324937032935, - "y": 4.4267521795236116, + "x": 4.897324937032934, + "y": 4.426752179523612, "heading": -3.2882943981413915, - "angularVelocity": -0.04883848690499538, - "velocityX": -1.5822077944606066, - "velocityY": 1.2032915225032208, - "timestamp": 13.485274175129428 - }, - { - "x": 4.855041998988872, - "y": 4.460764984125912, - "heading": -3.2896264183398576, - "angularVelocity": -0.04688694242276584, - "velocityX": -1.488354068369098, - "velocityY": 1.1972464177802156, - "timestamp": 13.513683368172046 - }, - { - "x": 4.815402731889438, - "y": 4.49439090299611, - "heading": -3.2909011283646152, - "angularVelocity": -0.044869631560659845, - "velocityX": -1.395297185666981, - "velocityY": 1.1836280889694686, - "timestamp": 13.542092561214664 - }, - { - "x": 4.778368948070447, - "y": 4.527425114367741, - "heading": -3.292116883219862, - "angularVelocity": -0.04279441705448228, - "velocityX": -1.3035845039116323, - "velocityY": 1.162800059898788, - "timestamp": 13.570501754257283 - }, - { - "x": 4.743889546033795, - "y": 4.559675883528322, - "heading": -3.2932722542437216, - "angularVelocity": -0.04066891383103432, - "velocityX": -1.2136705884228616, - "velocityY": 1.135222993212112, - "timestamp": 13.5989109472999 - }, - { - "x": 4.711903404867425, - "y": 4.590966294355543, - "heading": -3.294366022687478, - "angularVelocity": -0.038500510807015505, - "velocityX": -1.1259081213037754, - "velocityY": 1.1014185014083835, - "timestamp": 13.627320140342519 - }, - { - "x": 4.682342231358772, - "y": 4.62113502683453, - "heading": -3.2953971721767, - "angularVelocity": -0.036296331531676815, - "velocityX": -1.0405495666246902, - "velocityY": 1.0619355654956426, - "timestamp": 13.655729333385137 - }, - { - "x": 4.655133141889209, - "y": 4.650036350102354, - "heading": -3.2963648786428728, - "angularVelocity": -0.03406314514887169, - "velocityX": -0.9577565060980874, - "velocityY": 1.0173229216496225, - "timestamp": 13.684138526427756 - }, - { - "x": 4.6302008571197, - "y": 4.677539537863245, - "heading": -3.297268497203799, - "angularVelocity": -0.0318072589943193, + "angularVelocity": -0.04883848690499593, + "velocityX": -1.5822077944606079, + "velocityY": 1.2032915225032221, + "timestamp": 13.743345049096343 + }, + { + "x": 4.855041998988871, + "y": 4.4607649841259125, + "heading": -3.289626418339858, + "angularVelocity": -0.04688694242276638, + "velocityX": -1.4883540683690992, + "velocityY": 1.1972464177802173, + "timestamp": 13.771754242138961 + }, + { + "x": 4.815402731889437, + "y": 4.494390902996111, + "heading": -3.290901128364616, + "angularVelocity": -0.044869631560660386, + "velocityX": -1.3952971856669822, + "velocityY": 1.1836280889694708, + "timestamp": 13.80016343518158 + }, + { + "x": 4.7783689480704465, + "y": 4.527425114367743, + "heading": -3.292116883219863, + "angularVelocity": -0.04279441705448278, + "velocityX": -1.3035845039116334, + "velocityY": 1.1628000598987902, + "timestamp": 13.828572628224197 + }, + { + "x": 4.743889546033794, + "y": 4.559675883528325, + "heading": -3.2932722542437225, + "angularVelocity": -0.04066891383103477, + "velocityX": -1.2136705884228622, + "velocityY": 1.1352229932121145, + "timestamp": 13.856981821266816 + }, + { + "x": 4.7119034048674235, + "y": 4.590966294355546, + "heading": -3.2943660226874782, + "angularVelocity": -0.038500510807015914, + "velocityX": -1.1259081213037758, + "velocityY": 1.1014185014083862, + "timestamp": 13.885391014309434 + }, + { + "x": 4.682342231358771, + "y": 4.621135026834533, + "heading": -3.2953971721767004, + "angularVelocity": -0.03629633153167719, + "velocityX": -1.0405495666246907, + "velocityY": 1.0619355654956453, + "timestamp": 13.913800207352052 + }, + { + "x": 4.655133141889207, + "y": 4.650036350102356, + "heading": -3.296364878642873, + "angularVelocity": -0.034063145148872064, + "velocityX": -0.9577565060980876, + "velocityY": 1.0173229216496253, + "timestamp": 13.94220940039467 + }, + { + "x": 4.630200857119698, + "y": 4.677539537863246, + "heading": -3.2972684972037993, + "angularVelocity": -0.03180725899431965, "velocityX": -0.8776132687791319, - "velocityY": 0.9681087287355101, - "timestamp": 13.712547719470374 + "velocityY": 0.9681087287355129, + "timestamp": 13.970618593437289 }, { - "x": 4.60746946841203, - "y": 4.7035279061702235, - "heading": -3.298107546340062, - "angularVelocity": -0.029534423417245912, - "velocityX": -0.8001420059193414, - "velocityY": 0.9147872756537933, - "timestamp": 13.740956912512992 + "x": 4.607469468412028, + "y": 4.703527906170224, + "heading": -3.2981075463400624, + "angularVelocity": -0.02953442341724624, + "velocityX": -0.8001420059193413, + "velocityY": 0.9147872756537958, + "timestamp": 13.999027786479907 }, { - "x": 4.58686379126551, - "y": 4.727897641649931, - "heading": -3.2988816902568137, - "angularVelocity": -0.02724976790400753, - "velocityX": -0.7253172279694379, - "velocityY": 0.8578116049670773, - "timestamp": 13.76936610555561 + "x": 4.586863791265508, + "y": 4.727897641649932, + "heading": -3.298881690256814, + "angularVelocity": -0.02724976790400784, + "velocityX": -0.7253172279694378, + "velocityY": 0.8578116049670796, + "timestamp": 14.027436979522525 }, { - "x": 4.568310353233329, + "x": 4.5683103532333265, "y": 4.750556547471711, - "heading": -3.299590720494351, - "angularVelocity": -0.024957774635618345, - "velocityX": -0.6530786708495839, - "velocityY": 0.7975906175084967, - "timestamp": 13.797775298598228 + "heading": -3.2995907204943515, + "angularVelocity": -0.024957774635618633, + "velocityX": -0.6530786708495838, + "velocityY": 0.797590617508499, + "timestamp": 14.055846172565143 }, { - "x": 4.551738077215872, + "x": 4.55173807721587, "y": 4.771422795168187, - "heading": -3.3002345377586937, - "angularVelocity": -0.02266228623167014, - "velocityX": -0.5833420186414909, - "velocityY": 0.7344892783534258, - "timestamp": 13.826184491640847 + "heading": -3.300234537758694, + "angularVelocity": -0.022662286231670405, + "velocityX": -0.5833420186414907, + "velocityY": 0.7344892783534279, + "timestamp": 14.084255365607762 }, { - "x": 4.537078722172511, - "y": 4.790423737866177, - "heading": -3.300813134716119, - "angularVelocity": -0.020366539681611593, - "velocityX": -0.5160074424278739, - "velocityY": 0.6688307784556118, - "timestamp": 13.854593684683465 + "x": 4.5370787221725095, + "y": 4.790423737866178, + "heading": -3.3008131347161194, + "angularVelocity": -0.02036653968161184, + "velocityX": -0.5160074424278736, + "velocityY": 0.6688307784556137, + "timestamp": 14.11266455865038 }, { - "x": 4.524267137631748, - "y": 4.80749481595678, - "heading": -3.3013265802364233, - "angularVelocity": -0.01807321733970101, - "velocityX": -0.45096615456637523, - "velocityY": 0.6008997884943068, - "timestamp": 13.883002877726083 + "x": 4.524267137631747, + "y": 4.8074948159567805, + "heading": -3.3013265802364242, + "angularVelocity": -0.01807321733970122, + "velocityX": -0.45096615456637484, + "velocityY": 0.6008997884943085, + "timestamp": 14.141073751692998 }, { - "x": 4.513241379782428, - "y": 4.822578569091268, - "heading": -3.3017750053386177, - "angularVelocity": -0.015784506850350242, - "velocityX": -0.38810528101876257, - "velocityY": 0.5309462015292464, - "timestamp": 13.911412070768701 + "x": 4.513241379782426, + "y": 4.822578569091269, + "heading": -3.3017750053386186, + "angularVelocity": -0.015784506850350405, + "velocityX": -0.38810528101876224, + "velocityY": 0.5309462015292479, + "timestamp": 14.169482944735616 }, { - "x": 4.503942727769095, - "y": 4.835623757202515, - "heading": -3.3021585909145483, - "angularVelocity": -0.01350216373111781, - "velocityX": -0.3273113741521155, - "velocityY": 0.4591889706855446, - "timestamp": 13.93982126381132 + "x": 4.503942727769094, + "y": 4.835623757202516, + "heading": -3.3021585909145488, + "angularVelocity": -0.01350216373111798, + "velocityX": -0.32731137415211514, + "velocityY": 0.4591889706855459, + "timestamp": 14.197892137778235 }, { "x": 4.496315630351404, - "y": 4.846584586473705, - "heading": -3.3024775571832854, - "angularVelocity": -0.011227572295302874, - "velocityX": -0.2684728639158713, - "velocityY": 0.38581980328508136, - "timestamp": 13.968230456853938 + "y": 4.846584586473706, + "heading": -3.302477557183286, + "angularVelocity": -0.011227572295303039, + "velocityX": -0.26847286391587094, + "velocityY": 0.3858198032850825, + "timestamp": 14.226301330820853 }, { - "x": 4.490307605856895, - "y": 4.855420032462849, - "heading": -3.302732154753915, - "angularVelocity": -0.008961802267574209, - "velocityX": -0.21148170190886365, - "velocityY": 0.31100658071807374, - "timestamp": 13.996639649896556 + "x": 4.490307605856894, + "y": 4.85542003246285, + "heading": -3.3027321547539152, + "angularVelocity": -0.008961802267574346, + "velocityX": -0.2114817019088633, + "velocityY": 0.31100658071807463, + "timestamp": 14.254710523863471 }, { "x": 4.485869112477555, "y": 4.862093250897569, - "heading": -3.302922657135222, - "angularVelocity": -0.006705659714491805, - "velocityX": -0.15623440527439328, - "velocityY": 0.23489644442589466, - "timestamp": 14.025048842939174 + "heading": -3.3029226571352224, + "angularVelocity": -0.006705659714491917, + "velocityX": -0.15623440527439303, + "velocityY": 0.23489644442589536, + "timestamp": 14.28311971690609 }, { - "x": 4.482953401340074, + "x": 4.482953401340073, "y": 4.866571066222462, "heading": -3.303049354516641, - "angularVelocity": -0.00445973179275778, - "velocityX": -0.10263266306467411, - "velocityY": 0.15761853278180735, - "timestamp": 14.053458035981793 + "angularVelocity": -0.004459731792757826, + "velocityX": -0.10263266306467393, + "velocityY": 0.1576185327818078, + "timestamp": 14.311528909948708 }, { "x": 4.481516361236572, "y": 4.868823528289795, "heading": -3.3031125486467343, - "angularVelocity": -0.0022244253822551407, - "velocityX": -0.05058362979002091, - "velocityY": 0.0792863797276602, - "timestamp": 14.081867229024411 + "angularVelocity": -0.0022244253822551953, + "velocityX": -0.05058362979002082, + "velocityY": 0.07928637972766044, + "timestamp": 14.339938102991326 }, { "x": 4.481516361236572, "y": 4.868823528289795, "heading": -3.3031125486467343, - "angularVelocity": 1.1943565858737654e-24, - "velocityX": 6.201298415005488e-22, - "velocityY": 3.4466920783127177e-22, - "timestamp": 14.11027642206703 + "angularVelocity": 6.851173296886301e-29, + "velocityX": 4.467353937750162e-26, + "velocityY": -9.136715174907558e-29, + "timestamp": 14.368347296033944 } ], "trajectoryWaypoints": [ @@ -2947,7 +2947,7 @@ "controlIntervalCount": 29 }, { - "timestamp": 2.535502007308455, + "timestamp": 2.5570160545013483, "isStopPoint": false, "x": 8.151019096374512, "y": 7.458348274230957, @@ -2958,8 +2958,8 @@ "controlIntervalCount": 24 }, { - "timestamp": 4.775488551747936, - "isStopPoint": false, + "timestamp": 4.8339863415393385, + "isStopPoint": true, "x": 4.155092239379883, "y": 6.3448286056518555, "heading": -2.948811422950705, @@ -2969,7 +2969,7 @@ "controlIntervalCount": 20 }, { - "timestamp": 5.813159559226707, + "timestamp": 5.813382562801122, "isStopPoint": false, "x": 5.758828163146973, "y": 6.586098670959473, @@ -2980,7 +2980,7 @@ "controlIntervalCount": 26 }, { - "timestamp": 7.021914631269525, + "timestamp": 7.026413559697236, "isStopPoint": false, "x": 8.046205520629883, "y": 5.833732604980469, @@ -2991,7 +2991,7 @@ "controlIntervalCount": 27 }, { - "timestamp": 8.512775126970325, + "timestamp": 8.528819003729927, "isStopPoint": false, "x": 5.375634670257568, "y": 6.6854448318481445, @@ -3002,8 +3002,8 @@ "controlIntervalCount": 21 }, { - "timestamp": 9.492943160027963, - "isStopPoint": false, + "timestamp": 9.62936328972116, + "isStopPoint": true, "x": 4.126707553863525, "y": 5.5926337242126465, "heading": -3.1132314898410027, @@ -3013,7 +3013,7 @@ "controlIntervalCount": 29 }, { - "timestamp": 10.311979780547953, + "timestamp": 10.559677531131124, "isStopPoint": false, "x": 4.850517272949219, "y": 4.443053245544434, @@ -3024,7 +3024,7 @@ "controlIntervalCount": 36 }, { - "timestamp": 11.890189202418592, + "timestamp": 12.148260076385506, "isStopPoint": true, "x": 8.055134773254395, "y": 3.9504220485687256, @@ -3035,7 +3035,7 @@ "controlIntervalCount": 35 }, { - "timestamp": 13.343228209916337, + "timestamp": 13.601299083883251, "isStopPoint": false, "x": 5.148556709289551, "y": 4.258552551269531, @@ -3046,7 +3046,7 @@ "controlIntervalCount": 27 }, { - "timestamp": 14.11027642206703, + "timestamp": 14.368347296033944, "isStopPoint": true, "x": 4.481516361236572, "y": 4.868823528289795, @@ -3078,25 +3078,21 @@ }, { "scope": [ - 6, - 6 + 8 ], - "type": "MaxVelocity", - "velocity": 0.5 + "type": "StopPoint" }, { "scope": [ - 8 + 2 ], "type": "StopPoint" }, { "scope": [ - 2, - 2 + 6 ], - "type": "MaxVelocity", - "velocity": 0.5 + "type": "StopPoint" } ], "usesControlIntervalGuessing": true, @@ -3119,7 +3115,7 @@ { "name": "Shoot", "target": 2, - "targetTimestamp": 4.775488551747936, + "targetTimestamp": 4.8339863415393385, "offset": -0.375, "command": { "type": "named", @@ -3131,7 +3127,7 @@ { "name": "Sh + Intake Off", "target": 6, - "targetTimestamp": 9.492943160027963, + "targetTimestamp": 9.62936328972116, "offset": -0.375, "command": { "type": "parallel", @@ -3156,7 +3152,7 @@ { "name": "Intake On", "target": 7, - "targetTimestamp": 10.311979780547953, + "targetTimestamp": 10.559677531131124, "offset": 0.25, "command": { "type": "named", @@ -3168,7 +3164,7 @@ { "name": "Intake Off", "target": 8, - "targetTimestamp": 11.890189202418592, + "targetTimestamp": 12.148260076385506, "offset": 1, "command": { "type": "named", @@ -3180,7 +3176,7 @@ { "name": "Shoot", "target": 10, - "targetTimestamp": 14.11027642206703, + "targetTimestamp": 14.368347296033944, "offset": 0, "command": { "type": "named", @@ -5244,7 +5240,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Source Mid": { "waypoints": [ @@ -6406,7 +6402,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Source End": { "waypoints": [ @@ -6417,7 +6413,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 28 + "controlIntervalCount": 32 }, { "x": 5.914944171905518, @@ -6426,7 +6422,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 35 + "controlIntervalCount": 40 }, { "x": 7.972835540771484, @@ -6435,7 +6431,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 33 + "controlIntervalCount": 37 }, { "x": 6.085252285003662, @@ -6444,7 +6440,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 9 + "controlIntervalCount": 12 }, { "x": 5.006633281707764, @@ -6453,7 +6449,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 25 + "controlIntervalCount": 27 }, { "x": 4.29701566696167, @@ -6470,1180 +6466,1342 @@ "x": 2.9061648845672607, "y": 3.222510576248169, "heading": 2.450157821783761, - "angularVelocity": 2.2232245385438935e-21, - "velocityX": -1.0028629842919588e-22, - "velocityY": 3.595740872121164e-22, + "angularVelocity": -1.8632638174153823e-23, + "velocityX": -1.7042168177951542e-23, + "velocityY": 6.75310101580834e-24, "timestamp": 0 }, { - "x": 2.9128666879236222, - "y": 3.2133268252235805, - "heading": 2.451842096761156, - "angularVelocity": 0.037087232725719045, - "velocityX": 0.1475717113269897, - "velocityY": -0.20222345882665166, - "timestamp": 0.04541387570895476 - }, - { - "x": 2.9263863828772303, - "y": 3.195045804898136, - "heading": 2.4552496609939367, - "angularVelocity": 0.07503354821814583, - "velocityX": 0.2976996510989831, - "velocityY": -0.4025426158868783, - "timestamp": 0.09082775141790952 - }, - { - "x": 2.946854729402669, - "y": 3.1677677418967063, - "heading": 2.4604250779323276, - "angularVelocity": 0.11396113759500918, - "velocityX": 0.4507068865166789, - "velocityY": -0.6006548125565678, - "timestamp": 0.13624162712686427 - }, - { - "x": 2.9744200000662895, - "y": 3.131610016467351, - "heading": 2.4674194939213465, - "angularVelocity": 0.15401495423654998, - "velocityX": 0.6069790396283022, - "velocityY": -0.7961823311685926, - "timestamp": 0.18165550283581905 - }, - { - "x": 3.009251552705569, - "y": 3.0867117477645403, - "heading": 2.476291957644283, - "angularVelocity": 0.1953690052749055, - "velocityX": 0.7669804018160837, - "velocityY": -0.9886464874865684, - "timestamp": 0.22706937854477383 - }, - { - "x": 3.0515443573503513, - "y": 3.033240085853495, - "heading": 2.48711112302866, - "angularVelocity": 0.23823479532367425, - "velocityX": 0.9312749459179596, - "velocityY": -1.1774300492151524, - "timestamp": 0.2724832542537286 - }, - { - "x": 3.1015247627643214, - "y": 2.9713990389557963, - "heading": 2.499957473379582, - "angularVelocity": 0.28287280374946205, - "velocityX": 1.100553622295552, - "velocityY": -1.3617214107428572, - "timestamp": 0.3178971299626834 - }, - { - "x": 3.159457845655387, - "y": 2.9014421643575323, - "heading": 2.5149262615438457, - "angularVelocity": 0.3296082514558885, - "velocityX": 1.2756692087313235, - "velocityY": -1.540429516445558, - "timestamp": 0.36331100567163815 - }, - { - "x": 3.2256566848870794, - "y": 2.8236913081216124, - "heading": 2.5321314385861196, - "angularVelocity": 0.378852867624366, - "velocityX": 1.4576786983771988, - "velocityY": -1.712050667822423, - "timestamp": 0.40872488138059293 - }, - { - "x": 3.3004936793234267, - "y": 2.738565070443291, - "heading": 2.5517109344656403, - "angularVelocity": 0.43113466036241005, - "velocityX": 1.6478882999539048, - "velocityY": -1.8744543677327146, - "timestamp": 0.4541387570895477 - }, - { - "x": 3.3844130960333265, - "y": 2.646623264818412, - "heading": 2.573833701211917, - "angularVelocity": 0.4871367264061549, - "velocityX": 1.8478805299005152, - "velocityY": -2.0245311414094913, - "timestamp": 0.4995526327985025 - }, - { - "x": 3.477941004250027, - "y": 2.54863791213145, - "heading": 2.5987086778425676, - "angularVelocity": 0.5477395673090645, - "velocityX": 2.059456647481393, - "velocityY": -2.1576082454385443, - "timestamp": 0.5449665085074572 - }, - { - "x": 3.581679832328906, - "y": 2.4457069415518324, - "heading": 2.626594326343914, - "angularVelocity": 0.6140336640734679, - "velocityX": 2.2842980577943455, - "velocityY": -2.266509276576062, - "timestamp": 0.5903803842164119 - }, - { - "x": 3.6962513052431056, - "y": 2.3394269182506258, - "heading": 2.657801644299521, - "angularVelocity": 0.6871758348837222, - "velocityX": 2.522829666608007, - "velocityY": -2.34025441876676, - "timestamp": 0.6357942599253666 - }, - { - "x": 3.8221053363389577, - "y": 2.2321018628035514, - "heading": 2.6926688755591077, - "angularVelocity": 0.7677660343953339, - "velocityX": 2.7712682331368557, - "velocityY": -2.3632657149742413, - "timestamp": 0.6812081356343214 - }, - { - "x": 3.959102455546991, - "y": 2.1268027378876284, - "heading": 2.731472736807354, - "angularVelocity": 0.8544494527824409, - "velocityX": 3.0166357103280714, - "velocityY": -2.318655328841717, - "timestamp": 0.7266220113432761 - }, - { - "x": 4.106064548213917, - "y": 2.0268914551031214, - "heading": 2.7742549929607927, - "angularVelocity": 0.9420525221766646, - "velocityX": 3.236061454185624, - "velocityY": -2.200016651844701, - "timestamp": 0.7720358870522308 - }, - { - "x": 4.260926344497603, - "y": 1.9351158880352217, - "heading": 2.8206400124914244, - "angularVelocity": 1.0213842973434086, - "velocityX": 3.4100105720144724, - "velocityY": -2.0208706179596887, - "timestamp": 0.8174497627611855 - }, - { - "x": 4.421453103064402, - "y": 1.853180476458846, - "heading": 2.8699483284502496, - "angularVelocity": 1.0857544129205938, - "velocityX": 3.5347513521103315, - "velocityY": -1.804193328520933, - "timestamp": 0.8628636384701402 - }, - { - "x": 4.585742219859622, - "y": 1.78196927864388, - "heading": 2.9214858587438353, - "angularVelocity": 1.1348410477862687, - "velocityX": 3.6175973583075147, - "velocityY": -1.5680493396190038, - "timestamp": 0.908277514179095 - }, - { - "x": 4.752322755969812, - "y": 1.7218963963668528, - "heading": 2.9746787399025414, - "angularVelocity": 1.171291380185322, - "velocityX": 3.6680537282869157, - "velocityY": -1.3227869530893723, - "timestamp": 0.9536913898880497 - }, - { - "x": 4.920083939937902, - "y": 1.6731373714270672, - "heading": 3.0290817773026917, - "angularVelocity": 1.1979386597348438, - "velocityX": 3.6940512420306497, - "velocityY": -1.073659188488304, - "timestamp": 0.9991052655970044 - }, - { - "x": 5.088181109980999, - "y": 1.6357507554913027, - "heading": 3.0843519166705553, - "angularVelocity": 1.2170319864808536, - "velocityX": 3.701449555206138, - "velocityY": -0.8232421336457948, - "timestamp": 1.0445191413059591 - }, - { - "x": 5.255960575087693, - "y": 1.6097382203527058, - "heading": 3.140221355147231, - "angularVelocity": 1.2302283741367352, - "velocityX": 3.694453787250991, - "velocityY": -0.5727882664167325, - "timestamp": 1.089933017014914 - }, - { - "x": 5.422906233517842, - "y": 1.5950742253774643, - "heading": 3.196477145763251, - "angularVelocity": 1.2387357330289996, - "velocityX": 3.676093612887361, - "velocityY": -0.3228967963276029, - "timestamp": 1.1353468927238688 - }, - { - "x": 5.588602689207526, - "y": 1.591720887906522, - "heading": 3.25294680410691, - "angularVelocity": 1.243445036612991, - "velocityX": 3.6485865410736484, - "velocityY": -0.07383949109369516, - "timestamp": 1.1807607684328236 - }, - { - "x": 5.7527096924478425, - "y": 1.5996355504389552, - "heading": 3.3094882888224446, - "angularVelocity": 1.245026631901976, - "velocityX": 3.613587272137563, - "velocityY": 0.17427850869095848, - "timestamp": 1.2261746441417785 + "x": 2.9113055909652594, + "y": 3.215525752596394, + "heading": 2.4514582575843495, + "angularVelocity": 0.02539554914305498, + "velocityX": 0.10039023987290906, + "velocityY": -0.13640306751318104, + "timestamp": 0.05120723293924288 + }, + { + "x": 2.921663253533755, + "y": 3.201613287433786, + "heading": 2.454084517759628, + "angularVelocity": 0.05128689883310875, + "velocityX": 0.2022695227602883, + "velocityY": -0.27168945408776757, + "timestamp": 0.10241446587848577 + }, + { + "x": 2.9373223301857774, + "y": 3.1808380777696263, + "heading": 2.458065087425396, + "angularVelocity": 0.07773451985759916, + "velocityX": 0.3057981412626095, + "velocityY": -0.4057084999849448, + "timestamp": 0.15362169881772864 + }, + { + "x": 2.9583768302020736, + "y": 3.1532743423653993, + "heading": 2.463432031947695, + "angularVelocity": 0.10480832910199311, + "velocityX": 0.41116261918072106, + "velocityY": -0.5382781654484499, + "timestamp": 0.20482893175697153 + }, + { + "x": 2.9849319483474153, + "y": 3.119007689264869, + "heading": 2.4702215930058764, + "angularVelocity": 0.1325898836642352, + "velocityX": 0.5185813921414029, + "velocityY": -0.6691760349790243, + "timestamp": 0.25603616469621443 + }, + { + "x": 3.017106064531415, + "y": 3.0781378144243567, + "heading": 2.4784749288852317, + "angularVelocity": 0.16117519744032857, + "velocityX": 0.6283119461302282, + "velocityY": -0.7981269928996951, + "timestamp": 0.3072433976354573 + }, + { + "x": 3.05503320258041, + "y": 3.0307820798543887, + "heading": 2.488239041717323, + "angularVelocity": 0.19067839193100064, + "velocityX": 0.7406597832379636, + "velocityY": -0.9247860478256232, + "timestamp": 0.3584506305747002 + }, + { + "x": 3.098866061793619, + "y": 2.977080340140281, + "heading": 2.499567949189288, + "angularVelocity": 0.22123647035188507, + "velocityX": 0.8559896072731706, + "velocityY": -1.0487139537069792, + "timestamp": 0.4096578635139431 + }, + { + "x": 3.148779749957633, + "y": 2.9172015757078107, + "heading": 2.512524178104069, + "angularVelocity": 0.25301560289643715, + "velocityX": 0.974739022185334, + "velocityY": -1.169341926823425, + "timestamp": 0.460865096453186 + }, + { + "x": 3.2049763386889154, + "y": 2.8513531941180035, + "heading": 2.527180682548272, + "angularVelocity": 0.28621941868238787, + "velocityX": 1.0974345908899057, + "velocityY": -1.2859195432007804, + "timestamp": 0.5120723293924289 + }, + { + "x": 3.2676902851658904, + "y": 2.779794350173089, + "heading": 2.543623317646274, + "angularVelocity": 0.32109985551281023, + "velocityX": 1.2247087545500641, + "velocityY": -1.3974362572923749, + "timestamp": 0.5632795623316718 + }, + { + "x": 3.337194501529253, + "y": 2.7028554257460047, + "heading": 2.5619540171466797, + "angularVelocity": 0.3579709046601894, + "velocityX": 1.357312480559711, + "velocityY": -1.502501111871677, + "timestamp": 0.6144867952709147 + }, + { + "x": 3.413806113461603, + "y": 2.6209670488969037, + "heading": 2.582294779466242, + "angularVelocity": 0.3972243988206946, + "velocityX": 1.496109192684732, + "velocityY": -1.5991564501495594, + "timestamp": 0.6656940282101576 + }, + { + "x": 3.4978890280612576, + "y": 2.53470378007231, + "heading": 2.6047923014828496, + "angularVelocity": 0.43934266167634894, + "velocityX": 1.6420124613922928, + "velocityY": -1.6845914897792766, + "timestamp": 0.7169012611494004 + }, + { + "x": 3.5898457436249114, + "y": 2.4448492253220104, + "heading": 2.629622143800147, + "angularVelocity": 0.48488935824276863, + "velocityX": 1.7957759145619197, + "velocityY": -1.7547238855282683, + "timestamp": 0.7681084940886433 + }, + { + "x": 3.6900805658477336, + "y": 2.352487300280918, + "heading": 2.656988575201302, + "angularVelocity": 0.5344251159523686, + "velocityX": 1.957434847958887, + "velocityY": -1.8036890442934, + "timestamp": 0.8193157270278862 + }, + { + "x": 3.7988996355540694, + "y": 2.25910621274701, + "heading": 2.6871107034493438, + "angularVelocity": 0.588239717693429, + "velocityX": 2.1250722497630243, + "velocityY": -1.8235917501088947, + "timestamp": 0.8705229599671291 + }, + { + "x": 3.9163105803925973, + "y": 2.166642684771814, + "heading": 2.720181369851551, + "angularVelocity": 0.6458202192148362, + "velocityX": 2.2928586080375637, + "velocityY": -1.8056731963022379, + "timestamp": 0.921730192906372 + }, + { + "x": 4.041773646591577, + "y": 2.0773132019579514, + "heading": 2.7562901619168882, + "angularVelocity": 0.7051502296205008, + "velocityX": 2.450104389507651, + "velocityY": -1.7444700228159478, + "timestamp": 0.9729374258456149 + }, + { + "x": 4.174143364330658, + "y": 1.9931844907546805, + "heading": 2.7953180453804842, + "angularVelocity": 0.762155680427069, + "velocityX": 2.5849808736226247, + "velocityY": -1.642906799964944, + "timestamp": 1.0241446587848577 + }, + { + "x": 4.311947651714837, + "y": 1.9157918157649183, + "heading": 2.8369077401017524, + "angularVelocity": 0.8121839891371225, + "velocityX": 2.691109819342949, + "velocityY": -1.5113621757611504, + "timestamp": 1.0753518917241005 + }, + { + "x": 4.453747658858508, + "y": 1.8460867046987703, + "heading": 2.880588628450738, + "angularVelocity": 0.8530218455821048, + "velocityX": 2.769140197673169, + "velocityY": -1.361235651003692, + "timestamp": 1.1265591246633433 + }, + { + "x": 4.598324060406724, + "y": 1.7845956072657896, + "heading": 2.9259097626939266, + "angularVelocity": 0.8850533731623834, + "velocityX": 2.8233589914877046, + "velocityY": -1.2008283577036771, + "timestamp": 1.177766357602586 + }, + { + "x": 4.74470434375679, + "y": 1.7315896509686934, + "heading": 2.9724924215655713, + "angularVelocity": 0.9096890458212096, + "velocityX": 2.8585860814573887, + "velocityY": -1.0351263533412876, + "timestamp": 1.2289735905418289 + }, + { + "x": 4.892125717500927, + "y": 1.6871983627069491, + "heading": 3.0200325344629526, + "angularVelocity": 0.9283866783777883, + "velocityX": 2.878917006100534, + "velocityY": -0.8668948840569896, + "timestamp": 1.2801808234810717 + }, + { + "x": 5.039987681067959, + "y": 1.6514747812369852, + "heading": 3.0682877630201455, + "angularVelocity": 0.9423518082776987, + "velocityX": 2.887521060598398, + "velocityY": -0.697627647882282, + "timestamp": 1.3313880564203144 + }, + { + "x": 5.187811786772728, + "y": 1.6244309343056307, + "heading": 3.117063465229142, + "angularVelocity": 0.9525158734288245, + "velocityX": 2.886781753666743, + "velocityY": -0.52812552795895, + "timestamp": 1.3825952893595572 + }, + { + "x": 5.335211195327884, + "y": 1.606057043707228, + "heading": 3.166201249668279, + "angularVelocity": 0.9595867930891536, + "velocityX": 2.8784880590998623, + "velocityY": -0.3588143616391711, + "timestamp": 1.4338025222988 + }, + { + "x": 5.481868453157292, + "y": 1.5963320188418268, + "heading": 3.215570385851473, + "angularVelocity": 0.9641047435968806, + "velocityX": 2.863994975151585, + "velocityY": -0.18991506291581592, + "timestamp": 1.4850097552380428 + }, + { + "x": 5.627519369835149, + "y": 1.5952292624279771, + "heading": 3.2650615149375475, + "angularVelocity": 0.9664870809324044, + "velocityX": 2.8443426507866874, + "velocityY": -0.021535168970328783, + "timestamp": 1.5362169881772856 + }, + { + "x": 5.771941245363314, + "y": 1.6027199120891273, + "heading": 3.3145820545267926, + "angularVelocity": 0.9670614236859987, + "velocityX": 2.820341331458405, + "velocityY": 0.14628108630743103, + "timestamp": 1.5874242211165284 }, { "x": 5.914944171905518, "y": 1.618774652481079, - "heading": 3.3659829767052933, - "angularVelocity": 1.2439961796017462, - "velocityX": 3.57235485685901, - "velocityY": 0.42143731939508383, - "timestamp": 1.2715885198507333 - }, - { - "x": 6.035588806340424, - "y": 1.6394541292062057, - "heading": 3.4083265776392007, - "angularVelocity": 1.241563923199597, - "velocityX": 3.537441840994668, - "velocityY": 0.6063464534496739, - "timestamp": 1.3056935708615462 - }, - { - "x": 6.1549110861034935, - "y": 1.666413596824975, - "heading": 3.4505355738749044, - "angularVelocity": 1.2376171559550397, - "velocityX": 3.498668854805046, - "velocityY": 0.790483134308215, - "timestamp": 1.3397986218723592 - }, - { - "x": 6.272763015314017, - "y": 1.6996199600678876, - "heading": 3.4925517835068707, - "angularVelocity": 1.2319644271649108, - "velocityX": 3.4555564562316077, - "velocityY": 0.9736494231421837, - "timestamp": 1.3739036728831722 - }, - { - "x": 6.388977310142906, - "y": 1.7390313051664819, - "heading": 3.534309249026909, - "angularVelocity": 1.2243777470615422, - "velocityX": 3.4075391000600734, - "velocityY": 1.1555867512439428, - "timestamp": 1.4080087238939851 - }, - { - "x": 6.503363828841312, - "y": 1.7845940645868774, - "heading": 3.575732671697258, - "angularVelocity": 1.2145832198643007, - "velocityX": 3.3539465653383935, - "velocityY": 1.3359534165760587, - "timestamp": 1.442113774904798 - }, - { - "x": 6.615705247769987, - "y": 1.8362390822215717, - "heading": 3.616735445353753, - "angularVelocity": 1.2022492986008166, - "velocityX": 3.2939818472359588, - "velocityY": 1.5142923439205425, - "timestamp": 1.476218825915611 - }, - { - "x": 6.725751880441458, - "y": 1.8938760902116232, - "heading": 3.657217202680655, - "angularVelocity": 1.1869724902058387, - "velocityX": 3.2266960291770768, - "velocityY": 1.6899845120236898, - "timestamp": 1.510323876926424 - }, - { - "x": 6.833215615375313, - "y": 1.9573858820901124, - "heading": 3.697060805239955, - "angularVelocity": 1.1682610457514788, - "velocityX": 3.150962445409736, - "velocityY": 1.8621814070400662, - "timestamp": 1.544428927937237 - }, - { - "x": 6.937763164011495, - "y": 2.0266091584313166, - "heading": 3.7361287911659096, - "angularVelocity": 1.1455190585572865, - "velocityX": 3.065456451099711, - "velocityY": 2.029707456507175, - "timestamp": 1.57853397894805 - }, - { - "x": 7.039009309504076, - "y": 2.1013306580386533, - "heading": 3.7742595314428558, - "angularVelocity": 1.1180379195110097, - "velocityX": 2.9686554481469685, - "velocityY": 2.1909217958256537, - "timestamp": 1.6126390299588629 - }, - { - "x": 7.136511888628047, - "y": 2.1812569307410885, - "heading": 3.811263920998153, - "angularVelocity": 1.085011998473928, - "velocityX": 2.8588897020871724, - "velocityY": 2.343531832780279, - "timestamp": 1.6467440809696758 - }, - { - "x": 7.22977216790877, - "y": 2.265986470559125, - "heading": 3.846924654529132, - "angularVelocity": 1.0456144317061005, - "velocityX": 2.734500507011559, - "velocityY": 2.484369244636938, - "timestamp": 1.6808491319804888 - }, - { - "x": 7.318247196703315, - "y": 2.3549731397061673, - "heading": 3.881002263830399, - "angularVelocity": 0.9991953769681448, - "velocityX": 2.5941913638098484, - "velocityY": 2.609193257586063, - "timestamp": 1.7149541829913018 - }, - { - "x": 7.401383330480766, - "y": 2.4474898853243734, - "heading": 3.9132542500781606, - "angularVelocity": 0.9456659729826076, - "velocityX": 2.4376487151739696, - "velocityY": 2.712699230060463, - "timestamp": 1.7490592340021147 - }, - { - "x": 7.478677656627286, - "y": 2.5426104064994783, - "heading": 3.9434712501143188, - "angularVelocity": 0.8859977962377913, - "velocityX": 2.2663600802712174, - "velocityY": 2.7890449759171334, - "timestamp": 1.7831642850129277 - }, - { - "x": 7.54975931056459, - "y": 2.639234736979551, - "heading": 3.97151996138921, - "angularVelocity": 0.8224210327672106, - "velocityX": 2.0841972620057856, - "velocityY": 2.833138424259732, - "timestamp": 1.8172693360237406 - }, - { - "x": 7.614458496352838, - "y": 2.736173038995203, - "heading": 3.997364932300229, - "angularVelocity": 0.7578047868283583, - "velocityX": 1.8970558281157706, - "velocityY": 2.842344437043021, - "timestamp": 1.8513743870345536 - }, - { - "x": 7.672823839971332, - "y": 2.832264123512942, - "heading": 4.021053133675318, - "angularVelocity": 0.6945657805226282, - "velocityX": 1.7113401648333206, - "velocityY": 2.817503028723613, - "timestamp": 1.8854794380453666 - }, - { - "x": 7.725079842066262, - "y": 2.9264763498774746, - "heading": 4.0426799683616945, - "angularVelocity": 0.6341240973226909, - "velocityX": 1.5322071231725694, - "velocityY": 2.7624127093275055, - "timestamp": 1.9195844890561795 - }, - { - "x": 7.7715553968836195, - "y": 3.0179557069730056, - "heading": 4.062360688792578, - "angularVelocity": 0.5770617503150199, - "velocityX": 1.3627176456244698, - "velocityY": 2.682281784786863, - "timestamp": 1.9536895400669925 - }, - { - "x": 7.812619256840835, - "y": 3.106025341157235, - "heading": 4.080213037477331, - "angularVelocity": 0.5234517514456478, - "velocityX": 1.204040420411492, - "velocityY": 2.582304719506425, - "timestamp": 1.9877945910778054 - }, - { - "x": 7.84863769574921, - "y": 3.190159811701933, - "heading": 4.096348157574101, - "angularVelocity": 0.47310060001536125, - "velocityX": 1.0561027719019285, - "velocityY": 2.4669211172862338, - "timestamp": 2.0218996420886186 - }, - { - "x": 7.879952597637028, - "y": 3.2699532530767157, - "heading": 4.110866673835784, - "angularVelocity": 0.425699884075218, - "velocityX": 0.918189563120411, - "velocityY": 2.3396370628351777, - "timestamp": 2.056004693099432 - }, - { - "x": 7.906872911068676, - "y": 3.3450907499043514, - "heading": 4.123857749237068, - "angularVelocity": 0.3809135308774642, - "velocityX": 0.78933508772977, - "velocityY": 2.203119321059301, - "timestamp": 2.090109744110245 - }, - { - "x": 7.92967335872801, - "y": 3.415325596446574, - "heading": 4.135399630317554, - "angularVelocity": 0.3384214577725463, - "velocityX": 0.6685358028670148, - "velocityY": 2.059367878381269, - "timestamp": 2.124214795121058 - }, - { - "x": 7.9485965380562735, - "y": 3.4804621930055037, - "heading": 4.14556079129848, - "angularVelocity": 0.2979371289520607, - "velocityX": 0.5548497588308511, - "velocityY": 1.9098812237014051, - "timestamp": 2.1583198461318713 - }, - { - "x": 7.963856309062033, - "y": 3.540343468154577, - "heading": 4.154401215837848, - "angularVelocity": 0.25921159116767506, - "velocityX": 0.44743434047118863, - "velocityY": 1.755789051014386, - "timestamp": 2.1924248971426845 - }, - { - "x": 7.975641432659769, - "y": 3.5948416835203623, - "heading": 4.161973609771009, - "angularVelocity": 0.22203145014385386, - "velocityX": 0.3455536129824143, - "velocityY": 1.5979514397591115, - "timestamp": 2.2265299481534977 - }, - { - "x": 7.984118998461396, - "y": 3.643851691478983, - "heading": 4.168324469700783, - "angularVelocity": 0.1862146439177472, - "velocityX": 0.24857214841693745, - "velocityY": 1.4370307771444562, - "timestamp": 2.260634999164311 - }, - { - "x": 7.989437470121537, - "y": 3.6872859533917026, - "heading": 4.17349499336682, - "angularVelocity": 0.15160580362119816, - "velocityX": 0.1559438119138029, - "velocityY": 1.2735433792181823, - "timestamp": 2.294740050175124 - }, - { - "x": 7.991729312970037, - "y": 3.725070821508804, - "heading": 4.177521842923806, - "angularVelocity": 0.11807194059638135, - "velocityX": 0.06719951387181163, - "velocityY": 1.1078965430992342, - "timestamp": 2.3288451011859372 - }, - { - "x": 7.99111322809602, - "y": 3.7571437330128914, - "heading": 4.180437780593536, - "angularVelocity": 0.08549870424783614, - "velocityX": -0.018064329351725014, - "velocityY": 0.9404152919729587, - "timestamp": 2.3629501521967504 - }, - { - "x": 7.987696038925939, - "y": 3.7834510681367823, - "heading": 4.182272197135822, - "angularVelocity": 0.05378723936533091, - "velocityX": -0.10019598472373147, - "velocityY": 0.7713618465356136, - "timestamp": 2.3970552032075636 - }, - { - "x": 7.981574280773792, - "y": 3.8039464966481624, - "heading": 4.183051551698239, - "angularVelocity": 0.022851587648130094, - "velocityX": -0.17949711173882896, - "velocityY": 0.6009499444783675, - "timestamp": 2.431160254218377 + "heading": 3.3640528155632063, + "angularVelocity": 0.9660893236529856, + "velocityX": 2.7926313986126945, + "velocityY": 0.31352485714275447, + "timestamp": 1.6386314540557712 + }, + { + "x": 6.020777944796609, + "y": 1.6355085584506643, + "heading": 3.400904280098954, + "angularVelocity": 0.9643675166097004, + "velocityX": 2.769568428885968, + "velocityY": 0.43791028515067126, + "timestamp": 1.6768445459538697 + }, + { + "x": 6.125639580084532, + "y": 1.656977833256518, + "heading": 3.4376552290207467, + "angularVelocity": 0.9617371193044324, + "velocityX": 2.7441285192926665, + "velocityY": 0.5618303502659502, + "timestamp": 1.7150576378519682 + }, + { + "x": 6.229428776215976, + "y": 1.6831607086195022, + "heading": 3.474267250275643, + "angularVelocity": 0.9581015153792859, + "velocityX": 2.716063814156021, + "velocityY": 0.6851807603740969, + "timestamp": 1.7532707297500667 + }, + { + "x": 6.3320343621232995, + "y": 1.714030406969641, + "heading": 3.5106976603723656, + "angularVelocity": 0.9533489253858498, + "velocityX": 2.685089868700948, + "velocityY": 0.8078304271336628, + "timestamp": 1.7914838216481652 + }, + { + "x": 6.433332658705491, + "y": 1.749553806050537, + "heading": 3.546898805378257, + "angularVelocity": 0.9473492776357301, + "velocityX": 2.6508793596791667, + "velocityY": 0.9296133161803473, + "timestamp": 1.8296969135462637 + }, + { + "x": 6.53318556675295, + "y": 1.789689683941768, + "heading": 3.58281721914692, + "angularVelocity": 0.9399504720645423, + "velocityX": 2.6130549266658, + "velocityY": 1.0503174670675757, + "timestamp": 1.8679100054443623 + }, + { + "x": 6.631438355395581, + "y": 1.8343863962295928, + "heading": 3.6183926153660977, + "angularVelocity": 0.9309740314666345, + "velocityX": 2.5711813350418873, + "velocityY": 1.1696701331317512, + "timestamp": 1.9061230973424608 + }, + { + "x": 6.727917146196004, + "y": 1.8835787832994704, + "heading": 3.653556695194787, + "angularVelocity": 0.9202102756421789, + "velocityX": 2.5247575113183647, + "velocityY": 1.2873176345179635, + "timestamp": 1.9443361892405593 + }, + { + "x": 6.8224261353049895, + "y": 1.9371840367497888, + "heading": 3.6882317692807933, + "angularVelocity": 0.9074134639110804, + "velocityX": 2.473209688475594, + "velocityY": 1.4027981193792345, + "timestamp": 1.9825492811386578 + }, + { + "x": 6.914744691265183, + "y": 1.9950961730612478, + "heading": 3.722329234213893, + "angularVelocity": 0.8922979858323411, + "velocityX": 2.415888151798233, + "velocityY": 1.5155051170915799, + "timestamp": 2.020762373036756 + }, + { + "x": 7.0046246440390405, + "y": 2.0571786867448134, + "heading": 3.7557480315965552, + "angularVelocity": 0.8745379063222446, + "velocityX": 2.3520722430296175, + "velocityY": 1.6246398969525655, + "timestamp": 2.0589754649348544 + }, + { + "x": 7.091788391438202, + "y": 2.123254932680484, + "heading": 3.788373390594432, + "angularVelocity": 0.8537743840482023, + "velocityX": 2.280991750984126, + "velocityY": 1.7291520432807275, + "timestamp": 2.0971885568329527 + }, + { + "x": 7.175928944342895, + "y": 2.1930959306221323, + "heading": 3.8200764634573674, + "angularVelocity": 0.8296390396117933, + "velocityX": 2.2018776478246815, + "velocityY": 1.8276719959717111, + "timestamp": 2.135401648731051 + }, + { + "x": 7.256713710898279, + "y": 2.266405811115142, + "heading": 3.8507159408143004, + "angularVelocity": 0.8018057643343343, + "velocityX": 2.114059934506467, + "velocityY": 1.91844932853124, + "timestamp": 2.1736147406291493 + }, + { + "x": 7.3337944835848266, + "y": 2.3428063524565834, + "heading": 3.8801432687002584, + "angularVelocity": 0.7700849741348019, + "velocityX": 2.0171299640472826, + "velocityY": 1.9993289615291048, + "timestamp": 2.2118278325272476 + }, + { + "x": 7.406826105349172, + "y": 2.4218242186313876, + "heading": 3.908213144199668, + "angularVelocity": 0.7345617458608831, + "velocityX": 1.911167564223696, + "velocityY": 2.0678218445531384, + "timestamp": 2.250040924425346 + }, + { + "x": 7.475494494135224, + "y": 2.502887103811811, + "heading": 3.934799367276667, + "angularVelocity": 0.6957359835706366, + "velocityX": 1.7969859379389637, + "velocityY": 2.1213380324364, + "timestamp": 2.288254016323444 + }, + { + "x": 7.5395502270032555, + "y": 2.5853359669923646, + "heading": 3.9598120699093338, + "angularVelocity": 0.6545584612563531, + "velocityX": 1.6762771523133229, + "velocityY": 2.157607748685101, + "timestamp": 2.3264671082215425 + }, + { + "x": 7.598838235415281, + "y": 2.6684568263195323, + "heading": 3.9832084112667783, + "angularVelocity": 0.6122598354468323, + "velocityX": 1.5515103716319527, + "velocityY": 2.175193243949577, + "timestamp": 2.3646802001196408 + }, + { + "x": 7.653312233435752, + "y": 2.7515267667167436, + "heading": 4.0049909639065655, + "angularVelocity": 0.5700285310038007, + "velocityX": 1.4255323323675468, + "velocityY": 2.173860744342043, + "timestamp": 2.402893292017739 + }, + { + "x": 7.7030282649576645, + "y": 2.8338606563176305, + "heading": 4.025196298380201, + "angularVelocity": 0.5287542428525911, + "velocityX": 1.3010209080827217, + "velocityY": 2.154599000270482, + "timestamp": 2.4411063839158373 + }, + { + "x": 7.748121808317172, + "y": 2.9148450729972097, + "heading": 4.043881316781892, + "angularVelocity": 0.4889690279843902, + "velocityX": 1.1800548220425873, + "velocityY": 2.119284586956156, + "timestamp": 2.4793194758139356 + }, + { + "x": 7.788778861758571, + "y": 2.9939539404158495, + "heading": 4.061112406566655, + "angularVelocity": 0.45092110920288114, + "velocityX": 1.0639561318361235, + "velocityY": 2.0702032599088445, + "timestamp": 2.517532567712034 + }, + { + "x": 7.825210007677057, + "y": 3.0707487810478886, + "heading": 4.076958314450325, + "angularVelocity": 0.41467222610319826, + "velocityX": 0.9533681811363417, + "velocityY": 2.0096473961548327, + "timestamp": 2.5557456596101322 + }, + { + "x": 7.857631499196349, + "y": 3.144869951622929, + "heading": 4.091485913306106, + "angularVelocity": 0.3801733420190485, + "velocityX": 0.8484393674751142, + "velocityY": 1.939680012617054, + "timestamp": 2.5939587515082305 + }, + { + "x": 7.886253437175175, + "y": 3.2160244294016245, + "heading": 4.104757938931661, + "angularVelocity": 0.34731619364762556, + "velocityX": 0.7490086919726913, + "velocityY": 1.8620445047587648, + "timestamp": 2.632171843406329 + }, + { + "x": 7.911273388621043, + "y": 3.283973525115277, + "heading": 4.116831998207854, + "angularVelocity": 0.31596656215076, + "velocityX": 0.654748155752185, + "velocityY": 1.7781627274456175, + "timestamp": 2.670384935304427 + }, + { + "x": 7.932873600557423, + "y": 3.3485220534891567, + "heading": 4.1277603447712625, + "angularVelocity": 0.2859843582547855, + "velocityX": 0.5652568495106397, + "velocityY": 1.689173138515176, + "timestamp": 2.7085980272025254 + }, + { + "x": 7.951220358752493, + "y": 3.409509396144286, + "heading": 4.137590076238168, + "angularVelocity": 0.25723465384895294, + "velocityX": 0.48011708249084256, + "velocityY": 1.5959803205080123, + "timestamp": 2.7468111191006237 + }, + { + "x": 7.966464515315054, + "y": 3.4668023733883073, + "heading": 4.146363533085604, + "angularVelocity": 0.2295929591573598, + "velocityX": 0.39892497061509824, + "velocityY": 1.4993023175617965, + "timestamp": 2.785024210998722 + }, + { + "x": 7.978742584510864, + "y": 3.520289653410511, + "heading": 4.154118770391739, + "angularVelocity": 0.20294712939783252, + "velocityX": 0.3213053062691505, + "velocityY": 1.3997108678051104, + "timestamp": 2.8232373028968203 + }, + { + "x": 7.988178059570606, + "y": 3.569877396667095, + "heading": 4.160890032982404, + "angularVelocity": 0.17719745391765573, + "velocityX": 0.24691734144159244, + "velocityY": 1.2976637271021656, + "timestamp": 2.8614503947949186 + }, + { + "x": 7.994882760848184, + "y": 3.615485864920885, + "heading": 4.1667082001323665, + "angularVelocity": 0.15225585947028406, + "velocityX": 0.17545560813183597, + "velocityY": 1.1935299131358537, + "timestamp": 2.899663486693017 + }, + { + "x": 7.998958118835325, + "y": 3.657046773518291, + "heading": 4.171601185974506, + "angularVelocity": 0.12804475113364422, + "velocityX": 0.10664821360198111, + "velocityY": 1.0876091552139988, + "timestamp": 2.937876578591115 + }, + { + "x": 8.00049634854855, + "y": 3.6945012134134734, + "heading": 4.175594292348644, + "angularVelocity": 0.10449576770146222, + "velocityX": 0.040253997696058225, + "velocityY": 0.9801468040079241, + "timestamp": 2.9760896704892135 + }, + { + "x": 7.999581500886131, + "y": 3.727798009941937, + "heading": 4.178710516017615, + "angularVelocity": 0.08154858751763462, + "velocityX": -0.023940686737896708, + "velocityY": 0.8713452608664894, + "timestamp": 3.0143027623873118 + }, + { + "x": 7.99629039177413, + "y": 3.7568924174172387, + "heading": 4.180970814432266, + "angularVelocity": 0.05914984374145868, + "velocityX": -0.08612517199022549, + "velocityY": 0.7613727659851889, + "timestamp": 3.05251585428541 + }, + { + "x": 7.990693417298575, + "y": 3.7817450732193243, + "heading": 4.182394334940983, + "angularVelocity": 0.037252167726010275, + "velocityX": -0.14646745912318257, + "velocityY": 0.6503701890535178, + "timestamp": 3.0907289461835084 + }, + { + "x": 7.982855266066816, + "y": 3.802321153601619, + "heading": 4.182998612290459, + "angularVelocity": 0.015813359230053194, + "velocityX": -0.2051169073850163, + "velocityY": 0.5384563080413376, + "timestamp": 3.1289420380816066 }, { "x": 7.972835540771484, "y": 3.818589687347412, "heading": 4.182799738871681, - "angularVelocity": -0.007383446706423955, - "velocityX": -0.25623008156584126, - "velocityY": 0.4293554844590835, - "timestamp": 2.46526530522919 - }, - { - "x": 7.9637186612393265, - "y": 3.828871449615871, - "heading": 4.1820183188243725, - "angularVelocity": -0.03309906574350809, - "velocityX": -0.38616899585548714, - "velocityY": 0.4355106148798181, - "timestamp": 2.4888738280003215 - }, - { - "x": 7.951533900299869, - "y": 3.8392929926799955, - "heading": 4.180626994046899, - "angularVelocity": -0.05893315693492721, - "velocityX": -0.5161170420351017, - "velocityY": 0.44143139175423374, - "timestamp": 2.512482350771453 - }, - { - "x": 7.936281037210036, - "y": 3.8498483897527986, - "heading": 4.178622883313085, - "angularVelocity": -0.08488928990783955, - "velocityX": -0.6460744383584005, - "velocityY": 0.44710112424782095, - "timestamp": 2.5360908735425847 - }, - { - "x": 7.917959846822961, - "y": 3.8605312762810953, - "heading": 4.176003005913559, - "angularVelocity": -0.11097167853000488, - "velocityX": -0.776041371359331, - "velocityY": 0.45250126964154036, - "timestamp": 2.5596993963137162 - }, - { - "x": 7.896570100655752, - "y": 3.8713347995291443, - "heading": 4.172764264259679, - "angularVelocity": -0.1371852735250776, - "velocityX": -0.9060179823436121, - "velocityY": 0.4576111497012357, - "timestamp": 2.583307919084848 - }, - { - "x": 7.872111568382392, - "y": 3.8822515601370835, - "heading": 4.168903423841314, - "angularVelocity": -0.16353587455650437, - "velocityX": -1.0360043493810085, - "velocityY": 0.46240761075027864, - "timestamp": 2.6069164418559794 - }, - { - "x": 7.844584019895448, - "y": 3.8932735439961332, - "heading": 4.164417089967741, - "angularVelocity": -0.19003026648746557, - "velocityX": -1.1660004632143819, - "velocityY": 0.46686461350834163, - "timestamp": 2.630524964627111 - }, - { - "x": 7.813987228132184, - "y": 3.904392042354374, - "heading": 4.1593016805781176, - "angularVelocity": -0.21667638586345156, - "velocityX": -1.2960061948765607, - "velocityY": 0.47095273457066494, - "timestamp": 2.6541334873982425 - }, - { - "x": 7.780320972934565, - "y": 3.9155975575050164, - "heading": 4.153553394222869, - "angularVelocity": -0.2434835254613041, - "velocityX": -1.426021251900615, - "velocityY": 0.4746385557144377, - "timestamp": 2.677742010169374 - }, - { - "x": 7.7435850463173015, - "y": 3.926879690662087, - "heading": 4.147168172074516, - "angularVelocity": -0.27046258718739974, - "velocityX": -1.5560451186798385, - "velocityY": 0.4778839094018357, - "timestamp": 2.7013505329405056 - }, - { - "x": 7.703779259669669, - "y": 3.9382270076248616, - "heading": 4.140141652504649, - "angularVelocity": -0.29762639695773513, - "velocityX": -1.6860769745537036, - "velocityY": 0.48064493796511365, - "timestamp": 2.724959055711637 - }, - { - "x": 7.660903453639524, - "y": 3.949626876465817, - "heading": 4.1324691163318406, - "angularVelocity": -0.3249900998545743, - "velocityX": -1.8161155801997555, - "velocityY": 0.482870908589551, - "timestamp": 2.748567578482769 - }, - { - "x": 7.614957511778938, - "y": 3.961065269589929, - "heading": 4.124145420258021, - "angularVelocity": -0.35257166043431315, - "velocityX": -1.9461591182979985, - "velocityY": 0.48450270417155444, - "timestamp": 2.7721761012539003 - }, - { - "x": 7.565941379533382, - "y": 3.972526519867812, - "heading": 4.115164915200959, - "angularVelocity": -0.380392502492515, - "velocityX": -2.0762049671945992, - "velocityY": 0.4854708779958824, - "timestamp": 2.795784624025032 - }, - { - "x": 7.513855090932225, - "y": 3.9839930167730904, - "heading": 4.105521345095972, - "angularVelocity": -0.4084783363395984, - "velocityX": -2.2062493746896052, - "velocityY": 0.4856931124593558, - "timestamp": 2.8193931467961635 - }, - { - "x": 7.458698806563996, - "y": 3.995444822975592, - "heading": 4.095207720123672, - "angularVelocity": -0.43686024205255225, - "velocityX": -2.336286980042793, - "velocityY": 0.4850708497738249, - "timestamp": 2.843001669567295 - }, - { - "x": 7.400472868401379, - "y": 4.0068591837195235, - "heading": 4.084216155973937, - "angularVelocity": -0.46557610809832467, - "velocityX": -2.466310100257985, - "velocityY": 0.4834847505957555, - "timestamp": 2.8666101923384266 - }, - { - "x": 7.339177880333258, - "y": 4.018209888996166, - "heading": 4.072537667277958, - "angularVelocity": -0.4946725726634777, - "velocityX": -2.5963076411995325, - "velocityY": 0.4807884587562188, - "timestamp": 2.890218715109558 - }, - { - "x": 7.27481482889874, - "y": 4.029466429354311, - "heading": 4.06016189806287, - "angularVelocity": -0.524207691224974, - "velocityX": -2.7262633947272543, - "velocityY": 0.4767998602565998, - "timestamp": 2.9138272378806898 - }, - { - "x": 7.207385268714358, - "y": 4.040592855511578, - "heading": 4.047076763864054, - "angularVelocity": -0.5542546785187346, - "velocityX": -2.8561532984533065, - "velocityY": 0.4712885369884458, - "timestamp": 2.9374357606518213 - }, - { - "x": 7.136891615524657, - "y": 4.051546201216433, - "heading": 4.033267966939994, - "angularVelocity": -0.584907283608017, - "velocityX": -2.9859408770760103, - "velocityY": 0.46395726708693935, - "timestamp": 2.961044283422953 - }, - { - "x": 7.063337625419452, - "y": 4.062274241890114, - "heading": 4.018718324124552, - "angularVelocity": -0.6162877261102292, - "velocityX": -3.115569356806623, - "velocityY": 0.4544138901737024, - "timestamp": 2.9846528061940845 - }, - { - "x": 6.986729211328242, - "y": 4.0727122063788395, - "heading": 4.003406808949002, - "angularVelocity": -0.6485587990398427, - "velocityX": -3.24494737912542, - "velocityY": 0.4421269636355666, - "timestamp": 3.008261328965216 - }, - { - "x": 6.907075905402423, - "y": 4.0827777690377465, - "heading": 3.9873071408156635, - "angularVelocity": -0.681943054608452, - "velocityX": -3.3739216425358753, - "velocityY": 0.42635292163306987, - "timestamp": 3.0318698517363476 - }, - { - "x": 6.824393644375493, - "y": 4.092363079240797, - "heading": 3.970385621156536, - "angularVelocity": -0.7167547001212231, - "velocityX": -3.502220864408744, - "velocityY": 0.4060105876158922, - "timestamp": 3.055478374507479 - }, - { - "x": 6.738710497953685, - "y": 4.1013214071032555, - "heading": 3.95259764005598, - "angularVelocity": -0.7534559139086403, - "velocityX": -3.629331121326169, - "velocityY": 0.37945313009599524, - "timestamp": 3.0790868972786107 - }, - { - "x": 6.650079643932432, - "y": 4.109443461148631, - "heading": 3.9338816488629216, - "angularVelocity": -0.7927641798894928, - "velocityX": -3.754188895276186, - "velocityY": 0.3440305911605684, - "timestamp": 3.1026954200497423 - }, - { - "x": 6.5586124916873185, - "y": 4.116413273413615, - "heading": 3.9141479140434288, - "angularVelocity": -0.8358733416231714, - "velocityX": -3.8743276371765454, - "velocityY": 0.2952244124951097, - "timestamp": 3.126303942820874 - }, - { - "x": 6.46457504667221, - "y": 4.121728253195517, - "heading": 3.8932578414178582, - "angularVelocity": -0.8848530180429063, - "velocityX": -3.983199030568015, - "velocityY": 0.22512970563301316, - "timestamp": 3.1499124655920054 - }, - { - "x": 6.368678589791372, - "y": 4.124624521627842, - "heading": 3.8710237627532775, - "angularVelocity": -0.9417818675113662, - "velocityX": -4.061942282898786, - "velocityY": 0.12267893507825635, - "timestamp": 3.173520988363137 - }, - { - "x": 6.272525829089795, - "y": 4.124480807277699, - "heading": 3.8473779385258497, - "angularVelocity": -1.0015799995898869, - "velocityX": -4.0727986936627145, - "velocityY": -0.0060873927411320885, - "timestamp": 3.1971295111342686 - }, - { - "x": 6.17777722513879, - "y": 4.121614708086708, - "heading": 3.8226769599510275, - "angularVelocity": -1.0462737891006977, - "velocityX": -4.013322005342572, - "velocityY": -0.12140103888649843, - "timestamp": 3.2207380339054 + "angularVelocity": -0.005204326813122979, + "velocityX": -0.2622066102908217, + "velocityY": 0.4257319399638149, + "timestamp": 3.167155129979705 + }, + { + "x": 7.963451202002662, + "y": 3.8299573925524886, + "heading": 4.182187256834467, + "angularVelocity": -0.022887016371921386, + "velocityX": -0.35067071684037177, + "velocityY": 0.42478446604441783, + "timestamp": 3.1939162432354022 + }, + { + "x": 7.951699535558351, + "y": 3.8412962048515644, + "heading": 4.181099599512945, + "angularVelocity": -0.04064320161608694, + "velocityX": -0.439132196483299, + "velocityY": 0.42370480595245197, + "timestamp": 3.2206773564910995 + }, + { + "x": 7.937580621360099, + "y": 3.852602364647738, + "heading": 4.179534751300954, + "angularVelocity": -0.05847470533229181, + "velocityX": -0.5275906896454091, + "velocityY": 0.42248465854697903, + "timestamp": 3.247438469746797 + }, + { + "x": 7.921094550503366, + "y": 3.863871868563307, + "heading": 4.177490639391159, + "angularVelocity": -0.0763836649942111, + "velocityX": -0.6160457787840902, + "velocityY": 0.42111491431217335, + "timestamp": 3.274199583002494 + }, + { + "x": 7.902241427098489, + "y": 3.8751004449108475, + "heading": 4.174965124271339, + "angularVelocity": -0.09437257320683892, + "velocityX": -0.704496977563563, + "velocityY": 0.4195855471426245, + "timestamp": 3.3009606962581914 + }, + { + "x": 7.88102137046632, + "y": 3.886283525768321, + "heading": 4.171955988942259, + "angularVelocity": -0.11244432547808522, + "velocityX": -0.792943717602994, + "velocityY": 0.4178854874467351, + "timestamp": 3.3277218095138887 + }, + { + "x": 7.85743451777067, + "y": 3.897416215051291, + "heading": 4.168460926619584, + "angularVelocity": -0.13060227686648773, + "velocityX": -0.8813853321528802, + "velocityY": 0.41600247256526673, + "timestamp": 3.354482922769586 + }, + { + "x": 7.8314810271924085, + "y": 3.9084932518402047, + "heading": 4.164477526630598, + "angularVelocity": -0.14885030943689379, + "velocityX": -0.9698210358545546, + "velocityY": 0.41392286946641677, + "timestamp": 3.3812440360252833 + }, + { + "x": 7.803161081780004, + "y": 3.9195089680498767, + "heading": 4.1600032581515265, + "angularVelocity": -0.16719291295249908, + "velocityX": -1.05824989946468, + "velocityY": 0.4116314633258134, + "timestamp": 3.4080051492809806 + }, + { + "x": 7.772474894151133, + "y": 3.930457239309372, + "heading": 4.155035451348857, + "angularVelocity": -0.1856352818809576, + "velocityX": -1.1466708180511556, + "velocityY": 0.4091112038160546, + "timestamp": 3.434766262536678 + }, + { + "x": 7.739422712274089, + "y": 3.9413314276382687, + "heading": 4.149571275382789, + "angularVelocity": -0.2041834326494015, + "velocityX": -1.2350824706446473, + "velocityY": 0.4063428985555967, + "timestamp": 3.4615273757923752 + }, + { + "x": 7.704004826631203, + "y": 3.9521243141373215, + "heading": 4.143607712595044, + "angularVelocity": -0.2228443462260134, + "velocityX": -1.3234832685947802, + "velocityY": 0.40330483997174355, + "timestamp": 3.4882884890480725 + }, + { + "x": 7.666221579168315, + "y": 3.962828019427522, + "heading": 4.137141528026157, + "angularVelocity": -0.241626142645967, + "velocityX": -1.4118712888314486, + "velocityY": 0.3999723474851382, + "timestamp": 3.51504960230377 + }, + { + "x": 7.626073374576437, + "y": 3.9734339089269395, + "heading": 4.130169233174118, + "angularVelocity": -0.2605382961994449, + "velocityX": -1.500244186714977, + "velocityY": 0.39631720093564143, + "timestamp": 3.541810715559467 + }, + { + "x": 7.58356069465374, + "y": 3.983932479186973, + "heading": 4.122687042595275, + "angularVelocity": -0.2795919028984897, + "velocityX": -1.5885990809312174, + "velocityY": 0.3923069328140146, + "timestamp": 3.5685718288151644 + }, + { + "x": 7.538684116786936, + "y": 3.994313220324826, + "heading": 4.114690821529067, + "angularVelocity": -0.2988000158963987, + "velocityX": -1.6769323995612107, + "velocityY": 0.387903935036916, + "timestamp": 3.5953329420708617 + }, + { + "x": 7.491444338017231, + "y": 4.00456444794984, + "heading": 4.106176022154423, + "angularVelocity": -0.3181780702950364, + "velocityX": -1.7652396713969913, + "velocityY": 0.38306431900132476, + "timestamp": 3.622094055326559 + }, + { + "x": 7.4418422067924155, + "y": 4.014673095676399, + "heading": 4.097137605289561, + "angularVelocity": -0.3377444270909928, + "velocityX": -1.8535152387300855, + "velocityY": 0.3777364427994356, + "timestamp": 3.6488551685822563 + }, + { + "x": 7.389878765475513, + "y": 4.024624456021231, + "heading": 4.087569943223826, + "angularVelocity": -0.35752107822709445, + "velocityX": -1.9417518554030933, + "velocityY": 0.3718589824626068, + "timestamp": 3.6756162818379536 + }, + { + "x": 7.3355553081899885, + "y": 4.034401852682468, + "heading": 4.077466697757452, + "angularVelocity": -0.3775345730141747, + "velocityX": -2.0299401137192343, + "velocityY": 0.3653583678607193, + "timestamp": 3.702377395093651 + }, + { + "x": 7.278873460992411, + "y": 4.043986220059233, + "heading": 4.066820665162764, + "angularVelocity": -0.39781725419895203, + "velocityX": -2.1180676101175324, + "velocityY": 0.3581453164965952, + "timestamp": 3.7291385083493482 + }, + { + "x": 7.219835295323935, + "y": 4.053355555007508, + "heading": 4.055623576242335, + "angularVelocity": -0.41840893588553546, + "velocityX": -2.2061177016208897, + "velocityY": 0.35011005927721894, + "timestamp": 3.7558996216050455 + }, + { + "x": 7.158443492406841, + "y": 4.0624841888713705, + "heading": 4.043865834226526, + "angularVelocity": -0.4393592263320925, + "velocityX": -2.2940676021400144, + "velocityY": 0.3411156246243232, + "timestamp": 3.782660734860743 + }, + { + "x": 7.09470158805335, + "y": 4.071341800593327, + "heading": 4.031536164668173, + "angularVelocity": -0.46073081641055347, + "velocityX": -2.3818853776541133, + "velocityY": 0.33098816320999985, + "timestamp": 3.80942184811644 + }, + { + "x": 7.028614348964204, + "y": 4.079892046545646, + "heading": 4.018621137474081, + "angularVelocity": -0.48260425755428477, + "velocityX": -2.4695250327479035, + "velocityY": 0.31950262571743504, + "timestamp": 3.8361829613721374 + }, + { + "x": 6.960188373088244, + "y": 4.088090605115376, + "heading": 4.005104497423563, + "angularVelocity": -0.5050851181476842, + "velocityX": -2.5569181379773873, + "velocityY": 0.30636089356202295, + "timestamp": 3.8629440746278347 + }, + { + "x": 6.8894330908058015, + "y": 4.095882295321711, + "heading": 3.9909661972610597, + "angularVelocity": -0.5283150976349366, + "velocityX": -2.6439588520249506, + "velocityY": 0.2911571776512241, + "timestamp": 3.889705187883532 + }, + { + "x": 6.816362525944293, + "y": 4.103196669781287, + "heading": 3.9761809481036865, + "angularVelocity": -0.5524900633281915, + "velocityX": -2.7304755285528013, + "velocityY": 0.27332100834849943, + "timestamp": 3.9164663011392293 + }, + { + "x": 6.740998601423215, + "y": 4.109940977464476, + "heading": 3.9607159426745864, + "angularVelocity": -0.5778909599662544, + "velocityX": -2.8161729970270786, + "velocityY": 0.2520189507344823, + "timestamp": 3.9432274143949266 + }, + { + "x": 6.663377862518537, + "y": 4.115988372430229, + "heading": 3.9445270622102377, + "angularVelocity": -0.6049404712601872, + "velocityX": -2.900504854301995, + "velocityY": 0.22597695798279616, + "timestamp": 3.969988527650624 + }, + { + "x": 6.5835665711005085, + "y": 4.1211572050315874, + "heading": 3.9275520881376464, + "angularVelocity": -0.6343149446138038, + "velocityX": -2.9823606609877906, + "velocityY": 0.19314714421513643, + "timestamp": 3.9967496409063212 + }, + { + "x": 6.501698761089027, + "y": 4.125174012394954, + "heading": 3.9096978959603224, + "angularVelocity": -0.6671692618588209, + "velocityX": -3.0592079346344714, + "velocityY": 0.15009866461789562, + "timestamp": 4.023510754162018 + }, + { + "x": 6.418082461531196, + "y": 4.127617363423628, + "heading": 3.8908218948706237, + "angularVelocity": -0.7053518629566096, + "velocityX": -3.1245448856665323, + "velocityY": 0.0913022939413702, + "timestamp": 4.050271867417715 + }, + { + "x": 6.333468879031824, + "y": 4.127936187292477, + "heading": 3.8707699420597645, + "angularVelocity": -0.7492944190798996, + "velocityX": -3.161811008791136, + "velocityY": 0.011913699770386288, + "timestamp": 4.077032980673412 + }, + { + "x": 6.249185342560519, + "y": 4.125928681866208, + "heading": 3.8495306129865616, + "angularVelocity": -0.7936638834963641, + "velocityX": -3.1494779632668077, + "velocityY": -0.0750157666120823, + "timestamp": 4.103794093929109 + }, + { + "x": 6.166285601861295, + "y": 4.122007646444551, + "heading": 3.8274706354096204, + "angularVelocity": -0.8243295922020396, + "velocityX": -3.097768762724307, + "velocityY": -0.14651989191157552, + "timestamp": 4.1305552071848055 }, { "x": 6.085252285003662, "y": 4.116629123687744, - "heading": 3.7974224467067916, - "angularVelocity": -1.0697201806763073, - "velocityX": -3.9191329771917003, - "velocityY": -0.21117731284148858, - "timestamp": 3.2443465566765317 - }, - { - "x": 5.938861783887598, - "y": 4.1037244473818655, - "heading": 3.754861975503122, - "angularVelocity": -1.086887550109536, - "velocityX": -3.7384457600560106, - "velocityY": -0.3295530246351326, - "timestamp": 3.283504674919197 - }, - { - "x": 5.800760573779927, - "y": 4.092512730511137, - "heading": 3.712339212672838, - "angularVelocity": -1.0859245729523437, - "velocityX": -3.526758085050148, - "velocityY": -0.2863190922819579, - "timestamp": 3.3226627931618626 - }, - { - "x": 5.669860304643064, - "y": 4.085741390502388, - "heading": 3.6701248779070657, - "angularVelocity": -1.0780480947569435, - "velocityX": -3.342864136771513, - "velocityY": -0.17292301858807546, - "timestamp": 3.361820911404528 - }, - { - "x": 5.545377582842458, - "y": 4.084481715280869, - "heading": 3.6283363494098766, - "angularVelocity": -1.0671740720078278, - "velocityX": -3.1789760945400203, - "velocityY": -0.03216894166669459, - "timestamp": 3.4009790296471936 - }, - { - "x": 5.426822280051095, - "y": 4.089257297848366, - "heading": 3.587039929856771, - "angularVelocity": -1.054606845435952, - "velocityX": -3.0276046988945726, - "velocityY": 0.1219563855930542, - "timestamp": 3.440137147889859 - }, - { - "x": 5.3138701574626115, - "y": 4.100370049824379, - "heading": 3.5462794826588393, - "angularVelocity": -1.040919457501415, - "velocityX": -2.88451354808505, - "velocityY": 0.2837917774071924, - "timestamp": 3.4792952661325245 - }, - { - "x": 5.206293411755839, - "y": 4.118014128688355, - "heading": 3.506087166042516, - "angularVelocity": -1.0264108292244598, - "velocityX": -2.7472399220031574, - "velocityY": 0.45058546364884994, - "timestamp": 3.51845338437519 - }, - { - "x": 5.103924028303818, - "y": 4.14232411942007, - "heading": 3.4664882727991313, - "angularVelocity": -1.0112562865760766, - "velocityX": -2.6142569675496197, - "velocityY": 0.6208161122823261, - "timestamp": 3.5576115026178554 + "heading": 3.8049678199315378, + "angularVelocity": -0.8408774053258744, + "velocityX": -3.0280248838445276, + "velocityY": -0.2009827732283067, + "timestamp": 4.157316320440502 + }, + { + "x": 5.974992324878816, + "y": 4.106756362131966, + "heading": 3.772772862461783, + "angularVelocity": -0.8521811407903093, + "velocityX": -2.9185147609204627, + "velocityY": -0.2613260543442573, + "timestamp": 4.195095797043209 + }, + { + "x": 5.869427380748592, + "y": 4.097415560583956, + "heading": 3.740507406337221, + "angularVelocity": -0.854047197738348, + "velocityX": -2.7942405142443114, + "velocityY": -0.24724539321291195, + "timestamp": 4.232875273645915 + }, + { + "x": 5.768118803232247, + "y": 4.090126347890849, + "heading": 3.708345250781034, + "angularVelocity": -0.8513128938870157, + "velocityX": -2.681577052581149, + "velocityY": -0.19294107141179928, + "timestamp": 4.270654750248621 + }, + { + "x": 5.67065088965741, + "y": 4.085589027886395, + "heading": 3.676369898875793, + "angularVelocity": -0.8463683137143149, + "velocityX": -2.5799169903761094, + "velocityY": -0.12010012875955235, + "timestamp": 4.308434226851327 + }, + { + "x": 5.576731872491881, + "y": 4.084170563244895, + "heading": 3.644629809831453, + "angularVelocity": -0.8401410474296196, + "velocityX": -2.4859798390855907, + "velocityY": -0.037545905053554304, + "timestamp": 4.346213703454033 + }, + { + "x": 5.486157189161119, + "y": 4.086089175594324, + "heading": 3.6131569865293773, + "angularVelocity": -0.8330666841430566, + "velocityX": -2.397457335983126, + "velocityY": 0.05078451376130899, + "timestamp": 4.3839931800567395 + }, + { + "x": 5.398778197481823, + "y": 4.091487332597936, + "heading": 3.5819745162590415, + "angularVelocity": -0.8253812142040706, + "velocityX": -2.3128693019806765, + "velocityY": 0.14288596584815674, + "timestamp": 4.421772656659446 + }, + { + "x": 5.3144828836101885, + "y": 4.100464572741929, + "heading": 3.5511001516547482, + "angularVelocity": -0.8172258427233542, + "velocityX": -2.2312462069841628, + "velocityY": 0.2376221417358252, + "timestamp": 4.459552133262152 + }, + { + "x": 5.2331841516142665, + "y": 4.1130940414694965, + "heading": 3.52054821009081, + "angularVelocity": -0.8086914989645554, + "velocityX": -2.1519284888689807, + "velocityY": 0.3342944334666334, + "timestamp": 4.497331609864858 + }, + { + "x": 5.154812493825414, + "y": 4.129431607749487, + "heading": 3.4903306661884095, + "angularVelocity": -0.7998401941925376, + "velocityX": -2.0744505968947196, + "velocityY": 0.4324455431660657, + "timestamp": 4.535111086467564 + }, + { + "x": 5.079311226778378, + "y": 4.149521261213231, + "heading": 3.4604578201556584, + "angularVelocity": -0.7907162491131828, + "velocityX": -1.9984730821185472, + "velocityY": 0.531761031922558, + "timestamp": 4.5728905630702705 }, { "x": 5.006633281707764, "y": 4.173398494720459, - "heading": 3.427503698824361, - "angularVelocity": -0.9955681152291422, - "velocityX": -2.4845613365060037, - "velocityY": 0.7935615063987016, - "timestamp": 3.596769620860521 - }, - { - "x": 4.937656823275381, - "y": 4.200004533523932, - "heading": 3.3991245021119765, - "angularVelocity": -0.9837042847573768, - "velocityX": -2.390921716177865, - "velocityY": 0.9222415502684376, - "timestamp": 3.625618937827138 - }, - { - "x": 4.871513231042132, - "y": 4.230223128841872, - "heading": 3.371147875870923, - "angularVelocity": -0.9697500385685549, - "velocityX": -2.2927264555270552, - "velocityY": 1.0474631116189388, - "timestamp": 3.654468254793755 - }, - { - "x": 4.808351922297538, - "y": 4.263931274273916, - "heading": 3.3436428942859213, - "angularVelocity": -0.9534014831903603, - "velocityX": -2.1893519634340524, - "velocityY": 1.1684209186322614, - "timestamp": 3.683317571760372 - }, - { - "x": 4.748342933359481, - "y": 4.300975202346389, - "heading": 3.3166887915596823, - "angularVelocity": -0.9343064432835324, - "velocityX": -2.0800835252875274, - "velocityY": 1.2840487043535722, - "timestamp": 3.712166888726989 - }, - { - "x": 4.691679256160981, - "y": 4.341159950611299, - "heading": 3.2903763909228227, - "angularVelocity": -0.9120632099299534, - "velocityX": -1.9641254336825034, - "velocityY": 1.392918532920877, - "timestamp": 3.7410162056936063 - }, - { - "x": 4.638577930821313, - "y": 4.384234979098084, - "heading": 3.2648093675405647, - "angularVelocity": -0.8862262982462743, - "velocityX": -1.8406441095681965, - "velocityY": 1.4931039281322762, - "timestamp": 3.7698655226602233 - }, - { - "x": 4.589277916564578, - "y": 4.4298748189343184, - "heading": 3.24010500110691, - "angularVelocity": -0.8563241362782199, - "velocityX": -1.7088797739572847, - "velocityY": 1.5820076395236735, - "timestamp": 3.7987148396268404 - }, - { - "x": 4.5440310309587515, - "y": 4.477654622101576, - "heading": 3.2163939367958534, - "angularVelocity": -0.8218934381875912, - "velocityX": -1.5683867198029067, - "velocityY": 1.6561849011036218, - "timestamp": 3.8275641565934575 - }, - { - "x": 4.503080075782216, - "y": 4.527023624920059, - "heading": 3.193818301564307, - "angularVelocity": -0.782536212474967, - "velocityX": -1.4194774602089775, - "velocityY": 1.711271115208911, - "timestamp": 3.8564134735600746 - }, - { - "x": 4.46661789297568, - "y": 4.57728677898734, - "heading": 3.1725267154544348, - "angularVelocity": -0.7380273901981841, - "velocityX": -1.2638837463198034, - "velocityY": 1.7422649598757816, - "timestamp": 3.8852627905266917 - }, - { - "x": 4.434728523792188, - "y": 4.627614799328075, - "heading": 3.1526626177771173, - "angularVelocity": -0.6885465503499899, - "velocityX": -1.1053769217618672, - "velocityY": 1.7445134108016194, - "timestamp": 3.9141121074933087 - }, - { - "x": 4.407331531292003, - "y": 4.677102971954541, - "heading": 3.1343439647930738, - "angularVelocity": -0.6349770084761907, - "velocityX": -0.9496582720446234, - "velocityY": 1.7154018822609098, - "timestamp": 3.942961424459926 - }, - { - "x": 4.38416697035973, - "y": 4.724871159718963, - "heading": 3.1176453508036173, - "angularVelocity": -0.5788218143528088, - "velocityX": -0.8029500649557468, - "velocityY": 1.6557822779543205, - "timestamp": 3.971810741426543 - }, - { - "x": 4.364838650184773, - "y": 4.770158562720032, - "heading": 3.102596259666631, - "angularVelocity": -0.5216446252228655, - "velocityX": -0.6699749667322109, - "velocityY": 1.5697911688336352, - "timestamp": 4.0006600583931595 - }, - { - "x": 4.348888573038258, - "y": 4.812368956191183, - "heading": 3.089189215796109, - "angularVelocity": -0.46472656132675605, - "velocityX": -0.5528753822828192, - "velocityY": 1.4631332006921636, - "timestamp": 4.029509375359776 - }, - { - "x": 4.335861259266713, - "y": 4.85106463542958, - "heading": 3.077388704078398, - "angularVelocity": -0.4090395530461387, - "velocityX": -0.4515640278977055, - "velocityY": 1.3413031332136207, - "timestamp": 4.058358692326393 - }, - { - "x": 4.325340119447455, - "y": 4.8859350900174165, - "heading": 3.0671405005854333, - "angularVelocity": -0.35523210150256085, - "velocityX": -0.36469285672977003, - "velocityY": 1.2087098848195585, - "timestamp": 4.087208009293009 - }, - { - "x": 4.316960474710625, - "y": 4.9167626971561855, - "heading": 3.058380753694675, - "angularVelocity": -0.30363793017680446, - "velocityX": -0.29046250025703113, - "velocityY": 1.068573206583551, - "timestamp": 4.116057326259626 - }, - { - "x": 4.310409550752313, - "y": 4.9433947876173105, - "heading": 3.0510430147740575, - "angularVelocity": -0.25434705886134035, - "velocityX": -0.22707379747989975, - "velocityY": 0.9231445753790886, - "timestamp": 4.144906643226243 - }, - { - "x": 4.305421020948144, - "y": 4.965723440411237, - "heading": 3.0450626529491944, - "angularVelocity": -0.20729647886580527, - "velocityX": -0.1729167387201477, - "velocityY": 0.7739750934057472, - "timestamp": 4.173755960192859 - }, - { - "x": 4.301768102740837, - "y": 4.983671575861687, - "heading": 3.0403791563233025, - "angularVelocity": -0.1623434146226634, - "velocityX": -0.12662061328980811, - "velocityY": 0.6221338089639996, - "timestamp": 4.202605277159476 - }, - { - "x": 4.299256940796215, - "y": 4.997183546671836, - "heading": 3.0369370630877266, - "angularVelocity": -0.11931281560526409, - "velocityX": -0.08704406927651794, - "velocityY": 0.46836362974486884, - "timestamp": 4.231454594126093 - }, - { - "x": 4.297720871569226, - "y": 5.0062187774292, - "heading": 3.0346861151511018, - "angularVelocity": -0.0780243060599773, - "velocityX": -0.05324456134491601, - "velocityY": 0.3131869904518336, - "timestamp": 4.260303911092709 + "heading": 3.4309387268192957, + "angularVelocity": -0.7813526282216597, + "velocityX": -1.9237414492240437, + "velocityY": 0.6320159953067281, + "timestamp": 4.610670039672977 + }, + { + "x": 4.942868657450354, + "y": 4.198256846286876, + "heading": 3.404404470872184, + "angularVelocity": -0.7726521203159952, + "velocityX": -1.8567647885752279, + "velocityY": 0.723851389827387, + "timestamp": 4.645011828492841 + }, + { + "x": 4.881509496702508, + "y": 4.226188983081773, + "heading": 3.378217710449817, + "angularVelocity": -0.7625333834450684, + "velocityX": -1.786719994980448, + "velocityY": 0.8133570717999663, + "timestamp": 4.679353617312705 + }, + { + "x": 4.822674368879593, + "y": 4.25709776691911, + "heading": 3.352433635613109, + "angularVelocity": -0.7508075648579646, + "velocityX": -1.713222573568582, + "velocityY": 0.900034182827979, + "timestamp": 4.713695406132569 + }, + { + "x": 4.766496795353122, + "y": 4.290863870424898, + "heading": 3.32711485602231, + "angularVelocity": -0.7372586129279952, + "velocityX": -1.635837137696703, + "velocityY": 0.983236595009792, + "timestamp": 4.748037194952433 + }, + { + "x": 4.713126817534648, + "y": 4.327338953959474, + "heading": 3.302332355149848, + "angularVelocity": -0.72164269026451, + "velocityX": -1.5540826396207805, + "velocityY": 1.0621194989550988, + "timestamp": 4.782378983772297 + }, + { + "x": 4.662731869400387, + "y": 4.366336499085112, + "heading": 3.2781663522474465, + "angularVelocity": -0.7036908598198508, + "velocityX": -1.4674526245153463, + "velocityY": 1.1355711646296458, + "timestamp": 4.816720772592161 + }, + { + "x": 4.615495938030307, + "y": 4.407619714122828, + "heading": 3.25470688648321, + "angularVelocity": -0.6831171750339045, + "velocityX": -1.3754650818526581, + "velocityY": 1.2021276833965184, + "timestamp": 4.851062561412025 + }, + { + "x": 4.571615167814469, + "y": 4.450886271337786, + "heading": 3.2320538652482793, + "angularVelocity": -0.6596342827030635, + "velocityX": -1.2777660024062774, + "velocityY": 1.2598807080757402, + "timestamp": 4.885404350231889 + }, + { + "x": 4.531286947002188, + "y": 4.495750867878681, + "heading": 3.210316251948319, + "angularVelocity": -0.6329784803576448, + "velocityX": -1.1743191661860777, + "velocityY": 1.3064140827441386, + "timestamp": 4.919746139051753 + }, + { + "x": 4.49468875405066, + "y": 4.541729560722991, + "heading": 3.1896098329586398, + "angularVelocity": -0.6029510896561723, + "velocityX": -1.065704327270207, + "velocityY": 1.3388555000872755, + "timestamp": 4.954087927871617 + }, + { + "x": 4.461944703854708, + "y": 4.58823480395128, + "heading": 3.1700521077060673, + "angularVelocity": -0.5695022281792148, + "velocityX": -0.9534753814866304, + "velocityY": 1.3541881429714668, + "timestamp": 4.988429716691481 + }, + { + "x": 4.433084989818715, + "y": 4.634594075764574, + "heading": 3.15175191127338, + "angularVelocity": -0.5328841933272364, + "velocityX": -0.840367232684729, + "velocityY": 1.3499375951691615, + "timestamp": 5.022771505511345 + }, + { + "x": 4.408015136265837, + "y": 4.680099458997601, + "heading": 3.1347948929027134, + "angularVelocity": -0.4937721345737907, + "velocityX": -0.7300101251096751, + "velocityY": 1.3250731775132731, + "timestamp": 5.057113294331209 + }, + { + "x": 4.386515523359297, + "y": 4.7240761111554255, + "heading": 3.119233776621693, + "angularVelocity": -0.45312480263168503, + "velocityX": -0.6260481368431887, + "velocityY": 1.2805579927271504, + "timestamp": 5.091455083151073 + }, + { + "x": 4.3682750992900985, + "y": 4.7659405609732906, + "heading": 3.105089224757056, + "angularVelocity": -0.4118758035241259, + "velocityX": -0.531143679348733, + "velocityY": 1.21905268352387, + "timestamp": 5.1257968719709375 + }, + { + "x": 4.352940592262872, + "y": 4.805227096523998, + "heading": 3.0923557137916355, + "angularVelocity": -0.3707876439463567, + "velocityX": -0.44652615819354075, + "velocityY": 1.1439862890305763, + "timestamp": 5.1601386607908015 + }, + { + "x": 4.340158565629974, + "y": 4.841583652435461, + "heading": 3.0810074682882163, + "angularVelocity": -0.33045004041419795, + "velocityX": -0.3722003737179855, + "velocityY": 1.058668088088494, + "timestamp": 5.194480449610666 + }, + { + "x": 4.329600653798364, + "y": 4.874751978213288, + "heading": 3.0710045148132727, + "angularVelocity": -0.2912764249821968, + "velocityX": -0.30743628082363317, + "velocityY": 0.9658298800859751, + "timestamp": 5.22882223843053 + }, + { + "x": 4.320974113375607, + "y": 4.904544945118328, + "heading": 3.062298708280428, + "angularVelocity": -0.2535047483551423, + "velocityX": -0.25119659514553827, + "velocityY": 0.8675426624196874, + "timestamp": 5.263164027250394 + }, + { + "x": 4.314023414784346, + "y": 4.930827090495744, + "heading": 3.054838719869548, + "angularVelocity": -0.21722771781080963, + "velocityX": -0.20239768602969369, + "velocityY": 0.7653109019823413, + "timestamp": 5.297505816070258 + }, + { + "x": 4.308527535879405, + "y": 4.953499830547057, + "heading": 3.048573474005263, + "angularVelocity": -0.1824379591042448, + "velocityX": -0.1600347301000252, + "velocityY": 0.6602084757506164, + "timestamp": 5.331847604890122 + }, + { + "x": 4.3042957090143315, + "y": 4.972490820345766, + "heading": 3.0434541747536845, + "angularVelocity": -0.14906909125880094, + "velocityX": -0.12322674532980514, + "velocityY": 0.5529994345467729, + "timestamp": 5.366189393709986 + }, + { + "x": 4.301162979125563, + "y": 4.9877464707182675, + "heading": 3.039435315609642, + "angularVelocity": -0.1170253292606026, + "velocityX": -0.09122209402662507, + "velocityY": 0.44422992793192745, + "timestamp": 5.40053118252985 + }, + { + "x": 4.298986142785592, + "y": 4.999226717111559, + "heading": 3.0364750487374588, + "angularVelocity": -0.08620013615804763, + "velocityX": -0.06338738938113687, + "velocityY": 0.33429377990501713, + "timestamp": 5.434872971349714 + }, + { + "x": 4.2976402487172045, + "y": 5.006901351879666, + "heading": 3.034535187310271, + "angularVelocity": -0.05648690688080154, + "velocityX": -0.03919114625766282, + "velocityY": 0.22347801415830756, + "timestamp": 5.469214760169578 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": -0.0383058918727994, - "velocityX": -0.02444441261373577, - "velocityY": 0.15697616982684176, - "timestamp": 4.289153228059326 + "angularVelocity": -0.027784544960703036, + "velocityX": -0.018187222535483022, + "velocityY": 0.11199419020507764, + "timestamp": 5.503556548989442 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": 4.966568604592627e-21, - "velocityX": 7.617351748205077e-22, - "velocityY": 1.4083890100936048e-21, - "timestamp": 4.3180025450259425 + "angularVelocity": -8.769505529981165e-23, + "velocityX": -1.240876760933137e-21, + "velocityY": -2.1890549285133406e-22, + "timestamp": 5.537898337809306 } ], "trajectoryWaypoints": [ @@ -7656,10 +7814,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 28 + "controlIntervalCount": 32 }, { - "timestamp": 1.2715885198507333, + "timestamp": 1.6386314540557712, "isStopPoint": false, "x": 5.914944171905518, "y": 1.618774652481079, @@ -7667,10 +7825,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 35 + "controlIntervalCount": 40 }, { - "timestamp": 2.46526530522919, + "timestamp": 3.167155129979705, "isStopPoint": false, "x": 7.972835540771484, "y": 3.818589687347412, @@ -7678,10 +7836,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 33 + "controlIntervalCount": 37 }, { - "timestamp": 3.2443465566765317, + "timestamp": 4.157316320440502, "isStopPoint": false, "x": 6.085252285003662, "y": 4.116629123687744, @@ -7689,10 +7847,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 9 + "controlIntervalCount": 12 }, { - "timestamp": 3.596769620860521, + "timestamp": 4.610670039672977, "isStopPoint": false, "x": 5.006633281707764, "y": 4.173398494720459, @@ -7700,10 +7858,10 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": false, - "controlIntervalCount": 25 + "controlIntervalCount": 27 }, { - "timestamp": 4.3180025450259425, + "timestamp": 5.537898337809306, "isStopPoint": true, "x": 4.29701566696167, "y": 5.01074743270874, @@ -7756,7 +7914,7 @@ { "name": "Intake Off", "target": 2, - "targetTimestamp": 2.46526530522919, + "targetTimestamp": 3.167155129979705, "offset": 0.5, "command": { "type": "named", @@ -7766,7 +7924,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Amp Side Mid B": { "waypoints": [ @@ -7857,2044 +8015,2044 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": -1.3142297964035998e-23, - "velocityX": -1.083334582387026e-25, - "velocityY": -1.729816221225227e-24, + "angularVelocity": 2.0073542459851034e-22, + "velocityX": -1.4065326746107527e-21, + "velocityY": 7.40941788413694e-21, "timestamp": 0 }, { - "x": 2.60563777379529, - "y": 6.860019205441317, - "heading": -2.6716613236727724, - "angularVelocity": -0.022626919855620722, - "velocityX": 0.2908135076824555, - "velocityY": 0.0479031153248186, - "timestamp": 0.08905023460256821 - }, - { - "x": 2.657431788653954, - "y": 6.868550780384309, - "heading": -2.67569142112441, - "angularVelocity": -0.04525644957168479, - "velocityX": 0.5816269332677375, - "velocityY": 0.09580631630078756, - "timestamp": 0.17810046920513642 - }, - { - "x": 2.7351228017521323, - "y": 6.881348160715041, - "heading": -2.6817361560116657, - "angularVelocity": -0.06788005572622516, - "velocityX": 0.8724402967034719, - "velocityY": 0.14370967564371354, - "timestamp": 0.2671507038077046 - }, - { - "x": 2.838710809214557, - "y": 6.898411367068251, - "heading": -2.6897942738643654, - "angularVelocity": -0.09048957466157903, - "velocityX": 1.1632536166214305, - "velocityY": 0.1916132667068573, - "timestamp": 0.35620093841027284 - }, - { - "x": 2.968195808655137, - "y": 6.919740426657641, - "heading": -2.6998638401165413, - "angularVelocity": -0.11307736916265679, - "velocityX": 1.4540669097445138, - "velocityY": 0.23951716336943402, - "timestamp": 0.44525117301284106 - }, - { - "x": 3.123577798954381, - "y": 6.945335373287028, - "heading": -2.71194230142554, - "angularVelocity": -0.13563649060448887, - "velocityX": 1.7448801902961197, - "velocityY": 0.28742143963592753, - "timestamp": 0.5343014076154092 - }, - { - "x": 3.3048567799851756, - "y": 6.97519624728381, - "heading": -2.7260265619744923, - "angularVelocity": -0.15816084720955956, - "velocityX": 2.03569346942031, - "velocityY": 0.3353261687636266, - "timestamp": 0.6233516422179775 - }, - { - "x": 3.5120327522893717, - "y": 7.009323095281852, - "heading": -2.7421130753282568, - "angularVelocity": -0.18064537870741343, - "velocityX": 2.3265067546292677, - "velocityY": 0.3832314215717832, - "timestamp": 0.7124018768205457 - }, - { - "x": 3.745105716710612, - "y": 7.047715969716023, - "heading": -2.760197952403387, - "angularVelocity": -0.20308623728890646, - "velocityX": 2.6173200493120152, - "velocityY": 0.4311372632033863, - "timestamp": 0.8014521114231139 - }, - { - "x": 4.004075673995758, - "y": 7.090374927737104, - "heading": -2.7802770860662163, - "angularVelocity": -0.22548097433367448, - "velocityX": 2.908133352381726, - "velocityY": 0.47904374661636356, - "timestamp": 0.8905023460256821 - }, - { - "x": 4.28894262439546, - "y": 7.137300028836777, - "heading": -2.802346292800393, - "angularVelocity": -0.24782873209342446, - "velocityX": 3.1989466582661503, - "velocityY": 0.5269508980981372, - "timestamp": 0.9795525806282503 - }, - { - "x": 4.599706567353759, - "y": 7.188491329079206, - "heading": -2.8264014718479453, - "angularVelocity": -0.2701304399130545, - "velocityX": 3.489759957907361, - "velocityY": 0.5748586791589742, - "timestamp": 1.0686028152308185 - }, - { - "x": 4.936367501640731, - "y": 7.243948863571903, - "heading": -2.852438782605804, - "angularVelocity": -0.2923890192323865, - "velocityX": 3.7805732437369977, - "velocityY": 0.622766854463723, - "timestamp": 1.1576530498333866 - }, - { - "x": 5.298925428386942, - "y": 7.303672558707409, - "heading": -2.8804548458325563, - "angularVelocity": -0.3146096509659767, - "velocityX": 4.071386542262457, - "velocityY": 0.6706742031848971, - "timestamp": 1.2467032844359547 - }, - { - "x": 5.654193668021497, - "y": 7.340978019061845, - "heading": -2.91016580268315, - "angularVelocity": -0.3336426566779271, - "velocityX": 3.9895261502692283, - "velocityY": 0.41892601991372086, - "timestamp": 1.3357535190385228 - }, - { - "x": 5.98356504904068, - "y": 7.374016419687497, - "heading": -2.9379024670232585, - "angularVelocity": -0.3114721085676808, - "velocityX": 3.6987143547590864, - "velocityY": 0.37100857480165716, - "timestamp": 1.424803753641091 - }, - { - "x": 6.287039535369109, - "y": 7.402787834546961, - "heading": -2.9636656250656035, - "angularVelocity": -0.28931038932492203, - "velocityX": 3.4079021541362304, - "velocityY": 0.3230919602612063, - "timestamp": 1.513853988243659 - }, - { - "x": 6.564617124869861, - "y": 7.427292232732608, - "heading": -2.9874553284002965, - "angularVelocity": -0.26714924941935103, - "velocityX": 3.1170899295165584, - "velocityY": 0.2751749986399128, - "timestamp": 1.6029042228462271 - }, - { - "x": 6.816297824187459, - "y": 7.447529562819999, - "heading": -3.0092710593771144, - "angularVelocity": -0.24498229650019018, - "velocityX": 2.826277779512324, - "velocityY": 0.22725745954191853, - "timestamp": 1.6919544574487952 - }, - { - "x": 7.04208164327297, - "y": 7.4634997697510155, - "heading": -3.02911189018705, - "angularVelocity": -0.2228049246415303, - "velocityX": 2.5354657412547588, - "velocityY": 0.17933930216233074, - "timestamp": 1.7810046920513634 - }, - { - "x": 7.241968593239377, - "y": 7.475202800425809, - "heading": -3.046976628874181, - "angularVelocity": -0.20061416757475567, - "velocityX": 2.244653827791738, - "velocityY": 0.13142054849179688, - "timestamp": 1.8700549266539315 - }, - { - "x": 7.415958685210493, - "y": 7.482638606042888, - "heading": -3.062863950895082, - "angularVelocity": -0.17840853639303908, - "velocityX": 1.9538420392448632, - "velocityY": 0.08350124679924598, - "timestamp": 1.9591051612564996 - }, - { - "x": 7.56405192957815, - "y": 7.485807143207224, - "heading": -3.076772515723161, - "angularVelocity": -0.15618785161154392, - "velocityX": 1.6630303673942974, - "velocityY": 0.03558145779712713, - "timestamp": 2.0481553958590677 - }, - { - "x": 7.686248335471436, - "y": 7.484708374487247, - "heading": -3.0887010683171225, - "angularVelocity": -0.13395307319737726, - "velocityX": 1.372218798059888, - "velocityY": -0.012338751547152475, - "timestamp": 2.137205630461636 - }, - { - "x": 7.782547910358369, - "y": 7.479342268698847, - "heading": -3.098648525443845, - "angularVelocity": -0.11170613049048228, - "velocityX": 1.0814073125884323, - "velocityY": -0.06025931107703978, - "timestamp": 2.2262558650642044 - }, - { - "x": 7.852950659742851, - "y": 7.469708801046972, - "heading": -3.1066140469464796, - "angularVelocity": -0.08944975314421699, - "velocityX": 0.7905958889237127, - "velocityY": -0.10818014904588184, - "timestamp": 2.3153060996667727 - }, - { - "x": 7.897456586937546, - "y": 7.455807953193105, - "heading": -3.112597092103137, - "angularVelocity": -0.06718730369841065, - "velocityX": 0.49978450245892037, - "velocityY": -0.15610119294919206, - "timestamp": 2.404356334269341 + "x": 2.6056377595645173, + "y": 6.860019235347418, + "heading": -2.67166131940215, + "angularVelocity": -0.02262687664626412, + "velocityX": 0.2908134089016077, + "velocityY": 0.047903461211106606, + "timestamp": 0.08905021591596585 + }, + { + "x": 2.657431745912738, + "y": 6.868550871260021, + "heading": -2.675691408253123, + "angularVelocity": -0.04525636248626211, + "velocityX": 0.5816267351569059, + "velocityY": 0.09580702107060358, + "timestamp": 0.1781004318319317 + }, + { + "x": 2.7351227161637226, + "y": 6.881348344974158, + "heading": -2.681736130145307, + "angularVelocity": -0.06787992404070672, + "velocityX": 0.8724399986216745, + "velocityY": 0.14371075446030462, + "timestamp": 0.26715064774789754 + }, + { + "x": 2.838710666374723, + "y": 6.8984116787203495, + "heading": -2.689794230536387, + "angularVelocity": -0.09048939756287813, + "velocityX": 1.1632532178108679, + "velocityY": 0.1916147374902733, + "timestamp": 0.3562008636638634 + }, + { + "x": 2.9681955940786513, + "y": 6.919740901627221, + "heading": -2.699863774776327, + "angularVelocity": -0.11307714570217953, + "velocityX": 1.4540664092956235, + "velocityY": 0.23951904762364568, + "timestamp": 0.44525107957982923 + }, + { + "x": 3.123577498057011, + "y": 6.945336049839059, + "heading": -2.711942209420258, + "angularVelocity": -0.13563621962836306, + "velocityX": 1.7448795870971157, + "velocityY": 0.28742376364356087, + "timestamp": 0.5343012954957951 + }, + { + "x": 3.304856378058939, + "y": 6.975197166608854, + "heading": -2.726026438521239, + "angularVelocity": -0.1581605272498332, + "velocityX": 2.03569276208152, + "velocityY": 0.33532896537807844, + "timestamp": 0.6233515114117609 + }, + { + "x": 3.5120322344672066, + "y": 7.009324302331978, + "heading": -2.7421129154703023, + "angularVelocity": -0.18064500780373027, + "velocityX": 2.3265059413642897, + "velocityY": 0.38323473303342476, + "timestamp": 0.7124017273277268 + }, + { + "x": 3.7451050679134177, + "y": 7.0477175144586885, + "heading": -2.76019775093863, + "angularVelocity": -0.20308581267668144, + "velocityX": 2.6173191277397354, + "velocityY": 0.4311411458332731, + "timestamp": 0.8014519432436926 + }, + { + "x": 4.00407487884772, + "y": 7.090376867161408, + "heading": -2.7802768374227536, + "angularVelocity": -0.22548049185048172, + "velocityX": 2.908132319170181, + "velocityY": 0.4790482792649808, + "timestamp": 0.8905021591596585 + }, + { + "x": 4.288941667076001, + "y": 7.137302430464445, + "heading": -2.8023459907991892, + "angularVelocity": -0.24782818491155156, + "velocityX": 3.198945508420786, + "velocityY": 0.5269561990430291, + "timestamp": 0.9795523750756243 + }, + { + "x": 4.599705431301729, + "y": 7.18849427798667, + "heading": -2.826401109181455, + "angularVelocity": -0.2701298153500949, + "velocityX": 3.489758683111868, + "velocityY": 0.5748649455329105, + "timestamp": 1.0686025909915902 + }, + { + "x": 4.936366168815881, + "y": 7.243952479945757, + "heading": -2.852438349388676, + "angularVelocity": -0.29238828833150965, + "velocityX": 3.780571827381631, + "velocityY": 0.6227744805405371, + "timestamp": 1.157652806907556 + }, + { + "x": 5.29892387632096, + "y": 7.303677068067654, + "heading": -2.8804543230674837, + "angularVelocity": -0.31460871139544083, + "velocityX": 4.071384934621773, + "velocityY": 0.6706843718184372, + "timestamp": 1.2467030228235219 + }, + { + "x": 5.654192271473913, + "y": 7.340981844659183, + "heading": -2.910165358807353, + "angularVelocity": -0.3336436125871517, + "velocityX": 3.989528733857416, + "velocityY": 0.4189184294256161, + "timestamp": 1.3357532387394877 + }, + { + "x": 5.983563762603575, + "y": 7.374019749618405, + "heading": -2.937902079473165, + "angularVelocity": -0.3114728064442547, + "velocityX": 3.6987163674087062, + "velocityY": 0.3710030865101999, + "timestamp": 1.4248034546554535 + }, + { + "x": 6.2870383431109875, + "y": 7.4027907556301225, + "heading": -2.963665283121415, + "angularVelocity": -0.2893109621717427, + "velocityX": 3.407903926856203, + "velocityY": 0.32308743685547753, + "timestamp": 1.5138536705714194 + }, + { + "x": 6.564616020686646, + "y": 7.427294798001087, + "heading": -2.987455025630518, + "angularVelocity": -0.26714974539255987, + "velocityX": 3.117091572665025, + "velocityY": 0.27517106072025793, + "timestamp": 1.6029038864873852 + }, + { + "x": 6.816296806889978, + "y": 7.447531808401904, + "heading": -3.0092707916128694, + "angularVelocity": -0.24498274100692155, + "velocityX": 2.826279348281832, + "velocityY": 0.22725391727196229, + "timestamp": 1.691954102403351 + }, + { + "x": 7.042080714621744, + "y": 7.463501721624949, + "heading": -3.029111654665684, + "angularVelocity": -0.2228053334709305, + "velocityX": 2.535467268769251, + "velocityY": 0.17933604156686803, + "timestamp": 1.781004318319317 + }, + { + "x": 7.241967756961874, + "y": 7.475204477800177, + "heading": -3.046976423792443, + "angularVelocity": -0.20061455149774496, + "velocityX": 2.2446553361393184, + "velocityY": 0.1314174935440077, + "timestamp": 1.8700545342352828 + }, + { + "x": 7.415957946439473, + "y": 7.482640023287821, + "heading": -3.0628637751453267, + "angularVelocity": -0.17840890321789282, + "velocityX": 1.9538435442064368, + "velocityY": 0.08349834316698324, + "timestamp": 1.9591047501512486 + }, + { + "x": 7.564051294500569, + "y": 7.4858083110625495, + "heading": -3.0767723687242916, + "angularVelocity": -0.1561882072480332, + "velocityX": 1.6630318808080886, + "velocityY": 0.03557866471337611, + "timestamp": 2.0481549660672145 + }, + { + "x": 7.686247811094335, + "y": 7.4847093008681505, + "heading": -3.0887009498997005, + "angularVelocity": -0.13395342226531132, + "velocityX": 1.3722203291351878, + "velocityY": -0.012341465802140981, + "timestamp": 2.1372051819831803 + }, + { + "x": 7.78254750434497, + "y": 7.479342959260061, + "heading": -3.0986484357684994, + "angularVelocity": -0.11170647669384857, + "velocityX": 1.0814088686939272, + "velocityY": -0.06026197188730624, + "timestamp": 2.226255397899146 + }, + { + "x": 7.852950380293331, + "y": 7.469709259593279, + "heading": -3.1066139864439575, + "angularVelocity": -0.08945009951436005, + "velocityX": 0.7905974760891972, + "velocityY": -0.1081827771857946, + "timestamp": 2.315305613815112 + }, + { + "x": 7.897456442699593, + "y": 7.455808181987322, + "heading": -3.1125970614290615, + "angularVelocity": -0.06718765275931286, + "velocityX": 0.4997861257098042, + "velocityY": -0.15610380573444393, + "timestamp": 2.404355829731078 }, { "x": 7.916065692901611, "y": 7.4376397132873535, "heading": -3.116597461241803, - "angularVelocity": -0.0449226120124177, - "velocityX": 0.20897312676510937, - "velocityY": -0.2040223699222923, - "timestamp": 2.4934065688719094 - }, - { - "x": 7.9070122603589, - "y": 7.413826617664512, - "heading": -3.11861194216317, - "angularVelocity": -0.021520720211200346, - "velocityX": -0.09671791211130092, - "velocityY": -0.2543955432022431, - "timestamp": 2.5870131443766944 - }, - { - "x": 7.869344140213553, - "y": 7.385298267689194, - "heading": -3.1184352062412737, - "angularVelocity": 0.001888071654618472, - "velocityX": -0.4024089113635186, - "velocityY": -0.30476865349977356, - "timestamp": 2.6806197198814794 - }, - { - "x": 7.803061333004561, - "y": 7.352054678768873, - "heading": -3.1160670574506257, - "angularVelocity": 0.02529895766272299, - "velocityX": -0.7080999048576825, - "velocityY": -0.35514159919910054, - "timestamp": 2.7742262953862644 - }, - { - "x": 7.70816383608335, - "y": 7.314095876394929, - "heading": -3.111507734132627, - "angularVelocity": 0.048707297467210565, - "velocityX": -1.0137909266465996, - "velocityY": -0.4055142725737741, - "timestamp": 2.8678328708910494 - }, - { - "x": 7.584651643628721, - "y": 7.27142189709441, - "heading": -3.1047578739730084, - "angularVelocity": 0.07210882486854506, - "velocityX": -1.3194820106234444, - "velocityY": -0.455886555729595, - "timestamp": 2.9614394463958345 - }, - { - "x": 7.432524746664207, - "y": 7.224032790103509, - "heading": -3.0958184592506823, - "angularVelocity": 0.09549985857424112, - "velocityX": -1.6251731904959823, - "velocityY": -0.5062583128946773, - "timestamp": 3.0550460219006195 - }, - { - "x": 7.251783133001236, - "y": 7.171928620622399, - "heading": -3.0846907420606215, - "angularVelocity": 0.1188775161365886, - "velocityX": -1.9308645005791376, - "velocityY": -0.5566293735256479, - "timestamp": 3.1486525974054045 - }, - { - "x": 7.042426786875021, - "y": 7.115109477241975, - "heading": -3.0713761490336036, - "angularVelocity": 0.14223993298780116, - "velocityX": -2.236555979077694, - "velocityY": -0.6069994877391849, - "timestamp": 3.2422591729101895 - }, - { - "x": 6.804455687334457, - "y": 7.053575493929542, - "heading": -3.055876164351336, - "angularVelocity": 0.1655864943107016, - "velocityX": -2.542247681397121, - "velocityY": -0.6573681707786417, - "timestamp": 3.3358657484149745 - }, - { - "x": 6.537869798801013, - "y": 6.987326959347451, - "heading": -3.038192183929703, - "angularVelocity": 0.1889181430499978, - "velocityX": -2.8479397638023447, - "velocityY": -0.707733770035256, - "timestamp": 3.4294723239197595 - }, - { - "x": 6.251721942644649, - "y": 6.9401796162992495, - "heading": -3.0163639344951743, - "angularVelocity": 0.23319141114624786, - "velocityX": -3.0569204632609908, - "velocityY": -0.5036755462311673, - "timestamp": 3.5230788994245446 - }, - { - "x": 5.994188767247977, - "y": 6.8977475214878226, - "heading": -2.9967176405118674, - "angularVelocity": 0.20988155882599013, - "velocityX": -2.7512295371120445, - "velocityY": -0.45330250126774246, - "timestamp": 3.6166854749293296 - }, - { - "x": 5.765270336012349, - "y": 6.860030391062932, - "heading": -2.9792531096003043, - "angularVelocity": 0.18657376169764953, - "velocityX": -2.445537933645764, - "velocityY": -0.4029324886793023, - "timestamp": 3.7102920504341146 - }, - { - "x": 5.564966675703843, - "y": 6.827028091962186, - "heading": -2.9639704856474203, - "angularVelocity": 0.16326442742372366, - "velocityX": -2.139846044237206, - "velocityY": -0.35256389759777007, - "timestamp": 3.8038986259388996 - }, - { - "x": 5.393277802457308, - "y": 6.798740535430808, - "heading": -2.950870120937211, - "angularVelocity": 0.13995132969627333, - "velocityX": -1.8341539824599005, - "velocityY": -0.3021962546843907, - "timestamp": 3.8975052014436846 - }, - { - "x": 5.25020372728784, - "y": 6.7751676557798355, - "heading": -2.9399524598545517, - "angularVelocity": 0.11663348460067259, - "velocityX": -1.5284618030082089, - "velocityY": -0.25182931352687526, - "timestamp": 3.9911117769484696 - }, - { - "x": 5.135744458132628, - "y": 6.756309403324118, - "heading": -2.9312179411027137, - "angularVelocity": 0.09331095283356157, - "velocityX": -1.222769538763453, - "velocityY": -0.2014629031563385, - "timestamp": 4.084718352453255 - }, - { - "x": 5.049900000853324, - "y": 6.7421657413579945, - "heading": -2.9246669194518846, - "angularVelocity": 0.06998463105291268, - "velocityX": -0.9170772118985947, - "velocityY": -0.15109688491276213, - "timestamp": 4.17832492795804 - }, - { - "x": 4.9926703598055795, - "y": 6.732736644639159, - "heading": -2.920299607236711, - "angularVelocity": 0.04665604089907658, - "velocityX": -0.611384838502273, - "velocityY": -0.10073113633298339, - "timestamp": 4.271931503462826 + "angularVelocity": -0.044922965897315335, + "velocityX": 0.20897479035401717, + "velocityY": -0.2040249820069297, + "timestamp": 2.4934060456470437 + }, + { + "x": 7.907012409900235, + "y": 7.413826367530878, + "heading": -3.118611975460086, + "angularVelocity": -0.021521073293795764, + "velocityX": -0.09671630274627309, + "velocityY": -0.25439818430889266, + "timestamp": 2.587012632585414 + }, + { + "x": 7.86934443098964, + "y": 7.385297761212543, + "heading": -3.1184352727405407, + "angularVelocity": 0.001887716722986529, + "velocityX": -0.40240735339912476, + "velocityY": -0.3047713547885194, + "timestamp": 2.680619219523784 + }, + { + "x": 7.803061757039115, + "y": 7.35205390609398, + "heading": -3.116067157372098, + "angularVelocity": 0.025298597522861684, + "velocityX": -0.7080983947653753, + "velocityY": -0.3551443996184828, + "timestamp": 2.7742258064621543 + }, + { + "x": 7.708164385824663, + "y": 7.314094822979375, + "heading": -3.1115078681064587, + "angularVelocity": 0.04870692773619732, + "velocityX": -1.013789459890593, + "velocityY": -0.4055172221971618, + "timestamp": 2.8678323934005245 + }, + { + "x": 7.58465231209105, + "y": 7.27142054214674, + "heading": -3.1047580431849022, + "angularVelocity": 0.07210843961227054, + "velocityX": -1.3194805811575352, + "velocityY": -0.45588972131559213, + "timestamp": 2.9614389803388947 + }, + { + "x": 7.432525527653926, + "y": 7.22403110408453, + "heading": -3.0958186656762385, + "angularVelocity": 0.09549944935552229, + "velocityX": -1.6251717898579308, + "velocityY": -0.5062617878954225, + "timestamp": 3.055045567277265 + }, + { + "x": 7.251784021512525, + "y": 7.171926560872903, + "heading": -3.084690988878398, + "angularVelocity": 0.11887707010583433, + "velocityX": -1.9308631160796352, + "velocityY": -0.5566332981025642, + "timestamp": 3.148652154215635 + }, + { + "x": 7.042427779881054, + "y": 7.115106979238847, + "heading": -3.0713764414563793, + "angularVelocity": 0.1422394284152768, + "velocityX": -2.2365545895750922, + "velocityY": -0.6070040954646013, + "timestamp": 3.2422587411540054 + }, + { + "x": 6.804456785765002, + "y": 7.053572449427596, + "heading": -3.0558765117150686, + "angularVelocity": 0.16558588715040146, + "velocityX": -2.5422462446230534, + "velocityY": -0.6573739287360777, + "timestamp": 3.3358653280923756 + }, + { + "x": 6.537871015451157, + "y": 6.9873231289516795, + "heading": -3.0381926080821193, + "angularVelocity": 0.18891729964038087, + "velocityX": -2.847938152999453, + "velocityY": -0.7077420792997633, + "timestamp": 3.4294719150307458 + }, + { + "x": 6.251722869935082, + "y": 6.940176766797846, + "heading": -3.016364253674107, + "angularVelocity": 0.2331925040957211, + "velocityX": -3.056923181105537, + "velocityY": -0.5036650058064269, + "timestamp": 3.523078501969116 + }, + { + "x": 5.994189477499942, + "y": 6.897745373710483, + "heading": -2.9967178827416228, + "angularVelocity": 0.20988235523872914, + "velocityX": -2.7512315196867543, + "velocityY": -0.45329494937470055, + "timestamp": 3.616685088907486 + }, + { + "x": 5.765270870867694, + "y": 6.860028793884023, + "heading": -2.9792532906117453, + "angularVelocity": 0.1865743929043863, + "velocityX": -2.4455395086989586, + "velocityY": -0.4029265574151002, + "timestamp": 3.7102916758458564 + }, + { + "x": 5.564967066578637, + "y": 6.82702693693722, + "heading": -2.9639706170320186, + "angularVelocity": 0.16326493764576847, + "velocityX": -2.1398473210110196, + "velocityY": -0.3525591309993538, + "timestamp": 3.8038982627842266 + }, + { + "x": 5.393278075654954, + "y": 6.798739735455754, + "heading": -2.9508702121951718, + "angularVelocity": 0.13995174127513232, + "velocityX": -1.8341550155730215, + "velocityY": -0.302192424771196, + "timestamp": 3.897504849722597 + }, + { + "x": 5.250203906044256, + "y": 6.775167136554944, + "heading": -2.93995251921741, + "angularVelocity": 0.11663381109013397, + "velocityX": -1.528462625230599, + "velocityY": -0.2518262835107166, + "timestamp": 3.991111436660967 + }, + { + "x": 5.135744563638823, + "y": 6.756309099085823, + "heading": -2.931217975945437, + "angularVelocity": 0.09331120338490016, + "velocityX": -1.2227701719409092, + "velocityY": -0.20146058184490315, + "timestamp": 4.084718023599337 + }, + { + "x": 5.049900052839723, + "y": 6.742165592440054, + "heading": -2.9246669365280717, + "angularVelocity": 0.06998481230470345, + "velocityX": -0.9170776716345898, + "velocityY": -0.15109520716830446, + "timestamp": 4.178324610537707 + }, + { + "x": 4.992670376907219, + "y": 6.732736595948361, + "heading": -2.920299612824834, + "angularVelocity": 0.04665615792735934, + "velocityX": -0.611385136498824, + "velocityY": -0.10073005330169253, + "timestamp": 4.271931197476078 }, { "x": 4.96405553817749, - "y": 6.72802209854126, + "y": 6.7280220985412615, "heading": -2.918116035624805, - "angularVelocity": 0.023327117781321904, - "velocityX": -0.3056924310475032, - "velocityY": -0.05036554400665612, - "timestamp": 4.365538078967611 + "angularVelocity": 0.023327174629992398, + "velocityX": -0.3056925764056323, + "velocityY": -0.050365017690535835, + "timestamp": 4.365537784414448 }, { "x": 4.96405553817749, "y": 6.72802209854126, "heading": -2.918116035624805, - "angularVelocity": -2.0830291131761767e-23, - "velocityX": 2.6212070093081157e-24, - "velocityY": -2.6876451865538873e-24, - "timestamp": 4.4591446544723965 - }, - { - "x": 4.986997583079801, - "y": 6.722441944983784, - "heading": -2.922362708096326, - "angularVelocity": -0.05025246479823011, - "velocityX": 0.2714818040675807, - "velocityY": -0.066032045583043, - "timestamp": 4.543651404311878 - }, - { - "x": 5.03288163642963, - "y": 6.71128171901416, - "heading": -2.930855942511296, - "angularVelocity": -0.10050362167640607, - "velocityX": 0.5429631767519619, - "velocityY": -0.1320631309430564, - "timestamp": 4.628158154151359 - }, - { - "x": 5.10170770842542, - "y": 6.6945415441964125, - "heading": -2.943591386818814, - "angularVelocity": -0.15070327910739376, - "velocityX": 0.8144446701183498, - "velocityY": -0.19809275412371863, - "timestamp": 4.712664903990841 - }, - { - "x": 5.193475855215092, - "y": 6.672221590667123, - "heading": -2.960560694021866, - "angularVelocity": -0.2008041633985957, - "velocityX": 1.085926827904073, - "velocityY": -0.26412036401454975, - "timestamp": 4.797171653830322 - }, - { - "x": 5.308186177471799, - "y": 6.644322080265296, - "heading": -2.9817518825127913, - "angularVelocity": -0.25076326484189676, - "velocityX": 1.357410176992917, - "velocityY": -0.3301453488013894, - "timestamp": 4.881678403669803 - }, - { - "x": 5.445838818125752, - "y": 6.610843292401228, - "heading": -3.0071498190197725, - "angularVelocity": -0.30054328861568913, - "velocityX": 1.6288952174284352, - "velocityY": -0.39616702722160885, - "timestamp": 4.966185153509285 - }, - { - "x": 5.606433959098464, - "y": 6.57178557034531, - "heading": -3.0367368331942495, - "angularVelocity": -0.35011421254132336, - "velocityX": 1.900382410609302, - "velocityY": -0.4621846435948283, - "timestamp": 5.050691903348766 - }, - { - "x": 5.789971816830474, - "y": 6.527149327506201, - "heading": -3.0704934720227905, - "angularVelocity": -0.39945494167815665, - "velocityX": 2.1718721650120956, - "velocityY": -0.5281973679486492, - "timestamp": 5.135198653188247 - }, - { - "x": 5.996452636226433, - "y": 6.4769350530448095, - "heading": -3.1083994003520443, - "angularVelocity": -0.4485550373343583, - "velocityX": 2.4433648174632614, - "velocityY": -0.594204303878351, - "timestamp": 5.219705403027729 - }, - { - "x": 6.225876681885466, - "y": 6.4211433153733735, - "heading": -3.1504344509882194, - "angularVelocity": -0.49741648703824837, - "velocityX": 2.714860601014919, - "velocityY": -0.6602045135733137, - "timestamp": 5.30421215286721 - }, - { - "x": 6.478244219380954, - "y": 6.359774756070596, - "heading": -3.196579824919509, - "angularVelocity": -0.5460554809993506, - "velocityX": 2.986359527195811, - "velocityY": -0.7261971312273402, - "timestamp": 5.3887189027066915 - }, - { - "x": 6.717226111669154, - "y": 6.290548853732578, - "heading": -3.2412304050575518, - "angularVelocity": -0.5283670265730883, - "velocityX": 2.827962177484511, - "velocityY": -0.8191760122062468, - "timestamp": 5.473225652546173 - }, - { - "x": 6.9332640071159375, - "y": 6.226898382507029, - "heading": -3.2817950563873817, - "angularVelocity": -0.48001670170585536, - "velocityX": 2.556457275390921, - "velocityY": -0.7531998490824867, - "timestamp": 5.557732402385654 - }, - { - "x": 7.126357713200994, - "y": 6.168822797384324, - "heading": -3.3182799458605974, - "angularVelocity": -0.4317393526850495, - "velocityX": 2.2849500951324253, - "velocityY": -0.6872301352615873, - "timestamp": 5.642239152225136 - }, - { - "x": 7.296507081212939, - "y": 6.11632159040044, - "heading": -3.3506880436311652, - "angularVelocity": -0.38349715060780704, - "velocityX": 2.01344115511647, - "velocityY": -0.6212664323691197, - "timestamp": 5.726745902064617 - }, - { - "x": 7.443711995436663, - "y": 6.069394309199431, - "heading": -3.3790200360258207, - "angularVelocity": -0.335263070091698, - "velocityX": 1.7419308458003326, - "velocityY": -0.5553080823738457, - "timestamp": 5.811252651904098 - }, - { - "x": 7.567972366619772, - "y": 6.028040562856848, - "heading": -3.403275131384317, - "angularVelocity": -0.28701962156358174, - "velocityX": 1.4704194803271609, - "velocityY": -0.4893543583339052, - "timestamp": 5.89575940174358 - }, - { - "x": 7.669288126709092, - "y": 5.99226002475378, - "heading": -3.4234517524693158, - "angularVelocity": -0.23875750899571357, - "velocityX": 1.19890730955535, - "velocityY": -0.4234044992977654, - "timestamp": 5.980266151583061 - }, - { - "x": 7.747659224496879, - "y": 5.962052434133843, - "heading": -3.4395481122242697, - "angularVelocity": -0.19047424951886965, - "velocityX": 0.9273945328231248, - "velocityY": -0.35745772588955055, - "timestamp": 6.064772901422542 - }, - { - "x": 7.803085622131263, - "y": 5.937417596916517, - "heading": -3.451562671479707, - "angularVelocity": -0.14217277647357823, - "velocityX": 0.6558813081755649, - "velocityY": -0.2915132491087263, - "timestamp": 6.149279651262024 - }, - { - "x": 7.8355672925031605, - "y": 5.918355386069609, - "heading": -3.4594944783408175, - "angularVelocity": -0.09386003930072535, - "velocityX": 0.3843677627360551, - "velocityY": -0.22557027554740033, - "timestamp": 6.233786401101505 + "angularVelocity": 3.6338397195938546e-22, + "velocityX": -9.963230040673339e-21, + "velocityY": 1.3095690489139607e-20, + "timestamp": 4.459144371352818 + }, + { + "x": 4.986997583245362, + "y": 6.722441950535387, + "heading": -2.922362707394502, + "angularVelocity": -0.05025245955837001, + "velocityX": 0.27148182258542464, + "velocityY": -0.0660319839163844, + "timestamp": 4.543651116037918 + }, + { + "x": 5.032881637159744, + "y": 6.711281735897458, + "heading": -2.930855940399974, + "angularVelocity": -0.10050361112738114, + "velocityX": 0.5429632165499002, + "velocityY": -0.1320630049058865, + "timestamp": 4.628157860723017 + }, + { + "x": 5.101707710404414, + "y": 6.694541578470798, + "heading": -2.9435913825821065, + "angularVelocity": -0.15070326314886817, + "velocityX": 0.8144447345728314, + "velocityY": -0.19809256041088907, + "timestamp": 4.712664605408117 + }, + { + "x": 5.193475859483997, + "y": 6.672221648741145, + "heading": -2.960560686931331, + "angularVelocity": -0.20080414187598672, + "velocityX": 1.085926921236194, + "velocityY": -0.26412009849420676, + "timestamp": 4.797171350093216 + }, + { + "x": 5.308186185530338, + "y": 6.644322168996456, + "heading": -2.981751871819718, + "angularVelocity": -0.2507632375066888, + "velocityX": 1.3574103046306019, + "velocityY": -0.33014500616077025, + "timestamp": 4.881678094778316 + }, + { + "x": 5.445838832085338, + "y": 6.610843419245657, + "heading": -3.007149803941405, + "angularVelocity": -0.30054325505412216, + "velocityX": 1.6288953866101499, + "velocityY": -0.39616660037671664, + "timestamp": 4.966184839463415 + }, + { + "x": 5.606433981927045, + "y": 6.571785743597236, + "heading": -3.0367368128883587, + "angularVelocity": -0.3501141720368616, + "velocityX": 1.900382631470881, + "velocityY": -0.4621841226278734, + "timestamp": 5.050691584148515 + }, + { + "x": 5.7899718527810915, + "y": 6.5271495567170055, + "heading": -3.070493445537436, + "angularVelocity": -0.3994548929184966, + "velocityX": 2.1718724527606685, + "velocityY": -0.5281967379829884, + "timestamp": 5.1351983288336145 + }, + { + "x": 5.9964526916944845, + "y": 6.4769353498610895, + "heading": -3.1083993665141816, + "angularVelocity": -0.44855497768841657, + "velocityX": 2.4433651974503454, + "velocityY": -0.5942035401201552, + "timestamp": 5.219705073518714 + }, + { + "x": 6.225876767552239, + "y": 6.421143695632008, + "heading": -3.1504344081002755, + "angularVelocity": -0.4974164102845375, + "velocityX": 2.7148611239572196, + "velocityY": -0.6602035664369802, + "timestamp": 5.304211818203814 + }, + { + "x": 6.478244358788941, + "y": 6.3597752481787015, + "heading": -3.1965797694640314, + "angularVelocity": -0.5460553655889756, + "velocityX": 2.9863603452849636, + "velocityY": -0.7261958519640731, + "timestamp": 5.388718562888913 + }, + { + "x": 6.717226250105241, + "y": 6.290549248101248, + "heading": -3.2412303594046183, + "angularVelocity": -0.5283671747973506, + "velocityX": 2.8279623384716492, + "velocityY": -0.8191772187582416, + "timestamp": 5.473225307574013 + }, + { + "x": 6.933264135550156, + "y": 6.226898710086972, + "heading": -3.2817950179595727, + "angularVelocity": -0.48001681648147876, + "velocityX": 2.55645731296296, + "velocityY": -0.7532006853590326, + "timestamp": 5.557732052259112 + }, + { + "x": 7.126357828217531, + "y": 6.168823072058602, + "heading": -3.3182799133581264, + "angularVelocity": -0.4317394491351963, + "velocityX": 2.2849500757236236, + "velocityY": -0.687230803230894, + "timestamp": 5.642238796944212 + }, + { + "x": 7.296507181265965, + "y": 6.11632182036056, + "heading": -3.350688016235842, + "angularVelocity": -0.3834972344335215, + "velocityX": 2.0134411008549487, + "velocityY": -0.6212669993818719, + "timestamp": 5.726745541629311 + }, + { + "x": 7.443712079914637, + "y": 6.069394499789823, + "heading": -3.379020013186295, + "angularVelocity": -0.3352631444511035, + "velocityX": 1.7419307677417626, + "velocityY": -0.555308582120924, + "timestamp": 5.811252286314411 + }, + { + "x": 7.567972435471327, + "y": 6.02804071771291, + "heading": -3.4032751127228216, + "angularVelocity": -0.28701968851017895, + "velocityX": 1.4704193851002774, + "velocityY": -0.4893548110391755, + "timestamp": 5.8957590309995105 + }, + { + "x": 7.669288180256081, + "y": 5.992260146371071, + "heading": -3.42345173773138, + "angularVelocity": -0.23875756998738332, + "velocityX": 1.1989072015765272, + "velocityY": -0.4234049184496486, + "timestamp": 5.98026577568461 + }, + { + "x": 7.747659263327591, + "y": 5.962052524193432, + "heading": -3.43954810124812, + "angularVelocity": -0.19047430565122664, + "velocityX": 0.9273944152451641, + "velocityY": -0.35745812112634723, + "timestamp": 6.06477252036971 + }, + { + "x": 7.803085647033718, + "y": 5.937417656488415, + "heading": -3.4515626641762043, + "angularVelocity": -0.14217282860503722, + "velocityX": 0.6558811833619133, + "velocityY": -0.2915136276614969, + "timestamp": 6.149279265054809 + }, + { + "x": 7.835567304420652, + "y": 5.918355415748436, + "heading": -3.4594944746796688, + "angularVelocity": -0.09386008812694666, + "velocityX": 0.3843676325241542, + "velocityY": -0.22557064304169885, + "timestamp": 6.233786009739909 }, { "x": 7.845104217529297, "y": 5.904865741729736, "heading": -3.463343389598174, - "angularVelocity": -0.045545607477119734, - "velocityX": 0.11285400331040635, - "velocityY": -0.15962801037190835, - "timestamp": 6.3182931509409865 - }, - { - "x": 7.8291877801389544, - "y": 5.89681783094167, - "heading": -3.4628064836752768, - "angularVelocity": 0.005958713094771777, - "velocityX": -0.17664451043527943, - "velocityY": -0.08931767997576301, - "timestamp": 6.408397492995672 - }, - { - "x": 7.787186304810707, - "y": 5.895105277075071, - "heading": -3.457628506155186, - "angularVelocity": 0.057466459462613945, - "velocityX": -0.46614263386726634, - "velocityY": -0.019006341176760165, - "timestamp": 6.498501835050357 - }, - { - "x": 7.719099838437265, - "y": 5.899728258305112, - "heading": -3.447810162739233, - "angularVelocity": 0.10896637378467465, - "velocityX": -0.7556402368724836, - "velocityY": 0.05130697505382519, - "timestamp": 6.588606177105042 - }, - { - "x": 7.624928441800051, - "y": 5.91068704023302, - "heading": -3.4333528605757375, - "angularVelocity": 0.1604506712309276, - "velocityX": -1.0451371653106436, - "velocityY": 0.12162323899170813, - "timestamp": 6.678710519159727 - }, - { - "x": 7.5046721930394265, - "y": 5.927981975640617, - "heading": -3.414258222079659, - "angularVelocity": 0.21191696271962407, - "velocityX": -1.33463322652798, - "velocityY": 0.19194341818843927, - "timestamp": 6.768814861214413 - }, - { - "x": 7.358331192400225, - "y": 5.951613503654499, - "heading": -3.390527425061893, - "angularVelocity": 0.2633701825752592, - "velocityX": -1.624128175203652, - "velocityY": 0.2622684709194017, - "timestamp": 6.858919203269098 - }, - { - "x": 7.185905568247333, - "y": 5.981582148055597, - "heading": -3.362160369786068, - "angularVelocity": 0.3148245093295144, - "velocityX": -1.9136216992544741, - "velocityY": 0.3325993366991085, - "timestamp": 6.949023545323783 - }, - { - "x": 6.987395484481389, - "y": 6.017888514545585, - "heading": -3.329154675551666, - "angularVelocity": 0.36630525767970984, - "velocityX": -2.203113404295966, - "velocityY": 0.40293692470396786, - "timestamp": 7.039127887378468 - }, - { - "x": 6.762801150184142, - "y": 6.060533287389062, - "heading": -3.2915045124971307, - "angularVelocity": 0.41785070725765294, - "velocityX": -2.492602788897109, - "velocityY": 0.4732821068444771, - "timestamp": 7.129232229433153 - }, - { - "x": 6.512122838133032, - "y": 6.109517231240644, - "heading": -3.249199278174355, - "angularVelocity": 0.46951382539479003, - "velocityX": -2.782089146147601, - "velocityY": 0.5436357753087322, - "timestamp": 7.219336571487839 - }, - { - "x": 6.25129761637582, - "y": 6.172940412685561, - "heading": -3.2015674065543736, - "angularVelocity": 0.5286301473803918, - "velocityX": -2.894702028886867, - "velocityY": 0.7038859615269768, - "timestamp": 7.309440913542524 - }, - { - "x": 6.016555766986995, - "y": 6.230022996704365, - "heading": -3.158627751039872, - "angularVelocity": 0.47655478676534, - "velocityX": -2.605222390352269, - "velocityY": 0.6335164623271993, - "timestamp": 7.399545255597209 - }, - { - "x": 5.807896998539899, - "y": 6.280764356863859, - "heading": -3.1204019441225426, - "angularVelocity": 0.4242393434728108, - "velocityX": -2.3157459861419394, - "velocityY": 0.5631400108187857, - "timestamp": 7.489649597651894 - }, - { - "x": 5.625321043377808, - "y": 6.325163981104701, - "heading": -3.086911147615034, - "angularVelocity": 0.3716890412138256, - "velocityX": -2.026272552451302, - "velocityY": 0.4927578763506812, - "timestamp": 7.579753939706579 - }, - { - "x": 5.468827670291274, - "y": 6.363221451462664, - "heading": -3.058174826591968, - "angularVelocity": 0.31892271080150636, - "velocityX": -1.7368016847795997, - "velocityY": 0.4223711032134899, - "timestamp": 7.669858281761265 - }, - { - "x": 5.3384166918215215, - "y": 6.394936434094527, - "heading": -3.0342097293079573, - "angularVelocity": 0.265970504168003, - "velocityX": -1.4473328975711837, - "velocityY": 0.3519806250026743, - "timestamp": 7.75996262381595 - }, - { - "x": 5.234087969458135, - "y": 6.420308671366275, - "heading": -3.015029066317057, - "angularVelocity": 0.21287168357835284, - "velocityX": -1.1578656475852087, - "velocityY": 0.28158728750661927, - "timestamp": 7.850066965870635 - }, - { - "x": 5.155841417331177, - "y": 6.439337975209735, - "heading": -3.0006418789192395, - "angularVelocity": 0.15967252043287483, - "velocityX": -0.868399350604752, - "velocityY": 0.2111918627840607, - "timestamp": 7.94017130792532 - }, - { - "x": 5.103677004654206, - "y": 6.452024221800112, - "heading": -2.9910525860956274, - "angularVelocity": 0.10642431435537862, - "velocityX": -0.5789333952997849, - "velocityY": 0.14079506382364523, - "timestamp": 8.030275649980005 + "angularVelocity": -0.04554565357886152, + "velocityX": 0.11285386916963824, + "velocityY": -0.15962837130890287, + "timestamp": 6.318292754425008 + }, + { + "x": 7.8291877692828695, + "y": 5.896817799174314, + "heading": -3.462806487691953, + "angularVelocity": 0.0059586689373453934, + "velocityX": -0.1766446433882992, + "velocityY": -0.08931803884268785, + "timestamp": 6.408397090119129 + }, + { + "x": 7.787186284773775, + "y": 5.89510521302273, + "heading": -3.457628514345887, + "angularVelocity": 0.05746641719488619, + "velocityX": -0.46614276866407134, + "velocityY": -0.019006700825120525, + "timestamp": 6.49850142581325 + }, + { + "x": 7.719099810553242, + "y": 5.899728161129094, + "heading": -3.4478101752719477, + "angularVelocity": 0.10896633328799875, + "velocityX": -0.7556403773029171, + "velocityY": 0.05130661106095279, + "timestamp": 6.58860576150737 + }, + { + "x": 7.624928406963597, + "y": 5.91068690868204, + "heading": -3.4333528776383364, + "angularVelocity": 0.1604506322835518, + "velocityX": -1.0451373162478272, + "velocityY": 0.12162286607548435, + "timestamp": 6.678710097201491 + }, + { + "x": 7.504672151559691, + "y": 5.927981807913597, + "heading": -3.414258243895334, + "angularVelocity": 0.21191692492827224, + "velocityX": -1.3346333944699587, + "velocityY": 0.191943030247383, + "timestamp": 6.768814432895612 + }, + { + "x": 7.3583311437665895, + "y": 5.951613297181171, + "heading": -3.3905274519162645, + "angularVelocity": 0.26337014524616154, + "velocityX": -1.624128369248404, + "velocityY": 0.2622680594172169, + "timestamp": 6.858918768589732 + }, + { + "x": 7.185905510719418, + "y": 5.981581899112768, + "heading": -3.362160402078623, + "angularVelocity": 0.3148244711990307, + "velocityX": -1.9136219330500257, + "velocityY": 0.3325988888407347, + "timestamp": 6.949023104283853 + }, + { + "x": 6.987395414269062, + "y": 6.017888217489993, + "heading": -3.329154713906164, + "angularVelocity": 0.36630521626067764, + "velocityX": -2.20311370059087, + "velocityY": 0.4029364191804939, + "timestamp": 7.039127439977974 + }, + { + "x": 6.762801059397413, + "y": 6.060532932740197, + "heading": -3.2915045580545983, + "angularVelocity": 0.41785065681387246, + "velocityX": -2.4926031931924566, + "velocityY": 0.47328150106972355, + "timestamp": 7.129231775672094 + }, + { + "x": 6.512122706581224, + "y": 6.109516798013917, + "heading": -3.2491993338195644, + "angularVelocity": 0.4695137465820559, + "velocityX": -2.7820897949591883, + "velocityY": 0.543634941608216, + "timestamp": 7.219336111366215 + }, + { + "x": 6.25129749629379, + "y": 6.172940093448783, + "heading": -3.201567448489117, + "angularVelocity": 0.5286303368590953, + "velocityX": -2.8947021059326685, + "velocityY": 0.7038872763034365, + "timestamp": 7.309440447060336 + }, + { + "x": 6.016555665157353, + "y": 6.230022757637012, + "heading": -3.1586277825948064, + "angularVelocity": 0.47655493560353174, + "velocityX": -2.6052223716883294, + "velocityY": 0.6335173967877574, + "timestamp": 7.3995447827544565 + }, + { + "x": 5.807896916135595, + "y": 6.280764180000153, + "heading": -3.120401967413272, + "angularVelocity": 0.4242394651385117, + "velocityX": -2.3157459340258364, + "velocityY": 0.5631407409227794, + "timestamp": 7.489649118448577 + }, + { + "x": 5.6253209797030115, + "y": 6.3251638537635975, + "heading": -3.0869111642773346, + "angularVelocity": 0.37168914101569395, + "velocityX": -2.0262724876234564, + "velocityY": 0.4927584607489893, + "timestamp": 7.579753454142698 + }, + { + "x": 5.46882762371635, + "y": 6.363221363605436, + "heading": -3.0581748379825484, + "angularVelocity": 0.31892279182145133, + "velocityX": -1.7368016176037657, + "velocityY": 0.42237157123085867, + "timestamp": 7.6698577898368185 + }, + { + "x": 5.3384166601569225, + "y": 6.394936377267829, + "heading": -3.0342097365921425, + "angularVelocity": 0.26597056851693435, + "velocityX": -1.447332834261574, + "velocityY": 0.35198099423379936, + "timestamp": 7.759962125530939 + }, + { + "x": 5.234087950141294, + "y": 6.420308638173686, + "heading": -3.0150290705159977, + "angularVelocity": 0.21287173284599614, + "velocityX": -1.1578655922817724, + "velocityY": 0.28158756968132703, + "timestamp": 7.85006646122506 + }, + { + "x": 5.155841407533289, + "y": 6.4393379590097926, + "heading": -3.000641880938431, + "angularVelocity": 0.15967255589572538, + "velocityX": -0.8683993062623739, + "velocityY": 0.21119206628086706, + "timestamp": 7.940170796919181 + }, + { + "x": 5.103677001346942, + "y": 6.452024216517568, + "heading": -2.9910525867433884, + "angularVelocity": 0.10642433708846369, + "velocityX": -0.5789333641327775, + "velocityY": 0.14079519492648973, + "timestamp": 8.030275132613301 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 0.053181525635302096, - "velocityX": -0.289467155293118, - "velocityY": 0.07039756101124235, - "timestamp": 8.12037999203469 + "angularVelocity": 0.05318153657845512, + "velocityX": -0.289467139022103, + "velocityY": 0.07039762460765545, + "timestamp": 8.120379468307421 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 6.81746033497351e-25, - "velocityX": -7.666580770428612e-26, - "velocityY": 6.421082950062295e-25, - "timestamp": 8.210484334089376 - }, - { - "x": 5.080107751173253, - "y": 6.458664255646832, - "heading": -2.986987410743646, - "angularVelocity": -0.02623921538488642, - "velocityX": 0.09073619501676995, - "velocityY": 0.010720397580949911, - "timestamp": 8.23817994213984 - }, - { - "x": 5.085138525244606, - "y": 6.459212635742286, - "heading": -2.9884477760132566, - "angularVelocity": -0.052729128277294895, - "velocityX": 0.18164519306403581, - "velocityY": 0.01980025477160606, - "timestamp": 8.265875550190305 - }, - { - "x": 5.092691297903225, - "y": 6.4599637486298365, - "heading": -2.9906490360498172, - "angularVelocity": -0.07948047331365586, - "velocityX": 0.27270651161935916, - "velocityY": 0.02712028875412729, - "timestamp": 8.29357115824077 - }, - { - "x": 5.1027695509630275, - "y": 6.46086523800989, - "heading": -2.99359872097621, - "angularVelocity": -0.10650370705051675, - "velocityX": 0.36389354736097906, - "velocityY": 0.032549903884080994, - "timestamp": 8.321266766291235 - }, - { - "x": 5.115375820999888, - "y": 6.46186078752559, - "heading": -2.9973046369071197, - "angularVelocity": -0.133808794670882, - "velocityX": 0.4551721707604345, - "velocityY": 0.035946115134430356, - "timestamp": 8.3489623743417 - }, - { - "x": 5.130511443380374, - "y": 6.462889747097652, - "heading": -3.0017748444548444, - "angularVelocity": -0.1614049252711666, - "velocityX": 0.5464990099840698, - "velocityY": 0.03715244562195929, - "timestamp": 8.376657982392164 - }, - { - "x": 5.148176238439689, - "y": 6.4638867292256625, - "heading": -3.0070176268610034, - "angularVelocity": -0.18930013728551406, - "velocityX": 0.6378193620854306, - "velocityY": 0.03599784219196293, - "timestamp": 8.404353590442629 - }, - { - "x": 5.1683681275776605, - "y": 6.464781177655068, - "heading": -3.0130414446609124, - "angularVelocity": -0.21750083222338853, - "velocityX": 0.7290646625696118, - "velocityY": 0.03229567763146106, - "timestamp": 8.432049198493093 - }, - { - "x": 5.191082665034589, - "y": 6.46549691365525, - "heading": -3.0198548730944523, - "angularVelocity": -0.24601115170048243, - "velocityX": 0.8201494408622356, - "velocityY": 0.02584294227727148, - "timestamp": 8.459744806543558 - }, - { - "x": 5.216312469195933, - "y": 6.46595166928297, - "heading": -3.0274665177164044, - "angularVelocity": -0.2748321902910632, - "velocityX": 0.9109676926165635, - "velocityY": 0.016419774098878303, - "timestamp": 8.487440414594023 - }, - { - "x": 5.244046535806501, - "y": 6.466056622814985, - "heading": -3.0358849028723838, - "angularVelocity": -0.3039610157913839, - "velocityX": 1.0013886158423948, - "velocityY": 0.0037895370206108333, - "timestamp": 8.515136022644487 - }, - { - "x": 5.274269415037942, - "y": 6.465715959448529, - "heading": -3.0451183269591553, - "angularVelocity": -0.33338946990971013, - "velocityX": 1.0912516950835975, - "velocityY": -0.012300266736711637, - "timestamp": 8.542831630694952 - }, - { - "x": 5.306960235866464, - "y": 6.4648264907503386, - "heading": -3.05517467776126, - "angularVelocity": -0.36310272674933947, - "velocityX": 1.18036118827779, - "velocityY": -0.0321158754330219, - "timestamp": 8.570527238745417 - }, - { - "x": 5.3420915660214945, - "y": 6.463277379304427, - "heading": -3.0660612007183974, - "angularVelocity": -0.3930775932884671, - "velocityX": 1.2684801897476814, - "velocityY": -0.05593346941828854, - "timestamp": 8.598222846795881 - }, - { - "x": 5.379628105658185, - "y": 6.460950030133952, - "heading": -3.0777842127338517, - "angularVelocity": -0.42328054304110213, - "velocityX": 1.3553246265001357, - "velocityY": -0.08403314945225146, - "timestamp": 8.625918454846346 - }, - { - "x": 5.41952523001788, - "y": 6.457718226299439, - "heading": -3.0903487539619023, - "angularVelocity": -0.4536654766761787, - "velocityX": 1.440557805663538, - "velocityY": -0.11669012027553252, - "timestamp": 8.65361406289681 - }, - { - "x": 5.461727422684295, - "y": 6.453448599535394, - "heading": -3.1037581696728, - "angularVelocity": -0.48417119734160885, - "velocityX": 1.5237864642480061, - "velocityY": -0.1541625934431737, - "timestamp": 8.681309670947275 - }, - { - "x": 5.506166677536889, - "y": 6.448001532672273, - "heading": -3.1180136136798957, - "angularVelocity": -0.51471857852411, - "velocityX": 1.6045596389008698, - "velocityY": -0.19667619693330898, - "timestamp": 8.70900527899774 - }, - { - "x": 5.5527609923492784, - "y": 6.441232581553373, - "heading": -3.133113464661269, - "angularVelocity": -0.5452074189474115, - "velocityX": 1.68237197491708, - "velocityY": -0.24440521784415084, - "timestamp": 8.736700887048205 - }, - { - "x": 5.60141312366844, - "y": 6.432994471961219, - "heading": -3.1490526497734637, - "angularVelocity": -0.5755130951864894, - "velocityX": 1.75667316025385, - "velocityY": -0.29745184063635494, - "timestamp": 8.76439649509867 - }, - { - "x": 5.652009808542854, - "y": 6.423139665806347, - "heading": -3.1658218818373203, - "angularVelocity": -0.6054834410315529, - "velocityX": 1.8268847819560778, - "velocityY": -0.35582559288520166, - "timestamp": 8.792092103149134 - }, - { - "x": 5.704421666252762, - "y": 6.411523401958046, - "heading": -3.183406843958928, - "angularVelocity": -0.6349368495382306, - "velocityX": 1.8924248788619584, - "velocityY": -0.419426207474268, - "timestamp": 8.819787711199599 - }, - { - "x": 5.758503955194236, - "y": 6.398007014259739, - "heading": -3.201787400905252, - "angularVelocity": -0.6636632390533842, - "velocityX": 1.9527388184772771, - "velocityY": -0.4880336143434415, - "timestamp": 8.847483319250063 - }, - { - "x": 5.8140982688799205, - "y": 6.382461238924243, - "heading": -3.220936968623995, - "angularVelocity": -0.6914297632985671, - "velocityX": 2.0073332054810007, - "velocityY": -0.5613083239468838, - "timestamp": 8.875178927300528 - }, - { - "x": 5.871035121611879, - "y": 6.364769177707707, - "heading": -3.2408222043743016, - "angularVelocity": -0.7179923876043237, - "velocityX": 2.055808004944776, - "velocityY": -0.6388038559868158, - "timestamp": 8.902874535350993 + "angularVelocity": 4.933852135685226e-24, + "velocityX": 6.910665862954014e-23, + "velocityY": -2.160330311328782e-22, + "timestamp": 8.21048380400154 + }, + { + "x": 5.080107750922132, + "y": 6.4586642554977765, + "heading": -2.986987410677254, + "angularVelocity": -0.026239217300952723, + "velocityX": 0.09073620086499802, + "velocityY": 0.010720393961257955, + "timestamp": 8.238179407499345 + }, + { + "x": 5.085138524507197, + "y": 6.4592126353095916, + "heading": -2.988447775816188, + "angularVelocity": -0.05272913222670491, + "velocityX": 0.18164520536494946, + "velocityY": 0.01980024778510464, + "timestamp": 8.26587501099715 + }, + { + "x": 5.092691296461665, + "y": 6.459963747794391, + "heading": -2.990649035659873, + "angularVelocity": -0.07948047941471853, + "velocityX": 0.2727065310227512, + "velocityY": 0.0271202786702021, + "timestamp": 8.293570614494953 + }, + { + "x": 5.102769548618277, + "y": 6.460865236669119, + "heading": -2.993598720333269, + "angularVelocity": -0.10650371542289774, + "velocityX": 0.36389357456721133, + "velocityY": 0.03254989098898449, + "timestamp": 8.321266217992758 + }, + { + "x": 5.115375817573453, + "y": 6.461860785594569, + "heading": -2.997304635953141, + "angularVelocity": -0.1338088054360665, + "velocityX": 0.4551722065263811, + "velocityY": 0.03594609973127802, + "timestamp": 8.348961821490562 + }, + { + "x": 5.130511438716252, + "y": 6.4628897445102735, + "heading": -3.0017748431338958, + "angularVelocity": -0.16140493855312305, + "velocityX": 0.5464990551298429, + "velocityY": 0.03715242803017215, + "timestamp": 8.376657424988366 + }, + { + "x": 5.148176232406587, + "y": 6.4638867259358275, + "heading": -3.007017625119319, + "angularVelocity": -0.18930015321164578, + "velocityX": 0.6378194175019449, + "velocityY": 0.035997822745898966, + "timestamp": 8.40435302848617 + }, + { + "x": 5.1683681200714915, + "y": 6.4647811736378795, + "heading": -3.013041442446997, + "angularVelocity": -0.21750085092589103, + "velocityX": 0.7290647292270105, + "velocityY": 0.03229565667788419, + "timestamp": 8.432048631983974 + }, + { + "x": 5.191082655981316, + "y": 6.465496908908166, + "heading": -3.019854870359249, + "angularVelocity": -0.24601117331826733, + "velocityX": 0.8201495198191305, + "velocityY": 0.02584292017118624, + "timestamp": 8.459744235481779 + }, + { + "x": 5.2163124585547775, + "y": 6.4659516638268535, + "heading": -3.02746651441355, + "angularVelocity": -0.27483221497246374, + "velocityX": 0.9109677850299317, + "velocityY": 0.016419751197107906, + "timestamp": 8.487439838979583 + }, + { + "x": 5.244046523573541, + "y": 6.4660566166949724, + "heading": -3.035884898958586, + "angularVelocity": -0.3039610436979258, + "velocityX": 1.0013887229777827, + "velocityY": 0.003789513672319083, + "timestamp": 8.515135442477387 + }, + { + "x": 5.274269401250127, + "y": 6.465715952734587, + "heading": -3.045118322394742, + "angularVelocity": -0.3333895012213158, + "velocityX": 1.091251818324991, + "velocityY": -0.012300290203546045, + "timestamp": 8.542831045975191 + }, + { + "x": 5.30696022060602, + "y": 6.464826483537375, + "heading": -3.0551746725109514, + "angularVelocity": -0.3631027616714286, + "velocityX": 1.1803613291360742, + "velocityY": -0.03211589873034425, + "timestamp": 8.570526649472995 + }, + { + "x": 5.3420915494206636, + "y": 6.463277371711745, + "heading": -3.0660611947523826, + "angularVelocity": -0.39307763206150964, + "velocityX": 1.268480349865999, + "velocityY": -0.05593349232317884, + "timestamp": 8.5982222529708 + }, + { + "x": 5.379628087904175, + "y": 6.460950022303807, + "heading": -3.077784206029261, + "angularVelocity": -0.4232805859532344, + "velocityX": 1.355324807653638, + "velocityY": -0.08403317183976639, + "timestamp": 8.625917856468604 + }, + { + "x": 5.419525211357798, + "y": 6.4577182183944455, + "heading": -3.0903487465047883, + "angularVelocity": -0.4536655240794423, + "velocityX": 1.4405580097500568, + "velocityY": -0.11669014215987741, + "timestamp": 8.653613459966408 + }, + { + "x": 5.4617274034297, + "y": 6.453448591734476, + "heading": -3.103758161460742, + "angularVelocity": -0.48417124967206376, + "velocityX": 1.5237866932651936, + "velocityY": -0.15416261502686032, + "timestamp": 8.681309063464212 + }, + { + "x": 5.506166658067458, + "y": 6.448001525164964, + "heading": -3.1180136047253373, + "angularVelocity": -0.5147186363252797, + "velocityX": 1.6045598949046982, + "velocityY": -0.1966762186621121, + "timestamp": 8.709004666962016 + }, + { + "x": 5.552760973114925, + "y": 6.441232574532317, + "heading": -3.13311345499563, + "angularVelocity": -0.5452074828949123, + "velocityX": 1.6823722599568172, + "velocityY": -0.24440524046294754, + "timestamp": 8.73670027045982 + }, + { + "x": 5.601413105189096, + "y": 6.432994465613015, + "heading": -3.149052639451952, + "angularVelocity": -0.5755131661090493, + "velocityX": 1.7566734762804503, + "velocityY": -0.2974518652375824, + "timestamp": 8.764395873957625 + }, + { + "x": 5.652009791405134, + "y": 6.423139660301141, + "heading": -3.1658218709441153, + "angularVelocity": -0.6054835199201767, + "velocityX": 1.8268851307049931, + "velocityY": -0.355825620938548, + "timestamp": 8.792091477455429 + }, + { + "x": 5.704421651102894, + "y": 6.411523397438684, + "heading": -3.1834068326121203, + "angularVelocity": -0.6349369375323259, + "velocityX": 1.892425261717684, + "velocityY": -0.4194262408247933, + "timestamp": 8.819787080953233 + }, + { + "x": 5.758503942727014, + "y": 6.398007010831586, + "heading": -3.201787389260581, + "angularVelocity": -0.6636633373928178, + "velocityX": 1.9527392363343576, + "velocityY": -0.48803365516730274, + "timestamp": 8.847482684451037 + }, + { + "x": 5.814098259824012, + "y": 6.382461236647001, + "heading": -3.220936956876279, + "angularVelocity": -0.6914298732366274, + "velocityX": 2.0073336586222608, + "velocityY": -0.5613083746601761, + "timestamp": 8.875178287948842 + }, + { + "x": 5.871035116712426, + "y": 6.364769176590407, + "heading": -3.2408221927556276, + "angularVelocity": -0.7179925102887033, + "velocityX": 2.055808492959182, + "velocityY": -0.6388039191129229, + "timestamp": 8.902873891446646 }, { "x": 5.929137229919434, "y": 6.3448286056518555, - "heading": -3.261403158823053, - "angularVelocity": -0.7431125690127658, - "velocityX": 2.097881664186096, - "velocityY": -0.7199904049594251, - "timestamp": 8.930570143401457 - }, - { - "x": 6.007302079253197, - "y": 6.314544148535294, - "heading": -3.2896107940616304, - "angularVelocity": -0.7739403089677718, - "velocityX": 2.1446295349515356, - "velocityY": -0.8309226172089168, - "timestamp": 8.967016927361062 - }, - { - "x": 6.087114829660797, - "y": 6.280193048985801, - "heading": -3.3189187673686584, - "angularVelocity": -0.8041305740312225, - "velocityX": 2.189843430247822, - "velocityY": -0.9425001555025164, - "timestamp": 9.003463711320666 - }, - { - "x": 6.168508639016323, - "y": 6.241748383978386, - "heading": -3.3493003097546983, - "angularVelocity": -0.8335863712889872, - "velocityX": 2.233223360550562, - "velocityY": -1.0548163879157417, - "timestamp": 9.039910495280271 - }, - { - "x": 6.251402252665518, - "y": 6.199179142701848, - "heading": -3.3807240473323636, - "angularVelocity": -0.862181354944645, - "velocityX": 2.2743738855278037, - "velocityY": -1.1679834721143234, - "timestamp": 9.076357279239875 - }, - { - "x": 6.335694920423886, - "y": 6.152449426910681, - "heading": -3.413152371425761, - "angularVelocity": -0.889744459465611, - "velocityX": 2.3127601011873846, - "velocityY": -1.2821355059190056, - "timestamp": 9.11280406319948 - }, - { - "x": 6.421258702601704, - "y": 6.101517611306378, - "heading": -3.446538850206088, - "angularVelocity": -0.9160336016843442, - "velocityX": 2.3476360019214253, - "velocityY": -1.3974296239896904, - "timestamp": 9.149250847159085 - }, - { - "x": 6.507926335867612, - "y": 6.046335751863277, - "heading": -3.4808239104526053, - "angularVelocity": -0.940688217773002, - "velocityX": 2.3779226546289447, - "velocityY": -1.5140391949057066, - "timestamp": 9.185697631118689 - }, - { - "x": 6.59547117634327, - "y": 5.986850182434709, - "heading": -3.515927196529912, - "angularVelocity": -0.963138095153033, - "velocityX": 2.4019908196204427, - "velocityY": -1.6321212180065312, - "timestamp": 9.222144415078294 - }, - { - "x": 6.683572317876966, - "y": 5.923006316810353, - "heading": -3.551733094358475, - "angularVelocity": -0.9824158386169006, - "velocityX": 2.41725419810277, - "velocityY": -1.7517009373205057, - "timestamp": 9.258591199037898 - }, - { - "x": 6.771751179698686, - "y": 5.8547676777551505, - "heading": -3.588061329459728, - "angularVelocity": -0.9967473437853483, - "velocityX": 2.4193866300920903, - "velocityY": -1.8722814921293554, - "timestamp": 9.295037982997503 - }, - { - "x": 6.859256922629332, - "y": 5.782183607463669, - "heading": -3.6246053528816105, - "angularVelocity": -1.002667984708512, - "velocityX": 2.4009180899921043, - "velocityY": -1.9915082321647621, - "timestamp": 9.331484766957107 - }, - { - "x": 6.944909301097948, - "y": 5.705612424409275, - "heading": -3.66082549221537, - "angularVelocity": -0.9937814917745361, - "velocityX": 2.350066841660152, - "velocityY": -2.1009036939792307, - "timestamp": 9.367931550916712 - }, - { - "x": 7.027210040237496, - "y": 5.626208101741732, - "heading": -3.695966962162754, - "angularVelocity": -0.9641857560418463, - "velocityX": 2.258107031631849, - "velocityY": -2.178637290893834, - "timestamp": 9.404378334876316 - }, - { - "x": 7.10523023177058, - "y": 5.5458858745426305, - "heading": -3.729586198529605, - "angularVelocity": -0.922419832820185, - "velocityX": 2.1406605208173795, - "velocityY": -2.2038220790105076, - "timestamp": 9.440825118835921 - }, - { - "x": 7.178929482816853, - "y": 5.46624650139777, - "heading": -3.761625249399457, - "angularVelocity": -0.8790638676203348, - "velocityX": 2.0221057399182083, - "velocityY": -2.1850864326775583, - "timestamp": 9.477271902795525 - }, - { - "x": 7.248572018663502, - "y": 5.388245426263194, - "heading": -3.7921242323865507, - "angularVelocity": -0.8368086199566389, - "velocityX": 1.9108005777365134, - "velocityY": -2.1401360191623633, - "timestamp": 9.51371868675513 - }, - { - "x": 7.314425791413534, - "y": 5.3124347260695295, - "heading": -3.8211367419380795, - "angularVelocity": -0.7960238572403343, - "velocityX": 1.8068472878984692, - "velocityY": -2.080038125659881, - "timestamp": 9.550165470714735 - }, - { - "x": 7.376706932700329, - "y": 5.239153810976348, - "heading": -3.848710463005587, - "angularVelocity": -0.7565474390845812, - "velocityX": 1.7088240585458914, - "velocityY": -2.010627746316465, - "timestamp": 9.586612254674339 - }, - { - "x": 7.435583508205619, - "y": 5.168626359627546, - "heading": -3.8748845295229897, - "angularVelocity": -0.7181447489691611, - "velocityX": 1.6154120915180508, - "velocityY": -1.9350802371746179, - "timestamp": 9.623059038633944 - }, - { - "x": 7.491186989763459, - "y": 5.1010086867569635, - "heading": -3.8996906746747757, - "angularVelocity": -0.6806127305849615, - "velocityX": 1.5256073517890731, - "velocityY": -1.8552438795567412, - "timestamp": 9.659505822593548 - }, - { - "x": 7.543621925479677, - "y": 5.036415277092429, - "heading": -3.9231548106792564, - "angularVelocity": -0.6437916725516183, - "velocityX": 1.4386711259444849, - "velocityY": -1.77226637434259, - "timestamp": 9.695952606553153 - }, - { - "x": 7.5929729609126495, - "y": 4.9749331712566045, - "heading": -3.9452983490202, - "angularVelocity": -0.6075580870314048, - "velocityX": 1.3540573425537872, - "velocityY": -1.686900712665603, - "timestamp": 9.732399390512757 - }, - { - "x": 7.639309796246505, - "y": 4.916630564506439, - "heading": -3.9661392022496167, - "angularVelocity": -0.5718159729131582, - "velocityX": 1.2713559414518842, - "velocityY": -1.5996639597827182, - "timestamp": 9.768846174472362 - }, - { - "x": 7.682690702150729, - "y": 4.861562214126618, - "heading": -3.985692529782674, - "angularVelocity": -0.5364897916570514, - "velocityX": 1.1902533280386327, - "velocityY": -1.5109248168743088, - "timestamp": 9.805292958431966 - }, - { - "x": 7.723165050651695, - "y": 4.809772989497631, - "heading": -4.0039712958577836, - "angularVelocity": -0.5015193136208964, - "velocityX": 1.1105053479019453, - "velocityY": -1.4209545809690254, - "timestamp": 9.841739742391571 - }, - { - "x": 7.760775169567723, - "y": 4.761300289482094, - "heading": -4.0209866925236675, - "angularVelocity": -0.4668559147699564, - "velocityX": 1.0319187272521548, - "velocityY": -1.3299582226312006, - "timestamp": 9.878186526351175 - }, - { - "x": 7.795557725829888, - "y": 4.716175740629966, - "heading": -4.036748465365555, - "angularVelocity": -0.432459908104854, - "velocityX": 0.9543381468366806, - "velocityY": -1.2380941183217342, - "timestamp": 9.91463331031078 - }, - { - "x": 7.827544775062806, - "y": 4.674426422561036, - "heading": -4.051265168296167, - "angularVelocity": -0.3982985973934382, - "velocityX": 0.8776370850270793, - "velocityY": -1.1454870233599284, - "timestamp": 9.951080094270385 - }, - { - "x": 7.856764570580477, - "y": 4.636075772943556, - "heading": -4.06454436578724, - "angularVelocity": -0.36434483508316046, - "velocityX": 0.8017112168266097, - "velocityY": -1.0522368629283385, - "timestamp": 9.987526878229989 - }, - { - "x": 7.883242196001707, - "y": 4.601144269537644, - "heading": -4.076592795479517, - "angularVelocity": -0.33057593519446465, - "velocityX": 0.7264735744744237, - "velocityY": -0.9584248488050204, - "timestamp": 10.023973662189594 - }, - { - "x": 7.907000066488958, - "y": 4.569649953472743, - "heading": -4.08741650039222, - "angularVelocity": -0.2969728392140157, - "velocityX": 0.6518509428317129, - "velocityY": -0.8641178354668736, - "timestamp": 10.060420446149198 - }, - { - "x": 7.928058330680547, - "y": 4.541608837107262, - "heading": -4.097020937393002, - "angularVelocity": -0.263519464746925, - "velocityX": 0.577781134679236, - "velocityY": -0.7693714868384814, - "timestamp": 10.096867230108803 - }, - { - "x": 7.946435196531025, - "y": 4.517035226431758, - "heading": -4.10541106680612, - "angularVelocity": -0.2302021880014778, - "velocityX": 0.504210902965987, - "velocityY": -0.6742326209835452, - "timestamp": 10.133314014068407 - }, - { - "x": 7.9621471981139855, - "y": 4.495941979152886, - "heading": -4.11259142677868, - "angularVelocity": -0.19700942559207696, - "velocityX": 0.43109432097973954, - "velocityY": -0.5787409748484375, - "timestamp": 10.169760798028012 - }, - { - "x": 7.975209416089089, - "y": 4.47834071364718, - "heading": -4.11856619512576, - "angularVelocity": -0.16393129099408016, - "velocityX": 0.3583915110200509, - "velocityY": -0.48293055225983417, - "timestamp": 10.206207581987616 - }, - { - "x": 7.985635661414927, - "y": 4.464241979882344, - "heading": -4.123339240724452, - "angularVelocity": -0.13095930779465687, - "velocityX": 0.2860676359646435, - "velocityY": -0.38683066743181205, - "timestamp": 10.242654365947221 - }, - { - "x": 7.993438629621695, - "y": 4.453655400537663, - "heading": -4.126914166049869, - "angularVelocity": -0.09808616665271669, - "velocityX": 0.2140920915111967, - "velocityY": -0.2904667626206573, - "timestamp": 10.279101149906825 - }, - { - "x": 7.998630031288323, - "y": 4.446589788513624, - "heading": -4.129294342092437, - "angularVelocity": -0.06530551626189512, - "velocityX": 0.14243785329269415, - "velocityY": -0.193861055940361, - "timestamp": 10.31554793386643 + "heading": -3.2614031475973326, + "angularVelocity": -0.74311270535547, + "velocityX": 2.097882185943911, + "velocityY": -0.7199904829708007, + "timestamp": 8.93056949494445 + }, + { + "x": 6.007302084591608, + "y": 6.314544151241208, + "heading": -3.289610783038514, + "angularVelocity": -0.7739404627397579, + "velocityX": 2.1446300921291948, + "velocityY": -0.8309227020914641, + "timestamp": 8.967016271924331 + }, + { + "x": 6.087114841402334, + "y": 6.280193054798532, + "heading": -3.3189187570009855, + "angularVelocity": -0.8041307460094369, + "velocityX": 2.1898440252970555, + "velocityY": -0.942500250752998, + "timestamp": 9.003463048904212 + }, + { + "x": 6.1685086583378625, + "y": 6.241748393148706, + "heading": -3.349300300529803, + "angularVelocity": -0.8335865622792533, + "velocityX": 2.233223996197488, + "velocityY": -1.0548164977948045, + "timestamp": 9.039909825884093 + }, + { + "x": 6.2514022808693275, + "y": 6.19917915529385, + "heading": -3.3807240397738494, + "angularVelocity": -0.8621815657771995, + "velocityX": 2.274374564785891, + "velocityY": -1.1679836019068028, + "timestamp": 9.076356602863974 + }, + { + "x": 6.335694958951068, + "y": 6.152449442751412, + "heading": -3.4131523660951144, + "angularVelocity": -0.8897446909823113, + "velocityX": 2.312760827336565, + "velocityY": -1.282135662317486, + "timestamp": 9.112803379843855 + }, + { + "x": 6.421258753043241, + "y": 6.101517629914425, + "heading": -3.446538847703636, + "angularVelocity": -0.9160338547068533, + "velocityX": 2.3476367784017027, + "velocityY": -1.3974298156762228, + "timestamp": 9.149250156823737 + }, + { + "x": 6.507926399966151, + "y": 6.046335772344393, + "heading": -3.480823911416441, + "angularVelocity": -0.9406884930245291, + "velocityX": 2.377923484722704, + "velocityY": -1.5140394334591976, + "timestamp": 9.185696933803618 + }, + { + "x": 6.595471255967786, + "y": 5.98685020332471, + "heading": -3.5159272016289207, + "angularVelocity": -0.963138393056194, + "velocityX": 2.4019917056029767, + "velocityY": -1.6321215193463872, + "timestamp": 9.222143710783499 + }, + { + "x": 6.683572414922371, + "y": 5.923006335834524, + "heading": -3.551733104267443, + "angularVelocity": -0.9824161587261235, + "velocityX": 2.417255138999483, + "velocityY": -1.7517013239724988, + "timestamp": 9.25859048776338 + }, + { + "x": 6.771751295777157, + "y": 5.854767691472866, + "heading": -3.588061344776338, + "angularVelocity": -0.996747683037885, + "velocityX": 2.4193876156309213, + "velocityY": -1.8722819962743453, + "timestamp": 9.29503726474326 + }, + { + "x": 6.85925705819262, + "y": 5.78218361088312, + "heading": -3.62460537385057, + "angularVelocity": -1.0026683318089968, + "velocityX": 2.400919084388938, + "velocityY": -1.991508896103873, + "timestamp": 9.331484041723142 + }, + { + "x": 6.944909453348972, + "y": 5.705612411431668, + "heading": -3.6608255179525564, + "angularVelocity": -0.9937818129153185, + "velocityX": 2.3500677495744626, + "velocityY": -2.1009045462022984, + "timestamp": 9.367930818703023 + }, + { + "x": 7.027210201354827, + "y": 5.62620806893484, + "heading": -3.695966990119588, + "angularVelocity": -0.9641860015888399, + "velocityX": 2.258107707336853, + "velocityY": -2.1786382521741054, + "timestamp": 9.404377595682904 + }, + { + "x": 7.105230393366097, + "y": 5.545885824395972, + "heading": -3.7295862270405054, + "angularVelocity": -0.922420024669837, + "velocityX": 2.140660943883689, + "velocityY": -2.203822976808266, + "timestamp": 9.440824372662785 + }, + { + "x": 7.178929639725794, + "y": 5.466246438659954, + "heading": -3.7616252777879366, + "angularVelocity": -0.8790640326061538, + "velocityX": 2.0221059985737635, + "velocityY": -2.1850871965984764, + "timestamp": 9.477271149642666 + }, + { + "x": 7.248572168134217, + "y": 5.388245355286236, + "heading": -3.792124260256352, + "angularVelocity": -0.8368087659781548, + "velocityX": 1.9108007395788675, + "velocityY": -2.1401366550676073, + "timestamp": 9.513717926622547 + }, + { + "x": 7.31442593199645, + "y": 5.3124346503317215, + "heading": -3.821136769002482, + "angularVelocity": -0.7960239875845612, + "velocityX": 1.8068473900609938, + "velocityY": -2.0800386546213447, + "timestamp": 9.550164703602428 + }, + { + "x": 7.376707063653561, + "y": 5.239153733180057, + "heading": -3.8487104890382855, + "angularVelocity": -0.7565475556597182, + "velocityX": 1.7088241215812134, + "velocityY": -2.0106281878399503, + "timestamp": 9.58661148058231 + }, + { + "x": 7.4355836291988595, + "y": 5.168626281863128, + "heading": -3.874884554340605, + "angularVelocity": -0.7181448531585788, + "velocityX": 1.615412127601827, + "velocityY": -1.9350806068767121, + "timestamp": 9.62305825756219 + }, + { + "x": 7.491187100722936, + "y": 5.101008610638961, + "heading": -3.8996906981294193, + "angularVelocity": -0.6806128235291476, + "velocityX": 1.525607368650723, + "velocityY": -1.8552441896712295, + "timestamp": 9.659505034542072 + }, + { + "x": 7.543622026501356, + "y": 5.036415203861435, + "heading": -3.9231548326544954, + "angularVelocity": -0.6437917552498216, + "velocityX": 1.4386711287904919, + "velocityY": -1.7722666345280043, + "timestamp": 9.695951811521953 + }, + { + "x": 7.592973052210523, + "y": 4.974933101854329, + "heading": -3.945298369428269, + "angularVelocity": -0.607558160382675, + "velocityX": 1.3540573350672032, + "velocityY": -1.686900930665162, + "timestamp": 9.732398588501834 + }, + { + "x": 7.639309878120076, + "y": 4.916630499631534, + "heading": -3.9661392210291537, + "angularVelocity": -0.5718160377360476, + "velocityX": 1.2713559263452057, + "velocityY": -1.5996641419069288, + "timestamp": 9.768845365481715 + }, + { + "x": 7.682690774963622, + "y": 4.861562154276881, + "heading": -3.98569254689674, + "angularVelocity": -0.5364898487012988, + "velocityX": 1.1902533073773187, + "velocityY": -1.5109249683463282, + "timestamp": 9.805292142461596 + }, + { + "x": 7.723165114817025, + "y": 4.809772935002484, + "heading": -4.003971311292077, + "angularVelocity": -0.5015193635757659, + "velocityX": 1.1105053233032058, + "velocityY": -1.4209547061729377, + "timestamp": 9.841738919441477 + }, + { + "x": 7.760775225537743, + "y": 4.761300240527998, + "heading": -4.020986706284907, + "angularVelocity": -0.4668559582709364, + "velocityX": 1.031918700012345, + "velocityY": -1.3299583252929026, + "timestamp": 9.878185696421358 + }, + { + "x": 7.79555777408847, + "y": 4.716175697280637, + "heading": -4.036748477480001, + "angularVelocity": -0.43245994573936725, + "velocityX": 0.9543381180159589, + "velocityY": -1.2380942016428516, + "timestamp": 9.91463247340124 + }, + { + "x": 7.827544816119829, + "y": 4.674426384773752, + "heading": -4.051265178808281, + "angularVelocity": -0.39829862970583335, + "velocityX": 0.8776370555074606, + "velocityY": -1.1454870901185914, + "timestamp": 9.95107925038112 + }, + { + "x": 7.856764604967555, + "y": 4.636075740582476, + "heading": -4.0645443747584675, + "angularVelocity": -0.3643448625791197, + "velocityX": 0.801711187352885, + "velocityY": -1.0522369155562157, + "timestamp": 9.987526027361001 + }, + { + "x": 7.883242224268873, + "y": 4.601144242384833, + "heading": -4.076592802987174, + "angularVelocity": -0.3305759583449084, + "velocityX": 0.7264735456837021, + "velocityY": -0.9584248894470645, + "timestamp": 10.023972804340882 + }, + { + "x": 7.907000089202039, + "y": 4.569649931237369, + "heading": -4.087416506528491, + "angularVelocity": -0.29697285845856597, + "velocityX": 0.6518509152752107, + "velocityY": -0.8641178660282948, + "timestamp": 10.060419581320764 + }, + { + "x": 7.92805834841907, + "y": 4.541608819433365, + "heading": -4.097020942264019, + "angularVelocity": -0.2635194804969814, + "velocityX": 0.5777811088386537, + "velocityY": -0.7693715090221326, + "timestamp": 10.096866358300645 + }, + { + "x": 7.946435209886507, + "y": 4.517035212904852, + "heading": -4.10541107053113, + "angularVelocity": -0.2302022006429521, + "velocityX": 0.5042108792660284, + "velocityY": -0.6742326363200164, + "timestamp": 10.133313135280526 + }, + { + "x": 7.9621472076885365, + "y": 4.495941969305627, + "heading": -4.112591429489288, + "angularVelocity": -0.1970094354878312, + "velocityX": 0.4310942997978278, + "velocityY": -0.5787409847205335, + "timestamp": 10.169759912260407 + }, + { + "x": 7.975209422494241, + "y": 4.478340706964249, + "heading": -4.118566196965234, + "angularVelocity": -0.16393129848610621, + "velocityX": 0.35839149269397597, + "velocityY": -0.4829305579226738, + "timestamp": 10.206206689240288 + }, + { + "x": 7.985635665270655, + "y": 4.464241975804708, + "heading": -4.123339241847092, + "angularVelocity": -0.13095931320603413, + "velocityX": 0.28606762079865283, + "velocityY": -0.38683067002947596, + "timestamp": 10.242653466220169 + }, + { + "x": 7.993438631555588, + "y": 4.453655398466285, + "heading": -4.126914166620439, + "angularVelocity": -0.0980861702893798, + "velocityX": 0.2140920797809049, + "velocityY": -0.2904667632000886, + "timestamp": 10.27910024320005 + }, + { + "x": 7.9986300319348755, + "y": 4.446589787812739, + "heading": -4.12929434228564, + "angularVelocity": -0.06530551841424088, + "velocityX": 0.14243784524907988, + "velocityY": -0.19386105546305826, + "timestamp": 10.315547020179931 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": -0.032611781036393526, - "velocityX": 0.07108094474255332, - "velocityY": -0.09703305984719977, - "timestamp": 10.351994717826035 + "angularVelocity": -0.0326117819807531, + "velocityX": 0.07108094061524496, + "velocityY": -0.09703305919912024, + "timestamp": 10.351993797159812 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": 5.43498274287512e-28, - "velocityX": -9.773776117093748e-27, - "velocityY": -3.005417448336995e-26, - "timestamp": 10.388441501785639 - }, - { - "x": 7.9978628064592465, - "y": 4.441693189778957, - "heading": -4.12972677682109, - "angularVelocity": 0.022841316519794305, - "velocityX": -0.1014319719694858, - "velocityY": -0.04108319939911529, - "timestamp": 10.421546415360265 - }, - { - "x": 7.991138812092924, - "y": 4.438993628277519, - "heading": -4.128211445533363, - "angularVelocity": 0.04577360651647058, - "velocityX": -0.20311167256684373, - "velocityY": -0.081545644133843, - "timestamp": 10.45465132893489 - }, - { - "x": 7.981040039615165, - "y": 4.434976715873705, - "heading": -4.12593384407128, - "angularVelocity": 0.06879949881000491, - "velocityX": -0.3050535823026586, - "velocityY": -0.12133885789367849, - "timestamp": 10.487756242509516 - }, - { - "x": 7.967557291029649, - "y": 4.429666404764379, - "heading": -4.122890785038121, - "angularVelocity": 0.09192167278430328, - "velocityX": -0.40727333587877107, - "velocityY": -0.16040854773284244, - "timestamp": 10.520861156084141 - }, - { - "x": 7.950680809544412, - "y": 4.423088668530895, - "heading": -4.119078991959019, - "angularVelocity": 0.11514281922257556, - "velocityX": -0.5097878128330726, - "velocityY": -0.1986936536975387, - "timestamp": 10.553966069658767 - }, - { - "x": 7.930400235453064, - "y": 4.415271764180474, - "heading": -4.114495100547863, - "angularVelocity": 0.13846559063875805, - "velocityX": -0.6126152253994589, - "velocityY": -0.23612520035131226, - "timestamp": 10.587070983233392 - }, - { - "x": 7.90670455942382, - "y": 4.406246540435963, - "heading": -4.109135662098499, - "angularVelocity": 0.16189253710883125, - "velocityX": -0.7157751968096621, - "velocityY": -0.2726248997499001, - "timestamp": 10.620175896808018 - }, - { - "x": 7.879582073874223, - "y": 4.396046802675373, - "heading": -4.102997149666274, - "angularVelocity": 0.18542602198272123, - "velocityX": -0.8192888191191472, - "velocityY": -0.3081034402218639, - "timestamp": 10.653280810382643 - }, - { - "x": 7.849020323685139, - "y": 4.384709747772971, - "heading": -4.096075967969171, - "angularVelocity": 0.2090681095270295, - "velocityX": -0.923178673165617, - "velocityY": -0.34245837485262026, - "timestamp": 10.686385723957269 - }, - { - "x": 7.815006058419893, - "y": 4.372276485863039, - "heading": -4.088368468312413, - "angularVelocity": 0.23282041318080082, - "velocityX": -1.027468783102857, - "velocityY": -0.3755714958114766, - "timestamp": 10.719490637531894 - }, - { - "x": 7.777525189659056, - "y": 4.358792671072697, - "heading": -4.079870970377267, - "angularVelocity": 0.2566838882086457, - "velocityX": -1.132184461872942, - "velocityY": -0.4073055427239372, - "timestamp": 10.75259555110652 - }, - { - "x": 7.736562759355408, - "y": 4.3443092700230626, - "heading": -4.070579793488702, - "angularVelocity": 0.280658545373366, - "velocityX": -1.237351978319202, - "velocityY": -0.4375000411037426, - "timestamp": 10.785700464681145 - }, - { - "x": 7.692102928777451, - "y": 4.32888350603968, - "heading": -4.060491301098684, - "angularVelocity": 0.3047430517308739, - "velocityX": -1.3429979352682966, - "velocityY": -0.46596599470377864, - "timestamp": 10.818805378255771 - }, - { - "x": 7.644129003507531, - "y": 4.312580029465776, - "heading": -4.04960196385686, - "angularVelocity": 0.32893416916121687, - "velocityX": -1.449148180428791, - "velocityY": -0.49247905562876526, - "timestamp": 10.851910291830396 - }, - { - "x": 7.592623519547409, - "y": 4.2954723815055775, - "heading": -4.037908449029847, - "angularVelocity": 0.35322595845640614, - "velocityX": -1.555825960518466, - "velocityY": -0.5167706576739681, - "timestamp": 10.885015205405022 - }, - { - "x": 7.537568431341937, - "y": 4.277644842335571, - "heading": -4.025407747523989, - "angularVelocity": 0.37760864343229733, - "velocityX": -1.663048842624742, - "velocityY": -0.5385164087445838, - "timestamp": 10.918120118979648 - }, - { - "x": 7.478945468744125, - "y": 4.259194785924933, - "heading": -4.012097354853389, - "angularVelocity": 0.4020669814043128, - "velocityX": -1.7708236109924926, - "velocityY": -0.557320784694024, - "timestamp": 10.951225032554273 - }, - { - "x": 7.41673677407285, - "y": 4.240235706322923, - "heading": -3.9979755297163337, - "angularVelocity": 0.4265779188706207, - "velocityX": -1.8791378062668793, - "velocityY": -0.5726968463238129, - "timestamp": 10.984329946128899 - }, - { - "x": 7.350926005489431, - "y": 4.220901134197944, - "heading": -3.983041664129885, - "angularVelocity": 0.45110722167526907, - "velocityX": -1.9879456394008563, - "velocityY": -0.5840393475547041, - "timestamp": 11.017434859703524 - }, - { - "x": 7.281500221503902, - "y": 4.201349724406127, - "heading": -3.9672968128771577, - "angularVelocity": 0.47560466265031076, - "velocityX": -2.097144396073741, - "velocityY": -0.5905893621423952, - "timestamp": 11.05053977327815 - }, - { - "x": 7.208453081280606, - "y": 4.181771846596411, - "heading": -3.950744447003366, - "angularVelocity": 0.4999972537756106, - "velocityX": -2.2065346903453893, - "velocityY": -0.591388881459637, - "timestamp": 11.083644686852775 - }, - { - "x": 7.131790264139756, - "y": 4.162397991758564, - "heading": -3.9333915135611903, - "angularVelocity": 0.5241799953067018, - "velocityX": -2.3157534294127133, - "velocityY": -0.5852259603147614, - "timestamp": 11.1167496004274 - }, - { - "x": 7.051538595146062, - "y": 4.143509057085501, - "heading": -3.9152498946632917, - "angularVelocity": 0.5480038139052583, - "velocityX": -2.4241618638511357, - "velocityY": -0.5705779787185788, - "timestamp": 11.149854514002026 - }, - { - "x": 6.967761151528457, - "y": 4.125447705104888, - "heading": -3.8963383505125964, - "angularVelocity": 0.5712609431244915, - "velocityX": -2.5306649246720965, - "velocityY": -0.5455791914363196, - "timestamp": 11.182959427576652 - }, - { - "x": 6.880581207877887, - "y": 4.108627750977044, - "heading": -3.876684983625147, - "angularVelocity": 0.5936691797471845, - "velocityX": -2.6334442303873935, - "velocityY": -0.5080802911606311, - "timestamp": 11.216064341151277 - }, - { - "x": 6.790216608879877, - "y": 4.0935340018236515, - "heading": -3.856330118329937, - "angularVelocity": 0.6148593395154528, - "velocityX": -2.7296431025052987, - "velocityY": -0.45593682398137625, - "timestamp": 11.249169254725903 - }, - { - "x": 6.697019199323438, - "y": 4.080699197672285, - "heading": -3.83532911718854, - "angularVelocity": 0.6343771625942055, - "velocityX": -2.8152138004031935, - "velocityY": -0.3877008807902249, - "timestamp": 11.282274168300528 - }, - { - "x": 6.601498540052863, - "y": 4.07064612257462, - "heading": -3.813754414028283, - "angularVelocity": 0.6517069773229626, - "velocityX": -2.885392195791479, - "velocityY": -0.30367320171378936, - "timestamp": 11.315379081875154 - }, - { - "x": 6.504298225369728, - "y": 4.0638060169193, - "heading": -3.791697257810727, - "angularVelocity": 0.666280435012615, - "velocityX": -2.93612954052959, - "velocityY": -0.2066190458374174, - "timestamp": 11.34848399544978 - }, - { - "x": 6.406117512435041, - "y": 4.060457553922357, - "heading": -3.769268609747822, - "angularVelocity": 0.6775020877896717, - "velocityX": -2.965744426831601, - "velocityY": -0.10114700917115207, - "timestamp": 11.381588909024405 - }, - { - "x": 6.307619626153464, - "y": 4.060722723896358, - "heading": -3.7465929512301233, - "angularVelocity": 0.6849635316698022, - "velocityX": -2.975325280929776, - "velocityY": 0.008009988408604752, - "timestamp": 11.41469382259903 - }, - { - "x": 6.209374336917679, - "y": 4.064607085649101, - "heading": -3.7237946194075744, - "angularVelocity": 0.6886691237286258, - "velocityX": -2.9676950829163595, - "velocityY": 0.117334900874646, - "timestamp": 11.447798736173656 - }, - { - "x": 6.111843522629519, - "y": 4.072048543608375, - "heading": -3.70098589740335, - "angularVelocity": 0.6889829799074695, - "velocityX": -2.9461129408571565, - "velocityY": 0.22478409262418045, - "timestamp": 11.480903649748281 - }, - { - "x": 6.015391988393039, - "y": 4.082953827745876, - "heading": -3.6782618367430677, - "angularVelocity": 0.6864256150090193, - "velocityX": -2.9135111323900427, - "velocityY": 0.32941587697905805, - "timestamp": 11.514008563322907 - }, - { - "x": 5.920306236320189, - "y": 4.097220109283991, - "heading": -3.6557002049026477, - "angularVelocity": 0.68151912825755, - "velocityX": -2.872254955703382, - "velocityY": 0.43094151283481674, - "timestamp": 11.547113476897533 - }, - { - "x": 5.826812506445201, - "y": 4.11474607261669, - "heading": -3.6333637032024773, - "angularVelocity": 0.6747186229566627, - "velocityX": -2.824164747152575, - "velocityY": 0.5294067085597899, - "timestamp": 11.580218390472158 - }, - { - "x": 5.735091396535967, - "y": 4.135436875128028, - "heading": -3.611302700103551, - "angularVelocity": 0.6663966377437107, - "velocityX": -2.770619222505322, - "velocityY": 0.6250069937412039, - "timestamp": 11.613323304046784 + "angularVelocity": 3.521072073538637e-24, + "velocityX": 1.3091800468623773e-22, + "velocityY": 4.286584514522651e-22, + "timestamp": 10.388440574139693 + }, + { + "x": 7.997862807158953, + "y": 4.441693190015581, + "heading": -4.129726776956422, + "angularVelocity": 0.02284131688697609, + "velocityX": -0.10143197061746514, + "velocityY": -0.041083200264577825, + "timestamp": 10.421545481257297 + }, + { + "x": 7.9911388141737, + "y": 4.438993628966426, + "heading": -4.128211445929986, + "angularVelocity": 0.045773607551682645, + "velocityX": -0.20311167046523715, + "velocityY": -0.0815456463770018, + "timestamp": 10.454650388374901 + }, + { + "x": 7.9810400437385045, + "y": 4.43497671720804, + "heading": -4.125933844845356, + "angularVelocity": 0.0687995008274153, + "velocityX": -0.30505358010280076, + "velocityY": -0.12133886206402324, + "timestamp": 10.487755295492505 + }, + { + "x": 7.967557297835451, + "y": 4.429666406913068, + "heading": -4.122890786295556, + "angularVelocity": 0.09192167611254726, + "velocityX": -0.4072733342871634, + "velocityY": -0.16040855442089563, + "timestamp": 10.520860202610109 + }, + { + "x": 7.950680819649021, + "y": 4.423088671636749, + "heading": -4.119078993794958, + "angularVelocity": 0.1151428242059706, + "velocityX": -0.5097878126187516, + "velocityY": -0.19869366353910206, + "timestamp": 10.553965109727713 + }, + { + "x": 7.9304002494470245, + "y": 4.415271768358087, + "heading": -4.11449510304615, + "angularVelocity": 0.13846559763858526, + "velocityX": -0.6126152274027127, + "velocityY": -0.23612521403224035, + "timestamp": 10.587070016845317 + }, + { + "x": 7.906704577869307, + "y": 4.406246545769374, + "heading": -4.109135665331081, + "angularVelocity": 0.16189254650467774, + "velocityX": -0.7157752019524101, + "velocityY": -0.27262491801146155, + "timestamp": 10.62017492396292 + }, + { + "x": 7.879582097302059, + "y": 4.396046809215453, + "heading": -4.102997153692569, + "angularVelocity": 0.1854260341738729, + "velocityX": -0.8192888284173855, + "velocityY": -0.3081034638667474, + "timestamp": 10.653279831080525 + }, + { + "x": 7.849020352591328, + "y": 4.384709755534507, + "heading": -4.096075972835381, + "angularVelocity": 0.2090681249338963, + "velocityX": -0.9231786877444521, + "velocityY": -0.34245840475163225, + "timestamp": 10.686384738198129 + }, + { + "x": 7.8150060932615615, + "y": 4.372276494821474, + "heading": -4.088368474050785, + "angularVelocity": 0.23282043224634263, + "velocityX": -1.0274688042148068, + "velocityY": -0.37557153291095113, + "timestamp": 10.719489645315733 + }, + { + "x": 7.777525230849651, + "y": 4.358792681160471, + "heading": -4.079870977005314, + "angularVelocity": 0.2566839113997491, + "velocityX": -1.1321844909204, + "velocityY": -0.40730558805382683, + "timestamp": 10.752594552433337 + }, + { + "x": 7.736562807258985, + "y": 4.344309281125525, + "heading": -4.070579801008361, + "angularVelocity": 0.2806585731820932, + "velocityX": -1.2373520168822494, + "velocityY": -0.4375000957862593, + "timestamp": 10.78569945955094 + }, + { + "x": 7.692102983701815, + "y": 4.328883517990517, + "heading": -4.060491309495449, + "angularVelocity": 0.30474308467546074, + "velocityX": -1.342997985139448, + "velocityY": -0.4659660599622744, + "timestamp": 10.818804366668545 + }, + { + "x": 7.644129065695918, + "y": 4.312580042041941, + "heading": -4.04960197309887, + "angularVelocity": 0.3289342077866296, + "velocityX": -1.4491482436568, + "velocityY": -0.4924791327962167, + "timestamp": 10.851909273786148 + }, + { + "x": 7.592623589168311, + "y": 4.295472394421691, + "heading": -4.037908459066969, + "angularVelocity": 0.35322600333416404, + "velocityX": -1.5558260394640624, + "velocityY": -0.5167707481998554, + "timestamp": 10.885014180903752 + }, + { + "x": 7.537568508476518, + "y": 4.277644855237873, + "heading": -4.025407758286928, + "angularVelocity": 0.3776086951591106, + "velocityX": -1.6630489400321737, + "velocityY": -0.5385165141979279, + "timestamp": 10.918119088021356 + }, + { + "x": 7.478945553370504, + "y": 4.259194798384933, + "heading": -4.012097366252854, + "angularVelocity": 0.4020670405988502, + "velocityX": -1.7708237300820395, + "velocityY": -0.5573209067585142, + "timestamp": 10.95122399513896 + }, + { + "x": 7.416736866046282, + "y": 4.240235717831127, + "heading": -3.997975541642368, + "angularVelocity": 0.4265779861673775, + "velocityX": -1.8791379508550954, + "velocityY": -0.572696986777671, + "timestamp": 10.984328902256564 + }, + { + "x": 7.350926104517102, + "y": 4.220901144158427, + "heading": -3.9830416764514713, + "angularVelocity": 0.45110729771403824, + "velocityX": -1.9879458140568433, + "velocityY": -0.5840395082219955, + "timestamp": 11.017433809374168 + }, + { + "x": 7.281500327112687, + "y": 4.201349732133466, + "heading": -3.96729682544228, + "angularVelocity": 0.4756047480592185, + "velocityX": -2.097144606320271, + "velocityY": -0.5905895447917914, + "timestamp": 11.050538716491772 + }, + { + "x": 7.2084531927759015, + "y": 4.181771851317855, + "heading": -3.9507444596397754, + "angularVelocity": 0.4999973491453385, + "velocityX": -2.2065349429100904, + "velocityY": -0.5913890876075294, + "timestamp": 11.083643623609376 + }, + { + "x": 7.131790380553627, + "y": 4.162397992626754, + "heading": -3.9333915260781684, + "angularVelocity": 0.5241801011542423, + "velocityX": -2.3157537325186857, + "velocityY": -0.585226190856754, + "timestamp": 11.11674853072698 + }, + { + "x": 7.0515387151746305, + "y": 4.143509053211283, + "heading": -3.9152499068546014, + "angularVelocity": 0.5480039306293687, + "velocityX": -2.4241622274881247, + "velocityY": -0.5705782332621693, + "timestamp": 11.149853437844584 + }, + { + "x": 6.967761273464085, + "y": 4.12544769562606, + "heading": -3.896338362160399, + "angularVelocity": 0.5712610709650918, + "velocityX": -2.5306653606648495, + "velocityY": -0.545579467148517, + "timestamp": 11.182958344962188 + }, + { + "x": 6.880581329556192, + "y": 4.108627735185313, + "heading": -3.876684994503698, + "angularVelocity": 0.5936693187775344, + "velocityX": -2.6334447518064277, + "velocityY": -0.5080805809542204, + "timestamp": 11.216063252079792 + }, + { + "x": 6.790216727690451, + "y": 4.093533979368118, + "heading": -3.85633012820655, + "angularVelocity": 0.6148594897076288, + "velocityX": -2.729643721540304, + "velocityY": -0.4559371142040936, + "timestamp": 11.249168159197396 + }, + { + "x": 6.697019312366813, + "y": 4.080699168817031, + "heading": -3.8353291258180944, + "angularVelocity": 0.6343773239976459, + "velocityX": -2.8152145237127253, + "velocityY": -0.38770114972659575, + "timestamp": 11.282273066315 + }, + { + "x": 6.601498644505623, + "y": 4.070646088391479, + "heading": -3.813754421138034, + "angularVelocity": 0.6517071503453378, + "velocityX": -2.885393018076057, + "velocityY": -0.30367342188392765, + "timestamp": 11.315377973432604 + }, + { + "x": 6.504298318965137, + "y": 4.063805979232082, + "heading": -3.791697263090234, + "angularVelocity": 0.6662806202549634, + "velocityX": -2.9361304411816507, + "velocityY": -0.2066191919855685, + "timestamp": 11.348482880550208 + }, + { + "x": 6.406117593795898, + "y": 4.060457514963214, + "heading": -3.7692686128872914, + "angularVelocity": 0.6775022845787112, + "velocityX": -2.9657453748611045, + "velocityY": -0.10114706732064674, + "timestamp": 11.381587787667812 + }, + { + "x": 6.307619694810011, + "y": 4.060722685880049, + "heading": -3.746592951999944, + "angularVelocity": 0.6849637368500491, + "velocityX": -2.975326245017957, + "velocityY": 0.00801001845112039, + "timestamp": 11.414692694785415 + }, + { + "x": 6.209374393100852, + "y": 4.064607050480649, + "heading": -3.7237946177112957, + "angularVelocity": 0.6886693325451241, + "velocityX": -2.9676960385403794, + "velocityY": 0.11733500978574436, + "timestamp": 11.44779760190302 + }, + { + "x": 6.111843567014915, + "y": 4.072048512767596, + "heading": -3.7009858932799373, + "angularVelocity": 0.6889831876081538, + "velocityX": -2.946113871863876, + "velocityY": 0.22478426719373196, + "timestamp": 11.480902509020623 + }, + { + "x": 6.0153920218938275, + "y": 4.08295380228718, + "heading": -3.67826183034087, + "angularVelocity": 0.6864258177297179, + "velocityX": -2.9135120294537553, + "velocityY": 0.32941610380729425, + "timestamp": 11.514007416138227 + }, + { + "x": 5.920306259948002, + "y": 4.097220089886147, + "heading": -3.6557001964477682, + "angularVelocity": 0.6815193231913592, + "velocityX": -2.872255814161892, + "velocityY": 0.43094177996896244, + "timestamp": 11.547112323255831 + }, + { + "x": 5.826812521225562, + "y": 4.1147460596447285, + "heading": -3.633363692971576, + "angularVelocity": 0.6747188082069855, + "velocityX": -2.824165565253177, + "velocityY": 0.5294070059257744, + "timestamp": 11.580217230373435 + }, + { + "x": 5.73509140346026, + "y": 4.135436868691069, + "heading": -3.611302688403279, + "angularVelocity": 0.6663968121078352, + "velocityX": -2.7706200002152808, + "velocityY": 0.6250073130499223, + "timestamp": 11.61332213749104 }, { "x": 5.645288944244385, "y": 4.159205913543701, - "heading": -3.589557740824999, - "angularVelocity": 0.656849903248797, - "velocityX": -2.712662339055809, - "velocityY": 0.7179912541409452, - "timestamp": 11.64642821762141 - }, - { - "x": 5.556543272789032, - "y": 4.1863163780495505, - "heading": -3.567920606584658, - "angularVelocity": 0.6461920112656356, - "velocityX": -2.6503853648943725, - "velocityY": 0.8096527659711241, - "timestamp": 11.679912280969642 - }, - { - "x": 5.470146818109821, - "y": 4.21629829382191, - "heading": -3.546719854360496, - "angularVelocity": 0.633159482577573, - "velocityX": -2.5802261147546752, - "velocityY": 0.8954085249615271, - "timestamp": 11.713396344317875 - }, - { - "x": 5.38636992658066, - "y": 4.248906335893914, - "heading": -3.526034553779174, - "angularVelocity": 0.6177655431539323, - "velocityX": -2.5019929826880443, - "velocityY": 0.9738376651866179, - "timestamp": 11.746880407666108 - }, - { - "x": 5.305478349810334, - "y": 4.283844055187029, - "heading": -3.505938689685919, - "angularVelocity": 0.6001620497565967, - "velocityX": -2.415823191141911, - "velocityY": 1.0434133674209292, - "timestamp": 11.780364471014341 - }, - { - "x": 5.227719301839229, - "y": 4.32076498574019, - "heading": -3.4864965293384484, - "angularVelocity": 0.5806392176861178, - "velocityX": -2.322270363737359, - "velocityY": 1.1026418797857462, - "timestamp": 11.813848534362574 - }, - { - "x": 5.1533066354562695, - "y": 4.359280038599062, - "heading": -3.467759498175663, - "angularVelocity": 0.5595805672663093, - "velocityX": -2.2223308327030025, - "velocityY": 1.150250268562566, - "timestamp": 11.847332597710807 - }, - { - "x": 5.082408288831018, - "y": 4.3989712692340515, - "heading": -3.4497656171938673, - "angularVelocity": 0.5373864215540406, - "velocityX": -2.117375836018225, - "velocityY": 1.1853767633337151, - "timestamp": 11.88081666105904 - }, - { - "x": 5.01513906699728, - "y": 4.439409930939772, - "heading": -3.4325412407735434, - "angularVelocity": 0.514405203490123, - "velocityX": -2.008992192319671, - "velocityY": 1.207698757619713, - "timestamp": 11.914300724407273 - }, - { - "x": 4.951560246505482, - "y": 4.480175132009186, - "heading": -3.4161037850831852, - "angularVelocity": 0.490903852361318, - "velocityX": -1.8987785272826667, - "velocityY": 1.2174508405822064, - "timestamp": 11.947784787755506 - }, - { - "x": 4.891685240964086, - "y": 4.520869436323415, - "heading": -3.4004642391590387, - "angularVelocity": 0.4670743141743557, - "velocityX": -1.7881642654506853, - "velocityY": 1.2153335122744733, - "timestamp": 11.981268851103739 - }, - { - "x": 4.835488965074171, - "y": 4.561129265371178, - "heading": -3.3856290250526424, - "angularVelocity": 0.44305298171582685, - "velocityX": -1.678299174908268, - "velocityY": 1.2023579285782104, - "timestamp": 12.014752914451972 - }, - { - "x": 4.782918258230768, - "y": 4.600629876244802, - "heading": -3.3716013073356166, - "angularVelocity": 0.4189371394725309, - "velocityX": -1.5700217233694047, - "velocityY": 1.1796839129952525, - "timestamp": 12.048236977800205 - }, - { - "x": 4.733901443923004, - "y": 4.639085998252082, - "heading": -3.358381939905764, - "angularVelocity": 0.39479579561093997, - "velocityX": -1.4638848875057788, - "velocityY": 1.1484903014110828, - "timestamp": 12.081721041148437 - }, - { - "x": 4.688356082575613, - "y": 4.676249643136629, - "heading": -3.345970158873378, - "angularVelocity": 0.3706772652800276, - "velocityX": -1.3602101057365927, - "velocityY": 1.109890532043447, - "timestamp": 12.11520510449667 - }, - { - "x": 4.646194734008062, - "y": 4.7119064377976505, - "heading": -3.3343640770115957, - "angularVelocity": 0.34661509689190445, - "velocityX": -1.2591467209064442, - "velocityY": 1.0648885199562685, - "timestamp": 12.148689167844903 - }, - { - "x": 4.6073289583831585, - "y": 4.745871436865768, - "heading": -3.3235610235419317, - "angularVelocity": 0.32263269117946203, - "velocityX": -1.1607245877150678, - "velocityY": 1.014363122984295, - "timestamp": 12.182173231193136 - }, - { - "x": 4.57167193026909, - "y": 4.777984991592977, - "heading": -3.3135577714536746, - "angularVelocity": 0.29874665999236377, - "velocityX": -1.0648954920206877, - "velocityY": 0.9590698235524624, - "timestamp": 12.21565729454137 - }, - { - "x": 4.539140037844566, - "y": 4.808108969456149, - "heading": -3.304350688790571, - "angularVelocity": 0.27496909701041905, - "velocityX": -0.9715634594939336, - "velocityY": 0.8996512027194499, - "timestamp": 12.249141357889602 - }, - { - "x": 4.509653776241274, - "y": 4.836123440216494, - "heading": -3.29593584110889, - "angularVelocity": 0.25130903600816695, - "velocityX": -0.8806058361745399, - "velocityY": 0.8366508708634285, - "timestamp": 12.282625421237835 - }, - { - "x": 4.48313816887737, - "y": 4.861923843828622, - "heading": -3.2883090632845122, - "angularVelocity": 0.22777336624470876, - "velocityX": -0.7918873849969232, - "velocityY": 0.7705278580978897, - "timestamp": 12.316109484586068 - }, - { - "x": 4.459522884136782, - "y": 4.885418605956808, - "heading": -3.2814660119426646, - "angularVelocity": 0.20436741116752466, - "velocityX": -0.7052693842736527, - "velocityY": 0.7016699820401419, - "timestamp": 12.349593547934301 - }, - { - "x": 4.438742162822014, - "y": 4.906527146840758, - "heading": -3.275402205208727, - "angularVelocity": 0.18109530706814916, - "velocityX": -0.6206152789358182, - "velocityY": 0.6304055951759001, - "timestamp": 12.383077611282534 - }, - { - "x": 4.420734633898579, - "y": 4.925178225077248, - "heading": -3.2701130537081724, - "angularVelocity": 0.15796026442632197, - "velocityX": -0.5377940166985415, - "velocityY": 0.5570135871061982, - "timestamp": 12.416561674630767 - }, - { - "x": 4.405443069468726, - "y": 4.941308561350081, - "heading": -3.2655938851592956, - "angularVelocity": 0.13496475926106719, - "velocityX": -0.45668186297528196, - "velocityY": 0.4817317451910843, - "timestamp": 12.450045737979 - }, - { - "x": 4.392814111754166, - "y": 4.954861693705026, - "heading": -3.2618399640244657, - "angularVelocity": 0.1121106807076865, - "velocityX": -0.37716323682758857, - "velocityY": 0.40476366962971966, - "timestamp": 12.483529801327233 - }, - { - "x": 4.382797992684927, - "y": 4.965787023275837, - "heading": -3.2588465072023927, - "angularVelocity": 0.08939944925265392, - "velocityX": -0.2991309317830429, - "velocityY": 0.3262844612730617, - "timestamp": 12.517013864675466 - }, - { - "x": 4.375348258629927, - "y": 4.974039016306493, - "heading": -3.2566086964718237, - "angularVelocity": 0.06683211375202444, - "velocityX": -0.22248596227772716, - "velocityY": 0.2464453894031916, - "timestamp": 12.550497928023699 - }, - { - "x": 4.370421507535125, - "y": 4.979576534431501, - "heading": -3.2551216882351093, - "angularVelocity": 0.04440943207070345, - "velocityX": -0.14713719310477827, - "velocityY": 0.16537772215448024, - "timestamp": 12.583981991371932 + "heading": -3.5895577279773367, + "angularVelocity": 0.6568500660247814, + "velocityX": -2.712663077315302, + "velocityY": 0.7179915886244437, + "timestamp": 11.646427044608643 + }, + { + "x": 5.55654326392043, + "y": 4.186316385224252, + "heading": -3.5679205922393793, + "angularVelocity": 0.6461921616438002, + "velocityX": -2.6503860630907963, + "velocityY": 0.8096531126208885, + "timestamp": 11.679911102482258 + }, + { + "x": 5.47014680152862, + "y": 4.216298307971487, + "heading": -3.5467198389182046, + "angularVelocity": 0.6331596188608981, + "velocityX": -2.5802267669561205, + "velocityY": 0.8954088796644789, + "timestamp": 11.713395160355873 + }, + { + "x": 5.386369903571584, + "y": 4.248906356674734, + "heading": -3.526034537660783, + "angularVelocity": 0.6177656643498314, + "velocityX": -2.501993583730219, + "velocityY": 0.9738380224501408, + "timestamp": 11.746879218229488 + }, + { + "x": 5.305478321739699, + "y": 4.283844082081717, + "heading": -3.505938673301294, + "angularVelocity": 0.6001621558337007, + "velocityX": -2.415823737290412, + "velocityY": 1.0434137206086127, + "timestamp": 11.780363276103103 + }, + { + "x": 5.227719270089909, + "y": 4.3207650180463215, + "heading": -3.486496513053993, + "angularVelocity": 0.5806393096286306, + "velocityX": -2.322270853290538, + "velocityY": 1.1026422216794234, + "timestamp": 11.813847333976717 + }, + { + "x": 5.153306601354184, + "y": 4.359280075444413, + "heading": -3.4677594822906004, + "angularVelocity": 0.5595806468294645, + "velocityX": -2.2223312663176835, + "velocityY": 1.1502505921912554, + "timestamp": 11.847331391850332 + }, + { + "x": 5.082408253577596, + "y": 4.39897130961914, + "heading": -3.449765601932038, + "angularVelocity": 0.537386490803467, + "velocityX": -2.11737621659215, + "velocityY": 1.1853770628560039, + "timestamp": 11.880815449723947 + }, + { + "x": 5.015139031621627, + "y": 4.439409973799246, + "heading": -3.432541226289716, + "angularVelocity": 0.5144052643600046, + "velocityX": -2.008992524438854, + "velocityY": 1.2076990289749658, + "timestamp": 11.914299507597562 + }, + { + "x": 4.951560211842953, + "y": 4.480175176277809, + "heading": -3.4161037714769003, + "angularVelocity": 0.4909039064159544, + "velocityX": -1.8987788164341068, + "velocityY": 1.2174510817186697, + "timestamp": 11.947783565471177 + }, + { + "x": 4.89168520765914, + "y": 4.520869480993223, + "heading": -3.4004642264891163, + "angularVelocity": 0.4670743625762069, + "velocityX": -1.7881645172699678, + "velocityY": 1.2153337229619623, + "timestamp": 11.981267623344792 + }, + { + "x": 4.835488933599554, + "y": 4.5611293095322845, + "heading": -3.3856290133489932, + "angularVelocity": 0.44305302529694635, + "velocityX": -1.6782993946462035, + "velocityY": 1.2023581099704563, + "timestamp": 12.014751681218407 + }, + { + "x": 4.782918228914137, + "y": 4.600629919108832, + "heading": -3.3716012966078455, + "angularVelocity": 0.41893717882389225, + "velocityX": -1.5700219156186, + "velocityY": 1.1796840671355455, + "timestamp": 12.048235739092021 + }, + { + "x": 4.733901416974363, + "y": 4.639086039161345, + "heading": -3.3583819301491356, + "angularVelocity": 0.394795831156607, + "velocityX": -1.4638850561299048, + "velocityY": 1.1484904308093287, + "timestamp": 12.081719796965636 + }, + { + "x": 4.68835605811188, + "y": 4.676249681563439, + "heading": -3.3459701500728256, + "angularVelocity": 0.37067729733231536, + "velocityX": -1.3602102539182277, + "velocityY": 1.1098906393713428, + "timestamp": 12.115203854839251 + }, + { + "x": 4.646194712073395, + "y": 4.711906473337791, + "heading": -3.3343640691443137, + "angularVelocity": 0.34661512569112146, + "velocityX": -1.2591468512455393, + "velocityY": 1.0648886078544806, + "timestamp": 12.148687912712866 + }, + { + "x": 4.6073289389650105, + "y": 4.745871469229039, + "heading": -3.3235610165789797, + "angularVelocity": 0.32263271692188306, + "velocityX": -1.1607247023369474, + "velocityY": 1.0143631939548117, + "timestamp": 12.18217197058648 + }, + { + "x": 4.571671913310556, + "y": 4.777985020592715, + "heading": -3.3135577653609034, + "angularVelocity": 0.29874668284929173, + "velocityX": -1.0648955926740002, + "velocityY": 0.9590698799078438, + "timestamp": 12.215656028460096 + }, + { + "x": 4.539140023253754, + "y": 4.8081089949988245, + "heading": -3.3043506835291088, + "angularVelocity": 0.2749691171406556, + "velocityX": -0.9715635476319252, + "velocityY": 0.8996512465667004, + "timestamp": 12.24914008633371 + }, + { + "x": 4.509653763898365, + "y": 4.8361234622919635, + "heading": -3.295935836635349, + "angularVelocity": 0.25130905356578065, + "velocityX": -0.8806059130194128, + "velocityY": 0.8366509041072363, + "timestamp": 12.282624144207325 + }, + { + "x": 4.4831381586399495, + "y": 4.861923862501275, + "heading": -3.2883090595510325, + "angularVelocity": 0.22777338138357495, + "velocityX": -0.7918874515895754, + "velocityY": 0.7705278824536537, + "timestamp": 12.31610820208094 + }, + { + "x": 4.45952287584388, + "y": 4.885418621357682, + "heading": -3.281466008896871, + "angularVelocity": 0.20436742404372882, + "velocityX": -0.7052694415116886, + "velocityY": 0.7016699990511293, + "timestamp": 12.349592259954555 + }, + { + "x": 4.438742156297185, + "y": 4.906527159160586, + "heading": -3.275402202793641, + "angularVelocity": 0.18109531784102728, + "velocityX": -0.6206153276025074, + "velocityY": 0.6304056062313884, + "timestamp": 12.38307631782817 + }, + { + "x": 4.420734628952273, + "y": 4.925178234560356, + "heading": -3.2701130518621158, + "angularVelocity": 0.15796027325866763, + "velocityX": -0.5377940574849306, + "velocityY": 0.5570135934589632, + "timestamp": 12.416560375701785 + }, + { + "x": 4.405443065900129, + "y": 4.941308568289058, + "heading": -3.2655938838157965, + "angularVelocity": 0.13496476631885662, + "velocityX": -0.45668189649717433, + "velocityY": 0.48173174797346885, + "timestamp": 12.4500444335754 + }, + { + "x": 4.39281410935265, + "y": 4.954861698436055, + "heading": -3.261839963112179, + "angularVelocity": 0.11211068615955058, + "velocityX": -0.3771632636386863, + "velocityY": 0.4047636698680065, + "timestamp": 12.483528491449015 + }, + { + "x": 4.382797991231194, + "y": 4.9657870261746115, + "heading": -3.258846506645042, + "angularVelocity": 0.08939945326923995, + "velocityX": -0.2991309523852119, + "velocityY": 0.32628445990012805, + "timestamp": 12.51701254932263 + }, + { + "x": 4.375348257896936, + "y": 4.974039017784631, + "heading": -3.2566086961881613, + "angularVelocity": 0.06683211650533652, + "velocityX": -0.22248597712909673, + "velocityY": 0.24644538726955106, + "timestamp": 12.550496607196244 + }, + { + "x": 4.370421507288839, + "y": 4.979576534933385, + "heading": -3.255121688138895, + "angularVelocity": 0.04440943373347284, + "velocityX": -0.1471372026261985, + "velocityY": 0.16537772003787146, + "timestamp": 12.58398066506986 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": 0.02213193847444466, - "velocityX": -0.07300085344241602, - "velocityY": 0.08319587425074677, - "timestamp": 12.617466054720165 + "angularVelocity": 0.022131939219558208, + "velocityX": -0.07300085802266022, + "velocityY": 0.08319587286444159, + "timestamp": 12.617464722943474 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": -4.226950965349435e-29, - "velocityX": 7.000195221592091e-27, - "velocityY": -1.7484350204553325e-27, - "timestamp": 12.650950118068398 + "angularVelocity": 2.730389824214373e-24, + "velocityX": -3.568292000859936e-22, + "velocityY": -3.1134132334801996e-22, + "timestamp": 12.650948780817089 } ], "trajectoryWaypoints": [ @@ -9910,7 +10068,7 @@ "controlIntervalCount": 28 }, { - "timestamp": 2.4934065688719094, + "timestamp": 2.4934060456470437, "isStopPoint": false, "x": 7.916065692901611, "y": 7.4376397132873535, @@ -9921,7 +10079,7 @@ "controlIntervalCount": 21 }, { - "timestamp": 4.4591446544723965, + "timestamp": 4.459144371352818, "isStopPoint": true, "x": 4.96405553817749, "y": 6.72802209854126, @@ -9932,7 +10090,7 @@ "controlIntervalCount": 22 }, { - "timestamp": 6.3182931509409865, + "timestamp": 6.318292754425008, "isStopPoint": false, "x": 7.845104217529297, "y": 5.904865741729736, @@ -9943,7 +10101,7 @@ "controlIntervalCount": 21 }, { - "timestamp": 8.210484334089376, + "timestamp": 8.21048380400154, "isStopPoint": true, "x": 5.077594757080078, "y": 6.458367347717285, @@ -9954,7 +10112,7 @@ "controlIntervalCount": 26 }, { - "timestamp": 8.930570143401457, + "timestamp": 8.93056949494445, "isStopPoint": false, "x": 5.929137229919434, "y": 6.3448286056518555, @@ -9965,7 +10123,7 @@ "controlIntervalCount": 40 }, { - "timestamp": 10.388441501785639, + "timestamp": 10.388440574139693, "isStopPoint": true, "x": 8.001220703125, "y": 4.443053245544434, @@ -9976,7 +10134,7 @@ "controlIntervalCount": 38 }, { - "timestamp": 11.64642821762141, + "timestamp": 11.646427044608643, "isStopPoint": false, "x": 5.645288944244385, "y": 4.159205913543701, @@ -9987,7 +10145,7 @@ "controlIntervalCount": 30 }, { - "timestamp": 12.650950118068398, + "timestamp": 12.650948780817089, "isStopPoint": true, "x": 4.367977142333984, "y": 4.982362270355225, @@ -10019,25 +10177,21 @@ }, { "scope": [ - 4, - 4 + 6 ], - "type": "MaxVelocity", - "velocity": 0.5 + "type": "StopPoint" }, { "scope": [ - 6 + 2 ], "type": "StopPoint" }, { "scope": [ - 2, - 2 + 4 ], - "type": "MaxVelocity", - "velocity": 0.5 + "type": "StopPoint" }, { "scope": [ @@ -10072,7 +10226,7 @@ { "name": "Shoot", "target": 2, - "targetTimestamp": 4.4591446544723965, + "targetTimestamp": 4.459144371352818, "offset": 0, "command": { "type": "named", @@ -10084,7 +10238,7 @@ { "name": "Sh + Intake Off", "target": 4, - "targetTimestamp": 8.210484334089376, + "targetTimestamp": 8.21048380400154, "offset": 0, "command": { "type": "parallel", @@ -10109,7 +10263,7 @@ { "name": "Intake On", "target": 5, - "targetTimestamp": 8.930570143401457, + "targetTimestamp": 8.93056949494445, "offset": 0.5, "command": { "type": "named", @@ -10121,7 +10275,7 @@ { "name": "Intake Off", "target": 6, - "targetTimestamp": 10.388441501785639, + "targetTimestamp": 10.388440574139693, "offset": 1, "command": { "type": "named", @@ -10133,7 +10287,7 @@ { "name": "Shoot", "target": 8, - "targetTimestamp": 12.650950118068398, + "targetTimestamp": 12.650948780817089, "offset": 0, "command": { "type": "named", @@ -10143,18 +10297,18 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Amp Side Start C": { "waypoints": [ { - "x": 1.373390793800354, - "y": 4.741092681884766, - "heading": 2.6399884969262475, + "x": 1.2314672470092773, + "y": 4.670130729675293, + "heading": 2.414268531922355, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 11 + "controlIntervalCount": 15 }, { "x": 2.5087790489196777, @@ -10163,7 +10317,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 13 + "controlIntervalCount": 16 }, { "x": 1.6998157501220703, @@ -10172,7 +10326,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 8 + "controlIntervalCount": 10 }, { "x": 2.4236249923706055, @@ -10181,7 +10335,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 12 + "controlIntervalCount": 14 }, { "x": 1.9552781581878662, @@ -10190,7 +10344,7 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 8 + "controlIntervalCount": 10 }, { "x": 2.5797407627105713, @@ -10204,497 +10358,614 @@ ], "trajectory": [ { - "x": 1.373390793800354, - "y": 4.741092681884766, - "heading": 2.6399884969262475, - "angularVelocity": -3.6988129489772723e-28, - "velocityX": -6.858958396136724e-27, - "velocityY": -1.5418289496585915e-26, + "x": 1.2314672470092771, + "y": 4.670130729675293, + "heading": 2.414268531922355, + "angularVelocity": -5.2100101100154926e-30, + "velocityX": 5.347254929636904e-27, + "velocityY": 9.19140137657714e-27, "timestamp": 0 }, { - "x": 1.411237442090302, - "y": 4.725482025332623, - "heading": 2.644755988404159, - "angularVelocity": 0.0553306640200131, - "velocityX": 0.43924151527419975, - "velocityY": -0.18117452266465503, - "timestamp": 0.08616364112650379 - }, - { - "x": 1.4869306891456044, - "y": 4.694260596197965, - "heading": 2.654289693354832, - "angularVelocity": 0.11064649573798489, - "velocityX": 0.878482455774716, - "velocityY": -0.3623503919573132, - "timestamp": 0.17232728225300759 - }, - { - "x": 1.6004704665028786, - "y": 4.647428216491871, - "heading": 2.668587209347816, - "angularVelocity": 0.16593444527248416, - "velocityX": 1.3177226017013057, - "velocityY": -0.5435283269579504, - "timestamp": 0.2584909233795114 - }, - { - "x": 1.7518566827715065, - "y": 4.58498464715587, - "heading": 2.6876455596924695, - "angularVelocity": 0.22118784786116857, - "velocityX": 1.7569616869645228, - "velocityY": -0.7247090364289812, - "timestamp": 0.34465456450601517 - }, - { - "x": 1.941089213909603, - "y": 4.5069295915038685, - "heading": 2.7114619454581304, - "angularVelocity": 0.2764087665549548, - "velocityX": 2.1961993326195337, - "velocityY": -0.9058931891864103, - "timestamp": 0.43081820563251894 - }, - { - "x": 2.1303192711002823, - "y": 4.428868248917787, - "heading": 2.7352473347586073, - "angularVelocity": 0.2760490270548816, - "velocityX": 2.196170620422779, - "velocityY": -0.9059661542328877, - "timestamp": 0.5169818467590227 - }, - { - "x": 2.2817032282796483, - "y": 4.366418932119097, - "heading": 2.754276421488494, - "angularVelocity": 0.22084821951695574, - "velocityX": 1.7569354683735667, - "velocityY": -0.7247757404657851, - "timestamp": 0.6031454878855265 - }, - { - "x": 2.3952411491674033, - "y": 4.319581824357118, - "heading": 2.7685487866211282, - "angularVelocity": 0.16564254882961663, - "velocityX": 1.317701055843969, - "velocityY": -0.5435831999394507, - "timestamp": 0.6893091290120302 - }, - { - "x": 2.470933081482251, - "y": 4.288357045534494, - "heading": 2.778063858835731, - "angularVelocity": 0.1104302474942169, - "velocityX": 0.8784671971292191, - "velocityY": -0.3623892678442039, - "timestamp": 0.775472770138534 + "x": 1.25427772593092, + "y": 4.663040954972958, + "heading": 2.4209562198461265, + "angularVelocity": 0.07860545105698431, + "velocityX": 0.26810880006649607, + "velocityY": -0.08333148088273383, + "timestamp": 0.08507918768792878 + }, + { + "x": 1.299898487748357, + "y": 4.648861096431842, + "heading": 2.4343273732150403, + "angularVelocity": 0.1571612721310791, + "velocityX": 0.5362152960930298, + "velocityY": -0.1666665952797718, + "timestamp": 0.17015837537585757 + }, + { + "x": 1.3683293697300698, + "y": 4.6275906046406945, + "heading": 2.454369493563087, + "angularVelocity": 0.23557018928720364, + "velocityX": 0.8043198794130212, + "velocityY": -0.2500081673225167, + "timestamp": 0.25523756306378637 + }, + { + "x": 1.4595702265370212, + "y": 4.599228679736338, + "heading": 2.481062894448308, + "angularVelocity": 0.3137477168109834, + "velocityX": 1.0724227544534584, + "velocityY": -0.33335914076175294, + "timestamp": 0.34031675075171514 + }, + { + "x": 1.5736209091482751, + "y": 4.5637742614596535, + "heading": 2.5143822102441398, + "angularVelocity": 0.39162710295315967, + "velocityX": 1.340523877938196, + "velocityY": -0.41672257622782727, + "timestamp": 0.4253959384396439 + }, + { + "x": 1.7104812390640793, + "y": 4.521226021274406, + "heading": 2.5542983242065618, + "angularVelocity": 0.469164257994969, + "velocityX": 1.6086229033804282, + "velocityY": -0.5001016269844418, + "timestamp": 0.5104751261275727 + }, + { + "x": 1.8701509755218075, + "y": 4.471582359349749, + "heading": 2.600780705433162, + "angularVelocity": 0.5463425602639517, + "velocityX": 1.8767190989575278, + "velocityY": -0.5834994817622204, + "timestamp": 0.5955543138155015 + }, + { + "x": 2.0298090975993626, + "y": 4.421877004084367, + "heading": 2.646315216105001, + "angularVelocity": 0.5352015211858865, + "velocityX": 1.876582586368622, + "velocityY": -0.5842246102266782, + "timestamp": 0.6806335015034303 + }, + { + "x": 2.1666583517760736, + "y": 4.379270074305973, + "heading": 2.685326672139293, + "angularVelocity": 0.45853112957996595, + "velocityX": 1.6084927218472653, + "velocityY": -0.5007914501332125, + "timestamp": 0.765712689191359 + }, + { + "x": 2.2806989716360007, + "y": 4.343762747699759, + "heading": 2.717827419605436, + "angularVelocity": 0.38200585065945625, + "velocityX": 1.3404056028159197, + "velocityY": -0.4173444478155432, + "timestamp": 0.8507918768792878 + }, + { + "x": 2.3719311822566893, + "y": 4.315355961950949, + "heading": 2.7438246843650607, + "angularVelocity": 0.3055655027523666, + "velocityX": 1.0723211292910941, + "velocityY": -0.3338864241746834, + "timestamp": 0.9358710645672166 + }, + { + "x": 2.440355176758643, + "y": 4.29405041622838, + "heading": 2.763322145123904, + "angularVelocity": 0.22916839345434334, + "velocityX": 0.8042389256575113, + "velocityY": -0.2504201826740351, + "timestamp": 1.0209502522551455 + }, + { + "x": 2.4859711018991932, + "y": 4.279846572314698, + "heading": 2.776321113344305, + "angularVelocity": 0.1527866987644639, + "velocityX": 0.536158446973772, + "velocityY": -0.1669485134928884, + "timestamp": 1.1060294399430743 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": 0.05521427383525686, - "velocityX": 0.4392336134200937, - "velocityY": -0.18119463988808376, - "timestamp": 0.8616364112650378 + "angularVelocity": 0.07640186212250696, + "velocityX": 0.26807904071844774, + "velocityY": -0.08347419502425253, + "timestamp": 1.1911086276310032 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": -2.766219324607853e-28, - "velocityX": -9.297420403564632e-27, - "velocityY": -2.6804687000261814e-26, - "timestamp": 0.9478000523915415 - }, - { - "x": 2.485712247791879, - "y": 4.293165359703155, - "heading": 2.7875035435672006, - "angularVelocity": 0.06263155257733619, - "velocityX": -0.3085521387410952, - "velocityY": 0.27315672805697044, - "timestamp": 1.022558247949388 - }, - { - "x": 2.439795645378961, - "y": 4.3342479362983335, - "heading": 2.796948863574697, - "angularVelocity": 0.12634494368163166, - "velocityX": -0.6142015878030177, - "velocityY": 0.5495394356246737, - "timestamp": 1.0973164435072345 - }, - { - "x": 2.37135097351757, - "y": 4.396340662085837, - "heading": 2.8112801553510027, - "angularVelocity": 0.19170194878789426, - "velocityX": -0.9155474038753352, - "velocityY": 0.8305808523623003, - "timestamp": 1.172074639065081 - }, - { - "x": 2.2809036686278588, - "y": 4.479989853291562, - "heading": 2.8306966822828405, - "angularVelocity": 0.25972439258266794, - "velocityX": -1.2098647407791576, - "velocityY": 1.1189300461512346, - "timestamp": 1.2468328346229274 - }, - { - "x": 2.1694610822060914, - "y": 4.586171676149044, - "heading": 2.855565368951549, - "angularVelocity": 0.3326549883011264, - "velocityX": -1.4907072808563897, - "velocityY": 1.420336888352538, - "timestamp": 1.3215910301807738 - }, - { - "x": 2.0396783229737445, - "y": 4.717080893375947, - "heading": 2.8867637105218655, - "angularVelocity": 0.4173233628435488, - "velocityX": -1.7360338657709218, - "velocityY": 1.7511018858876508, - "timestamp": 1.3963492257386203 - }, - { - "x": 1.9083459965924492, - "y": 4.878682966459805, - "heading": 2.927751972703886, - "angularVelocity": 0.5482778426654837, - "velocityX": -1.7567615884959766, - "velocityY": 2.1616636393907322, - "timestamp": 1.4711074212964668 - }, - { - "x": 1.8072662278781861, - "y": 5.034315326748822, - "heading": 2.9680728874159334, - "angularVelocity": 0.539351096039333, - "velocityX": -1.3520894660445504, - "velocityY": 2.081810015981342, - "timestamp": 1.5458656168543132 - }, - { - "x": 1.7337783112249077, - "y": 5.176201891301336, - "heading": 3.005629932991069, - "angularVelocity": 0.5023803115482496, - "velocityX": -0.9830081652574799, - "velocityY": 1.8979399314517253, - "timestamp": 1.6206238124121597 - }, - { - "x": 1.6867607756102783, - "y": 5.302300031050603, - "heading": 3.039795163689665, - "angularVelocity": 0.4570098360942832, - "velocityX": -0.6289281765535397, - "velocityY": 1.6867467012589215, - "timestamp": 1.6953820079700062 - }, - { - "x": 1.66563929435333, - "y": 5.411689307516261, - "heading": 3.0702577432581744, - "angularVelocity": 0.40748147198038986, - "velocityX": -0.2825306456280759, - "velocityY": 1.4632412627056373, - "timestamp": 1.7701402035278526 - }, - { - "x": 1.6700678493315473, - "y": 5.503848245609138, - "heading": 3.096827358057357, - "angularVelocity": 0.3554073851156999, - "velocityX": 0.059238387780379306, - "velocityY": 1.2327603335685882, - "timestamp": 1.844898399085699 + "angularVelocity": 1.3083302481141851e-23, + "velocityX": 3.175111039019461e-23, + "velocityY": -1.059107290269951e-22, + "timestamp": 1.276187815318932 + }, + { + "x": 2.4961384531980824, + "y": 4.293147174010466, + "heading": 2.7879029651962903, + "angularVelocity": 0.0596298372930921, + "velocityX": -0.1483293088992677, + "velocityY": 0.23941050888166174, + "timestamp": 1.3614076266657247 + }, + { + "x": 2.4708572541131812, + "y": 4.333952271885203, + "heading": 2.7980693711600293, + "angularVelocity": 0.11929627398925077, + "velocityX": -0.2966587074691136, + "velocityY": 0.4788217344049931, + "timestamp": 1.4466274380125173 + }, + { + "x": 2.43293550597329, + "y": 4.39515996535009, + "heading": 2.81333132170297, + "angularVelocity": 0.17908923173783667, + "velocityX": -0.4449874687656011, + "velocityY": 0.7182331490480437, + "timestamp": 1.5318472493593098 + }, + { + "x": 2.3823733177577484, + "y": 4.4767702188313825, + "heading": 2.833707465015003, + "angularVelocity": 0.23910101407188608, + "velocityX": -0.5933149512592097, + "velocityY": 0.9576441462559535, + "timestamp": 1.6170670607061024 + }, + { + "x": 2.3191708434490903, + "y": 4.578782935778785, + "heading": 2.8592245757517496, + "angularVelocity": 0.29942697987100375, + "velocityX": -0.7416406268662431, + "velocityY": 1.1970540105078704, + "timestamp": 1.702286872052895 + }, + { + "x": 2.2433282697859203, + "y": 4.701197946502626, + "heading": 2.889917854748574, + "angularVelocity": 0.36016600496710854, + "velocityX": -0.8899641112151426, + "velocityY": 1.4364618835599956, + "timestamp": 1.7875066833996875 + }, + { + "x": 2.1548458019426757, + "y": 4.844014991577765, + "heading": 2.92583130513466, + "angularVelocity": 0.42142137865032253, + "velocityX": -1.0382851879731971, + "velocityY": 1.6758667124239617, + "timestamp": 1.8727264947464801 + }, + { + "x": 2.0537236539135044, + "y": 5.007233688756998, + "heading": 2.9670187669038475, + "angularVelocity": 0.48330853023811365, + "velocityX": -1.1866037536467386, + "velocityY": 1.915267055861383, + "timestamp": 1.9579463060932727 + }, + { + "x": 1.9652468625527026, + "y": 5.150036653856614, + "heading": 3.004999757447428, + "angularVelocity": 0.4456826404956622, + "velocityX": -1.038218578081046, + "velocityY": 1.675701492913359, + "timestamp": 2.043166117440065 + }, + { + "x": 1.8894096037270685, + "y": 5.272438573207108, + "heading": 3.037623268634309, + "angularVelocity": 0.38281604560379573, + "velocityX": -0.8899017449947522, + "velocityY": 1.4363082646638674, + "timestamp": 2.1283859287868574 + }, + { + "x": 1.826211820751686, + "y": 5.374439786670781, + "heading": 3.0648511640007152, + "angularVelocity": 0.31950194369247265, + "velocityX": -0.7415855770697051, + "velocityY": 1.196919024481186, + "timestamp": 2.2136057401336497 + }, + { + "x": 1.775653508102984, + "y": 5.456040555547696, + "heading": 3.0866552681926986, + "angularVelocity": 0.25585722201676364, + "velocityX": -0.5932694739602328, + "velocityY": 0.9575328504876601, + "timestamp": 2.298825551480442 + }, + { + "x": 1.7377346923011106, + "y": 5.517241063340047, + "heading": 3.103016273246131, + "angularVelocity": 0.19198593372675934, + "velocityX": -0.4449530596537833, + "velocityY": 0.718148829775071, + "timestamp": 2.3840453628272344 + }, + { + "x": 1.7124554199802746, + "y": 5.558041412096877, + "heading": 3.113923384428593, + "angularVelocity": 0.1279879761535398, + "velocityX": -0.29663609812470576, + "velocityY": 0.4787660065427378, + "timestamp": 2.469265174174027 + }, + { + "x": 1.6998157501220703, + "y": 5.578441619873047, + "heading": 3.119374105883044, + "angularVelocity": 0.06396073129368503, + "velocityX": -0.14831844448432865, + "velocityY": 0.23938339517267646, + "timestamp": 2.554484985520819 }, { "x": 1.6998157501220703, "y": 5.578441619873047, "heading": 3.119374105883044, - "angularVelocity": 0.3015956666348506, - "velocityX": 0.3979216000138016, - "velocityY": 0.9977952745821669, - "timestamp": 1.9196565946435455 - }, - { - "x": 1.7709826420562977, - "y": 5.642054671165342, - "heading": 3.1403920142026824, - "angularVelocity": 0.235935182853837, - "velocityX": 0.7988793844891111, - "velocityY": 0.714084230470965, - "timestamp": 2.0087399948613887 - }, - { - "x": 1.8769896454817743, - "y": 5.679202945892192, - "heading": 3.155122468211894, - "angularVelocity": 0.165355767440287, - "velocityX": 1.1899748232134009, - "velocityY": 0.41700557720079373, - "timestamp": 2.0978233950792315 - }, - { - "x": 2.0158411922869908, - "y": 5.6874616166026, - "heading": 3.162677726672294, - "angularVelocity": 0.08481106964848781, - "velocityX": 1.5586691399932127, - "velocityY": 0.09270717878091565, - "timestamp": 2.1869067952970744 - }, - { - "x": 2.179488895661179, - "y": 5.65973110035875, - "heading": 3.160185249129962, - "angularVelocity": -0.027979146914432176, - "velocityX": 1.837016806430909, - "velocityY": -0.31128713291183985, - "timestamp": 2.2759901955149173 - }, - { - "x": 2.302727279564493, - "y": 5.615213661893722, - "heading": 3.152124381433497, - "angularVelocity": -0.09048675372463387, - "velocityX": 1.3834045804487551, - "velocityY": -0.49972765247133827, - "timestamp": 2.36507359573276 - }, - { - "x": 2.3835854229640785, - "y": 5.5816948392958325, - "heading": 3.1456792910205356, - "angularVelocity": -0.0723489493800244, - "velocityX": 0.9076679067239992, - "velocityY": -0.3762633949301785, - "timestamp": 2.454156995950603 + "angularVelocity": -3.4316659457512185e-22, + "velocityX": -1.2045271909880823e-19, + "velocityY": 2.513903520736929e-21, + "timestamp": 2.6397047968676115 + }, + { + "x": 1.7287681227432554, + "y": 5.577863962119422, + "heading": 3.120286516385215, + "angularVelocity": 0.009755413431152524, + "velocityX": 0.30955624037688323, + "velocityY": -0.006176266269302699, + "timestamp": 2.7332334318773133 + }, + { + "x": 1.786672866957634, + "y": 5.576708644835487, + "heading": 3.122111340489658, + "angularVelocity": 0.01951086000831366, + "velocityX": 0.6191124697625702, + "velocityY": -0.01235255153477734, + "timestamp": 2.826762066887015 + }, + { + "x": 1.87352998092093, + "y": 5.5749756652217295, + "heading": 3.1248485866529543, + "angularVelocity": 0.02926639700250132, + "velocityX": 0.9286686794294203, + "velocityY": -0.0185288667323963, + "timestamp": 2.920290701896717 + }, + { + "x": 1.9893394603702492, + "y": 5.572665018738519, + "heading": 3.1284982784106385, + "angularVelocity": 0.03902218563657427, + "velocityX": 1.2382248435177754, + "velocityY": -0.024705230467347593, + "timestamp": 3.0138193369064186 + }, + { + "x": 2.1341012843457174, + "y": 5.569776692693561, + "heading": 3.1330605100745275, + "angularVelocity": 0.048778982644361334, + "velocityX": 1.5477807835049844, + "velocityY": -0.030881729907188495, + "timestamp": 3.1073479719161203 + }, + { + "x": 2.249910763173944, + "y": 5.5674660191857654, + "heading": 3.136710398653379, + "angularVelocity": 0.039024290031313275, + "velocityX": 1.2382248368771065, + "velocityY": -0.024705519411841684, + "timestamp": 3.200876606925822 + }, + { + "x": 2.336767876421202, + "y": 5.56573301061262, + "heading": 3.1394478461474296, + "angularVelocity": 0.029268549613353196, + "velocityX": 0.9286686717736026, + "velocityY": -0.018529176363649796, + "timestamp": 3.294405241935524 + }, + { + "x": 2.39467262006123, + "y": 5.564577670368081, + "heading": 3.1412728202985685, + "angularVelocity": 0.019512464294487476, + "velocityX": 0.6191124636216653, + "velocityY": -0.012352797027553951, + "timestamp": 3.3879338769452256 }, { "x": 2.4236249923706055, "y": 5.564, "heading": 3.142185307179586, - "angularVelocity": -0.03922149168537586, - "velocityX": 0.4494616203312267, - "velocityY": -0.1986322844947736, - "timestamp": 2.543240396168446 + "angularVelocity": 0.009756230067115347, + "velocityX": 0.3095562370430423, + "velocityY": -0.006176401141967854, + "timestamp": 3.4814625119549274 }, { "x": 2.4236249923706055, "y": 5.564, "heading": 3.142185307179586, - "angularVelocity": -1.3163055540056727e-20, - "velocityX": -6.385708612136203e-20, - "velocityY": -2.8704334108285326e-20, - "timestamp": 2.632323796386289 - }, - { - "x": 2.409612055518575, - "y": 5.58524376278675, - "heading": 3.148111521834478, - "angularVelocity": 0.08717591331517136, - "velocityX": -0.20613336496261087, - "velocityY": 0.31250039545180536, - "timestamp": 2.7003037512789456 - }, - { - "x": 2.3815864744249673, - "y": 5.6277314809234555, - "heading": 3.159971962699225, - "angularVelocity": 0.17446967835555188, - "velocityX": -0.4122624255615048, - "velocityY": 0.6250036235504083, - "timestamp": 2.7682837061716024 - }, - { - "x": 2.3395487510664066, - "y": 5.691463368053803, - "heading": 3.1777843874051737, - "angularVelocity": 0.2620246620356821, - "velocityX": -0.6183841019744774, - "velocityY": 0.9375099943943577, - "timestamp": 2.836263661064259 - }, - { - "x": 2.283499791323817, - "y": 5.776439782459147, - "heading": 3.201576339928571, - "angularVelocity": 0.34998482362875394, - "velocityX": -0.8244924526809903, - "velocityY": 1.2500216356353748, - "timestamp": 2.904243615956916 - }, - { - "x": 2.2134415121987265, - "y": 5.8826616080438106, - "heading": 3.2313857853388175, - "angularVelocity": 0.43850345969362503, - "velocityX": -1.0305726038758856, - "velocityY": 1.5625462793026774, - "timestamp": 2.9722235708495726 - }, - { - "x": 2.129379950303024, - "y": 6.010132186700346, - "heading": 3.267266255767484, - "angularVelocity": 0.527809565118472, - "velocityX": -1.2365639551900183, - "velocityY": 1.8751200829391979, - "timestamp": 3.0402035257422293 - }, - { - "x": 2.0652995239269436, - "y": 6.149747163890891, - "heading": 3.339691350620692, - "angularVelocity": 1.0653889807307233, - "velocityX": -0.9426370829057792, - "velocityY": 2.0537668406958973, - "timestamp": 3.108183480634886 - }, - { - "x": 2.0152486713845863, - "y": 6.268131297939755, - "heading": 3.405944606191115, - "angularVelocity": 0.9745998754344565, - "velocityX": -0.736258984304856, - "velocityY": 1.7414564960478351, - "timestamp": 3.1761634355275428 - }, - { - "x": 1.9792219228775823, - "y": 6.3652817383289895, - "heading": 3.465961537990357, - "angularVelocity": 0.8828621892146225, - "velocityX": -0.529961347633911, - "velocityY": 1.429104219657847, - "timestamp": 3.2441433904201995 - }, - { - "x": 1.9572180136114146, - "y": 6.441198107657332, - "heading": 3.5197002979628174, - "angularVelocity": 0.7905089089470001, - "velocityX": -0.32368231636681893, - "velocityY": 1.116746391612311, - "timestamp": 3.3121233453128562 - }, - { - "x": 1.949236712516745, - "y": 6.495880541543467, - "heading": 3.567133251485307, - "angularVelocity": 0.6977491173300784, - "velocityX": -0.11740668418025209, - "velocityY": 0.8043905585473795, - "timestamp": 3.380103300205513 + "angularVelocity": 3.3410580458147742e-22, + "velocityX": 1.2042686799658795e-19, + "velocityY": -2.4047952466491755e-21, + "timestamp": 3.574991146964629 + }, + { + "x": 2.4140779254680305, + "y": 5.583709309226524, + "heading": 3.151463363949818, + "angularVelocity": 0.11372307764511755, + "velocityX": -0.11702039096464664, + "velocityY": 0.24158111542184144, + "timestamp": 3.656575790665394 + }, + { + "x": 2.3949829879765785, + "y": 5.62312756336461, + "heading": 3.1700362858815154, + "angularVelocity": 0.22765217924857556, + "velocityX": -0.23405063287998745, + "velocityY": 0.4831577653591796, + "timestamp": 3.738160434366159 + }, + { + "x": 2.3663391576755437, + "y": 5.682253860614875, + "heading": 3.197942084713568, + "angularVelocity": 0.3420471986665186, + "velocityX": -0.35109340436778835, + "velocityY": 0.7247233617533075, + "timestamp": 3.819745078066924 + }, + { + "x": 2.328145078144294, + "y": 5.7610867485151145, + "heading": 3.2352374385677356, + "angularVelocity": 0.45713693364843233, + "velocityX": -0.46815280178630153, + "velocityY": 0.9662711550151736, + "timestamp": 3.901329721767689 + }, + { + "x": 2.2803989066713406, + "y": 5.859624221147295, + "heading": 3.2819935759092966, + "angularVelocity": 0.5730997307906688, + "velocityX": -0.5852347857039822, + "velocityY": 1.2077943613211701, + "timestamp": 3.9829143654684542 + }, + { + "x": 2.223098132213267, + "y": 5.977863741088111, + "heading": 3.3382899990774475, + "angularVelocity": 0.6900370046921317, + "velocityX": -0.7023475480047573, + "velocityY": 1.4492864659002822, + "timestamp": 4.064499009169219 + }, + { + "x": 2.1562393685944863, + "y": 6.115802289227864, + "heading": 3.4042057129719607, + "angularVelocity": 0.8079426581340238, + "velocityX": -0.8195018153661886, + "velocityY": 1.6907415646219235, + "timestamp": 4.146083652869984 + }, + { + "x": 2.098828464211886, + "y": 6.233956292510019, + "heading": 3.4624873051908924, + "angularVelocity": 0.714369635941493, + "velocityX": -0.7036974334676412, + "velocityY": 1.4482382703725323, + "timestamp": 4.227668296570749 + }, + { + "x": 2.05098170212058, + "y": 6.3324155783553335, + "heading": 3.5110711178320413, + "angularVelocity": 0.5955019282714947, + "velocityX": -0.5864677459007784, + "velocityY": 1.2068360095613324, + "timestamp": 4.309252940271514 + }, + { + "x": 2.012701638553593, + "y": 6.41118168027954, + "heading": 3.549941318600023, + "angularVelocity": 0.47644016085366725, + "velocityX": -0.4692067260523973, + "velocityY": 0.9654525453724375, + "timestamp": 4.390837583972279 + }, + { + "x": 1.983990243171154, + "y": 6.470255634029948, + "heading": 3.579093105150347, + "angularVelocity": 0.3573195300974364, + "velocityX": -0.3519215636676191, + "velocityY": 0.7240817765544071, + "timestamp": 4.472422227673044 + }, + { + "x": 1.9648488560972521, + "y": 6.509638074951002, + "heading": 3.5985266556625928, + "angularVelocity": 0.238201083325482, + "velocityX": -0.23461997510350763, + "velocityY": 0.48271879528578393, + "timestamp": 4.554006871373809 + }, + { + "x": 1.9552781581878664, + "y": 6.529329299926758, + "heading": 3.608243235262859, + "angularVelocity": 0.11909814346808352, + "velocityX": -0.1173100411455963, + "velocityY": 0.24135945298700673, + "timestamp": 4.635591515074574 }, { "x": 1.9552781581878664, "y": 6.529329299926758, "heading": 3.608243235262859, - "angularVelocity": 0.6047368498915096, - "velocityX": 0.08887098675868511, - "velocityY": 0.49203854924752166, - "timestamp": 3.4480832550981697 - }, - { - "x": 2.0006043407435827, - "y": 6.583133113105081, - "heading": 3.6496542119455833, - "angularVelocity": 0.4878402887555722, - "velocityX": 0.5339632087304119, - "velocityY": 0.6338335837419347, - "timestamp": 3.532969595232887 - }, - { - "x": 2.083776428758392, - "y": 6.64875146963275, - "heading": 3.6808388847002447, - "angularVelocity": 0.36736974058689287, - "velocityX": 0.9798053241877831, - "velocityY": 0.7730143203668534, - "timestamp": 3.6178559353676043 - }, - { - "x": 2.204973941262137, - "y": 6.7255300317827444, - "heading": 3.700977494901769, - "angularVelocity": 0.23724206002477527, - "velocityX": 1.4277622561109762, - "velocityY": 0.9044866586089649, - "timestamp": 3.7027422755023216 - }, - { - "x": 2.3546609278681885, - "y": 6.778279098781838, - "heading": 3.666800571270185, - "angularVelocity": -0.4026198276111786, - "velocityX": 1.7633813210522657, - "velocityY": 0.6214081902385484, - "timestamp": 3.787628615637039 - }, - { - "x": 2.4671462438769933, - "y": 6.817185614214145, - "heading": 3.640375034259479, - "angularVelocity": -0.3113049398615635, - "velocityX": 1.3251285875947652, - "velocityY": 0.45833658714189324, - "timestamp": 3.872514955771756 - }, - { - "x": 2.542197289718945, - "y": 6.842935062369607, - "heading": 3.6225306420612564, - "angularVelocity": -0.2102151202408199, - "velocityX": 0.8841357245799891, - "velocityY": 0.3033403032171308, - "timestamp": 3.9574012959064735 + "angularVelocity": -9.888785845800769e-24, + "velocityX": -4.720252750565187e-22, + "velocityY": -2.4396364960678477e-22, + "timestamp": 4.717176158775339 + }, + { + "x": 1.9802566647379416, + "y": 6.54238626614273, + "heading": 3.6084550653858125, + "angularVelocity": 0.0022957571929635837, + "velocityX": 0.2707102525469008, + "velocityY": 0.14150784454371504, + "timestamp": 4.809446423071101 + }, + { + "x": 2.0302136769874943, + "y": 6.5685001981039175, + "heading": 3.6088787250144767, + "angularVelocity": 0.004591507696416521, + "velocityX": 0.5414204958752578, + "velocityY": 0.28301568398549637, + "timestamp": 4.901716687366863 + }, + { + "x": 2.1051491934031836, + "y": 6.607671094967555, + "heading": 3.609514212959391, + "angularVelocity": 0.0068872453088156165, + "velocityX": 0.8121307225856843, + "velocityY": 0.42452351429360885, + "timestamp": 4.993986951662626 + }, + { + "x": 2.2050632103951786, + "y": 6.659898954789809, + "heading": 3.610361527196442, + "angularVelocity": 0.009182960984431228, + "velocityX": 1.0828409103904961, + "velocityY": 0.5660313235349994, + "timestamp": 5.086257215958388 + }, + { + "x": 2.3299557099523103, + "y": 6.725183767963683, + "heading": 3.61142066210994, + "angularVelocity": 0.011478615798723989, + "velocityX": 1.3535509029951656, + "velocityY": 0.7075390286583688, + "timestamp": 5.17852748025415 + }, + { + "x": 2.4298697271063556, + "y": 6.777411627477712, + "heading": 3.612267964972866, + "angularVelocity": 0.009182837714761008, + "velocityX": 1.0828409121467542, + "velocityY": 0.5660313201945365, + "timestamp": 5.270797744549912 + }, + { + "x": 2.504805243696443, + "y": 6.816582524011431, + "heading": 3.6129034408171097, + "angularVelocity": 0.0068871141650438715, + "velocityX": 0.8121307244757614, + "velocityY": 0.42452351071804617, + "timestamp": 5.363068008845675 + }, + { + "x": 2.5547622560844396, + "y": 6.842696455711132, + "heading": 3.613327090986633, + "angularVelocity": 0.004591405180818135, + "velocityX": 0.541420497375673, + "velocityY": 0.2830156811515774, + "timestamp": 5.455338273141437 }, { "x": 2.5797407627105713, "y": 6.855753421783447, "heading": 3.6135389160282902, - "angularVelocity": -0.10592665461482069, - "velocityX": 0.4422793223508465, - "velocityY": 0.15100615002955248, - "timestamp": 4.04228763604119 + "angularVelocity": 0.0022957021232574135, + "velocityX": 0.2707102533711829, + "velocityY": 0.14150784298679514, + "timestamp": 5.547608537437199 }, { "x": 2.5797407627105713, "y": 6.855753421783447, "heading": 3.6135389160282902, - "angularVelocity": -3.766803016126858e-21, - "velocityX": -3.2775605320598313e-21, - "velocityY": 2.0004094663730272e-21, - "timestamp": 4.127173976175907 + "angularVelocity": 1.7177582135515924e-25, + "velocityX": 2.3572095291926415e-22, + "velocityY": 1.2321856311211027e-22, + "timestamp": 5.639878801732961 } ], "trajectoryWaypoints": [ { "timestamp": 0, "isStopPoint": true, - "x": 1.373390793800354, - "y": 4.741092681884766, - "heading": 2.6399884969262475, + "x": 1.2314672470092773, + "y": 4.670130729675293, + "heading": 2.414268531922355, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 11 + "controlIntervalCount": 15 }, { - "timestamp": 0.9478000523915415, + "timestamp": 1.276187815318932, "isStopPoint": true, "x": 2.5087790489196777, "y": 4.272744655609131, @@ -10702,21 +10973,21 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 13 + "controlIntervalCount": 16 }, { - "timestamp": 1.9196565946435455, - "isStopPoint": false, + "timestamp": 2.6397047968676115, + "isStopPoint": true, "x": 1.6998157501220703, "y": 5.578441619873047, "heading": 3.1193741058830438, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 8 + "controlIntervalCount": 10 }, { - "timestamp": 2.632323796386289, + "timestamp": 3.574991146964629, "isStopPoint": true, "x": 2.4236249923706055, "y": 5.564, @@ -10724,21 +10995,21 @@ "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 12 + "controlIntervalCount": 14 }, { - "timestamp": 3.4480832550981697, - "isStopPoint": false, + "timestamp": 4.717176158775339, + "isStopPoint": true, "x": 1.9552781581878662, "y": 6.529329299926758, "heading": 3.608243235262859, "isInitialGuess": false, "translationConstrained": true, "headingConstrained": true, - "controlIntervalCount": 8 + "controlIntervalCount": 10 }, { - "timestamp": 4.127173976175907, + "timestamp": 5.639878801732961, "isStopPoint": true, "x": 2.5797407627105713, "y": 6.855753421783447, @@ -10787,6 +11058,18 @@ ], "type": "MaxVelocity", "velocity": 0.5 + }, + { + "scope": [ + 2 + ], + "type": "StopPoint" + }, + { + "scope": [ + 4 + ], + "type": "StopPoint" } ], "usesControlIntervalGuessing": true, @@ -10822,7 +11105,7 @@ { "name": "Marker", "target": 3, - "targetTimestamp": 2.632323796386289, + "targetTimestamp": 3.574991146964629, "offset": 0, "command": { "type": "named", @@ -10834,7 +11117,7 @@ { "name": "Marker", "target": 2, - "targetTimestamp": 1.9196565946435455, + "targetTimestamp": 2.6397047968676115, "offset": 0, "command": { "type": "named", @@ -10844,7 +11127,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false }, "Source Side Start B": { "waypoints": [ @@ -12342,7 +12625,7 @@ } } ], - "isTrajectoryStale": true + "isTrajectoryStale": false } }, "splitTrajectoriesAtStopPoints": true, diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid A.1.traj b/Robot/src/main/deploy/choreo/Amp Side Mid A.1.traj index 97fd35a..ca23309 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid A.1.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid A.1.traj @@ -4,1918 +4,487 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": 2.138090744083086e-22, - "velocityX": 8.395290935795329e-21, - "velocityY": 1.2014410640329063e-20, + "angularVelocity": 3.3655423830458915e-22, + "velocityX": 6.379206572795731e-21, + "velocityY": 6.00570137114375e-21, "timestamp": 0 }, { - "x": 2.604589766672516, - "y": 6.860513178172266, - "heading": -2.671504019088023, - "angularVelocity": -0.021246762972301565, - "velocityX": 0.2842124016542836, - "velocityY": 0.054440081245398515, - "timestamp": 0.08743110370029157 - }, - { - "x": 2.6542901215482235, - "y": 6.8700203662565915, - "heading": -2.675220477646094, - "angularVelocity": -0.04250728174278654, - "velocityX": 0.5684516467512226, - "velocityY": 0.10873919785932558, - "timestamp": 0.17486220740058314 - }, - { - "x": 2.7288445568610946, - "y": 6.884260625866981, - "heading": -2.6807965298828265, - "angularVelocity": -0.06377652804025735, - "velocityX": 0.8527221109828285, - "velocityY": 0.1628740689263849, - "timestamp": 0.2622933111008747 - }, - { - "x": 2.8282562855247506, - "y": 6.903217009019292, - "heading": -2.688232564646954, - "angularVelocity": -0.08505022182514968, - "velocityX": 1.1370293231620792, - "velocityY": 0.21681509611603708, - "timestamp": 0.3497244148011663 - }, - { - "x": 2.952529143619552, - "y": 6.926869208476042, - "heading": -2.697528688552468, - "angularVelocity": -0.10632513501580529, - "velocityX": 1.4213804108066732, - "velocityY": 0.2705238577088996, - "timestamp": 0.43715551850145784 - }, - { - "x": 3.101667789963631, - "y": 6.955192446614957, - "heading": -2.7086848533162016, - "angularVelocity": -0.12759949596400413, - "velocityX": 1.705784784043409, - "velocityY": 0.32394922333368664, - "timestamp": 0.5245866222017495 - }, - { - "x": 3.2756780012561117, - "y": 6.988155814528643, - "heading": -2.721701033579155, - "angularVelocity": -0.14887356686668493, - "velocityX": 1.990255228722458, - "velocityY": 0.37702106594332374, - "timestamp": 0.6120177259020411 - }, - { - "x": 3.4745671276840473, - "y": 7.025719673404508, - "heading": -2.736577482795638, - "angularVelocity": -0.1701505366726105, - "velocityX": 2.2748097417335074, - "velocityY": 0.42963953657307824, - "timestamp": 0.6994488296023327 - }, - { - "x": 3.6983448349031947, - "y": 7.067831347797815, - "heading": -2.753315121465556, - "angularVelocity": -0.1914380347672825, - "velocityX": 2.5594748064286494, - "velocityY": 0.48165552773605236, - "timestamp": 0.7868799333026243 - }, - { - "x": 3.947024398434649, - "y": 7.1144174317493984, - "heading": -2.7719161751976173, - "angularVelocity": -0.2127509884334108, - "velocityX": 2.844291710921471, - "velocityY": 0.5328319325726028, - "timestamp": 0.8743110370029159 - }, - { - "x": 4.220625178803467, - "y": 7.165368564094144, - "heading": -2.792385350903891, - "angularVelocity": -0.2341177777698074, - "velocityX": 3.129330052914627, - "velocityY": 0.582757510638344, - "timestamp": 0.9617421407032075 - }, - { - "x": 4.519178004654404, - "y": 7.220504479528652, - "heading": -2.814732394345908, - "angularVelocity": -0.25559603500627764, - "velocityX": 3.4147209999127814, - "velocityY": 0.6306212903763969, - "timestamp": 1.0491732444034991 - }, - { - "x": 4.842739369959763, - "y": 7.2794721381065175, - "heading": -2.83897926425426, - "angularVelocity": -0.27732544691953914, - "velocityX": 3.700758101081589, - "velocityY": 0.6744471484656239, - "timestamp": 1.1366043481037906 - }, - { - "x": 5.191441788464345, - "y": 7.341270741000058, - "heading": -2.8651925381906103, - "angularVelocity": -0.2998163448354441, - "velocityX": 3.9883108384392805, - "velocityY": 0.7068262926816484, - "timestamp": 1.2240354518040821 - }, - { - "x": 5.561204157509806, - "y": 7.389060004842413, - "heading": -2.8942968081284857, - "angularVelocity": -0.33288233484553686, - "velocityX": 4.229185648999519, - "velocityY": 0.5465933954828472, - "timestamp": 1.3114665555043736 - }, - { - "x": 5.90676702099797, - "y": 7.429462102575199, - "heading": -2.9217646179534578, - "angularVelocity": -0.31416519593679304, - "velocityX": 3.9524019355026363, - "velocityY": 0.46210211266784756, - "timestamp": 1.3988976592046651 - }, - { - "x": 6.227776320980141, - "y": 7.463758279292559, - "heading": -2.9475006078951895, - "angularVelocity": -0.2943573722911377, - "velocityX": 3.671568656877204, - "velocityY": 0.39226516955480606, - "timestamp": 1.4863287629049566 - }, - { - "x": 6.524134980202349, - "y": 7.492353826396467, - "heading": -2.971474957941676, - "angularVelocity": -0.27420847995547176, - "velocityX": 3.3896250496631803, - "velocityY": 0.3270637781484755, - "timestamp": 1.5737598666052481 - }, - { - "x": 6.795798003981723, - "y": 7.515447318802456, - "heading": -2.9936725567296794, - "angularVelocity": -0.25388675023588664, - "velocityX": 3.107166812289346, - "velocityY": 0.26413360267248104, - "timestamp": 1.6611909703055396 - }, - { - "x": 7.042739486323945, - "y": 7.533156595046494, - "heading": -3.0140838093526265, - "angularVelocity": -0.23345527803143726, - "velocityX": 2.824412273105024, - "velocityY": 0.20255121455111968, - "timestamp": 1.7486220740058311 - }, - { - "x": 7.264942602620708, - "y": 7.545559665755271, - "heading": -3.032701765954018, - "angularVelocity": -0.21294431630661517, - "velocityX": 2.541465301164011, - "velocityY": 0.14186107899647651, - "timestamp": 1.8360531777061226 - }, - { - "x": 7.462395551623203, - "y": 7.5527119818078186, - "heading": -3.0495209788957442, - "angularVelocity": -0.19237104680025272, - "velocityX": 2.2583833515284413, - "velocityY": 0.08180516715270715, - "timestamp": 1.9234842814064141 - }, - { - "x": 7.635089599917891, - "y": 7.554654982123625, - "heading": -3.0645369861632634, - "angularVelocity": -0.17174674265800233, - "velocityX": 1.9752015128011309, - "velocityY": 0.02222321615047185, - "timestamp": 2.010915385106706 - }, - { - "x": 7.783018023947976, - "y": 7.551420808420136, - "heading": -3.077746062264594, - "angularVelocity": -0.15107982791352897, - "velocityX": 1.6919427728737597, - "velocityY": -0.03699111147646792, - "timestamp": 2.0983464888069974 - }, - { - "x": 7.9061754878102075, - "y": 7.5430351187739655, - "heading": -3.089145095467739, - "angularVelocity": -0.13037732249406989, - "velocityX": 1.4086230031409384, - "velocityY": -0.09591197287085713, - "timestamp": 2.185777592507289 - }, - { - "x": 8.004557653466987, - "y": 7.5295188704834, - "heading": -3.0987315280382326, - "angularVelocity": -0.1096455627891347, - "velocityX": 1.1252536167681009, - "velocityY": -0.1545931335477347, - "timestamp": 2.2732086962075804 - }, - { - "x": 8.0781609241493, - "y": 7.510889504584073, - "heading": -3.1065033281773795, - "angularVelocity": -0.08889056422972949, - "velocityX": 0.8418430920718916, - "velocityY": -0.21307481103277137, - "timestamp": 2.360639799907872 - }, - { - "x": 8.126982268554706, - "y": 7.48716176359185, - "heading": -3.1124589770111943, - "angularVelocity": -0.06811819343183008, - "velocityX": 0.5583978966199632, - "velocityY": -0.27138786985420976, - "timestamp": 2.4480709036081634 + "x": 2.6050610765354496, + "y": 6.860345987159577, + "heading": -2.6712752622193263, + "angularVelocity": -0.018473587950192584, + "velocityX": 0.28716640227144474, + "velocityY": 0.05208586613029278, + "timestamp": 0.08817296739659823 + }, + { + "x": 2.655702449187344, + "y": 6.869526965685582, + "heading": -2.674534004894112, + "angularVelocity": -0.03695852335476156, + "velocityX": 0.5743412538687886, + "velocityY": 0.10412464043213543, + "timestamp": 0.17634593479319646 + }, + { + "x": 2.7316657503038435, + "y": 6.883291516752998, + "heading": -2.6794232791182258, + "angularVelocity": -0.05545094339540405, + "velocityX": 0.861525968325646, + "velocityY": 0.156108515725732, + "timestamp": 0.2645189021897947 + }, + { + "x": 2.8329520075707495, + "y": 6.901633922922054, + "heading": -2.6859434576928263, + "angularVelocity": -0.07394759150242652, + "velocityX": 1.1487223381212155, + "velocityY": 0.2080275475651401, + "timestamp": 0.3526918695863929 + }, + { + "x": 2.9595624533624134, + "y": 6.9245473261835055, + "heading": -2.694094701532431, + "angularVelocity": -0.09244606459642621, + "velocityX": 1.4359326846988782, + "velocityY": 0.2598688003590563, + "timestamp": 0.44086483698299117 + }, + { + "x": 3.1114985918883113, + "y": 6.952023347160384, + "heading": -2.703877064931321, + "angularVelocity": -0.11094515346057994, + "velocityX": 1.7231600910344236, + "velocityY": 0.31161501975194, + "timestamp": 0.5290378043795894 + }, + { + "x": 3.2887622995138552, + "y": 6.984051514205735, + "heading": -2.715290645068638, + "angularVelocity": -0.12944534446685022, + "velocityX": 2.01040877787655, + "velocityY": 0.36324247658910663, + "timestamp": 0.6172107717761876 + }, + { + "x": 3.4913559816226885, + "y": 7.020618366869622, + "heading": -2.7283358019554202, + "angularVelocity": -0.14794961848233576, + "velocityX": 2.297684745003259, + "velocityY": 0.41471727382623713, + "timestamp": 0.7053837391727857 + }, + { + "x": 3.7192828323534473, + "y": 7.061705962999724, + "heading": -2.743013500900774, + "angularVelocity": -0.16646484040095605, + "velocityX": 2.5849969379566557, + "velocityY": 0.4659885829326004, + "timestamp": 0.7935567065693839 + }, + { + "x": 3.9725472979903476, + "y": 7.107289194770783, + "heading": -2.7593258915247603, + "angularVelocity": -0.18500444190126777, + "velocityX": 2.872359557751167, + "velocityY": 0.5169751355427069, + "timestamp": 0.8817296739659821 + }, + { + "x": 4.251155992007747, + "y": 7.157330430023032, + "heading": -2.777277407245389, + "angularVelocity": -0.2035943243225953, + "velocityX": 3.1597971832367806, + "velocityY": 0.5675348888641238, + "timestamp": 0.9699026413625803 + }, + { + "x": 4.555119788328324, + "y": 7.211767042055497, + "heading": -2.796877233287328, + "angularVelocity": -0.22228837954131203, + "velocityX": 3.447358133625697, + "velocityY": 0.6173843711940759, + "timestamp": 1.0580756087591785 + }, + { + "x": 4.884459882518826, + "y": 7.27047417558018, + "heading": -2.8181465130803445, + "angularVelocity": -0.24122222968121568, + "velocityX": 3.7351594702392714, + "velocityY": 0.665817826688542, + "timestamp": 1.1462485761557768 + }, + { + "x": 5.239235528324246, + "y": 7.333080725767244, + "heading": -2.8411535355871766, + "angularVelocity": -0.2609305684739806, + "velocityX": 4.023632823988497, + "velocityY": 0.7100424544573067, + "timestamp": 1.234421543552375 + }, + { + "x": 5.610187450691477, + "y": 7.375734987777251, + "heading": -2.8703104693697137, + "angularVelocity": -0.33067883097764283, + "velocityX": 4.20709354941754, + "velocityY": 0.4837566804137338, + "timestamp": 1.3225945109489734 + }, + { + "x": 5.955981368436564, + "y": 7.412973853213799, + "heading": -2.898024923168262, + "angularVelocity": -0.31431916852576924, + "velocityX": 3.9217679517319706, + "velocityY": 0.4223388021982916, + "timestamp": 1.4107674783455717 + }, + { + "x": 6.276537520123413, + "y": 7.4451838654734495, + "heading": -2.924223595532576, + "angularVelocity": -0.2971281690733325, + "velocityX": 3.635537752120799, + "velocityY": 0.3653048458125664, + "timestamp": 1.49894044574217 + }, + { + "x": 6.571830912097573, + "y": 7.47249273252466, + "heading": -2.9488824909824602, + "angularVelocity": -0.279665028613237, + "velocityX": 3.3490240908638538, + "velocityY": 0.30971926949419576, + "timestamp": 1.5871134131387683 + }, + { + "x": 6.841849345139681, + "y": 7.494964072142321, + "heading": -2.9719894022564435, + "angularVelocity": -0.2620634413952497, + "velocityX": 3.062372074057307, + "velocityY": 0.2548552042780421, + "timestamp": 1.6752863805353666 + }, + { + "x": 7.086585597012585, + "y": 7.512635968870317, + "heading": -2.993536590651642, + "angularVelocity": -0.24437408688175255, + "velocityX": 2.775638147371063, + "velocityY": 0.20042306899470433, + "timestamp": 1.763459347931965 + }, + { + "x": 7.306034895064365, + "y": 7.525533770781237, + "heading": -3.01351842580479, + "angularVelocity": -0.22662087647873794, + "velocityX": 2.4888500923951824, + "velocityY": 0.14627841493534438, + "timestamp": 1.8516323153285632 + }, + { + "x": 7.5001938519959825, + "y": 7.533675560070343, + "heading": -3.0319304290369935, + "angularVelocity": -0.20881687183541217, + "velocityX": 2.2020236208939075, + "velocityY": 0.09233883728199388, + "timestamp": 1.9398052827251615 + }, + { + "x": 7.669059939862971, + "y": 7.537074883806149, + "heading": -3.048768836452478, + "angularVelocity": -0.19097017955339882, + "velocityX": 1.9151684791035324, + "velocityY": 0.03855290159982452, + "timestamp": 2.02797825012176 + }, + { + "x": 7.812631200221533, + "y": 7.535742269192649, + "heading": -3.064030388112588, + "angularVelocity": -0.17308651518400572, + "velocityX": 1.6282911259273427, + "velocityY": -0.015113641435094947, + "timestamp": 2.116151217518358 + }, + { + "x": 7.930906071252784, + "y": 7.529686131887914, + "heading": -3.077712226044625, + "angularVelocity": -0.15517043756162383, + "velocityX": 1.3413960596251193, + "velocityY": -0.0686847395925208, + "timestamp": 2.204324184914956 + }, + { + "x": 8.023883278248142, + "y": 7.51891335359463, + "heading": -3.0898118478873737, + "angularVelocity": -0.13722597979860962, + "velocityX": 1.0544865364137177, + "velocityY": -0.12217778998892762, + "timestamp": 2.292497152311554 + }, + { + "x": 8.09156176085636, + "y": 7.503429666879887, + "heading": -3.100327089640208, + "angularVelocity": -0.11925697935896586, + "velocityX": 0.7675649873934917, + "velocityY": -0.17560582536707564, + "timestamp": 2.380670119708152 + }, + { + "x": 8.133940622858004, + "y": 7.483239921445362, + "heading": -3.1092561232896654, + "angularVelocity": -0.10126724678885639, + "velocityX": 0.48063327403995604, + "velocityY": -0.22897885860767764, + "timestamp": 2.46884308710475 }, { "x": 8.151019096374512, "y": 7.458348274230957, "heading": -3.116597461241803, - "angularVelocity": -0.047334232961245795, - "velocityX": 0.2749230743123512, - "velocityY": -0.32955650954222365, - "timestamp": 2.535502007308455 - }, - { - "x": 8.148432483672298, - "y": 7.421806810166393, - "heading": -3.118943939908983, - "angularVelocity": -0.02514099388324918, - "velocityX": -0.027713873999485883, - "velocityY": -0.3915180382340248, - "timestamp": 2.6288347799934333 - }, - { - "x": 8.117594384206546, - "y": 7.379509385872707, - "heading": -3.119220822186634, - "angularVelocity": -0.002966613652270148, - "velocityX": -0.33041019331803306, - "velocityY": -0.4531894111455441, - "timestamp": 2.7221675526784117 - }, - { - "x": 8.058498182340648, - "y": 7.331488492932785, - "heading": -3.1174309173732504, - "angularVelocity": 0.019177666771188435, - "velocityX": -0.6331773948831888, - "velocityY": -0.5145126578635241, - "timestamp": 2.81550032536339 - }, - { - "x": 7.971135845182134, - "y": 7.277783830019588, - "heading": -3.1135782415558078, - "angularVelocity": 0.04127891743285837, - "velocityX": -0.936030663670345, - "velocityY": -0.5754105591019291, - "timestamp": 2.9088330980483685 - }, - { - "x": 7.8554974161850275, - "y": 7.218444994953398, - "heading": -3.1076682424852238, - "angularVelocity": 0.06332179898406654, - "velocityX": -1.2389906103766541, - "velocityY": -0.6357770519308876, - "timestamp": 3.002165870733347 - }, - { - "x": 7.711570234789305, - "y": 7.153535709516692, - "heading": -3.099708151091067, - "angularVelocity": 0.08528720582451799, - "velocityX": -1.5420862067551742, - "velocityY": -0.6954608072749517, - "timestamp": 3.0954986434183254 - }, - { - "x": 7.539337668596006, - "y": 7.083140848637671, - "heading": -3.089707578332241, - "angularVelocity": 0.10714963748671837, - "velocityX": -1.8453600084787853, - "velocityY": -0.7542351829257374, - "timestamp": 3.188831416103304 - }, - { - "x": 7.338776909525806, - "y": 7.007379062900374, - "heading": -3.0776796181255017, - "angularVelocity": 0.12887177634094718, - "velocityX": -2.1488781839487765, - "velocityY": -0.811738294682546, - "timestamp": 3.282164188788282 - }, - { - "x": 7.109854784667936, - "y": 6.926427936059983, - "heading": -3.0636431064242595, - "angularVelocity": 0.1503921001963516, - "velocityX": -2.4527517855977448, - "velocityY": -0.8673387119187144, - "timestamp": 3.3754969614732606 - }, - { - "x": 6.8525187501181435, - "y": 6.840582358481015, - "heading": -3.0476279773679096, - "angularVelocity": 0.17159169920307685, - "velocityX": -2.757188361031195, - "velocityY": -0.9197795705557481, - "timestamp": 3.468829734158239 - }, - { - "x": 6.566673825053886, - "y": 6.750427785913005, - "heading": -3.0296914111518154, - "angularVelocity": 0.1921786495793364, - "velocityX": -3.0626425942477433, - "velocityY": -0.9659476513389746, - "timestamp": 3.5621625068432174 - }, - { - "x": 6.252112121252732, - "y": 6.657680588303757, - "heading": -3.009997409599457, - "angularVelocity": 0.2110084270059204, - "velocityX": -3.370324214655872, - "velocityY": -0.9937259436435488, - "timestamp": 3.655495279528196 - }, - { - "x": 5.924327501069443, - "y": 6.590553317899491, - "heading": -2.992729144054426, - "angularVelocity": 0.18501824223432767, - "velocityX": -3.511999169784069, - "velocityY": -0.7192250746780882, - "timestamp": 3.7488280522131743 - }, - { - "x": 5.623686963906954, - "y": 6.533138892879347, - "heading": -2.9778838065365383, - "angularVelocity": 0.15905814314543523, - "velocityX": -3.2211679618393605, - "velocityY": -0.6151582490100377, - "timestamp": 3.8421608248981527 - }, - { - "x": 5.350776487888487, - "y": 6.483614379242258, - "heading": -2.9652903356820435, - "angularVelocity": 0.13493085539204083, - "velocityX": -2.9240583791463015, - "velocityY": -0.5306229763927237, - "timestamp": 3.935493597583131 - }, - { - "x": 5.105761697875294, - "y": 6.441374025055136, - "heading": -2.9548920644835968, - "angularVelocity": 0.11141071779302807, - "velocityX": -2.625174233708662, - "velocityY": -0.4525779420450055, - "timestamp": 4.028826370268109 - }, - { - "x": 4.88871990253492, - "y": 6.40611581054929, - "heading": -2.9466608880442298, - "angularVelocity": 0.08819170589894769, - "velocityX": -2.325461776143144, - "velocityY": -0.37776885322857806, - "timestamp": 4.1221591429530875 - }, - { - "x": 4.699695738823262, - "y": 6.377658859572386, - "heading": -2.940580123655932, - "angularVelocity": 0.06515143837869165, - "velocityX": -2.0252710626058645, - "velocityY": -0.304897734828379, - "timestamp": 4.215491915638066 - }, - { - "x": 4.538718238992774, - "y": 6.35588274428126, - "heading": -2.9366387902452415, - "angularVelocity": 0.042228825923698476, - "velocityX": -1.724769287352341, - "velocityY": -0.2333169224986504, - "timestamp": 4.308824688323044 - }, - { - "x": 4.405807785111533, - "y": 6.340701529308257, - "heading": -2.9348291518927363, - "angularVelocity": 0.019389098817553782, - "velocityX": -1.4240491314861898, - "velocityY": -0.16265685178180805, - "timestamp": 4.402157461008023 - }, - { - "x": 4.300979468853507, - "y": 6.33205081523707, - "heading": -2.935145493541909, - "angularVelocity": -0.003389395172478266, - "velocityX": -1.1231672781419237, - "velocityY": -0.09268677895581871, - "timestamp": 4.495490233693001 - }, - { - "x": 4.22424491179168, - "y": 6.329880549721713, - "heading": -2.9375834532510026, - "angularVelocity": -0.026121153791524136, - "velocityX": -0.8221609071962866, - "velocityY": -0.023252984486819624, - "timestamp": 4.58882300637798 - }, - { - "x": 4.175613336776075, - "y": 6.334150718518695, - "heading": -2.9421396411976675, - "angularVelocity": -0.04881659266721974, - "velocityX": -0.5210557194068298, - "velocityY": 0.04575208336941216, - "timestamp": 4.682155779062958 + "angularVelocity": -0.08326064290335773, + "velocityX": 0.19369285191104127, + "velocityY": -0.28230474656073734, + "timestamp": 2.5570160545013483 + }, + { + "x": 8.140102729329666, + "y": 7.426125423374085, + "heading": -3.122657155923987, + "angularVelocity": -0.06387113314578731, + "velocityX": -0.11506202367581048, + "velocityY": -0.33963922365053295, + "timestamp": 2.6518898164612645 + }, + { + "x": 8.099892493103056, + "y": 7.388469206934611, + "heading": -3.1268746035962094, + "angularVelocity": -0.04445325646520159, + "velocityX": -0.4238288373512569, + "velocityY": -0.39690864641145623, + "timestamp": 2.746763578421181 + }, + { + "x": 8.03038702638155, + "y": 7.345387040589032, + "heading": -3.129247224498405, + "angularVelocity": -0.025008188282847746, + "velocityX": -0.7326099997054184, + "velocityY": -0.45409990555429286, + "timestamp": 2.841637340381097 + }, + { + "x": 7.93158466399431, + "y": 7.296887997756347, + "heading": -3.1297724840024768, + "angularVelocity": -0.005536404304212232, + "velocityX": -1.0414087134963954, + "velocityY": -0.5111955279392933, + "timestamp": 2.9365111023410133 + }, + { + "x": 7.803483324511263, + "y": 7.242983431199695, + "heading": -3.12844777249931, + "angularVelocity": 0.0139628857947746, + "velocityX": -1.35022936623056, + "velocityY": -0.5681714885452221, + "timestamp": 3.0313848643009296 + }, + { + "x": 7.646080334197257, + "y": 7.183687950924871, + "heading": -3.1252702011157885, + "angularVelocity": 0.03349262554660872, + "velocityX": -1.6590782009941545, + "velocityY": -0.6249934549857522, + "timestamp": 3.126258626260846 + }, + { + "x": 7.459372134789933, + "y": 7.119021056318589, + "heading": -3.1202362522670124, + "angularVelocity": 0.0530594417759311, + "velocityX": -1.967964540988761, + "velocityY": -0.681609891611587, + "timestamp": 3.221132388220762 + }, + { + "x": 7.243353760299336, + "y": 7.049010079509845, + "heading": -3.113341150659997, + "angularVelocity": 0.07267659113094418, + "velocityX": -2.276903224116522, + "velocityY": -0.7379382387969712, + "timestamp": 3.3160061501806783 + }, + { + "x": 6.998017798486094, + "y": 6.973696087603587, + "heading": -3.1045776181342863, + "angularVelocity": 0.09237045464069367, + "velocityX": -2.5859200346339737, + "velocityY": -0.7938337254727885, + "timestamp": 3.4108799121405946 + }, + { + "x": 6.7233519959559755, + "y": 6.893147709815927, + "heading": -3.093932999275366, + "angularVelocity": 0.11219771029441636, + "velocityX": -2.8950659998721515, + "velocityY": -0.849005838112451, + "timestamp": 3.505753674100511 + }, + { + "x": 6.419332224949389, + "y": 6.807502909527294, + "heading": -3.0813806824079646, + "angularVelocity": 0.13230546157434672, + "velocityX": -3.2044662794654784, + "velocityY": -0.9027237722987913, + "timestamp": 3.600627436060427 + }, + { + "x": 6.0858892119725905, + "y": 6.717181338233644, + "heading": -3.0668369094740004, + "angularVelocity": 0.15329604975619027, + "velocityX": -3.5145967239886153, + "velocityY": -0.9520184445917703, + "timestamp": 3.6955011980203434 + }, + { + "x": 5.764278765937413, + "y": 6.654175690194563, + "heading": -3.0473584875163273, + "angularVelocity": 0.20530883940179634, + "velocityX": -3.389877658388376, + "velocityY": -0.6640998178790448, + "timestamp": 3.7903749599802596 + }, + { + "x": 5.471788390267883, + "y": 6.59747295201529, + "heading": -3.029533854057239, + "angularVelocity": 0.18787737611395156, + "velocityX": -3.082942740197291, + "velocityY": -0.5976651184468632, + "timestamp": 3.885248721940176 + }, + { + "x": 5.208500110382171, + "y": 6.546679537535185, + "heading": -3.013443507342508, + "angularVelocity": 0.16959743539556021, + "velocityX": -2.7751432476868563, + "velocityY": -0.5353789438808637, + "timestamp": 3.980122483900092 + }, + { + "x": 4.974440418410986, + "y": 6.5016623079036036, + "heading": -2.999114209332587, + "angularVelocity": 0.15103541499677672, + "velocityX": -2.467064519588399, + "velocityY": -0.4744960956708154, + "timestamp": 4.074996245860008 + }, + { + "x": 4.7696223965133315, + "y": 6.46235431777243, + "heading": -2.986559323622326, + "angularVelocity": 0.13233253800523867, + "velocityX": -2.1588479013216424, + "velocityY": -0.41431887298598197, + "timestamp": 4.169870007819925 + }, + { + "x": 4.594053841274844, + "y": 6.4287152751902195, + "heading": -2.975786926655579, + "angularVelocity": 0.11354453269490751, + "velocityX": -1.8505491045318088, + "velocityY": -0.354566340443241, + "timestamp": 4.264743769779841 + }, + { + "x": 4.447739928323049, + "y": 6.400718265491756, + "heading": -2.966802484943942, + "angularVelocity": 0.09469890859217249, + "velocityX": -1.5421957549613354, + "velocityY": -0.29509749713827227, + "timestamp": 4.359617531739757 + }, + { + "x": 4.330684343492378, + "y": 6.378344037986267, + "heading": -2.9596099787157644, + "angularVelocity": 0.07581133160099555, + "velocityX": -1.2338035555091167, + "velocityY": -0.23583156231268904, + "timestamp": 4.4544912936996734 + }, + { + "x": 4.242889844841654, + "y": 6.361578141572037, + "heading": -2.9542124480151872, + "angularVelocity": 0.05689171156570921, + "velocityX": -0.9253822852288359, + "velocityY": -0.17671794675237118, + "timestamp": 4.54936505565959 + }, + { + "x": 4.184358573473123, + "y": 6.350409330356464, + "heading": -2.9506122877942356, + "angularVelocity": 0.037946847964903434, + "velocityX": -0.6169384470414571, + "velocityY": -0.1177228665212151, + "timestamp": 4.644238817619506 }, { "x": 4.155092239379883, "y": 6.3448286056518555, "heading": -2.948811422950705, - "angularVelocity": -0.07148380532480915, - "velocityX": -0.21987022142217327, - "velocityY": 0.11440662080404759, - "timestamp": 4.775488551747936 + "angularVelocity": 0.01898169532152746, + "velocityX": -0.30847658497620073, + "velocityY": -0.058822635355874404, + "timestamp": 4.739112579579422 }, { - "x": 4.1523733002027585, - "y": 6.352736136844345, - "heading": -2.9531733467821883, - "angularVelocity": -0.0840714214822575, - "velocityX": -0.05240464766826728, - "velocityY": 0.1524092151654666, - "timestamp": 4.827372102121875 - }, - { - "x": 4.158366785929934, - "y": 6.362507716377033, - "heading": -2.958190711819862, - "angularVelocity": -0.09670435044463713, - "velocityX": 0.11551803382727258, - "velocityY": 0.1883367553349982, - "timestamp": 4.8792556524958135 - }, - { - "x": 4.173097322502434, - "y": 6.374024196518687, - "heading": -2.9638660249161624, - "angularVelocity": -0.10938559630937192, - "velocityX": 0.2839153540251724, - "velocityY": 0.22196785028494526, - "timestamp": 4.931139202869752 - }, - { - "x": 4.196590311934801, - "y": 6.387153081322849, - "heading": -2.9702019538562587, - "angularVelocity": -0.12211826088291282, - "velocityX": 0.4528022709133544, - "velocityY": 0.2530452274283173, - "timestamp": 4.983022753243691 - }, - { - "x": 4.228871699685148, - "y": 6.401746260752157, - "heading": -2.9772013305250957, - "angularVelocity": -0.13490550701312382, - "velocityX": 0.6221892587860005, - "velocityY": 0.28126794184536924, - "timestamp": 5.034906303617629 - }, - { - "x": 4.269967592351735, - "y": 6.417637232054739, - "heading": -2.984867150661907, - "angularVelocity": -0.14775049281634614, - "velocityX": 0.7920794234472852, - "velocityY": 0.3062814936150427, - "timestamp": 5.086789853991568 - }, - { - "x": 4.319903648657689, - "y": 6.434637666385072, - "heading": -2.9932025678242957, - "angularVelocity": -0.16065626007305117, - "velocityX": 0.9624641325825063, - "velocityY": 0.3276652081017283, - "timestamp": 5.138673404365506 - }, - { - "x": 4.378704125067283, - "y": 6.452533134609333, - "heading": -3.0022108777762337, - "angularVelocity": -0.17362554965904736, - "velocityX": 1.1333163591504853, - "velocityY": 0.3449160301344857, - "timestamp": 5.190556954739445 - }, - { - "x": 4.446390391271482, - "y": 6.471077749304567, - "heading": -3.0118954871845838, - "angularVelocity": -0.1866604991090635, - "velocityX": 1.3045804636800333, - "velocityY": 0.3574276348009622, - "timestamp": 5.242440505113383 - }, - { - "x": 4.522978624713606, - "y": 6.489987409231171, - "heading": -3.022259856563219, - "angularVelocity": -0.19976214626671202, - "velocityX": 1.4761563711452288, - "velocityY": 0.3644634916137398, - "timestamp": 5.294324055487322 - }, - { - "x": 4.608476221898354, - "y": 6.508931252042045, - "heading": -3.0333074005444227, - "angularVelocity": -0.21292960681336567, - "velocityX": 1.647874838335918, - "velocityY": 0.3651223301863666, - "timestamp": 5.34620760586126 - }, - { - "x": 4.702876186716506, - "y": 6.527520848501598, - "heading": -3.0450413162822625, - "angularVelocity": -0.22615868908874204, - "velocityX": 1.8194584629961805, - "velocityY": 0.3582946102487687, - "timestamp": 5.398091156235199 - }, - { - "x": 4.80614831100124, - "y": 6.545296659635279, - "heading": -3.057464288154216, - "angularVelocity": -0.23943950987196802, - "velocityX": 1.9904598575159884, - "velocityY": 0.3426097675576714, - "timestamp": 5.4499747066091375 - }, - { - "x": 4.918225271137858, - "y": 6.561711461524763, - "heading": -3.070577974004793, - "angularVelocity": -0.2527522838368351, - "velocityX": 2.1601636612924295, - "velocityY": 0.31637776850615995, - "timestamp": 5.501858256983076 - }, - { - "x": 5.038980773812091, - "y": 6.57611113382983, - "heading": -3.0843820954085435, - "angularVelocity": -0.2660596914486556, - "velocityX": 2.3274332963707454, - "velocityY": 0.2775382987726222, - "timestamp": 5.553741807357015 - }, - { - "x": 5.168195744747027, - "y": 6.587715060112655, - "heading": -3.0988727967741583, - "angularVelocity": -0.2792927866573567, - "velocityX": 2.490480508825023, - "velocityY": 0.22365328122674002, - "timestamp": 5.605625357730953 - }, - { - "x": 5.30550815428385, - "y": 6.595602511169989, - "heading": -3.1140396624904128, - "angularVelocity": -0.2923251320879681, - "velocityX": 2.646549986405633, - "velocityY": 0.1520221920143693, - "timestamp": 5.657508908104892 - }, - { - "x": 5.450345178811565, - "y": 6.598718775503018, - "heading": -3.1298604289814644, - "angularVelocity": -0.30492837088108665, - "velocityX": 2.7915789009008614, - "velocityY": 0.06006266553790952, - "timestamp": 5.70939245847883 - }, - { - "x": 5.6018485220334355, - "y": 6.595923224272249, - "heading": -3.1462924963317724, - "angularVelocity": -0.3167105418167766, - "velocityX": 2.9200650712980316, - "velocityY": -0.05388126314836061, - "timestamp": 5.761276008852769 - }, - { - "x": 5.758828163146973, - "y": 6.586098670959473, - "heading": -3.1632623831303452, - "angularVelocity": -0.32707643706465594, - "velocityX": 3.0256148621700416, - "velocityY": -0.1893577683479254, - "timestamp": 5.813159559226707 - }, - { - "x": 5.902695261238535, - "y": 6.570898320745469, - "heading": -3.17881147753637, - "angularVelocity": -0.334456883703837, - "velocityX": 3.0945430028757137, - "velocityY": -0.32695548891982595, - "timestamp": 5.859650138920662 - }, - { - "x": 6.049135676690236, - "y": 6.549021835593513, - "heading": -3.1946542371072635, - "angularVelocity": -0.34077354326802706, - "velocityX": 3.149894374639172, - "velocityY": -0.4705573751923071, - "timestamp": 5.906140718614616 - }, - { - "x": 6.197160957910471, - "y": 6.5201679684564, - "heading": -3.2107077631198266, - "angularVelocity": -0.3453070733521208, - "velocityX": 3.1839844156532195, - "velocityY": -0.6206390053008074, - "timestamp": 5.952631298308571 - }, - { - "x": 6.345163267243832, - "y": 6.484158835890345, - "heading": -3.2268259776118957, - "angularVelocity": -0.34669850533537744, - "velocityX": 3.1834902964784026, - "velocityY": -0.7745468609576753, - "timestamp": 5.9991218780025255 - }, - { - "x": 6.490686976954829, - "y": 6.44143753364954, - "heading": -3.2427755688515667, - "angularVelocity": -0.3430714640399521, - "velocityX": 3.1301762780540514, - "velocityY": -0.9189238448312944, - "timestamp": 6.04561245769648 - }, - { - "x": 6.631051195173747, - "y": 6.393759766983925, - "heading": -3.25832527798554, - "angularVelocity": -0.33447010633844293, - "velocityX": 3.0191969887862986, - "velocityY": -1.0255360758991645, - "timestamp": 6.092103037390435 - }, - { - "x": 6.764714286137434, - "y": 6.343577352526553, - "heading": -3.2733740999169187, - "angularVelocity": -0.32369615587598016, - "velocityX": 2.875057524418642, - "velocityY": -1.0794103835168365, - "timestamp": 6.138593617084389 - }, - { - "x": 6.8912461581954085, - "y": 6.2928282307057035, - "heading": -3.2878993621114248, - "angularVelocity": -0.3124345252333994, - "velocityX": 2.721666903078607, - "velocityY": -1.0916001081279028, - "timestamp": 6.185084196778344 - }, - { - "x": 7.010658039170415, - "y": 6.242772475916749, - "heading": -3.3018996360525708, - "angularVelocity": -0.3011421675812394, - "velocityX": 2.5685177892185584, - "velocityY": -1.0766859677480711, - "timestamp": 6.231574776472298 - }, - { - "x": 7.123076613613992, - "y": 6.194223053842943, - "heading": -3.315378698836471, - "angularVelocity": -0.2899310542615808, - "velocityX": 2.41809362635666, - "velocityY": -1.0442851518179614, - "timestamp": 6.278065356166253 - }, - { - "x": 7.228642675189584, - "y": 6.147727642667839, - "heading": -3.328341498218578, - "angularVelocity": -0.2788263658453163, - "velocityX": 2.2706978977360404, - "velocityY": -1.0001039238740794, - "timestamp": 6.324555935860207 - }, - { - "x": 7.3274843779409755, - "y": 6.1036734220962625, - "heading": -3.3407929863654613, - "angularVelocity": -0.2678281972143777, - "velocityX": 2.1260587285007455, - "velocityY": -0.9475945634918501, - "timestamp": 6.371046515554162 - }, - { - "x": 7.419712318737089, - "y": 6.062345928160032, - "heading": -3.352737769324828, - "angularVelocity": -0.25692910344415465, - "velocityX": 1.9837984684907406, - "velocityY": -0.8889433990345353, - "timestamp": 6.417537095248116 - }, - { - "x": 7.505420648253909, - "y": 6.023963255092294, - "heading": -3.364180022815759, - "angularVelocity": -0.24611982828036585, - "velocityX": 1.8435633644715703, - "velocityY": -0.8256010856481106, - "timestamp": 6.464027674942071 - }, - { - "x": 7.584689528763382, - "y": 5.988696855541549, - "heading": -3.3751234991855714, - "angularVelocity": -0.2353912651090335, - "velocityX": 1.7050525295940933, - "velocityY": -0.7585708714088366, - "timestamp": 6.510518254636025 - }, - { - "x": 7.657587578550974, - "y": 5.956684760340136, - "heading": -3.3855715636517316, - "angularVelocity": -0.22473508687006247, - "velocityX": 1.5680176557804868, - "velocityY": -0.688571650690245, - "timestamp": 6.55700883432998 - }, - { - "x": 7.724173959062888, - "y": 5.928040318491664, - "heading": -3.395527236991756, - "angularVelocity": -0.21414388475175317, - "velocityX": 1.4322553289343771, - "velocityY": -0.6161343230615005, - "timestamp": 6.6034994140239345 - }, - { - "x": 7.784500070286371, - "y": 5.902858177956981, - "heading": -3.4049932363871975, - "angularVelocity": -0.20361112848571972, - "velocityX": 1.2975986021384787, - "velocityY": -0.5416611429768321, - "timestamp": 6.649989993717889 - }, - { - "x": 7.838610905305163, - "y": 5.881218502530634, - "heading": -3.4139720117646606, - "angularVelocity": -0.19313106948912953, - "velocityX": 1.1639096646030658, - "velocityY": -0.4654636609997264, - "timestamp": 6.6964805734118436 - }, - { - "x": 7.886546129379081, - "y": 5.86319002330096, - "heading": -3.42246577716849, - "angularVelocity": -0.18269863399732386, - "velocityX": 1.0310739162529936, - "velocityY": -0.3877877915989518, - "timestamp": 6.742971153105798 - }, - { - "x": 7.928340942331937, - "y": 5.848832297421699, - "heading": -3.4304765375087274, - "angularVelocity": -0.1723093235871096, - "velocityX": 0.8989953067479537, - "velocityY": -0.30883086366694207, - "timestamp": 6.789461732799753 - }, - { - "x": 7.964026771943328, - "y": 5.8381974137160135, - "heading": -3.4380061112749485, - "angularVelocity": -0.16195912840381457, - "velocityX": 0.7675927004203498, - "velocityY": -0.228753519007396, - "timestamp": 6.835952312493707 - }, - { - "x": 7.99363183554634, - "y": 5.8313313033992795, - "heading": -3.4450561498298287, - "angularVelocity": -0.1516444535923259, - "velocityX": 0.6367970414200341, - "velocityY": -0.14768820612546799, - "timestamp": 6.882442892187662 - }, - { - "x": 8.01718159841729, - "y": 5.828274763168966, - "heading": -3.4516281538375715, - "angularVelocity": -0.14136205766857937, - "velocityX": 0.5065491337379875, - "velocityY": -0.06574536713534573, - "timestamp": 6.928933471881616 - }, - { - "x": 8.034699150840398, - "y": 5.829064264971731, - "heading": -3.457723487300717, - "angularVelocity": -0.13110900107658668, - "velocityX": 0.37679789192616997, - "velocityY": 0.01698197372375355, - "timestamp": 6.975424051575571 - }, - { - "x": 8.046205520629883, - "y": 5.833732604980469, - "heading": -3.463343389598174, - "angularVelocity": -0.12088260319515205, - "velocityX": 0.2474989528035481, - "velocityY": 0.10041475153610135, - "timestamp": 7.021914631269525 - }, - { - "x": 8.051419182584468, - "y": 5.8447906809115855, - "heading": -3.4693491742690163, - "angularVelocity": -0.10876684074758049, - "velocityX": 0.09442122397079034, - "velocityY": 0.20026558554682747, - "timestamp": 7.077131686665851 - }, - { - "x": 8.048120067651531, - "y": 5.861268574669593, - "heading": -3.474675084898529, - "angularVelocity": -0.0964540863558432, - "velocityX": -0.059748114224046904, - "velocityY": 0.2984203637759236, - "timestamp": 7.1323487420621765 - }, - { - "x": 8.036241609424145, - "y": 5.883060143584873, - "heading": -3.479308784103769, - "angularVelocity": -0.0839178976854301, - "velocityX": -0.21512299310652097, - "velocityY": 0.39465286149124257, - "timestamp": 7.187565797458502 - }, - { - "x": 8.015709993867125, - "y": 5.910044148075149, - "heading": -3.483236224053585, - "angularVelocity": -0.07112729792681803, - "velocityX": -0.37183466973481016, - "velocityY": 0.4886896683750097, - "timestamp": 7.242782852854828 - }, - { - "x": 7.986443029902223, - "y": 5.942080890750444, - "heading": -3.4864413312001137, - "angularVelocity": -0.05804560064864295, - "velocityX": -0.5300348552604761, - "velocityY": 0.5801965071362207, - "timestamp": 7.297999908251153 - }, - { - "x": 7.948348824180798, - "y": 5.979007815148917, - "heading": -3.488905604522003, - "angularVelocity": -0.04462884346514799, - "velocityX": -0.6898992611612746, - "velocityY": 0.6687593920651365, - "timestamp": 7.353216963647479 - }, - { - "x": 7.901324248569515, - "y": 6.020633645713137, - "heading": -3.4906075967346855, - "angularVelocity": -0.03082366852897056, - "velocityX": -0.85163135327951, - "velocityY": 0.7538582103925403, - "timestamp": 7.4084340190438045 - }, - { - "x": 7.845253222549627, - "y": 6.066730442605587, - "heading": -3.491522234596702, - "angularVelocity": -0.016564408504792263, - "velocityX": -1.0154657038017145, - "velocityY": 0.8348289593058718, - "timestamp": 7.46365107444013 - }, - { - "x": 7.780004916702429, - "y": 6.117022615205706, - "heading": -3.491619914397988, - "angularVelocity": -0.0017690150368460669, - "velocityX": -1.1816694204149643, - "velocityY": 0.9108086666183527, - "timestamp": 7.518868129836456 - }, - { - "x": 7.70543218188968, - "y": 6.171171408690927, - "heading": -3.4908652785924956, - "angularVelocity": 0.013666715837632718, - "velocityX": -1.3505380588931304, - "velocityY": 0.9806534067519966, - "timestamp": 7.574085185232781 - }, - { - "x": 7.621370970218071, - "y": 6.228752526262233, - "heading": -3.4892155354501093, - "angularVelocity": 0.02987741976722745, - "velocityX": -1.5223776615440932, - "velocityY": 1.042813984882243, - "timestamp": 7.629302240629107 - }, - { - "x": 7.527642587861271, - "y": 6.289223211041998, - "heading": -3.4866181253772446, - "angularVelocity": 0.04703999614288995, - "velocityX": -1.69745347128809, - "velocityY": 1.0951450479517597, - "timestamp": 7.6845192960254325 - }, - { - "x": 7.424063129042053, - "y": 6.3518731983485806, - "heading": -3.4830074891516145, - "angularVelocity": 0.06538987274337808, - "velocityX": -1.875859878361262, - "velocityY": 1.134612971606443, - "timestamp": 7.739736351421758 - }, - { - "x": 7.310470238938363, - "y": 6.415752089641368, - "heading": -3.478300789900097, - "angularVelocity": 0.08523995381019685, - "velocityX": -2.0572065875002874, - "velocityY": 1.1568688484796892, - "timestamp": 7.794953406818084 - }, - { - "x": 7.186789890037512, - "y": 6.479567879571034, - "heading": -3.4723932719177033, - "angularVelocity": 0.10698719698092815, - "velocityX": -2.2398939605366954, - "velocityY": 1.1557260609357407, - "timestamp": 7.850170462214409 - }, - { - "x": 7.053186773651001, - "y": 6.541573247740791, - "heading": -3.465157679667485, - "angularVelocity": 0.13103908200616907, - "velocityX": -2.419598716873995, - "velocityY": 1.1229386957473142, - "timestamp": 7.905387517610735 - }, - { - "x": 6.910343930776152, - "y": 6.59953553576051, - "heading": -3.456464119078635, - "angularVelocity": 0.15744339364805293, - "velocityX": -2.5869333641495382, - "velocityY": 1.0497171137375771, - "timestamp": 7.9606045730070605 - }, - { - "x": 6.759778343764309, - "y": 6.651011215266716, - "heading": -3.4462520027321037, - "angularVelocity": 0.18494496443594796, - "velocityX": -2.726794935570973, - "velocityY": 0.9322423866454576, - "timestamp": 8.015821628403387 - }, - { - "x": 6.603790713499927, - "y": 6.6939811250265135, - "heading": -3.434630215078176, - "angularVelocity": 0.21047460011242525, - "velocityX": -2.824990017029447, - "velocityY": 0.7781999502033666, - "timestamp": 8.071038683799713 - }, - { - "x": 6.444871386080698, - "y": 6.727297088370096, - "heading": -3.421861790963788, - "angularVelocity": 0.2312405835976036, - "velocityX": -2.8780840680215385, - "velocityY": 0.6033636365513104, - "timestamp": 8.12625573919604 - }, - { - "x": 6.285143890283095, - "y": 6.750554272686326, - "heading": -3.4082408981262526, - "angularVelocity": 0.24667908746256292, - "velocityX": -2.892720277297344, - "velocityY": 0.42119566408057085, - "timestamp": 8.181472794592366 - }, - { - "x": 6.126216972903622, - "y": 6.763750889103841, - "heading": -3.3940156098665684, - "angularVelocity": 0.25762489791570925, - "velocityX": -2.8782215248306717, - "velocityY": 0.23899529452983848, - "timestamp": 8.236689849988693 - }, - { - "x": 5.969266867293909, - "y": 6.767049973704876, - "heading": -3.3793756191034694, - "angularVelocity": 0.2651353039023758, - "velocityX": -2.8424207789276137, - "velocityY": 0.059747564902821196, - "timestamp": 8.29190690538502 - }, - { - "x": 5.815157493846427, - "y": 6.760663715506681, - "heading": -3.3644631758659895, - "angularVelocity": 0.2700695125888956, - "velocityX": -2.7909741354613375, - "velocityY": -0.11565734812110663, - "timestamp": 8.347123960781346 - }, - { - "x": 5.664535976276008, - "y": 6.744805721319696, - "heading": -3.3493860812399614, - "angularVelocity": 0.2730514062695079, - "velocityX": -2.7278078573606983, - "velocityY": -0.28719376781615824, - "timestamp": 8.402341016177672 - }, - { - "x": 5.5178985721714335, - "y": 6.719673719283003, - "heading": -3.3342277061260854, - "angularVelocity": 0.27452342405938374, - "velocityX": -2.6556541824273316, - "velocityY": -0.45514926242091686, - "timestamp": 8.457558071573999 - }, - { - "x": 5.375634670257568, - "y": 6.6854448318481445, - "heading": -3.3190539711882665, - "angularVelocity": 0.27480159579151087, - "velocityX": -2.5764485428053243, - "velocityY": -0.619897008074366, - "timestamp": 8.512775126970325 - }, - { - "x": 5.258727665904114, - "y": 6.650123372593305, - "heading": -3.3062547426441777, - "angularVelocity": 0.27422216432360225, - "velocityX": -2.504720628119257, - "velocityY": -0.7567586570210144, - "timestamp": 8.559449795211165 - }, - { - "x": 5.145593525293582, - "y": 6.608655391628734, - "heading": -3.293517807854288, - "angularVelocity": 0.2728875270021734, - "velocityX": -2.423887407763944, - "velocityY": -0.888447256884578, - "timestamp": 8.606124463452005 - }, - { - "x": 5.036709373339286, - "y": 6.561360633601731, - "heading": -3.280882894662897, - "angularVelocity": 0.27070172467418824, - "velocityX": -2.3328318348714934, - "velocityY": -1.0132853603364422, - "timestamp": 8.652799131692845 - }, - { - "x": 4.932601329245533, - "y": 6.508662017990669, - "heading": -3.2683939898435894, - "angularVelocity": 0.26757351021469256, - "velocityX": -2.2305042117612404, - "velocityY": -1.1290624571585341, - "timestamp": 8.699473799933685 - }, - { - "x": 4.833831275235675, - "y": 6.451113923616155, - "heading": -3.256098455639155, - "angularVelocity": 0.26343056454070557, - "velocityX": -2.116138319402874, - "velocityY": -1.232962044369908, - "timestamp": 8.746148468174525 - }, - { - "x": 4.740968002070127, - "y": 6.38942823102359, - "heading": -3.2440453255997848, - "angularVelocity": 0.25823708006184887, - "velocityX": -1.9895861430953543, - "velocityY": -1.321609663603138, - "timestamp": 8.792823136415365 - }, - { - "x": 4.654539547896897, - "y": 6.324486679853536, - "heading": -3.2322829510253057, - "angularVelocity": 0.25200767392252327, - "velocityX": -1.8517208033972823, - "velocityY": -1.3913661010927205, - "timestamp": 8.839497804656204 - }, - { - "x": 4.574972065691894, - "y": 6.257324316824639, - "heading": -3.220856603386505, - "angularVelocity": 0.24480833114529404, - "velocityX": -1.7047251797149867, - "velocityY": -1.4389467683485437, - "timestamp": 8.886172472897044 - }, - { - "x": 4.502533427208671, - "y": 6.189074788052417, - "heading": -3.209806687720587, - "angularVelocity": 0.23674331457271136, - "velocityX": -1.5519904310715604, - "velocityY": -1.4622391833629367, - "timestamp": 8.932847141137884 - }, - { - "x": 4.4373056272084614, - "y": 6.120887020764479, - "heading": -3.199167672698052, - "angularVelocity": 0.22793981025506352, - "velocityX": -1.397498953043142, - "velocityY": -1.4609159498700834, - "timestamp": 8.979521809378724 - }, - { - "x": 4.37919780834056, - "y": 6.053841192884822, - "heading": -3.1889674291924752, - "angularVelocity": 0.2185391753176214, - "velocityX": -1.2449540844739644, - "velocityY": -1.4364500146782433, - "timestamp": 9.026196477619564 - }, - { - "x": 4.327989641671973, - "y": 5.988891000938848, - "heading": -3.179226926397484, - "angularVelocity": 0.20868927754838076, - "velocityX": -1.0971297407911678, - "velocityY": -1.3915512288343186, - "timestamp": 9.072871145860404 - }, - { - "x": 4.283383388011125, - "y": 5.926840968076357, - "heading": -3.169960503204579, - "angularVelocity": 0.1985321704932263, - "velocityX": -0.9556844288786528, - "velocityY": -1.3294156166748594, - "timestamp": 9.119545814101244 - }, - { - "x": 4.245047973877159, - "y": 5.8683507787998055, - "heading": -3.1611767340548393, - "angularVelocity": 0.18819135691367764, - "velocityX": -0.8213323324797336, - "velocityY": -1.2531463314263613, - "timestamp": 9.166220482342084 - }, - { - "x": 4.2126491469882685, - "y": 5.813953620815217, - "heading": -3.1528796247049495, - "angularVelocity": 0.1777647204063085, - "velocityX": -0.6941415570800369, - "velocityY": -1.1654535540328004, - "timestamp": 9.212895150582924 - }, - { - "x": 4.185866990370122, - "y": 5.764078548080203, - "heading": -3.1450698281525344, - "angularVelocity": 0.16732409349149657, - "velocityX": -0.5738049701810753, - "velocityY": -1.0685683394182859, - "timestamp": 9.259569818823763 - }, - { - "x": 4.164404474628658, - "y": 5.71907153950035, - "heading": -3.1377456899052736, - "angularVelocity": 0.15691891390568613, - "velocityX": -0.45983220771313277, - "velocityY": -0.9642705620877334, - "timestamp": 9.306244487064603 - }, - { - "x": 4.1479904974082915, - "y": 5.679213252595555, - "heading": -3.1309040597644757, - "angularVelocity": 0.14658122700509368, - "velocityX": -0.3516677855249456, - "velocityY": -0.8539597260579826, - "timestamp": 9.352919155305443 - }, - { - "x": 4.136379866864982, - "y": 5.644733200221981, - "heading": -3.1245408830189114, - "angularVelocity": 0.1363304118784621, - "velocityX": -0.24875657355287575, - "velocityY": -0.7387316005259564, - "timestamp": 9.399593823546283 - }, - { - "x": 4.1293517622446805, - "y": 5.615820774762028, - "heading": -3.118651612951779, - "angularVelocity": 0.12617700969494677, - "velocityX": -0.1505764236831326, - "velocityY": -0.619445762544374, - "timestamp": 9.446268491787123 - }, - { - "x": 4.126707553863525, - "y": 5.5926337242126465, - "heading": -3.1132314898410027, - "angularVelocity": 0.11612558407074823, - "velocityX": -0.05665189450327197, - "velocityY": -0.4967801898395365, - "timestamp": 9.492943160027963 - }, - { - "x": 4.126202452000023, - "y": 5.576200893396058, - "heading": -3.1101415344409413, - "angularVelocity": 0.10940744816134937, - "velocityX": -0.017884370093563993, - "velocityY": -0.5818446718274068, - "timestamp": 9.521185802114859 - }, - { - "x": 4.126848340594801, - "y": 5.557391994422956, - "heading": -3.107243507448873, - "angularVelocity": 0.10261175222742301, - "velocityX": 0.022869269553109393, - "velocityY": -0.665975191528855, - "timestamp": 9.549428444201755 - }, - { - "x": 4.128704875969954, - "y": 5.536236876199957, - "heading": -3.1045395779376674, - "angularVelocity": 0.09573925494952655, - "velocityX": 0.06573518757349699, - "velocityY": -0.7490488374958029, - "timestamp": 9.577671086288651 - }, - { - "x": 4.131835486712304, - "y": 5.512769384210887, - "heading": -3.10203186538837, - "angularVelocity": 0.08879171224780506, - "velocityX": 0.11084695025055208, - "velocityY": -0.8309241011116071, - "timestamp": 9.605913728375548 - }, - { - "x": 4.136307565749363, - "y": 5.487027967716942, - "heading": -3.09972240427302, - "angularVelocity": 0.08177213407458436, - "velocityX": 0.1583449247878192, - "velocityY": -0.9114379743490315, - "timestamp": 9.634156370462444 - }, - { - "x": 4.142192630826981, - "y": 5.459056378613465, - "heading": -3.0976131001489353, - "angularVelocity": 0.07468508497167435, - "velocityX": 0.20837516049356766, - "velocityY": -0.9904027044429669, - "timestamp": 9.66239901254934 - }, - { - "x": 4.149566433458333, - "y": 5.428904470508613, - "heading": -3.095705676064946, - "angularVelocity": 0.0675370270996881, - "velocityX": 0.2610875642818267, - "velocityY": -1.0676022452886083, - "timestamp": 9.690641654636236 - }, - { - "x": 4.158508989800092, - "y": 5.396629103824818, - "heading": -3.0940016082871296, - "angularVelocity": 0.06033669840708298, - "velocityX": 0.3166331363136689, - "velocityY": -1.1427885034442629, - "timestamp": 9.718884296723132 - }, - { - "x": 4.169104499088999, - "y": 5.36229515746973, - "heading": -3.0925020508230623, - "angularVelocity": 0.05309550924639011, - "velocityX": 0.3751599887966468, - "velocityY": -1.2156775647777545, - "timestamp": 9.747126938810029 - }, - { - "x": 4.181441106637344, - "y": 5.3259766387957415, - "heading": -3.0912077490711503, - "angularVelocity": 0.045827927427253216, - "velocityX": 0.4368078422120931, - "velocityY": -1.2859462143182547, - "timestamp": 9.775369580896925 - }, - { - "x": 4.195610459906488, - "y": 5.287757869928078, - "heading": -3.0901189442549186, - "angularVelocity": 0.03855180449767203, - "velocityX": 0.5017006987359274, - "velocityY": -1.3532292322394428, - "timestamp": 9.803612222983821 - }, - { - "x": 4.2117069996895005, - "y": 5.247734708939476, - "heading": -3.089235272184188, - "angularVelocity": 0.03128857661446859, - "velocityX": 0.5699374631270886, - "velocityY": -1.4171181600312093, - "timestamp": 9.831854865070717 - }, - { - "x": 4.229826926929038, - "y": 5.206015738227041, - "heading": -3.0885556622564883, - "angularVelocity": 0.02406325603706172, - "velocityX": 0.6415804577980706, - "velocityY": -1.4771624617865668, - "timestamp": 9.860097507157613 - }, - { - "x": 4.250066793413857, - "y": 5.162723320699504, - "heading": -3.088078245188932, - "angularVelocity": 0.016904122004143384, - "velocityX": 0.7166421053152825, - "velocityY": -1.5328742046986106, - "timestamp": 9.88834014924451 - }, - { - "x": 4.272521686590209, - "y": 5.117994390534871, - "heading": -3.0878002801517295, - "angularVelocity": 0.00984203377102721, - "velocityX": 0.795070557041513, - "velocityY": -1.5837374572468441, - "timestamp": 9.916582791331406 - }, - { - "x": 4.297283019475378, - "y": 5.071980816631299, - "heading": -3.0877181128372237, - "angularVelocity": 0.0029093352616577084, - "velocityX": 0.8767357108086503, - "velocityY": -1.6292234190412864, - "timestamp": 9.944825433418302 - }, - { - "x": 4.324435997461225, - "y": 5.024849164870591, - "heading": -3.087827174498778, - "angularVelocity": -0.0038615955695118155, - "velocityX": 0.9614177704162753, - "velocityY": -1.6688117073358897, - "timestamp": 9.973068075505198 - }, - { - "x": 4.354056909275255, - "y": 4.976779703710972, - "heading": -3.088122027441298, - "angularVelocity": -0.010439991471521545, - "velocityX": 1.0488010194971473, - "velocityY": -1.7020171488106757, - "timestamp": 10.001310717592094 - }, - { - "x": 4.386210464798987, - "y": 4.927964557643445, - "heading": -3.08859645514647, - "angularVelocity": -0.016798276298381022, - "velocityX": 1.1384754806155697, - "velocityY": -1.7284199515517666, - "timestamp": 10.02955335967899 - }, - { - "x": 4.420947454648737, - "y": 4.878605015906615, - "heading": -3.0892435869039567, - "angularVelocity": -0.022913286777326337, - "velocityX": 1.229948308053933, - "velocityY": -1.7476956151964618, - "timestamp": 10.057796001765887 - }, - { - "x": 4.458303010660593, - "y": 4.828908134239048, - "heading": -3.0900560403399195, - "angularVelocity": -0.02876690620740358, - "velocityX": 1.322665064299653, - "velocityY": -1.7596399626728296, - "timestamp": 10.086038643852783 - }, - { - "x": 4.498295688268876, - "y": 4.779082893453277, - "heading": -3.0910260632840125, - "angularVelocity": -0.03434604103639958, - "velocityX": 1.4160388211993622, - "velocityY": -1.7641848320164313, - "timestamp": 10.11428128593968 - }, - { - "x": 4.540927477874527, - "y": 4.7293362618821755, - "heading": -3.0921456599273003, - "angularVelocity": -0.03964206464263729, - "velocityX": 1.5094830531252688, - "velocityY": -1.7614014800047542, - "timestamp": 10.142523928026575 - }, - { - "x": 4.586184711726668, - "y": 4.679869521543178, - "heading": -3.093406693575906, - "angularVelocity": -0.0446499886492845, - "velocityX": 1.6024433448150754, - "velocityY": -1.7514912445797743, - "timestamp": 10.170766570113472 - }, - { - "x": 4.634039705671291, - "y": 4.630875157025283, - "heading": -3.094800966167012, - "angularVelocity": -0.0493676401384937, - "velocityX": 1.6944234111449143, - "velocityY": -1.7347656202684976, - "timestamp": 10.199009212200368 - }, - { - "x": 4.684452894473009, - "y": 4.582534494245445, - "heading": -3.0963202800022835, - "angularVelocity": -0.05379503201566885, - "velocityX": 1.7850025732935824, - "velocityY": -1.7116197072180923, - "timestamp": 10.227251854287264 - }, - { - "x": 4.737375198235536, - "y": 4.535016149580233, - "heading": -3.0979564886356585, - "angularVelocity": -0.05793397899320715, - "velocityX": 1.8738439413599313, - "velocityY": -1.682503517872359, - "timestamp": 10.25549449637416 - }, - { - "x": 4.792750387303713, - "y": 4.4884752415165705, - "heading": -3.099701542316806, - "angularVelocity": -0.061787904820602965, - "velocityX": 1.96069436059847, - "velocityY": -1.6478949781138656, - "timestamp": 10.283737138461056 - }, - { - "x": 4.850517272949219, - "y": 4.443053245544434, - "heading": -3.1015475306172475, - "angularVelocity": -0.06536174252967485, - "velocityX": 2.0453782428630785, - "velocityY": -1.6082771517050376, - "timestamp": 10.311979780547953 - }, - { - "x": 4.945792762773265, - "y": 4.375552517193276, - "heading": -3.104637557561012, - "angularVelocity": -0.07048555688108925, - "velocityX": 2.1732968933870485, - "velocityY": -1.5397362269966697, - "timestamp": 10.35581893115547 - }, - { - "x": 5.046613542601896, - "y": 4.311170508357876, - "heading": -3.1079513748428638, - "angularVelocity": -0.07559036240275999, - "velocityX": 2.2997886234442926, - "velocityY": -1.4685961735845707, - "timestamp": 10.399658081762988 - }, - { - "x": 5.152902446465935, - "y": 4.250040627121963, - "heading": -3.1114878828795027, - "angularVelocity": -0.08067008570262957, - "velocityX": 2.4245201467432853, - "velocityY": -1.3944129936092113, - "timestamp": 10.443497232370506 - }, - { - "x": 5.264562389730376, - "y": 4.192320838235789, - "heading": -3.1152455876027774, - "angularVelocity": -0.08571572832048371, - "velocityX": 2.547037105351461, - "velocityY": -1.316626533276764, - "timestamp": 10.487336382978024 - }, - { - "x": 5.381468375232392, - "y": 4.1382004854773315, - "heading": -3.1192223904774794, - "angularVelocity": -0.09071350196324425, - "velocityX": 2.666702796061197, - "velocityY": -1.2345210162255122, - "timestamp": 10.531175533585541 - }, - { - "x": 5.503455043013129, - "y": 4.08790945524459, - "heading": -3.1234152290197748, - "angularVelocity": -0.09564141832566364, - "velocityX": 2.7825965168179527, - "velocityY": -1.147171638496956, - "timestamp": 10.575014684193059 - }, - { - "x": 5.630296567310867, - "y": 4.041730311926649, - "heading": -3.127819430009789, - "angularVelocity": -0.10046273545405592, - "velocityX": 2.8933390026946704, - "velocityY": -1.053376780297883, - "timestamp": 10.618853834800577 - }, - { - "x": 5.761673013159542, - "y": 4.00001345800068, - "heading": -3.132427482658239, - "angularVelocity": -0.10511272651483035, - "velocityX": 2.996783560540646, - "velocityY": -0.9515890100027304, - "timestamp": 10.662692985408095 - }, - { - "x": 5.897112457336204, - "y": 3.963192523243404, - "heading": -3.137226596457673, - "angularVelocity": -0.10947095764695358, - "velocityX": 3.08946323776255, - "velocityY": -0.8399098579013413, - "timestamp": 10.706532136015612 - }, - { - "x": 6.03589172673902, - "y": 3.931786771388618, - "heading": -3.142193739184528, - "angularVelocity": -0.11330380853690723, - "velocityX": 3.1656468585643007, - "velocityY": -0.7163859568346735, - "timestamp": 10.75037128662313 - }, - { - "x": 6.176882566019167, - "y": 3.906346629663003, - "heading": -3.147286302822329, - "angularVelocity": -0.11616474241011562, - "velocityX": 3.216094229160719, - "velocityY": -0.5803064469331211, - "timestamp": 10.794210437230648 - }, - { - "x": 6.318402928580952, - "y": 3.887246837030129, - "heading": -3.15243062411994, - "angularVelocity": -0.11734536883862791, - "velocityX": 3.22817300519314, - "velocityY": -0.43567889359605416, - "timestamp": 10.838049587838166 - }, - { - "x": 6.458344624342974, - "y": 3.8743105056536162, - "heading": -3.1575282040954695, - "angularVelocity": -0.11627916838916771, - "velocityX": 3.192162572101109, - "velocityY": -0.29508626871740457, - "timestamp": 10.881888738445683 - }, - { - "x": 6.594766808589048, - "y": 3.866674400680897, - "heading": -3.162494391138218, - "angularVelocity": -0.11328200875080248, - "velocityX": 3.111880188268938, - "velocityY": -0.1741846013642831, - "timestamp": 10.925727889053201 - }, - { - "x": 6.726364790951044, - "y": 3.863186213104212, - "heading": -3.1672811670327787, - "angularVelocity": -0.10918952188229065, - "velocityX": 3.0018369548297525, - "velocityY": -0.0795678640746057, - "timestamp": 10.969567039660719 - }, - { - "x": 6.85241037724519, - "y": 3.862804185416008, - "heading": -3.171865764529248, - "angularVelocity": -0.10457769899591095, - "velocityX": 2.87518313077287, - "velocityY": -0.008714304061773629, - "timestamp": 11.013406190268237 - }, - { - "x": 6.972520342290402, - "y": 3.864712411625189, - "heading": -3.176237050164369, - "angularVelocity": -0.09971191445417933, - "velocityX": 2.739787687050078, - "velocityY": 0.04352790103679518, - "timestamp": 11.057245340875754 - }, - { - "x": 7.086492438843414, - "y": 3.8682949024292745, - "heading": -3.1803889652599335, - "angularVelocity": -0.09470792745816826, - "velocityX": 2.5997788500370076, - "velocityY": 0.08171898301950821, - "timestamp": 11.101084491483272 - }, - { - "x": 7.194218018560886, - "y": 3.873084644688448, - "heading": -3.18431784696781, - "angularVelocity": -0.08962038847539197, - "velocityX": 2.4572916725033225, - "velocityY": 0.10925718661967229, - "timestamp": 11.14492364209079 - }, - { - "x": 7.295638116776633, - "y": 3.878721280840711, - "heading": -3.1880212870664604, - "angularVelocity": -0.0844779163676376, - "velocityX": 2.3134594719623562, - "velocityY": 0.1285753960592616, - "timestamp": 11.188762792698308 - }, - { - "x": 7.390721083197748, - "y": 3.8849209621060954, - "heading": -3.1914975975406707, - "angularVelocity": -0.07929693951721277, - "velocityX": 2.1689053073215674, - "velocityY": 0.14141882722337154, - "timestamp": 11.232601943305825 - }, - { - "x": 7.479450781979312, - "y": 3.8914556120813315, - "heading": -3.1947455356655263, - "angularVelocity": -0.0740876152901293, - "velocityX": 2.0239830733934867, - "velocityY": 0.14905968488621668, - "timestamp": 11.276441093913343 - }, - { - "x": 7.561820121690822, - "y": 3.898138635011677, - "heading": -3.1977641509162766, - "angularVelocity": -0.06885660896523792, - "velocityX": 1.8788990792486582, - "velocityY": 0.15244417005650296, - "timestamp": 11.32028024452086 - }, - { - "x": 7.63782737731302, - "y": 3.904814917700527, - "heading": -3.200552694085297, - "angularVelocity": -0.06360851271927202, - "velocityX": 1.7337757362744945, - "velocityY": 0.1522904206931706, - "timestamp": 11.364119395128379 - }, - { - "x": 7.707474032598791, - "y": 3.9113537003122296, - "heading": -3.203110560481528, - "angularVelocity": -0.05834662307057743, - "velocityX": 1.588686238684281, - "velocityY": 0.14915395305540546, - "timestamp": 11.407958545735896 - }, - { - "x": 7.770763480621882, - "y": 3.9176433914401314, - "heading": -3.2054372529156474, - "angularVelocity": -0.05307339220483149, - "velocityX": 1.443674139348821, - "velocityY": 0.1434720116776842, - "timestamp": 11.451797696343414 - }, - { - "x": 7.827700224514358, - "y": 3.9235877249027666, - "heading": -3.207532356731126, - "angularVelocity": -0.047790702749590255, - "velocityX": 1.298764759431989, - "velocityY": 0.13559417507546984, - "timestamp": 11.495636846950932 - }, - { - "x": 7.8782893780082945, - "y": 3.9291028602207745, - "heading": -3.2093955224644075, - "angularVelocity": -0.0425000417996671, - "velocityX": 1.1539720271236498, - "velocityY": 0.1258038817262506, - "timestamp": 11.53947599755845 - }, - { - "x": 7.922536350053699, - "y": 3.9341151592421566, - "heading": -3.2110264534997506, - "angularVelocity": -0.03720261484864023, - "velocityX": 1.0093026765399213, - "velocityY": 0.11433385346025998, - "timestamp": 11.583315148165967 - }, - { - "x": 7.960446644787287, - "y": 3.9385594558007666, - "heading": -3.212424897087272, - "angularVelocity": -0.03189942250572562, - "velocityX": 0.8647588789525155, - "velocityY": 0.10137734187413922, - "timestamp": 11.627154298773485 - }, - { - "x": 7.99202573502137, - "y": 3.9423776908019037, - "heading": -3.2135906376808516, - "angularVelocity": -0.026591313413353933, - "velocityX": 0.7203399198310967, - "velocityY": 0.08709646396484473, - "timestamp": 11.670993449381003 - }, - { - "x": 8.01727898323447, - "y": 3.9455178222713507, - "heading": -3.214523491909814, - "angularVelocity": -0.02127902151467548, - "velocityX": 0.5760432823889977, - "velocityY": 0.07162847422752046, - "timestamp": 11.71483259998852 - }, - { - "x": 8.036211593571213, - "y": 3.9479329451914285, - "heading": -3.2152233047220844, - "angularVelocity": -0.01596319277569034, - "velocityX": 0.43186535492534833, - "velocityY": 0.055090550035959585, - "timestamp": 11.758671750596038 - }, - { - "x": 8.048828584224365, - "y": 3.9495805734534923, - "heading": -3.2156899463805253, - "angularVelocity": -0.010644404646863087, - "velocityX": 0.28780189575545956, - "velocityY": 0.03758348962585016, - "timestamp": 11.802510901203556 - }, - { - "x": 8.055134773254395, - "y": 3.9504220485687256, - "heading": -3.2159233100890603, - "angularVelocity": -0.005323180428930311, - "velocityX": 0.14384833972918967, - "velocityY": 0.019194603535245852, - "timestamp": 11.846350051811074 - }, - { - "x": 8.055134773254395, - "y": 3.9504220485687256, - "heading": -3.2159233100890603, - "angularVelocity": -6.67822227879436e-24, - "velocityX": 2.8759643270288254e-22, - "velocityY": -3.633600230346585e-23, - "timestamp": 11.890189202418592 + "x": 4.155092239379883, + "y": 6.3448286056518555, + "heading": -2.948811422950705, + "angularVelocity": 7.532394355764215e-22, + "velocityX": -1.0416622637345536e-20, + "velocityY": 4.974602571682824e-21, + "timestamp": 4.8339863415393385 } ], "eventMarkers": [ @@ -1929,44 +498,13 @@ } }, { - "timestamp": 4.400488551747936, + "timestamp": 4.4589863415393385, "command": { "type": "named", "data": { "name": "Shoot" } } - }, - { - "timestamp": 9.117943160027963, - "command": { - "type": "parallel", - "data": { - "commands": [ - { - "type": "named", - "data": { - "name": "Shoot" - } - }, - { - "type": "named", - "data": { - "name": "Intake Off" - } - } - ] - } - } - }, - { - "timestamp": 10.561979780547953, - "command": { - "type": "named", - "data": { - "name": "Intake On" - } - } } ] } \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid A.2.traj b/Robot/src/main/deploy/choreo/Amp Side Mid A.2.traj index 80be3f7..59e25de 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid A.2.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid A.2.traj @@ -1,589 +1,881 @@ { "samples": [ { - "x": 8.055134773254395, - "y": 3.9504220485687256, - "heading": -3.2159233100890603, - "angularVelocity": -6.67822227879436e-24, - "velocityX": 2.8759643270288254e-22, - "velocityY": -3.633600230346585e-23, + "x": 4.155092239379883, + "y": 6.3448286056518555, + "heading": -2.948811422950705, + "angularVelocity": 7.532394355764215e-22, + "velocityX": -1.0416622637345536e-20, + "velocityY": 4.974602571682824e-21, "timestamp": 0 }, { - "x": 8.049461022102024, - "y": 3.949818782258034, - "heading": -3.2160337027243697, - "angularVelocity": -0.0026590767459743715, - "velocityX": -0.13666617985358623, - "velocityY": -0.014531145251617299, - "timestamp": 0.04151540021422129 - }, - { - "x": 8.038111439942709, - "y": 3.948632147519207, - "heading": -3.216254752452189, - "angularVelocity": -0.005324523590736258, - "velocityX": -0.2733824580939108, - "velocityY": -0.028583001312859572, - "timestamp": 0.08303080042844257 - }, - { - "x": 8.021083835373686, - "y": 3.9468838801152724, - "heading": -3.2165867486967437, - "angularVelocity": -0.007996941926150615, - "velocityX": -0.4101515216319159, - "velocityY": -0.04211129833539491, - "timestamp": 0.12454620064266386 - }, - { - "x": 7.998375901501308, - "y": 3.9445978195464457, - "heading": -3.217030009033054, - "angularVelocity": -0.010677009833060662, - "velocityX": -0.5469761523483998, - "velocityY": -0.05506536266133637, - "timestamp": 0.16606160085688515 - }, - { - "x": 7.969985213798721, - "y": 3.941800228532568, - "heading": -3.2175848829828544, - "angularVelocity": -0.013365496826158159, - "velocityX": -0.6838591837267317, - "velocityY": -0.06738682511649931, - "timestamp": 0.20757700107110644 - }, - { - "x": 7.935909230970343, - "y": 3.9385201802867242, - "heading": -3.2182517565758397, - "angularVelocity": -0.01606328228908489, - "velocityX": -0.8208034284276452, - "velocityY": -0.07900798809402601, - "timestamp": 0.24909240128532772 - }, - { - "x": 7.896145300692885, - "y": 3.9347900324583227, - "heading": -3.2190310578779004, - "angularVelocity": -0.018771378766420068, - "velocityX": -0.9578115608250078, - "velocityY": -0.0898497379081842, - "timestamp": 0.290607801499549 - }, - { - "x": 7.850690673153943, - "y": 3.9306460132603056, - "heading": -3.2199232637551667, - "angularVelocity": -0.02149096173137802, - "velocityX": -1.0948859291827262, - "velocityY": -0.09981884256525955, - "timestamp": 0.3321232017137703 - }, - { - "x": 7.799542527002307, - "y": 3.926128954800206, - "heading": -3.2209289082374455, - "angularVelocity": -0.024223408110953828, - "velocityX": -1.2320282566881058, - "velocityY": -0.10880440599854417, - "timestamp": 0.3736386019279916 - }, - { - "x": 7.742698015104244, - "y": 3.9212852225051047, - "heading": -3.2220485929804368, - "angularVelocity": -0.02697034684030146, - "velocityX": -1.3692391643761666, - "velocityY": -0.11667314466696567, - "timestamp": 0.4151540021422129 - }, - { - "x": 7.680154342166579, - "y": 3.9161679101915414, - "heading": -3.2232830005246065, - "angularVelocity": -0.029733726226896906, - "velocityX": -1.5065174035402846, - "velocityY": -0.12326298884649987, - "timestamp": 0.45666940235643416 - }, - { - "x": 7.6119088943213455, - "y": 3.910838401815779, - "heading": -3.224632911344616, - "angularVelocity": -0.03251590525548651, - "velocityX": -1.6438586041103576, - "velocityY": -0.12837425023635576, - "timestamp": 0.49818480257065545 - }, - { - "x": 7.537959455007088, - "y": 3.9053684501424586, - "heading": -3.226099226134968, - "angularVelocity": -0.03531977971513932, - "velocityX": -1.781253195986903, - "velocityY": -0.13175717071484946, - "timestamp": 0.5397002027848767 - }, - { - "x": 7.458304567583275, - "y": 3.8998430016438226, - "heading": -3.2276829954841744, - "angularVelocity": -0.03814896016982299, - "velocityX": -1.918682874614946, - "velocityY": -0.13309394755015685, - "timestamp": 0.581215602999098 - }, - { - "x": 7.372944154845319, - "y": 3.8943641280279326, - "heading": -3.2293854602252283, - "angularVelocity": -0.04100802912339145, - "velocityX": -2.0561144129044084, - "velocityY": -0.13197207753312612, - "timestamp": 0.6227310032133193 - }, - { - "x": 7.281880604712493, - "y": 3.889056649665367, - "heading": -3.231208107626954, - "angularVelocity": -0.04390292258585246, - "velocityX": -2.1934884323150885, - "velocityY": -0.12784360346230503, - "timestamp": 0.6642464034275406 - }, - { - "x": 7.185120739461101, - "y": 3.8840764365077023, - "heading": -3.233152751779346, - "angularVelocity": -0.046841512844808565, - "velocityX": -2.3306981205072343, - "velocityY": -0.11996062020276857, - "timestamp": 0.7057618036417619 - }, - { - "x": 7.082679550342636, - "y": 3.879623112717479, - "heading": -3.235221652055951, - "angularVelocity": -0.049834525644205194, - "velocityX": -2.4675467077244044, - "velocityY": -0.10726920051942225, - "timestamp": 0.7472772038559832 - }, - { - "x": 6.974587692374974, - "y": 3.8759603104264273, - "heading": -3.2374176930686835, - "angularVelocity": -0.05289702138003147, - "velocityX": -2.60365689382502, - "velocityY": -0.08822755585039416, - "timestamp": 0.7887926040702045 - }, - { - "x": 6.860907625972457, - "y": 3.873449383506687, - "heading": -3.2397446641736134, - "angularVelocity": -0.056050793029157005, - "velocityX": -2.7382625680090227, - "velocityY": -0.060481818958357046, - "timestamp": 0.8303080042844257 - }, - { - "x": 6.74177148088028, - "y": 3.8726075802709827, - "heading": -3.2422076835623286, - "angularVelocity": -0.05932784884658806, - "velocityX": -2.869685573965975, - "velocityY": -0.020276890776945063, - "timestamp": 0.871823404498647 - }, - { - "x": 6.6174784673151565, - "y": 3.874207359068915, - "heading": -3.24481367151268, - "angularVelocity": -0.06277159648960273, - "velocityX": -2.9939013697029333, - "velocityY": 0.0385345869165934, - "timestamp": 0.9133388047128683 - }, - { - "x": 6.4887587158832485, - "y": 3.879406926640923, - "heading": -3.2475703091903396, - "angularVelocity": -0.06640036380319413, - "velocityX": -3.100530183202083, - "velocityY": 0.12524430802010658, - "timestamp": 0.9548542049270896 - }, - { - "x": 6.357349625228428, - "y": 3.8896386087606305, - "heading": -3.250472668687868, - "angularVelocity": -0.06991043040781324, - "velocityX": -3.1653094990471695, - "velocityY": 0.24645510020164924, - "timestamp": 0.9963696051413109 - }, - { - "x": 6.226097742502279, - "y": 3.905573882546097, - "heading": -3.253467220206788, - "angularVelocity": -0.07213110083169348, - "velocityX": -3.161522761406179, - "velocityY": 0.383840061838245, - "timestamp": 1.0378850053555322 - }, - { - "x": 6.097361671143063, - "y": 3.9266303810010146, - "heading": -3.256480660362481, - "angularVelocity": -0.07258607986779293, - "velocityX": -3.1009232885852347, - "velocityY": 0.5071972893496193, - "timestamp": 1.0794004055697535 - }, - { - "x": 5.972395859043094, - "y": 3.9519695662893874, - "heading": -3.2594678160246513, - "angularVelocity": -0.0719529535246346, - "velocityX": -3.0101073687146878, - "velocityY": 0.6103562812262663, - "timestamp": 1.1209158057839748 - }, - { - "x": 5.851830452160621, - "y": 3.98094091133554, - "heading": -3.2624048122101206, - "angularVelocity": -0.07074473979086844, - "velocityX": -2.9041128415082156, - "velocityY": 0.6978457366822637, - "timestamp": 1.162431205998196 - }, - { - "x": 5.736009410595541, - "y": 4.013081963648901, - "heading": -3.265278093679901, - "angularVelocity": -0.06921001495720346, - "velocityX": -2.7898331936447005, - "velocityY": 0.7741958923077217, - "timestamp": 1.2039466062124173 - }, - { - "x": 5.625138940256401, - "y": 4.048059882088208, - "heading": -3.2680792005517927, - "angularVelocity": -0.06747151315988424, - "velocityX": -2.6705865718996242, - "velocityY": 0.8425287546023715, - "timestamp": 1.2454620064266386 - }, - { - "x": 5.519352651225023, - "y": 4.085627588699354, - "heading": -3.270802426805142, - "angularVelocity": -0.0655955678928201, - "velocityX": -2.548121624397602, - "velocityY": 0.9049101397865453, - "timestamp": 1.28697740664086 - }, - { - "x": 5.41874256251759, - "y": 4.125595879402791, - "heading": -3.2734436882617857, - "angularVelocity": -0.06362124520091712, - "velocityX": -2.4234401737254054, - "velocityY": 0.9627340817431456, - "timestamp": 1.3284928068550812 - }, - { - "x": 5.323375157332968, - "y": 4.167815854983862, - "heading": -3.2759999255233883, - "angularVelocity": -0.06157322941395978, - "velocityX": -2.2971573125278995, - "velocityY": 1.0169714217667107, - "timestamp": 1.3700082070693025 - }, - { - "x": 5.233300333220428, - "y": 4.212167583324044, - "heading": -3.2784687641766523, - "angularVelocity": -0.05946802007267365, - "velocityX": -2.1696725467597475, - "velocityY": 1.0683199032485298, - "timestamp": 1.4115236072835238 - }, - { - "x": 5.148556709289551, - "y": 4.258552551269531, - "heading": -3.2808483088426774, - "angularVelocity": -0.057317155892666005, - "velocityX": -2.0412575452385195, - "velocityY": 1.1172954543648586, - "timestamp": 1.453039007497745 - }, - { - "x": 5.093077041800994, - "y": 4.291207597300885, - "heading": -3.28243411107928, - "angularVelocity": -0.05582003804977698, - "velocityX": -1.9528772748078769, - "velocityY": 1.1494534879032838, - "timestamp": 1.4814482005403633 - }, - { - "x": 5.040173170230802, - "y": 4.324572617724137, - "heading": -3.283974328628088, - "angularVelocity": -0.05421546280803395, - "velocityX": -1.8622095844407967, - "velocityY": 1.1744444966528669, - "timestamp": 1.5098573935829815 - }, - { - "x": 4.98989479951463, - "y": 4.358433126349112, - "heading": -3.2854661326260484, - "angularVelocity": -0.05251131194477776, - "velocityX": -1.7697922866287699, - "velocityY": 1.1918856186509867, - "timestamp": 1.5382665866255998 - }, - { - "x": 4.9422741836993005, - "y": 4.392567638374272, - "heading": -3.286906936138998, - "angularVelocity": -0.050716101326364144, - "velocityX": -1.6762396504502126, - "velocityY": 1.2015305036631476, - "timestamp": 1.566675779668218 - }, - { - "x": 4.897324937032935, - "y": 4.4267521795236116, - "heading": -3.2882943981413915, - "angularVelocity": -0.04883848690499538, - "velocityX": -1.5822077944606066, - "velocityY": 1.2032915225032208, - "timestamp": 1.5950849727108363 - }, - { - "x": 4.855041998988872, - "y": 4.460764984125912, - "heading": -3.2896264183398576, - "angularVelocity": -0.04688694242276584, - "velocityX": -1.488354068369098, - "velocityY": 1.1972464177802156, - "timestamp": 1.6234941657534545 - }, - { - "x": 4.815402731889438, - "y": 4.49439090299611, - "heading": -3.2909011283646152, - "angularVelocity": -0.044869631560659845, - "velocityX": -1.395297185666981, - "velocityY": 1.1836280889694686, - "timestamp": 1.6519033587960728 - }, - { - "x": 4.778368948070447, - "y": 4.527425114367741, - "heading": -3.292116883219862, - "angularVelocity": -0.04279441705448228, - "velocityX": -1.3035845039116323, - "velocityY": 1.162800059898788, - "timestamp": 1.680312551838691 - }, - { - "x": 4.743889546033795, - "y": 4.559675883528322, - "heading": -3.2932722542437216, - "angularVelocity": -0.04066891383103432, - "velocityX": -1.2136705884228616, - "velocityY": 1.135222993212112, - "timestamp": 1.7087217448813092 - }, - { - "x": 4.711903404867425, - "y": 4.590966294355543, - "heading": -3.294366022687478, - "angularVelocity": -0.038500510807015505, - "velocityX": -1.1259081213037754, - "velocityY": 1.1014185014083835, - "timestamp": 1.7371309379239275 - }, - { - "x": 4.682342231358772, - "y": 4.62113502683453, - "heading": -3.2953971721767, - "angularVelocity": -0.036296331531676815, - "velocityX": -1.0405495666246902, - "velocityY": 1.0619355654956426, - "timestamp": 1.7655401309665457 - }, - { - "x": 4.655133141889209, - "y": 4.650036350102354, - "heading": -3.2963648786428728, - "angularVelocity": -0.03406314514887169, - "velocityX": -0.9577565060980874, - "velocityY": 1.0173229216496225, - "timestamp": 1.793949324009164 - }, - { - "x": 4.6302008571197, - "y": 4.677539537863245, - "heading": -3.297268497203799, - "angularVelocity": -0.0318072589943193, - "velocityX": -0.8776132687791319, - "velocityY": 0.9681087287355101, - "timestamp": 1.8223585170517822 - }, - { - "x": 4.60746946841203, - "y": 4.7035279061702235, - "heading": -3.298107546340062, - "angularVelocity": -0.029534423417245912, - "velocityX": -0.8001420059193414, - "velocityY": 0.9147872756537933, - "timestamp": 1.8507677100944004 - }, - { - "x": 4.58686379126551, - "y": 4.727897641649931, - "heading": -3.2988816902568137, - "angularVelocity": -0.02724976790400753, - "velocityX": -0.7253172279694379, - "velocityY": 0.8578116049670773, - "timestamp": 1.8791769031370187 - }, - { - "x": 4.568310353233329, - "y": 4.750556547471711, - "heading": -3.299590720494351, - "angularVelocity": -0.024957774635618345, - "velocityX": -0.6530786708495839, - "velocityY": 0.7975906175084967, - "timestamp": 1.907586096179637 - }, - { - "x": 4.551738077215872, - "y": 4.771422795168187, - "heading": -3.3002345377586937, - "angularVelocity": -0.02266228623167014, - "velocityX": -0.5833420186414909, - "velocityY": 0.7344892783534258, - "timestamp": 1.9359952892222552 - }, - { - "x": 4.537078722172511, - "y": 4.790423737866177, - "heading": -3.300813134716119, - "angularVelocity": -0.020366539681611593, - "velocityX": -0.5160074424278739, - "velocityY": 0.6688307784556118, - "timestamp": 1.9644044822648734 - }, - { - "x": 4.524267137631748, - "y": 4.80749481595678, - "heading": -3.3013265802364233, - "angularVelocity": -0.01807321733970101, - "velocityX": -0.45096615456637523, - "velocityY": 0.6008997884943068, - "timestamp": 1.9928136753074916 - }, - { - "x": 4.513241379782428, - "y": 4.822578569091268, - "heading": -3.3017750053386177, - "angularVelocity": -0.015784506850350242, - "velocityX": -0.38810528101876257, - "velocityY": 0.5309462015292464, - "timestamp": 2.02122286835011 - }, - { - "x": 4.503942727769095, - "y": 4.835623757202515, - "heading": -3.3021585909145483, - "angularVelocity": -0.01350216373111781, - "velocityX": -0.3273113741521155, - "velocityY": 0.4591889706855446, - "timestamp": 2.049632061392728 - }, - { - "x": 4.496315630351404, - "y": 4.846584586473705, - "heading": -3.3024775571832854, - "angularVelocity": -0.011227572295302874, - "velocityX": -0.2684728639158713, - "velocityY": 0.38581980328508136, - "timestamp": 2.0780412544353464 - }, - { - "x": 4.490307605856895, - "y": 4.855420032462849, - "heading": -3.302732154753915, - "angularVelocity": -0.008961802267574209, - "velocityX": -0.21148170190886365, - "velocityY": 0.31100658071807374, - "timestamp": 2.1064504474779646 - }, - { - "x": 4.485869112477555, - "y": 4.862093250897569, - "heading": -3.302922657135222, - "angularVelocity": -0.006705659714491805, - "velocityX": -0.15623440527439328, - "velocityY": 0.23489644442589466, - "timestamp": 2.134859640520583 - }, - { - "x": 4.482953401340074, - "y": 4.866571066222462, - "heading": -3.303049354516641, - "angularVelocity": -0.00445973179275778, - "velocityX": -0.10263266306467411, - "velocityY": 0.15761853278180735, - "timestamp": 2.163268833563201 - }, - { - "x": 4.481516361236572, - "y": 4.868823528289795, - "heading": -3.3031125486467343, - "angularVelocity": -0.0022244253822551407, - "velocityX": -0.05058362979002091, - "velocityY": 0.0792863797276602, - "timestamp": 2.1916780266058193 - }, - { - "x": 4.481516361236572, - "y": 4.868823528289795, - "heading": -3.3031125486467343, - "angularVelocity": 1.1943565858737654e-24, - "velocityX": 6.201298415005488e-22, - "velocityY": 3.4466920783127177e-22, - "timestamp": 2.2200872196484376 + "x": 4.162583214768669, + "y": 6.347447665147435, + "heading": -2.9495836761516045, + "angularVelocity": -0.01576998530593318, + "velocityX": 0.15297129448051064, + "velocityY": 0.05348314479313053, + "timestamp": 0.048969811063089175 + }, + { + "x": 4.177602512253265, + "y": 6.35257626623424, + "heading": -2.9511334665493774, + "angularVelocity": -0.03164787374360031, + "velocityX": 0.3067052365230814, + "velocityY": 0.10472985244312193, + "timestamp": 0.09793962212617835 + }, + { + "x": 4.200189635119117, + "y": 6.360092465931462, + "heading": -2.9534665854996804, + "angularVelocity": -0.04764402597545136, + "velocityX": 0.4612458650647525, + "velocityY": 0.15348639363829186, + "timestamp": 0.14690943318926752 + }, + { + "x": 4.23038623992188, + "y": 6.369859774063522, + "heading": -2.9565893733664335, + "angularVelocity": -0.06376965315896455, + "velocityX": 0.6166371514862435, + "velocityY": 0.1994557038310018, + "timestamp": 0.1958792442523567 + }, + { + "x": 4.268236035993276, + "y": 6.381724551550718, + "heading": -2.9605087652771482, + "angularVelocity": -0.08003690080946649, + "velocityX": 0.772921015003155, + "velocityY": 0.24228758963171887, + "timestamp": 0.24484905531544587 + }, + { + "x": 4.313784526607596, + "y": 6.395512797793485, + "heading": -2.965232340164235, + "angularVelocity": -0.09645891590230844, + "velocityX": 0.930134089258357, + "velocityY": 0.2815662536455856, + "timestamp": 0.29381886637853505 + }, + { + "x": 4.367078495343951, + "y": 6.411026156284386, + "heading": -2.9707683712029516, + "angularVelocity": -0.11304987539332809, + "velocityX": 1.088302519029422, + "velocityY": 0.31679433010095004, + "timestamp": 0.3427886774416242 + }, + { + "x": 4.428165084675981, + "y": 6.428036917409757, + "heading": -2.9771258738162327, + "angularVelocity": -0.1298249365326444, + "velocityX": 1.247433633209869, + "velocityY": 0.34737240671513037, + "timestamp": 0.3917584885047134 + }, + { + "x": 4.49709022288104, + "y": 6.446281736854329, + "heading": -2.9843146438854973, + "angularVelocity": -0.14680003686359283, + "velocityX": 1.4075026370075427, + "velocityY": 0.3725727963513324, + "timestamp": 0.4407282995678026 + }, + { + "x": 4.573896008655205, + "y": 6.465453722665752, + "heading": -2.9923452723182273, + "angularVelocity": -0.16399141141026485, + "velocityX": 1.5684313275216506, + "velocityY": 0.3915062238390777, + "timestamp": 0.48969811063089175 + }, + { + "x": 4.658616427207793, + "y": 6.485192493152983, + "heading": -3.001229110020898, + "angularVelocity": -0.1814145799179313, + "velocityX": 1.7300540213120348, + "velocityY": 0.4030803888910354, + "timestamp": 0.5386679216939809 + }, + { + "x": 4.751270399780848, + "y": 6.505071823127092, + "heading": -3.0109781343477864, + "angularVelocity": -0.19908233491709118, + "velocityX": 1.8920631009518674, + "velocityY": 0.4059507182598449, + "timestamp": 0.5876377327570701 + }, + { + "x": 4.851850606754849, + "y": 6.524584700969826, + "heading": -3.021604623744328, + "angularVelocity": -0.2170008249133559, + "velocityX": 2.0539227085115646, + "velocityY": 0.39846749291304245, + "timestamp": 0.6366075438201593 + }, + { + "x": 4.9603057580757115, + "y": 6.543126281504873, + "heading": -3.033120461060416, + "angularVelocity": -0.2351619715512455, + "velocityX": 2.214734934981403, + "velocityY": 0.3786328787578623, + "timestamp": 0.6855773548832484 + }, + { + "x": 5.076513193637353, + "y": 6.559976852057536, + "heading": -3.0455357212182053, + "angularVelocity": -0.2535288556003304, + "velocityX": 2.373042350764386, + "velocityY": 0.3441011959583454, + "timestamp": 0.7345471659463376 + }, + { + "x": 5.200238658586685, + "y": 6.574290291218965, + "heading": -3.058855907991928, + "angularVelocity": -0.2720081308167943, + "velocityX": 2.526566108044267, + "velocityY": 0.2922910840515189, + "timestamp": 0.7835169770094268 + }, + { + "x": 5.331082896954063, + "y": 6.585098992297486, + "heading": -3.073076807020245, + "angularVelocity": -0.2904013456371353, + "velocityX": 2.671936761177355, + "velocityY": 0.22072172311622418, + "timestamp": 0.832486788072516 + }, + { + "x": 5.468423843235409, + "y": 6.591351575529229, + "heading": -3.088175823348266, + "angularVelocity": -0.3083331546566214, + "velocityX": 2.804604373588566, + "velocityY": 0.12768240464901381, + "timestamp": 0.8814565991356051 + }, + { + "x": 5.611379563022578, + "y": 6.591996238312479, + "heading": -3.104100231369373, + "angularVelocity": -0.32518826753468183, + "velocityX": 2.919262228784082, + "velocityY": 0.013164493986290755, + "timestamp": 0.9304264101986943 + }, + { + "x": 5.758828163146973, + "y": 6.586098670959473, + "heading": -3.1207574004201586, + "angularVelocity": -0.3401517933023314, + "velocityX": 3.011010190225819, + "velocityY": -0.1204327160954054, + "timestamp": 0.9793962212617835 + }, + { + "x": 5.902233426168296, + "y": 6.573896393326713, + "heading": -3.137173214129699, + "angularVelocity": -0.35185511132046066, + "velocityX": 3.0737358304074114, + "velocityY": -0.26154254859402304, + "timestamp": 1.0260512596039417 + }, + { + "x": 6.047959669804794, + "y": 6.55487337569396, + "heading": -3.1540968828538256, + "angularVelocity": -0.3627404311622608, + "velocityX": 3.12348352535416, + "velocityY": -0.40773769154880374, + "timestamp": 1.0727062979461 + }, + { + "x": 6.195103135419279, + "y": 6.528785988145332, + "heading": -3.1714630452763988, + "angularVelocity": -0.37222480228637916, + "velocityX": 3.1538601369345067, + "velocityY": -0.5591547767533385, + "timestamp": 1.1193613362882582 + }, + { + "x": 6.342273583838334, + "y": 6.495493098699492, + "heading": -3.189153294446043, + "angularVelocity": -0.37917124919944706, + "velocityX": 3.154438484001192, + "velocityY": -0.7135968724680373, + "timestamp": 1.1660163746304164 + }, + { + "x": 6.487408197918111, + "y": 6.455287801316945, + "heading": -3.2069610000901583, + "angularVelocity": -0.3816888009718795, + "velocityX": 3.110802589323585, + "velocityY": -0.8617568179387292, + "timestamp": 1.2126714129725746 + }, + { + "x": 6.628042592487971, + "y": 6.4094546101533805, + "heading": -3.2246122107652013, + "angularVelocity": -0.3783345015299816, + "velocityX": 3.014345279034542, + "velocityY": -0.9823845996531712, + "timestamp": 1.2593264513147329 + }, + { + "x": 6.76234555654877, + "y": 6.36018205657845, + "heading": -3.2418944864102914, + "angularVelocity": -0.37042678045500493, + "velocityX": 2.878637952794035, + "velocityY": -1.0561035919331003, + "timestamp": 1.305981489656891 + }, + { + "x": 6.889571626411602, + "y": 6.309558361869554, + "heading": -3.2587010350854584, + "angularVelocity": -0.36023009030473874, + "velocityX": 2.726952423225606, + "velocityY": -1.0850638324982687, + "timestamp": 1.3526365279990493 + }, + { + "x": 7.0095947472284355, + "y": 6.259078906708206, + "heading": -3.2749813089827535, + "angularVelocity": -0.34894996287215513, + "velocityX": 2.5725650450999407, + "velocityY": -1.0819722146864885, + "timestamp": 1.3992915663412075 + }, + { + "x": 7.122504658549263, + "y": 6.209740963724178, + "heading": -3.2907092275270267, + "angularVelocity": -0.3371108266791727, + "velocityX": 2.420101136618307, + "velocityY": -1.0575051427928084, + "timestamp": 1.4459466046833658 + }, + { + "x": 7.228443461182924, + "y": 6.162220474685008, + "heading": -3.305870367171903, + "angularVelocity": -0.3249625374581804, + "velocityX": 2.2706830044105364, + "velocityY": -1.0185499943363998, + "timestamp": 1.492601643025524 + }, + { + "x": 7.327553022424126, + "y": 6.116993511470743, + "heading": -3.3204564150614004, + "angularVelocity": -0.3126360712111283, + "velocityX": 2.1243056433552177, + "velocityY": -0.969390762956412, + "timestamp": 1.5392566813676822 + }, + { + "x": 7.419960559859087, + "y": 6.074408763951777, + "heading": -3.3344624883943017, + "angularVelocity": -0.30020494743105264, + "velocityX": 1.980655052885471, + "velocityY": -0.9127577434758154, + "timestamp": 1.5859117197098405 + }, + { + "x": 7.505776426038997, + "y": 6.034730578891011, + "heading": -3.3478857294831443, + "angularVelocity": -0.28771257222851315, + "velocityX": 1.8393697493195704, + "velocityY": -0.8504587386634338, + "timestamp": 1.6325667580519987 + }, + { + "x": 7.585095518792171, + "y": 5.998165283481503, + "heading": -3.3607245222151003, + "angularVelocity": -0.27518555740538053, + "velocityX": 1.7001184774828544, + "velocityY": -0.783737334890718, + "timestamp": 1.679221796394157 + }, + { + "x": 7.657999517022542, + "y": 5.964877896157417, + "heading": -3.372978032399648, + "angularVelocity": -0.26264066261575153, + "velocityX": 1.5626179041094987, + "velocityY": -0.7134789404729223, + "timestamp": 1.7258768347363151 + }, + { + "x": 7.724559056876027, + "y": 5.93500312880336, + "heading": -3.3846459265015914, + "angularVelocity": -0.25008861886198047, + "velocityX": 1.4266313396926282, + "velocityY": -0.6403331433351711, + "timestamp": 1.7725318730784734 + }, + { + "x": 7.784835607016778, + "y": 5.908652875091113, + "heading": -3.3957281933250307, + "angularVelocity": -0.2375363351362947, + "velocityX": 1.2919622892322207, + "velocityY": -0.5647890270499625, + "timestamp": 1.8191869114206316 + }, + { + "x": 7.838883015534668, + "y": 5.885921459816752, + "heading": -3.406225027554339, + "angularVelocity": -0.22498822425835854, + "velocityX": 1.1584474140074106, + "velocityY": -0.4872231613583445, + "timestamp": 1.8658419497627898 + }, + { + "x": 7.8867487658899655, + "y": 5.866889415616827, + "heading": -3.416136751780165, + "angularVelocity": -0.21244702776012941, + "velocityX": 1.025950295105533, + "velocityY": -0.40793116619792125, + "timestamp": 1.912496988104948 + }, + { + "x": 7.928474992731514, + "y": 5.851626263091601, + "heading": -3.4254637632041343, + "angularVelocity": -0.19991434484667214, + "velocityX": 0.8943562865716137, + "velocityY": -0.32714907258866266, + "timestamp": 1.9591520264471063 + }, + { + "x": 7.96409930505654, + "y": 5.840192599068134, + "heading": -3.4342064965877315, + "angularVelocity": -0.1873909805727762, + "velocityX": 0.7635683859857584, + "velocityY": -0.24506815190281384, + "timestamp": 2.0058070647892645 + }, + { + "x": 7.993655456392744, + "y": 5.83264169349778, + "heading": -3.442365398135876, + "angularVelocity": -0.17487718021596504, + "velocityX": 0.6335039555523552, + "velocityY": -0.16184544775158413, + "timestamp": 2.0524621031314227 + }, + { + "x": 8.017173893739177, + "y": 5.829020730205745, + "heading": -3.449940906881815, + "angularVelocity": -0.1623727900592901, + "velocityX": 0.5040921234262654, + "velocityY": -0.07761140962911499, + "timestamp": 2.099117141473581 + }, + { + "x": 8.034682210183265, + "y": 5.82937178474551, + "heading": -3.4569334412987898, + "angularVelocity": -0.14987736942133326, + "velocityX": 0.37527171911607915, + "velocityY": 0.007524472216504663, + "timestamp": 2.145772179815739 + }, + { + "x": 8.046205520629883, + "y": 5.833732604980469, + "heading": -3.463343389598174, + "angularVelocity": -0.1373902696719508, + "velocityX": 0.24698962547429237, + "velocityY": 0.09346943845543118, + "timestamp": 2.1924272181578974 + }, + { + "x": 8.051468196812584, + "y": 5.844685972106404, + "heading": -3.4701603161303347, + "angularVelocity": -0.1225082198013852, + "velocityX": 0.09457650562789995, + "velocityY": 0.1968449419395451, + "timestamp": 2.2480718642331823 + }, + { + "x": 8.048184809934325, + "y": 5.861294321662854, + "heading": -3.4761375108001347, + "angularVelocity": -0.10741724660649189, + "velocityX": -0.059006339510488656, + "velocityY": 0.2984716541098781, + "timestamp": 2.303716510308467 + }, + { + "x": 8.036283303334299, + "y": 5.883447036443524, + "heading": -3.4812616846530076, + "angularVelocity": -0.09208745520530746, + "velocityX": -0.21388412793432043, + "velocityY": 0.3981104444567551, + "timestamp": 2.359361156383752 + }, + { + "x": 8.015683562895257, + "y": 5.911017346008104, + "heading": -3.485517607433818, + "angularVelocity": -0.07648395813412644, + "velocityX": -0.3702016616508371, + "velocityY": 0.4954710202896893, + "timestamp": 2.415005802459037 + }, + { + "x": 7.986296123840878, + "y": 5.943858632575643, + "heading": -3.488887756801902, + "angularVelocity": -0.06056556390931846, + "velocityX": -0.5281269830455628, + "velocityY": 0.5901967014599441, + "timestamp": 2.4706504485343217 + }, + { + "x": 7.948020645133899, + "y": 5.981799561635306, + "heading": -3.491351870321391, + "angularVelocity": -0.044283029784292674, + "velocityX": -0.6878555513713837, + "velocityY": 0.6818432991438246, + "timestamp": 2.5262950946096066 + }, + { + "x": 7.900744135928116, + "y": 6.024637551422569, + "heading": -3.4928863660328324, + "angularVelocity": -0.027576700000313138, + "velocityX": -0.8496146986328078, + "velocityY": 0.7698492632930963, + "timestamp": 2.5819397406848914 + }, + { + "x": 7.844338959231667, + "y": 6.072129847299749, + "heading": -3.493463582743254, + "angularVelocity": -0.010373265913863132, + "velocityX": -1.0136676333628925, + "velocityY": 0.8534926399374545, + "timestamp": 2.6375843867601763 + }, + { + "x": 7.778660742221798, + "y": 6.123981070303483, + "heading": -3.493050769497451, + "angularVelocity": 0.00741874151278994, + "velocityX": -1.1803151182057858, + "velocityY": 0.9318277078010678, + "timestamp": 2.693229032835461 + }, + { + "x": 7.703546574545105, + "y": 6.179825467361639, + "heading": -3.491608722205396, + "angularVelocity": 0.025915292732810263, + "velocityX": -1.3498902944780617, + "velocityY": 1.0035897610455067, + "timestamp": 2.748873678910746 + }, + { + "x": 7.618814473494392, + "y": 6.239201054727309, + "heading": -3.489089922616978, + "angularVelocity": 0.04526580302101711, + "velocityX": -1.5227359148996, + "velocityY": 1.06704942080748, + "timestamp": 2.804518324986031 + }, + { + "x": 7.5242665108900155, + "y": 6.301511231764772, + "heading": -3.485435989576966, + "angularVelocity": 0.0656654916102557, + "velocityX": -1.6991385384401072, + "velocityY": 1.119787462627769, + "timestamp": 2.8601629710613157 + }, + { + "x": 7.4197013507482, + "y": 6.365967240446262, + "heading": -3.480574261391913, + "angularVelocity": 0.08737099663595954, + "velocityX": -1.8791594073640787, + "velocityY": 1.1583505912551633, + "timestamp": 2.9158076171366005 + }, + { + "x": 7.30494971575777, + "y": 6.431503283367323, + "heading": -3.4744136439159683, + "angularVelocity": 0.11071357103447453, + "velocityX": -2.062222389467215, + "velocityY": 1.1777600819384002, + "timestamp": 2.9714522632118854 + }, + { + "x": 7.179962559798994, + "y": 6.496661814894046, + "heading": -3.466841472829506, + "angularVelocity": 0.13608085630049782, + "velocityX": -2.2461667882598197, + "velocityY": 1.1709757563839487, + "timestamp": 3.0270969092871702 + }, + { + "x": 7.0450043650642655, + "y": 6.559483047956268, + "heading": -3.4577292994416897, + "angularVelocity": 0.16375651622417847, + "velocityX": -2.425358129731578, + "velocityY": 1.1289717428919859, + "timestamp": 3.082741555362455 + }, + { + "x": 6.900979989447752, + "y": 6.617542454098851, + "heading": -3.4469716329246967, + "angularVelocity": 0.1933279708965771, + "velocityX": -2.588288106310453, + "velocityY": 1.0433960899676162, + "timestamp": 3.13838620143774 + }, + { + "x": 6.749698748781295, + "y": 6.668375124023075, + "heading": -3.4345853306759078, + "angularVelocity": 0.22259647823135656, + "velocityX": -2.718702540793954, + "velocityY": 0.9135231061663974, + "timestamp": 3.194030847513025 + }, + { + "x": 6.593622281446755, + "y": 6.710155384191086, + "heading": -3.4207896059713114, + "angularVelocity": 0.2479254641305738, + "velocityX": -2.8048784266392115, + "velocityY": 0.7508406129762251, + "timestamp": 3.2496754935883096 + }, + { + "x": 6.43518641122628, + "y": 6.741964154206405, + "heading": -3.4059237330536236, + "angularVelocity": 0.26715729124370924, + "velocityX": -2.8472796826871427, + "velocityY": 0.5716411597313928, + "timestamp": 3.3053201396635945 + }, + { + "x": 6.276365829184199, + "y": 6.7635314295136775, + "heading": -3.3903129196471515, + "angularVelocity": 0.28054475151753555, + "velocityX": -2.854193408422522, + "velocityY": 0.38758940578205786, + "timestamp": 3.3609647857388794 + }, + { + "x": 6.1186300644231135, + "y": 6.774906528048223, + "heading": -3.3742151723731513, + "angularVelocity": 0.2892955281307887, + "velocityX": -2.8346979608366234, + "velocityY": 0.2044239533692823, + "timestamp": 3.416609431814164 + }, + { + "x": 5.963053116486022, + "y": 6.776261296768168, + "heading": -3.3578237831063493, + "angularVelocity": 0.29457262149938523, + "velocityX": -2.795901473191203, + "velocityY": 0.024346793725904915, + "timestamp": 3.472254077889449 + }, + { + "x": 5.8104290835439985, + "y": 6.767800149453071, + "heading": -3.3412831833352663, + "angularVelocity": 0.2972541104620299, + "velocityX": -2.742834103671541, + "velocityY": -0.15205680890934775, + "timestamp": 3.527898723964734 + }, + { + "x": 5.661358014830183, + "y": 6.749723919281858, + "heading": -3.3247031677966823, + "angularVelocity": 0.2979624583495684, + "velocityX": -2.678983140842141, + "velocityY": -0.3248512021579965, + "timestamp": 3.5835433700400188 + }, + { + "x": 5.516304135655185, + "y": 6.722217125506872, + "heading": -3.3081691225058854, + "angularVelocity": 0.2971363187111854, + "velocityX": -2.606789500983575, + "velocityY": -0.49432956654573584, + "timestamp": 3.6391880161153036 + }, + { + "x": 5.375634670257568, + "y": 6.6854448318481445, + "heading": -3.2917489862090847, + "angularVelocity": 0.2950892395754448, + "velocityX": -2.527996407907734, + "velocityY": -0.6608415409629179, + "timestamp": 3.6948326621905885 + }, + { + "x": 5.247302186313446, + "y": 6.642723250226847, + "heading": -3.2764342569191007, + "angularVelocity": 0.29222750886394533, + "velocityX": -2.4487721186061138, + "velocityY": -0.8151904702673559, + "timestamp": 3.747239532952076 + }, + { + "x": 5.123684691215023, + "y": 6.592227601868027, + "heading": -3.261343469002182, + "angularVelocity": 0.287954378837072, + "velocityX": -2.35880321229308, + "velocityY": -0.96353107188246, + "timestamp": 3.799646403713563 + }, + { + "x": 5.005442832506228, + "y": 6.534399403999677, + "heading": -3.2465629258898607, + "angularVelocity": 0.2820344526882774, + "velocityX": -2.2562281813568914, + "velocityY": -1.1034468768710974, + "timestamp": 3.8520532744750504 + }, + { + "x": 4.893338332381132, + "y": 6.4698636715273565, + "heading": -3.2321912465960825, + "angularVelocity": 0.2742327310322778, + "velocityX": -2.139118373148127, + "velocityY": -1.2314364802667634, + "timestamp": 3.9044601452365377 + }, + { + "x": 4.788214065335871, + "y": 6.399503311235688, + "heading": -3.218336699236444, + "angularVelocity": 0.26436509484973597, + "velocityX": -2.005925282654272, + "velocityY": -1.3425789265665398, + "timestamp": 3.956867015998025 + }, + { + "x": 4.690926811703409, + "y": 6.324536430026673, + "heading": -3.2051106978803485, + "angularVelocity": 0.25237151472541847, + "velocityX": -1.8563835661021135, + "velocityY": -1.4304781056324285, + "timestamp": 4.009273886759512 + }, + { + "x": 4.602213375050993, + "y": 6.246550389883575, + "heading": -3.1926184281535104, + "angularVelocity": 0.23837083850498517, + "velocityX": -1.692782556244718, + "velocityY": -1.488088088640642, + "timestamp": 4.061680757521 + }, + { + "x": 4.522516933607232, + "y": 6.167421361715161, + "heading": -3.180950391265689, + "angularVelocity": 0.2226432663939251, + "velocityX": -1.5207250554316514, + "velocityY": -1.5098979774721726, + "timestamp": 4.114087628282487 + }, + { + "x": 4.451873293775449, + "y": 6.089098032772841, + "heading": -3.1701771256978444, + "angularVelocity": 0.20556971655254663, + "velocityX": -1.3479843158980969, + "velocityY": -1.4945240538933033, + "timestamp": 4.166494499043974 + }, + { + "x": 4.389944797643215, + "y": 6.013352078757408, + "heading": -3.160345990530402, + "angularVelocity": 0.18759248595829828, + "velocityX": -1.1816865848388818, + "velocityY": -1.4453439580502128, + "timestamp": 4.218901369805462 + }, + { + "x": 4.3361645159835325, + "y": 5.941631275114407, + "heading": -3.15148070753079, + "angularVelocity": 0.16916260923037685, + "velocityX": -1.0262066953863092, + "velocityY": -1.3685381821291336, + "timestamp": 4.271308240566949 + }, + { + "x": 4.289884639082712, + "y": 5.875042815583236, + "heading": -3.1435850366687292, + "angularVelocity": 0.150660986762505, + "velocityX": -0.8830879659167057, + "velocityY": -1.2706055248790982, + "timestamp": 4.323715111328436 + }, + { + "x": 4.2504715009741, + "y": 5.814408213255479, + "heading": -3.1366488915258626, + "angularVelocity": 0.13235182795847486, + "velocityX": -0.7520605129809926, + "velocityY": -1.1569971922902238, + "timestamp": 4.3761219820899235 + }, + { + "x": 4.217349104588903, + "y": 5.760333428471323, + "heading": -3.130654197761707, + "angularVelocity": 0.11438755409455087, + "velocityX": -0.6320239293802175, + "velocityY": -1.0318262471777937, + "timestamp": 4.428528852851411 + }, + { + "x": 4.19001158999409, + "y": 5.71326891600178, + "heading": -3.125579181017236, + "angularVelocity": 0.09683876695421119, + "velocityX": -0.5216398956394738, + "velocityY": -0.8980599640024567, + "timestamp": 4.480935723612898 + }, + { + "x": 4.168021099523672, + "y": 5.673554367501423, + "heading": -3.121401048080275, + "angularVelocity": 0.07972490775067456, + "velocityX": -0.4196108287117665, + "velocityY": -0.7578118655682702, + "timestamp": 4.5333425943743855 + }, + { + "x": 4.1510001991687515, + "y": 5.641450291339017, + "heading": -3.1180974896766025, + "angularVelocity": 0.06303674223762575, + "velocityX": -0.32478375654951874, + "velocityY": -0.6125928851680192, + "timestamp": 4.585749465135873 + }, + { + "x": 4.138623122411169, + "y": 5.617159927154894, + "heading": -3.1156474380074726, + "angularVelocity": 0.046750581241157815, + "velocityX": -0.2361727876085765, + "velocityY": -0.463495794180744, + "timestamp": 4.63815633589736 + }, + { + "x": 4.130607560354345, + "y": 5.600844466363652, + "heading": -3.114031389790168, + "angularVelocity": 0.030836571499560275, + "velocityX": -0.1529486866961616, + "velocityY": -0.3113229344582824, + "timestamp": 4.690563206658847 + }, + { + "x": 4.126707553863525, + "y": 5.5926337242126465, + "heading": -3.1132314898410027, + "angularVelocity": 0.01526326486474834, + "velocityX": -0.0744178470141595, + "velocityY": -0.1566730093154095, + "timestamp": 4.742970077420335 + }, + { + "x": 4.126707553863525, + "y": 5.5926337242126465, + "heading": -3.1132314898410027, + "angularVelocity": 6.34380051935383e-30, + "velocityX": 9.034383342873221e-27, + "velocityY": -4.2893656784840804e-27, + "timestamp": 4.795376948181822 } ], "eventMarkers": [ { - "timestamp": 1, + "timestamp": 4.420376948181822, "command": { - "type": "named", + "type": "parallel", "data": { - "name": "Intake Off" - } - } - }, - { - "timestamp": 2.2200872196484376, - "command": { - "type": "named", - "data": { - "name": "Shoot" + "commands": [ + { + "type": "named", + "data": { + "name": "Shoot" + } + }, + { + "type": "named", + "data": { + "name": "Intake Off" + } + } + ] } } } diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid A.3.traj b/Robot/src/main/deploy/choreo/Amp Side Mid A.3.traj new file mode 100644 index 0000000..7908eae --- /dev/null +++ b/Robot/src/main/deploy/choreo/Amp Side Mid A.3.traj @@ -0,0 +1,609 @@ +{ + "samples": [ + { + "x": 4.126707553863525, + "y": 5.5926337242126465, + "heading": -3.1132314898410027, + "angularVelocity": 6.34380051935383e-30, + "velocityX": 9.034383342873221e-27, + "velocityY": -4.2893656784840804e-27, + "timestamp": 0 + }, + { + "x": 4.127361618163081, + "y": 5.589290222894501, + "heading": -3.1133058118000747, + "angularVelocity": -0.002316783638418587, + "velocityX": 0.020388664219920926, + "velocityY": -0.10422450169017787, + "timestamp": 0.032079801427929766 + }, + { + "x": 4.128734349992625, + "y": 5.58261651038244, + "heading": -3.113455522105689, + "angularVelocity": -0.00466680898728499, + "velocityX": 0.042791157315218396, + "velocityY": -0.20803472013549282, + "timestamp": 0.06415960285585953 + }, + { + "x": 4.130895677213884, + "y": 5.572628451087546, + "heading": -3.113681729122776, + "angularVelocity": -0.0070513845790317895, + "velocityX": 0.06737346009184561, + "velocityY": -0.311350408989694, + "timestamp": 0.0962394042837893 + }, + { + "x": 4.133921430664805, + "y": 5.559345011471469, + "heading": -3.1139855796338396, + "angularVelocity": -0.009471707976318045, + "velocityX": 0.09431958167568807, + "velocityY": -0.4140748703173961, + "timestamp": 0.12831920571171906 + }, + { + "x": 4.137893983879697, + "y": 5.54278890926221, + "heading": -3.114368252819973, + "angularVelocity": -0.011928789116523258, + "velocityX": 0.12383347271698328, + "velocityY": -0.5160911686580497, + "timestamp": 0.16039900713964883 + }, + { + "x": 4.14290295369757, + "y": 5.522987413987094, + "heading": -3.114830950875775, + "angularVelocity": -0.014423345382647558, + "velocityX": 0.15614092341333877, + "velocityY": -0.6172574141271481, + "timestamp": 0.1924788085675786 + }, + { + "x": 4.149045956059229, + "y": 5.4999733355974545, + "heading": -3.1153748850742073, + "angularVelocity": -0.016955659767858167, + "velocityX": 0.19149128386781503, + "velocityY": -0.7174008991714964, + "timestamp": 0.22455860999550836 + }, + { + "x": 4.156429402683938, + "y": 5.473786245698353, + "heading": -3.1160012557676575, + "angularVelocity": -0.01952539185310932, + "velocityX": 0.23015873839794218, + "velocityY": -0.8163108477442936, + "timestamp": 0.25663841142343813 + }, + { + "x": 4.165169310646326, + "y": 5.4444739837791545, + "heading": -3.116711224448415, + "angularVelocity": -0.02213133028121866, + "velocityX": 0.27244270766523915, + "velocityY": -0.9137295311834174, + "timestamp": 0.2887182128513679 + }, + { + "x": 4.17539207591783, + "y": 5.412094507307328, + "heading": -3.1175058756504197, + "angularVelocity": -0.02477107608630567, + "velocityX": 0.31866672536831697, + "velocityY": -1.0093415492165811, + "timestamp": 0.32079801427929766 + }, + { + "x": 4.187235130982154, + "y": 5.376718146511725, + "heading": -3.1183861662726913, + "angularVelocity": -0.027440650599082298, + "velocityX": 0.3691748245677717, + "velocityY": -1.1027612148747323, + "timestamp": 0.3528778157072274 + }, + { + "x": 4.200847362955722, + "y": 5.33843031658447, + "heading": -3.119352860063593, + "angularVelocity": -0.030134032876520004, + "velocityX": 0.4243240720847195, + "velocityY": -1.193518295718653, + "timestamp": 0.3849576171351572 + }, + { + "x": 4.2163891108304945, + "y": 5.297334712708628, + "heading": -3.1204064458854384, + "angularVelocity": -0.03284265409848758, + "velocityX": 0.4844714487927506, + "velocityY": -1.281042963067218, + "timestamp": 0.41703741856308696 + }, + { + "x": 4.234031491286171, + "y": 5.253556953213796, + "heading": -3.1215470404870604, + "angularVelocity": -0.03555491464573967, + "velocityX": 0.5499529196061951, + "velocityY": -1.364651822835758, + "timestamp": 0.4491172199910167 + }, + { + "x": 4.253954734090019, + "y": 5.207248526343466, + "heading": -3.1227742803836263, + "angularVelocity": -0.038255844548259026, + "velocityX": 0.6210525600854548, + "velocityY": -1.4435384512702805, + "timestamp": 0.4811970214189465 + }, + { + "x": 4.276345168971491, + "y": 5.158590722055644, + "heading": -3.124087213275635, + "angularVelocity": -0.04092708912050639, + "velocityX": 0.6979605198546586, + "velocityY": -1.5167738614946593, + "timestamp": 0.5132768228468763 + }, + { + "x": 4.301390546701751, + "y": 5.107797994402928, + "heading": -3.1254842063708126, + "angularVelocity": -0.04354743586290734, + "velocityX": 0.7807210959995424, + "velocityY": -1.5833242536375496, + "timestamp": 0.545356624274806 + }, + { + "x": 4.329273565068363, + "y": 5.0551199465792225, + "heading": -3.1269628942313124, + "angularVelocity": -0.046094046555177036, + "velocityX": 0.8691767755874421, + "velocityY": -1.6420939494295976, + "timestamp": 0.5774364257027358 + }, + { + "x": 4.360163856491336, + "y": 5.00084097031078, + "heading": -3.128520187661993, + "angularVelocity": -0.048544360044720423, + "velocityX": 0.9629202815475943, + "velocityY": -1.6919985115988345, + "timestamp": 0.6095162271306656 + }, + { + "x": 4.3942092464422435, + "y": 4.9452766723777355, + "heading": -3.130152353475603, + "angularVelocity": -0.050878301640261164, + "velocityX": 1.061271841953092, + "velocityY": -1.7320648962829983, + "timestamp": 0.6415960285585953 + }, + { + "x": 4.431527630090928, + "y": 4.88876672478548, + "heading": -3.131855153972168, + "angularVelocity": -0.053080144538629505, + "velocityX": 1.1632984615732394, + "velocityY": -1.761542935956488, + "timestamp": 0.6736758299865251 + }, + { + "x": 4.472201034372105, + "y": 4.831664641398759, + "heading": -3.1336240146211116, + "angularVelocity": -0.05513938896777467, + "velocityX": 1.267882046357295, + "velocityY": -1.780001148542263, + "timestamp": 0.7057556314144549 + }, + { + "x": 4.516273089684364, + "y": 4.77432589666215, + "heading": -3.1354541821875874, + "angularVelocity": -0.057050464311241014, + "velocityX": 1.373825689391232, + "velocityY": -1.7873784183305264, + "timestamp": 0.7378354328423846 + }, + { + "x": 4.563750284037316, + "y": 4.717096303849241, + "heading": -3.1373408479707163, + "angularVelocity": -0.05881164156728009, + "velocityX": 1.4799715783657519, + "velocityY": -1.783975905882153, + "timestamp": 0.7699152342703144 + }, + { + "x": 4.6146064004753145, + "y": 4.660302391620251, + "heading": -3.1392792319137426, + "angularVelocity": -0.060423813638029025, + "velocityX": 1.5853002255095934, + "velocityY": -1.7703947562326396, + "timestamp": 0.8019950356982442 + }, + { + "x": 4.668788898913788, + "y": 4.604244792379401, + "heading": -3.1412646382650102, + "angularVelocity": -0.06188960850422685, + "velocityX": 1.6889910793307523, + "velocityY": -1.747442214278986, + "timestamp": 0.8340748371261739 + }, + { + "x": 4.726225895091368, + "y": 4.5491947921222655, + "heading": -3.1432924960907886, + "angularVelocity": -0.0632129170230195, + "velocityX": 1.7904411380668532, + "velocityY": -1.7160330739830774, + "timestamp": 0.8661546385541037 + }, + { + "x": 4.786832692051615, + "y": 4.495393553809111, + "heading": -3.1453583927115, + "angularVelocity": -0.06439867233443626, + "velocityX": 1.8892510010202963, + "velocityY": -1.677106338517248, + "timestamp": 0.8982344399820335 + }, + { + "x": 4.850517272949219, + "y": 4.443053245544434, + "heading": -3.1474581021699306, + "angularVelocity": -0.06545269499711938, + "velocityX": 1.9851924906916565, + "velocityY": -1.6315658431448485, + "timestamp": 0.9303142414099632 + }, + { + "x": 4.9437621180180376, + "y": 4.374171818676806, + "heading": -3.150402741414032, + "angularVelocity": -0.06673056625500977, + "velocityX": 2.11308781687508, + "velocityY": -1.5609710522391966, + "timestamp": 0.9744415343336961 + }, + { + "x": 5.042589175643495, + "y": 4.308514394194728, + "heading": -3.15340097541372, + "angularVelocity": -0.0679451151664831, + "velocityX": 2.239590309703874, + "velocityY": -1.4879096389519224, + "timestamp": 1.018568827257429 + }, + { + "x": 5.146923258079112, + "y": 4.246207789306398, + "heading": -3.15644944306721, + "angularVelocity": -0.06908349575757691, + "velocityX": 2.364388919482122, + "velocityY": -1.4119743306261106, + "timestamp": 1.0626961201811618 + }, + { + "x": 5.256670681278472, + "y": 4.187401339376366, + "heading": -3.1595440333108304, + "angularVelocity": -0.07012871260806186, + "velocityX": 2.4870644883891004, + "velocityY": -1.3326548272895222, + "timestamp": 1.1068234131048946 + }, + { + "x": 5.37171218426409, + "y": 4.1322729451563776, + "heading": -3.1626796182046615, + "angularVelocity": -0.07105772156135512, + "velocityX": 2.607037399381106, + "velocityY": -1.2493037883667124, + "timestamp": 1.1509507060286275 + }, + { + "x": 5.491892080249721, + "y": 4.081037149777456, + "heading": -3.1658496518601376, + "angularVelocity": -0.07183838947372749, + "velocityX": 2.7234821812736496, + "velocityY": -1.1610908348145161, + "timestamp": 1.1950779989523603 + }, + { + "x": 5.617001050441113, + "y": 4.033955830214484, + "heading": -3.1690455482470474, + "angularVelocity": -0.07242448324290972, + "velocityX": 2.8351834409516603, + "velocityY": -1.066943300699277, + "timestamp": 1.2392052918760932 + }, + { + "x": 5.746747873958915, + "y": 3.99135176259693, + "heading": -3.172255686793518, + "angularVelocity": -0.07274723495997151, + "velocityX": 2.9402851369570526, + "velocityY": -0.9654811069237402, + "timestamp": 1.283332584799826 + }, + { + "x": 5.880711540503468, + "y": 3.953623523789422, + "heading": -3.1754637955644602, + "angularVelocity": -0.0727012367716988, + "velocityX": 3.0358460188366085, + "velocityY": -0.8549864790644365, + "timestamp": 1.327459877723559 + }, + { + "x": 6.018259312854991, + "y": 3.921253418671523, + "heading": -3.17864639066564, + "angularVelocity": -0.07212305333754412, + "velocityX": 3.1170679921211555, + "velocityY": -0.7335619969674041, + "timestamp": 1.3715871706472917 + }, + { + "x": 6.1584140770218765, + "y": 3.894778972069645, + "heading": -3.1817693859537624, + "angularVelocity": -0.07077241954361635, + "velocityX": 3.1761468896158984, + "velocityY": -0.5999562821049207, + "timestamp": 1.4157144635710246 + }, + { + "x": 6.299691207685043, + "y": 3.8746523574270517, + "heading": -3.1847868443417173, + "angularVelocity": -0.06838077271519878, + "velocityX": 3.2015816358220777, + "velocityY": -0.4561035429338189, + "timestamp": 1.4598417564947574 + }, + { + "x": 6.440086926929617, + "y": 3.8609114265325597, + "heading": -3.1876514418180824, + "angularVelocity": -0.064916682773087, + "velocityX": 3.181607344171908, + "velocityY": -0.31139301742893755, + "timestamp": 1.5039690494184903 + }, + { + "x": 6.577519585241789, + "y": 3.852895304317245, + "heading": -3.1903375774921936, + "angularVelocity": -0.06087243282188403, + "velocityX": 3.1144593109235577, + "velocityY": -0.1816590523504174, + "timestamp": 1.5480963423422232 + }, + { + "x": 6.710430813156556, + "y": 3.849473711924821, + "heading": -3.1928462395413875, + "angularVelocity": -0.05685057666079069, + "velocityX": 3.0119959577960485, + "velocityY": -0.07753914110112503, + "timestamp": 1.592223635265956 + }, + { + "x": 6.837903774130578, + "y": 3.849513114724915, + "heading": -3.195189040331929, + "angularVelocity": -0.05309187659869676, + "velocityX": 2.888755519046643, + "velocityY": 0.0008929349045215606, + "timestamp": 1.6363509281896889 + }, + { + "x": 6.959451864685314, + "y": 3.8520920843748097, + "heading": -3.1973778162141286, + "angularVelocity": -0.049601408497511906, + "velocityX": 2.754487812447785, + "velocityY": 0.0584438672535896, + "timestamp": 1.6804782211134217 + }, + { + "x": 7.074821471996235, + "y": 3.8565095462953276, + "heading": -3.199422165983164, + "angularVelocity": -0.046328465527412294, + "velocityX": 2.6144728050804824, + "velocityY": 0.10010724945563003, + "timestamp": 1.7246055140371546 + }, + { + "x": 7.183879110928512, + "y": 3.862235800907705, + "heading": -3.2013295566724143, + "angularVelocity": -0.043224738316652994, + "velocityX": 2.47143279604223, + "velocityY": 0.12976673240016404, + "timestamp": 1.7687328069608874 + }, + { + "x": 7.286554059594033, + "y": 3.8688649864165408, + "heading": -3.203105828627542, + "angularVelocity": -0.04025336333678901, + "velocityX": 2.3267901079492375, + "velocityY": 0.15022869225839522, + "timestamp": 1.8128600998846203 + }, + { + "x": 7.382809422368965, + "y": 3.876079871178506, + "heading": -3.2047556287978103, + "angularVelocity": -0.037387296182429475, + "velocityX": 2.1813113018578907, + "velocityY": 0.16350164000394588, + "timestamp": 1.8569873928083531 + }, + { + "x": 7.472627119079689, + "y": 3.8836274243417246, + "heading": -3.2062827243266865, + "angularVelocity": -0.03460659894808434, + "velocityX": 2.0354227680805117, + "velocityY": 0.1710404754776865, + "timestamp": 1.901114685732086 + }, + { + "x": 7.55599980644016, + "y": 3.891302009366154, + "heading": -3.2076902226665296, + "angularVelocity": -0.0318963219039034, + "velocityX": 1.8893678228702142, + "velocityY": 0.17391923492097494, + "timestamp": 1.9452419786558188 + }, + { + "x": 7.6329263709350945, + "y": 3.8989336935716974, + "heading": -3.2089807269793242, + "angularVelocity": -0.029245036966696142, + "velocityX": 1.743287643497406, + "velocityY": 0.17294702892229097, + "timestamp": 1.9893692715795517 + }, + { + "x": 7.703409332939463, + "y": 3.9063799703337883, + "heading": -3.2101564476934303, + "angularVelocity": -0.026643844120189303, + "velocityX": 1.5972645801360887, + "velocityY": 0.16874537885115004, + "timestamp": 2.0334965645032845 + }, + { + "x": 7.767453311384192, + "y": 3.9135197819904346, + "heading": -3.211219284147651, + "angularVelocity": -0.02408569354248682, + "velocityX": 1.4513461896567743, + "velocityY": 0.16180035491836087, + "timestamp": 2.0776238574270174 + }, + { + "x": 7.825064096457434, + "y": 3.9202491201135516, + "heading": -3.2121708854927884, + "angularVelocity": -0.02156491554516941, + "velocityX": 1.3055590147533807, + "velocityY": 0.1524983219511668, + "timestamp": 2.1217511503507502 + }, + { + "x": 7.876248081008777, + "y": 3.926477727608759, + "heading": -3.21301269693629, + "angularVelocity": -0.01907688842269266, + "velocityX": 1.1599167127656267, + "velocityY": 0.14115090871249011, + "timestamp": 2.165878443274483 + }, + { + "x": 7.921011908809607, + "y": 3.9321265849814897, + "heading": -3.213745995433236, + "angularVelocity": -0.01661779928837861, + "velocityX": 1.0144249700111274, + "velocityY": 0.12801277845196743, + "timestamp": 2.210005736198216 + }, + { + "x": 7.959362256636442, + "y": 3.9371259647519805, + "heading": -3.214371917641177, + "angularVelocity": -0.01418446876001787, + "velocityX": 0.8690845344425987, + "velocityY": 0.11329450413219869, + "timestamp": 2.254133029121949 + }, + { + "x": 7.991305700332075, + "y": 3.9414139044546914, + "heading": -3.2148914821093557, + "angularVelocity": -0.011774220301181082, + "velocityX": 0.7238931187290586, + "velocityY": 0.09717205426858692, + "timestamp": 2.2982603220456816 + }, + { + "x": 8.0168486342553, + "y": 3.9449349928496713, + "heading": -3.215305607104995, + "angularVelocity": -0.009384781349602625, + "velocityX": 0.5788466101324847, + "velocityY": 0.07979389084813283, + "timestamp": 2.3423876149694145 + }, + { + "x": 8.035997224984508, + "y": 3.9476393938744345, + "heading": -3.2156151250917477, + "angularVelocity": -0.007014207449519859, + "velocityX": 0.4339398467588367, + "velocityY": 0.061286356936450265, + "timestamp": 2.3865149078931474 + }, + { + "x": 8.048757387107702, + "y": 3.949482053440674, + "heading": -3.2158207946062887, + "angularVelocity": -0.004660823289036077, + "velocityX": 0.2891671180747018, + "velocityY": 0.04175782025477947, + "timestamp": 2.43064220081688 + }, + { + "x": 8.055134773254395, + "y": 3.9504220485687256, + "heading": -3.2159233100890603, + "angularVelocity": -0.0023231763378057644, + "velocityX": 0.1445224876521085, + "velocityY": 0.02130189879710489, + "timestamp": 2.474769493740613 + }, + { + "x": 8.055134773254395, + "y": 3.9504220485687256, + "heading": -3.2159233100890603, + "angularVelocity": -3.604262691063738e-28, + "velocityX": 6.313479362917307e-28, + "velocityY": -2.1122209046929412e-26, + "timestamp": 2.518896786664346 + } + ], + "eventMarkers": [ + { + "timestamp": 1.1803142414099632, + "command": { + "type": "named", + "data": { + "name": "Intake On" + } + } + } + ] +} \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid A.4.traj b/Robot/src/main/deploy/choreo/Amp Side Mid A.4.traj new file mode 100644 index 0000000..c5da747 --- /dev/null +++ b/Robot/src/main/deploy/choreo/Amp Side Mid A.4.traj @@ -0,0 +1,591 @@ +{ + "samples": [ + { + "x": 8.055134773254395, + "y": 3.9504220485687256, + "heading": -3.2159233100890603, + "angularVelocity": -3.604262691063738e-28, + "velocityX": 6.313479362917307e-28, + "velocityY": -2.1122209046929412e-26, + "timestamp": 0 + }, + { + "x": 8.049461022102024, + "y": 3.9498187822580335, + "heading": -3.2160337027243697, + "angularVelocity": -0.0026590767459743207, + "velocityX": -0.13666617985358606, + "velocityY": -0.014531145251617469, + "timestamp": 0.04151540021422129 + }, + { + "x": 8.038111439942707, + "y": 3.9486321475192065, + "heading": -3.216254752452189, + "angularVelocity": -0.005324523590736178, + "velocityX": -0.27338245809391043, + "velocityY": -0.028583001312859898, + "timestamp": 0.08303080042844257 + }, + { + "x": 8.021083835373686, + "y": 3.9468838801152724, + "heading": -3.216586748696743, + "angularVelocity": -0.007996941926150492, + "velocityX": -0.41015152163191543, + "velocityY": -0.0421112983353954, + "timestamp": 0.12454620064266386 + }, + { + "x": 7.998375901501307, + "y": 3.9445978195464457, + "heading": -3.2170300090330537, + "angularVelocity": -0.010677009833060467, + "velocityX": -0.5469761523483992, + "velocityY": -0.055065362661337006, + "timestamp": 0.16606160085688515 + }, + { + "x": 7.96998521379872, + "y": 3.9418002285325686, + "heading": -3.2175848829828535, + "angularVelocity": -0.013365496826157975, + "velocityX": -0.683859183726731, + "velocityY": -0.06738682511650008, + "timestamp": 0.20757700107110644 + }, + { + "x": 7.935909230970341, + "y": 3.9385201802867247, + "heading": -3.218251756575839, + "angularVelocity": -0.01606328228908466, + "velocityX": -0.8208034284276444, + "velocityY": -0.07900798809402691, + "timestamp": 0.24909240128532772 + }, + { + "x": 7.896145300692883, + "y": 3.9347900324583236, + "heading": -3.2190310578778996, + "angularVelocity": -0.01877137876641979, + "velocityX": -0.957811560825007, + "velocityY": -0.08984973790818522, + "timestamp": 0.290607801499549 + }, + { + "x": 7.8506906731539425, + "y": 3.930646013260306, + "heading": -3.2199232637551662, + "angularVelocity": -0.02149096173137775, + "velocityX": -1.094885929182725, + "velocityY": -0.0998188425652607, + "timestamp": 0.3321232017137703 + }, + { + "x": 7.7995425270023055, + "y": 3.926128954800206, + "heading": -3.220928908237445, + "angularVelocity": -0.024223408110953516, + "velocityX": -1.2320282566881047, + "velocityY": -0.10880440599854542, + "timestamp": 0.3736386019279916 + }, + { + "x": 7.742698015104242, + "y": 3.921285222505105, + "heading": -3.2220485929804363, + "angularVelocity": -0.026970346840301144, + "velocityX": -1.3692391643761652, + "velocityY": -0.116673144666967, + "timestamp": 0.4151540021422129 + }, + { + "x": 7.680154342166577, + "y": 3.9161679101915414, + "heading": -3.223283000524606, + "angularVelocity": -0.02973372622689661, + "velocityX": -1.506517403540283, + "velocityY": -0.12326298884650128, + "timestamp": 0.45666940235643416 + }, + { + "x": 7.611908894321344, + "y": 3.9108384018157785, + "heading": -3.2246329113446155, + "angularVelocity": -0.03251590525548623, + "velocityX": -1.6438586041103558, + "velocityY": -0.12837425023635723, + "timestamp": 0.49818480257065545 + }, + { + "x": 7.537959455007086, + "y": 3.905368450142458, + "heading": -3.2260992261349672, + "angularVelocity": -0.035319779715139006, + "velocityX": -1.781253195986901, + "velocityY": -0.13175717071485094, + "timestamp": 0.5397002027848767 + }, + { + "x": 7.458304567583274, + "y": 3.8998430016438226, + "heading": -3.227682995484174, + "angularVelocity": -0.03814896016982266, + "velocityX": -1.918682874614944, + "velocityY": -0.13309394755015833, + "timestamp": 0.581215602999098 + }, + { + "x": 7.372944154845317, + "y": 3.8943641280279326, + "heading": -3.229385460225228, + "angularVelocity": -0.04100802912339112, + "velocityX": -2.0561144129044058, + "velocityY": -0.13197207753312756, + "timestamp": 0.6227310032133193 + }, + { + "x": 7.281880604712491, + "y": 3.8890566496653665, + "heading": -3.2312081076269537, + "angularVelocity": -0.043902922585852135, + "velocityX": -2.193488432315086, + "velocityY": -0.1278436034623064, + "timestamp": 0.6642464034275406 + }, + { + "x": 7.185120739461099, + "y": 3.8840764365077023, + "heading": -3.2331527517793455, + "angularVelocity": -0.04684151284480821, + "velocityX": -2.330698120507232, + "velocityY": -0.11996062020276978, + "timestamp": 0.7057618036417619 + }, + { + "x": 7.082679550342636, + "y": 3.879623112717479, + "heading": -3.2352216520559507, + "angularVelocity": -0.049834525644204826, + "velocityX": -2.467546707724402, + "velocityY": -0.10726920051942324, + "timestamp": 0.7472772038559832 + }, + { + "x": 6.974587692374973, + "y": 3.8759603104264273, + "heading": -3.237417693068683, + "angularVelocity": -0.05289702138003111, + "velocityX": -2.6036568938250175, + "velocityY": -0.08822755585039478, + "timestamp": 0.7887926040702045 + }, + { + "x": 6.860907625972457, + "y": 3.873449383506687, + "heading": -3.239744664173613, + "angularVelocity": -0.056050793029156644, + "velocityX": -2.7382625680090196, + "velocityY": -0.06048181895835718, + "timestamp": 0.8303080042844257 + }, + { + "x": 6.741771480880281, + "y": 3.8726075802709823, + "heading": -3.242207683562328, + "angularVelocity": -0.059327848846587705, + "velocityX": -2.8696855739659712, + "velocityY": -0.020276890776944532, + "timestamp": 0.871823404498647 + }, + { + "x": 6.617478467315157, + "y": 3.8742073590689143, + "heading": -3.24481367151268, + "angularVelocity": -0.0627715964896024, + "velocityX": -2.9939013697029293, + "velocityY": 0.03853458691659454, + "timestamp": 0.9133388047128683 + }, + { + "x": 6.488758715883249, + "y": 3.879406926640922, + "heading": -3.247570309190339, + "angularVelocity": -0.06640036380319386, + "velocityX": -3.1005301832020784, + "velocityY": 0.12524430802010722, + "timestamp": 0.9548542049270896 + }, + { + "x": 6.357349625228428, + "y": 3.8896386087606296, + "heading": -3.250472668687868, + "angularVelocity": -0.06991043040781329, + "velocityX": -3.165309499047169, + "velocityY": 0.24645510020164774, + "timestamp": 0.9963696051413109 + }, + { + "x": 6.226097742502279, + "y": 3.905573882546096, + "heading": -3.253467220206788, + "angularVelocity": -0.07213110083169395, + "velocityX": -3.161522761406181, + "velocityY": 0.38384006183824343, + "timestamp": 1.0378850053555322 + }, + { + "x": 6.097361671143063, + "y": 3.926630381001014, + "heading": -3.256480660362481, + "angularVelocity": -0.07258607986779345, + "velocityX": -3.1009232885852347, + "velocityY": 0.5071972893496168, + "timestamp": 1.0794004055697535 + }, + { + "x": 5.972395859043095, + "y": 3.951969566289386, + "heading": -3.2594678160246513, + "angularVelocity": -0.07195295352463506, + "velocityX": -3.0101073687146873, + "velocityY": 0.6103562812262632, + "timestamp": 1.1209158057839748 + }, + { + "x": 5.851830452160621, + "y": 3.980940911335539, + "heading": -3.2624048122101206, + "angularVelocity": -0.07074473979086897, + "velocityX": -2.9041128415082147, + "velocityY": 0.6978457366822604, + "timestamp": 1.162431205998196 + }, + { + "x": 5.736009410595542, + "y": 4.0130819636489, + "heading": -3.265278093679901, + "angularVelocity": -0.06921001495720394, + "velocityX": -2.7898331936447, + "velocityY": 0.7741958923077186, + "timestamp": 1.2039466062124173 + }, + { + "x": 5.625138940256402, + "y": 4.048059882088207, + "heading": -3.2680792005517927, + "angularVelocity": -0.06747151315988477, + "velocityX": -2.670586571899624, + "velocityY": 0.8425287546023689, + "timestamp": 1.2454620064266386 + }, + { + "x": 5.519352651225023, + "y": 4.085627588699353, + "heading": -3.270802426805142, + "angularVelocity": -0.06559556789282064, + "velocityX": -2.5481216243976026, + "velocityY": 0.9049101397865432, + "timestamp": 1.28697740664086 + }, + { + "x": 5.41874256251759, + "y": 4.125595879402791, + "heading": -3.2734436882617852, + "angularVelocity": -0.06362124520091768, + "velocityX": -2.4234401737254063, + "velocityY": 0.9627340817431439, + "timestamp": 1.3284928068550812 + }, + { + "x": 5.323375157332968, + "y": 4.1678158549838615, + "heading": -3.275999925523388, + "angularVelocity": -0.06157322941396035, + "velocityX": -2.297157312527901, + "velocityY": 1.0169714217667094, + "timestamp": 1.3700082070693025 + }, + { + "x": 5.233300333220428, + "y": 4.212167583324043, + "heading": -3.2784687641766523, + "angularVelocity": -0.059468020072674224, + "velocityX": -2.169672546759749, + "velocityY": 1.0683199032485289, + "timestamp": 1.4115236072835238 + }, + { + "x": 5.148556709289551, + "y": 4.258552551269531, + "heading": -3.2808483088426774, + "angularVelocity": -0.05731715589266657, + "velocityX": -2.0412575452385213, + "velocityY": 1.117295454364858, + "timestamp": 1.453039007497745 + }, + { + "x": 5.093077041800993, + "y": 4.291207597300886, + "heading": -3.28243411107928, + "angularVelocity": -0.05582003804977755, + "velocityX": -1.9528772748078782, + "velocityY": 1.1494534879032836, + "timestamp": 1.4814482005403633 + }, + { + "x": 5.040173170230802, + "y": 4.3245726177241375, + "heading": -3.283974328628088, + "angularVelocity": -0.054215462808034555, + "velocityX": -1.8622095844407982, + "velocityY": 1.174444496652867, + "timestamp": 1.5098573935829815 + }, + { + "x": 4.989894799514629, + "y": 4.358433126349113, + "heading": -3.2854661326260484, + "angularVelocity": -0.05251131194477834, + "velocityX": -1.7697922866287714, + "velocityY": 1.1918856186509874, + "timestamp": 1.5382665866255998 + }, + { + "x": 4.9422741836993, + "y": 4.392567638374273, + "heading": -3.286906936138998, + "angularVelocity": -0.0507161013263647, + "velocityX": -1.676239650450214, + "velocityY": 1.2015305036631485, + "timestamp": 1.566675779668218 + }, + { + "x": 4.897324937032934, + "y": 4.426752179523612, + "heading": -3.2882943981413915, + "angularVelocity": -0.04883848690499593, + "velocityX": -1.5822077944606079, + "velocityY": 1.2032915225032221, + "timestamp": 1.5950849727108363 + }, + { + "x": 4.855041998988871, + "y": 4.4607649841259125, + "heading": -3.289626418339858, + "angularVelocity": -0.04688694242276638, + "velocityX": -1.4883540683690992, + "velocityY": 1.1972464177802173, + "timestamp": 1.6234941657534545 + }, + { + "x": 4.815402731889437, + "y": 4.494390902996111, + "heading": -3.290901128364616, + "angularVelocity": -0.044869631560660386, + "velocityX": -1.3952971856669822, + "velocityY": 1.1836280889694708, + "timestamp": 1.6519033587960728 + }, + { + "x": 4.7783689480704465, + "y": 4.527425114367743, + "heading": -3.292116883219863, + "angularVelocity": -0.04279441705448278, + "velocityX": -1.3035845039116334, + "velocityY": 1.1628000598987902, + "timestamp": 1.680312551838691 + }, + { + "x": 4.743889546033794, + "y": 4.559675883528325, + "heading": -3.2932722542437225, + "angularVelocity": -0.04066891383103477, + "velocityX": -1.2136705884228622, + "velocityY": 1.1352229932121145, + "timestamp": 1.7087217448813092 + }, + { + "x": 4.7119034048674235, + "y": 4.590966294355546, + "heading": -3.2943660226874782, + "angularVelocity": -0.038500510807015914, + "velocityX": -1.1259081213037758, + "velocityY": 1.1014185014083862, + "timestamp": 1.7371309379239275 + }, + { + "x": 4.682342231358771, + "y": 4.621135026834533, + "heading": -3.2953971721767004, + "angularVelocity": -0.03629633153167719, + "velocityX": -1.0405495666246907, + "velocityY": 1.0619355654956453, + "timestamp": 1.7655401309665457 + }, + { + "x": 4.655133141889207, + "y": 4.650036350102356, + "heading": -3.296364878642873, + "angularVelocity": -0.034063145148872064, + "velocityX": -0.9577565060980876, + "velocityY": 1.0173229216496253, + "timestamp": 1.793949324009164 + }, + { + "x": 4.630200857119698, + "y": 4.677539537863246, + "heading": -3.2972684972037993, + "angularVelocity": -0.03180725899431965, + "velocityX": -0.8776132687791319, + "velocityY": 0.9681087287355129, + "timestamp": 1.8223585170517822 + }, + { + "x": 4.607469468412028, + "y": 4.703527906170224, + "heading": -3.2981075463400624, + "angularVelocity": -0.02953442341724624, + "velocityX": -0.8001420059193413, + "velocityY": 0.9147872756537958, + "timestamp": 1.8507677100944004 + }, + { + "x": 4.586863791265508, + "y": 4.727897641649932, + "heading": -3.298881690256814, + "angularVelocity": -0.02724976790400784, + "velocityX": -0.7253172279694378, + "velocityY": 0.8578116049670796, + "timestamp": 1.8791769031370187 + }, + { + "x": 4.5683103532333265, + "y": 4.750556547471711, + "heading": -3.2995907204943515, + "angularVelocity": -0.024957774635618633, + "velocityX": -0.6530786708495838, + "velocityY": 0.797590617508499, + "timestamp": 1.907586096179637 + }, + { + "x": 4.55173807721587, + "y": 4.771422795168187, + "heading": -3.300234537758694, + "angularVelocity": -0.022662286231670405, + "velocityX": -0.5833420186414907, + "velocityY": 0.7344892783534279, + "timestamp": 1.9359952892222552 + }, + { + "x": 4.5370787221725095, + "y": 4.790423737866178, + "heading": -3.3008131347161194, + "angularVelocity": -0.02036653968161184, + "velocityX": -0.5160074424278736, + "velocityY": 0.6688307784556137, + "timestamp": 1.9644044822648734 + }, + { + "x": 4.524267137631747, + "y": 4.8074948159567805, + "heading": -3.3013265802364242, + "angularVelocity": -0.01807321733970122, + "velocityX": -0.45096615456637484, + "velocityY": 0.6008997884943085, + "timestamp": 1.9928136753074916 + }, + { + "x": 4.513241379782426, + "y": 4.822578569091269, + "heading": -3.3017750053386186, + "angularVelocity": -0.015784506850350405, + "velocityX": -0.38810528101876224, + "velocityY": 0.5309462015292479, + "timestamp": 2.02122286835011 + }, + { + "x": 4.503942727769094, + "y": 4.835623757202516, + "heading": -3.3021585909145488, + "angularVelocity": -0.01350216373111798, + "velocityX": -0.32731137415211514, + "velocityY": 0.4591889706855459, + "timestamp": 2.049632061392728 + }, + { + "x": 4.496315630351404, + "y": 4.846584586473706, + "heading": -3.302477557183286, + "angularVelocity": -0.011227572295303039, + "velocityX": -0.26847286391587094, + "velocityY": 0.3858198032850825, + "timestamp": 2.0780412544353464 + }, + { + "x": 4.490307605856894, + "y": 4.85542003246285, + "heading": -3.3027321547539152, + "angularVelocity": -0.008961802267574346, + "velocityX": -0.2114817019088633, + "velocityY": 0.31100658071807463, + "timestamp": 2.1064504474779646 + }, + { + "x": 4.485869112477555, + "y": 4.862093250897569, + "heading": -3.3029226571352224, + "angularVelocity": -0.006705659714491917, + "velocityX": -0.15623440527439303, + "velocityY": 0.23489644442589536, + "timestamp": 2.134859640520583 + }, + { + "x": 4.482953401340073, + "y": 4.866571066222462, + "heading": -3.303049354516641, + "angularVelocity": -0.004459731792757826, + "velocityX": -0.10263266306467393, + "velocityY": 0.1576185327818078, + "timestamp": 2.163268833563201 + }, + { + "x": 4.481516361236572, + "y": 4.868823528289795, + "heading": -3.3031125486467343, + "angularVelocity": -0.0022244253822551953, + "velocityX": -0.05058362979002082, + "velocityY": 0.07928637972766044, + "timestamp": 2.1916780266058193 + }, + { + "x": 4.481516361236572, + "y": 4.868823528289795, + "heading": -3.3031125486467343, + "angularVelocity": 6.851173296886301e-29, + "velocityX": 4.467353937750162e-26, + "velocityY": -9.136715174907558e-29, + "timestamp": 2.2200872196484376 + } + ], + "eventMarkers": [ + { + "timestamp": 1, + "command": { + "type": "named", + "data": { + "name": "Intake Off" + } + } + }, + { + "timestamp": 2.2200872196484376, + "command": { + "type": "named", + "data": { + "name": "Shoot" + } + } + } + ] +} \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid A.traj b/Robot/src/main/deploy/choreo/Amp Side Mid A.traj index f847ec7..291b918 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid A.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid A.traj @@ -4,2476 +4,2476 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": 2.138090744083086e-22, - "velocityX": 8.395290935795329e-21, - "velocityY": 1.2014410640329063e-20, + "angularVelocity": 3.3655423830458915e-22, + "velocityX": 6.379206572795731e-21, + "velocityY": 6.00570137114375e-21, "timestamp": 0 }, { - "x": 2.604589766672516, - "y": 6.860513178172266, - "heading": -2.671504019088023, - "angularVelocity": -0.021246762972301565, - "velocityX": 0.2842124016542836, - "velocityY": 0.054440081245398515, - "timestamp": 0.08743110370029157 - }, - { - "x": 2.6542901215482235, - "y": 6.8700203662565915, - "heading": -2.675220477646094, - "angularVelocity": -0.04250728174278654, - "velocityX": 0.5684516467512226, - "velocityY": 0.10873919785932558, - "timestamp": 0.17486220740058314 - }, - { - "x": 2.7288445568610946, - "y": 6.884260625866981, - "heading": -2.6807965298828265, - "angularVelocity": -0.06377652804025735, - "velocityX": 0.8527221109828285, - "velocityY": 0.1628740689263849, - "timestamp": 0.2622933111008747 - }, - { - "x": 2.8282562855247506, - "y": 6.903217009019292, - "heading": -2.688232564646954, - "angularVelocity": -0.08505022182514968, - "velocityX": 1.1370293231620792, - "velocityY": 0.21681509611603708, - "timestamp": 0.3497244148011663 - }, - { - "x": 2.952529143619552, - "y": 6.926869208476042, - "heading": -2.697528688552468, - "angularVelocity": -0.10632513501580529, - "velocityX": 1.4213804108066732, - "velocityY": 0.2705238577088996, - "timestamp": 0.43715551850145784 - }, - { - "x": 3.101667789963631, - "y": 6.955192446614957, - "heading": -2.7086848533162016, - "angularVelocity": -0.12759949596400413, - "velocityX": 1.705784784043409, - "velocityY": 0.32394922333368664, - "timestamp": 0.5245866222017495 - }, - { - "x": 3.2756780012561117, - "y": 6.988155814528643, - "heading": -2.721701033579155, - "angularVelocity": -0.14887356686668493, - "velocityX": 1.990255228722458, - "velocityY": 0.37702106594332374, - "timestamp": 0.6120177259020411 - }, - { - "x": 3.4745671276840473, - "y": 7.025719673404508, - "heading": -2.736577482795638, - "angularVelocity": -0.1701505366726105, - "velocityX": 2.2748097417335074, - "velocityY": 0.42963953657307824, - "timestamp": 0.6994488296023327 - }, - { - "x": 3.6983448349031947, - "y": 7.067831347797815, - "heading": -2.753315121465556, - "angularVelocity": -0.1914380347672825, - "velocityX": 2.5594748064286494, - "velocityY": 0.48165552773605236, - "timestamp": 0.7868799333026243 - }, - { - "x": 3.947024398434649, - "y": 7.1144174317493984, - "heading": -2.7719161751976173, - "angularVelocity": -0.2127509884334108, - "velocityX": 2.844291710921471, - "velocityY": 0.5328319325726028, - "timestamp": 0.8743110370029159 - }, - { - "x": 4.220625178803467, - "y": 7.165368564094144, - "heading": -2.792385350903891, - "angularVelocity": -0.2341177777698074, - "velocityX": 3.129330052914627, - "velocityY": 0.582757510638344, - "timestamp": 0.9617421407032075 - }, - { - "x": 4.519178004654404, - "y": 7.220504479528652, - "heading": -2.814732394345908, - "angularVelocity": -0.25559603500627764, - "velocityX": 3.4147209999127814, - "velocityY": 0.6306212903763969, - "timestamp": 1.0491732444034991 - }, - { - "x": 4.842739369959763, - "y": 7.2794721381065175, - "heading": -2.83897926425426, - "angularVelocity": -0.27732544691953914, - "velocityX": 3.700758101081589, - "velocityY": 0.6744471484656239, - "timestamp": 1.1366043481037906 - }, - { - "x": 5.191441788464345, - "y": 7.341270741000058, - "heading": -2.8651925381906103, - "angularVelocity": -0.2998163448354441, - "velocityX": 3.9883108384392805, - "velocityY": 0.7068262926816484, - "timestamp": 1.2240354518040821 - }, - { - "x": 5.561204157509806, - "y": 7.389060004842413, - "heading": -2.8942968081284857, - "angularVelocity": -0.33288233484553686, - "velocityX": 4.229185648999519, - "velocityY": 0.5465933954828472, - "timestamp": 1.3114665555043736 - }, - { - "x": 5.90676702099797, - "y": 7.429462102575199, - "heading": -2.9217646179534578, - "angularVelocity": -0.31416519593679304, - "velocityX": 3.9524019355026363, - "velocityY": 0.46210211266784756, - "timestamp": 1.3988976592046651 - }, - { - "x": 6.227776320980141, - "y": 7.463758279292559, - "heading": -2.9475006078951895, - "angularVelocity": -0.2943573722911377, - "velocityX": 3.671568656877204, - "velocityY": 0.39226516955480606, - "timestamp": 1.4863287629049566 - }, - { - "x": 6.524134980202349, - "y": 7.492353826396467, - "heading": -2.971474957941676, - "angularVelocity": -0.27420847995547176, - "velocityX": 3.3896250496631803, - "velocityY": 0.3270637781484755, - "timestamp": 1.5737598666052481 - }, - { - "x": 6.795798003981723, - "y": 7.515447318802456, - "heading": -2.9936725567296794, - "angularVelocity": -0.25388675023588664, - "velocityX": 3.107166812289346, - "velocityY": 0.26413360267248104, - "timestamp": 1.6611909703055396 - }, - { - "x": 7.042739486323945, - "y": 7.533156595046494, - "heading": -3.0140838093526265, - "angularVelocity": -0.23345527803143726, - "velocityX": 2.824412273105024, - "velocityY": 0.20255121455111968, - "timestamp": 1.7486220740058311 - }, - { - "x": 7.264942602620708, - "y": 7.545559665755271, - "heading": -3.032701765954018, - "angularVelocity": -0.21294431630661517, - "velocityX": 2.541465301164011, - "velocityY": 0.14186107899647651, - "timestamp": 1.8360531777061226 - }, - { - "x": 7.462395551623203, - "y": 7.5527119818078186, - "heading": -3.0495209788957442, - "angularVelocity": -0.19237104680025272, - "velocityX": 2.2583833515284413, - "velocityY": 0.08180516715270715, - "timestamp": 1.9234842814064141 - }, - { - "x": 7.635089599917891, - "y": 7.554654982123625, - "heading": -3.0645369861632634, - "angularVelocity": -0.17174674265800233, - "velocityX": 1.9752015128011309, - "velocityY": 0.02222321615047185, - "timestamp": 2.010915385106706 - }, - { - "x": 7.783018023947976, - "y": 7.551420808420136, - "heading": -3.077746062264594, - "angularVelocity": -0.15107982791352897, - "velocityX": 1.6919427728737597, - "velocityY": -0.03699111147646792, - "timestamp": 2.0983464888069974 - }, - { - "x": 7.9061754878102075, - "y": 7.5430351187739655, - "heading": -3.089145095467739, - "angularVelocity": -0.13037732249406989, - "velocityX": 1.4086230031409384, - "velocityY": -0.09591197287085713, - "timestamp": 2.185777592507289 - }, - { - "x": 8.004557653466987, - "y": 7.5295188704834, - "heading": -3.0987315280382326, - "angularVelocity": -0.1096455627891347, - "velocityX": 1.1252536167681009, - "velocityY": -0.1545931335477347, - "timestamp": 2.2732086962075804 - }, - { - "x": 8.0781609241493, - "y": 7.510889504584073, - "heading": -3.1065033281773795, - "angularVelocity": -0.08889056422972949, - "velocityX": 0.8418430920718916, - "velocityY": -0.21307481103277137, - "timestamp": 2.360639799907872 - }, - { - "x": 8.126982268554706, - "y": 7.48716176359185, - "heading": -3.1124589770111943, - "angularVelocity": -0.06811819343183008, - "velocityX": 0.5583978966199632, - "velocityY": -0.27138786985420976, - "timestamp": 2.4480709036081634 + "x": 2.6050610765354496, + "y": 6.860345987159577, + "heading": -2.6712752622193263, + "angularVelocity": -0.018473587950192584, + "velocityX": 0.28716640227144474, + "velocityY": 0.05208586613029278, + "timestamp": 0.08817296739659823 + }, + { + "x": 2.655702449187344, + "y": 6.869526965685582, + "heading": -2.674534004894112, + "angularVelocity": -0.03695852335476156, + "velocityX": 0.5743412538687886, + "velocityY": 0.10412464043213543, + "timestamp": 0.17634593479319646 + }, + { + "x": 2.7316657503038435, + "y": 6.883291516752998, + "heading": -2.6794232791182258, + "angularVelocity": -0.05545094339540405, + "velocityX": 0.861525968325646, + "velocityY": 0.156108515725732, + "timestamp": 0.2645189021897947 + }, + { + "x": 2.8329520075707495, + "y": 6.901633922922054, + "heading": -2.6859434576928263, + "angularVelocity": -0.07394759150242652, + "velocityX": 1.1487223381212155, + "velocityY": 0.2080275475651401, + "timestamp": 0.3526918695863929 + }, + { + "x": 2.9595624533624134, + "y": 6.9245473261835055, + "heading": -2.694094701532431, + "angularVelocity": -0.09244606459642621, + "velocityX": 1.4359326846988782, + "velocityY": 0.2598688003590563, + "timestamp": 0.44086483698299117 + }, + { + "x": 3.1114985918883113, + "y": 6.952023347160384, + "heading": -2.703877064931321, + "angularVelocity": -0.11094515346057994, + "velocityX": 1.7231600910344236, + "velocityY": 0.31161501975194, + "timestamp": 0.5290378043795894 + }, + { + "x": 3.2887622995138552, + "y": 6.984051514205735, + "heading": -2.715290645068638, + "angularVelocity": -0.12944534446685022, + "velocityX": 2.01040877787655, + "velocityY": 0.36324247658910663, + "timestamp": 0.6172107717761876 + }, + { + "x": 3.4913559816226885, + "y": 7.020618366869622, + "heading": -2.7283358019554202, + "angularVelocity": -0.14794961848233576, + "velocityX": 2.297684745003259, + "velocityY": 0.41471727382623713, + "timestamp": 0.7053837391727857 + }, + { + "x": 3.7192828323534473, + "y": 7.061705962999724, + "heading": -2.743013500900774, + "angularVelocity": -0.16646484040095605, + "velocityX": 2.5849969379566557, + "velocityY": 0.4659885829326004, + "timestamp": 0.7935567065693839 + }, + { + "x": 3.9725472979903476, + "y": 7.107289194770783, + "heading": -2.7593258915247603, + "angularVelocity": -0.18500444190126777, + "velocityX": 2.872359557751167, + "velocityY": 0.5169751355427069, + "timestamp": 0.8817296739659821 + }, + { + "x": 4.251155992007747, + "y": 7.157330430023032, + "heading": -2.777277407245389, + "angularVelocity": -0.2035943243225953, + "velocityX": 3.1597971832367806, + "velocityY": 0.5675348888641238, + "timestamp": 0.9699026413625803 + }, + { + "x": 4.555119788328324, + "y": 7.211767042055497, + "heading": -2.796877233287328, + "angularVelocity": -0.22228837954131203, + "velocityX": 3.447358133625697, + "velocityY": 0.6173843711940759, + "timestamp": 1.0580756087591785 + }, + { + "x": 4.884459882518826, + "y": 7.27047417558018, + "heading": -2.8181465130803445, + "angularVelocity": -0.24122222968121568, + "velocityX": 3.7351594702392714, + "velocityY": 0.665817826688542, + "timestamp": 1.1462485761557768 + }, + { + "x": 5.239235528324246, + "y": 7.333080725767244, + "heading": -2.8411535355871766, + "angularVelocity": -0.2609305684739806, + "velocityX": 4.023632823988497, + "velocityY": 0.7100424544573067, + "timestamp": 1.234421543552375 + }, + { + "x": 5.610187450691477, + "y": 7.375734987777251, + "heading": -2.8703104693697137, + "angularVelocity": -0.33067883097764283, + "velocityX": 4.20709354941754, + "velocityY": 0.4837566804137338, + "timestamp": 1.3225945109489734 + }, + { + "x": 5.955981368436564, + "y": 7.412973853213799, + "heading": -2.898024923168262, + "angularVelocity": -0.31431916852576924, + "velocityX": 3.9217679517319706, + "velocityY": 0.4223388021982916, + "timestamp": 1.4107674783455717 + }, + { + "x": 6.276537520123413, + "y": 7.4451838654734495, + "heading": -2.924223595532576, + "angularVelocity": -0.2971281690733325, + "velocityX": 3.635537752120799, + "velocityY": 0.3653048458125664, + "timestamp": 1.49894044574217 + }, + { + "x": 6.571830912097573, + "y": 7.47249273252466, + "heading": -2.9488824909824602, + "angularVelocity": -0.279665028613237, + "velocityX": 3.3490240908638538, + "velocityY": 0.30971926949419576, + "timestamp": 1.5871134131387683 + }, + { + "x": 6.841849345139681, + "y": 7.494964072142321, + "heading": -2.9719894022564435, + "angularVelocity": -0.2620634413952497, + "velocityX": 3.062372074057307, + "velocityY": 0.2548552042780421, + "timestamp": 1.6752863805353666 + }, + { + "x": 7.086585597012585, + "y": 7.512635968870317, + "heading": -2.993536590651642, + "angularVelocity": -0.24437408688175255, + "velocityX": 2.775638147371063, + "velocityY": 0.20042306899470433, + "timestamp": 1.763459347931965 + }, + { + "x": 7.306034895064365, + "y": 7.525533770781237, + "heading": -3.01351842580479, + "angularVelocity": -0.22662087647873794, + "velocityX": 2.4888500923951824, + "velocityY": 0.14627841493534438, + "timestamp": 1.8516323153285632 + }, + { + "x": 7.5001938519959825, + "y": 7.533675560070343, + "heading": -3.0319304290369935, + "angularVelocity": -0.20881687183541217, + "velocityX": 2.2020236208939075, + "velocityY": 0.09233883728199388, + "timestamp": 1.9398052827251615 + }, + { + "x": 7.669059939862971, + "y": 7.537074883806149, + "heading": -3.048768836452478, + "angularVelocity": -0.19097017955339882, + "velocityX": 1.9151684791035324, + "velocityY": 0.03855290159982452, + "timestamp": 2.02797825012176 + }, + { + "x": 7.812631200221533, + "y": 7.535742269192649, + "heading": -3.064030388112588, + "angularVelocity": -0.17308651518400572, + "velocityX": 1.6282911259273427, + "velocityY": -0.015113641435094947, + "timestamp": 2.116151217518358 + }, + { + "x": 7.930906071252784, + "y": 7.529686131887914, + "heading": -3.077712226044625, + "angularVelocity": -0.15517043756162383, + "velocityX": 1.3413960596251193, + "velocityY": -0.0686847395925208, + "timestamp": 2.204324184914956 + }, + { + "x": 8.023883278248142, + "y": 7.51891335359463, + "heading": -3.0898118478873737, + "angularVelocity": -0.13722597979860962, + "velocityX": 1.0544865364137177, + "velocityY": -0.12217778998892762, + "timestamp": 2.292497152311554 + }, + { + "x": 8.09156176085636, + "y": 7.503429666879887, + "heading": -3.100327089640208, + "angularVelocity": -0.11925697935896586, + "velocityX": 0.7675649873934917, + "velocityY": -0.17560582536707564, + "timestamp": 2.380670119708152 + }, + { + "x": 8.133940622858004, + "y": 7.483239921445362, + "heading": -3.1092561232896654, + "angularVelocity": -0.10126724678885639, + "velocityX": 0.48063327403995604, + "velocityY": -0.22897885860767764, + "timestamp": 2.46884308710475 }, { "x": 8.151019096374512, "y": 7.458348274230957, "heading": -3.116597461241803, - "angularVelocity": -0.047334232961245795, - "velocityX": 0.2749230743123512, - "velocityY": -0.32955650954222365, - "timestamp": 2.535502007308455 - }, - { - "x": 8.148432483672298, - "y": 7.421806810166393, - "heading": -3.118943939908983, - "angularVelocity": -0.02514099388324918, - "velocityX": -0.027713873999485883, - "velocityY": -0.3915180382340248, - "timestamp": 2.6288347799934333 - }, - { - "x": 8.117594384206546, - "y": 7.379509385872707, - "heading": -3.119220822186634, - "angularVelocity": -0.002966613652270148, - "velocityX": -0.33041019331803306, - "velocityY": -0.4531894111455441, - "timestamp": 2.7221675526784117 - }, - { - "x": 8.058498182340648, - "y": 7.331488492932785, - "heading": -3.1174309173732504, - "angularVelocity": 0.019177666771188435, - "velocityX": -0.6331773948831888, - "velocityY": -0.5145126578635241, - "timestamp": 2.81550032536339 - }, - { - "x": 7.971135845182134, - "y": 7.277783830019588, - "heading": -3.1135782415558078, - "angularVelocity": 0.04127891743285837, - "velocityX": -0.936030663670345, - "velocityY": -0.5754105591019291, - "timestamp": 2.9088330980483685 - }, - { - "x": 7.8554974161850275, - "y": 7.218444994953398, - "heading": -3.1076682424852238, - "angularVelocity": 0.06332179898406654, - "velocityX": -1.2389906103766541, - "velocityY": -0.6357770519308876, - "timestamp": 3.002165870733347 - }, - { - "x": 7.711570234789305, - "y": 7.153535709516692, - "heading": -3.099708151091067, - "angularVelocity": 0.08528720582451799, - "velocityX": -1.5420862067551742, - "velocityY": -0.6954608072749517, - "timestamp": 3.0954986434183254 - }, - { - "x": 7.539337668596006, - "y": 7.083140848637671, - "heading": -3.089707578332241, - "angularVelocity": 0.10714963748671837, - "velocityX": -1.8453600084787853, - "velocityY": -0.7542351829257374, - "timestamp": 3.188831416103304 - }, - { - "x": 7.338776909525806, - "y": 7.007379062900374, - "heading": -3.0776796181255017, - "angularVelocity": 0.12887177634094718, - "velocityX": -2.1488781839487765, - "velocityY": -0.811738294682546, - "timestamp": 3.282164188788282 - }, - { - "x": 7.109854784667936, - "y": 6.926427936059983, - "heading": -3.0636431064242595, - "angularVelocity": 0.1503921001963516, - "velocityX": -2.4527517855977448, - "velocityY": -0.8673387119187144, - "timestamp": 3.3754969614732606 - }, - { - "x": 6.8525187501181435, - "y": 6.840582358481015, - "heading": -3.0476279773679096, - "angularVelocity": 0.17159169920307685, - "velocityX": -2.757188361031195, - "velocityY": -0.9197795705557481, - "timestamp": 3.468829734158239 - }, - { - "x": 6.566673825053886, - "y": 6.750427785913005, - "heading": -3.0296914111518154, - "angularVelocity": 0.1921786495793364, - "velocityX": -3.0626425942477433, - "velocityY": -0.9659476513389746, - "timestamp": 3.5621625068432174 - }, - { - "x": 6.252112121252732, - "y": 6.657680588303757, - "heading": -3.009997409599457, - "angularVelocity": 0.2110084270059204, - "velocityX": -3.370324214655872, - "velocityY": -0.9937259436435488, - "timestamp": 3.655495279528196 - }, - { - "x": 5.924327501069443, - "y": 6.590553317899491, - "heading": -2.992729144054426, - "angularVelocity": 0.18501824223432767, - "velocityX": -3.511999169784069, - "velocityY": -0.7192250746780882, - "timestamp": 3.7488280522131743 - }, - { - "x": 5.623686963906954, - "y": 6.533138892879347, - "heading": -2.9778838065365383, - "angularVelocity": 0.15905814314543523, - "velocityX": -3.2211679618393605, - "velocityY": -0.6151582490100377, - "timestamp": 3.8421608248981527 - }, - { - "x": 5.350776487888487, - "y": 6.483614379242258, - "heading": -2.9652903356820435, - "angularVelocity": 0.13493085539204083, - "velocityX": -2.9240583791463015, - "velocityY": -0.5306229763927237, - "timestamp": 3.935493597583131 - }, - { - "x": 5.105761697875294, - "y": 6.441374025055136, - "heading": -2.9548920644835968, - "angularVelocity": 0.11141071779302807, - "velocityX": -2.625174233708662, - "velocityY": -0.4525779420450055, - "timestamp": 4.028826370268109 - }, - { - "x": 4.88871990253492, - "y": 6.40611581054929, - "heading": -2.9466608880442298, - "angularVelocity": 0.08819170589894769, - "velocityX": -2.325461776143144, - "velocityY": -0.37776885322857806, - "timestamp": 4.1221591429530875 - }, - { - "x": 4.699695738823262, - "y": 6.377658859572386, - "heading": -2.940580123655932, - "angularVelocity": 0.06515143837869165, - "velocityX": -2.0252710626058645, - "velocityY": -0.304897734828379, - "timestamp": 4.215491915638066 - }, - { - "x": 4.538718238992774, - "y": 6.35588274428126, - "heading": -2.9366387902452415, - "angularVelocity": 0.042228825923698476, - "velocityX": -1.724769287352341, - "velocityY": -0.2333169224986504, - "timestamp": 4.308824688323044 - }, - { - "x": 4.405807785111533, - "y": 6.340701529308257, - "heading": -2.9348291518927363, - "angularVelocity": 0.019389098817553782, - "velocityX": -1.4240491314861898, - "velocityY": -0.16265685178180805, - "timestamp": 4.402157461008023 - }, - { - "x": 4.300979468853507, - "y": 6.33205081523707, - "heading": -2.935145493541909, - "angularVelocity": -0.003389395172478266, - "velocityX": -1.1231672781419237, - "velocityY": -0.09268677895581871, - "timestamp": 4.495490233693001 - }, - { - "x": 4.22424491179168, - "y": 6.329880549721713, - "heading": -2.9375834532510026, - "angularVelocity": -0.026121153791524136, - "velocityX": -0.8221609071962866, - "velocityY": -0.023252984486819624, - "timestamp": 4.58882300637798 - }, - { - "x": 4.175613336776075, - "y": 6.334150718518695, - "heading": -2.9421396411976675, - "angularVelocity": -0.04881659266721974, - "velocityX": -0.5210557194068298, - "velocityY": 0.04575208336941216, - "timestamp": 4.682155779062958 + "angularVelocity": -0.08326064290335773, + "velocityX": 0.19369285191104127, + "velocityY": -0.28230474656073734, + "timestamp": 2.5570160545013483 + }, + { + "x": 8.140102729329666, + "y": 7.426125423374085, + "heading": -3.122657155923987, + "angularVelocity": -0.06387113314578731, + "velocityX": -0.11506202367581048, + "velocityY": -0.33963922365053295, + "timestamp": 2.6518898164612645 + }, + { + "x": 8.099892493103056, + "y": 7.388469206934611, + "heading": -3.1268746035962094, + "angularVelocity": -0.04445325646520159, + "velocityX": -0.4238288373512569, + "velocityY": -0.39690864641145623, + "timestamp": 2.746763578421181 + }, + { + "x": 8.03038702638155, + "y": 7.345387040589032, + "heading": -3.129247224498405, + "angularVelocity": -0.025008188282847746, + "velocityX": -0.7326099997054184, + "velocityY": -0.45409990555429286, + "timestamp": 2.841637340381097 + }, + { + "x": 7.93158466399431, + "y": 7.296887997756347, + "heading": -3.1297724840024768, + "angularVelocity": -0.005536404304212232, + "velocityX": -1.0414087134963954, + "velocityY": -0.5111955279392933, + "timestamp": 2.9365111023410133 + }, + { + "x": 7.803483324511263, + "y": 7.242983431199695, + "heading": -3.12844777249931, + "angularVelocity": 0.0139628857947746, + "velocityX": -1.35022936623056, + "velocityY": -0.5681714885452221, + "timestamp": 3.0313848643009296 + }, + { + "x": 7.646080334197257, + "y": 7.183687950924871, + "heading": -3.1252702011157885, + "angularVelocity": 0.03349262554660872, + "velocityX": -1.6590782009941545, + "velocityY": -0.6249934549857522, + "timestamp": 3.126258626260846 + }, + { + "x": 7.459372134789933, + "y": 7.119021056318589, + "heading": -3.1202362522670124, + "angularVelocity": 0.0530594417759311, + "velocityX": -1.967964540988761, + "velocityY": -0.681609891611587, + "timestamp": 3.221132388220762 + }, + { + "x": 7.243353760299336, + "y": 7.049010079509845, + "heading": -3.113341150659997, + "angularVelocity": 0.07267659113094418, + "velocityX": -2.276903224116522, + "velocityY": -0.7379382387969712, + "timestamp": 3.3160061501806783 + }, + { + "x": 6.998017798486094, + "y": 6.973696087603587, + "heading": -3.1045776181342863, + "angularVelocity": 0.09237045464069367, + "velocityX": -2.5859200346339737, + "velocityY": -0.7938337254727885, + "timestamp": 3.4108799121405946 + }, + { + "x": 6.7233519959559755, + "y": 6.893147709815927, + "heading": -3.093932999275366, + "angularVelocity": 0.11219771029441636, + "velocityX": -2.8950659998721515, + "velocityY": -0.849005838112451, + "timestamp": 3.505753674100511 + }, + { + "x": 6.419332224949389, + "y": 6.807502909527294, + "heading": -3.0813806824079646, + "angularVelocity": 0.13230546157434672, + "velocityX": -3.2044662794654784, + "velocityY": -0.9027237722987913, + "timestamp": 3.600627436060427 + }, + { + "x": 6.0858892119725905, + "y": 6.717181338233644, + "heading": -3.0668369094740004, + "angularVelocity": 0.15329604975619027, + "velocityX": -3.5145967239886153, + "velocityY": -0.9520184445917703, + "timestamp": 3.6955011980203434 + }, + { + "x": 5.764278765937413, + "y": 6.654175690194563, + "heading": -3.0473584875163273, + "angularVelocity": 0.20530883940179634, + "velocityX": -3.389877658388376, + "velocityY": -0.6640998178790448, + "timestamp": 3.7903749599802596 + }, + { + "x": 5.471788390267883, + "y": 6.59747295201529, + "heading": -3.029533854057239, + "angularVelocity": 0.18787737611395156, + "velocityX": -3.082942740197291, + "velocityY": -0.5976651184468632, + "timestamp": 3.885248721940176 + }, + { + "x": 5.208500110382171, + "y": 6.546679537535185, + "heading": -3.013443507342508, + "angularVelocity": 0.16959743539556021, + "velocityX": -2.7751432476868563, + "velocityY": -0.5353789438808637, + "timestamp": 3.980122483900092 + }, + { + "x": 4.974440418410986, + "y": 6.5016623079036036, + "heading": -2.999114209332587, + "angularVelocity": 0.15103541499677672, + "velocityX": -2.467064519588399, + "velocityY": -0.4744960956708154, + "timestamp": 4.074996245860008 + }, + { + "x": 4.7696223965133315, + "y": 6.46235431777243, + "heading": -2.986559323622326, + "angularVelocity": 0.13233253800523867, + "velocityX": -2.1588479013216424, + "velocityY": -0.41431887298598197, + "timestamp": 4.169870007819925 + }, + { + "x": 4.594053841274844, + "y": 6.4287152751902195, + "heading": -2.975786926655579, + "angularVelocity": 0.11354453269490751, + "velocityX": -1.8505491045318088, + "velocityY": -0.354566340443241, + "timestamp": 4.264743769779841 + }, + { + "x": 4.447739928323049, + "y": 6.400718265491756, + "heading": -2.966802484943942, + "angularVelocity": 0.09469890859217249, + "velocityX": -1.5421957549613354, + "velocityY": -0.29509749713827227, + "timestamp": 4.359617531739757 + }, + { + "x": 4.330684343492378, + "y": 6.378344037986267, + "heading": -2.9596099787157644, + "angularVelocity": 0.07581133160099555, + "velocityX": -1.2338035555091167, + "velocityY": -0.23583156231268904, + "timestamp": 4.4544912936996734 + }, + { + "x": 4.242889844841654, + "y": 6.361578141572037, + "heading": -2.9542124480151872, + "angularVelocity": 0.05689171156570921, + "velocityX": -0.9253822852288359, + "velocityY": -0.17671794675237118, + "timestamp": 4.54936505565959 + }, + { + "x": 4.184358573473123, + "y": 6.350409330356464, + "heading": -2.9506122877942356, + "angularVelocity": 0.037946847964903434, + "velocityX": -0.6169384470414571, + "velocityY": -0.1177228665212151, + "timestamp": 4.644238817619506 }, { "x": 4.155092239379883, "y": 6.3448286056518555, "heading": -2.948811422950705, - "angularVelocity": -0.07148380532480915, - "velocityX": -0.21987022142217327, - "velocityY": 0.11440662080404759, - "timestamp": 4.775488551747936 - }, - { - "x": 4.1523733002027585, - "y": 6.352736136844345, - "heading": -2.9531733467821883, - "angularVelocity": -0.0840714214822575, - "velocityX": -0.05240464766826728, - "velocityY": 0.1524092151654666, - "timestamp": 4.827372102121875 - }, - { - "x": 4.158366785929934, - "y": 6.362507716377033, - "heading": -2.958190711819862, - "angularVelocity": -0.09670435044463713, - "velocityX": 0.11551803382727258, - "velocityY": 0.1883367553349982, - "timestamp": 4.8792556524958135 - }, - { - "x": 4.173097322502434, - "y": 6.374024196518687, - "heading": -2.9638660249161624, - "angularVelocity": -0.10938559630937192, - "velocityX": 0.2839153540251724, - "velocityY": 0.22196785028494526, - "timestamp": 4.931139202869752 - }, - { - "x": 4.196590311934801, - "y": 6.387153081322849, - "heading": -2.9702019538562587, - "angularVelocity": -0.12211826088291282, - "velocityX": 0.4528022709133544, - "velocityY": 0.2530452274283173, - "timestamp": 4.983022753243691 - }, - { - "x": 4.228871699685148, - "y": 6.401746260752157, - "heading": -2.9772013305250957, - "angularVelocity": -0.13490550701312382, - "velocityX": 0.6221892587860005, - "velocityY": 0.28126794184536924, - "timestamp": 5.034906303617629 - }, - { - "x": 4.269967592351735, - "y": 6.417637232054739, - "heading": -2.984867150661907, - "angularVelocity": -0.14775049281634614, - "velocityX": 0.7920794234472852, - "velocityY": 0.3062814936150427, - "timestamp": 5.086789853991568 - }, - { - "x": 4.319903648657689, - "y": 6.434637666385072, - "heading": -2.9932025678242957, - "angularVelocity": -0.16065626007305117, - "velocityX": 0.9624641325825063, - "velocityY": 0.3276652081017283, - "timestamp": 5.138673404365506 - }, - { - "x": 4.378704125067283, - "y": 6.452533134609333, - "heading": -3.0022108777762337, - "angularVelocity": -0.17362554965904736, - "velocityX": 1.1333163591504853, - "velocityY": 0.3449160301344857, - "timestamp": 5.190556954739445 - }, - { - "x": 4.446390391271482, - "y": 6.471077749304567, - "heading": -3.0118954871845838, - "angularVelocity": -0.1866604991090635, - "velocityX": 1.3045804636800333, - "velocityY": 0.3574276348009622, - "timestamp": 5.242440505113383 - }, - { - "x": 4.522978624713606, - "y": 6.489987409231171, - "heading": -3.022259856563219, - "angularVelocity": -0.19976214626671202, - "velocityX": 1.4761563711452288, - "velocityY": 0.3644634916137398, - "timestamp": 5.294324055487322 - }, - { - "x": 4.608476221898354, - "y": 6.508931252042045, - "heading": -3.0333074005444227, - "angularVelocity": -0.21292960681336567, - "velocityX": 1.647874838335918, - "velocityY": 0.3651223301863666, - "timestamp": 5.34620760586126 - }, - { - "x": 4.702876186716506, - "y": 6.527520848501598, - "heading": -3.0450413162822625, - "angularVelocity": -0.22615868908874204, - "velocityX": 1.8194584629961805, - "velocityY": 0.3582946102487687, - "timestamp": 5.398091156235199 - }, - { - "x": 4.80614831100124, - "y": 6.545296659635279, - "heading": -3.057464288154216, - "angularVelocity": -0.23943950987196802, - "velocityX": 1.9904598575159884, - "velocityY": 0.3426097675576714, - "timestamp": 5.4499747066091375 - }, - { - "x": 4.918225271137858, - "y": 6.561711461524763, - "heading": -3.070577974004793, - "angularVelocity": -0.2527522838368351, - "velocityX": 2.1601636612924295, - "velocityY": 0.31637776850615995, - "timestamp": 5.501858256983076 - }, - { - "x": 5.038980773812091, - "y": 6.57611113382983, - "heading": -3.0843820954085435, - "angularVelocity": -0.2660596914486556, - "velocityX": 2.3274332963707454, - "velocityY": 0.2775382987726222, - "timestamp": 5.553741807357015 - }, - { - "x": 5.168195744747027, - "y": 6.587715060112655, - "heading": -3.0988727967741583, - "angularVelocity": -0.2792927866573567, - "velocityX": 2.490480508825023, - "velocityY": 0.22365328122674002, - "timestamp": 5.605625357730953 - }, - { - "x": 5.30550815428385, - "y": 6.595602511169989, - "heading": -3.1140396624904128, - "angularVelocity": -0.2923251320879681, - "velocityX": 2.646549986405633, - "velocityY": 0.1520221920143693, - "timestamp": 5.657508908104892 - }, - { - "x": 5.450345178811565, - "y": 6.598718775503018, - "heading": -3.1298604289814644, - "angularVelocity": -0.30492837088108665, - "velocityX": 2.7915789009008614, - "velocityY": 0.06006266553790952, - "timestamp": 5.70939245847883 - }, - { - "x": 5.6018485220334355, - "y": 6.595923224272249, - "heading": -3.1462924963317724, - "angularVelocity": -0.3167105418167766, - "velocityX": 2.9200650712980316, - "velocityY": -0.05388126314836061, - "timestamp": 5.761276008852769 + "angularVelocity": 0.01898169532152746, + "velocityX": -0.30847658497620073, + "velocityY": -0.058822635355874404, + "timestamp": 4.739112579579422 + }, + { + "x": 4.155092239379883, + "y": 6.3448286056518555, + "heading": -2.948811422950705, + "angularVelocity": 7.532394355764215e-22, + "velocityX": -1.0416622637345536e-20, + "velocityY": 4.974602571682824e-21, + "timestamp": 4.8339863415393385 + }, + { + "x": 4.162583214768669, + "y": 6.347447665147435, + "heading": -2.9495836761516045, + "angularVelocity": -0.01576998530593318, + "velocityX": 0.15297129448051064, + "velocityY": 0.05348314479313053, + "timestamp": 4.882956152602428 + }, + { + "x": 4.177602512253265, + "y": 6.35257626623424, + "heading": -2.9511334665493774, + "angularVelocity": -0.03164787374360031, + "velocityX": 0.3067052365230814, + "velocityY": 0.10472985244312193, + "timestamp": 4.931925963665517 + }, + { + "x": 4.200189635119117, + "y": 6.360092465931462, + "heading": -2.9534665854996804, + "angularVelocity": -0.04764402597545136, + "velocityX": 0.4612458650647525, + "velocityY": 0.15348639363829186, + "timestamp": 4.980895774728606 + }, + { + "x": 4.23038623992188, + "y": 6.369859774063522, + "heading": -2.9565893733664335, + "angularVelocity": -0.06376965315896455, + "velocityX": 0.6166371514862435, + "velocityY": 0.1994557038310018, + "timestamp": 5.029865585791695 + }, + { + "x": 4.268236035993276, + "y": 6.381724551550718, + "heading": -2.9605087652771482, + "angularVelocity": -0.08003690080946649, + "velocityX": 0.772921015003155, + "velocityY": 0.24228758963171887, + "timestamp": 5.078835396854784 + }, + { + "x": 4.313784526607596, + "y": 6.395512797793485, + "heading": -2.965232340164235, + "angularVelocity": -0.09645891590230844, + "velocityX": 0.930134089258357, + "velocityY": 0.2815662536455856, + "timestamp": 5.1278052079178735 + }, + { + "x": 4.367078495343951, + "y": 6.411026156284386, + "heading": -2.9707683712029516, + "angularVelocity": -0.11304987539332809, + "velocityX": 1.088302519029422, + "velocityY": 0.31679433010095004, + "timestamp": 5.176775018980963 + }, + { + "x": 4.428165084675981, + "y": 6.428036917409757, + "heading": -2.9771258738162327, + "angularVelocity": -0.1298249365326444, + "velocityX": 1.247433633209869, + "velocityY": 0.34737240671513037, + "timestamp": 5.225744830044052 + }, + { + "x": 4.49709022288104, + "y": 6.446281736854329, + "heading": -2.9843146438854973, + "angularVelocity": -0.14680003686359283, + "velocityX": 1.4075026370075427, + "velocityY": 0.3725727963513324, + "timestamp": 5.274714641107141 + }, + { + "x": 4.573896008655205, + "y": 6.465453722665752, + "heading": -2.9923452723182273, + "angularVelocity": -0.16399141141026485, + "velocityX": 1.5684313275216506, + "velocityY": 0.3915062238390777, + "timestamp": 5.32368445217023 + }, + { + "x": 4.658616427207793, + "y": 6.485192493152983, + "heading": -3.001229110020898, + "angularVelocity": -0.1814145799179313, + "velocityX": 1.7300540213120348, + "velocityY": 0.4030803888910354, + "timestamp": 5.372654263233319 + }, + { + "x": 4.751270399780848, + "y": 6.505071823127092, + "heading": -3.0109781343477864, + "angularVelocity": -0.19908233491709118, + "velocityX": 1.8920631009518674, + "velocityY": 0.4059507182598449, + "timestamp": 5.421624074296409 + }, + { + "x": 4.851850606754849, + "y": 6.524584700969826, + "heading": -3.021604623744328, + "angularVelocity": -0.2170008249133559, + "velocityX": 2.0539227085115646, + "velocityY": 0.39846749291304245, + "timestamp": 5.470593885359498 + }, + { + "x": 4.9603057580757115, + "y": 6.543126281504873, + "heading": -3.033120461060416, + "angularVelocity": -0.2351619715512455, + "velocityX": 2.214734934981403, + "velocityY": 0.3786328787578623, + "timestamp": 5.519563696422587 + }, + { + "x": 5.076513193637353, + "y": 6.559976852057536, + "heading": -3.0455357212182053, + "angularVelocity": -0.2535288556003304, + "velocityX": 2.373042350764386, + "velocityY": 0.3441011959583454, + "timestamp": 5.568533507485676 + }, + { + "x": 5.200238658586685, + "y": 6.574290291218965, + "heading": -3.058855907991928, + "angularVelocity": -0.2720081308167943, + "velocityX": 2.526566108044267, + "velocityY": 0.2922910840515189, + "timestamp": 5.617503318548765 + }, + { + "x": 5.331082896954063, + "y": 6.585098992297486, + "heading": -3.073076807020245, + "angularVelocity": -0.2904013456371353, + "velocityX": 2.671936761177355, + "velocityY": 0.22072172311622418, + "timestamp": 5.6664731296118545 + }, + { + "x": 5.468423843235409, + "y": 6.591351575529229, + "heading": -3.088175823348266, + "angularVelocity": -0.3083331546566214, + "velocityX": 2.804604373588566, + "velocityY": 0.12768240464901381, + "timestamp": 5.715442940674944 + }, + { + "x": 5.611379563022578, + "y": 6.591996238312479, + "heading": -3.104100231369373, + "angularVelocity": -0.32518826753468183, + "velocityX": 2.919262228784082, + "velocityY": 0.013164493986290755, + "timestamp": 5.764412751738033 }, { "x": 5.758828163146973, "y": 6.586098670959473, - "heading": -3.1632623831303452, - "angularVelocity": -0.32707643706465594, - "velocityX": 3.0256148621700416, - "velocityY": -0.1893577683479254, - "timestamp": 5.813159559226707 - }, - { - "x": 5.902695261238535, - "y": 6.570898320745469, - "heading": -3.17881147753637, - "angularVelocity": -0.334456883703837, - "velocityX": 3.0945430028757137, - "velocityY": -0.32695548891982595, - "timestamp": 5.859650138920662 - }, - { - "x": 6.049135676690236, - "y": 6.549021835593513, - "heading": -3.1946542371072635, - "angularVelocity": -0.34077354326802706, - "velocityX": 3.149894374639172, - "velocityY": -0.4705573751923071, - "timestamp": 5.906140718614616 - }, - { - "x": 6.197160957910471, - "y": 6.5201679684564, - "heading": -3.2107077631198266, - "angularVelocity": -0.3453070733521208, - "velocityX": 3.1839844156532195, - "velocityY": -0.6206390053008074, - "timestamp": 5.952631298308571 - }, - { - "x": 6.345163267243832, - "y": 6.484158835890345, - "heading": -3.2268259776118957, - "angularVelocity": -0.34669850533537744, - "velocityX": 3.1834902964784026, - "velocityY": -0.7745468609576753, - "timestamp": 5.9991218780025255 - }, - { - "x": 6.490686976954829, - "y": 6.44143753364954, - "heading": -3.2427755688515667, - "angularVelocity": -0.3430714640399521, - "velocityX": 3.1301762780540514, - "velocityY": -0.9189238448312944, - "timestamp": 6.04561245769648 - }, - { - "x": 6.631051195173747, - "y": 6.393759766983925, - "heading": -3.25832527798554, - "angularVelocity": -0.33447010633844293, - "velocityX": 3.0191969887862986, - "velocityY": -1.0255360758991645, - "timestamp": 6.092103037390435 - }, - { - "x": 6.764714286137434, - "y": 6.343577352526553, - "heading": -3.2733740999169187, - "angularVelocity": -0.32369615587598016, - "velocityX": 2.875057524418642, - "velocityY": -1.0794103835168365, - "timestamp": 6.138593617084389 - }, - { - "x": 6.8912461581954085, - "y": 6.2928282307057035, - "heading": -3.2878993621114248, - "angularVelocity": -0.3124345252333994, - "velocityX": 2.721666903078607, - "velocityY": -1.0916001081279028, - "timestamp": 6.185084196778344 - }, - { - "x": 7.010658039170415, - "y": 6.242772475916749, - "heading": -3.3018996360525708, - "angularVelocity": -0.3011421675812394, - "velocityX": 2.5685177892185584, - "velocityY": -1.0766859677480711, - "timestamp": 6.231574776472298 - }, - { - "x": 7.123076613613992, - "y": 6.194223053842943, - "heading": -3.315378698836471, - "angularVelocity": -0.2899310542615808, - "velocityX": 2.41809362635666, - "velocityY": -1.0442851518179614, - "timestamp": 6.278065356166253 - }, - { - "x": 7.228642675189584, - "y": 6.147727642667839, - "heading": -3.328341498218578, - "angularVelocity": -0.2788263658453163, - "velocityX": 2.2706978977360404, - "velocityY": -1.0001039238740794, - "timestamp": 6.324555935860207 - }, - { - "x": 7.3274843779409755, - "y": 6.1036734220962625, - "heading": -3.3407929863654613, - "angularVelocity": -0.2678281972143777, - "velocityX": 2.1260587285007455, - "velocityY": -0.9475945634918501, - "timestamp": 6.371046515554162 - }, - { - "x": 7.419712318737089, - "y": 6.062345928160032, - "heading": -3.352737769324828, - "angularVelocity": -0.25692910344415465, - "velocityX": 1.9837984684907406, - "velocityY": -0.8889433990345353, - "timestamp": 6.417537095248116 - }, - { - "x": 7.505420648253909, - "y": 6.023963255092294, - "heading": -3.364180022815759, - "angularVelocity": -0.24611982828036585, - "velocityX": 1.8435633644715703, - "velocityY": -0.8256010856481106, - "timestamp": 6.464027674942071 - }, - { - "x": 7.584689528763382, - "y": 5.988696855541549, - "heading": -3.3751234991855714, - "angularVelocity": -0.2353912651090335, - "velocityX": 1.7050525295940933, - "velocityY": -0.7585708714088366, - "timestamp": 6.510518254636025 - }, - { - "x": 7.657587578550974, - "y": 5.956684760340136, - "heading": -3.3855715636517316, - "angularVelocity": -0.22473508687006247, - "velocityX": 1.5680176557804868, - "velocityY": -0.688571650690245, - "timestamp": 6.55700883432998 - }, - { - "x": 7.724173959062888, - "y": 5.928040318491664, - "heading": -3.395527236991756, - "angularVelocity": -0.21414388475175317, - "velocityX": 1.4322553289343771, - "velocityY": -0.6161343230615005, - "timestamp": 6.6034994140239345 - }, - { - "x": 7.784500070286371, - "y": 5.902858177956981, - "heading": -3.4049932363871975, - "angularVelocity": -0.20361112848571972, - "velocityX": 1.2975986021384787, - "velocityY": -0.5416611429768321, - "timestamp": 6.649989993717889 - }, - { - "x": 7.838610905305163, - "y": 5.881218502530634, - "heading": -3.4139720117646606, - "angularVelocity": -0.19313106948912953, - "velocityX": 1.1639096646030658, - "velocityY": -0.4654636609997264, - "timestamp": 6.6964805734118436 - }, - { - "x": 7.886546129379081, - "y": 5.86319002330096, - "heading": -3.42246577716849, - "angularVelocity": -0.18269863399732386, - "velocityX": 1.0310739162529936, - "velocityY": -0.3877877915989518, - "timestamp": 6.742971153105798 - }, - { - "x": 7.928340942331937, - "y": 5.848832297421699, - "heading": -3.4304765375087274, - "angularVelocity": -0.1723093235871096, - "velocityX": 0.8989953067479537, - "velocityY": -0.30883086366694207, - "timestamp": 6.789461732799753 - }, - { - "x": 7.964026771943328, - "y": 5.8381974137160135, - "heading": -3.4380061112749485, - "angularVelocity": -0.16195912840381457, - "velocityX": 0.7675927004203498, - "velocityY": -0.228753519007396, - "timestamp": 6.835952312493707 - }, - { - "x": 7.99363183554634, - "y": 5.8313313033992795, - "heading": -3.4450561498298287, - "angularVelocity": -0.1516444535923259, - "velocityX": 0.6367970414200341, - "velocityY": -0.14768820612546799, - "timestamp": 6.882442892187662 - }, - { - "x": 8.01718159841729, - "y": 5.828274763168966, - "heading": -3.4516281538375715, - "angularVelocity": -0.14136205766857937, - "velocityX": 0.5065491337379875, - "velocityY": -0.06574536713534573, - "timestamp": 6.928933471881616 - }, - { - "x": 8.034699150840398, - "y": 5.829064264971731, - "heading": -3.457723487300717, - "angularVelocity": -0.13110900107658668, - "velocityX": 0.37679789192616997, - "velocityY": 0.01698197372375355, - "timestamp": 6.975424051575571 + "heading": -3.1207574004201586, + "angularVelocity": -0.3401517933023314, + "velocityX": 3.011010190225819, + "velocityY": -0.1204327160954054, + "timestamp": 5.813382562801122 + }, + { + "x": 5.902233426168296, + "y": 6.573896393326713, + "heading": -3.137173214129699, + "angularVelocity": -0.35185511132046066, + "velocityX": 3.0737358304074114, + "velocityY": -0.26154254859402304, + "timestamp": 5.86003760114328 + }, + { + "x": 6.047959669804794, + "y": 6.55487337569396, + "heading": -3.1540968828538256, + "angularVelocity": -0.3627404311622608, + "velocityX": 3.12348352535416, + "velocityY": -0.40773769154880374, + "timestamp": 5.906692639485438 + }, + { + "x": 6.195103135419279, + "y": 6.528785988145332, + "heading": -3.1714630452763988, + "angularVelocity": -0.37222480228637916, + "velocityX": 3.1538601369345067, + "velocityY": -0.5591547767533385, + "timestamp": 5.953347677827597 + }, + { + "x": 6.342273583838334, + "y": 6.495493098699492, + "heading": -3.189153294446043, + "angularVelocity": -0.37917124919944706, + "velocityX": 3.154438484001192, + "velocityY": -0.7135968724680373, + "timestamp": 6.000002716169755 + }, + { + "x": 6.487408197918111, + "y": 6.455287801316945, + "heading": -3.2069610000901583, + "angularVelocity": -0.3816888009718795, + "velocityX": 3.110802589323585, + "velocityY": -0.8617568179387292, + "timestamp": 6.046657754511913 + }, + { + "x": 6.628042592487971, + "y": 6.4094546101533805, + "heading": -3.2246122107652013, + "angularVelocity": -0.3783345015299816, + "velocityX": 3.014345279034542, + "velocityY": -0.9823845996531712, + "timestamp": 6.093312792854071 + }, + { + "x": 6.76234555654877, + "y": 6.36018205657845, + "heading": -3.2418944864102914, + "angularVelocity": -0.37042678045500493, + "velocityX": 2.878637952794035, + "velocityY": -1.0561035919331003, + "timestamp": 6.13996783119623 + }, + { + "x": 6.889571626411602, + "y": 6.309558361869554, + "heading": -3.2587010350854584, + "angularVelocity": -0.36023009030473874, + "velocityX": 2.726952423225606, + "velocityY": -1.0850638324982687, + "timestamp": 6.186622869538388 + }, + { + "x": 7.0095947472284355, + "y": 6.259078906708206, + "heading": -3.2749813089827535, + "angularVelocity": -0.34894996287215513, + "velocityX": 2.5725650450999407, + "velocityY": -1.0819722146864885, + "timestamp": 6.233277907880546 + }, + { + "x": 7.122504658549263, + "y": 6.209740963724178, + "heading": -3.2907092275270267, + "angularVelocity": -0.3371108266791727, + "velocityX": 2.420101136618307, + "velocityY": -1.0575051427928084, + "timestamp": 6.279932946222704 + }, + { + "x": 7.228443461182924, + "y": 6.162220474685008, + "heading": -3.305870367171903, + "angularVelocity": -0.3249625374581804, + "velocityX": 2.2706830044105364, + "velocityY": -1.0185499943363998, + "timestamp": 6.3265879845648625 + }, + { + "x": 7.327553022424126, + "y": 6.116993511470743, + "heading": -3.3204564150614004, + "angularVelocity": -0.3126360712111283, + "velocityX": 2.1243056433552177, + "velocityY": -0.969390762956412, + "timestamp": 6.373243022907021 + }, + { + "x": 7.419960559859087, + "y": 6.074408763951777, + "heading": -3.3344624883943017, + "angularVelocity": -0.30020494743105264, + "velocityX": 1.980655052885471, + "velocityY": -0.9127577434758154, + "timestamp": 6.419898061249179 + }, + { + "x": 7.505776426038997, + "y": 6.034730578891011, + "heading": -3.3478857294831443, + "angularVelocity": -0.28771257222851315, + "velocityX": 1.8393697493195704, + "velocityY": -0.8504587386634338, + "timestamp": 6.466553099591337 + }, + { + "x": 7.585095518792171, + "y": 5.998165283481503, + "heading": -3.3607245222151003, + "angularVelocity": -0.27518555740538053, + "velocityX": 1.7001184774828544, + "velocityY": -0.783737334890718, + "timestamp": 6.513208137933495 + }, + { + "x": 7.657999517022542, + "y": 5.964877896157417, + "heading": -3.372978032399648, + "angularVelocity": -0.26264066261575153, + "velocityX": 1.5626179041094987, + "velocityY": -0.7134789404729223, + "timestamp": 6.559863176275654 + }, + { + "x": 7.724559056876027, + "y": 5.93500312880336, + "heading": -3.3846459265015914, + "angularVelocity": -0.25008861886198047, + "velocityX": 1.4266313396926282, + "velocityY": -0.6403331433351711, + "timestamp": 6.606518214617812 + }, + { + "x": 7.784835607016778, + "y": 5.908652875091113, + "heading": -3.3957281933250307, + "angularVelocity": -0.2375363351362947, + "velocityX": 1.2919622892322207, + "velocityY": -0.5647890270499625, + "timestamp": 6.65317325295997 + }, + { + "x": 7.838883015534668, + "y": 5.885921459816752, + "heading": -3.406225027554339, + "angularVelocity": -0.22498822425835854, + "velocityX": 1.1584474140074106, + "velocityY": -0.4872231613583445, + "timestamp": 6.699828291302128 + }, + { + "x": 7.8867487658899655, + "y": 5.866889415616827, + "heading": -3.416136751780165, + "angularVelocity": -0.21244702776012941, + "velocityX": 1.025950295105533, + "velocityY": -0.40793116619792125, + "timestamp": 6.7464833296442865 + }, + { + "x": 7.928474992731514, + "y": 5.851626263091601, + "heading": -3.4254637632041343, + "angularVelocity": -0.19991434484667214, + "velocityX": 0.8943562865716137, + "velocityY": -0.32714907258866266, + "timestamp": 6.793138367986445 + }, + { + "x": 7.96409930505654, + "y": 5.840192599068134, + "heading": -3.4342064965877315, + "angularVelocity": -0.1873909805727762, + "velocityX": 0.7635683859857584, + "velocityY": -0.24506815190281384, + "timestamp": 6.839793406328603 + }, + { + "x": 7.993655456392744, + "y": 5.83264169349778, + "heading": -3.442365398135876, + "angularVelocity": -0.17487718021596504, + "velocityX": 0.6335039555523552, + "velocityY": -0.16184544775158413, + "timestamp": 6.886448444670761 + }, + { + "x": 8.017173893739177, + "y": 5.829020730205745, + "heading": -3.449940906881815, + "angularVelocity": -0.1623727900592901, + "velocityX": 0.5040921234262654, + "velocityY": -0.07761140962911499, + "timestamp": 6.9331034830129195 + }, + { + "x": 8.034682210183265, + "y": 5.82937178474551, + "heading": -3.4569334412987898, + "angularVelocity": -0.14987736942133326, + "velocityX": 0.37527171911607915, + "velocityY": 0.007524472216504663, + "timestamp": 6.979758521355078 }, { "x": 8.046205520629883, "y": 5.833732604980469, "heading": -3.463343389598174, - "angularVelocity": -0.12088260319515205, - "velocityX": 0.2474989528035481, - "velocityY": 0.10041475153610135, - "timestamp": 7.021914631269525 - }, - { - "x": 8.051419182584468, - "y": 5.8447906809115855, - "heading": -3.4693491742690163, - "angularVelocity": -0.10876684074758049, - "velocityX": 0.09442122397079034, - "velocityY": 0.20026558554682747, - "timestamp": 7.077131686665851 - }, - { - "x": 8.048120067651531, - "y": 5.861268574669593, - "heading": -3.474675084898529, - "angularVelocity": -0.0964540863558432, - "velocityX": -0.059748114224046904, - "velocityY": 0.2984203637759236, - "timestamp": 7.1323487420621765 - }, - { - "x": 8.036241609424145, - "y": 5.883060143584873, - "heading": -3.479308784103769, - "angularVelocity": -0.0839178976854301, - "velocityX": -0.21512299310652097, - "velocityY": 0.39465286149124257, - "timestamp": 7.187565797458502 - }, - { - "x": 8.015709993867125, - "y": 5.910044148075149, - "heading": -3.483236224053585, - "angularVelocity": -0.07112729792681803, - "velocityX": -0.37183466973481016, - "velocityY": 0.4886896683750097, - "timestamp": 7.242782852854828 - }, - { - "x": 7.986443029902223, - "y": 5.942080890750444, - "heading": -3.4864413312001137, - "angularVelocity": -0.05804560064864295, - "velocityX": -0.5300348552604761, - "velocityY": 0.5801965071362207, - "timestamp": 7.297999908251153 - }, - { - "x": 7.948348824180798, - "y": 5.979007815148917, - "heading": -3.488905604522003, - "angularVelocity": -0.04462884346514799, - "velocityX": -0.6898992611612746, - "velocityY": 0.6687593920651365, - "timestamp": 7.353216963647479 - }, - { - "x": 7.901324248569515, - "y": 6.020633645713137, - "heading": -3.4906075967346855, - "angularVelocity": -0.03082366852897056, - "velocityX": -0.85163135327951, - "velocityY": 0.7538582103925403, - "timestamp": 7.4084340190438045 - }, - { - "x": 7.845253222549627, - "y": 6.066730442605587, - "heading": -3.491522234596702, - "angularVelocity": -0.016564408504792263, - "velocityX": -1.0154657038017145, - "velocityY": 0.8348289593058718, - "timestamp": 7.46365107444013 - }, - { - "x": 7.780004916702429, - "y": 6.117022615205706, - "heading": -3.491619914397988, - "angularVelocity": -0.0017690150368460669, - "velocityX": -1.1816694204149643, - "velocityY": 0.9108086666183527, - "timestamp": 7.518868129836456 - }, - { - "x": 7.70543218188968, - "y": 6.171171408690927, - "heading": -3.4908652785924956, - "angularVelocity": 0.013666715837632718, - "velocityX": -1.3505380588931304, - "velocityY": 0.9806534067519966, - "timestamp": 7.574085185232781 - }, - { - "x": 7.621370970218071, - "y": 6.228752526262233, - "heading": -3.4892155354501093, - "angularVelocity": 0.02987741976722745, - "velocityX": -1.5223776615440932, - "velocityY": 1.042813984882243, - "timestamp": 7.629302240629107 - }, - { - "x": 7.527642587861271, - "y": 6.289223211041998, - "heading": -3.4866181253772446, - "angularVelocity": 0.04703999614288995, - "velocityX": -1.69745347128809, - "velocityY": 1.0951450479517597, - "timestamp": 7.6845192960254325 - }, - { - "x": 7.424063129042053, - "y": 6.3518731983485806, - "heading": -3.4830074891516145, - "angularVelocity": 0.06538987274337808, - "velocityX": -1.875859878361262, - "velocityY": 1.134612971606443, - "timestamp": 7.739736351421758 - }, - { - "x": 7.310470238938363, - "y": 6.415752089641368, - "heading": -3.478300789900097, - "angularVelocity": 0.08523995381019685, - "velocityX": -2.0572065875002874, - "velocityY": 1.1568688484796892, - "timestamp": 7.794953406818084 - }, - { - "x": 7.186789890037512, - "y": 6.479567879571034, - "heading": -3.4723932719177033, - "angularVelocity": 0.10698719698092815, - "velocityX": -2.2398939605366954, - "velocityY": 1.1557260609357407, - "timestamp": 7.850170462214409 - }, - { - "x": 7.053186773651001, - "y": 6.541573247740791, - "heading": -3.465157679667485, - "angularVelocity": 0.13103908200616907, - "velocityX": -2.419598716873995, - "velocityY": 1.1229386957473142, - "timestamp": 7.905387517610735 - }, - { - "x": 6.910343930776152, - "y": 6.59953553576051, - "heading": -3.456464119078635, - "angularVelocity": 0.15744339364805293, - "velocityX": -2.5869333641495382, - "velocityY": 1.0497171137375771, - "timestamp": 7.9606045730070605 - }, - { - "x": 6.759778343764309, - "y": 6.651011215266716, - "heading": -3.4462520027321037, - "angularVelocity": 0.18494496443594796, - "velocityX": -2.726794935570973, - "velocityY": 0.9322423866454576, - "timestamp": 8.015821628403387 - }, - { - "x": 6.603790713499927, - "y": 6.6939811250265135, - "heading": -3.434630215078176, - "angularVelocity": 0.21047460011242525, - "velocityX": -2.824990017029447, - "velocityY": 0.7781999502033666, - "timestamp": 8.071038683799713 - }, - { - "x": 6.444871386080698, - "y": 6.727297088370096, - "heading": -3.421861790963788, - "angularVelocity": 0.2312405835976036, - "velocityX": -2.8780840680215385, - "velocityY": 0.6033636365513104, - "timestamp": 8.12625573919604 - }, - { - "x": 6.285143890283095, - "y": 6.750554272686326, - "heading": -3.4082408981262526, - "angularVelocity": 0.24667908746256292, - "velocityX": -2.892720277297344, - "velocityY": 0.42119566408057085, - "timestamp": 8.181472794592366 - }, - { - "x": 6.126216972903622, - "y": 6.763750889103841, - "heading": -3.3940156098665684, - "angularVelocity": 0.25762489791570925, - "velocityX": -2.8782215248306717, - "velocityY": 0.23899529452983848, - "timestamp": 8.236689849988693 - }, - { - "x": 5.969266867293909, - "y": 6.767049973704876, - "heading": -3.3793756191034694, - "angularVelocity": 0.2651353039023758, - "velocityX": -2.8424207789276137, - "velocityY": 0.059747564902821196, - "timestamp": 8.29190690538502 - }, - { - "x": 5.815157493846427, - "y": 6.760663715506681, - "heading": -3.3644631758659895, - "angularVelocity": 0.2700695125888956, - "velocityX": -2.7909741354613375, - "velocityY": -0.11565734812110663, - "timestamp": 8.347123960781346 - }, - { - "x": 5.664535976276008, - "y": 6.744805721319696, - "heading": -3.3493860812399614, - "angularVelocity": 0.2730514062695079, - "velocityX": -2.7278078573606983, - "velocityY": -0.28719376781615824, - "timestamp": 8.402341016177672 - }, - { - "x": 5.5178985721714335, - "y": 6.719673719283003, - "heading": -3.3342277061260854, - "angularVelocity": 0.27452342405938374, - "velocityX": -2.6556541824273316, - "velocityY": -0.45514926242091686, - "timestamp": 8.457558071573999 + "angularVelocity": -0.1373902696719508, + "velocityX": 0.24698962547429237, + "velocityY": 0.09346943845543118, + "timestamp": 7.026413559697236 + }, + { + "x": 8.051468196812584, + "y": 5.844685972106404, + "heading": -3.4701603161303347, + "angularVelocity": -0.1225082198013852, + "velocityX": 0.09457650562789995, + "velocityY": 0.1968449419395451, + "timestamp": 7.082058205772521 + }, + { + "x": 8.048184809934325, + "y": 5.861294321662854, + "heading": -3.4761375108001347, + "angularVelocity": -0.10741724660649189, + "velocityX": -0.059006339510488656, + "velocityY": 0.2984716541098781, + "timestamp": 7.137702851847806 + }, + { + "x": 8.036283303334299, + "y": 5.883447036443524, + "heading": -3.4812616846530076, + "angularVelocity": -0.09208745520530746, + "velocityX": -0.21388412793432043, + "velocityY": 0.3981104444567551, + "timestamp": 7.1933474979230905 + }, + { + "x": 8.015683562895257, + "y": 5.911017346008104, + "heading": -3.485517607433818, + "angularVelocity": -0.07648395813412644, + "velocityX": -0.3702016616508371, + "velocityY": 0.4954710202896893, + "timestamp": 7.248992143998375 + }, + { + "x": 7.986296123840878, + "y": 5.943858632575643, + "heading": -3.488887756801902, + "angularVelocity": -0.06056556390931846, + "velocityX": -0.5281269830455628, + "velocityY": 0.5901967014599441, + "timestamp": 7.30463679007366 + }, + { + "x": 7.948020645133899, + "y": 5.981799561635306, + "heading": -3.491351870321391, + "angularVelocity": -0.044283029784292674, + "velocityX": -0.6878555513713837, + "velocityY": 0.6818432991438246, + "timestamp": 7.360281436148945 + }, + { + "x": 7.900744135928116, + "y": 6.024637551422569, + "heading": -3.4928863660328324, + "angularVelocity": -0.027576700000313138, + "velocityX": -0.8496146986328078, + "velocityY": 0.7698492632930963, + "timestamp": 7.41592608222423 + }, + { + "x": 7.844338959231667, + "y": 6.072129847299749, + "heading": -3.493463582743254, + "angularVelocity": -0.010373265913863132, + "velocityX": -1.0136676333628925, + "velocityY": 0.8534926399374545, + "timestamp": 7.471570728299515 + }, + { + "x": 7.778660742221798, + "y": 6.123981070303483, + "heading": -3.493050769497451, + "angularVelocity": 0.00741874151278994, + "velocityX": -1.1803151182057858, + "velocityY": 0.9318277078010678, + "timestamp": 7.5272153743748 + }, + { + "x": 7.703546574545105, + "y": 6.179825467361639, + "heading": -3.491608722205396, + "angularVelocity": 0.025915292732810263, + "velocityX": -1.3498902944780617, + "velocityY": 1.0035897610455067, + "timestamp": 7.5828600204500844 + }, + { + "x": 7.618814473494392, + "y": 6.239201054727309, + "heading": -3.489089922616978, + "angularVelocity": 0.04526580302101711, + "velocityX": -1.5227359148996, + "velocityY": 1.06704942080748, + "timestamp": 7.638504666525369 + }, + { + "x": 7.5242665108900155, + "y": 6.301511231764772, + "heading": -3.485435989576966, + "angularVelocity": 0.0656654916102557, + "velocityX": -1.6991385384401072, + "velocityY": 1.119787462627769, + "timestamp": 7.694149312600654 + }, + { + "x": 7.4197013507482, + "y": 6.365967240446262, + "heading": -3.480574261391913, + "angularVelocity": 0.08737099663595954, + "velocityX": -1.8791594073640787, + "velocityY": 1.1583505912551633, + "timestamp": 7.749793958675939 + }, + { + "x": 7.30494971575777, + "y": 6.431503283367323, + "heading": -3.4744136439159683, + "angularVelocity": 0.11071357103447453, + "velocityX": -2.062222389467215, + "velocityY": 1.1777600819384002, + "timestamp": 7.805438604751224 + }, + { + "x": 7.179962559798994, + "y": 6.496661814894046, + "heading": -3.466841472829506, + "angularVelocity": 0.13608085630049782, + "velocityX": -2.2461667882598197, + "velocityY": 1.1709757563839487, + "timestamp": 7.861083250826509 + }, + { + "x": 7.0450043650642655, + "y": 6.559483047956268, + "heading": -3.4577292994416897, + "angularVelocity": 0.16375651622417847, + "velocityX": -2.425358129731578, + "velocityY": 1.1289717428919859, + "timestamp": 7.916727896901794 + }, + { + "x": 6.900979989447752, + "y": 6.617542454098851, + "heading": -3.4469716329246967, + "angularVelocity": 0.1933279708965771, + "velocityX": -2.588288106310453, + "velocityY": 1.0433960899676162, + "timestamp": 7.972372542977078 + }, + { + "x": 6.749698748781295, + "y": 6.668375124023075, + "heading": -3.4345853306759078, + "angularVelocity": 0.22259647823135656, + "velocityX": -2.718702540793954, + "velocityY": 0.9135231061663974, + "timestamp": 8.028017189052363 + }, + { + "x": 6.593622281446755, + "y": 6.710155384191086, + "heading": -3.4207896059713114, + "angularVelocity": 0.2479254641305738, + "velocityX": -2.8048784266392115, + "velocityY": 0.7508406129762251, + "timestamp": 8.083661835127648 + }, + { + "x": 6.43518641122628, + "y": 6.741964154206405, + "heading": -3.4059237330536236, + "angularVelocity": 0.26715729124370924, + "velocityX": -2.8472796826871427, + "velocityY": 0.5716411597313928, + "timestamp": 8.139306481202933 + }, + { + "x": 6.276365829184199, + "y": 6.7635314295136775, + "heading": -3.3903129196471515, + "angularVelocity": 0.28054475151753555, + "velocityX": -2.854193408422522, + "velocityY": 0.38758940578205786, + "timestamp": 8.194951127278218 + }, + { + "x": 6.1186300644231135, + "y": 6.774906528048223, + "heading": -3.3742151723731513, + "angularVelocity": 0.2892955281307887, + "velocityX": -2.8346979608366234, + "velocityY": 0.2044239533692823, + "timestamp": 8.250595773353503 + }, + { + "x": 5.963053116486022, + "y": 6.776261296768168, + "heading": -3.3578237831063493, + "angularVelocity": 0.29457262149938523, + "velocityX": -2.795901473191203, + "velocityY": 0.024346793725904915, + "timestamp": 8.306240419428788 + }, + { + "x": 5.8104290835439985, + "y": 6.767800149453071, + "heading": -3.3412831833352663, + "angularVelocity": 0.2972541104620299, + "velocityX": -2.742834103671541, + "velocityY": -0.15205680890934775, + "timestamp": 8.361885065504072 + }, + { + "x": 5.661358014830183, + "y": 6.749723919281858, + "heading": -3.3247031677966823, + "angularVelocity": 0.2979624583495684, + "velocityX": -2.678983140842141, + "velocityY": -0.3248512021579965, + "timestamp": 8.417529711579357 + }, + { + "x": 5.516304135655185, + "y": 6.722217125506872, + "heading": -3.3081691225058854, + "angularVelocity": 0.2971363187111854, + "velocityX": -2.606789500983575, + "velocityY": -0.49432956654573584, + "timestamp": 8.473174357654642 }, { "x": 5.375634670257568, "y": 6.6854448318481445, - "heading": -3.3190539711882665, - "angularVelocity": 0.27480159579151087, - "velocityX": -2.5764485428053243, - "velocityY": -0.619897008074366, - "timestamp": 8.512775126970325 - }, - { - "x": 5.258727665904114, - "y": 6.650123372593305, - "heading": -3.3062547426441777, - "angularVelocity": 0.27422216432360225, - "velocityX": -2.504720628119257, - "velocityY": -0.7567586570210144, - "timestamp": 8.559449795211165 - }, - { - "x": 5.145593525293582, - "y": 6.608655391628734, - "heading": -3.293517807854288, - "angularVelocity": 0.2728875270021734, - "velocityX": -2.423887407763944, - "velocityY": -0.888447256884578, - "timestamp": 8.606124463452005 - }, - { - "x": 5.036709373339286, - "y": 6.561360633601731, - "heading": -3.280882894662897, - "angularVelocity": 0.27070172467418824, - "velocityX": -2.3328318348714934, - "velocityY": -1.0132853603364422, - "timestamp": 8.652799131692845 - }, - { - "x": 4.932601329245533, - "y": 6.508662017990669, - "heading": -3.2683939898435894, - "angularVelocity": 0.26757351021469256, - "velocityX": -2.2305042117612404, - "velocityY": -1.1290624571585341, - "timestamp": 8.699473799933685 - }, - { - "x": 4.833831275235675, - "y": 6.451113923616155, - "heading": -3.256098455639155, - "angularVelocity": 0.26343056454070557, - "velocityX": -2.116138319402874, - "velocityY": -1.232962044369908, - "timestamp": 8.746148468174525 - }, - { - "x": 4.740968002070127, - "y": 6.38942823102359, - "heading": -3.2440453255997848, - "angularVelocity": 0.25823708006184887, - "velocityX": -1.9895861430953543, - "velocityY": -1.321609663603138, - "timestamp": 8.792823136415365 - }, - { - "x": 4.654539547896897, - "y": 6.324486679853536, - "heading": -3.2322829510253057, - "angularVelocity": 0.25200767392252327, - "velocityX": -1.8517208033972823, - "velocityY": -1.3913661010927205, - "timestamp": 8.839497804656204 - }, - { - "x": 4.574972065691894, - "y": 6.257324316824639, - "heading": -3.220856603386505, - "angularVelocity": 0.24480833114529404, - "velocityX": -1.7047251797149867, - "velocityY": -1.4389467683485437, - "timestamp": 8.886172472897044 - }, - { - "x": 4.502533427208671, - "y": 6.189074788052417, - "heading": -3.209806687720587, - "angularVelocity": 0.23674331457271136, - "velocityX": -1.5519904310715604, - "velocityY": -1.4622391833629367, - "timestamp": 8.932847141137884 - }, - { - "x": 4.4373056272084614, - "y": 6.120887020764479, - "heading": -3.199167672698052, - "angularVelocity": 0.22793981025506352, - "velocityX": -1.397498953043142, - "velocityY": -1.4609159498700834, - "timestamp": 8.979521809378724 - }, - { - "x": 4.37919780834056, - "y": 6.053841192884822, - "heading": -3.1889674291924752, - "angularVelocity": 0.2185391753176214, - "velocityX": -1.2449540844739644, - "velocityY": -1.4364500146782433, - "timestamp": 9.026196477619564 - }, - { - "x": 4.327989641671973, - "y": 5.988891000938848, - "heading": -3.179226926397484, - "angularVelocity": 0.20868927754838076, - "velocityX": -1.0971297407911678, - "velocityY": -1.3915512288343186, - "timestamp": 9.072871145860404 - }, - { - "x": 4.283383388011125, - "y": 5.926840968076357, - "heading": -3.169960503204579, - "angularVelocity": 0.1985321704932263, - "velocityX": -0.9556844288786528, - "velocityY": -1.3294156166748594, - "timestamp": 9.119545814101244 - }, - { - "x": 4.245047973877159, - "y": 5.8683507787998055, - "heading": -3.1611767340548393, - "angularVelocity": 0.18819135691367764, - "velocityX": -0.8213323324797336, - "velocityY": -1.2531463314263613, - "timestamp": 9.166220482342084 - }, - { - "x": 4.2126491469882685, - "y": 5.813953620815217, - "heading": -3.1528796247049495, - "angularVelocity": 0.1777647204063085, - "velocityX": -0.6941415570800369, - "velocityY": -1.1654535540328004, - "timestamp": 9.212895150582924 - }, - { - "x": 4.185866990370122, - "y": 5.764078548080203, - "heading": -3.1450698281525344, - "angularVelocity": 0.16732409349149657, - "velocityX": -0.5738049701810753, - "velocityY": -1.0685683394182859, - "timestamp": 9.259569818823763 - }, - { - "x": 4.164404474628658, - "y": 5.71907153950035, - "heading": -3.1377456899052736, - "angularVelocity": 0.15691891390568613, - "velocityX": -0.45983220771313277, - "velocityY": -0.9642705620877334, - "timestamp": 9.306244487064603 - }, - { - "x": 4.1479904974082915, - "y": 5.679213252595555, - "heading": -3.1309040597644757, - "angularVelocity": 0.14658122700509368, - "velocityX": -0.3516677855249456, - "velocityY": -0.8539597260579826, - "timestamp": 9.352919155305443 - }, - { - "x": 4.136379866864982, - "y": 5.644733200221981, - "heading": -3.1245408830189114, - "angularVelocity": 0.1363304118784621, - "velocityX": -0.24875657355287575, - "velocityY": -0.7387316005259564, - "timestamp": 9.399593823546283 - }, - { - "x": 4.1293517622446805, - "y": 5.615820774762028, - "heading": -3.118651612951779, - "angularVelocity": 0.12617700969494677, - "velocityX": -0.1505764236831326, - "velocityY": -0.619445762544374, - "timestamp": 9.446268491787123 + "heading": -3.2917489862090847, + "angularVelocity": 0.2950892395754448, + "velocityX": -2.527996407907734, + "velocityY": -0.6608415409629179, + "timestamp": 8.528819003729927 + }, + { + "x": 5.247302186313446, + "y": 6.642723250226847, + "heading": -3.2764342569191007, + "angularVelocity": 0.29222750886394533, + "velocityX": -2.4487721186061138, + "velocityY": -0.8151904702673559, + "timestamp": 8.581225874491414 + }, + { + "x": 5.123684691215023, + "y": 6.592227601868027, + "heading": -3.261343469002182, + "angularVelocity": 0.287954378837072, + "velocityX": -2.35880321229308, + "velocityY": -0.96353107188246, + "timestamp": 8.633632745252902 + }, + { + "x": 5.005442832506228, + "y": 6.534399403999677, + "heading": -3.2465629258898607, + "angularVelocity": 0.2820344526882774, + "velocityX": -2.2562281813568914, + "velocityY": -1.1034468768710974, + "timestamp": 8.686039616014389 + }, + { + "x": 4.893338332381132, + "y": 6.4698636715273565, + "heading": -3.2321912465960825, + "angularVelocity": 0.2742327310322778, + "velocityX": -2.139118373148127, + "velocityY": -1.2314364802667634, + "timestamp": 8.738446486775876 + }, + { + "x": 4.788214065335871, + "y": 6.399503311235688, + "heading": -3.218336699236444, + "angularVelocity": 0.26436509484973597, + "velocityX": -2.005925282654272, + "velocityY": -1.3425789265665398, + "timestamp": 8.790853357537364 + }, + { + "x": 4.690926811703409, + "y": 6.324536430026673, + "heading": -3.2051106978803485, + "angularVelocity": 0.25237151472541847, + "velocityX": -1.8563835661021135, + "velocityY": -1.4304781056324285, + "timestamp": 8.84326022829885 + }, + { + "x": 4.602213375050993, + "y": 6.246550389883575, + "heading": -3.1926184281535104, + "angularVelocity": 0.23837083850498517, + "velocityX": -1.692782556244718, + "velocityY": -1.488088088640642, + "timestamp": 8.895667099060338 + }, + { + "x": 4.522516933607232, + "y": 6.167421361715161, + "heading": -3.180950391265689, + "angularVelocity": 0.2226432663939251, + "velocityX": -1.5207250554316514, + "velocityY": -1.5098979774721726, + "timestamp": 8.948073969821825 + }, + { + "x": 4.451873293775449, + "y": 6.089098032772841, + "heading": -3.1701771256978444, + "angularVelocity": 0.20556971655254663, + "velocityX": -1.3479843158980969, + "velocityY": -1.4945240538933033, + "timestamp": 9.000480840583313 + }, + { + "x": 4.389944797643215, + "y": 6.013352078757408, + "heading": -3.160345990530402, + "angularVelocity": 0.18759248595829828, + "velocityX": -1.1816865848388818, + "velocityY": -1.4453439580502128, + "timestamp": 9.0528877113448 + }, + { + "x": 4.3361645159835325, + "y": 5.941631275114407, + "heading": -3.15148070753079, + "angularVelocity": 0.16916260923037685, + "velocityX": -1.0262066953863092, + "velocityY": -1.3685381821291336, + "timestamp": 9.105294582106287 + }, + { + "x": 4.289884639082712, + "y": 5.875042815583236, + "heading": -3.1435850366687292, + "angularVelocity": 0.150660986762505, + "velocityX": -0.8830879659167057, + "velocityY": -1.2706055248790982, + "timestamp": 9.157701452867775 + }, + { + "x": 4.2504715009741, + "y": 5.814408213255479, + "heading": -3.1366488915258626, + "angularVelocity": 0.13235182795847486, + "velocityX": -0.7520605129809926, + "velocityY": -1.1569971922902238, + "timestamp": 9.210108323629262 + }, + { + "x": 4.217349104588903, + "y": 5.760333428471323, + "heading": -3.130654197761707, + "angularVelocity": 0.11438755409455087, + "velocityX": -0.6320239293802175, + "velocityY": -1.0318262471777937, + "timestamp": 9.26251519439075 + }, + { + "x": 4.19001158999409, + "y": 5.71326891600178, + "heading": -3.125579181017236, + "angularVelocity": 0.09683876695421119, + "velocityX": -0.5216398956394738, + "velocityY": -0.8980599640024567, + "timestamp": 9.314922065152237 + }, + { + "x": 4.168021099523672, + "y": 5.673554367501423, + "heading": -3.121401048080275, + "angularVelocity": 0.07972490775067456, + "velocityX": -0.4196108287117665, + "velocityY": -0.7578118655682702, + "timestamp": 9.367328935913724 + }, + { + "x": 4.1510001991687515, + "y": 5.641450291339017, + "heading": -3.1180974896766025, + "angularVelocity": 0.06303674223762575, + "velocityX": -0.32478375654951874, + "velocityY": -0.6125928851680192, + "timestamp": 9.419735806675211 + }, + { + "x": 4.138623122411169, + "y": 5.617159927154894, + "heading": -3.1156474380074726, + "angularVelocity": 0.046750581241157815, + "velocityX": -0.2361727876085765, + "velocityY": -0.463495794180744, + "timestamp": 9.472142677436699 + }, + { + "x": 4.130607560354345, + "y": 5.600844466363652, + "heading": -3.114031389790168, + "angularVelocity": 0.030836571499560275, + "velocityX": -0.1529486866961616, + "velocityY": -0.3113229344582824, + "timestamp": 9.524549548198186 + }, + { + "x": 4.126707553863525, + "y": 5.5926337242126465, + "heading": -3.1132314898410027, + "angularVelocity": 0.01526326486474834, + "velocityX": -0.0744178470141595, + "velocityY": -0.1566730093154095, + "timestamp": 9.576956418959673 }, { "x": 4.126707553863525, "y": 5.5926337242126465, "heading": -3.1132314898410027, - "angularVelocity": 0.11612558407074823, - "velocityX": -0.05665189450327197, - "velocityY": -0.4967801898395365, - "timestamp": 9.492943160027963 - }, - { - "x": 4.126202452000023, - "y": 5.576200893396058, - "heading": -3.1101415344409413, - "angularVelocity": 0.10940744816134937, - "velocityX": -0.017884370093563993, - "velocityY": -0.5818446718274068, - "timestamp": 9.521185802114859 - }, - { - "x": 4.126848340594801, - "y": 5.557391994422956, - "heading": -3.107243507448873, - "angularVelocity": 0.10261175222742301, - "velocityX": 0.022869269553109393, - "velocityY": -0.665975191528855, - "timestamp": 9.549428444201755 - }, - { - "x": 4.128704875969954, - "y": 5.536236876199957, - "heading": -3.1045395779376674, - "angularVelocity": 0.09573925494952655, - "velocityX": 0.06573518757349699, - "velocityY": -0.7490488374958029, - "timestamp": 9.577671086288651 - }, - { - "x": 4.131835486712304, - "y": 5.512769384210887, - "heading": -3.10203186538837, - "angularVelocity": 0.08879171224780506, - "velocityX": 0.11084695025055208, - "velocityY": -0.8309241011116071, - "timestamp": 9.605913728375548 - }, - { - "x": 4.136307565749363, - "y": 5.487027967716942, - "heading": -3.09972240427302, - "angularVelocity": 0.08177213407458436, - "velocityX": 0.1583449247878192, - "velocityY": -0.9114379743490315, - "timestamp": 9.634156370462444 - }, - { - "x": 4.142192630826981, - "y": 5.459056378613465, - "heading": -3.0976131001489353, - "angularVelocity": 0.07468508497167435, - "velocityX": 0.20837516049356766, - "velocityY": -0.9904027044429669, - "timestamp": 9.66239901254934 - }, - { - "x": 4.149566433458333, - "y": 5.428904470508613, - "heading": -3.095705676064946, - "angularVelocity": 0.0675370270996881, - "velocityX": 0.2610875642818267, - "velocityY": -1.0676022452886083, - "timestamp": 9.690641654636236 - }, - { - "x": 4.158508989800092, - "y": 5.396629103824818, - "heading": -3.0940016082871296, - "angularVelocity": 0.06033669840708298, - "velocityX": 0.3166331363136689, - "velocityY": -1.1427885034442629, - "timestamp": 9.718884296723132 - }, - { - "x": 4.169104499088999, - "y": 5.36229515746973, - "heading": -3.0925020508230623, - "angularVelocity": 0.05309550924639011, - "velocityX": 0.3751599887966468, - "velocityY": -1.2156775647777545, - "timestamp": 9.747126938810029 - }, - { - "x": 4.181441106637344, - "y": 5.3259766387957415, - "heading": -3.0912077490711503, - "angularVelocity": 0.045827927427253216, - "velocityX": 0.4368078422120931, - "velocityY": -1.2859462143182547, - "timestamp": 9.775369580896925 - }, - { - "x": 4.195610459906488, - "y": 5.287757869928078, - "heading": -3.0901189442549186, - "angularVelocity": 0.03855180449767203, - "velocityX": 0.5017006987359274, - "velocityY": -1.3532292322394428, - "timestamp": 9.803612222983821 - }, - { - "x": 4.2117069996895005, - "y": 5.247734708939476, - "heading": -3.089235272184188, - "angularVelocity": 0.03128857661446859, - "velocityX": 0.5699374631270886, - "velocityY": -1.4171181600312093, - "timestamp": 9.831854865070717 - }, - { - "x": 4.229826926929038, - "y": 5.206015738227041, - "heading": -3.0885556622564883, - "angularVelocity": 0.02406325603706172, - "velocityX": 0.6415804577980706, - "velocityY": -1.4771624617865668, - "timestamp": 9.860097507157613 - }, - { - "x": 4.250066793413857, - "y": 5.162723320699504, - "heading": -3.088078245188932, - "angularVelocity": 0.016904122004143384, - "velocityX": 0.7166421053152825, - "velocityY": -1.5328742046986106, - "timestamp": 9.88834014924451 - }, - { - "x": 4.272521686590209, - "y": 5.117994390534871, - "heading": -3.0878002801517295, - "angularVelocity": 0.00984203377102721, - "velocityX": 0.795070557041513, - "velocityY": -1.5837374572468441, - "timestamp": 9.916582791331406 - }, - { - "x": 4.297283019475378, - "y": 5.071980816631299, - "heading": -3.0877181128372237, - "angularVelocity": 0.0029093352616577084, - "velocityX": 0.8767357108086503, - "velocityY": -1.6292234190412864, - "timestamp": 9.944825433418302 - }, - { - "x": 4.324435997461225, - "y": 5.024849164870591, - "heading": -3.087827174498778, - "angularVelocity": -0.0038615955695118155, - "velocityX": 0.9614177704162753, - "velocityY": -1.6688117073358897, - "timestamp": 9.973068075505198 - }, - { - "x": 4.354056909275255, - "y": 4.976779703710972, - "heading": -3.088122027441298, - "angularVelocity": -0.010439991471521545, - "velocityX": 1.0488010194971473, - "velocityY": -1.7020171488106757, - "timestamp": 10.001310717592094 - }, - { - "x": 4.386210464798987, - "y": 4.927964557643445, - "heading": -3.08859645514647, - "angularVelocity": -0.016798276298381022, - "velocityX": 1.1384754806155697, - "velocityY": -1.7284199515517666, - "timestamp": 10.02955335967899 - }, - { - "x": 4.420947454648737, - "y": 4.878605015906615, - "heading": -3.0892435869039567, - "angularVelocity": -0.022913286777326337, - "velocityX": 1.229948308053933, - "velocityY": -1.7476956151964618, - "timestamp": 10.057796001765887 - }, - { - "x": 4.458303010660593, - "y": 4.828908134239048, - "heading": -3.0900560403399195, - "angularVelocity": -0.02876690620740358, - "velocityX": 1.322665064299653, - "velocityY": -1.7596399626728296, - "timestamp": 10.086038643852783 - }, - { - "x": 4.498295688268876, - "y": 4.779082893453277, - "heading": -3.0910260632840125, - "angularVelocity": -0.03434604103639958, - "velocityX": 1.4160388211993622, - "velocityY": -1.7641848320164313, - "timestamp": 10.11428128593968 - }, - { - "x": 4.540927477874527, - "y": 4.7293362618821755, - "heading": -3.0921456599273003, - "angularVelocity": -0.03964206464263729, - "velocityX": 1.5094830531252688, - "velocityY": -1.7614014800047542, - "timestamp": 10.142523928026575 - }, - { - "x": 4.586184711726668, - "y": 4.679869521543178, - "heading": -3.093406693575906, - "angularVelocity": -0.0446499886492845, - "velocityX": 1.6024433448150754, - "velocityY": -1.7514912445797743, - "timestamp": 10.170766570113472 - }, - { - "x": 4.634039705671291, - "y": 4.630875157025283, - "heading": -3.094800966167012, - "angularVelocity": -0.0493676401384937, - "velocityX": 1.6944234111449143, - "velocityY": -1.7347656202684976, - "timestamp": 10.199009212200368 - }, - { - "x": 4.684452894473009, - "y": 4.582534494245445, - "heading": -3.0963202800022835, - "angularVelocity": -0.05379503201566885, - "velocityX": 1.7850025732935824, - "velocityY": -1.7116197072180923, - "timestamp": 10.227251854287264 - }, - { - "x": 4.737375198235536, - "y": 4.535016149580233, - "heading": -3.0979564886356585, - "angularVelocity": -0.05793397899320715, - "velocityX": 1.8738439413599313, - "velocityY": -1.682503517872359, - "timestamp": 10.25549449637416 - }, - { - "x": 4.792750387303713, - "y": 4.4884752415165705, - "heading": -3.099701542316806, - "angularVelocity": -0.061787904820602965, - "velocityX": 1.96069436059847, - "velocityY": -1.6478949781138656, - "timestamp": 10.283737138461056 + "angularVelocity": 6.34380051935383e-30, + "velocityX": 9.034383342873221e-27, + "velocityY": -4.2893656784840804e-27, + "timestamp": 9.62936328972116 + }, + { + "x": 4.127361618163081, + "y": 5.589290222894501, + "heading": -3.1133058118000747, + "angularVelocity": -0.002316783638418587, + "velocityX": 0.020388664219920926, + "velocityY": -0.10422450169017787, + "timestamp": 9.66144309114909 + }, + { + "x": 4.128734349992625, + "y": 5.58261651038244, + "heading": -3.113455522105689, + "angularVelocity": -0.00466680898728499, + "velocityX": 0.042791157315218396, + "velocityY": -0.20803472013549282, + "timestamp": 9.69352289257702 + }, + { + "x": 4.130895677213884, + "y": 5.572628451087546, + "heading": -3.113681729122776, + "angularVelocity": -0.0070513845790317895, + "velocityX": 0.06737346009184561, + "velocityY": -0.311350408989694, + "timestamp": 9.72560269400495 + }, + { + "x": 4.133921430664805, + "y": 5.559345011471469, + "heading": -3.1139855796338396, + "angularVelocity": -0.009471707976318045, + "velocityX": 0.09431958167568807, + "velocityY": -0.4140748703173961, + "timestamp": 9.75768249543288 + }, + { + "x": 4.137893983879697, + "y": 5.54278890926221, + "heading": -3.114368252819973, + "angularVelocity": -0.011928789116523258, + "velocityX": 0.12383347271698328, + "velocityY": -0.5160911686580497, + "timestamp": 9.78976229686081 + }, + { + "x": 4.14290295369757, + "y": 5.522987413987094, + "heading": -3.114830950875775, + "angularVelocity": -0.014423345382647558, + "velocityX": 0.15614092341333877, + "velocityY": -0.6172574141271481, + "timestamp": 9.821842098288739 + }, + { + "x": 4.149045956059229, + "y": 5.4999733355974545, + "heading": -3.1153748850742073, + "angularVelocity": -0.016955659767858167, + "velocityX": 0.19149128386781503, + "velocityY": -0.7174008991714964, + "timestamp": 9.853921899716669 + }, + { + "x": 4.156429402683938, + "y": 5.473786245698353, + "heading": -3.1160012557676575, + "angularVelocity": -0.01952539185310932, + "velocityX": 0.23015873839794218, + "velocityY": -0.8163108477442936, + "timestamp": 9.886001701144599 + }, + { + "x": 4.165169310646326, + "y": 5.4444739837791545, + "heading": -3.116711224448415, + "angularVelocity": -0.02213133028121866, + "velocityX": 0.27244270766523915, + "velocityY": -0.9137295311834174, + "timestamp": 9.918081502572528 + }, + { + "x": 4.17539207591783, + "y": 5.412094507307328, + "heading": -3.1175058756504197, + "angularVelocity": -0.02477107608630567, + "velocityX": 0.31866672536831697, + "velocityY": -1.0093415492165811, + "timestamp": 9.950161304000458 + }, + { + "x": 4.187235130982154, + "y": 5.376718146511725, + "heading": -3.1183861662726913, + "angularVelocity": -0.027440650599082298, + "velocityX": 0.3691748245677717, + "velocityY": -1.1027612148747323, + "timestamp": 9.982241105428388 + }, + { + "x": 4.200847362955722, + "y": 5.33843031658447, + "heading": -3.119352860063593, + "angularVelocity": -0.030134032876520004, + "velocityX": 0.4243240720847195, + "velocityY": -1.193518295718653, + "timestamp": 10.014320906856318 + }, + { + "x": 4.2163891108304945, + "y": 5.297334712708628, + "heading": -3.1204064458854384, + "angularVelocity": -0.03284265409848758, + "velocityX": 0.4844714487927506, + "velocityY": -1.281042963067218, + "timestamp": 10.046400708284247 + }, + { + "x": 4.234031491286171, + "y": 5.253556953213796, + "heading": -3.1215470404870604, + "angularVelocity": -0.03555491464573967, + "velocityX": 0.5499529196061951, + "velocityY": -1.364651822835758, + "timestamp": 10.078480509712177 + }, + { + "x": 4.253954734090019, + "y": 5.207248526343466, + "heading": -3.1227742803836263, + "angularVelocity": -0.038255844548259026, + "velocityX": 0.6210525600854548, + "velocityY": -1.4435384512702805, + "timestamp": 10.110560311140107 + }, + { + "x": 4.276345168971491, + "y": 5.158590722055644, + "heading": -3.124087213275635, + "angularVelocity": -0.04092708912050639, + "velocityX": 0.6979605198546586, + "velocityY": -1.5167738614946593, + "timestamp": 10.142640112568037 + }, + { + "x": 4.301390546701751, + "y": 5.107797994402928, + "heading": -3.1254842063708126, + "angularVelocity": -0.04354743586290734, + "velocityX": 0.7807210959995424, + "velocityY": -1.5833242536375496, + "timestamp": 10.174719913995967 + }, + { + "x": 4.329273565068363, + "y": 5.0551199465792225, + "heading": -3.1269628942313124, + "angularVelocity": -0.046094046555177036, + "velocityX": 0.8691767755874421, + "velocityY": -1.6420939494295976, + "timestamp": 10.206799715423896 + }, + { + "x": 4.360163856491336, + "y": 5.00084097031078, + "heading": -3.128520187661993, + "angularVelocity": -0.048544360044720423, + "velocityX": 0.9629202815475943, + "velocityY": -1.6919985115988345, + "timestamp": 10.238879516851826 + }, + { + "x": 4.3942092464422435, + "y": 4.9452766723777355, + "heading": -3.130152353475603, + "angularVelocity": -0.050878301640261164, + "velocityX": 1.061271841953092, + "velocityY": -1.7320648962829983, + "timestamp": 10.270959318279756 + }, + { + "x": 4.431527630090928, + "y": 4.88876672478548, + "heading": -3.131855153972168, + "angularVelocity": -0.053080144538629505, + "velocityX": 1.1632984615732394, + "velocityY": -1.761542935956488, + "timestamp": 10.303039119707686 + }, + { + "x": 4.472201034372105, + "y": 4.831664641398759, + "heading": -3.1336240146211116, + "angularVelocity": -0.05513938896777467, + "velocityX": 1.267882046357295, + "velocityY": -1.780001148542263, + "timestamp": 10.335118921135615 + }, + { + "x": 4.516273089684364, + "y": 4.77432589666215, + "heading": -3.1354541821875874, + "angularVelocity": -0.057050464311241014, + "velocityX": 1.373825689391232, + "velocityY": -1.7873784183305264, + "timestamp": 10.367198722563545 + }, + { + "x": 4.563750284037316, + "y": 4.717096303849241, + "heading": -3.1373408479707163, + "angularVelocity": -0.05881164156728009, + "velocityX": 1.4799715783657519, + "velocityY": -1.783975905882153, + "timestamp": 10.399278523991475 + }, + { + "x": 4.6146064004753145, + "y": 4.660302391620251, + "heading": -3.1392792319137426, + "angularVelocity": -0.060423813638029025, + "velocityX": 1.5853002255095934, + "velocityY": -1.7703947562326396, + "timestamp": 10.431358325419405 + }, + { + "x": 4.668788898913788, + "y": 4.604244792379401, + "heading": -3.1412646382650102, + "angularVelocity": -0.06188960850422685, + "velocityX": 1.6889910793307523, + "velocityY": -1.747442214278986, + "timestamp": 10.463438126847334 + }, + { + "x": 4.726225895091368, + "y": 4.5491947921222655, + "heading": -3.1432924960907886, + "angularVelocity": -0.0632129170230195, + "velocityX": 1.7904411380668532, + "velocityY": -1.7160330739830774, + "timestamp": 10.495517928275264 + }, + { + "x": 4.786832692051615, + "y": 4.495393553809111, + "heading": -3.1453583927115, + "angularVelocity": -0.06439867233443626, + "velocityX": 1.8892510010202963, + "velocityY": -1.677106338517248, + "timestamp": 10.527597729703194 }, { "x": 4.850517272949219, "y": 4.443053245544434, - "heading": -3.1015475306172475, - "angularVelocity": -0.06536174252967485, - "velocityX": 2.0453782428630785, - "velocityY": -1.6082771517050376, - "timestamp": 10.311979780547953 - }, - { - "x": 4.945792762773265, - "y": 4.375552517193276, - "heading": -3.104637557561012, - "angularVelocity": -0.07048555688108925, - "velocityX": 2.1732968933870485, - "velocityY": -1.5397362269966697, - "timestamp": 10.35581893115547 - }, - { - "x": 5.046613542601896, - "y": 4.311170508357876, - "heading": -3.1079513748428638, - "angularVelocity": -0.07559036240275999, - "velocityX": 2.2997886234442926, - "velocityY": -1.4685961735845707, - "timestamp": 10.399658081762988 - }, - { - "x": 5.152902446465935, - "y": 4.250040627121963, - "heading": -3.1114878828795027, - "angularVelocity": -0.08067008570262957, - "velocityX": 2.4245201467432853, - "velocityY": -1.3944129936092113, - "timestamp": 10.443497232370506 - }, - { - "x": 5.264562389730376, - "y": 4.192320838235789, - "heading": -3.1152455876027774, - "angularVelocity": -0.08571572832048371, - "velocityX": 2.547037105351461, - "velocityY": -1.316626533276764, - "timestamp": 10.487336382978024 - }, - { - "x": 5.381468375232392, - "y": 4.1382004854773315, - "heading": -3.1192223904774794, - "angularVelocity": -0.09071350196324425, - "velocityX": 2.666702796061197, - "velocityY": -1.2345210162255122, - "timestamp": 10.531175533585541 - }, - { - "x": 5.503455043013129, - "y": 4.08790945524459, - "heading": -3.1234152290197748, - "angularVelocity": -0.09564141832566364, - "velocityX": 2.7825965168179527, - "velocityY": -1.147171638496956, - "timestamp": 10.575014684193059 - }, - { - "x": 5.630296567310867, - "y": 4.041730311926649, - "heading": -3.127819430009789, - "angularVelocity": -0.10046273545405592, - "velocityX": 2.8933390026946704, - "velocityY": -1.053376780297883, - "timestamp": 10.618853834800577 - }, - { - "x": 5.761673013159542, - "y": 4.00001345800068, - "heading": -3.132427482658239, - "angularVelocity": -0.10511272651483035, - "velocityX": 2.996783560540646, - "velocityY": -0.9515890100027304, - "timestamp": 10.662692985408095 - }, - { - "x": 5.897112457336204, - "y": 3.963192523243404, - "heading": -3.137226596457673, - "angularVelocity": -0.10947095764695358, - "velocityX": 3.08946323776255, - "velocityY": -0.8399098579013413, - "timestamp": 10.706532136015612 - }, - { - "x": 6.03589172673902, - "y": 3.931786771388618, - "heading": -3.142193739184528, - "angularVelocity": -0.11330380853690723, - "velocityX": 3.1656468585643007, - "velocityY": -0.7163859568346735, - "timestamp": 10.75037128662313 - }, - { - "x": 6.176882566019167, - "y": 3.906346629663003, - "heading": -3.147286302822329, - "angularVelocity": -0.11616474241011562, - "velocityX": 3.216094229160719, - "velocityY": -0.5803064469331211, - "timestamp": 10.794210437230648 - }, - { - "x": 6.318402928580952, - "y": 3.887246837030129, - "heading": -3.15243062411994, - "angularVelocity": -0.11734536883862791, - "velocityX": 3.22817300519314, - "velocityY": -0.43567889359605416, - "timestamp": 10.838049587838166 - }, - { - "x": 6.458344624342974, - "y": 3.8743105056536162, - "heading": -3.1575282040954695, - "angularVelocity": -0.11627916838916771, - "velocityX": 3.192162572101109, - "velocityY": -0.29508626871740457, - "timestamp": 10.881888738445683 - }, - { - "x": 6.594766808589048, - "y": 3.866674400680897, - "heading": -3.162494391138218, - "angularVelocity": -0.11328200875080248, - "velocityX": 3.111880188268938, - "velocityY": -0.1741846013642831, - "timestamp": 10.925727889053201 - }, - { - "x": 6.726364790951044, - "y": 3.863186213104212, - "heading": -3.1672811670327787, - "angularVelocity": -0.10918952188229065, - "velocityX": 3.0018369548297525, - "velocityY": -0.0795678640746057, - "timestamp": 10.969567039660719 - }, - { - "x": 6.85241037724519, - "y": 3.862804185416008, - "heading": -3.171865764529248, - "angularVelocity": -0.10457769899591095, - "velocityX": 2.87518313077287, - "velocityY": -0.008714304061773629, - "timestamp": 11.013406190268237 - }, - { - "x": 6.972520342290402, - "y": 3.864712411625189, - "heading": -3.176237050164369, - "angularVelocity": -0.09971191445417933, - "velocityX": 2.739787687050078, - "velocityY": 0.04352790103679518, - "timestamp": 11.057245340875754 - }, - { - "x": 7.086492438843414, - "y": 3.8682949024292745, - "heading": -3.1803889652599335, - "angularVelocity": -0.09470792745816826, - "velocityX": 2.5997788500370076, - "velocityY": 0.08171898301950821, - "timestamp": 11.101084491483272 - }, - { - "x": 7.194218018560886, - "y": 3.873084644688448, - "heading": -3.18431784696781, - "angularVelocity": -0.08962038847539197, - "velocityX": 2.4572916725033225, - "velocityY": 0.10925718661967229, - "timestamp": 11.14492364209079 - }, - { - "x": 7.295638116776633, - "y": 3.878721280840711, - "heading": -3.1880212870664604, - "angularVelocity": -0.0844779163676376, - "velocityX": 2.3134594719623562, - "velocityY": 0.1285753960592616, - "timestamp": 11.188762792698308 - }, - { - "x": 7.390721083197748, - "y": 3.8849209621060954, - "heading": -3.1914975975406707, - "angularVelocity": -0.07929693951721277, - "velocityX": 2.1689053073215674, - "velocityY": 0.14141882722337154, - "timestamp": 11.232601943305825 - }, - { - "x": 7.479450781979312, - "y": 3.8914556120813315, - "heading": -3.1947455356655263, - "angularVelocity": -0.0740876152901293, - "velocityX": 2.0239830733934867, - "velocityY": 0.14905968488621668, - "timestamp": 11.276441093913343 - }, - { - "x": 7.561820121690822, - "y": 3.898138635011677, - "heading": -3.1977641509162766, - "angularVelocity": -0.06885660896523792, - "velocityX": 1.8788990792486582, - "velocityY": 0.15244417005650296, - "timestamp": 11.32028024452086 - }, - { - "x": 7.63782737731302, - "y": 3.904814917700527, - "heading": -3.200552694085297, - "angularVelocity": -0.06360851271927202, - "velocityX": 1.7337757362744945, - "velocityY": 0.1522904206931706, - "timestamp": 11.364119395128379 - }, - { - "x": 7.707474032598791, - "y": 3.9113537003122296, - "heading": -3.203110560481528, - "angularVelocity": -0.05834662307057743, - "velocityX": 1.588686238684281, - "velocityY": 0.14915395305540546, - "timestamp": 11.407958545735896 - }, - { - "x": 7.770763480621882, - "y": 3.9176433914401314, - "heading": -3.2054372529156474, - "angularVelocity": -0.05307339220483149, - "velocityX": 1.443674139348821, - "velocityY": 0.1434720116776842, - "timestamp": 11.451797696343414 - }, - { - "x": 7.827700224514358, - "y": 3.9235877249027666, - "heading": -3.207532356731126, - "angularVelocity": -0.047790702749590255, - "velocityX": 1.298764759431989, - "velocityY": 0.13559417507546984, - "timestamp": 11.495636846950932 - }, - { - "x": 7.8782893780082945, - "y": 3.9291028602207745, - "heading": -3.2093955224644075, - "angularVelocity": -0.0425000417996671, - "velocityX": 1.1539720271236498, - "velocityY": 0.1258038817262506, - "timestamp": 11.53947599755845 - }, - { - "x": 7.922536350053699, - "y": 3.9341151592421566, - "heading": -3.2110264534997506, - "angularVelocity": -0.03720261484864023, - "velocityX": 1.0093026765399213, - "velocityY": 0.11433385346025998, - "timestamp": 11.583315148165967 - }, - { - "x": 7.960446644787287, - "y": 3.9385594558007666, - "heading": -3.212424897087272, - "angularVelocity": -0.03189942250572562, - "velocityX": 0.8647588789525155, - "velocityY": 0.10137734187413922, - "timestamp": 11.627154298773485 - }, - { - "x": 7.99202573502137, - "y": 3.9423776908019037, - "heading": -3.2135906376808516, - "angularVelocity": -0.026591313413353933, - "velocityX": 0.7203399198310967, - "velocityY": 0.08709646396484473, - "timestamp": 11.670993449381003 - }, - { - "x": 8.01727898323447, - "y": 3.9455178222713507, - "heading": -3.214523491909814, - "angularVelocity": -0.02127902151467548, - "velocityX": 0.5760432823889977, - "velocityY": 0.07162847422752046, - "timestamp": 11.71483259998852 - }, - { - "x": 8.036211593571213, - "y": 3.9479329451914285, - "heading": -3.2152233047220844, - "angularVelocity": -0.01596319277569034, - "velocityX": 0.43186535492534833, - "velocityY": 0.055090550035959585, - "timestamp": 11.758671750596038 - }, - { - "x": 8.048828584224365, - "y": 3.9495805734534923, - "heading": -3.2156899463805253, - "angularVelocity": -0.010644404646863087, - "velocityX": 0.28780189575545956, - "velocityY": 0.03758348962585016, - "timestamp": 11.802510901203556 + "heading": -3.1474581021699306, + "angularVelocity": -0.06545269499711938, + "velocityX": 1.9851924906916565, + "velocityY": -1.6315658431448485, + "timestamp": 10.559677531131124 + }, + { + "x": 4.9437621180180376, + "y": 4.374171818676806, + "heading": -3.150402741414032, + "angularVelocity": -0.06673056625500977, + "velocityX": 2.11308781687508, + "velocityY": -1.5609710522391966, + "timestamp": 10.603804824054857 + }, + { + "x": 5.042589175643495, + "y": 4.308514394194728, + "heading": -3.15340097541372, + "angularVelocity": -0.0679451151664831, + "velocityX": 2.239590309703874, + "velocityY": -1.4879096389519224, + "timestamp": 10.64793211697859 + }, + { + "x": 5.146923258079112, + "y": 4.246207789306398, + "heading": -3.15644944306721, + "angularVelocity": -0.06908349575757691, + "velocityX": 2.364388919482122, + "velocityY": -1.4119743306261106, + "timestamp": 10.692059409902322 + }, + { + "x": 5.256670681278472, + "y": 4.187401339376366, + "heading": -3.1595440333108304, + "angularVelocity": -0.07012871260806186, + "velocityX": 2.4870644883891004, + "velocityY": -1.3326548272895222, + "timestamp": 10.736186702826055 + }, + { + "x": 5.37171218426409, + "y": 4.1322729451563776, + "heading": -3.1626796182046615, + "angularVelocity": -0.07105772156135512, + "velocityX": 2.607037399381106, + "velocityY": -1.2493037883667124, + "timestamp": 10.780313995749788 + }, + { + "x": 5.491892080249721, + "y": 4.081037149777456, + "heading": -3.1658496518601376, + "angularVelocity": -0.07183838947372749, + "velocityX": 2.7234821812736496, + "velocityY": -1.1610908348145161, + "timestamp": 10.82444128867352 + }, + { + "x": 5.617001050441113, + "y": 4.033955830214484, + "heading": -3.1690455482470474, + "angularVelocity": -0.07242448324290972, + "velocityX": 2.8351834409516603, + "velocityY": -1.066943300699277, + "timestamp": 10.868568581597254 + }, + { + "x": 5.746747873958915, + "y": 3.99135176259693, + "heading": -3.172255686793518, + "angularVelocity": -0.07274723495997151, + "velocityX": 2.9402851369570526, + "velocityY": -0.9654811069237402, + "timestamp": 10.912695874520987 + }, + { + "x": 5.880711540503468, + "y": 3.953623523789422, + "heading": -3.1754637955644602, + "angularVelocity": -0.0727012367716988, + "velocityX": 3.0358460188366085, + "velocityY": -0.8549864790644365, + "timestamp": 10.95682316744472 + }, + { + "x": 6.018259312854991, + "y": 3.921253418671523, + "heading": -3.17864639066564, + "angularVelocity": -0.07212305333754412, + "velocityX": 3.1170679921211555, + "velocityY": -0.7335619969674041, + "timestamp": 11.000950460368452 + }, + { + "x": 6.1584140770218765, + "y": 3.894778972069645, + "heading": -3.1817693859537624, + "angularVelocity": -0.07077241954361635, + "velocityX": 3.1761468896158984, + "velocityY": -0.5999562821049207, + "timestamp": 11.045077753292185 + }, + { + "x": 6.299691207685043, + "y": 3.8746523574270517, + "heading": -3.1847868443417173, + "angularVelocity": -0.06838077271519878, + "velocityX": 3.2015816358220777, + "velocityY": -0.4561035429338189, + "timestamp": 11.089205046215918 + }, + { + "x": 6.440086926929617, + "y": 3.8609114265325597, + "heading": -3.1876514418180824, + "angularVelocity": -0.064916682773087, + "velocityX": 3.181607344171908, + "velocityY": -0.31139301742893755, + "timestamp": 11.13333233913965 + }, + { + "x": 6.577519585241789, + "y": 3.852895304317245, + "heading": -3.1903375774921936, + "angularVelocity": -0.06087243282188403, + "velocityX": 3.1144593109235577, + "velocityY": -0.1816590523504174, + "timestamp": 11.177459632063384 + }, + { + "x": 6.710430813156556, + "y": 3.849473711924821, + "heading": -3.1928462395413875, + "angularVelocity": -0.05685057666079069, + "velocityX": 3.0119959577960485, + "velocityY": -0.07753914110112503, + "timestamp": 11.221586924987117 + }, + { + "x": 6.837903774130578, + "y": 3.849513114724915, + "heading": -3.195189040331929, + "angularVelocity": -0.05309187659869676, + "velocityX": 2.888755519046643, + "velocityY": 0.0008929349045215606, + "timestamp": 11.26571421791085 + }, + { + "x": 6.959451864685314, + "y": 3.8520920843748097, + "heading": -3.1973778162141286, + "angularVelocity": -0.049601408497511906, + "velocityX": 2.754487812447785, + "velocityY": 0.0584438672535896, + "timestamp": 11.309841510834582 + }, + { + "x": 7.074821471996235, + "y": 3.8565095462953276, + "heading": -3.199422165983164, + "angularVelocity": -0.046328465527412294, + "velocityX": 2.6144728050804824, + "velocityY": 0.10010724945563003, + "timestamp": 11.353968803758315 + }, + { + "x": 7.183879110928512, + "y": 3.862235800907705, + "heading": -3.2013295566724143, + "angularVelocity": -0.043224738316652994, + "velocityX": 2.47143279604223, + "velocityY": 0.12976673240016404, + "timestamp": 11.398096096682048 + }, + { + "x": 7.286554059594033, + "y": 3.8688649864165408, + "heading": -3.203105828627542, + "angularVelocity": -0.04025336333678901, + "velocityX": 2.3267901079492375, + "velocityY": 0.15022869225839522, + "timestamp": 11.44222338960578 + }, + { + "x": 7.382809422368965, + "y": 3.876079871178506, + "heading": -3.2047556287978103, + "angularVelocity": -0.037387296182429475, + "velocityX": 2.1813113018578907, + "velocityY": 0.16350164000394588, + "timestamp": 11.486350682529514 + }, + { + "x": 7.472627119079689, + "y": 3.8836274243417246, + "heading": -3.2062827243266865, + "angularVelocity": -0.03460659894808434, + "velocityX": 2.0354227680805117, + "velocityY": 0.1710404754776865, + "timestamp": 11.530477975453246 + }, + { + "x": 7.55599980644016, + "y": 3.891302009366154, + "heading": -3.2076902226665296, + "angularVelocity": -0.0318963219039034, + "velocityX": 1.8893678228702142, + "velocityY": 0.17391923492097494, + "timestamp": 11.57460526837698 + }, + { + "x": 7.6329263709350945, + "y": 3.8989336935716974, + "heading": -3.2089807269793242, + "angularVelocity": -0.029245036966696142, + "velocityX": 1.743287643497406, + "velocityY": 0.17294702892229097, + "timestamp": 11.618732561300712 + }, + { + "x": 7.703409332939463, + "y": 3.9063799703337883, + "heading": -3.2101564476934303, + "angularVelocity": -0.026643844120189303, + "velocityX": 1.5972645801360887, + "velocityY": 0.16874537885115004, + "timestamp": 11.662859854224445 + }, + { + "x": 7.767453311384192, + "y": 3.9135197819904346, + "heading": -3.211219284147651, + "angularVelocity": -0.02408569354248682, + "velocityX": 1.4513461896567743, + "velocityY": 0.16180035491836087, + "timestamp": 11.706987147148178 + }, + { + "x": 7.825064096457434, + "y": 3.9202491201135516, + "heading": -3.2121708854927884, + "angularVelocity": -0.02156491554516941, + "velocityX": 1.3055590147533807, + "velocityY": 0.1524983219511668, + "timestamp": 11.75111444007191 + }, + { + "x": 7.876248081008777, + "y": 3.926477727608759, + "heading": -3.21301269693629, + "angularVelocity": -0.01907688842269266, + "velocityX": 1.1599167127656267, + "velocityY": 0.14115090871249011, + "timestamp": 11.795241732995644 + }, + { + "x": 7.921011908809607, + "y": 3.9321265849814897, + "heading": -3.213745995433236, + "angularVelocity": -0.01661779928837861, + "velocityX": 1.0144249700111274, + "velocityY": 0.12801277845196743, + "timestamp": 11.839369025919376 + }, + { + "x": 7.959362256636442, + "y": 3.9371259647519805, + "heading": -3.214371917641177, + "angularVelocity": -0.01418446876001787, + "velocityX": 0.8690845344425987, + "velocityY": 0.11329450413219869, + "timestamp": 11.88349631884311 + }, + { + "x": 7.991305700332075, + "y": 3.9414139044546914, + "heading": -3.2148914821093557, + "angularVelocity": -0.011774220301181082, + "velocityX": 0.7238931187290586, + "velocityY": 0.09717205426858692, + "timestamp": 11.927623611766842 + }, + { + "x": 8.0168486342553, + "y": 3.9449349928496713, + "heading": -3.215305607104995, + "angularVelocity": -0.009384781349602625, + "velocityX": 0.5788466101324847, + "velocityY": 0.07979389084813283, + "timestamp": 11.971750904690575 + }, + { + "x": 8.035997224984508, + "y": 3.9476393938744345, + "heading": -3.2156151250917477, + "angularVelocity": -0.007014207449519859, + "velocityX": 0.4339398467588367, + "velocityY": 0.061286356936450265, + "timestamp": 12.015878197614308 + }, + { + "x": 8.048757387107702, + "y": 3.949482053440674, + "heading": -3.2158207946062887, + "angularVelocity": -0.004660823289036077, + "velocityX": 0.2891671180747018, + "velocityY": 0.04175782025477947, + "timestamp": 12.06000549053804 }, { "x": 8.055134773254395, "y": 3.9504220485687256, "heading": -3.2159233100890603, - "angularVelocity": -0.005323180428930311, - "velocityX": 0.14384833972918967, - "velocityY": 0.019194603535245852, - "timestamp": 11.846350051811074 + "angularVelocity": -0.0023231763378057644, + "velocityX": 0.1445224876521085, + "velocityY": 0.02130189879710489, + "timestamp": 12.104132783461774 }, { "x": 8.055134773254395, "y": 3.9504220485687256, "heading": -3.2159233100890603, - "angularVelocity": -6.67822227879436e-24, - "velocityX": 2.8759643270288254e-22, - "velocityY": -3.633600230346585e-23, - "timestamp": 11.890189202418592 + "angularVelocity": -3.604262691063738e-28, + "velocityX": 6.313479362917307e-28, + "velocityY": -2.1122209046929412e-26, + "timestamp": 12.148260076385506 }, { "x": 8.049461022102024, - "y": 3.949818782258034, + "y": 3.9498187822580335, "heading": -3.2160337027243697, - "angularVelocity": -0.0026590767459743715, - "velocityX": -0.13666617985358623, - "velocityY": -0.014531145251617299, - "timestamp": 11.931704602632813 + "angularVelocity": -0.0026590767459743207, + "velocityX": -0.13666617985358606, + "velocityY": -0.014531145251617469, + "timestamp": 12.189775476599728 }, { - "x": 8.038111439942709, - "y": 3.948632147519207, + "x": 8.038111439942707, + "y": 3.9486321475192065, "heading": -3.216254752452189, - "angularVelocity": -0.005324523590736258, - "velocityX": -0.2733824580939108, - "velocityY": -0.028583001312859572, - "timestamp": 11.973220002847034 + "angularVelocity": -0.005324523590736178, + "velocityX": -0.27338245809391043, + "velocityY": -0.028583001312859898, + "timestamp": 12.231290876813949 }, { "x": 8.021083835373686, "y": 3.9468838801152724, - "heading": -3.2165867486967437, - "angularVelocity": -0.007996941926150615, - "velocityX": -0.4101515216319159, - "velocityY": -0.04211129833539491, - "timestamp": 12.014735403061255 + "heading": -3.216586748696743, + "angularVelocity": -0.007996941926150492, + "velocityX": -0.41015152163191543, + "velocityY": -0.0421112983353954, + "timestamp": 12.27280627702817 }, { - "x": 7.998375901501308, + "x": 7.998375901501307, "y": 3.9445978195464457, - "heading": -3.217030009033054, - "angularVelocity": -0.010677009833060662, - "velocityX": -0.5469761523483998, - "velocityY": -0.05506536266133637, - "timestamp": 12.056250803275477 - }, - { - "x": 7.969985213798721, - "y": 3.941800228532568, - "heading": -3.2175848829828544, - "angularVelocity": -0.013365496826158159, - "velocityX": -0.6838591837267317, - "velocityY": -0.06738682511649931, - "timestamp": 12.097766203489698 - }, - { - "x": 7.935909230970343, - "y": 3.9385201802867242, - "heading": -3.2182517565758397, - "angularVelocity": -0.01606328228908489, - "velocityX": -0.8208034284276452, - "velocityY": -0.07900798809402601, - "timestamp": 12.13928160370392 - }, - { - "x": 7.896145300692885, - "y": 3.9347900324583227, - "heading": -3.2190310578779004, - "angularVelocity": -0.018771378766420068, - "velocityX": -0.9578115608250078, - "velocityY": -0.0898497379081842, - "timestamp": 12.18079700391814 - }, - { - "x": 7.850690673153943, - "y": 3.9306460132603056, - "heading": -3.2199232637551667, - "angularVelocity": -0.02149096173137802, - "velocityX": -1.0948859291827262, - "velocityY": -0.09981884256525955, - "timestamp": 12.222312404132362 - }, - { - "x": 7.799542527002307, + "heading": -3.2170300090330537, + "angularVelocity": -0.010677009833060467, + "velocityX": -0.5469761523483992, + "velocityY": -0.055065362661337006, + "timestamp": 12.314321677242392 + }, + { + "x": 7.96998521379872, + "y": 3.9418002285325686, + "heading": -3.2175848829828535, + "angularVelocity": -0.013365496826157975, + "velocityX": -0.683859183726731, + "velocityY": -0.06738682511650008, + "timestamp": 12.355837077456613 + }, + { + "x": 7.935909230970341, + "y": 3.9385201802867247, + "heading": -3.218251756575839, + "angularVelocity": -0.01606328228908466, + "velocityX": -0.8208034284276444, + "velocityY": -0.07900798809402691, + "timestamp": 12.397352477670834 + }, + { + "x": 7.896145300692883, + "y": 3.9347900324583236, + "heading": -3.2190310578778996, + "angularVelocity": -0.01877137876641979, + "velocityX": -0.957811560825007, + "velocityY": -0.08984973790818522, + "timestamp": 12.438867877885055 + }, + { + "x": 7.8506906731539425, + "y": 3.930646013260306, + "heading": -3.2199232637551662, + "angularVelocity": -0.02149096173137775, + "velocityX": -1.094885929182725, + "velocityY": -0.0998188425652607, + "timestamp": 12.480383278099277 + }, + { + "x": 7.7995425270023055, "y": 3.926128954800206, - "heading": -3.2209289082374455, - "angularVelocity": -0.024223408110953828, - "velocityX": -1.2320282566881058, - "velocityY": -0.10880440599854417, - "timestamp": 12.263827804346583 + "heading": -3.220928908237445, + "angularVelocity": -0.024223408110953516, + "velocityX": -1.2320282566881047, + "velocityY": -0.10880440599854542, + "timestamp": 12.521898678313498 }, { - "x": 7.742698015104244, - "y": 3.9212852225051047, - "heading": -3.2220485929804368, - "angularVelocity": -0.02697034684030146, - "velocityX": -1.3692391643761666, - "velocityY": -0.11667314466696567, - "timestamp": 12.305343204560804 + "x": 7.742698015104242, + "y": 3.921285222505105, + "heading": -3.2220485929804363, + "angularVelocity": -0.026970346840301144, + "velocityX": -1.3692391643761652, + "velocityY": -0.116673144666967, + "timestamp": 12.56341407852772 }, { - "x": 7.680154342166579, + "x": 7.680154342166577, "y": 3.9161679101915414, - "heading": -3.2232830005246065, - "angularVelocity": -0.029733726226896906, - "velocityX": -1.5065174035402846, - "velocityY": -0.12326298884649987, - "timestamp": 12.346858604775026 + "heading": -3.223283000524606, + "angularVelocity": -0.02973372622689661, + "velocityX": -1.506517403540283, + "velocityY": -0.12326298884650128, + "timestamp": 12.60492947874194 }, { - "x": 7.6119088943213455, - "y": 3.910838401815779, - "heading": -3.224632911344616, - "angularVelocity": -0.03251590525548651, - "velocityX": -1.6438586041103576, - "velocityY": -0.12837425023635576, - "timestamp": 12.388374004989247 + "x": 7.611908894321344, + "y": 3.9108384018157785, + "heading": -3.2246329113446155, + "angularVelocity": -0.03251590525548623, + "velocityX": -1.6438586041103558, + "velocityY": -0.12837425023635723, + "timestamp": 12.646444878956162 }, { - "x": 7.537959455007088, - "y": 3.9053684501424586, - "heading": -3.226099226134968, - "angularVelocity": -0.03531977971513932, - "velocityX": -1.781253195986903, - "velocityY": -0.13175717071484946, - "timestamp": 12.429889405203468 + "x": 7.537959455007086, + "y": 3.905368450142458, + "heading": -3.2260992261349672, + "angularVelocity": -0.035319779715139006, + "velocityX": -1.781253195986901, + "velocityY": -0.13175717071485094, + "timestamp": 12.687960279170383 }, { - "x": 7.458304567583275, + "x": 7.458304567583274, "y": 3.8998430016438226, - "heading": -3.2276829954841744, - "angularVelocity": -0.03814896016982299, - "velocityX": -1.918682874614946, - "velocityY": -0.13309394755015685, - "timestamp": 12.47140480541769 + "heading": -3.227682995484174, + "angularVelocity": -0.03814896016982266, + "velocityX": -1.918682874614944, + "velocityY": -0.13309394755015833, + "timestamp": 12.729475679384604 }, { - "x": 7.372944154845319, + "x": 7.372944154845317, "y": 3.8943641280279326, - "heading": -3.2293854602252283, - "angularVelocity": -0.04100802912339145, - "velocityX": -2.0561144129044084, - "velocityY": -0.13197207753312612, - "timestamp": 12.51292020563191 + "heading": -3.229385460225228, + "angularVelocity": -0.04100802912339112, + "velocityX": -2.0561144129044058, + "velocityY": -0.13197207753312756, + "timestamp": 12.770991079598826 }, { - "x": 7.281880604712493, - "y": 3.889056649665367, - "heading": -3.231208107626954, - "angularVelocity": -0.04390292258585246, - "velocityX": -2.1934884323150885, - "velocityY": -0.12784360346230503, - "timestamp": 12.554435605846132 + "x": 7.281880604712491, + "y": 3.8890566496653665, + "heading": -3.2312081076269537, + "angularVelocity": -0.043902922585852135, + "velocityX": -2.193488432315086, + "velocityY": -0.1278436034623064, + "timestamp": 12.812506479813047 }, { - "x": 7.185120739461101, + "x": 7.185120739461099, "y": 3.8840764365077023, - "heading": -3.233152751779346, - "angularVelocity": -0.046841512844808565, - "velocityX": -2.3306981205072343, - "velocityY": -0.11996062020276857, - "timestamp": 12.595951006060353 + "heading": -3.2331527517793455, + "angularVelocity": -0.04684151284480821, + "velocityX": -2.330698120507232, + "velocityY": -0.11996062020276978, + "timestamp": 12.854021880027268 }, { "x": 7.082679550342636, "y": 3.879623112717479, - "heading": -3.235221652055951, - "angularVelocity": -0.049834525644205194, - "velocityX": -2.4675467077244044, - "velocityY": -0.10726920051942225, - "timestamp": 12.637466406274575 + "heading": -3.2352216520559507, + "angularVelocity": -0.049834525644204826, + "velocityX": -2.467546707724402, + "velocityY": -0.10726920051942324, + "timestamp": 12.89553728024149 }, { - "x": 6.974587692374974, + "x": 6.974587692374973, "y": 3.8759603104264273, - "heading": -3.2374176930686835, - "angularVelocity": -0.05289702138003147, - "velocityX": -2.60365689382502, - "velocityY": -0.08822755585039416, - "timestamp": 12.678981806488796 + "heading": -3.237417693068683, + "angularVelocity": -0.05289702138003111, + "velocityX": -2.6036568938250175, + "velocityY": -0.08822755585039478, + "timestamp": 12.93705268045571 }, { "x": 6.860907625972457, "y": 3.873449383506687, - "heading": -3.2397446641736134, - "angularVelocity": -0.056050793029157005, - "velocityX": -2.7382625680090227, - "velocityY": -0.060481818958357046, - "timestamp": 12.720497206703017 + "heading": -3.239744664173613, + "angularVelocity": -0.056050793029156644, + "velocityX": -2.7382625680090196, + "velocityY": -0.06048181895835718, + "timestamp": 12.978568080669932 }, { - "x": 6.74177148088028, - "y": 3.8726075802709827, - "heading": -3.2422076835623286, - "angularVelocity": -0.05932784884658806, - "velocityX": -2.869685573965975, - "velocityY": -0.020276890776945063, - "timestamp": 12.762012606917239 + "x": 6.741771480880281, + "y": 3.8726075802709823, + "heading": -3.242207683562328, + "angularVelocity": -0.059327848846587705, + "velocityX": -2.8696855739659712, + "velocityY": -0.020276890776944532, + "timestamp": 13.020083480884153 }, { - "x": 6.6174784673151565, - "y": 3.874207359068915, + "x": 6.617478467315157, + "y": 3.8742073590689143, "heading": -3.24481367151268, - "angularVelocity": -0.06277159648960273, - "velocityX": -2.9939013697029333, - "velocityY": 0.0385345869165934, - "timestamp": 12.80352800713146 + "angularVelocity": -0.0627715964896024, + "velocityX": -2.9939013697029293, + "velocityY": 0.03853458691659454, + "timestamp": 13.061598881098375 }, { - "x": 6.4887587158832485, - "y": 3.879406926640923, - "heading": -3.2475703091903396, - "angularVelocity": -0.06640036380319413, - "velocityX": -3.100530183202083, - "velocityY": 0.12524430802010658, - "timestamp": 12.845043407345681 + "x": 6.488758715883249, + "y": 3.879406926640922, + "heading": -3.247570309190339, + "angularVelocity": -0.06640036380319386, + "velocityX": -3.1005301832020784, + "velocityY": 0.12524430802010722, + "timestamp": 13.103114281312596 }, { "x": 6.357349625228428, - "y": 3.8896386087606305, + "y": 3.8896386087606296, "heading": -3.250472668687868, - "angularVelocity": -0.06991043040781324, - "velocityX": -3.1653094990471695, - "velocityY": 0.24645510020164924, - "timestamp": 12.886558807559902 + "angularVelocity": -0.06991043040781329, + "velocityX": -3.165309499047169, + "velocityY": 0.24645510020164774, + "timestamp": 13.144629681526817 }, { "x": 6.226097742502279, - "y": 3.905573882546097, + "y": 3.905573882546096, "heading": -3.253467220206788, - "angularVelocity": -0.07213110083169348, - "velocityX": -3.161522761406179, - "velocityY": 0.383840061838245, - "timestamp": 12.928074207774124 + "angularVelocity": -0.07213110083169395, + "velocityX": -3.161522761406181, + "velocityY": 0.38384006183824343, + "timestamp": 13.186145081741039 }, { "x": 6.097361671143063, - "y": 3.9266303810010146, + "y": 3.926630381001014, "heading": -3.256480660362481, - "angularVelocity": -0.07258607986779293, + "angularVelocity": -0.07258607986779345, "velocityX": -3.1009232885852347, - "velocityY": 0.5071972893496193, - "timestamp": 12.969589607988345 + "velocityY": 0.5071972893496168, + "timestamp": 13.22766048195526 }, { - "x": 5.972395859043094, - "y": 3.9519695662893874, + "x": 5.972395859043095, + "y": 3.951969566289386, "heading": -3.2594678160246513, - "angularVelocity": -0.0719529535246346, - "velocityX": -3.0101073687146878, - "velocityY": 0.6103562812262663, - "timestamp": 13.011105008202566 + "angularVelocity": -0.07195295352463506, + "velocityX": -3.0101073687146873, + "velocityY": 0.6103562812262632, + "timestamp": 13.269175882169481 }, { "x": 5.851830452160621, - "y": 3.98094091133554, + "y": 3.980940911335539, "heading": -3.2624048122101206, - "angularVelocity": -0.07074473979086844, - "velocityX": -2.9041128415082156, - "velocityY": 0.6978457366822637, - "timestamp": 13.052620408416788 + "angularVelocity": -0.07074473979086897, + "velocityX": -2.9041128415082147, + "velocityY": 0.6978457366822604, + "timestamp": 13.310691282383702 }, { - "x": 5.736009410595541, - "y": 4.013081963648901, + "x": 5.736009410595542, + "y": 4.0130819636489, "heading": -3.265278093679901, - "angularVelocity": -0.06921001495720346, - "velocityX": -2.7898331936447005, - "velocityY": 0.7741958923077217, - "timestamp": 13.094135808631009 + "angularVelocity": -0.06921001495720394, + "velocityX": -2.7898331936447, + "velocityY": 0.7741958923077186, + "timestamp": 13.352206682597924 }, { - "x": 5.625138940256401, - "y": 4.048059882088208, + "x": 5.625138940256402, + "y": 4.048059882088207, "heading": -3.2680792005517927, - "angularVelocity": -0.06747151315988424, - "velocityX": -2.6705865718996242, - "velocityY": 0.8425287546023715, - "timestamp": 13.13565120884523 + "angularVelocity": -0.06747151315988477, + "velocityX": -2.670586571899624, + "velocityY": 0.8425287546023689, + "timestamp": 13.393722082812145 }, { "x": 5.519352651225023, - "y": 4.085627588699354, + "y": 4.085627588699353, "heading": -3.270802426805142, - "angularVelocity": -0.0655955678928201, - "velocityX": -2.548121624397602, - "velocityY": 0.9049101397865453, - "timestamp": 13.177166609059451 + "angularVelocity": -0.06559556789282064, + "velocityX": -2.5481216243976026, + "velocityY": 0.9049101397865432, + "timestamp": 13.435237483026366 }, { "x": 5.41874256251759, "y": 4.125595879402791, - "heading": -3.2734436882617857, - "angularVelocity": -0.06362124520091712, - "velocityX": -2.4234401737254054, - "velocityY": 0.9627340817431456, - "timestamp": 13.218682009273673 + "heading": -3.2734436882617852, + "angularVelocity": -0.06362124520091768, + "velocityX": -2.4234401737254063, + "velocityY": 0.9627340817431439, + "timestamp": 13.476752883240588 }, { "x": 5.323375157332968, - "y": 4.167815854983862, - "heading": -3.2759999255233883, - "angularVelocity": -0.06157322941395978, - "velocityX": -2.2971573125278995, - "velocityY": 1.0169714217667107, - "timestamp": 13.260197409487894 + "y": 4.1678158549838615, + "heading": -3.275999925523388, + "angularVelocity": -0.06157322941396035, + "velocityX": -2.297157312527901, + "velocityY": 1.0169714217667094, + "timestamp": 13.518268283454809 }, { "x": 5.233300333220428, - "y": 4.212167583324044, + "y": 4.212167583324043, "heading": -3.2784687641766523, - "angularVelocity": -0.05946802007267365, - "velocityX": -2.1696725467597475, - "velocityY": 1.0683199032485298, - "timestamp": 13.301712809702115 + "angularVelocity": -0.059468020072674224, + "velocityX": -2.169672546759749, + "velocityY": 1.0683199032485289, + "timestamp": 13.55978368366903 }, { "x": 5.148556709289551, "y": 4.258552551269531, "heading": -3.2808483088426774, - "angularVelocity": -0.057317155892666005, - "velocityX": -2.0412575452385195, - "velocityY": 1.1172954543648586, - "timestamp": 13.343228209916337 + "angularVelocity": -0.05731715589266657, + "velocityX": -2.0412575452385213, + "velocityY": 1.117295454364858, + "timestamp": 13.601299083883251 }, { - "x": 5.093077041800994, - "y": 4.291207597300885, + "x": 5.093077041800993, + "y": 4.291207597300886, "heading": -3.28243411107928, - "angularVelocity": -0.05582003804977698, - "velocityX": -1.9528772748078769, - "velocityY": 1.1494534879032838, - "timestamp": 13.371637402958955 + "angularVelocity": -0.05582003804977755, + "velocityX": -1.9528772748078782, + "velocityY": 1.1494534879032836, + "timestamp": 13.62970827692587 }, { "x": 5.040173170230802, - "y": 4.324572617724137, + "y": 4.3245726177241375, "heading": -3.283974328628088, - "angularVelocity": -0.05421546280803395, - "velocityX": -1.8622095844407967, - "velocityY": 1.1744444966528669, - "timestamp": 13.400046596001573 + "angularVelocity": -0.054215462808034555, + "velocityX": -1.8622095844407982, + "velocityY": 1.174444496652867, + "timestamp": 13.658117469968488 }, { - "x": 4.98989479951463, - "y": 4.358433126349112, + "x": 4.989894799514629, + "y": 4.358433126349113, "heading": -3.2854661326260484, - "angularVelocity": -0.05251131194477776, - "velocityX": -1.7697922866287699, - "velocityY": 1.1918856186509867, - "timestamp": 13.428455789044191 + "angularVelocity": -0.05251131194477834, + "velocityX": -1.7697922866287714, + "velocityY": 1.1918856186509874, + "timestamp": 13.686526663011106 }, { - "x": 4.9422741836993005, - "y": 4.392567638374272, + "x": 4.9422741836993, + "y": 4.392567638374273, "heading": -3.286906936138998, - "angularVelocity": -0.050716101326364144, - "velocityX": -1.6762396504502126, - "velocityY": 1.2015305036631476, - "timestamp": 13.45686498208681 + "angularVelocity": -0.0507161013263647, + "velocityX": -1.676239650450214, + "velocityY": 1.2015305036631485, + "timestamp": 13.714935856053724 }, { - "x": 4.897324937032935, - "y": 4.4267521795236116, + "x": 4.897324937032934, + "y": 4.426752179523612, "heading": -3.2882943981413915, - "angularVelocity": -0.04883848690499538, - "velocityX": -1.5822077944606066, - "velocityY": 1.2032915225032208, - "timestamp": 13.485274175129428 - }, - { - "x": 4.855041998988872, - "y": 4.460764984125912, - "heading": -3.2896264183398576, - "angularVelocity": -0.04688694242276584, - "velocityX": -1.488354068369098, - "velocityY": 1.1972464177802156, - "timestamp": 13.513683368172046 - }, - { - "x": 4.815402731889438, - "y": 4.49439090299611, - "heading": -3.2909011283646152, - "angularVelocity": -0.044869631560659845, - "velocityX": -1.395297185666981, - "velocityY": 1.1836280889694686, - "timestamp": 13.542092561214664 - }, - { - "x": 4.778368948070447, - "y": 4.527425114367741, - "heading": -3.292116883219862, - "angularVelocity": -0.04279441705448228, - "velocityX": -1.3035845039116323, - "velocityY": 1.162800059898788, - "timestamp": 13.570501754257283 - }, - { - "x": 4.743889546033795, - "y": 4.559675883528322, - "heading": -3.2932722542437216, - "angularVelocity": -0.04066891383103432, - "velocityX": -1.2136705884228616, - "velocityY": 1.135222993212112, - "timestamp": 13.5989109472999 - }, - { - "x": 4.711903404867425, - "y": 4.590966294355543, - "heading": -3.294366022687478, - "angularVelocity": -0.038500510807015505, - "velocityX": -1.1259081213037754, - "velocityY": 1.1014185014083835, - "timestamp": 13.627320140342519 - }, - { - "x": 4.682342231358772, - "y": 4.62113502683453, - "heading": -3.2953971721767, - "angularVelocity": -0.036296331531676815, - "velocityX": -1.0405495666246902, - "velocityY": 1.0619355654956426, - "timestamp": 13.655729333385137 - }, - { - "x": 4.655133141889209, - "y": 4.650036350102354, - "heading": -3.2963648786428728, - "angularVelocity": -0.03406314514887169, - "velocityX": -0.9577565060980874, - "velocityY": 1.0173229216496225, - "timestamp": 13.684138526427756 - }, - { - "x": 4.6302008571197, - "y": 4.677539537863245, - "heading": -3.297268497203799, - "angularVelocity": -0.0318072589943193, + "angularVelocity": -0.04883848690499593, + "velocityX": -1.5822077944606079, + "velocityY": 1.2032915225032221, + "timestamp": 13.743345049096343 + }, + { + "x": 4.855041998988871, + "y": 4.4607649841259125, + "heading": -3.289626418339858, + "angularVelocity": -0.04688694242276638, + "velocityX": -1.4883540683690992, + "velocityY": 1.1972464177802173, + "timestamp": 13.771754242138961 + }, + { + "x": 4.815402731889437, + "y": 4.494390902996111, + "heading": -3.290901128364616, + "angularVelocity": -0.044869631560660386, + "velocityX": -1.3952971856669822, + "velocityY": 1.1836280889694708, + "timestamp": 13.80016343518158 + }, + { + "x": 4.7783689480704465, + "y": 4.527425114367743, + "heading": -3.292116883219863, + "angularVelocity": -0.04279441705448278, + "velocityX": -1.3035845039116334, + "velocityY": 1.1628000598987902, + "timestamp": 13.828572628224197 + }, + { + "x": 4.743889546033794, + "y": 4.559675883528325, + "heading": -3.2932722542437225, + "angularVelocity": -0.04066891383103477, + "velocityX": -1.2136705884228622, + "velocityY": 1.1352229932121145, + "timestamp": 13.856981821266816 + }, + { + "x": 4.7119034048674235, + "y": 4.590966294355546, + "heading": -3.2943660226874782, + "angularVelocity": -0.038500510807015914, + "velocityX": -1.1259081213037758, + "velocityY": 1.1014185014083862, + "timestamp": 13.885391014309434 + }, + { + "x": 4.682342231358771, + "y": 4.621135026834533, + "heading": -3.2953971721767004, + "angularVelocity": -0.03629633153167719, + "velocityX": -1.0405495666246907, + "velocityY": 1.0619355654956453, + "timestamp": 13.913800207352052 + }, + { + "x": 4.655133141889207, + "y": 4.650036350102356, + "heading": -3.296364878642873, + "angularVelocity": -0.034063145148872064, + "velocityX": -0.9577565060980876, + "velocityY": 1.0173229216496253, + "timestamp": 13.94220940039467 + }, + { + "x": 4.630200857119698, + "y": 4.677539537863246, + "heading": -3.2972684972037993, + "angularVelocity": -0.03180725899431965, "velocityX": -0.8776132687791319, - "velocityY": 0.9681087287355101, - "timestamp": 13.712547719470374 + "velocityY": 0.9681087287355129, + "timestamp": 13.970618593437289 }, { - "x": 4.60746946841203, - "y": 4.7035279061702235, - "heading": -3.298107546340062, - "angularVelocity": -0.029534423417245912, - "velocityX": -0.8001420059193414, - "velocityY": 0.9147872756537933, - "timestamp": 13.740956912512992 + "x": 4.607469468412028, + "y": 4.703527906170224, + "heading": -3.2981075463400624, + "angularVelocity": -0.02953442341724624, + "velocityX": -0.8001420059193413, + "velocityY": 0.9147872756537958, + "timestamp": 13.999027786479907 }, { - "x": 4.58686379126551, - "y": 4.727897641649931, - "heading": -3.2988816902568137, - "angularVelocity": -0.02724976790400753, - "velocityX": -0.7253172279694379, - "velocityY": 0.8578116049670773, - "timestamp": 13.76936610555561 + "x": 4.586863791265508, + "y": 4.727897641649932, + "heading": -3.298881690256814, + "angularVelocity": -0.02724976790400784, + "velocityX": -0.7253172279694378, + "velocityY": 0.8578116049670796, + "timestamp": 14.027436979522525 }, { - "x": 4.568310353233329, + "x": 4.5683103532333265, "y": 4.750556547471711, - "heading": -3.299590720494351, - "angularVelocity": -0.024957774635618345, - "velocityX": -0.6530786708495839, - "velocityY": 0.7975906175084967, - "timestamp": 13.797775298598228 + "heading": -3.2995907204943515, + "angularVelocity": -0.024957774635618633, + "velocityX": -0.6530786708495838, + "velocityY": 0.797590617508499, + "timestamp": 14.055846172565143 }, { - "x": 4.551738077215872, + "x": 4.55173807721587, "y": 4.771422795168187, - "heading": -3.3002345377586937, - "angularVelocity": -0.02266228623167014, - "velocityX": -0.5833420186414909, - "velocityY": 0.7344892783534258, - "timestamp": 13.826184491640847 + "heading": -3.300234537758694, + "angularVelocity": -0.022662286231670405, + "velocityX": -0.5833420186414907, + "velocityY": 0.7344892783534279, + "timestamp": 14.084255365607762 }, { - "x": 4.537078722172511, - "y": 4.790423737866177, - "heading": -3.300813134716119, - "angularVelocity": -0.020366539681611593, - "velocityX": -0.5160074424278739, - "velocityY": 0.6688307784556118, - "timestamp": 13.854593684683465 + "x": 4.5370787221725095, + "y": 4.790423737866178, + "heading": -3.3008131347161194, + "angularVelocity": -0.02036653968161184, + "velocityX": -0.5160074424278736, + "velocityY": 0.6688307784556137, + "timestamp": 14.11266455865038 }, { - "x": 4.524267137631748, - "y": 4.80749481595678, - "heading": -3.3013265802364233, - "angularVelocity": -0.01807321733970101, - "velocityX": -0.45096615456637523, - "velocityY": 0.6008997884943068, - "timestamp": 13.883002877726083 + "x": 4.524267137631747, + "y": 4.8074948159567805, + "heading": -3.3013265802364242, + "angularVelocity": -0.01807321733970122, + "velocityX": -0.45096615456637484, + "velocityY": 0.6008997884943085, + "timestamp": 14.141073751692998 }, { - "x": 4.513241379782428, - "y": 4.822578569091268, - "heading": -3.3017750053386177, - "angularVelocity": -0.015784506850350242, - "velocityX": -0.38810528101876257, - "velocityY": 0.5309462015292464, - "timestamp": 13.911412070768701 + "x": 4.513241379782426, + "y": 4.822578569091269, + "heading": -3.3017750053386186, + "angularVelocity": -0.015784506850350405, + "velocityX": -0.38810528101876224, + "velocityY": 0.5309462015292479, + "timestamp": 14.169482944735616 }, { - "x": 4.503942727769095, - "y": 4.835623757202515, - "heading": -3.3021585909145483, - "angularVelocity": -0.01350216373111781, - "velocityX": -0.3273113741521155, - "velocityY": 0.4591889706855446, - "timestamp": 13.93982126381132 + "x": 4.503942727769094, + "y": 4.835623757202516, + "heading": -3.3021585909145488, + "angularVelocity": -0.01350216373111798, + "velocityX": -0.32731137415211514, + "velocityY": 0.4591889706855459, + "timestamp": 14.197892137778235 }, { "x": 4.496315630351404, - "y": 4.846584586473705, - "heading": -3.3024775571832854, - "angularVelocity": -0.011227572295302874, - "velocityX": -0.2684728639158713, - "velocityY": 0.38581980328508136, - "timestamp": 13.968230456853938 + "y": 4.846584586473706, + "heading": -3.302477557183286, + "angularVelocity": -0.011227572295303039, + "velocityX": -0.26847286391587094, + "velocityY": 0.3858198032850825, + "timestamp": 14.226301330820853 }, { - "x": 4.490307605856895, - "y": 4.855420032462849, - "heading": -3.302732154753915, - "angularVelocity": -0.008961802267574209, - "velocityX": -0.21148170190886365, - "velocityY": 0.31100658071807374, - "timestamp": 13.996639649896556 + "x": 4.490307605856894, + "y": 4.85542003246285, + "heading": -3.3027321547539152, + "angularVelocity": -0.008961802267574346, + "velocityX": -0.2114817019088633, + "velocityY": 0.31100658071807463, + "timestamp": 14.254710523863471 }, { "x": 4.485869112477555, "y": 4.862093250897569, - "heading": -3.302922657135222, - "angularVelocity": -0.006705659714491805, - "velocityX": -0.15623440527439328, - "velocityY": 0.23489644442589466, - "timestamp": 14.025048842939174 + "heading": -3.3029226571352224, + "angularVelocity": -0.006705659714491917, + "velocityX": -0.15623440527439303, + "velocityY": 0.23489644442589536, + "timestamp": 14.28311971690609 }, { - "x": 4.482953401340074, + "x": 4.482953401340073, "y": 4.866571066222462, "heading": -3.303049354516641, - "angularVelocity": -0.00445973179275778, - "velocityX": -0.10263266306467411, - "velocityY": 0.15761853278180735, - "timestamp": 14.053458035981793 + "angularVelocity": -0.004459731792757826, + "velocityX": -0.10263266306467393, + "velocityY": 0.1576185327818078, + "timestamp": 14.311528909948708 }, { "x": 4.481516361236572, "y": 4.868823528289795, "heading": -3.3031125486467343, - "angularVelocity": -0.0022244253822551407, - "velocityX": -0.05058362979002091, - "velocityY": 0.0792863797276602, - "timestamp": 14.081867229024411 + "angularVelocity": -0.0022244253822551953, + "velocityX": -0.05058362979002082, + "velocityY": 0.07928637972766044, + "timestamp": 14.339938102991326 }, { "x": 4.481516361236572, "y": 4.868823528289795, "heading": -3.3031125486467343, - "angularVelocity": 1.1943565858737654e-24, - "velocityX": 6.201298415005488e-22, - "velocityY": 3.4466920783127177e-22, - "timestamp": 14.11027642206703 + "angularVelocity": 6.851173296886301e-29, + "velocityX": 4.467353937750162e-26, + "velocityY": -9.136715174907558e-29, + "timestamp": 14.368347296033944 } ], "eventMarkers": [ @@ -2487,7 +2487,7 @@ } }, { - "timestamp": 4.400488551747936, + "timestamp": 4.4589863415393385, "command": { "type": "named", "data": { @@ -2496,7 +2496,7 @@ } }, { - "timestamp": 9.117943160027963, + "timestamp": 9.25436328972116, "command": { "type": "parallel", "data": { @@ -2518,7 +2518,7 @@ } }, { - "timestamp": 10.561979780547953, + "timestamp": 10.809677531131124, "command": { "type": "named", "data": { @@ -2527,7 +2527,7 @@ } }, { - "timestamp": 12.890189202418592, + "timestamp": 13.148260076385506, "command": { "type": "named", "data": { @@ -2536,7 +2536,7 @@ } }, { - "timestamp": 14.11027642206703, + "timestamp": 14.368347296033944, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid B.1.traj b/Robot/src/main/deploy/choreo/Amp Side Mid B.1.traj index f85cd5d..dbaaa1d 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid B.1.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid B.1.traj @@ -4,451 +4,451 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": -1.3142297964035998e-23, - "velocityX": -1.083334582387026e-25, - "velocityY": -1.729816221225227e-24, + "angularVelocity": 2.0073542459851034e-22, + "velocityX": -1.4065326746107527e-21, + "velocityY": 7.40941788413694e-21, "timestamp": 0 }, { - "x": 2.60563777379529, - "y": 6.860019205441317, - "heading": -2.6716613236727724, - "angularVelocity": -0.022626919855620722, - "velocityX": 0.2908135076824555, - "velocityY": 0.0479031153248186, - "timestamp": 0.08905023460256821 - }, - { - "x": 2.657431788653954, - "y": 6.868550780384309, - "heading": -2.67569142112441, - "angularVelocity": -0.04525644957168479, - "velocityX": 0.5816269332677375, - "velocityY": 0.09580631630078756, - "timestamp": 0.17810046920513642 - }, - { - "x": 2.7351228017521323, - "y": 6.881348160715041, - "heading": -2.6817361560116657, - "angularVelocity": -0.06788005572622516, - "velocityX": 0.8724402967034719, - "velocityY": 0.14370967564371354, - "timestamp": 0.2671507038077046 - }, - { - "x": 2.838710809214557, - "y": 6.898411367068251, - "heading": -2.6897942738643654, - "angularVelocity": -0.09048957466157903, - "velocityX": 1.1632536166214305, - "velocityY": 0.1916132667068573, - "timestamp": 0.35620093841027284 - }, - { - "x": 2.968195808655137, - "y": 6.919740426657641, - "heading": -2.6998638401165413, - "angularVelocity": -0.11307736916265679, - "velocityX": 1.4540669097445138, - "velocityY": 0.23951716336943402, - "timestamp": 0.44525117301284106 - }, - { - "x": 3.123577798954381, - "y": 6.945335373287028, - "heading": -2.71194230142554, - "angularVelocity": -0.13563649060448887, - "velocityX": 1.7448801902961197, - "velocityY": 0.28742143963592753, - "timestamp": 0.5343014076154092 - }, - { - "x": 3.3048567799851756, - "y": 6.97519624728381, - "heading": -2.7260265619744923, - "angularVelocity": -0.15816084720955956, - "velocityX": 2.03569346942031, - "velocityY": 0.3353261687636266, - "timestamp": 0.6233516422179775 - }, - { - "x": 3.5120327522893717, - "y": 7.009323095281852, - "heading": -2.7421130753282568, - "angularVelocity": -0.18064537870741343, - "velocityX": 2.3265067546292677, - "velocityY": 0.3832314215717832, - "timestamp": 0.7124018768205457 - }, - { - "x": 3.745105716710612, - "y": 7.047715969716023, - "heading": -2.760197952403387, - "angularVelocity": -0.20308623728890646, - "velocityX": 2.6173200493120152, - "velocityY": 0.4311372632033863, - "timestamp": 0.8014521114231139 - }, - { - "x": 4.004075673995758, - "y": 7.090374927737104, - "heading": -2.7802770860662163, - "angularVelocity": -0.22548097433367448, - "velocityX": 2.908133352381726, - "velocityY": 0.47904374661636356, - "timestamp": 0.8905023460256821 - }, - { - "x": 4.28894262439546, - "y": 7.137300028836777, - "heading": -2.802346292800393, - "angularVelocity": -0.24782873209342446, - "velocityX": 3.1989466582661503, - "velocityY": 0.5269508980981372, - "timestamp": 0.9795525806282503 - }, - { - "x": 4.599706567353759, - "y": 7.188491329079206, - "heading": -2.8264014718479453, - "angularVelocity": -0.2701304399130545, - "velocityX": 3.489759957907361, - "velocityY": 0.5748586791589742, - "timestamp": 1.0686028152308185 - }, - { - "x": 4.936367501640731, - "y": 7.243948863571903, - "heading": -2.852438782605804, - "angularVelocity": -0.2923890192323865, - "velocityX": 3.7805732437369977, - "velocityY": 0.622766854463723, - "timestamp": 1.1576530498333866 - }, - { - "x": 5.298925428386942, - "y": 7.303672558707409, - "heading": -2.8804548458325563, - "angularVelocity": -0.3146096509659767, - "velocityX": 4.071386542262457, - "velocityY": 0.6706742031848971, - "timestamp": 1.2467032844359547 - }, - { - "x": 5.654193668021497, - "y": 7.340978019061845, - "heading": -2.91016580268315, - "angularVelocity": -0.3336426566779271, - "velocityX": 3.9895261502692283, - "velocityY": 0.41892601991372086, - "timestamp": 1.3357535190385228 - }, - { - "x": 5.98356504904068, - "y": 7.374016419687497, - "heading": -2.9379024670232585, - "angularVelocity": -0.3114721085676808, - "velocityX": 3.6987143547590864, - "velocityY": 0.37100857480165716, - "timestamp": 1.424803753641091 - }, - { - "x": 6.287039535369109, - "y": 7.402787834546961, - "heading": -2.9636656250656035, - "angularVelocity": -0.28931038932492203, - "velocityX": 3.4079021541362304, - "velocityY": 0.3230919602612063, - "timestamp": 1.513853988243659 - }, - { - "x": 6.564617124869861, - "y": 7.427292232732608, - "heading": -2.9874553284002965, - "angularVelocity": -0.26714924941935103, - "velocityX": 3.1170899295165584, - "velocityY": 0.2751749986399128, - "timestamp": 1.6029042228462271 - }, - { - "x": 6.816297824187459, - "y": 7.447529562819999, - "heading": -3.0092710593771144, - "angularVelocity": -0.24498229650019018, - "velocityX": 2.826277779512324, - "velocityY": 0.22725745954191853, - "timestamp": 1.6919544574487952 - }, - { - "x": 7.04208164327297, - "y": 7.4634997697510155, - "heading": -3.02911189018705, - "angularVelocity": -0.2228049246415303, - "velocityX": 2.5354657412547588, - "velocityY": 0.17933930216233074, - "timestamp": 1.7810046920513634 - }, - { - "x": 7.241968593239377, - "y": 7.475202800425809, - "heading": -3.046976628874181, - "angularVelocity": -0.20061416757475567, - "velocityX": 2.244653827791738, - "velocityY": 0.13142054849179688, - "timestamp": 1.8700549266539315 - }, - { - "x": 7.415958685210493, - "y": 7.482638606042888, - "heading": -3.062863950895082, - "angularVelocity": -0.17840853639303908, - "velocityX": 1.9538420392448632, - "velocityY": 0.08350124679924598, - "timestamp": 1.9591051612564996 - }, - { - "x": 7.56405192957815, - "y": 7.485807143207224, - "heading": -3.076772515723161, - "angularVelocity": -0.15618785161154392, - "velocityX": 1.6630303673942974, - "velocityY": 0.03558145779712713, - "timestamp": 2.0481553958590677 - }, - { - "x": 7.686248335471436, - "y": 7.484708374487247, - "heading": -3.0887010683171225, - "angularVelocity": -0.13395307319737726, - "velocityX": 1.372218798059888, - "velocityY": -0.012338751547152475, - "timestamp": 2.137205630461636 - }, - { - "x": 7.782547910358369, - "y": 7.479342268698847, - "heading": -3.098648525443845, - "angularVelocity": -0.11170613049048228, - "velocityX": 1.0814073125884323, - "velocityY": -0.06025931107703978, - "timestamp": 2.2262558650642044 - }, - { - "x": 7.852950659742851, - "y": 7.469708801046972, - "heading": -3.1066140469464796, - "angularVelocity": -0.08944975314421699, - "velocityX": 0.7905958889237127, - "velocityY": -0.10818014904588184, - "timestamp": 2.3153060996667727 - }, - { - "x": 7.897456586937546, - "y": 7.455807953193105, - "heading": -3.112597092103137, - "angularVelocity": -0.06718730369841065, - "velocityX": 0.49978450245892037, - "velocityY": -0.15610119294919206, - "timestamp": 2.404356334269341 + "x": 2.6056377595645173, + "y": 6.860019235347418, + "heading": -2.67166131940215, + "angularVelocity": -0.02262687664626412, + "velocityX": 0.2908134089016077, + "velocityY": 0.047903461211106606, + "timestamp": 0.08905021591596585 + }, + { + "x": 2.657431745912738, + "y": 6.868550871260021, + "heading": -2.675691408253123, + "angularVelocity": -0.04525636248626211, + "velocityX": 0.5816267351569059, + "velocityY": 0.09580702107060358, + "timestamp": 0.1781004318319317 + }, + { + "x": 2.7351227161637226, + "y": 6.881348344974158, + "heading": -2.681736130145307, + "angularVelocity": -0.06787992404070672, + "velocityX": 0.8724399986216745, + "velocityY": 0.14371075446030462, + "timestamp": 0.26715064774789754 + }, + { + "x": 2.838710666374723, + "y": 6.8984116787203495, + "heading": -2.689794230536387, + "angularVelocity": -0.09048939756287813, + "velocityX": 1.1632532178108679, + "velocityY": 0.1916147374902733, + "timestamp": 0.3562008636638634 + }, + { + "x": 2.9681955940786513, + "y": 6.919740901627221, + "heading": -2.699863774776327, + "angularVelocity": -0.11307714570217953, + "velocityX": 1.4540664092956235, + "velocityY": 0.23951904762364568, + "timestamp": 0.44525107957982923 + }, + { + "x": 3.123577498057011, + "y": 6.945336049839059, + "heading": -2.711942209420258, + "angularVelocity": -0.13563621962836306, + "velocityX": 1.7448795870971157, + "velocityY": 0.28742376364356087, + "timestamp": 0.5343012954957951 + }, + { + "x": 3.304856378058939, + "y": 6.975197166608854, + "heading": -2.726026438521239, + "angularVelocity": -0.1581605272498332, + "velocityX": 2.03569276208152, + "velocityY": 0.33532896537807844, + "timestamp": 0.6233515114117609 + }, + { + "x": 3.5120322344672066, + "y": 7.009324302331978, + "heading": -2.7421129154703023, + "angularVelocity": -0.18064500780373027, + "velocityX": 2.3265059413642897, + "velocityY": 0.38323473303342476, + "timestamp": 0.7124017273277268 + }, + { + "x": 3.7451050679134177, + "y": 7.0477175144586885, + "heading": -2.76019775093863, + "angularVelocity": -0.20308581267668144, + "velocityX": 2.6173191277397354, + "velocityY": 0.4311411458332731, + "timestamp": 0.8014519432436926 + }, + { + "x": 4.00407487884772, + "y": 7.090376867161408, + "heading": -2.7802768374227536, + "angularVelocity": -0.22548049185048172, + "velocityX": 2.908132319170181, + "velocityY": 0.4790482792649808, + "timestamp": 0.8905021591596585 + }, + { + "x": 4.288941667076001, + "y": 7.137302430464445, + "heading": -2.8023459907991892, + "angularVelocity": -0.24782818491155156, + "velocityX": 3.198945508420786, + "velocityY": 0.5269561990430291, + "timestamp": 0.9795523750756243 + }, + { + "x": 4.599705431301729, + "y": 7.18849427798667, + "heading": -2.826401109181455, + "angularVelocity": -0.2701298153500949, + "velocityX": 3.489758683111868, + "velocityY": 0.5748649455329105, + "timestamp": 1.0686025909915902 + }, + { + "x": 4.936366168815881, + "y": 7.243952479945757, + "heading": -2.852438349388676, + "angularVelocity": -0.29238828833150965, + "velocityX": 3.780571827381631, + "velocityY": 0.6227744805405371, + "timestamp": 1.157652806907556 + }, + { + "x": 5.29892387632096, + "y": 7.303677068067654, + "heading": -2.8804543230674837, + "angularVelocity": -0.31460871139544083, + "velocityX": 4.071384934621773, + "velocityY": 0.6706843718184372, + "timestamp": 1.2467030228235219 + }, + { + "x": 5.654192271473913, + "y": 7.340981844659183, + "heading": -2.910165358807353, + "angularVelocity": -0.3336436125871517, + "velocityX": 3.989528733857416, + "velocityY": 0.4189184294256161, + "timestamp": 1.3357532387394877 + }, + { + "x": 5.983563762603575, + "y": 7.374019749618405, + "heading": -2.937902079473165, + "angularVelocity": -0.3114728064442547, + "velocityX": 3.6987163674087062, + "velocityY": 0.3710030865101999, + "timestamp": 1.4248034546554535 + }, + { + "x": 6.2870383431109875, + "y": 7.4027907556301225, + "heading": -2.963665283121415, + "angularVelocity": -0.2893109621717427, + "velocityX": 3.407903926856203, + "velocityY": 0.32308743685547753, + "timestamp": 1.5138536705714194 + }, + { + "x": 6.564616020686646, + "y": 7.427294798001087, + "heading": -2.987455025630518, + "angularVelocity": -0.26714974539255987, + "velocityX": 3.117091572665025, + "velocityY": 0.27517106072025793, + "timestamp": 1.6029038864873852 + }, + { + "x": 6.816296806889978, + "y": 7.447531808401904, + "heading": -3.0092707916128694, + "angularVelocity": -0.24498274100692155, + "velocityX": 2.826279348281832, + "velocityY": 0.22725391727196229, + "timestamp": 1.691954102403351 + }, + { + "x": 7.042080714621744, + "y": 7.463501721624949, + "heading": -3.029111654665684, + "angularVelocity": -0.2228053334709305, + "velocityX": 2.535467268769251, + "velocityY": 0.17933604156686803, + "timestamp": 1.781004318319317 + }, + { + "x": 7.241967756961874, + "y": 7.475204477800177, + "heading": -3.046976423792443, + "angularVelocity": -0.20061455149774496, + "velocityX": 2.2446553361393184, + "velocityY": 0.1314174935440077, + "timestamp": 1.8700545342352828 + }, + { + "x": 7.415957946439473, + "y": 7.482640023287821, + "heading": -3.0628637751453267, + "angularVelocity": -0.17840890321789282, + "velocityX": 1.9538435442064368, + "velocityY": 0.08349834316698324, + "timestamp": 1.9591047501512486 + }, + { + "x": 7.564051294500569, + "y": 7.4858083110625495, + "heading": -3.0767723687242916, + "angularVelocity": -0.1561882072480332, + "velocityX": 1.6630318808080886, + "velocityY": 0.03557866471337611, + "timestamp": 2.0481549660672145 + }, + { + "x": 7.686247811094335, + "y": 7.4847093008681505, + "heading": -3.0887009498997005, + "angularVelocity": -0.13395342226531132, + "velocityX": 1.3722203291351878, + "velocityY": -0.012341465802140981, + "timestamp": 2.1372051819831803 + }, + { + "x": 7.78254750434497, + "y": 7.479342959260061, + "heading": -3.0986484357684994, + "angularVelocity": -0.11170647669384857, + "velocityX": 1.0814088686939272, + "velocityY": -0.06026197188730624, + "timestamp": 2.226255397899146 + }, + { + "x": 7.852950380293331, + "y": 7.469709259593279, + "heading": -3.1066139864439575, + "angularVelocity": -0.08945009951436005, + "velocityX": 0.7905974760891972, + "velocityY": -0.1081827771857946, + "timestamp": 2.315305613815112 + }, + { + "x": 7.897456442699593, + "y": 7.455808181987322, + "heading": -3.1125970614290615, + "angularVelocity": -0.06718765275931286, + "velocityX": 0.4997861257098042, + "velocityY": -0.15610380573444393, + "timestamp": 2.404355829731078 }, { "x": 7.916065692901611, "y": 7.4376397132873535, "heading": -3.116597461241803, - "angularVelocity": -0.0449226120124177, - "velocityX": 0.20897312676510937, - "velocityY": -0.2040223699222923, - "timestamp": 2.4934065688719094 - }, - { - "x": 7.9070122603589, - "y": 7.413826617664512, - "heading": -3.11861194216317, - "angularVelocity": -0.021520720211200346, - "velocityX": -0.09671791211130092, - "velocityY": -0.2543955432022431, - "timestamp": 2.5870131443766944 - }, - { - "x": 7.869344140213553, - "y": 7.385298267689194, - "heading": -3.1184352062412737, - "angularVelocity": 0.001888071654618472, - "velocityX": -0.4024089113635186, - "velocityY": -0.30476865349977356, - "timestamp": 2.6806197198814794 - }, - { - "x": 7.803061333004561, - "y": 7.352054678768873, - "heading": -3.1160670574506257, - "angularVelocity": 0.02529895766272299, - "velocityX": -0.7080999048576825, - "velocityY": -0.35514159919910054, - "timestamp": 2.7742262953862644 - }, - { - "x": 7.70816383608335, - "y": 7.314095876394929, - "heading": -3.111507734132627, - "angularVelocity": 0.048707297467210565, - "velocityX": -1.0137909266465996, - "velocityY": -0.4055142725737741, - "timestamp": 2.8678328708910494 - }, - { - "x": 7.584651643628721, - "y": 7.27142189709441, - "heading": -3.1047578739730084, - "angularVelocity": 0.07210882486854506, - "velocityX": -1.3194820106234444, - "velocityY": -0.455886555729595, - "timestamp": 2.9614394463958345 - }, - { - "x": 7.432524746664207, - "y": 7.224032790103509, - "heading": -3.0958184592506823, - "angularVelocity": 0.09549985857424112, - "velocityX": -1.6251731904959823, - "velocityY": -0.5062583128946773, - "timestamp": 3.0550460219006195 - }, - { - "x": 7.251783133001236, - "y": 7.171928620622399, - "heading": -3.0846907420606215, - "angularVelocity": 0.1188775161365886, - "velocityX": -1.9308645005791376, - "velocityY": -0.5566293735256479, - "timestamp": 3.1486525974054045 - }, - { - "x": 7.042426786875021, - "y": 7.115109477241975, - "heading": -3.0713761490336036, - "angularVelocity": 0.14223993298780116, - "velocityX": -2.236555979077694, - "velocityY": -0.6069994877391849, - "timestamp": 3.2422591729101895 - }, - { - "x": 6.804455687334457, - "y": 7.053575493929542, - "heading": -3.055876164351336, - "angularVelocity": 0.1655864943107016, - "velocityX": -2.542247681397121, - "velocityY": -0.6573681707786417, - "timestamp": 3.3358657484149745 - }, - { - "x": 6.537869798801013, - "y": 6.987326959347451, - "heading": -3.038192183929703, - "angularVelocity": 0.1889181430499978, - "velocityX": -2.8479397638023447, - "velocityY": -0.707733770035256, - "timestamp": 3.4294723239197595 - }, - { - "x": 6.251721942644649, - "y": 6.9401796162992495, - "heading": -3.0163639344951743, - "angularVelocity": 0.23319141114624786, - "velocityX": -3.0569204632609908, - "velocityY": -0.5036755462311673, - "timestamp": 3.5230788994245446 - }, - { - "x": 5.994188767247977, - "y": 6.8977475214878226, - "heading": -2.9967176405118674, - "angularVelocity": 0.20988155882599013, - "velocityX": -2.7512295371120445, - "velocityY": -0.45330250126774246, - "timestamp": 3.6166854749293296 - }, - { - "x": 5.765270336012349, - "y": 6.860030391062932, - "heading": -2.9792531096003043, - "angularVelocity": 0.18657376169764953, - "velocityX": -2.445537933645764, - "velocityY": -0.4029324886793023, - "timestamp": 3.7102920504341146 - }, - { - "x": 5.564966675703843, - "y": 6.827028091962186, - "heading": -2.9639704856474203, - "angularVelocity": 0.16326442742372366, - "velocityX": -2.139846044237206, - "velocityY": -0.35256389759777007, - "timestamp": 3.8038986259388996 - }, - { - "x": 5.393277802457308, - "y": 6.798740535430808, - "heading": -2.950870120937211, - "angularVelocity": 0.13995132969627333, - "velocityX": -1.8341539824599005, - "velocityY": -0.3021962546843907, - "timestamp": 3.8975052014436846 - }, - { - "x": 5.25020372728784, - "y": 6.7751676557798355, - "heading": -2.9399524598545517, - "angularVelocity": 0.11663348460067259, - "velocityX": -1.5284618030082089, - "velocityY": -0.25182931352687526, - "timestamp": 3.9911117769484696 - }, - { - "x": 5.135744458132628, - "y": 6.756309403324118, - "heading": -2.9312179411027137, - "angularVelocity": 0.09331095283356157, - "velocityX": -1.222769538763453, - "velocityY": -0.2014629031563385, - "timestamp": 4.084718352453255 - }, - { - "x": 5.049900000853324, - "y": 6.7421657413579945, - "heading": -2.9246669194518846, - "angularVelocity": 0.06998463105291268, - "velocityX": -0.9170772118985947, - "velocityY": -0.15109688491276213, - "timestamp": 4.17832492795804 - }, - { - "x": 4.9926703598055795, - "y": 6.732736644639159, - "heading": -2.920299607236711, - "angularVelocity": 0.04665604089907658, - "velocityX": -0.611384838502273, - "velocityY": -0.10073113633298339, - "timestamp": 4.271931503462826 + "angularVelocity": -0.044922965897315335, + "velocityX": 0.20897479035401717, + "velocityY": -0.2040249820069297, + "timestamp": 2.4934060456470437 + }, + { + "x": 7.907012409900235, + "y": 7.413826367530878, + "heading": -3.118611975460086, + "angularVelocity": -0.021521073293795764, + "velocityX": -0.09671630274627309, + "velocityY": -0.25439818430889266, + "timestamp": 2.587012632585414 + }, + { + "x": 7.86934443098964, + "y": 7.385297761212543, + "heading": -3.1184352727405407, + "angularVelocity": 0.001887716722986529, + "velocityX": -0.40240735339912476, + "velocityY": -0.3047713547885194, + "timestamp": 2.680619219523784 + }, + { + "x": 7.803061757039115, + "y": 7.35205390609398, + "heading": -3.116067157372098, + "angularVelocity": 0.025298597522861684, + "velocityX": -0.7080983947653753, + "velocityY": -0.3551443996184828, + "timestamp": 2.7742258064621543 + }, + { + "x": 7.708164385824663, + "y": 7.314094822979375, + "heading": -3.1115078681064587, + "angularVelocity": 0.04870692773619732, + "velocityX": -1.013789459890593, + "velocityY": -0.4055172221971618, + "timestamp": 2.8678323934005245 + }, + { + "x": 7.58465231209105, + "y": 7.27142054214674, + "heading": -3.1047580431849022, + "angularVelocity": 0.07210843961227054, + "velocityX": -1.3194805811575352, + "velocityY": -0.45588972131559213, + "timestamp": 2.9614389803388947 + }, + { + "x": 7.432525527653926, + "y": 7.22403110408453, + "heading": -3.0958186656762385, + "angularVelocity": 0.09549944935552229, + "velocityX": -1.6251717898579308, + "velocityY": -0.5062617878954225, + "timestamp": 3.055045567277265 + }, + { + "x": 7.251784021512525, + "y": 7.171926560872903, + "heading": -3.084690988878398, + "angularVelocity": 0.11887707010583433, + "velocityX": -1.9308631160796352, + "velocityY": -0.5566332981025642, + "timestamp": 3.148652154215635 + }, + { + "x": 7.042427779881054, + "y": 7.115106979238847, + "heading": -3.0713764414563793, + "angularVelocity": 0.1422394284152768, + "velocityX": -2.2365545895750922, + "velocityY": -0.6070040954646013, + "timestamp": 3.2422587411540054 + }, + { + "x": 6.804456785765002, + "y": 7.053572449427596, + "heading": -3.0558765117150686, + "angularVelocity": 0.16558588715040146, + "velocityX": -2.5422462446230534, + "velocityY": -0.6573739287360777, + "timestamp": 3.3358653280923756 + }, + { + "x": 6.537871015451157, + "y": 6.9873231289516795, + "heading": -3.0381926080821193, + "angularVelocity": 0.18891729964038087, + "velocityX": -2.847938152999453, + "velocityY": -0.7077420792997633, + "timestamp": 3.4294719150307458 + }, + { + "x": 6.251722869935082, + "y": 6.940176766797846, + "heading": -3.016364253674107, + "angularVelocity": 0.2331925040957211, + "velocityX": -3.056923181105537, + "velocityY": -0.5036650058064269, + "timestamp": 3.523078501969116 + }, + { + "x": 5.994189477499942, + "y": 6.897745373710483, + "heading": -2.9967178827416228, + "angularVelocity": 0.20988235523872914, + "velocityX": -2.7512315196867543, + "velocityY": -0.45329494937470055, + "timestamp": 3.616685088907486 + }, + { + "x": 5.765270870867694, + "y": 6.860028793884023, + "heading": -2.9792532906117453, + "angularVelocity": 0.1865743929043863, + "velocityX": -2.4455395086989586, + "velocityY": -0.4029265574151002, + "timestamp": 3.7102916758458564 + }, + { + "x": 5.564967066578637, + "y": 6.82702693693722, + "heading": -2.9639706170320186, + "angularVelocity": 0.16326493764576847, + "velocityX": -2.1398473210110196, + "velocityY": -0.3525591309993538, + "timestamp": 3.8038982627842266 + }, + { + "x": 5.393278075654954, + "y": 6.798739735455754, + "heading": -2.9508702121951718, + "angularVelocity": 0.13995174127513232, + "velocityX": -1.8341550155730215, + "velocityY": -0.302192424771196, + "timestamp": 3.897504849722597 + }, + { + "x": 5.250203906044256, + "y": 6.775167136554944, + "heading": -2.93995251921741, + "angularVelocity": 0.11663381109013397, + "velocityX": -1.528462625230599, + "velocityY": -0.2518262835107166, + "timestamp": 3.991111436660967 + }, + { + "x": 5.135744563638823, + "y": 6.756309099085823, + "heading": -2.931217975945437, + "angularVelocity": 0.09331120338490016, + "velocityX": -1.2227701719409092, + "velocityY": -0.20146058184490315, + "timestamp": 4.084718023599337 + }, + { + "x": 5.049900052839723, + "y": 6.742165592440054, + "heading": -2.9246669365280717, + "angularVelocity": 0.06998481230470345, + "velocityX": -0.9170776716345898, + "velocityY": -0.15109520716830446, + "timestamp": 4.178324610537707 + }, + { + "x": 4.992670376907219, + "y": 6.732736595948361, + "heading": -2.920299612824834, + "angularVelocity": 0.04665615792735934, + "velocityX": -0.611385136498824, + "velocityY": -0.10073005330169253, + "timestamp": 4.271931197476078 }, { "x": 4.96405553817749, - "y": 6.72802209854126, + "y": 6.7280220985412615, "heading": -2.918116035624805, - "angularVelocity": 0.023327117781321904, - "velocityX": -0.3056924310475032, - "velocityY": -0.05036554400665612, - "timestamp": 4.365538078967611 + "angularVelocity": 0.023327174629992398, + "velocityX": -0.3056925764056323, + "velocityY": -0.050365017690535835, + "timestamp": 4.365537784414448 }, { "x": 4.96405553817749, "y": 6.72802209854126, "heading": -2.918116035624805, - "angularVelocity": -2.0830291131761767e-23, - "velocityX": 2.6212070093081157e-24, - "velocityY": -2.6876451865538873e-24, - "timestamp": 4.4591446544723965 + "angularVelocity": 3.6338397195938546e-22, + "velocityX": -9.963230040673339e-21, + "velocityY": 1.3095690489139607e-20, + "timestamp": 4.459144371352818 } ], "eventMarkers": [ @@ -462,7 +462,7 @@ } }, { - "timestamp": 4.4591446544723965, + "timestamp": 4.459144371352818, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid B.2.traj b/Robot/src/main/deploy/choreo/Amp Side Mid B.2.traj index 8a8f181..23e51f3 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid B.2.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid B.2.traj @@ -4,397 +4,397 @@ "x": 4.96405553817749, "y": 6.72802209854126, "heading": -2.918116035624805, - "angularVelocity": -2.0830291131761767e-23, - "velocityX": 2.6212070093081157e-24, - "velocityY": -2.6876451865538873e-24, + "angularVelocity": 3.6338397195938546e-22, + "velocityX": -9.963230040673339e-21, + "velocityY": 1.3095690489139607e-20, "timestamp": 0 }, { - "x": 4.986997583079801, - "y": 6.722441944983784, - "heading": -2.922362708096326, - "angularVelocity": -0.05025246479823011, - "velocityX": 0.2714818040675807, - "velocityY": -0.066032045583043, - "timestamp": 0.08450674983948137 - }, - { - "x": 5.03288163642963, - "y": 6.71128171901416, - "heading": -2.930855942511296, - "angularVelocity": -0.10050362167640607, - "velocityX": 0.5429631767519619, - "velocityY": -0.1320631309430564, - "timestamp": 0.16901349967896273 - }, - { - "x": 5.10170770842542, - "y": 6.6945415441964125, - "heading": -2.943591386818814, - "angularVelocity": -0.15070327910739376, - "velocityX": 0.8144446701183498, - "velocityY": -0.19809275412371863, - "timestamp": 0.2535202495184441 - }, - { - "x": 5.193475855215092, - "y": 6.672221590667123, - "heading": -2.960560694021866, - "angularVelocity": -0.2008041633985957, - "velocityX": 1.085926827904073, - "velocityY": -0.26412036401454975, - "timestamp": 0.33802699935792546 - }, - { - "x": 5.308186177471799, - "y": 6.644322080265296, - "heading": -2.9817518825127913, - "angularVelocity": -0.25076326484189676, - "velocityX": 1.357410176992917, - "velocityY": -0.3301453488013894, - "timestamp": 0.4225337491974068 - }, - { - "x": 5.445838818125752, - "y": 6.610843292401228, - "heading": -3.0071498190197725, - "angularVelocity": -0.30054328861568913, - "velocityX": 1.6288952174284352, - "velocityY": -0.39616702722160885, - "timestamp": 0.5070404990368882 - }, - { - "x": 5.606433959098464, - "y": 6.57178557034531, - "heading": -3.0367368331942495, - "angularVelocity": -0.35011421254132336, - "velocityX": 1.900382410609302, - "velocityY": -0.4621846435948283, - "timestamp": 0.5915472488763696 - }, - { - "x": 5.789971816830474, - "y": 6.527149327506201, - "heading": -3.0704934720227905, - "angularVelocity": -0.39945494167815665, - "velocityX": 2.1718721650120956, - "velocityY": -0.5281973679486492, - "timestamp": 0.6760539987158509 - }, - { - "x": 5.996452636226433, - "y": 6.4769350530448095, - "heading": -3.1083994003520443, - "angularVelocity": -0.4485550373343583, - "velocityX": 2.4433648174632614, - "velocityY": -0.594204303878351, - "timestamp": 0.7605607485553323 - }, - { - "x": 6.225876681885466, - "y": 6.4211433153733735, - "heading": -3.1504344509882194, - "angularVelocity": -0.49741648703824837, - "velocityX": 2.714860601014919, - "velocityY": -0.6602045135733137, - "timestamp": 0.8450674983948137 - }, - { - "x": 6.478244219380954, - "y": 6.359774756070596, - "heading": -3.196579824919509, - "angularVelocity": -0.5460554809993506, - "velocityX": 2.986359527195811, - "velocityY": -0.7261971312273402, - "timestamp": 0.929574248234295 - }, - { - "x": 6.717226111669154, - "y": 6.290548853732578, - "heading": -3.2412304050575518, - "angularVelocity": -0.5283670265730883, - "velocityX": 2.827962177484511, - "velocityY": -0.8191760122062468, - "timestamp": 1.0140809980737764 - }, - { - "x": 6.9332640071159375, - "y": 6.226898382507029, - "heading": -3.2817950563873817, - "angularVelocity": -0.48001670170585536, - "velocityX": 2.556457275390921, - "velocityY": -0.7531998490824867, - "timestamp": 1.0985877479132578 - }, - { - "x": 7.126357713200994, - "y": 6.168822797384324, - "heading": -3.3182799458605974, - "angularVelocity": -0.4317393526850495, - "velocityX": 2.2849500951324253, - "velocityY": -0.6872301352615873, - "timestamp": 1.1830944977527391 - }, - { - "x": 7.296507081212939, - "y": 6.11632159040044, - "heading": -3.3506880436311652, - "angularVelocity": -0.38349715060780704, - "velocityX": 2.01344115511647, - "velocityY": -0.6212664323691197, - "timestamp": 1.2676012475922205 - }, - { - "x": 7.443711995436663, - "y": 6.069394309199431, - "heading": -3.3790200360258207, - "angularVelocity": -0.335263070091698, - "velocityX": 1.7419308458003326, - "velocityY": -0.5553080823738457, - "timestamp": 1.3521079974317018 - }, - { - "x": 7.567972366619772, - "y": 6.028040562856848, - "heading": -3.403275131384317, - "angularVelocity": -0.28701962156358174, - "velocityX": 1.4704194803271609, - "velocityY": -0.4893543583339052, - "timestamp": 1.4366147472711832 - }, - { - "x": 7.669288126709092, - "y": 5.99226002475378, - "heading": -3.4234517524693158, - "angularVelocity": -0.23875750899571357, - "velocityX": 1.19890730955535, - "velocityY": -0.4234044992977654, - "timestamp": 1.5211214971106646 - }, - { - "x": 7.747659224496879, - "y": 5.962052434133843, - "heading": -3.4395481122242697, - "angularVelocity": -0.19047424951886965, - "velocityX": 0.9273945328231248, - "velocityY": -0.35745772588955055, - "timestamp": 1.605628246950146 - }, - { - "x": 7.803085622131263, - "y": 5.937417596916517, - "heading": -3.451562671479707, - "angularVelocity": -0.14217277647357823, - "velocityX": 0.6558813081755649, - "velocityY": -0.2915132491087263, - "timestamp": 1.6901349967896273 - }, - { - "x": 7.8355672925031605, - "y": 5.918355386069609, - "heading": -3.4594944783408175, - "angularVelocity": -0.09386003930072535, - "velocityX": 0.3843677627360551, - "velocityY": -0.22557027554740033, - "timestamp": 1.7746417466291087 + "x": 4.986997583245362, + "y": 6.722441950535387, + "heading": -2.922362707394502, + "angularVelocity": -0.05025245955837001, + "velocityX": 0.27148182258542464, + "velocityY": -0.0660319839163844, + "timestamp": 0.08450674468509956 + }, + { + "x": 5.032881637159744, + "y": 6.711281735897458, + "heading": -2.930855940399974, + "angularVelocity": -0.10050361112738114, + "velocityX": 0.5429632165499002, + "velocityY": -0.1320630049058865, + "timestamp": 0.1690134893701991 + }, + { + "x": 5.101707710404414, + "y": 6.694541578470798, + "heading": -2.9435913825821065, + "angularVelocity": -0.15070326314886817, + "velocityX": 0.8144447345728314, + "velocityY": -0.19809256041088907, + "timestamp": 0.25352023405529867 + }, + { + "x": 5.193475859483997, + "y": 6.672221648741145, + "heading": -2.960560686931331, + "angularVelocity": -0.20080414187598672, + "velocityX": 1.085926921236194, + "velocityY": -0.26412009849420676, + "timestamp": 0.3380269787403982 + }, + { + "x": 5.308186185530338, + "y": 6.644322168996456, + "heading": -2.981751871819718, + "angularVelocity": -0.2507632375066888, + "velocityX": 1.3574103046306019, + "velocityY": -0.33014500616077025, + "timestamp": 0.4225337234254978 + }, + { + "x": 5.445838832085338, + "y": 6.610843419245657, + "heading": -3.007149803941405, + "angularVelocity": -0.30054325505412216, + "velocityX": 1.6288953866101499, + "velocityY": -0.39616660037671664, + "timestamp": 0.5070404681105973 + }, + { + "x": 5.606433981927045, + "y": 6.571785743597236, + "heading": -3.0367368128883587, + "angularVelocity": -0.3501141720368616, + "velocityX": 1.900382631470881, + "velocityY": -0.4621841226278734, + "timestamp": 0.5915472127956969 + }, + { + "x": 5.7899718527810915, + "y": 6.5271495567170055, + "heading": -3.070493445537436, + "angularVelocity": -0.3994548929184966, + "velocityX": 2.1718724527606685, + "velocityY": -0.5281967379829884, + "timestamp": 0.6760539574807964 + }, + { + "x": 5.9964526916944845, + "y": 6.4769353498610895, + "heading": -3.1083993665141816, + "angularVelocity": -0.44855497768841657, + "velocityX": 2.4433651974503454, + "velocityY": -0.5942035401201552, + "timestamp": 0.760560702165896 + }, + { + "x": 6.225876767552239, + "y": 6.421143695632008, + "heading": -3.1504344081002755, + "angularVelocity": -0.4974164102845375, + "velocityX": 2.7148611239572196, + "velocityY": -0.6602035664369802, + "timestamp": 0.8450674468509956 + }, + { + "x": 6.478244358788941, + "y": 6.3597752481787015, + "heading": -3.1965797694640314, + "angularVelocity": -0.5460553655889756, + "velocityX": 2.9863603452849636, + "velocityY": -0.7261958519640731, + "timestamp": 0.9295741915360951 + }, + { + "x": 6.717226250105241, + "y": 6.290549248101248, + "heading": -3.2412303594046183, + "angularVelocity": -0.5283671747973506, + "velocityX": 2.8279623384716492, + "velocityY": -0.8191772187582416, + "timestamp": 1.0140809362211947 + }, + { + "x": 6.933264135550156, + "y": 6.226898710086972, + "heading": -3.2817950179595727, + "angularVelocity": -0.48001681648147876, + "velocityX": 2.55645731296296, + "velocityY": -0.7532006853590326, + "timestamp": 1.0985876809062942 + }, + { + "x": 7.126357828217531, + "y": 6.168823072058602, + "heading": -3.3182799133581264, + "angularVelocity": -0.4317394491351963, + "velocityX": 2.2849500757236236, + "velocityY": -0.687230803230894, + "timestamp": 1.1830944255913938 + }, + { + "x": 7.296507181265965, + "y": 6.11632182036056, + "heading": -3.350688016235842, + "angularVelocity": -0.3834972344335215, + "velocityX": 2.0134411008549487, + "velocityY": -0.6212669993818719, + "timestamp": 1.2676011702764933 + }, + { + "x": 7.443712079914637, + "y": 6.069394499789823, + "heading": -3.379020013186295, + "angularVelocity": -0.3352631444511035, + "velocityX": 1.7419307677417626, + "velocityY": -0.555308582120924, + "timestamp": 1.3521079149615929 + }, + { + "x": 7.567972435471327, + "y": 6.02804071771291, + "heading": -3.4032751127228216, + "angularVelocity": -0.28701968851017895, + "velocityX": 1.4704193851002774, + "velocityY": -0.4893548110391755, + "timestamp": 1.4366146596466924 + }, + { + "x": 7.669288180256081, + "y": 5.992260146371071, + "heading": -3.42345173773138, + "angularVelocity": -0.23875756998738332, + "velocityX": 1.1989072015765272, + "velocityY": -0.4234049184496486, + "timestamp": 1.521121404331792 + }, + { + "x": 7.747659263327591, + "y": 5.962052524193432, + "heading": -3.43954810124812, + "angularVelocity": -0.19047430565122664, + "velocityX": 0.9273944152451641, + "velocityY": -0.35745812112634723, + "timestamp": 1.6056281490168915 + }, + { + "x": 7.803085647033718, + "y": 5.937417656488415, + "heading": -3.4515626641762043, + "angularVelocity": -0.14217282860503722, + "velocityX": 0.6558811833619133, + "velocityY": -0.2915136276614969, + "timestamp": 1.690134893701991 + }, + { + "x": 7.835567304420652, + "y": 5.918355415748436, + "heading": -3.4594944746796688, + "angularVelocity": -0.09386008812694666, + "velocityX": 0.3843676325241542, + "velocityY": -0.22557064304169885, + "timestamp": 1.7746416383870907 }, { "x": 7.845104217529297, "y": 5.904865741729736, "heading": -3.463343389598174, - "angularVelocity": -0.045545607477119734, - "velocityX": 0.11285400331040635, - "velocityY": -0.15962801037190835, - "timestamp": 1.85914849646859 - }, - { - "x": 7.8291877801389544, - "y": 5.89681783094167, - "heading": -3.4628064836752768, - "angularVelocity": 0.005958713094771777, - "velocityX": -0.17664451043527943, - "velocityY": -0.08931767997576301, - "timestamp": 1.9492528385232752 - }, - { - "x": 7.787186304810707, - "y": 5.895105277075071, - "heading": -3.457628506155186, - "angularVelocity": 0.057466459462613945, - "velocityX": -0.46614263386726634, - "velocityY": -0.019006341176760165, - "timestamp": 2.0393571805779604 - }, - { - "x": 7.719099838437265, - "y": 5.899728258305112, - "heading": -3.447810162739233, - "angularVelocity": 0.10896637378467465, - "velocityX": -0.7556402368724836, - "velocityY": 0.05130697505382519, - "timestamp": 2.1294615226326457 - }, - { - "x": 7.624928441800051, - "y": 5.91068704023302, - "heading": -3.4333528605757375, - "angularVelocity": 0.1604506712309276, - "velocityX": -1.0451371653106436, - "velocityY": 0.12162323899170813, - "timestamp": 2.219565864687331 - }, - { - "x": 7.5046721930394265, - "y": 5.927981975640617, - "heading": -3.414258222079659, - "angularVelocity": 0.21191696271962407, - "velocityX": -1.33463322652798, - "velocityY": 0.19194341818843927, - "timestamp": 2.309670206742016 - }, - { - "x": 7.358331192400225, - "y": 5.951613503654499, - "heading": -3.390527425061893, - "angularVelocity": 0.2633701825752592, - "velocityX": -1.624128175203652, - "velocityY": 0.2622684709194017, - "timestamp": 2.3997745487967013 - }, - { - "x": 7.185905568247333, - "y": 5.981582148055597, - "heading": -3.362160369786068, - "angularVelocity": 0.3148245093295144, - "velocityX": -1.9136216992544741, - "velocityY": 0.3325993366991085, - "timestamp": 2.4898788908513865 - }, - { - "x": 6.987395484481389, - "y": 6.017888514545585, - "heading": -3.329154675551666, - "angularVelocity": 0.36630525767970984, - "velocityX": -2.203113404295966, - "velocityY": 0.40293692470396786, - "timestamp": 2.5799832329060717 - }, - { - "x": 6.762801150184142, - "y": 6.060533287389062, - "heading": -3.2915045124971307, - "angularVelocity": 0.41785070725765294, - "velocityX": -2.492602788897109, - "velocityY": 0.4732821068444771, - "timestamp": 2.670087574960757 - }, - { - "x": 6.512122838133032, - "y": 6.109517231240644, - "heading": -3.249199278174355, - "angularVelocity": 0.46951382539479003, - "velocityX": -2.782089146147601, - "velocityY": 0.5436357753087322, - "timestamp": 2.760191917015442 - }, - { - "x": 6.25129761637582, - "y": 6.172940412685561, - "heading": -3.2015674065543736, - "angularVelocity": 0.5286301473803918, - "velocityX": -2.894702028886867, - "velocityY": 0.7038859615269768, - "timestamp": 2.8502962590701273 - }, - { - "x": 6.016555766986995, - "y": 6.230022996704365, - "heading": -3.158627751039872, - "angularVelocity": 0.47655478676534, - "velocityX": -2.605222390352269, - "velocityY": 0.6335164623271993, - "timestamp": 2.9404006011248125 - }, - { - "x": 5.807896998539899, - "y": 6.280764356863859, - "heading": -3.1204019441225426, - "angularVelocity": 0.4242393434728108, - "velocityX": -2.3157459861419394, - "velocityY": 0.5631400108187857, - "timestamp": 3.0305049431794977 - }, - { - "x": 5.625321043377808, - "y": 6.325163981104701, - "heading": -3.086911147615034, - "angularVelocity": 0.3716890412138256, - "velocityX": -2.026272552451302, - "velocityY": 0.4927578763506812, - "timestamp": 3.120609285234183 - }, - { - "x": 5.468827670291274, - "y": 6.363221451462664, - "heading": -3.058174826591968, - "angularVelocity": 0.31892271080150636, - "velocityX": -1.7368016847795997, - "velocityY": 0.4223711032134899, - "timestamp": 3.210713627288868 - }, - { - "x": 5.3384166918215215, - "y": 6.394936434094527, - "heading": -3.0342097293079573, - "angularVelocity": 0.265970504168003, - "velocityX": -1.4473328975711837, - "velocityY": 0.3519806250026743, - "timestamp": 3.3008179693435533 - }, - { - "x": 5.234087969458135, - "y": 6.420308671366275, - "heading": -3.015029066317057, - "angularVelocity": 0.21287168357835284, - "velocityX": -1.1578656475852087, - "velocityY": 0.28158728750661927, - "timestamp": 3.3909223113982385 - }, - { - "x": 5.155841417331177, - "y": 6.439337975209735, - "heading": -3.0006418789192395, - "angularVelocity": 0.15967252043287483, - "velocityX": -0.868399350604752, - "velocityY": 0.2111918627840607, - "timestamp": 3.4810266534529237 - }, - { - "x": 5.103677004654206, - "y": 6.452024221800112, - "heading": -2.9910525860956274, - "angularVelocity": 0.10642431435537862, - "velocityX": -0.5789333952997849, - "velocityY": 0.14079506382364523, - "timestamp": 3.571130995507609 + "angularVelocity": -0.04554565357886152, + "velocityX": 0.11285386916963824, + "velocityY": -0.15962837130890287, + "timestamp": 1.8591483830721902 + }, + { + "x": 7.8291877692828695, + "y": 5.896817799174314, + "heading": -3.462806487691953, + "angularVelocity": 0.0059586689373453934, + "velocityX": -0.1766446433882992, + "velocityY": -0.08931803884268785, + "timestamp": 1.949252718766311 + }, + { + "x": 7.787186284773775, + "y": 5.89510521302273, + "heading": -3.457628514345887, + "angularVelocity": 0.05746641719488619, + "velocityX": -0.46614276866407134, + "velocityY": -0.019006700825120525, + "timestamp": 2.0393570544604316 + }, + { + "x": 7.719099810553242, + "y": 5.899728161129094, + "heading": -3.4478101752719477, + "angularVelocity": 0.10896633328799875, + "velocityX": -0.7556403773029171, + "velocityY": 0.05130661106095279, + "timestamp": 2.1294613901545523 + }, + { + "x": 7.624928406963597, + "y": 5.91068690868204, + "heading": -3.4333528776383364, + "angularVelocity": 0.1604506322835518, + "velocityX": -1.0451373162478272, + "velocityY": 0.12162286607548435, + "timestamp": 2.219565725848673 + }, + { + "x": 7.504672151559691, + "y": 5.927981807913597, + "heading": -3.414258243895334, + "angularVelocity": 0.21191692492827224, + "velocityX": -1.3346333944699587, + "velocityY": 0.191943030247383, + "timestamp": 2.3096700615427936 + }, + { + "x": 7.3583311437665895, + "y": 5.951613297181171, + "heading": -3.3905274519162645, + "angularVelocity": 0.26337014524616154, + "velocityX": -1.624128369248404, + "velocityY": 0.2622680594172169, + "timestamp": 2.3997743972369143 + }, + { + "x": 7.185905510719418, + "y": 5.981581899112768, + "heading": -3.362160402078623, + "angularVelocity": 0.3148244711990307, + "velocityX": -1.9136219330500257, + "velocityY": 0.3325988888407347, + "timestamp": 2.489878732931035 + }, + { + "x": 6.987395414269062, + "y": 6.017888217489993, + "heading": -3.329154713906164, + "angularVelocity": 0.36630521626067764, + "velocityX": -2.20311370059087, + "velocityY": 0.4029364191804939, + "timestamp": 2.5799830686251557 + }, + { + "x": 6.762801059397413, + "y": 6.060532932740197, + "heading": -3.2915045580545983, + "angularVelocity": 0.41785065681387246, + "velocityX": -2.4926031931924566, + "velocityY": 0.47328150106972355, + "timestamp": 2.6700874043192764 + }, + { + "x": 6.512122706581224, + "y": 6.109516798013917, + "heading": -3.2491993338195644, + "angularVelocity": 0.4695137465820559, + "velocityX": -2.7820897949591883, + "velocityY": 0.543634941608216, + "timestamp": 2.760191740013397 + }, + { + "x": 6.25129749629379, + "y": 6.172940093448783, + "heading": -3.201567448489117, + "angularVelocity": 0.5286303368590953, + "velocityX": -2.8947021059326685, + "velocityY": 0.7038872763034365, + "timestamp": 2.8502960757075178 + }, + { + "x": 6.016555665157353, + "y": 6.230022757637012, + "heading": -3.1586277825948064, + "angularVelocity": 0.47655493560353174, + "velocityX": -2.6052223716883294, + "velocityY": 0.6335173967877574, + "timestamp": 2.9404004114016384 + }, + { + "x": 5.807896916135595, + "y": 6.280764180000153, + "heading": -3.120401967413272, + "angularVelocity": 0.4242394651385117, + "velocityX": -2.3157459340258364, + "velocityY": 0.5631407409227794, + "timestamp": 3.030504747095759 + }, + { + "x": 5.6253209797030115, + "y": 6.3251638537635975, + "heading": -3.0869111642773346, + "angularVelocity": 0.37168914101569395, + "velocityX": -2.0262724876234564, + "velocityY": 0.4927584607489893, + "timestamp": 3.12060908278988 + }, + { + "x": 5.46882762371635, + "y": 6.363221363605436, + "heading": -3.0581748379825484, + "angularVelocity": 0.31892279182145133, + "velocityX": -1.7368016176037657, + "velocityY": 0.42237157123085867, + "timestamp": 3.2107134184840005 + }, + { + "x": 5.3384166601569225, + "y": 6.394936377267829, + "heading": -3.0342097365921425, + "angularVelocity": 0.26597056851693435, + "velocityX": -1.447332834261574, + "velocityY": 0.35198099423379936, + "timestamp": 3.300817754178121 + }, + { + "x": 5.234087950141294, + "y": 6.420308638173686, + "heading": -3.0150290705159977, + "angularVelocity": 0.21287173284599614, + "velocityX": -1.1578655922817724, + "velocityY": 0.28158756968132703, + "timestamp": 3.390922089872242 + }, + { + "x": 5.155841407533289, + "y": 6.4393379590097926, + "heading": -3.000641880938431, + "angularVelocity": 0.15967255589572538, + "velocityX": -0.8683993062623739, + "velocityY": 0.21119206628086706, + "timestamp": 3.4810264255663625 + }, + { + "x": 5.103677001346942, + "y": 6.452024216517568, + "heading": -2.9910525867433884, + "angularVelocity": 0.10642433708846369, + "velocityX": -0.5789333641327775, + "velocityY": 0.14079519492648973, + "timestamp": 3.5711307612604832 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 0.053181525635302096, - "velocityX": -0.289467155293118, - "velocityY": 0.07039756101124235, - "timestamp": 3.661235337562294 + "angularVelocity": 0.05318153657845512, + "velocityX": -0.289467139022103, + "velocityY": 0.07039762460765545, + "timestamp": 3.661235096954603 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 6.81746033497351e-25, - "velocityX": -7.666580770428612e-26, - "velocityY": 6.421082950062295e-25, - "timestamp": 3.7513396796169793 + "angularVelocity": 4.933852135685226e-24, + "velocityX": 6.910665862954014e-23, + "velocityY": -2.160330311328782e-22, + "timestamp": 3.751339432648723 } ], "eventMarkers": [ @@ -408,7 +408,7 @@ } }, { - "timestamp": 3.7513396796169793, + "timestamp": 3.751339432648723, "command": { "type": "parallel", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid B.3.traj b/Robot/src/main/deploy/choreo/Amp Side Mid B.3.traj index 09a8c0f..20cdc43 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid B.3.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid B.3.traj @@ -4,604 +4,604 @@ "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 6.81746033497351e-25, - "velocityX": -7.666580770428612e-26, - "velocityY": 6.421082950062295e-25, + "angularVelocity": 4.933852135685226e-24, + "velocityX": 6.910665862954014e-23, + "velocityY": -2.160330311328782e-22, "timestamp": 0 }, { - "x": 5.080107751173253, - "y": 6.458664255646832, - "heading": -2.986987410743646, - "angularVelocity": -0.02623921538488642, - "velocityX": 0.09073619501676995, - "velocityY": 0.010720397580949911, - "timestamp": 0.02769560805046467 - }, - { - "x": 5.085138525244606, - "y": 6.459212635742286, - "heading": -2.9884477760132566, - "angularVelocity": -0.052729128277294895, - "velocityX": 0.18164519306403581, - "velocityY": 0.01980025477160606, - "timestamp": 0.05539121610092934 - }, - { - "x": 5.092691297903225, - "y": 6.4599637486298365, - "heading": -2.9906490360498172, - "angularVelocity": -0.07948047331365586, - "velocityX": 0.27270651161935916, - "velocityY": 0.02712028875412729, - "timestamp": 0.08308682415139401 - }, - { - "x": 5.1027695509630275, - "y": 6.46086523800989, - "heading": -2.99359872097621, - "angularVelocity": -0.10650370705051675, - "velocityX": 0.36389354736097906, - "velocityY": 0.032549903884080994, - "timestamp": 0.11078243220185868 - }, - { - "x": 5.115375820999888, - "y": 6.46186078752559, - "heading": -2.9973046369071197, - "angularVelocity": -0.133808794670882, - "velocityX": 0.4551721707604345, - "velocityY": 0.035946115134430356, - "timestamp": 0.13847804025232335 - }, - { - "x": 5.130511443380374, - "y": 6.462889747097652, - "heading": -3.0017748444548444, - "angularVelocity": -0.1614049252711666, - "velocityX": 0.5464990099840698, - "velocityY": 0.03715244562195929, - "timestamp": 0.16617364830278802 - }, - { - "x": 5.148176238439689, - "y": 6.4638867292256625, - "heading": -3.0070176268610034, - "angularVelocity": -0.18930013728551406, - "velocityX": 0.6378193620854306, - "velocityY": 0.03599784219196293, - "timestamp": 0.1938692563532527 - }, - { - "x": 5.1683681275776605, - "y": 6.464781177655068, - "heading": -3.0130414446609124, - "angularVelocity": -0.21750083222338853, - "velocityX": 0.7290646625696118, - "velocityY": 0.03229567763146106, - "timestamp": 0.22156486440371737 - }, - { - "x": 5.191082665034589, - "y": 6.46549691365525, - "heading": -3.0198548730944523, - "angularVelocity": -0.24601115170048243, - "velocityX": 0.8201494408622356, - "velocityY": 0.02584294227727148, - "timestamp": 0.24926047245418204 - }, - { - "x": 5.216312469195933, - "y": 6.46595166928297, - "heading": -3.0274665177164044, - "angularVelocity": -0.2748321902910632, - "velocityX": 0.9109676926165635, - "velocityY": 0.016419774098878303, - "timestamp": 0.2769560805046467 - }, - { - "x": 5.244046535806501, - "y": 6.466056622814985, - "heading": -3.0358849028723838, - "angularVelocity": -0.3039610157913839, - "velocityX": 1.0013886158423948, - "velocityY": 0.0037895370206108333, - "timestamp": 0.3046516885551114 - }, - { - "x": 5.274269415037942, - "y": 6.465715959448529, - "heading": -3.0451183269591553, - "angularVelocity": -0.33338946990971013, - "velocityX": 1.0912516950835975, - "velocityY": -0.012300266736711637, - "timestamp": 0.33234729660557605 - }, - { - "x": 5.306960235866464, - "y": 6.4648264907503386, - "heading": -3.05517467776126, - "angularVelocity": -0.36310272674933947, - "velocityX": 1.18036118827779, - "velocityY": -0.0321158754330219, - "timestamp": 0.3600429046560407 - }, - { - "x": 5.3420915660214945, - "y": 6.463277379304427, - "heading": -3.0660612007183974, - "angularVelocity": -0.3930775932884671, - "velocityX": 1.2684801897476814, - "velocityY": -0.05593346941828854, - "timestamp": 0.3877385127065054 - }, - { - "x": 5.379628105658185, - "y": 6.460950030133952, - "heading": -3.0777842127338517, - "angularVelocity": -0.42328054304110213, - "velocityX": 1.3553246265001357, - "velocityY": -0.08403314945225146, - "timestamp": 0.41543412075697006 - }, - { - "x": 5.41952523001788, - "y": 6.457718226299439, - "heading": -3.0903487539619023, - "angularVelocity": -0.4536654766761787, - "velocityX": 1.440557805663538, - "velocityY": -0.11669012027553252, - "timestamp": 0.44312972880743473 - }, - { - "x": 5.461727422684295, - "y": 6.453448599535394, - "heading": -3.1037581696728, - "angularVelocity": -0.48417119734160885, - "velocityX": 1.5237864642480061, - "velocityY": -0.1541625934431737, - "timestamp": 0.4708253368578994 - }, - { - "x": 5.506166677536889, - "y": 6.448001532672273, - "heading": -3.1180136136798957, - "angularVelocity": -0.51471857852411, - "velocityX": 1.6045596389008698, - "velocityY": -0.19667619693330898, - "timestamp": 0.49852094490836407 - }, - { - "x": 5.5527609923492784, - "y": 6.441232581553373, - "heading": -3.133113464661269, - "angularVelocity": -0.5452074189474115, - "velocityX": 1.68237197491708, - "velocityY": -0.24440521784415084, - "timestamp": 0.5262165529588287 - }, - { - "x": 5.60141312366844, - "y": 6.432994471961219, - "heading": -3.1490526497734637, - "angularVelocity": -0.5755130951864894, - "velocityX": 1.75667316025385, - "velocityY": -0.29745184063635494, - "timestamp": 0.5539121610092934 - }, - { - "x": 5.652009808542854, - "y": 6.423139665806347, - "heading": -3.1658218818373203, - "angularVelocity": -0.6054834410315529, - "velocityX": 1.8268847819560778, - "velocityY": -0.35582559288520166, - "timestamp": 0.5816077690597581 - }, - { - "x": 5.704421666252762, - "y": 6.411523401958046, - "heading": -3.183406843958928, - "angularVelocity": -0.6349368495382306, - "velocityX": 1.8924248788619584, - "velocityY": -0.419426207474268, - "timestamp": 0.6093033771102228 - }, - { - "x": 5.758503955194236, - "y": 6.398007014259739, - "heading": -3.201787400905252, - "angularVelocity": -0.6636632390533842, - "velocityX": 1.9527388184772771, - "velocityY": -0.4880336143434415, - "timestamp": 0.6369989851606874 - }, - { - "x": 5.8140982688799205, - "y": 6.382461238924243, - "heading": -3.220936968623995, - "angularVelocity": -0.6914297632985671, - "velocityX": 2.0073332054810007, - "velocityY": -0.5613083239468838, - "timestamp": 0.6646945932111521 - }, - { - "x": 5.871035121611879, - "y": 6.364769177707707, - "heading": -3.2408222043743016, - "angularVelocity": -0.7179923876043237, - "velocityX": 2.055808004944776, - "velocityY": -0.6388038559868158, - "timestamp": 0.6923902012616168 + "x": 5.080107750922132, + "y": 6.4586642554977765, + "heading": -2.986987410677254, + "angularVelocity": -0.026239217300952723, + "velocityX": 0.09073620086499802, + "velocityY": 0.010720393961257955, + "timestamp": 0.0276956034978042 + }, + { + "x": 5.085138524507197, + "y": 6.4592126353095916, + "heading": -2.988447775816188, + "angularVelocity": -0.05272913222670491, + "velocityX": 0.18164520536494946, + "velocityY": 0.01980024778510464, + "timestamp": 0.0553912069956084 + }, + { + "x": 5.092691296461665, + "y": 6.459963747794391, + "heading": -2.990649035659873, + "angularVelocity": -0.07948047941471853, + "velocityX": 0.2727065310227512, + "velocityY": 0.0271202786702021, + "timestamp": 0.0830868104934126 + }, + { + "x": 5.102769548618277, + "y": 6.460865236669119, + "heading": -2.993598720333269, + "angularVelocity": -0.10650371542289774, + "velocityX": 0.36389357456721133, + "velocityY": 0.03254989098898449, + "timestamp": 0.1107824139912168 + }, + { + "x": 5.115375817573453, + "y": 6.461860785594569, + "heading": -2.997304635953141, + "angularVelocity": -0.1338088054360665, + "velocityX": 0.4551722065263811, + "velocityY": 0.03594609973127802, + "timestamp": 0.138478017489021 + }, + { + "x": 5.130511438716252, + "y": 6.4628897445102735, + "heading": -3.0017748431338958, + "angularVelocity": -0.16140493855312305, + "velocityX": 0.5464990551298429, + "velocityY": 0.03715242803017215, + "timestamp": 0.1661736209868252 + }, + { + "x": 5.148176232406587, + "y": 6.4638867259358275, + "heading": -3.007017625119319, + "angularVelocity": -0.18930015321164578, + "velocityX": 0.6378194175019449, + "velocityY": 0.035997822745898966, + "timestamp": 0.1938692244846294 + }, + { + "x": 5.1683681200714915, + "y": 6.4647811736378795, + "heading": -3.013041442446997, + "angularVelocity": -0.21750085092589103, + "velocityX": 0.7290647292270105, + "velocityY": 0.03229565667788419, + "timestamp": 0.2215648279824336 + }, + { + "x": 5.191082655981316, + "y": 6.465496908908166, + "heading": -3.019854870359249, + "angularVelocity": -0.24601117331826733, + "velocityX": 0.8201495198191305, + "velocityY": 0.02584292017118624, + "timestamp": 0.2492604314802378 + }, + { + "x": 5.2163124585547775, + "y": 6.4659516638268535, + "heading": -3.02746651441355, + "angularVelocity": -0.27483221497246374, + "velocityX": 0.9109677850299317, + "velocityY": 0.016419751197107906, + "timestamp": 0.276956034978042 + }, + { + "x": 5.244046523573541, + "y": 6.4660566166949724, + "heading": -3.035884898958586, + "angularVelocity": -0.3039610436979258, + "velocityX": 1.0013887229777827, + "velocityY": 0.003789513672319083, + "timestamp": 0.3046516384758462 + }, + { + "x": 5.274269401250127, + "y": 6.465715952734587, + "heading": -3.045118322394742, + "angularVelocity": -0.3333895012213158, + "velocityX": 1.091251818324991, + "velocityY": -0.012300290203546045, + "timestamp": 0.3323472419736504 + }, + { + "x": 5.30696022060602, + "y": 6.464826483537375, + "heading": -3.0551746725109514, + "angularVelocity": -0.3631027616714286, + "velocityX": 1.1803613291360742, + "velocityY": -0.03211589873034425, + "timestamp": 0.3600428454714546 + }, + { + "x": 5.3420915494206636, + "y": 6.463277371711745, + "heading": -3.0660611947523826, + "angularVelocity": -0.39307763206150964, + "velocityX": 1.268480349865999, + "velocityY": -0.05593349232317884, + "timestamp": 0.3877384489692588 + }, + { + "x": 5.379628087904175, + "y": 6.460950022303807, + "heading": -3.077784206029261, + "angularVelocity": -0.4232805859532344, + "velocityX": 1.355324807653638, + "velocityY": -0.08403317183976639, + "timestamp": 0.415434052467063 + }, + { + "x": 5.419525211357798, + "y": 6.4577182183944455, + "heading": -3.0903487465047883, + "angularVelocity": -0.4536655240794423, + "velocityX": 1.4405580097500568, + "velocityY": -0.11669014215987741, + "timestamp": 0.4431296559648672 + }, + { + "x": 5.4617274034297, + "y": 6.453448591734476, + "heading": -3.103758161460742, + "angularVelocity": -0.48417124967206376, + "velocityX": 1.5237866932651936, + "velocityY": -0.15416261502686032, + "timestamp": 0.4708252594626714 + }, + { + "x": 5.506166658067458, + "y": 6.448001525164964, + "heading": -3.1180136047253373, + "angularVelocity": -0.5147186363252797, + "velocityX": 1.6045598949046982, + "velocityY": -0.1966762186621121, + "timestamp": 0.4985208629604756 + }, + { + "x": 5.552760973114925, + "y": 6.441232574532317, + "heading": -3.13311345499563, + "angularVelocity": -0.5452074828949123, + "velocityX": 1.6823722599568172, + "velocityY": -0.24440524046294754, + "timestamp": 0.5262164664582798 + }, + { + "x": 5.601413105189096, + "y": 6.432994465613015, + "heading": -3.149052639451952, + "angularVelocity": -0.5755131661090493, + "velocityX": 1.7566734762804503, + "velocityY": -0.2974518652375824, + "timestamp": 0.553912069956084 + }, + { + "x": 5.652009791405134, + "y": 6.423139660301141, + "heading": -3.1658218709441153, + "angularVelocity": -0.6054835199201767, + "velocityX": 1.8268851307049931, + "velocityY": -0.355825620938548, + "timestamp": 0.5816076734538882 + }, + { + "x": 5.704421651102894, + "y": 6.411523397438684, + "heading": -3.1834068326121203, + "angularVelocity": -0.6349369375323259, + "velocityX": 1.892425261717684, + "velocityY": -0.4194262408247933, + "timestamp": 0.6093032769516924 + }, + { + "x": 5.758503942727014, + "y": 6.398007010831586, + "heading": -3.201787389260581, + "angularVelocity": -0.6636633373928178, + "velocityX": 1.9527392363343576, + "velocityY": -0.48803365516730274, + "timestamp": 0.6369988804494966 + }, + { + "x": 5.814098259824012, + "y": 6.382461236647001, + "heading": -3.220936956876279, + "angularVelocity": -0.6914298732366274, + "velocityX": 2.0073336586222608, + "velocityY": -0.5613083746601761, + "timestamp": 0.6646944839473008 + }, + { + "x": 5.871035116712426, + "y": 6.364769176590407, + "heading": -3.2408221927556276, + "angularVelocity": -0.7179925102887033, + "velocityX": 2.055808492959182, + "velocityY": -0.6388039191129229, + "timestamp": 0.692390087445105 }, { "x": 5.929137229919434, "y": 6.3448286056518555, - "heading": -3.261403158823053, - "angularVelocity": -0.7431125690127658, - "velocityX": 2.097881664186096, - "velocityY": -0.7199904049594251, - "timestamp": 0.7200858093120814 - }, - { - "x": 6.007302079253197, - "y": 6.314544148535294, - "heading": -3.2896107940616304, - "angularVelocity": -0.7739403089677718, - "velocityX": 2.1446295349515356, - "velocityY": -0.8309226172089168, - "timestamp": 0.756532593271686 - }, - { - "x": 6.087114829660797, - "y": 6.280193048985801, - "heading": -3.3189187673686584, - "angularVelocity": -0.8041305740312225, - "velocityX": 2.189843430247822, - "velocityY": -0.9425001555025164, - "timestamp": 0.7929793772312905 - }, - { - "x": 6.168508639016323, - "y": 6.241748383978386, - "heading": -3.3493003097546983, - "angularVelocity": -0.8335863712889872, - "velocityX": 2.233223360550562, - "velocityY": -1.0548163879157417, - "timestamp": 0.8294261611908951 - }, - { - "x": 6.251402252665518, - "y": 6.199179142701848, - "heading": -3.3807240473323636, - "angularVelocity": -0.862181354944645, - "velocityX": 2.2743738855278037, - "velocityY": -1.1679834721143234, - "timestamp": 0.8658729451504996 - }, - { - "x": 6.335694920423886, - "y": 6.152449426910681, - "heading": -3.413152371425761, - "angularVelocity": -0.889744459465611, - "velocityX": 2.3127601011873846, - "velocityY": -1.2821355059190056, - "timestamp": 0.9023197291101042 - }, - { - "x": 6.421258702601704, - "y": 6.101517611306378, - "heading": -3.446538850206088, - "angularVelocity": -0.9160336016843442, - "velocityX": 2.3476360019214253, - "velocityY": -1.3974296239896904, - "timestamp": 0.9387665130697087 - }, - { - "x": 6.507926335867612, - "y": 6.046335751863277, - "heading": -3.4808239104526053, - "angularVelocity": -0.940688217773002, - "velocityX": 2.3779226546289447, - "velocityY": -1.5140391949057066, - "timestamp": 0.9752132970293133 - }, - { - "x": 6.59547117634327, - "y": 5.986850182434709, - "heading": -3.515927196529912, - "angularVelocity": -0.963138095153033, - "velocityX": 2.4019908196204427, - "velocityY": -1.6321212180065312, - "timestamp": 1.0116600809889178 - }, - { - "x": 6.683572317876966, - "y": 5.923006316810353, - "heading": -3.551733094358475, - "angularVelocity": -0.9824158386169006, - "velocityX": 2.41725419810277, - "velocityY": -1.7517009373205057, - "timestamp": 1.0481068649485223 - }, - { - "x": 6.771751179698686, - "y": 5.8547676777551505, - "heading": -3.588061329459728, - "angularVelocity": -0.9967473437853483, - "velocityX": 2.4193866300920903, - "velocityY": -1.8722814921293554, - "timestamp": 1.0845536489081269 - }, - { - "x": 6.859256922629332, - "y": 5.782183607463669, - "heading": -3.6246053528816105, - "angularVelocity": -1.002667984708512, - "velocityX": 2.4009180899921043, - "velocityY": -1.9915082321647621, - "timestamp": 1.1210004328677314 - }, - { - "x": 6.944909301097948, - "y": 5.705612424409275, - "heading": -3.66082549221537, - "angularVelocity": -0.9937814917745361, - "velocityX": 2.350066841660152, - "velocityY": -2.1009036939792307, - "timestamp": 1.157447216827336 - }, - { - "x": 7.027210040237496, - "y": 5.626208101741732, - "heading": -3.695966962162754, - "angularVelocity": -0.9641857560418463, - "velocityX": 2.258107031631849, - "velocityY": -2.178637290893834, - "timestamp": 1.1938940007869405 - }, - { - "x": 7.10523023177058, - "y": 5.5458858745426305, - "heading": -3.729586198529605, - "angularVelocity": -0.922419832820185, - "velocityX": 2.1406605208173795, - "velocityY": -2.2038220790105076, - "timestamp": 1.230340784746545 - }, - { - "x": 7.178929482816853, - "y": 5.46624650139777, - "heading": -3.761625249399457, - "angularVelocity": -0.8790638676203348, - "velocityX": 2.0221057399182083, - "velocityY": -2.1850864326775583, - "timestamp": 1.2667875687061496 - }, - { - "x": 7.248572018663502, - "y": 5.388245426263194, - "heading": -3.7921242323865507, - "angularVelocity": -0.8368086199566389, - "velocityX": 1.9108005777365134, - "velocityY": -2.1401360191623633, - "timestamp": 1.3032343526657542 - }, - { - "x": 7.314425791413534, - "y": 5.3124347260695295, - "heading": -3.8211367419380795, - "angularVelocity": -0.7960238572403343, - "velocityX": 1.8068472878984692, - "velocityY": -2.080038125659881, - "timestamp": 1.3396811366253587 - }, - { - "x": 7.376706932700329, - "y": 5.239153810976348, - "heading": -3.848710463005587, - "angularVelocity": -0.7565474390845812, - "velocityX": 1.7088240585458914, - "velocityY": -2.010627746316465, - "timestamp": 1.3761279205849632 - }, - { - "x": 7.435583508205619, - "y": 5.168626359627546, - "heading": -3.8748845295229897, - "angularVelocity": -0.7181447489691611, - "velocityX": 1.6154120915180508, - "velocityY": -1.9350802371746179, - "timestamp": 1.4125747045445678 - }, - { - "x": 7.491186989763459, - "y": 5.1010086867569635, - "heading": -3.8996906746747757, - "angularVelocity": -0.6806127305849615, - "velocityX": 1.5256073517890731, - "velocityY": -1.8552438795567412, - "timestamp": 1.4490214885041723 - }, - { - "x": 7.543621925479677, - "y": 5.036415277092429, - "heading": -3.9231548106792564, - "angularVelocity": -0.6437916725516183, - "velocityX": 1.4386711259444849, - "velocityY": -1.77226637434259, - "timestamp": 1.4854682724637769 - }, - { - "x": 7.5929729609126495, - "y": 4.9749331712566045, - "heading": -3.9452983490202, - "angularVelocity": -0.6075580870314048, - "velocityX": 1.3540573425537872, - "velocityY": -1.686900712665603, - "timestamp": 1.5219150564233814 - }, - { - "x": 7.639309796246505, - "y": 4.916630564506439, - "heading": -3.9661392022496167, - "angularVelocity": -0.5718159729131582, - "velocityX": 1.2713559414518842, - "velocityY": -1.5996639597827182, - "timestamp": 1.558361840382986 - }, - { - "x": 7.682690702150729, - "y": 4.861562214126618, - "heading": -3.985692529782674, - "angularVelocity": -0.5364897916570514, - "velocityX": 1.1902533280386327, - "velocityY": -1.5109248168743088, - "timestamp": 1.5948086243425905 - }, - { - "x": 7.723165050651695, - "y": 4.809772989497631, - "heading": -4.0039712958577836, - "angularVelocity": -0.5015193136208964, - "velocityX": 1.1105053479019453, - "velocityY": -1.4209545809690254, - "timestamp": 1.631255408302195 - }, - { - "x": 7.760775169567723, - "y": 4.761300289482094, - "heading": -4.0209866925236675, - "angularVelocity": -0.4668559147699564, - "velocityX": 1.0319187272521548, - "velocityY": -1.3299582226312006, - "timestamp": 1.6677021922617996 - }, - { - "x": 7.795557725829888, - "y": 4.716175740629966, - "heading": -4.036748465365555, - "angularVelocity": -0.432459908104854, - "velocityX": 0.9543381468366806, - "velocityY": -1.2380941183217342, - "timestamp": 1.7041489762214042 - }, - { - "x": 7.827544775062806, - "y": 4.674426422561036, - "heading": -4.051265168296167, - "angularVelocity": -0.3982985973934382, - "velocityX": 0.8776370850270793, - "velocityY": -1.1454870233599284, - "timestamp": 1.7405957601810087 - }, - { - "x": 7.856764570580477, - "y": 4.636075772943556, - "heading": -4.06454436578724, - "angularVelocity": -0.36434483508316046, - "velocityX": 0.8017112168266097, - "velocityY": -1.0522368629283385, - "timestamp": 1.7770425441406132 - }, - { - "x": 7.883242196001707, - "y": 4.601144269537644, - "heading": -4.076592795479517, - "angularVelocity": -0.33057593519446465, - "velocityX": 0.7264735744744237, - "velocityY": -0.9584248488050204, - "timestamp": 1.8134893281002178 - }, - { - "x": 7.907000066488958, - "y": 4.569649953472743, - "heading": -4.08741650039222, - "angularVelocity": -0.2969728392140157, - "velocityX": 0.6518509428317129, - "velocityY": -0.8641178354668736, - "timestamp": 1.8499361120598223 - }, - { - "x": 7.928058330680547, - "y": 4.541608837107262, - "heading": -4.097020937393002, - "angularVelocity": -0.263519464746925, - "velocityX": 0.577781134679236, - "velocityY": -0.7693714868384814, - "timestamp": 1.8863828960194269 - }, - { - "x": 7.946435196531025, - "y": 4.517035226431758, - "heading": -4.10541106680612, - "angularVelocity": -0.2302021880014778, - "velocityX": 0.504210902965987, - "velocityY": -0.6742326209835452, - "timestamp": 1.9228296799790314 - }, - { - "x": 7.9621471981139855, - "y": 4.495941979152886, - "heading": -4.11259142677868, - "angularVelocity": -0.19700942559207696, - "velocityX": 0.43109432097973954, - "velocityY": -0.5787409748484375, - "timestamp": 1.959276463938636 - }, - { - "x": 7.975209416089089, - "y": 4.47834071364718, - "heading": -4.11856619512576, - "angularVelocity": -0.16393129099408016, - "velocityX": 0.3583915110200509, - "velocityY": -0.48293055225983417, - "timestamp": 1.9957232478982405 - }, - { - "x": 7.985635661414927, - "y": 4.464241979882344, - "heading": -4.123339240724452, - "angularVelocity": -0.13095930779465687, - "velocityX": 0.2860676359646435, - "velocityY": -0.38683066743181205, - "timestamp": 2.032170031857845 - }, - { - "x": 7.993438629621695, - "y": 4.453655400537663, - "heading": -4.126914166049869, - "angularVelocity": -0.09808616665271669, - "velocityX": 0.2140920915111967, - "velocityY": -0.2904667626206573, - "timestamp": 2.0686168158174496 - }, - { - "x": 7.998630031288323, - "y": 4.446589788513624, - "heading": -4.129294342092437, - "angularVelocity": -0.06530551626189512, - "velocityX": 0.14243785329269415, - "velocityY": -0.193861055940361, - "timestamp": 2.105063599777054 + "heading": -3.2614031475973326, + "angularVelocity": -0.74311270535547, + "velocityX": 2.097882185943911, + "velocityY": -0.7199904829708007, + "timestamp": 0.7200856909429092 + }, + { + "x": 6.007302084591608, + "y": 6.314544151241208, + "heading": -3.289610783038514, + "angularVelocity": -0.7739404627397579, + "velocityX": 2.1446300921291948, + "velocityY": -0.8309227020914641, + "timestamp": 0.7565324679227903 + }, + { + "x": 6.087114841402334, + "y": 6.280193054798532, + "heading": -3.3189187570009855, + "angularVelocity": -0.8041307460094369, + "velocityX": 2.1898440252970555, + "velocityY": -0.942500250752998, + "timestamp": 0.7929792449026714 + }, + { + "x": 6.1685086583378625, + "y": 6.241748393148706, + "heading": -3.349300300529803, + "angularVelocity": -0.8335865622792533, + "velocityX": 2.233223996197488, + "velocityY": -1.0548164977948045, + "timestamp": 0.8294260218825524 + }, + { + "x": 6.2514022808693275, + "y": 6.19917915529385, + "heading": -3.3807240397738494, + "angularVelocity": -0.8621815657771995, + "velocityX": 2.274374564785891, + "velocityY": -1.1679836019068028, + "timestamp": 0.8658727988624335 + }, + { + "x": 6.335694958951068, + "y": 6.152449442751412, + "heading": -3.4131523660951144, + "angularVelocity": -0.8897446909823113, + "velocityX": 2.312760827336565, + "velocityY": -1.282135662317486, + "timestamp": 0.9023195758423146 + }, + { + "x": 6.421258753043241, + "y": 6.101517629914425, + "heading": -3.446538847703636, + "angularVelocity": -0.9160338547068533, + "velocityX": 2.3476367784017027, + "velocityY": -1.3974298156762228, + "timestamp": 0.9387663528221957 + }, + { + "x": 6.507926399966151, + "y": 6.046335772344393, + "heading": -3.480823911416441, + "angularVelocity": -0.9406884930245291, + "velocityX": 2.377923484722704, + "velocityY": -1.5140394334591976, + "timestamp": 0.9752131298020768 + }, + { + "x": 6.595471255967786, + "y": 5.98685020332471, + "heading": -3.5159272016289207, + "angularVelocity": -0.963138393056194, + "velocityX": 2.4019917056029767, + "velocityY": -1.6321215193463872, + "timestamp": 1.0116599067819578 + }, + { + "x": 6.683572414922371, + "y": 5.923006335834524, + "heading": -3.551733104267443, + "angularVelocity": -0.9824161587261235, + "velocityX": 2.417255138999483, + "velocityY": -1.7517013239724988, + "timestamp": 1.048106683761839 + }, + { + "x": 6.771751295777157, + "y": 5.854767691472866, + "heading": -3.588061344776338, + "angularVelocity": -0.996747683037885, + "velocityX": 2.4193876156309213, + "velocityY": -1.8722819962743453, + "timestamp": 1.08455346074172 + }, + { + "x": 6.85925705819262, + "y": 5.78218361088312, + "heading": -3.62460537385057, + "angularVelocity": -1.0026683318089968, + "velocityX": 2.400919084388938, + "velocityY": -1.991508896103873, + "timestamp": 1.121000237721601 + }, + { + "x": 6.944909453348972, + "y": 5.705612411431668, + "heading": -3.6608255179525564, + "angularVelocity": -0.9937818129153185, + "velocityX": 2.3500677495744626, + "velocityY": -2.1009045462022984, + "timestamp": 1.1574470147014821 + }, + { + "x": 7.027210201354827, + "y": 5.62620806893484, + "heading": -3.695966990119588, + "angularVelocity": -0.9641860015888399, + "velocityX": 2.258107707336853, + "velocityY": -2.1786382521741054, + "timestamp": 1.1938937916813632 + }, + { + "x": 7.105230393366097, + "y": 5.545885824395972, + "heading": -3.7295862270405054, + "angularVelocity": -0.922420024669837, + "velocityX": 2.140660943883689, + "velocityY": -2.203822976808266, + "timestamp": 1.2303405686612443 + }, + { + "x": 7.178929639725794, + "y": 5.466246438659954, + "heading": -3.7616252777879366, + "angularVelocity": -0.8790640326061538, + "velocityX": 2.0221059985737635, + "velocityY": -2.1850871965984764, + "timestamp": 1.2667873456411254 + }, + { + "x": 7.248572168134217, + "y": 5.388245355286236, + "heading": -3.792124260256352, + "angularVelocity": -0.8368087659781548, + "velocityX": 1.9108007395788675, + "velocityY": -2.1401366550676073, + "timestamp": 1.3032341226210065 + }, + { + "x": 7.31442593199645, + "y": 5.3124346503317215, + "heading": -3.821136769002482, + "angularVelocity": -0.7960239875845612, + "velocityX": 1.8068473900609938, + "velocityY": -2.0800386546213447, + "timestamp": 1.3396808996008875 + }, + { + "x": 7.376707063653561, + "y": 5.239153733180057, + "heading": -3.8487104890382855, + "angularVelocity": -0.7565475556597182, + "velocityX": 1.7088241215812134, + "velocityY": -2.0106281878399503, + "timestamp": 1.3761276765807686 + }, + { + "x": 7.4355836291988595, + "y": 5.168626281863128, + "heading": -3.874884554340605, + "angularVelocity": -0.7181448531585788, + "velocityX": 1.615412127601827, + "velocityY": -1.9350806068767121, + "timestamp": 1.4125744535606497 + }, + { + "x": 7.491187100722936, + "y": 5.101008610638961, + "heading": -3.8996906981294193, + "angularVelocity": -0.6806128235291476, + "velocityX": 1.525607368650723, + "velocityY": -1.8552441896712295, + "timestamp": 1.4490212305405308 + }, + { + "x": 7.543622026501356, + "y": 5.036415203861435, + "heading": -3.9231548326544954, + "angularVelocity": -0.6437917552498216, + "velocityX": 1.4386711287904919, + "velocityY": -1.7722666345280043, + "timestamp": 1.4854680075204119 + }, + { + "x": 7.592973052210523, + "y": 4.974933101854329, + "heading": -3.945298369428269, + "angularVelocity": -0.607558160382675, + "velocityX": 1.3540573350672032, + "velocityY": -1.686900930665162, + "timestamp": 1.521914784500293 + }, + { + "x": 7.639309878120076, + "y": 4.916630499631534, + "heading": -3.9661392210291537, + "angularVelocity": -0.5718160377360476, + "velocityX": 1.2713559263452057, + "velocityY": -1.5996641419069288, + "timestamp": 1.558361561480174 + }, + { + "x": 7.682690774963622, + "y": 4.861562154276881, + "heading": -3.98569254689674, + "angularVelocity": -0.5364898487012988, + "velocityX": 1.1902533073773187, + "velocityY": -1.5109249683463282, + "timestamp": 1.594808338460055 + }, + { + "x": 7.723165114817025, + "y": 4.809772935002484, + "heading": -4.003971311292077, + "angularVelocity": -0.5015193635757659, + "velocityX": 1.1105053233032058, + "velocityY": -1.4209547061729377, + "timestamp": 1.6312551154399362 + }, + { + "x": 7.760775225537743, + "y": 4.761300240527998, + "heading": -4.020986706284907, + "angularVelocity": -0.4668559582709364, + "velocityX": 1.031918700012345, + "velocityY": -1.3299583252929026, + "timestamp": 1.6677018924198173 + }, + { + "x": 7.79555777408847, + "y": 4.716175697280637, + "heading": -4.036748477480001, + "angularVelocity": -0.43245994573936725, + "velocityX": 0.9543381180159589, + "velocityY": -1.2380942016428516, + "timestamp": 1.7041486693996983 + }, + { + "x": 7.827544816119829, + "y": 4.674426384773752, + "heading": -4.051265178808281, + "angularVelocity": -0.39829862970583335, + "velocityX": 0.8776370555074606, + "velocityY": -1.1454870901185914, + "timestamp": 1.7405954463795794 + }, + { + "x": 7.856764604967555, + "y": 4.636075740582476, + "heading": -4.0645443747584675, + "angularVelocity": -0.3643448625791197, + "velocityX": 0.801711187352885, + "velocityY": -1.0522369155562157, + "timestamp": 1.7770422233594605 + }, + { + "x": 7.883242224268873, + "y": 4.601144242384833, + "heading": -4.076592802987174, + "angularVelocity": -0.3305759583449084, + "velocityX": 0.7264735456837021, + "velocityY": -0.9584248894470645, + "timestamp": 1.8134890003393416 + }, + { + "x": 7.907000089202039, + "y": 4.569649931237369, + "heading": -4.087416506528491, + "angularVelocity": -0.29697285845856597, + "velocityX": 0.6518509152752107, + "velocityY": -0.8641178660282948, + "timestamp": 1.8499357773192227 + }, + { + "x": 7.92805834841907, + "y": 4.541608819433365, + "heading": -4.097020942264019, + "angularVelocity": -0.2635194804969814, + "velocityX": 0.5777811088386537, + "velocityY": -0.7693715090221326, + "timestamp": 1.8863825542991037 + }, + { + "x": 7.946435209886507, + "y": 4.517035212904852, + "heading": -4.10541107053113, + "angularVelocity": -0.2302022006429521, + "velocityX": 0.5042108792660284, + "velocityY": -0.6742326363200164, + "timestamp": 1.9228293312789848 + }, + { + "x": 7.9621472076885365, + "y": 4.495941969305627, + "heading": -4.112591429489288, + "angularVelocity": -0.1970094354878312, + "velocityX": 0.4310942997978278, + "velocityY": -0.5787409847205335, + "timestamp": 1.959276108258866 + }, + { + "x": 7.975209422494241, + "y": 4.478340706964249, + "heading": -4.118566196965234, + "angularVelocity": -0.16393129848610621, + "velocityX": 0.35839149269397597, + "velocityY": -0.4829305579226738, + "timestamp": 1.995722885238747 + }, + { + "x": 7.985635665270655, + "y": 4.464241975804708, + "heading": -4.123339241847092, + "angularVelocity": -0.13095931320603413, + "velocityX": 0.28606762079865283, + "velocityY": -0.38683067002947596, + "timestamp": 2.032169662218628 + }, + { + "x": 7.993438631555588, + "y": 4.453655398466285, + "heading": -4.126914166620439, + "angularVelocity": -0.0980861702893798, + "velocityX": 0.2140920797809049, + "velocityY": -0.2904667632000886, + "timestamp": 2.068616439198509 + }, + { + "x": 7.9986300319348755, + "y": 4.446589787812739, + "heading": -4.12929434228564, + "angularVelocity": -0.06530551841424088, + "velocityX": 0.14243784524907988, + "velocityY": -0.19386105546305826, + "timestamp": 2.10506321617839 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": -0.032611781036393526, - "velocityX": 0.07108094474255332, - "velocityY": -0.09703305984719977, - "timestamp": 2.1415103837366587 + "angularVelocity": -0.0326117819807531, + "velocityX": 0.07108094061524496, + "velocityY": -0.09703305919912024, + "timestamp": 2.1415099931582713 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": 5.43498274287512e-28, - "velocityX": -9.773776117093748e-27, - "velocityY": -3.005417448336995e-26, - "timestamp": 2.1779571676962632 + "angularVelocity": 3.521072073538637e-24, + "velocityX": 1.3091800468623773e-22, + "velocityY": 4.286584514522651e-22, + "timestamp": 2.1779567701381524 } ], "eventMarkers": [ @@ -628,7 +628,7 @@ } }, { - "timestamp": 1.2200858093120814, + "timestamp": 1.2200856909429092, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid B.4.traj b/Robot/src/main/deploy/choreo/Amp Side Mid B.4.traj index 9d8b48d..253342c 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid B.4.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid B.4.traj @@ -4,622 +4,622 @@ "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": 5.43498274287512e-28, - "velocityX": -9.773776117093748e-27, - "velocityY": -3.005417448336995e-26, + "angularVelocity": 3.521072073538637e-24, + "velocityX": 1.3091800468623773e-22, + "velocityY": 4.286584514522651e-22, "timestamp": 0 }, { - "x": 7.9978628064592465, - "y": 4.441693189778957, - "heading": -4.12972677682109, - "angularVelocity": 0.022841316519794305, - "velocityX": -0.1014319719694858, - "velocityY": -0.04108319939911529, - "timestamp": 0.03310491357462553 - }, - { - "x": 7.991138812092924, - "y": 4.438993628277519, - "heading": -4.128211445533363, - "angularVelocity": 0.04577360651647058, - "velocityX": -0.20311167256684373, - "velocityY": -0.081545644133843, - "timestamp": 0.06620982714925105 - }, - { - "x": 7.981040039615165, - "y": 4.434976715873705, - "heading": -4.12593384407128, - "angularVelocity": 0.06879949881000491, - "velocityX": -0.3050535823026586, - "velocityY": -0.12133885789367849, - "timestamp": 0.09931474072387658 - }, - { - "x": 7.967557291029649, - "y": 4.429666404764379, - "heading": -4.122890785038121, - "angularVelocity": 0.09192167278430328, - "velocityX": -0.40727333587877107, - "velocityY": -0.16040854773284244, - "timestamp": 0.1324196542985021 - }, - { - "x": 7.950680809544412, - "y": 4.423088668530895, - "heading": -4.119078991959019, - "angularVelocity": 0.11514281922257556, - "velocityX": -0.5097878128330726, - "velocityY": -0.1986936536975387, - "timestamp": 0.16552456787312764 - }, - { - "x": 7.930400235453064, - "y": 4.415271764180474, - "heading": -4.114495100547863, - "angularVelocity": 0.13846559063875805, - "velocityX": -0.6126152253994589, - "velocityY": -0.23612520035131226, - "timestamp": 0.19862948144775316 - }, - { - "x": 7.90670455942382, - "y": 4.406246540435963, - "heading": -4.109135662098499, - "angularVelocity": 0.16189253710883125, - "velocityX": -0.7157751968096621, - "velocityY": -0.2726248997499001, - "timestamp": 0.2317343950223787 - }, - { - "x": 7.879582073874223, - "y": 4.396046802675373, - "heading": -4.102997149666274, - "angularVelocity": 0.18542602198272123, - "velocityX": -0.8192888191191472, - "velocityY": -0.3081034402218639, - "timestamp": 0.2648393085970042 - }, - { - "x": 7.849020323685139, - "y": 4.384709747772971, - "heading": -4.096075967969171, - "angularVelocity": 0.2090681095270295, - "velocityX": -0.923178673165617, - "velocityY": -0.34245837485262026, - "timestamp": 0.29794422217162975 - }, - { - "x": 7.815006058419893, - "y": 4.372276485863039, - "heading": -4.088368468312413, - "angularVelocity": 0.23282041318080082, - "velocityX": -1.027468783102857, - "velocityY": -0.3755714958114766, - "timestamp": 0.3310491357462553 - }, - { - "x": 7.777525189659056, - "y": 4.358792671072697, - "heading": -4.079870970377267, - "angularVelocity": 0.2566838882086457, - "velocityX": -1.132184461872942, - "velocityY": -0.4073055427239372, - "timestamp": 0.3641540493208808 - }, - { - "x": 7.736562759355408, - "y": 4.3443092700230626, - "heading": -4.070579793488702, - "angularVelocity": 0.280658545373366, - "velocityX": -1.237351978319202, - "velocityY": -0.4375000411037426, - "timestamp": 0.39725896289550633 - }, - { - "x": 7.692102928777451, - "y": 4.32888350603968, - "heading": -4.060491301098684, - "angularVelocity": 0.3047430517308739, - "velocityX": -1.3429979352682966, - "velocityY": -0.46596599470377864, - "timestamp": 0.43036387647013186 - }, - { - "x": 7.644129003507531, - "y": 4.312580029465776, - "heading": -4.04960196385686, - "angularVelocity": 0.32893416916121687, - "velocityX": -1.449148180428791, - "velocityY": -0.49247905562876526, - "timestamp": 0.4634687900447574 - }, - { - "x": 7.592623519547409, - "y": 4.2954723815055775, - "heading": -4.037908449029847, - "angularVelocity": 0.35322595845640614, - "velocityX": -1.555825960518466, - "velocityY": -0.5167706576739681, - "timestamp": 0.4965737036193829 - }, - { - "x": 7.537568431341937, - "y": 4.277644842335571, - "heading": -4.025407747523989, - "angularVelocity": 0.37760864343229733, - "velocityX": -1.663048842624742, - "velocityY": -0.5385164087445838, - "timestamp": 0.5296786171940084 - }, - { - "x": 7.478945468744125, - "y": 4.259194785924933, - "heading": -4.012097354853389, - "angularVelocity": 0.4020669814043128, - "velocityX": -1.7708236109924926, - "velocityY": -0.557320784694024, - "timestamp": 0.562783530768634 - }, - { - "x": 7.41673677407285, - "y": 4.240235706322923, - "heading": -3.9979755297163337, - "angularVelocity": 0.4265779188706207, - "velocityX": -1.8791378062668793, - "velocityY": -0.5726968463238129, - "timestamp": 0.5958884443432595 - }, - { - "x": 7.350926005489431, - "y": 4.220901134197944, - "heading": -3.983041664129885, - "angularVelocity": 0.45110722167526907, - "velocityX": -1.9879456394008563, - "velocityY": -0.5840393475547041, - "timestamp": 0.628993357917885 - }, - { - "x": 7.281500221503902, - "y": 4.201349724406127, - "heading": -3.9672968128771577, - "angularVelocity": 0.47560466265031076, - "velocityX": -2.097144396073741, - "velocityY": -0.5905893621423952, - "timestamp": 0.6620982714925105 - }, - { - "x": 7.208453081280606, - "y": 4.181771846596411, - "heading": -3.950744447003366, - "angularVelocity": 0.4999972537756106, - "velocityX": -2.2065346903453893, - "velocityY": -0.591388881459637, - "timestamp": 0.6952031850671361 - }, - { - "x": 7.131790264139756, - "y": 4.162397991758564, - "heading": -3.9333915135611903, - "angularVelocity": 0.5241799953067018, - "velocityX": -2.3157534294127133, - "velocityY": -0.5852259603147614, - "timestamp": 0.7283080986417616 - }, - { - "x": 7.051538595146062, - "y": 4.143509057085501, - "heading": -3.9152498946632917, - "angularVelocity": 0.5480038139052583, - "velocityX": -2.4241618638511357, - "velocityY": -0.5705779787185788, - "timestamp": 0.7614130122163871 - }, - { - "x": 6.967761151528457, - "y": 4.125447705104888, - "heading": -3.8963383505125964, - "angularVelocity": 0.5712609431244915, - "velocityX": -2.5306649246720965, - "velocityY": -0.5455791914363196, - "timestamp": 0.7945179257910127 - }, - { - "x": 6.880581207877887, - "y": 4.108627750977044, - "heading": -3.876684983625147, - "angularVelocity": 0.5936691797471845, - "velocityX": -2.6334442303873935, - "velocityY": -0.5080802911606311, - "timestamp": 0.8276228393656382 - }, - { - "x": 6.790216608879877, - "y": 4.0935340018236515, - "heading": -3.856330118329937, - "angularVelocity": 0.6148593395154528, - "velocityX": -2.7296431025052987, - "velocityY": -0.45593682398137625, - "timestamp": 0.8607277529402637 - }, - { - "x": 6.697019199323438, - "y": 4.080699197672285, - "heading": -3.83532911718854, - "angularVelocity": 0.6343771625942055, - "velocityX": -2.8152138004031935, - "velocityY": -0.3877008807902249, - "timestamp": 0.8938326665148892 - }, - { - "x": 6.601498540052863, - "y": 4.07064612257462, - "heading": -3.813754414028283, - "angularVelocity": 0.6517069773229626, - "velocityX": -2.885392195791479, - "velocityY": -0.30367320171378936, - "timestamp": 0.9269375800895148 - }, - { - "x": 6.504298225369728, - "y": 4.0638060169193, - "heading": -3.791697257810727, - "angularVelocity": 0.666280435012615, - "velocityX": -2.93612954052959, - "velocityY": -0.2066190458374174, - "timestamp": 0.9600424936641403 - }, - { - "x": 6.406117512435041, - "y": 4.060457553922357, - "heading": -3.769268609747822, - "angularVelocity": 0.6775020877896717, - "velocityX": -2.965744426831601, - "velocityY": -0.10114700917115207, - "timestamp": 0.9931474072387658 - }, - { - "x": 6.307619626153464, - "y": 4.060722723896358, - "heading": -3.7465929512301233, - "angularVelocity": 0.6849635316698022, - "velocityX": -2.975325280929776, - "velocityY": 0.008009988408604752, - "timestamp": 1.0262523208133913 - }, - { - "x": 6.209374336917679, - "y": 4.064607085649101, - "heading": -3.7237946194075744, - "angularVelocity": 0.6886691237286258, - "velocityX": -2.9676950829163595, - "velocityY": 0.117334900874646, - "timestamp": 1.0593572343880169 - }, - { - "x": 6.111843522629519, - "y": 4.072048543608375, - "heading": -3.70098589740335, - "angularVelocity": 0.6889829799074695, - "velocityX": -2.9461129408571565, - "velocityY": 0.22478409262418045, - "timestamp": 1.0924621479626424 - }, - { - "x": 6.015391988393039, - "y": 4.082953827745876, - "heading": -3.6782618367430677, - "angularVelocity": 0.6864256150090193, - "velocityX": -2.9135111323900427, - "velocityY": 0.32941587697905805, - "timestamp": 1.125567061537268 - }, - { - "x": 5.920306236320189, - "y": 4.097220109283991, - "heading": -3.6557002049026477, - "angularVelocity": 0.68151912825755, - "velocityX": -2.872254955703382, - "velocityY": 0.43094151283481674, - "timestamp": 1.1586719751118935 - }, - { - "x": 5.826812506445201, - "y": 4.11474607261669, - "heading": -3.6333637032024773, - "angularVelocity": 0.6747186229566627, - "velocityX": -2.824164747152575, - "velocityY": 0.5294067085597899, - "timestamp": 1.191776888686519 - }, - { - "x": 5.735091396535967, - "y": 4.135436875128028, - "heading": -3.611302700103551, - "angularVelocity": 0.6663966377437107, - "velocityX": -2.770619222505322, - "velocityY": 0.6250069937412039, - "timestamp": 1.2248818022611445 + "x": 7.997862807158953, + "y": 4.441693190015581, + "heading": -4.129726776956422, + "angularVelocity": 0.02284131688697609, + "velocityX": -0.10143197061746514, + "velocityY": -0.041083200264577825, + "timestamp": 0.03310490711760394 + }, + { + "x": 7.9911388141737, + "y": 4.438993628966426, + "heading": -4.128211445929986, + "angularVelocity": 0.045773607551682645, + "velocityX": -0.20311167046523715, + "velocityY": -0.0815456463770018, + "timestamp": 0.06620981423520789 + }, + { + "x": 7.9810400437385045, + "y": 4.43497671720804, + "heading": -4.125933844845356, + "angularVelocity": 0.0687995008274153, + "velocityX": -0.30505358010280076, + "velocityY": -0.12133886206402324, + "timestamp": 0.09931472135281183 + }, + { + "x": 7.967557297835451, + "y": 4.429666406913068, + "heading": -4.122890786295556, + "angularVelocity": 0.09192167611254726, + "velocityX": -0.4072733342871634, + "velocityY": -0.16040855442089563, + "timestamp": 0.13241962847041577 + }, + { + "x": 7.950680819649021, + "y": 4.423088671636749, + "heading": -4.119078993794958, + "angularVelocity": 0.1151428242059706, + "velocityX": -0.5097878126187516, + "velocityY": -0.19869366353910206, + "timestamp": 0.16552453558801972 + }, + { + "x": 7.9304002494470245, + "y": 4.415271768358087, + "heading": -4.11449510304615, + "angularVelocity": 0.13846559763858526, + "velocityX": -0.6126152274027127, + "velocityY": -0.23612521403224035, + "timestamp": 0.19862944270562366 + }, + { + "x": 7.906704577869307, + "y": 4.406246545769374, + "heading": -4.109135665331081, + "angularVelocity": 0.16189254650467774, + "velocityX": -0.7157752019524101, + "velocityY": -0.27262491801146155, + "timestamp": 0.2317343498232276 + }, + { + "x": 7.879582097302059, + "y": 4.396046809215453, + "heading": -4.102997153692569, + "angularVelocity": 0.1854260341738729, + "velocityX": -0.8192888284173855, + "velocityY": -0.3081034638667474, + "timestamp": 0.26483925694083155 + }, + { + "x": 7.849020352591328, + "y": 4.384709755534507, + "heading": -4.096075972835381, + "angularVelocity": 0.2090681249338963, + "velocityX": -0.9231786877444521, + "velocityY": -0.34245840475163225, + "timestamp": 0.2979441640584355 + }, + { + "x": 7.8150060932615615, + "y": 4.372276494821474, + "heading": -4.088368474050785, + "angularVelocity": 0.23282043224634263, + "velocityX": -1.0274688042148068, + "velocityY": -0.37557153291095113, + "timestamp": 0.33104907117603943 + }, + { + "x": 7.777525230849651, + "y": 4.358792681160471, + "heading": -4.079870977005314, + "angularVelocity": 0.2566839113997491, + "velocityX": -1.1321844909204, + "velocityY": -0.40730558805382683, + "timestamp": 0.3641539782936434 + }, + { + "x": 7.736562807258985, + "y": 4.344309281125525, + "heading": -4.070579801008361, + "angularVelocity": 0.2806585731820932, + "velocityX": -1.2373520168822494, + "velocityY": -0.4375000957862593, + "timestamp": 0.3972588854112473 + }, + { + "x": 7.692102983701815, + "y": 4.328883517990517, + "heading": -4.060491309495449, + "angularVelocity": 0.30474308467546074, + "velocityX": -1.342997985139448, + "velocityY": -0.4659660599622744, + "timestamp": 0.43036379252885126 + }, + { + "x": 7.644129065695918, + "y": 4.312580042041941, + "heading": -4.04960197309887, + "angularVelocity": 0.3289342077866296, + "velocityX": -1.4491482436568, + "velocityY": -0.4924791327962167, + "timestamp": 0.4634686996464552 + }, + { + "x": 7.592623589168311, + "y": 4.295472394421691, + "heading": -4.037908459066969, + "angularVelocity": 0.35322600333416404, + "velocityX": -1.5558260394640624, + "velocityY": -0.5167707481998554, + "timestamp": 0.49657360676405915 + }, + { + "x": 7.537568508476518, + "y": 4.277644855237873, + "heading": -4.025407758286928, + "angularVelocity": 0.3776086951591106, + "velocityX": -1.6630489400321737, + "velocityY": -0.5385165141979279, + "timestamp": 0.5296785138816631 + }, + { + "x": 7.478945553370504, + "y": 4.259194798384933, + "heading": -4.012097366252854, + "angularVelocity": 0.4020670405988502, + "velocityX": -1.7708237300820395, + "velocityY": -0.5573209067585142, + "timestamp": 0.562783420999267 + }, + { + "x": 7.416736866046282, + "y": 4.240235717831127, + "heading": -3.997975541642368, + "angularVelocity": 0.4265779861673775, + "velocityX": -1.8791379508550954, + "velocityY": -0.572696986777671, + "timestamp": 0.595888328116871 + }, + { + "x": 7.350926104517102, + "y": 4.220901144158427, + "heading": -3.9830416764514713, + "angularVelocity": 0.45110729771403824, + "velocityX": -1.9879458140568433, + "velocityY": -0.5840395082219955, + "timestamp": 0.6289932352344749 + }, + { + "x": 7.281500327112687, + "y": 4.201349732133466, + "heading": -3.96729682544228, + "angularVelocity": 0.4756047480592185, + "velocityX": -2.097144606320271, + "velocityY": -0.5905895447917914, + "timestamp": 0.6620981423520789 + }, + { + "x": 7.2084531927759015, + "y": 4.181771851317855, + "heading": -3.9507444596397754, + "angularVelocity": 0.4999973491453385, + "velocityX": -2.2065349429100904, + "velocityY": -0.5913890876075294, + "timestamp": 0.6952030494696828 + }, + { + "x": 7.131790380553627, + "y": 4.162397992626754, + "heading": -3.9333915260781684, + "angularVelocity": 0.5241801011542423, + "velocityX": -2.3157537325186857, + "velocityY": -0.585226190856754, + "timestamp": 0.7283079565872868 + }, + { + "x": 7.0515387151746305, + "y": 4.143509053211283, + "heading": -3.9152499068546014, + "angularVelocity": 0.5480039306293687, + "velocityX": -2.4241622274881247, + "velocityY": -0.5705782332621693, + "timestamp": 0.7614128637048907 + }, + { + "x": 6.967761273464085, + "y": 4.12544769562606, + "heading": -3.896338362160399, + "angularVelocity": 0.5712610709650918, + "velocityX": -2.5306653606648495, + "velocityY": -0.545579467148517, + "timestamp": 0.7945177708224946 + }, + { + "x": 6.880581329556192, + "y": 4.108627735185313, + "heading": -3.876684994503698, + "angularVelocity": 0.5936693187775344, + "velocityX": -2.6334447518064277, + "velocityY": -0.5080805809542204, + "timestamp": 0.8276226779400986 + }, + { + "x": 6.790216727690451, + "y": 4.093533979368118, + "heading": -3.85633012820655, + "angularVelocity": 0.6148594897076288, + "velocityX": -2.729643721540304, + "velocityY": -0.4559371142040936, + "timestamp": 0.8607275850577025 + }, + { + "x": 6.697019312366813, + "y": 4.080699168817031, + "heading": -3.8353291258180944, + "angularVelocity": 0.6343773239976459, + "velocityX": -2.8152145237127253, + "velocityY": -0.38770114972659575, + "timestamp": 0.8938324921753065 + }, + { + "x": 6.601498644505623, + "y": 4.070646088391479, + "heading": -3.813754421138034, + "angularVelocity": 0.6517071503453378, + "velocityX": -2.885393018076057, + "velocityY": -0.30367342188392765, + "timestamp": 0.9269373992929104 + }, + { + "x": 6.504298318965137, + "y": 4.063805979232082, + "heading": -3.791697263090234, + "angularVelocity": 0.6662806202549634, + "velocityX": -2.9361304411816507, + "velocityY": -0.2066191919855685, + "timestamp": 0.9600423064105144 + }, + { + "x": 6.406117593795898, + "y": 4.060457514963214, + "heading": -3.7692686128872914, + "angularVelocity": 0.6775022845787112, + "velocityX": -2.9657453748611045, + "velocityY": -0.10114706732064674, + "timestamp": 0.9931472135281183 + }, + { + "x": 6.307619694810011, + "y": 4.060722685880049, + "heading": -3.746592951999944, + "angularVelocity": 0.6849637368500491, + "velocityX": -2.975326245017957, + "velocityY": 0.00801001845112039, + "timestamp": 1.0262521206457222 + }, + { + "x": 6.209374393100852, + "y": 4.064607050480649, + "heading": -3.7237946177112957, + "angularVelocity": 0.6886693325451241, + "velocityX": -2.9676960385403794, + "velocityY": 0.11733500978574436, + "timestamp": 1.0593570277633262 + }, + { + "x": 6.111843567014915, + "y": 4.072048512767596, + "heading": -3.7009858932799373, + "angularVelocity": 0.6889831876081538, + "velocityX": -2.946113871863876, + "velocityY": 0.22478426719373196, + "timestamp": 1.0924619348809301 + }, + { + "x": 6.0153920218938275, + "y": 4.08295380228718, + "heading": -3.67826183034087, + "angularVelocity": 0.6864258177297179, + "velocityX": -2.9135120294537553, + "velocityY": 0.32941610380729425, + "timestamp": 1.125566841998534 + }, + { + "x": 5.920306259948002, + "y": 4.097220089886147, + "heading": -3.6557001964477682, + "angularVelocity": 0.6815193231913592, + "velocityX": -2.872255814161892, + "velocityY": 0.43094177996896244, + "timestamp": 1.158671749116138 + }, + { + "x": 5.826812521225562, + "y": 4.1147460596447285, + "heading": -3.633363692971576, + "angularVelocity": 0.6747188082069855, + "velocityX": -2.824165565253177, + "velocityY": 0.5294070059257744, + "timestamp": 1.191776656233742 + }, + { + "x": 5.73509140346026, + "y": 4.135436868691069, + "heading": -3.611302688403279, + "angularVelocity": 0.6663968121078352, + "velocityX": -2.7706200002152808, + "velocityY": 0.6250073130499223, + "timestamp": 1.224881563351346 }, { "x": 5.645288944244385, "y": 4.159205913543701, - "heading": -3.589557740824999, - "angularVelocity": 0.656849903248797, - "velocityX": -2.712662339055809, - "velocityY": 0.7179912541409452, - "timestamp": 1.25798671583577 - }, - { - "x": 5.556543272789032, - "y": 4.1863163780495505, - "heading": -3.567920606584658, - "angularVelocity": 0.6461920112656356, - "velocityX": -2.6503853648943725, - "velocityY": 0.8096527659711241, - "timestamp": 1.291470779184003 - }, - { - "x": 5.470146818109821, - "y": 4.21629829382191, - "heading": -3.546719854360496, - "angularVelocity": 0.633159482577573, - "velocityX": -2.5802261147546752, - "velocityY": 0.8954085249615271, - "timestamp": 1.324954842532236 - }, - { - "x": 5.38636992658066, - "y": 4.248906335893914, - "heading": -3.526034553779174, - "angularVelocity": 0.6177655431539323, - "velocityX": -2.5019929826880443, - "velocityY": 0.9738376651866179, - "timestamp": 1.358438905880469 - }, - { - "x": 5.305478349810334, - "y": 4.283844055187029, - "heading": -3.505938689685919, - "angularVelocity": 0.6001620497565967, - "velocityX": -2.415823191141911, - "velocityY": 1.0434133674209292, - "timestamp": 1.3919229692287018 - }, - { - "x": 5.227719301839229, - "y": 4.32076498574019, - "heading": -3.4864965293384484, - "angularVelocity": 0.5806392176861178, - "velocityX": -2.322270363737359, - "velocityY": 1.1026418797857462, - "timestamp": 1.4254070325769348 - }, - { - "x": 5.1533066354562695, - "y": 4.359280038599062, - "heading": -3.467759498175663, - "angularVelocity": 0.5595805672663093, - "velocityX": -2.2223308327030025, - "velocityY": 1.150250268562566, - "timestamp": 1.4588910959251677 - }, - { - "x": 5.082408288831018, - "y": 4.3989712692340515, - "heading": -3.4497656171938673, - "angularVelocity": 0.5373864215540406, - "velocityX": -2.117375836018225, - "velocityY": 1.1853767633337151, - "timestamp": 1.4923751592734007 - }, - { - "x": 5.01513906699728, - "y": 4.439409930939772, - "heading": -3.4325412407735434, - "angularVelocity": 0.514405203490123, - "velocityX": -2.008992192319671, - "velocityY": 1.207698757619713, - "timestamp": 1.5258592226216336 - }, - { - "x": 4.951560246505482, - "y": 4.480175132009186, - "heading": -3.4161037850831852, - "angularVelocity": 0.490903852361318, - "velocityX": -1.8987785272826667, - "velocityY": 1.2174508405822064, - "timestamp": 1.5593432859698666 - }, - { - "x": 4.891685240964086, - "y": 4.520869436323415, - "heading": -3.4004642391590387, - "angularVelocity": 0.4670743141743557, - "velocityX": -1.7881642654506853, - "velocityY": 1.2153335122744733, - "timestamp": 1.5928273493180996 - }, - { - "x": 4.835488965074171, - "y": 4.561129265371178, - "heading": -3.3856290250526424, - "angularVelocity": 0.44305298171582685, - "velocityX": -1.678299174908268, - "velocityY": 1.2023579285782104, - "timestamp": 1.6263114126663325 - }, - { - "x": 4.782918258230768, - "y": 4.600629876244802, - "heading": -3.3716013073356166, - "angularVelocity": 0.4189371394725309, - "velocityX": -1.5700217233694047, - "velocityY": 1.1796839129952525, - "timestamp": 1.6597954760145655 - }, - { - "x": 4.733901443923004, - "y": 4.639085998252082, - "heading": -3.358381939905764, - "angularVelocity": 0.39479579561093997, - "velocityX": -1.4638848875057788, - "velocityY": 1.1484903014110828, - "timestamp": 1.6932795393627984 - }, - { - "x": 4.688356082575613, - "y": 4.676249643136629, - "heading": -3.345970158873378, - "angularVelocity": 0.3706772652800276, - "velocityX": -1.3602101057365927, - "velocityY": 1.109890532043447, - "timestamp": 1.7267636027110314 - }, - { - "x": 4.646194734008062, - "y": 4.7119064377976505, - "heading": -3.3343640770115957, - "angularVelocity": 0.34661509689190445, - "velocityX": -1.2591467209064442, - "velocityY": 1.0648885199562685, - "timestamp": 1.7602476660592643 - }, - { - "x": 4.6073289583831585, - "y": 4.745871436865768, - "heading": -3.3235610235419317, - "angularVelocity": 0.32263269117946203, - "velocityX": -1.1607245877150678, - "velocityY": 1.014363122984295, - "timestamp": 1.7937317294074973 - }, - { - "x": 4.57167193026909, - "y": 4.777984991592977, - "heading": -3.3135577714536746, - "angularVelocity": 0.29874665999236377, - "velocityX": -1.0648954920206877, - "velocityY": 0.9590698235524624, - "timestamp": 1.8272157927557302 - }, - { - "x": 4.539140037844566, - "y": 4.808108969456149, - "heading": -3.304350688790571, - "angularVelocity": 0.27496909701041905, - "velocityX": -0.9715634594939336, - "velocityY": 0.8996512027194499, - "timestamp": 1.8606998561039632 - }, - { - "x": 4.509653776241274, - "y": 4.836123440216494, - "heading": -3.29593584110889, - "angularVelocity": 0.25130903600816695, - "velocityX": -0.8806058361745399, - "velocityY": 0.8366508708634285, - "timestamp": 1.894183919452196 - }, - { - "x": 4.48313816887737, - "y": 4.861923843828622, - "heading": -3.2883090632845122, - "angularVelocity": 0.22777336624470876, - "velocityX": -0.7918873849969232, - "velocityY": 0.7705278580978897, - "timestamp": 1.927667982800429 - }, - { - "x": 4.459522884136782, - "y": 4.885418605956808, - "heading": -3.2814660119426646, - "angularVelocity": 0.20436741116752466, - "velocityX": -0.7052693842736527, - "velocityY": 0.7016699820401419, - "timestamp": 1.961152046148662 - }, - { - "x": 4.438742162822014, - "y": 4.906527146840758, - "heading": -3.275402205208727, - "angularVelocity": 0.18109530706814916, - "velocityX": -0.6206152789358182, - "velocityY": 0.6304055951759001, - "timestamp": 1.994636109496895 - }, - { - "x": 4.420734633898579, - "y": 4.925178225077248, - "heading": -3.2701130537081724, - "angularVelocity": 0.15796026442632197, - "velocityX": -0.5377940166985415, - "velocityY": 0.5570135871061982, - "timestamp": 2.028120172845128 - }, - { - "x": 4.405443069468726, - "y": 4.941308561350081, - "heading": -3.2655938851592956, - "angularVelocity": 0.13496475926106719, - "velocityX": -0.45668186297528196, - "velocityY": 0.4817317451910843, - "timestamp": 2.061604236193361 - }, - { - "x": 4.392814111754166, - "y": 4.954861693705026, - "heading": -3.2618399640244657, - "angularVelocity": 0.1121106807076865, - "velocityX": -0.37716323682758857, - "velocityY": 0.40476366962971966, - "timestamp": 2.095088299541594 - }, - { - "x": 4.382797992684927, - "y": 4.965787023275837, - "heading": -3.2588465072023927, - "angularVelocity": 0.08939944925265392, - "velocityX": -0.2991309317830429, - "velocityY": 0.3262844612730617, - "timestamp": 2.1285723628898268 - }, - { - "x": 4.375348258629927, - "y": 4.974039016306493, - "heading": -3.2566086964718237, - "angularVelocity": 0.06683211375202444, - "velocityX": -0.22248596227772716, - "velocityY": 0.2464453894031916, - "timestamp": 2.1620564262380597 - }, - { - "x": 4.370421507535125, - "y": 4.979576534431501, - "heading": -3.2551216882351093, - "angularVelocity": 0.04440943207070345, - "velocityX": -0.14713719310477827, - "velocityY": 0.16537772215448024, - "timestamp": 2.1955404895862927 + "heading": -3.5895577279773367, + "angularVelocity": 0.6568500660247814, + "velocityX": -2.712663077315302, + "velocityY": 0.7179915886244437, + "timestamp": 1.2579864704689498 + }, + { + "x": 5.55654326392043, + "y": 4.186316385224252, + "heading": -3.5679205922393793, + "angularVelocity": 0.6461921616438002, + "velocityX": -2.6503860630907963, + "velocityY": 0.8096531126208885, + "timestamp": 1.2914705283425647 + }, + { + "x": 5.47014680152862, + "y": 4.216298307971487, + "heading": -3.5467198389182046, + "angularVelocity": 0.6331596188608981, + "velocityX": -2.5802267669561205, + "velocityY": 0.8954088796644789, + "timestamp": 1.3249545862161796 + }, + { + "x": 5.386369903571584, + "y": 4.248906356674734, + "heading": -3.526034537660783, + "angularVelocity": 0.6177656643498314, + "velocityX": -2.501993583730219, + "velocityY": 0.9738380224501408, + "timestamp": 1.3584386440897944 + }, + { + "x": 5.305478321739699, + "y": 4.283844082081717, + "heading": -3.505938673301294, + "angularVelocity": 0.6001621558337007, + "velocityX": -2.415823737290412, + "velocityY": 1.0434137206086127, + "timestamp": 1.3919227019634093 + }, + { + "x": 5.227719270089909, + "y": 4.3207650180463215, + "heading": -3.486496513053993, + "angularVelocity": 0.5806393096286306, + "velocityX": -2.322270853290538, + "velocityY": 1.1026422216794234, + "timestamp": 1.4254067598370241 + }, + { + "x": 5.153306601354184, + "y": 4.359280075444413, + "heading": -3.4677594822906004, + "angularVelocity": 0.5595806468294645, + "velocityX": -2.2223312663176835, + "velocityY": 1.1502505921912554, + "timestamp": 1.458890817710639 + }, + { + "x": 5.082408253577596, + "y": 4.39897130961914, + "heading": -3.449765601932038, + "angularVelocity": 0.537386490803467, + "velocityX": -2.11737621659215, + "velocityY": 1.1853770628560039, + "timestamp": 1.4923748755842539 + }, + { + "x": 5.015139031621627, + "y": 4.439409973799246, + "heading": -3.432541226289716, + "angularVelocity": 0.5144052643600046, + "velocityX": -2.008992524438854, + "velocityY": 1.2076990289749658, + "timestamp": 1.5258589334578687 + }, + { + "x": 4.951560211842953, + "y": 4.480175176277809, + "heading": -3.4161037714769003, + "angularVelocity": 0.4909039064159544, + "velocityX": -1.8987788164341068, + "velocityY": 1.2174510817186697, + "timestamp": 1.5593429913314836 + }, + { + "x": 4.89168520765914, + "y": 4.520869480993223, + "heading": -3.4004642264891163, + "angularVelocity": 0.4670743625762069, + "velocityX": -1.7881645172699678, + "velocityY": 1.2153337229619623, + "timestamp": 1.5928270492050984 + }, + { + "x": 4.835488933599554, + "y": 4.5611293095322845, + "heading": -3.3856290133489932, + "angularVelocity": 0.44305302529694635, + "velocityX": -1.6782993946462035, + "velocityY": 1.2023581099704563, + "timestamp": 1.6263111070787133 + }, + { + "x": 4.782918228914137, + "y": 4.600629919108832, + "heading": -3.3716012966078455, + "angularVelocity": 0.41893717882389225, + "velocityX": -1.5700219156186, + "velocityY": 1.1796840671355455, + "timestamp": 1.6597951649523282 + }, + { + "x": 4.733901416974363, + "y": 4.639086039161345, + "heading": -3.3583819301491356, + "angularVelocity": 0.394795831156607, + "velocityX": -1.4638850561299048, + "velocityY": 1.1484904308093287, + "timestamp": 1.693279222825943 + }, + { + "x": 4.68835605811188, + "y": 4.676249681563439, + "heading": -3.3459701500728256, + "angularVelocity": 0.37067729733231536, + "velocityX": -1.3602102539182277, + "velocityY": 1.1098906393713428, + "timestamp": 1.7267632806995579 + }, + { + "x": 4.646194712073395, + "y": 4.711906473337791, + "heading": -3.3343640691443137, + "angularVelocity": 0.34661512569112146, + "velocityX": -1.2591468512455393, + "velocityY": 1.0648886078544806, + "timestamp": 1.7602473385731727 + }, + { + "x": 4.6073289389650105, + "y": 4.745871469229039, + "heading": -3.3235610165789797, + "angularVelocity": 0.32263271692188306, + "velocityX": -1.1607247023369474, + "velocityY": 1.0143631939548117, + "timestamp": 1.7937313964467876 + }, + { + "x": 4.571671913310556, + "y": 4.777985020592715, + "heading": -3.3135577653609034, + "angularVelocity": 0.29874668284929173, + "velocityX": -1.0648955926740002, + "velocityY": 0.9590698799078438, + "timestamp": 1.8272154543204024 + }, + { + "x": 4.539140023253754, + "y": 4.8081089949988245, + "heading": -3.3043506835291088, + "angularVelocity": 0.2749691171406556, + "velocityX": -0.9715635476319252, + "velocityY": 0.8996512465667004, + "timestamp": 1.8606995121940173 + }, + { + "x": 4.509653763898365, + "y": 4.8361234622919635, + "heading": -3.295935836635349, + "angularVelocity": 0.25130905356578065, + "velocityX": -0.8806059130194128, + "velocityY": 0.8366509041072363, + "timestamp": 1.8941835700676322 + }, + { + "x": 4.4831381586399495, + "y": 4.861923862501275, + "heading": -3.2883090595510325, + "angularVelocity": 0.22777338138357495, + "velocityX": -0.7918874515895754, + "velocityY": 0.7705278824536537, + "timestamp": 1.927667627941247 + }, + { + "x": 4.45952287584388, + "y": 4.885418621357682, + "heading": -3.281466008896871, + "angularVelocity": 0.20436742404372882, + "velocityX": -0.7052694415116886, + "velocityY": 0.7016699990511293, + "timestamp": 1.9611516858148619 + }, + { + "x": 4.438742156297185, + "y": 4.906527159160586, + "heading": -3.275402202793641, + "angularVelocity": 0.18109531784102728, + "velocityX": -0.6206153276025074, + "velocityY": 0.6304056062313884, + "timestamp": 1.9946357436884767 + }, + { + "x": 4.420734628952273, + "y": 4.925178234560356, + "heading": -3.2701130518621158, + "angularVelocity": 0.15796027325866763, + "velocityX": -0.5377940574849306, + "velocityY": 0.5570135934589632, + "timestamp": 2.0281198015620916 + }, + { + "x": 4.405443065900129, + "y": 4.941308568289058, + "heading": -3.2655938838157965, + "angularVelocity": 0.13496476631885662, + "velocityX": -0.45668189649717433, + "velocityY": 0.48173174797346885, + "timestamp": 2.0616038594357065 + }, + { + "x": 4.39281410935265, + "y": 4.954861698436055, + "heading": -3.261839963112179, + "angularVelocity": 0.11211068615955058, + "velocityX": -0.3771632636386863, + "velocityY": 0.4047636698680065, + "timestamp": 2.0950879173093213 + }, + { + "x": 4.382797991231194, + "y": 4.9657870261746115, + "heading": -3.258846506645042, + "angularVelocity": 0.08939945326923995, + "velocityX": -0.2991309523852119, + "velocityY": 0.32628445990012805, + "timestamp": 2.128571975182936 + }, + { + "x": 4.375348257896936, + "y": 4.974039017784631, + "heading": -3.2566086961881613, + "angularVelocity": 0.06683211650533652, + "velocityX": -0.22248597712909673, + "velocityY": 0.24644538726955106, + "timestamp": 2.162056033056551 + }, + { + "x": 4.370421507288839, + "y": 4.979576534933385, + "heading": -3.255121688138895, + "angularVelocity": 0.04440943373347284, + "velocityX": -0.1471372026261985, + "velocityY": 0.16537772003787146, + "timestamp": 2.195540090930166 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": 0.02213193847444466, - "velocityX": -0.07300085344241602, - "velocityY": 0.08319587425074677, - "timestamp": 2.2290245529345256 + "angularVelocity": 0.022131939219558208, + "velocityX": -0.07300085802266022, + "velocityY": 0.08319587286444159, + "timestamp": 2.2290241488037807 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": -4.226950965349435e-29, - "velocityX": 7.000195221592091e-27, - "velocityY": -1.7484350204553325e-27, - "timestamp": 2.2625086162827586 + "angularVelocity": 2.730389824214373e-24, + "velocityX": -3.568292000859936e-22, + "velocityY": -3.1134132334801996e-22, + "timestamp": 2.2625082066773956 } ], "eventMarkers": [ @@ -633,7 +633,7 @@ } }, { - "timestamp": 2.2625086162827586, + "timestamp": 2.2625082066773956, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Mid B.traj b/Robot/src/main/deploy/choreo/Amp Side Mid B.traj index 03fa2da..f26344d 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Mid B.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Mid B.traj @@ -4,2044 +4,2044 @@ "x": 2.5797407627105713, "y": 6.855753421783447, "heading": -2.669646391151296, - "angularVelocity": -1.3142297964035998e-23, - "velocityX": -1.083334582387026e-25, - "velocityY": -1.729816221225227e-24, + "angularVelocity": 2.0073542459851034e-22, + "velocityX": -1.4065326746107527e-21, + "velocityY": 7.40941788413694e-21, "timestamp": 0 }, { - "x": 2.60563777379529, - "y": 6.860019205441317, - "heading": -2.6716613236727724, - "angularVelocity": -0.022626919855620722, - "velocityX": 0.2908135076824555, - "velocityY": 0.0479031153248186, - "timestamp": 0.08905023460256821 - }, - { - "x": 2.657431788653954, - "y": 6.868550780384309, - "heading": -2.67569142112441, - "angularVelocity": -0.04525644957168479, - "velocityX": 0.5816269332677375, - "velocityY": 0.09580631630078756, - "timestamp": 0.17810046920513642 - }, - { - "x": 2.7351228017521323, - "y": 6.881348160715041, - "heading": -2.6817361560116657, - "angularVelocity": -0.06788005572622516, - "velocityX": 0.8724402967034719, - "velocityY": 0.14370967564371354, - "timestamp": 0.2671507038077046 - }, - { - "x": 2.838710809214557, - "y": 6.898411367068251, - "heading": -2.6897942738643654, - "angularVelocity": -0.09048957466157903, - "velocityX": 1.1632536166214305, - "velocityY": 0.1916132667068573, - "timestamp": 0.35620093841027284 - }, - { - "x": 2.968195808655137, - "y": 6.919740426657641, - "heading": -2.6998638401165413, - "angularVelocity": -0.11307736916265679, - "velocityX": 1.4540669097445138, - "velocityY": 0.23951716336943402, - "timestamp": 0.44525117301284106 - }, - { - "x": 3.123577798954381, - "y": 6.945335373287028, - "heading": -2.71194230142554, - "angularVelocity": -0.13563649060448887, - "velocityX": 1.7448801902961197, - "velocityY": 0.28742143963592753, - "timestamp": 0.5343014076154092 - }, - { - "x": 3.3048567799851756, - "y": 6.97519624728381, - "heading": -2.7260265619744923, - "angularVelocity": -0.15816084720955956, - "velocityX": 2.03569346942031, - "velocityY": 0.3353261687636266, - "timestamp": 0.6233516422179775 - }, - { - "x": 3.5120327522893717, - "y": 7.009323095281852, - "heading": -2.7421130753282568, - "angularVelocity": -0.18064537870741343, - "velocityX": 2.3265067546292677, - "velocityY": 0.3832314215717832, - "timestamp": 0.7124018768205457 - }, - { - "x": 3.745105716710612, - "y": 7.047715969716023, - "heading": -2.760197952403387, - "angularVelocity": -0.20308623728890646, - "velocityX": 2.6173200493120152, - "velocityY": 0.4311372632033863, - "timestamp": 0.8014521114231139 - }, - { - "x": 4.004075673995758, - "y": 7.090374927737104, - "heading": -2.7802770860662163, - "angularVelocity": -0.22548097433367448, - "velocityX": 2.908133352381726, - "velocityY": 0.47904374661636356, - "timestamp": 0.8905023460256821 - }, - { - "x": 4.28894262439546, - "y": 7.137300028836777, - "heading": -2.802346292800393, - "angularVelocity": -0.24782873209342446, - "velocityX": 3.1989466582661503, - "velocityY": 0.5269508980981372, - "timestamp": 0.9795525806282503 - }, - { - "x": 4.599706567353759, - "y": 7.188491329079206, - "heading": -2.8264014718479453, - "angularVelocity": -0.2701304399130545, - "velocityX": 3.489759957907361, - "velocityY": 0.5748586791589742, - "timestamp": 1.0686028152308185 - }, - { - "x": 4.936367501640731, - "y": 7.243948863571903, - "heading": -2.852438782605804, - "angularVelocity": -0.2923890192323865, - "velocityX": 3.7805732437369977, - "velocityY": 0.622766854463723, - "timestamp": 1.1576530498333866 - }, - { - "x": 5.298925428386942, - "y": 7.303672558707409, - "heading": -2.8804548458325563, - "angularVelocity": -0.3146096509659767, - "velocityX": 4.071386542262457, - "velocityY": 0.6706742031848971, - "timestamp": 1.2467032844359547 - }, - { - "x": 5.654193668021497, - "y": 7.340978019061845, - "heading": -2.91016580268315, - "angularVelocity": -0.3336426566779271, - "velocityX": 3.9895261502692283, - "velocityY": 0.41892601991372086, - "timestamp": 1.3357535190385228 - }, - { - "x": 5.98356504904068, - "y": 7.374016419687497, - "heading": -2.9379024670232585, - "angularVelocity": -0.3114721085676808, - "velocityX": 3.6987143547590864, - "velocityY": 0.37100857480165716, - "timestamp": 1.424803753641091 - }, - { - "x": 6.287039535369109, - "y": 7.402787834546961, - "heading": -2.9636656250656035, - "angularVelocity": -0.28931038932492203, - "velocityX": 3.4079021541362304, - "velocityY": 0.3230919602612063, - "timestamp": 1.513853988243659 - }, - { - "x": 6.564617124869861, - "y": 7.427292232732608, - "heading": -2.9874553284002965, - "angularVelocity": -0.26714924941935103, - "velocityX": 3.1170899295165584, - "velocityY": 0.2751749986399128, - "timestamp": 1.6029042228462271 - }, - { - "x": 6.816297824187459, - "y": 7.447529562819999, - "heading": -3.0092710593771144, - "angularVelocity": -0.24498229650019018, - "velocityX": 2.826277779512324, - "velocityY": 0.22725745954191853, - "timestamp": 1.6919544574487952 - }, - { - "x": 7.04208164327297, - "y": 7.4634997697510155, - "heading": -3.02911189018705, - "angularVelocity": -0.2228049246415303, - "velocityX": 2.5354657412547588, - "velocityY": 0.17933930216233074, - "timestamp": 1.7810046920513634 - }, - { - "x": 7.241968593239377, - "y": 7.475202800425809, - "heading": -3.046976628874181, - "angularVelocity": -0.20061416757475567, - "velocityX": 2.244653827791738, - "velocityY": 0.13142054849179688, - "timestamp": 1.8700549266539315 - }, - { - "x": 7.415958685210493, - "y": 7.482638606042888, - "heading": -3.062863950895082, - "angularVelocity": -0.17840853639303908, - "velocityX": 1.9538420392448632, - "velocityY": 0.08350124679924598, - "timestamp": 1.9591051612564996 - }, - { - "x": 7.56405192957815, - "y": 7.485807143207224, - "heading": -3.076772515723161, - "angularVelocity": -0.15618785161154392, - "velocityX": 1.6630303673942974, - "velocityY": 0.03558145779712713, - "timestamp": 2.0481553958590677 - }, - { - "x": 7.686248335471436, - "y": 7.484708374487247, - "heading": -3.0887010683171225, - "angularVelocity": -0.13395307319737726, - "velocityX": 1.372218798059888, - "velocityY": -0.012338751547152475, - "timestamp": 2.137205630461636 - }, - { - "x": 7.782547910358369, - "y": 7.479342268698847, - "heading": -3.098648525443845, - "angularVelocity": -0.11170613049048228, - "velocityX": 1.0814073125884323, - "velocityY": -0.06025931107703978, - "timestamp": 2.2262558650642044 - }, - { - "x": 7.852950659742851, - "y": 7.469708801046972, - "heading": -3.1066140469464796, - "angularVelocity": -0.08944975314421699, - "velocityX": 0.7905958889237127, - "velocityY": -0.10818014904588184, - "timestamp": 2.3153060996667727 - }, - { - "x": 7.897456586937546, - "y": 7.455807953193105, - "heading": -3.112597092103137, - "angularVelocity": -0.06718730369841065, - "velocityX": 0.49978450245892037, - "velocityY": -0.15610119294919206, - "timestamp": 2.404356334269341 + "x": 2.6056377595645173, + "y": 6.860019235347418, + "heading": -2.67166131940215, + "angularVelocity": -0.02262687664626412, + "velocityX": 0.2908134089016077, + "velocityY": 0.047903461211106606, + "timestamp": 0.08905021591596585 + }, + { + "x": 2.657431745912738, + "y": 6.868550871260021, + "heading": -2.675691408253123, + "angularVelocity": -0.04525636248626211, + "velocityX": 0.5816267351569059, + "velocityY": 0.09580702107060358, + "timestamp": 0.1781004318319317 + }, + { + "x": 2.7351227161637226, + "y": 6.881348344974158, + "heading": -2.681736130145307, + "angularVelocity": -0.06787992404070672, + "velocityX": 0.8724399986216745, + "velocityY": 0.14371075446030462, + "timestamp": 0.26715064774789754 + }, + { + "x": 2.838710666374723, + "y": 6.8984116787203495, + "heading": -2.689794230536387, + "angularVelocity": -0.09048939756287813, + "velocityX": 1.1632532178108679, + "velocityY": 0.1916147374902733, + "timestamp": 0.3562008636638634 + }, + { + "x": 2.9681955940786513, + "y": 6.919740901627221, + "heading": -2.699863774776327, + "angularVelocity": -0.11307714570217953, + "velocityX": 1.4540664092956235, + "velocityY": 0.23951904762364568, + "timestamp": 0.44525107957982923 + }, + { + "x": 3.123577498057011, + "y": 6.945336049839059, + "heading": -2.711942209420258, + "angularVelocity": -0.13563621962836306, + "velocityX": 1.7448795870971157, + "velocityY": 0.28742376364356087, + "timestamp": 0.5343012954957951 + }, + { + "x": 3.304856378058939, + "y": 6.975197166608854, + "heading": -2.726026438521239, + "angularVelocity": -0.1581605272498332, + "velocityX": 2.03569276208152, + "velocityY": 0.33532896537807844, + "timestamp": 0.6233515114117609 + }, + { + "x": 3.5120322344672066, + "y": 7.009324302331978, + "heading": -2.7421129154703023, + "angularVelocity": -0.18064500780373027, + "velocityX": 2.3265059413642897, + "velocityY": 0.38323473303342476, + "timestamp": 0.7124017273277268 + }, + { + "x": 3.7451050679134177, + "y": 7.0477175144586885, + "heading": -2.76019775093863, + "angularVelocity": -0.20308581267668144, + "velocityX": 2.6173191277397354, + "velocityY": 0.4311411458332731, + "timestamp": 0.8014519432436926 + }, + { + "x": 4.00407487884772, + "y": 7.090376867161408, + "heading": -2.7802768374227536, + "angularVelocity": -0.22548049185048172, + "velocityX": 2.908132319170181, + "velocityY": 0.4790482792649808, + "timestamp": 0.8905021591596585 + }, + { + "x": 4.288941667076001, + "y": 7.137302430464445, + "heading": -2.8023459907991892, + "angularVelocity": -0.24782818491155156, + "velocityX": 3.198945508420786, + "velocityY": 0.5269561990430291, + "timestamp": 0.9795523750756243 + }, + { + "x": 4.599705431301729, + "y": 7.18849427798667, + "heading": -2.826401109181455, + "angularVelocity": -0.2701298153500949, + "velocityX": 3.489758683111868, + "velocityY": 0.5748649455329105, + "timestamp": 1.0686025909915902 + }, + { + "x": 4.936366168815881, + "y": 7.243952479945757, + "heading": -2.852438349388676, + "angularVelocity": -0.29238828833150965, + "velocityX": 3.780571827381631, + "velocityY": 0.6227744805405371, + "timestamp": 1.157652806907556 + }, + { + "x": 5.29892387632096, + "y": 7.303677068067654, + "heading": -2.8804543230674837, + "angularVelocity": -0.31460871139544083, + "velocityX": 4.071384934621773, + "velocityY": 0.6706843718184372, + "timestamp": 1.2467030228235219 + }, + { + "x": 5.654192271473913, + "y": 7.340981844659183, + "heading": -2.910165358807353, + "angularVelocity": -0.3336436125871517, + "velocityX": 3.989528733857416, + "velocityY": 0.4189184294256161, + "timestamp": 1.3357532387394877 + }, + { + "x": 5.983563762603575, + "y": 7.374019749618405, + "heading": -2.937902079473165, + "angularVelocity": -0.3114728064442547, + "velocityX": 3.6987163674087062, + "velocityY": 0.3710030865101999, + "timestamp": 1.4248034546554535 + }, + { + "x": 6.2870383431109875, + "y": 7.4027907556301225, + "heading": -2.963665283121415, + "angularVelocity": -0.2893109621717427, + "velocityX": 3.407903926856203, + "velocityY": 0.32308743685547753, + "timestamp": 1.5138536705714194 + }, + { + "x": 6.564616020686646, + "y": 7.427294798001087, + "heading": -2.987455025630518, + "angularVelocity": -0.26714974539255987, + "velocityX": 3.117091572665025, + "velocityY": 0.27517106072025793, + "timestamp": 1.6029038864873852 + }, + { + "x": 6.816296806889978, + "y": 7.447531808401904, + "heading": -3.0092707916128694, + "angularVelocity": -0.24498274100692155, + "velocityX": 2.826279348281832, + "velocityY": 0.22725391727196229, + "timestamp": 1.691954102403351 + }, + { + "x": 7.042080714621744, + "y": 7.463501721624949, + "heading": -3.029111654665684, + "angularVelocity": -0.2228053334709305, + "velocityX": 2.535467268769251, + "velocityY": 0.17933604156686803, + "timestamp": 1.781004318319317 + }, + { + "x": 7.241967756961874, + "y": 7.475204477800177, + "heading": -3.046976423792443, + "angularVelocity": -0.20061455149774496, + "velocityX": 2.2446553361393184, + "velocityY": 0.1314174935440077, + "timestamp": 1.8700545342352828 + }, + { + "x": 7.415957946439473, + "y": 7.482640023287821, + "heading": -3.0628637751453267, + "angularVelocity": -0.17840890321789282, + "velocityX": 1.9538435442064368, + "velocityY": 0.08349834316698324, + "timestamp": 1.9591047501512486 + }, + { + "x": 7.564051294500569, + "y": 7.4858083110625495, + "heading": -3.0767723687242916, + "angularVelocity": -0.1561882072480332, + "velocityX": 1.6630318808080886, + "velocityY": 0.03557866471337611, + "timestamp": 2.0481549660672145 + }, + { + "x": 7.686247811094335, + "y": 7.4847093008681505, + "heading": -3.0887009498997005, + "angularVelocity": -0.13395342226531132, + "velocityX": 1.3722203291351878, + "velocityY": -0.012341465802140981, + "timestamp": 2.1372051819831803 + }, + { + "x": 7.78254750434497, + "y": 7.479342959260061, + "heading": -3.0986484357684994, + "angularVelocity": -0.11170647669384857, + "velocityX": 1.0814088686939272, + "velocityY": -0.06026197188730624, + "timestamp": 2.226255397899146 + }, + { + "x": 7.852950380293331, + "y": 7.469709259593279, + "heading": -3.1066139864439575, + "angularVelocity": -0.08945009951436005, + "velocityX": 0.7905974760891972, + "velocityY": -0.1081827771857946, + "timestamp": 2.315305613815112 + }, + { + "x": 7.897456442699593, + "y": 7.455808181987322, + "heading": -3.1125970614290615, + "angularVelocity": -0.06718765275931286, + "velocityX": 0.4997861257098042, + "velocityY": -0.15610380573444393, + "timestamp": 2.404355829731078 }, { "x": 7.916065692901611, "y": 7.4376397132873535, "heading": -3.116597461241803, - "angularVelocity": -0.0449226120124177, - "velocityX": 0.20897312676510937, - "velocityY": -0.2040223699222923, - "timestamp": 2.4934065688719094 - }, - { - "x": 7.9070122603589, - "y": 7.413826617664512, - "heading": -3.11861194216317, - "angularVelocity": -0.021520720211200346, - "velocityX": -0.09671791211130092, - "velocityY": -0.2543955432022431, - "timestamp": 2.5870131443766944 - }, - { - "x": 7.869344140213553, - "y": 7.385298267689194, - "heading": -3.1184352062412737, - "angularVelocity": 0.001888071654618472, - "velocityX": -0.4024089113635186, - "velocityY": -0.30476865349977356, - "timestamp": 2.6806197198814794 - }, - { - "x": 7.803061333004561, - "y": 7.352054678768873, - "heading": -3.1160670574506257, - "angularVelocity": 0.02529895766272299, - "velocityX": -0.7080999048576825, - "velocityY": -0.35514159919910054, - "timestamp": 2.7742262953862644 - }, - { - "x": 7.70816383608335, - "y": 7.314095876394929, - "heading": -3.111507734132627, - "angularVelocity": 0.048707297467210565, - "velocityX": -1.0137909266465996, - "velocityY": -0.4055142725737741, - "timestamp": 2.8678328708910494 - }, - { - "x": 7.584651643628721, - "y": 7.27142189709441, - "heading": -3.1047578739730084, - "angularVelocity": 0.07210882486854506, - "velocityX": -1.3194820106234444, - "velocityY": -0.455886555729595, - "timestamp": 2.9614394463958345 - }, - { - "x": 7.432524746664207, - "y": 7.224032790103509, - "heading": -3.0958184592506823, - "angularVelocity": 0.09549985857424112, - "velocityX": -1.6251731904959823, - "velocityY": -0.5062583128946773, - "timestamp": 3.0550460219006195 - }, - { - "x": 7.251783133001236, - "y": 7.171928620622399, - "heading": -3.0846907420606215, - "angularVelocity": 0.1188775161365886, - "velocityX": -1.9308645005791376, - "velocityY": -0.5566293735256479, - "timestamp": 3.1486525974054045 - }, - { - "x": 7.042426786875021, - "y": 7.115109477241975, - "heading": -3.0713761490336036, - "angularVelocity": 0.14223993298780116, - "velocityX": -2.236555979077694, - "velocityY": -0.6069994877391849, - "timestamp": 3.2422591729101895 - }, - { - "x": 6.804455687334457, - "y": 7.053575493929542, - "heading": -3.055876164351336, - "angularVelocity": 0.1655864943107016, - "velocityX": -2.542247681397121, - "velocityY": -0.6573681707786417, - "timestamp": 3.3358657484149745 - }, - { - "x": 6.537869798801013, - "y": 6.987326959347451, - "heading": -3.038192183929703, - "angularVelocity": 0.1889181430499978, - "velocityX": -2.8479397638023447, - "velocityY": -0.707733770035256, - "timestamp": 3.4294723239197595 - }, - { - "x": 6.251721942644649, - "y": 6.9401796162992495, - "heading": -3.0163639344951743, - "angularVelocity": 0.23319141114624786, - "velocityX": -3.0569204632609908, - "velocityY": -0.5036755462311673, - "timestamp": 3.5230788994245446 - }, - { - "x": 5.994188767247977, - "y": 6.8977475214878226, - "heading": -2.9967176405118674, - "angularVelocity": 0.20988155882599013, - "velocityX": -2.7512295371120445, - "velocityY": -0.45330250126774246, - "timestamp": 3.6166854749293296 - }, - { - "x": 5.765270336012349, - "y": 6.860030391062932, - "heading": -2.9792531096003043, - "angularVelocity": 0.18657376169764953, - "velocityX": -2.445537933645764, - "velocityY": -0.4029324886793023, - "timestamp": 3.7102920504341146 - }, - { - "x": 5.564966675703843, - "y": 6.827028091962186, - "heading": -2.9639704856474203, - "angularVelocity": 0.16326442742372366, - "velocityX": -2.139846044237206, - "velocityY": -0.35256389759777007, - "timestamp": 3.8038986259388996 - }, - { - "x": 5.393277802457308, - "y": 6.798740535430808, - "heading": -2.950870120937211, - "angularVelocity": 0.13995132969627333, - "velocityX": -1.8341539824599005, - "velocityY": -0.3021962546843907, - "timestamp": 3.8975052014436846 - }, - { - "x": 5.25020372728784, - "y": 6.7751676557798355, - "heading": -2.9399524598545517, - "angularVelocity": 0.11663348460067259, - "velocityX": -1.5284618030082089, - "velocityY": -0.25182931352687526, - "timestamp": 3.9911117769484696 - }, - { - "x": 5.135744458132628, - "y": 6.756309403324118, - "heading": -2.9312179411027137, - "angularVelocity": 0.09331095283356157, - "velocityX": -1.222769538763453, - "velocityY": -0.2014629031563385, - "timestamp": 4.084718352453255 - }, - { - "x": 5.049900000853324, - "y": 6.7421657413579945, - "heading": -2.9246669194518846, - "angularVelocity": 0.06998463105291268, - "velocityX": -0.9170772118985947, - "velocityY": -0.15109688491276213, - "timestamp": 4.17832492795804 - }, - { - "x": 4.9926703598055795, - "y": 6.732736644639159, - "heading": -2.920299607236711, - "angularVelocity": 0.04665604089907658, - "velocityX": -0.611384838502273, - "velocityY": -0.10073113633298339, - "timestamp": 4.271931503462826 + "angularVelocity": -0.044922965897315335, + "velocityX": 0.20897479035401717, + "velocityY": -0.2040249820069297, + "timestamp": 2.4934060456470437 + }, + { + "x": 7.907012409900235, + "y": 7.413826367530878, + "heading": -3.118611975460086, + "angularVelocity": -0.021521073293795764, + "velocityX": -0.09671630274627309, + "velocityY": -0.25439818430889266, + "timestamp": 2.587012632585414 + }, + { + "x": 7.86934443098964, + "y": 7.385297761212543, + "heading": -3.1184352727405407, + "angularVelocity": 0.001887716722986529, + "velocityX": -0.40240735339912476, + "velocityY": -0.3047713547885194, + "timestamp": 2.680619219523784 + }, + { + "x": 7.803061757039115, + "y": 7.35205390609398, + "heading": -3.116067157372098, + "angularVelocity": 0.025298597522861684, + "velocityX": -0.7080983947653753, + "velocityY": -0.3551443996184828, + "timestamp": 2.7742258064621543 + }, + { + "x": 7.708164385824663, + "y": 7.314094822979375, + "heading": -3.1115078681064587, + "angularVelocity": 0.04870692773619732, + "velocityX": -1.013789459890593, + "velocityY": -0.4055172221971618, + "timestamp": 2.8678323934005245 + }, + { + "x": 7.58465231209105, + "y": 7.27142054214674, + "heading": -3.1047580431849022, + "angularVelocity": 0.07210843961227054, + "velocityX": -1.3194805811575352, + "velocityY": -0.45588972131559213, + "timestamp": 2.9614389803388947 + }, + { + "x": 7.432525527653926, + "y": 7.22403110408453, + "heading": -3.0958186656762385, + "angularVelocity": 0.09549944935552229, + "velocityX": -1.6251717898579308, + "velocityY": -0.5062617878954225, + "timestamp": 3.055045567277265 + }, + { + "x": 7.251784021512525, + "y": 7.171926560872903, + "heading": -3.084690988878398, + "angularVelocity": 0.11887707010583433, + "velocityX": -1.9308631160796352, + "velocityY": -0.5566332981025642, + "timestamp": 3.148652154215635 + }, + { + "x": 7.042427779881054, + "y": 7.115106979238847, + "heading": -3.0713764414563793, + "angularVelocity": 0.1422394284152768, + "velocityX": -2.2365545895750922, + "velocityY": -0.6070040954646013, + "timestamp": 3.2422587411540054 + }, + { + "x": 6.804456785765002, + "y": 7.053572449427596, + "heading": -3.0558765117150686, + "angularVelocity": 0.16558588715040146, + "velocityX": -2.5422462446230534, + "velocityY": -0.6573739287360777, + "timestamp": 3.3358653280923756 + }, + { + "x": 6.537871015451157, + "y": 6.9873231289516795, + "heading": -3.0381926080821193, + "angularVelocity": 0.18891729964038087, + "velocityX": -2.847938152999453, + "velocityY": -0.7077420792997633, + "timestamp": 3.4294719150307458 + }, + { + "x": 6.251722869935082, + "y": 6.940176766797846, + "heading": -3.016364253674107, + "angularVelocity": 0.2331925040957211, + "velocityX": -3.056923181105537, + "velocityY": -0.5036650058064269, + "timestamp": 3.523078501969116 + }, + { + "x": 5.994189477499942, + "y": 6.897745373710483, + "heading": -2.9967178827416228, + "angularVelocity": 0.20988235523872914, + "velocityX": -2.7512315196867543, + "velocityY": -0.45329494937470055, + "timestamp": 3.616685088907486 + }, + { + "x": 5.765270870867694, + "y": 6.860028793884023, + "heading": -2.9792532906117453, + "angularVelocity": 0.1865743929043863, + "velocityX": -2.4455395086989586, + "velocityY": -0.4029265574151002, + "timestamp": 3.7102916758458564 + }, + { + "x": 5.564967066578637, + "y": 6.82702693693722, + "heading": -2.9639706170320186, + "angularVelocity": 0.16326493764576847, + "velocityX": -2.1398473210110196, + "velocityY": -0.3525591309993538, + "timestamp": 3.8038982627842266 + }, + { + "x": 5.393278075654954, + "y": 6.798739735455754, + "heading": -2.9508702121951718, + "angularVelocity": 0.13995174127513232, + "velocityX": -1.8341550155730215, + "velocityY": -0.302192424771196, + "timestamp": 3.897504849722597 + }, + { + "x": 5.250203906044256, + "y": 6.775167136554944, + "heading": -2.93995251921741, + "angularVelocity": 0.11663381109013397, + "velocityX": -1.528462625230599, + "velocityY": -0.2518262835107166, + "timestamp": 3.991111436660967 + }, + { + "x": 5.135744563638823, + "y": 6.756309099085823, + "heading": -2.931217975945437, + "angularVelocity": 0.09331120338490016, + "velocityX": -1.2227701719409092, + "velocityY": -0.20146058184490315, + "timestamp": 4.084718023599337 + }, + { + "x": 5.049900052839723, + "y": 6.742165592440054, + "heading": -2.9246669365280717, + "angularVelocity": 0.06998481230470345, + "velocityX": -0.9170776716345898, + "velocityY": -0.15109520716830446, + "timestamp": 4.178324610537707 + }, + { + "x": 4.992670376907219, + "y": 6.732736595948361, + "heading": -2.920299612824834, + "angularVelocity": 0.04665615792735934, + "velocityX": -0.611385136498824, + "velocityY": -0.10073005330169253, + "timestamp": 4.271931197476078 }, { "x": 4.96405553817749, - "y": 6.72802209854126, + "y": 6.7280220985412615, "heading": -2.918116035624805, - "angularVelocity": 0.023327117781321904, - "velocityX": -0.3056924310475032, - "velocityY": -0.05036554400665612, - "timestamp": 4.365538078967611 + "angularVelocity": 0.023327174629992398, + "velocityX": -0.3056925764056323, + "velocityY": -0.050365017690535835, + "timestamp": 4.365537784414448 }, { "x": 4.96405553817749, "y": 6.72802209854126, "heading": -2.918116035624805, - "angularVelocity": -2.0830291131761767e-23, - "velocityX": 2.6212070093081157e-24, - "velocityY": -2.6876451865538873e-24, - "timestamp": 4.4591446544723965 - }, - { - "x": 4.986997583079801, - "y": 6.722441944983784, - "heading": -2.922362708096326, - "angularVelocity": -0.05025246479823011, - "velocityX": 0.2714818040675807, - "velocityY": -0.066032045583043, - "timestamp": 4.543651404311878 - }, - { - "x": 5.03288163642963, - "y": 6.71128171901416, - "heading": -2.930855942511296, - "angularVelocity": -0.10050362167640607, - "velocityX": 0.5429631767519619, - "velocityY": -0.1320631309430564, - "timestamp": 4.628158154151359 - }, - { - "x": 5.10170770842542, - "y": 6.6945415441964125, - "heading": -2.943591386818814, - "angularVelocity": -0.15070327910739376, - "velocityX": 0.8144446701183498, - "velocityY": -0.19809275412371863, - "timestamp": 4.712664903990841 - }, - { - "x": 5.193475855215092, - "y": 6.672221590667123, - "heading": -2.960560694021866, - "angularVelocity": -0.2008041633985957, - "velocityX": 1.085926827904073, - "velocityY": -0.26412036401454975, - "timestamp": 4.797171653830322 - }, - { - "x": 5.308186177471799, - "y": 6.644322080265296, - "heading": -2.9817518825127913, - "angularVelocity": -0.25076326484189676, - "velocityX": 1.357410176992917, - "velocityY": -0.3301453488013894, - "timestamp": 4.881678403669803 - }, - { - "x": 5.445838818125752, - "y": 6.610843292401228, - "heading": -3.0071498190197725, - "angularVelocity": -0.30054328861568913, - "velocityX": 1.6288952174284352, - "velocityY": -0.39616702722160885, - "timestamp": 4.966185153509285 - }, - { - "x": 5.606433959098464, - "y": 6.57178557034531, - "heading": -3.0367368331942495, - "angularVelocity": -0.35011421254132336, - "velocityX": 1.900382410609302, - "velocityY": -0.4621846435948283, - "timestamp": 5.050691903348766 - }, - { - "x": 5.789971816830474, - "y": 6.527149327506201, - "heading": -3.0704934720227905, - "angularVelocity": -0.39945494167815665, - "velocityX": 2.1718721650120956, - "velocityY": -0.5281973679486492, - "timestamp": 5.135198653188247 - }, - { - "x": 5.996452636226433, - "y": 6.4769350530448095, - "heading": -3.1083994003520443, - "angularVelocity": -0.4485550373343583, - "velocityX": 2.4433648174632614, - "velocityY": -0.594204303878351, - "timestamp": 5.219705403027729 - }, - { - "x": 6.225876681885466, - "y": 6.4211433153733735, - "heading": -3.1504344509882194, - "angularVelocity": -0.49741648703824837, - "velocityX": 2.714860601014919, - "velocityY": -0.6602045135733137, - "timestamp": 5.30421215286721 - }, - { - "x": 6.478244219380954, - "y": 6.359774756070596, - "heading": -3.196579824919509, - "angularVelocity": -0.5460554809993506, - "velocityX": 2.986359527195811, - "velocityY": -0.7261971312273402, - "timestamp": 5.3887189027066915 - }, - { - "x": 6.717226111669154, - "y": 6.290548853732578, - "heading": -3.2412304050575518, - "angularVelocity": -0.5283670265730883, - "velocityX": 2.827962177484511, - "velocityY": -0.8191760122062468, - "timestamp": 5.473225652546173 - }, - { - "x": 6.9332640071159375, - "y": 6.226898382507029, - "heading": -3.2817950563873817, - "angularVelocity": -0.48001670170585536, - "velocityX": 2.556457275390921, - "velocityY": -0.7531998490824867, - "timestamp": 5.557732402385654 - }, - { - "x": 7.126357713200994, - "y": 6.168822797384324, - "heading": -3.3182799458605974, - "angularVelocity": -0.4317393526850495, - "velocityX": 2.2849500951324253, - "velocityY": -0.6872301352615873, - "timestamp": 5.642239152225136 - }, - { - "x": 7.296507081212939, - "y": 6.11632159040044, - "heading": -3.3506880436311652, - "angularVelocity": -0.38349715060780704, - "velocityX": 2.01344115511647, - "velocityY": -0.6212664323691197, - "timestamp": 5.726745902064617 - }, - { - "x": 7.443711995436663, - "y": 6.069394309199431, - "heading": -3.3790200360258207, - "angularVelocity": -0.335263070091698, - "velocityX": 1.7419308458003326, - "velocityY": -0.5553080823738457, - "timestamp": 5.811252651904098 - }, - { - "x": 7.567972366619772, - "y": 6.028040562856848, - "heading": -3.403275131384317, - "angularVelocity": -0.28701962156358174, - "velocityX": 1.4704194803271609, - "velocityY": -0.4893543583339052, - "timestamp": 5.89575940174358 - }, - { - "x": 7.669288126709092, - "y": 5.99226002475378, - "heading": -3.4234517524693158, - "angularVelocity": -0.23875750899571357, - "velocityX": 1.19890730955535, - "velocityY": -0.4234044992977654, - "timestamp": 5.980266151583061 - }, - { - "x": 7.747659224496879, - "y": 5.962052434133843, - "heading": -3.4395481122242697, - "angularVelocity": -0.19047424951886965, - "velocityX": 0.9273945328231248, - "velocityY": -0.35745772588955055, - "timestamp": 6.064772901422542 - }, - { - "x": 7.803085622131263, - "y": 5.937417596916517, - "heading": -3.451562671479707, - "angularVelocity": -0.14217277647357823, - "velocityX": 0.6558813081755649, - "velocityY": -0.2915132491087263, - "timestamp": 6.149279651262024 - }, - { - "x": 7.8355672925031605, - "y": 5.918355386069609, - "heading": -3.4594944783408175, - "angularVelocity": -0.09386003930072535, - "velocityX": 0.3843677627360551, - "velocityY": -0.22557027554740033, - "timestamp": 6.233786401101505 + "angularVelocity": 3.6338397195938546e-22, + "velocityX": -9.963230040673339e-21, + "velocityY": 1.3095690489139607e-20, + "timestamp": 4.459144371352818 + }, + { + "x": 4.986997583245362, + "y": 6.722441950535387, + "heading": -2.922362707394502, + "angularVelocity": -0.05025245955837001, + "velocityX": 0.27148182258542464, + "velocityY": -0.0660319839163844, + "timestamp": 4.543651116037918 + }, + { + "x": 5.032881637159744, + "y": 6.711281735897458, + "heading": -2.930855940399974, + "angularVelocity": -0.10050361112738114, + "velocityX": 0.5429632165499002, + "velocityY": -0.1320630049058865, + "timestamp": 4.628157860723017 + }, + { + "x": 5.101707710404414, + "y": 6.694541578470798, + "heading": -2.9435913825821065, + "angularVelocity": -0.15070326314886817, + "velocityX": 0.8144447345728314, + "velocityY": -0.19809256041088907, + "timestamp": 4.712664605408117 + }, + { + "x": 5.193475859483997, + "y": 6.672221648741145, + "heading": -2.960560686931331, + "angularVelocity": -0.20080414187598672, + "velocityX": 1.085926921236194, + "velocityY": -0.26412009849420676, + "timestamp": 4.797171350093216 + }, + { + "x": 5.308186185530338, + "y": 6.644322168996456, + "heading": -2.981751871819718, + "angularVelocity": -0.2507632375066888, + "velocityX": 1.3574103046306019, + "velocityY": -0.33014500616077025, + "timestamp": 4.881678094778316 + }, + { + "x": 5.445838832085338, + "y": 6.610843419245657, + "heading": -3.007149803941405, + "angularVelocity": -0.30054325505412216, + "velocityX": 1.6288953866101499, + "velocityY": -0.39616660037671664, + "timestamp": 4.966184839463415 + }, + { + "x": 5.606433981927045, + "y": 6.571785743597236, + "heading": -3.0367368128883587, + "angularVelocity": -0.3501141720368616, + "velocityX": 1.900382631470881, + "velocityY": -0.4621841226278734, + "timestamp": 5.050691584148515 + }, + { + "x": 5.7899718527810915, + "y": 6.5271495567170055, + "heading": -3.070493445537436, + "angularVelocity": -0.3994548929184966, + "velocityX": 2.1718724527606685, + "velocityY": -0.5281967379829884, + "timestamp": 5.1351983288336145 + }, + { + "x": 5.9964526916944845, + "y": 6.4769353498610895, + "heading": -3.1083993665141816, + "angularVelocity": -0.44855497768841657, + "velocityX": 2.4433651974503454, + "velocityY": -0.5942035401201552, + "timestamp": 5.219705073518714 + }, + { + "x": 6.225876767552239, + "y": 6.421143695632008, + "heading": -3.1504344081002755, + "angularVelocity": -0.4974164102845375, + "velocityX": 2.7148611239572196, + "velocityY": -0.6602035664369802, + "timestamp": 5.304211818203814 + }, + { + "x": 6.478244358788941, + "y": 6.3597752481787015, + "heading": -3.1965797694640314, + "angularVelocity": -0.5460553655889756, + "velocityX": 2.9863603452849636, + "velocityY": -0.7261958519640731, + "timestamp": 5.388718562888913 + }, + { + "x": 6.717226250105241, + "y": 6.290549248101248, + "heading": -3.2412303594046183, + "angularVelocity": -0.5283671747973506, + "velocityX": 2.8279623384716492, + "velocityY": -0.8191772187582416, + "timestamp": 5.473225307574013 + }, + { + "x": 6.933264135550156, + "y": 6.226898710086972, + "heading": -3.2817950179595727, + "angularVelocity": -0.48001681648147876, + "velocityX": 2.55645731296296, + "velocityY": -0.7532006853590326, + "timestamp": 5.557732052259112 + }, + { + "x": 7.126357828217531, + "y": 6.168823072058602, + "heading": -3.3182799133581264, + "angularVelocity": -0.4317394491351963, + "velocityX": 2.2849500757236236, + "velocityY": -0.687230803230894, + "timestamp": 5.642238796944212 + }, + { + "x": 7.296507181265965, + "y": 6.11632182036056, + "heading": -3.350688016235842, + "angularVelocity": -0.3834972344335215, + "velocityX": 2.0134411008549487, + "velocityY": -0.6212669993818719, + "timestamp": 5.726745541629311 + }, + { + "x": 7.443712079914637, + "y": 6.069394499789823, + "heading": -3.379020013186295, + "angularVelocity": -0.3352631444511035, + "velocityX": 1.7419307677417626, + "velocityY": -0.555308582120924, + "timestamp": 5.811252286314411 + }, + { + "x": 7.567972435471327, + "y": 6.02804071771291, + "heading": -3.4032751127228216, + "angularVelocity": -0.28701968851017895, + "velocityX": 1.4704193851002774, + "velocityY": -0.4893548110391755, + "timestamp": 5.8957590309995105 + }, + { + "x": 7.669288180256081, + "y": 5.992260146371071, + "heading": -3.42345173773138, + "angularVelocity": -0.23875756998738332, + "velocityX": 1.1989072015765272, + "velocityY": -0.4234049184496486, + "timestamp": 5.98026577568461 + }, + { + "x": 7.747659263327591, + "y": 5.962052524193432, + "heading": -3.43954810124812, + "angularVelocity": -0.19047430565122664, + "velocityX": 0.9273944152451641, + "velocityY": -0.35745812112634723, + "timestamp": 6.06477252036971 + }, + { + "x": 7.803085647033718, + "y": 5.937417656488415, + "heading": -3.4515626641762043, + "angularVelocity": -0.14217282860503722, + "velocityX": 0.6558811833619133, + "velocityY": -0.2915136276614969, + "timestamp": 6.149279265054809 + }, + { + "x": 7.835567304420652, + "y": 5.918355415748436, + "heading": -3.4594944746796688, + "angularVelocity": -0.09386008812694666, + "velocityX": 0.3843676325241542, + "velocityY": -0.22557064304169885, + "timestamp": 6.233786009739909 }, { "x": 7.845104217529297, "y": 5.904865741729736, "heading": -3.463343389598174, - "angularVelocity": -0.045545607477119734, - "velocityX": 0.11285400331040635, - "velocityY": -0.15962801037190835, - "timestamp": 6.3182931509409865 - }, - { - "x": 7.8291877801389544, - "y": 5.89681783094167, - "heading": -3.4628064836752768, - "angularVelocity": 0.005958713094771777, - "velocityX": -0.17664451043527943, - "velocityY": -0.08931767997576301, - "timestamp": 6.408397492995672 - }, - { - "x": 7.787186304810707, - "y": 5.895105277075071, - "heading": -3.457628506155186, - "angularVelocity": 0.057466459462613945, - "velocityX": -0.46614263386726634, - "velocityY": -0.019006341176760165, - "timestamp": 6.498501835050357 - }, - { - "x": 7.719099838437265, - "y": 5.899728258305112, - "heading": -3.447810162739233, - "angularVelocity": 0.10896637378467465, - "velocityX": -0.7556402368724836, - "velocityY": 0.05130697505382519, - "timestamp": 6.588606177105042 - }, - { - "x": 7.624928441800051, - "y": 5.91068704023302, - "heading": -3.4333528605757375, - "angularVelocity": 0.1604506712309276, - "velocityX": -1.0451371653106436, - "velocityY": 0.12162323899170813, - "timestamp": 6.678710519159727 - }, - { - "x": 7.5046721930394265, - "y": 5.927981975640617, - "heading": -3.414258222079659, - "angularVelocity": 0.21191696271962407, - "velocityX": -1.33463322652798, - "velocityY": 0.19194341818843927, - "timestamp": 6.768814861214413 - }, - { - "x": 7.358331192400225, - "y": 5.951613503654499, - "heading": -3.390527425061893, - "angularVelocity": 0.2633701825752592, - "velocityX": -1.624128175203652, - "velocityY": 0.2622684709194017, - "timestamp": 6.858919203269098 - }, - { - "x": 7.185905568247333, - "y": 5.981582148055597, - "heading": -3.362160369786068, - "angularVelocity": 0.3148245093295144, - "velocityX": -1.9136216992544741, - "velocityY": 0.3325993366991085, - "timestamp": 6.949023545323783 - }, - { - "x": 6.987395484481389, - "y": 6.017888514545585, - "heading": -3.329154675551666, - "angularVelocity": 0.36630525767970984, - "velocityX": -2.203113404295966, - "velocityY": 0.40293692470396786, - "timestamp": 7.039127887378468 - }, - { - "x": 6.762801150184142, - "y": 6.060533287389062, - "heading": -3.2915045124971307, - "angularVelocity": 0.41785070725765294, - "velocityX": -2.492602788897109, - "velocityY": 0.4732821068444771, - "timestamp": 7.129232229433153 - }, - { - "x": 6.512122838133032, - "y": 6.109517231240644, - "heading": -3.249199278174355, - "angularVelocity": 0.46951382539479003, - "velocityX": -2.782089146147601, - "velocityY": 0.5436357753087322, - "timestamp": 7.219336571487839 - }, - { - "x": 6.25129761637582, - "y": 6.172940412685561, - "heading": -3.2015674065543736, - "angularVelocity": 0.5286301473803918, - "velocityX": -2.894702028886867, - "velocityY": 0.7038859615269768, - "timestamp": 7.309440913542524 - }, - { - "x": 6.016555766986995, - "y": 6.230022996704365, - "heading": -3.158627751039872, - "angularVelocity": 0.47655478676534, - "velocityX": -2.605222390352269, - "velocityY": 0.6335164623271993, - "timestamp": 7.399545255597209 - }, - { - "x": 5.807896998539899, - "y": 6.280764356863859, - "heading": -3.1204019441225426, - "angularVelocity": 0.4242393434728108, - "velocityX": -2.3157459861419394, - "velocityY": 0.5631400108187857, - "timestamp": 7.489649597651894 - }, - { - "x": 5.625321043377808, - "y": 6.325163981104701, - "heading": -3.086911147615034, - "angularVelocity": 0.3716890412138256, - "velocityX": -2.026272552451302, - "velocityY": 0.4927578763506812, - "timestamp": 7.579753939706579 - }, - { - "x": 5.468827670291274, - "y": 6.363221451462664, - "heading": -3.058174826591968, - "angularVelocity": 0.31892271080150636, - "velocityX": -1.7368016847795997, - "velocityY": 0.4223711032134899, - "timestamp": 7.669858281761265 - }, - { - "x": 5.3384166918215215, - "y": 6.394936434094527, - "heading": -3.0342097293079573, - "angularVelocity": 0.265970504168003, - "velocityX": -1.4473328975711837, - "velocityY": 0.3519806250026743, - "timestamp": 7.75996262381595 - }, - { - "x": 5.234087969458135, - "y": 6.420308671366275, - "heading": -3.015029066317057, - "angularVelocity": 0.21287168357835284, - "velocityX": -1.1578656475852087, - "velocityY": 0.28158728750661927, - "timestamp": 7.850066965870635 - }, - { - "x": 5.155841417331177, - "y": 6.439337975209735, - "heading": -3.0006418789192395, - "angularVelocity": 0.15967252043287483, - "velocityX": -0.868399350604752, - "velocityY": 0.2111918627840607, - "timestamp": 7.94017130792532 - }, - { - "x": 5.103677004654206, - "y": 6.452024221800112, - "heading": -2.9910525860956274, - "angularVelocity": 0.10642431435537862, - "velocityX": -0.5789333952997849, - "velocityY": 0.14079506382364523, - "timestamp": 8.030275649980005 + "angularVelocity": -0.04554565357886152, + "velocityX": 0.11285386916963824, + "velocityY": -0.15962837130890287, + "timestamp": 6.318292754425008 + }, + { + "x": 7.8291877692828695, + "y": 5.896817799174314, + "heading": -3.462806487691953, + "angularVelocity": 0.0059586689373453934, + "velocityX": -0.1766446433882992, + "velocityY": -0.08931803884268785, + "timestamp": 6.408397090119129 + }, + { + "x": 7.787186284773775, + "y": 5.89510521302273, + "heading": -3.457628514345887, + "angularVelocity": 0.05746641719488619, + "velocityX": -0.46614276866407134, + "velocityY": -0.019006700825120525, + "timestamp": 6.49850142581325 + }, + { + "x": 7.719099810553242, + "y": 5.899728161129094, + "heading": -3.4478101752719477, + "angularVelocity": 0.10896633328799875, + "velocityX": -0.7556403773029171, + "velocityY": 0.05130661106095279, + "timestamp": 6.58860576150737 + }, + { + "x": 7.624928406963597, + "y": 5.91068690868204, + "heading": -3.4333528776383364, + "angularVelocity": 0.1604506322835518, + "velocityX": -1.0451373162478272, + "velocityY": 0.12162286607548435, + "timestamp": 6.678710097201491 + }, + { + "x": 7.504672151559691, + "y": 5.927981807913597, + "heading": -3.414258243895334, + "angularVelocity": 0.21191692492827224, + "velocityX": -1.3346333944699587, + "velocityY": 0.191943030247383, + "timestamp": 6.768814432895612 + }, + { + "x": 7.3583311437665895, + "y": 5.951613297181171, + "heading": -3.3905274519162645, + "angularVelocity": 0.26337014524616154, + "velocityX": -1.624128369248404, + "velocityY": 0.2622680594172169, + "timestamp": 6.858918768589732 + }, + { + "x": 7.185905510719418, + "y": 5.981581899112768, + "heading": -3.362160402078623, + "angularVelocity": 0.3148244711990307, + "velocityX": -1.9136219330500257, + "velocityY": 0.3325988888407347, + "timestamp": 6.949023104283853 + }, + { + "x": 6.987395414269062, + "y": 6.017888217489993, + "heading": -3.329154713906164, + "angularVelocity": 0.36630521626067764, + "velocityX": -2.20311370059087, + "velocityY": 0.4029364191804939, + "timestamp": 7.039127439977974 + }, + { + "x": 6.762801059397413, + "y": 6.060532932740197, + "heading": -3.2915045580545983, + "angularVelocity": 0.41785065681387246, + "velocityX": -2.4926031931924566, + "velocityY": 0.47328150106972355, + "timestamp": 7.129231775672094 + }, + { + "x": 6.512122706581224, + "y": 6.109516798013917, + "heading": -3.2491993338195644, + "angularVelocity": 0.4695137465820559, + "velocityX": -2.7820897949591883, + "velocityY": 0.543634941608216, + "timestamp": 7.219336111366215 + }, + { + "x": 6.25129749629379, + "y": 6.172940093448783, + "heading": -3.201567448489117, + "angularVelocity": 0.5286303368590953, + "velocityX": -2.8947021059326685, + "velocityY": 0.7038872763034365, + "timestamp": 7.309440447060336 + }, + { + "x": 6.016555665157353, + "y": 6.230022757637012, + "heading": -3.1586277825948064, + "angularVelocity": 0.47655493560353174, + "velocityX": -2.6052223716883294, + "velocityY": 0.6335173967877574, + "timestamp": 7.3995447827544565 + }, + { + "x": 5.807896916135595, + "y": 6.280764180000153, + "heading": -3.120401967413272, + "angularVelocity": 0.4242394651385117, + "velocityX": -2.3157459340258364, + "velocityY": 0.5631407409227794, + "timestamp": 7.489649118448577 + }, + { + "x": 5.6253209797030115, + "y": 6.3251638537635975, + "heading": -3.0869111642773346, + "angularVelocity": 0.37168914101569395, + "velocityX": -2.0262724876234564, + "velocityY": 0.4927584607489893, + "timestamp": 7.579753454142698 + }, + { + "x": 5.46882762371635, + "y": 6.363221363605436, + "heading": -3.0581748379825484, + "angularVelocity": 0.31892279182145133, + "velocityX": -1.7368016176037657, + "velocityY": 0.42237157123085867, + "timestamp": 7.6698577898368185 + }, + { + "x": 5.3384166601569225, + "y": 6.394936377267829, + "heading": -3.0342097365921425, + "angularVelocity": 0.26597056851693435, + "velocityX": -1.447332834261574, + "velocityY": 0.35198099423379936, + "timestamp": 7.759962125530939 + }, + { + "x": 5.234087950141294, + "y": 6.420308638173686, + "heading": -3.0150290705159977, + "angularVelocity": 0.21287173284599614, + "velocityX": -1.1578655922817724, + "velocityY": 0.28158756968132703, + "timestamp": 7.85006646122506 + }, + { + "x": 5.155841407533289, + "y": 6.4393379590097926, + "heading": -3.000641880938431, + "angularVelocity": 0.15967255589572538, + "velocityX": -0.8683993062623739, + "velocityY": 0.21119206628086706, + "timestamp": 7.940170796919181 + }, + { + "x": 5.103677001346942, + "y": 6.452024216517568, + "heading": -2.9910525867433884, + "angularVelocity": 0.10642433708846369, + "velocityX": -0.5789333641327775, + "velocityY": 0.14079519492648973, + "timestamp": 8.030275132613301 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 0.053181525635302096, - "velocityX": -0.289467155293118, - "velocityY": 0.07039756101124235, - "timestamp": 8.12037999203469 + "angularVelocity": 0.05318153657845512, + "velocityX": -0.289467139022103, + "velocityY": 0.07039762460765545, + "timestamp": 8.120379468307421 }, { "x": 5.077594757080078, "y": 6.458367347717285, "heading": -2.986260699718794, - "angularVelocity": 6.81746033497351e-25, - "velocityX": -7.666580770428612e-26, - "velocityY": 6.421082950062295e-25, - "timestamp": 8.210484334089376 - }, - { - "x": 5.080107751173253, - "y": 6.458664255646832, - "heading": -2.986987410743646, - "angularVelocity": -0.02623921538488642, - "velocityX": 0.09073619501676995, - "velocityY": 0.010720397580949911, - "timestamp": 8.23817994213984 - }, - { - "x": 5.085138525244606, - "y": 6.459212635742286, - "heading": -2.9884477760132566, - "angularVelocity": -0.052729128277294895, - "velocityX": 0.18164519306403581, - "velocityY": 0.01980025477160606, - "timestamp": 8.265875550190305 - }, - { - "x": 5.092691297903225, - "y": 6.4599637486298365, - "heading": -2.9906490360498172, - "angularVelocity": -0.07948047331365586, - "velocityX": 0.27270651161935916, - "velocityY": 0.02712028875412729, - "timestamp": 8.29357115824077 - }, - { - "x": 5.1027695509630275, - "y": 6.46086523800989, - "heading": -2.99359872097621, - "angularVelocity": -0.10650370705051675, - "velocityX": 0.36389354736097906, - "velocityY": 0.032549903884080994, - "timestamp": 8.321266766291235 - }, - { - "x": 5.115375820999888, - "y": 6.46186078752559, - "heading": -2.9973046369071197, - "angularVelocity": -0.133808794670882, - "velocityX": 0.4551721707604345, - "velocityY": 0.035946115134430356, - "timestamp": 8.3489623743417 - }, - { - "x": 5.130511443380374, - "y": 6.462889747097652, - "heading": -3.0017748444548444, - "angularVelocity": -0.1614049252711666, - "velocityX": 0.5464990099840698, - "velocityY": 0.03715244562195929, - "timestamp": 8.376657982392164 - }, - { - "x": 5.148176238439689, - "y": 6.4638867292256625, - "heading": -3.0070176268610034, - "angularVelocity": -0.18930013728551406, - "velocityX": 0.6378193620854306, - "velocityY": 0.03599784219196293, - "timestamp": 8.404353590442629 - }, - { - "x": 5.1683681275776605, - "y": 6.464781177655068, - "heading": -3.0130414446609124, - "angularVelocity": -0.21750083222338853, - "velocityX": 0.7290646625696118, - "velocityY": 0.03229567763146106, - "timestamp": 8.432049198493093 - }, - { - "x": 5.191082665034589, - "y": 6.46549691365525, - "heading": -3.0198548730944523, - "angularVelocity": -0.24601115170048243, - "velocityX": 0.8201494408622356, - "velocityY": 0.02584294227727148, - "timestamp": 8.459744806543558 - }, - { - "x": 5.216312469195933, - "y": 6.46595166928297, - "heading": -3.0274665177164044, - "angularVelocity": -0.2748321902910632, - "velocityX": 0.9109676926165635, - "velocityY": 0.016419774098878303, - "timestamp": 8.487440414594023 - }, - { - "x": 5.244046535806501, - "y": 6.466056622814985, - "heading": -3.0358849028723838, - "angularVelocity": -0.3039610157913839, - "velocityX": 1.0013886158423948, - "velocityY": 0.0037895370206108333, - "timestamp": 8.515136022644487 - }, - { - "x": 5.274269415037942, - "y": 6.465715959448529, - "heading": -3.0451183269591553, - "angularVelocity": -0.33338946990971013, - "velocityX": 1.0912516950835975, - "velocityY": -0.012300266736711637, - "timestamp": 8.542831630694952 - }, - { - "x": 5.306960235866464, - "y": 6.4648264907503386, - "heading": -3.05517467776126, - "angularVelocity": -0.36310272674933947, - "velocityX": 1.18036118827779, - "velocityY": -0.0321158754330219, - "timestamp": 8.570527238745417 - }, - { - "x": 5.3420915660214945, - "y": 6.463277379304427, - "heading": -3.0660612007183974, - "angularVelocity": -0.3930775932884671, - "velocityX": 1.2684801897476814, - "velocityY": -0.05593346941828854, - "timestamp": 8.598222846795881 - }, - { - "x": 5.379628105658185, - "y": 6.460950030133952, - "heading": -3.0777842127338517, - "angularVelocity": -0.42328054304110213, - "velocityX": 1.3553246265001357, - "velocityY": -0.08403314945225146, - "timestamp": 8.625918454846346 - }, - { - "x": 5.41952523001788, - "y": 6.457718226299439, - "heading": -3.0903487539619023, - "angularVelocity": -0.4536654766761787, - "velocityX": 1.440557805663538, - "velocityY": -0.11669012027553252, - "timestamp": 8.65361406289681 - }, - { - "x": 5.461727422684295, - "y": 6.453448599535394, - "heading": -3.1037581696728, - "angularVelocity": -0.48417119734160885, - "velocityX": 1.5237864642480061, - "velocityY": -0.1541625934431737, - "timestamp": 8.681309670947275 - }, - { - "x": 5.506166677536889, - "y": 6.448001532672273, - "heading": -3.1180136136798957, - "angularVelocity": -0.51471857852411, - "velocityX": 1.6045596389008698, - "velocityY": -0.19667619693330898, - "timestamp": 8.70900527899774 - }, - { - "x": 5.5527609923492784, - "y": 6.441232581553373, - "heading": -3.133113464661269, - "angularVelocity": -0.5452074189474115, - "velocityX": 1.68237197491708, - "velocityY": -0.24440521784415084, - "timestamp": 8.736700887048205 - }, - { - "x": 5.60141312366844, - "y": 6.432994471961219, - "heading": -3.1490526497734637, - "angularVelocity": -0.5755130951864894, - "velocityX": 1.75667316025385, - "velocityY": -0.29745184063635494, - "timestamp": 8.76439649509867 - }, - { - "x": 5.652009808542854, - "y": 6.423139665806347, - "heading": -3.1658218818373203, - "angularVelocity": -0.6054834410315529, - "velocityX": 1.8268847819560778, - "velocityY": -0.35582559288520166, - "timestamp": 8.792092103149134 - }, - { - "x": 5.704421666252762, - "y": 6.411523401958046, - "heading": -3.183406843958928, - "angularVelocity": -0.6349368495382306, - "velocityX": 1.8924248788619584, - "velocityY": -0.419426207474268, - "timestamp": 8.819787711199599 - }, - { - "x": 5.758503955194236, - "y": 6.398007014259739, - "heading": -3.201787400905252, - "angularVelocity": -0.6636632390533842, - "velocityX": 1.9527388184772771, - "velocityY": -0.4880336143434415, - "timestamp": 8.847483319250063 - }, - { - "x": 5.8140982688799205, - "y": 6.382461238924243, - "heading": -3.220936968623995, - "angularVelocity": -0.6914297632985671, - "velocityX": 2.0073332054810007, - "velocityY": -0.5613083239468838, - "timestamp": 8.875178927300528 - }, - { - "x": 5.871035121611879, - "y": 6.364769177707707, - "heading": -3.2408222043743016, - "angularVelocity": -0.7179923876043237, - "velocityX": 2.055808004944776, - "velocityY": -0.6388038559868158, - "timestamp": 8.902874535350993 + "angularVelocity": 4.933852135685226e-24, + "velocityX": 6.910665862954014e-23, + "velocityY": -2.160330311328782e-22, + "timestamp": 8.21048380400154 + }, + { + "x": 5.080107750922132, + "y": 6.4586642554977765, + "heading": -2.986987410677254, + "angularVelocity": -0.026239217300952723, + "velocityX": 0.09073620086499802, + "velocityY": 0.010720393961257955, + "timestamp": 8.238179407499345 + }, + { + "x": 5.085138524507197, + "y": 6.4592126353095916, + "heading": -2.988447775816188, + "angularVelocity": -0.05272913222670491, + "velocityX": 0.18164520536494946, + "velocityY": 0.01980024778510464, + "timestamp": 8.26587501099715 + }, + { + "x": 5.092691296461665, + "y": 6.459963747794391, + "heading": -2.990649035659873, + "angularVelocity": -0.07948047941471853, + "velocityX": 0.2727065310227512, + "velocityY": 0.0271202786702021, + "timestamp": 8.293570614494953 + }, + { + "x": 5.102769548618277, + "y": 6.460865236669119, + "heading": -2.993598720333269, + "angularVelocity": -0.10650371542289774, + "velocityX": 0.36389357456721133, + "velocityY": 0.03254989098898449, + "timestamp": 8.321266217992758 + }, + { + "x": 5.115375817573453, + "y": 6.461860785594569, + "heading": -2.997304635953141, + "angularVelocity": -0.1338088054360665, + "velocityX": 0.4551722065263811, + "velocityY": 0.03594609973127802, + "timestamp": 8.348961821490562 + }, + { + "x": 5.130511438716252, + "y": 6.4628897445102735, + "heading": -3.0017748431338958, + "angularVelocity": -0.16140493855312305, + "velocityX": 0.5464990551298429, + "velocityY": 0.03715242803017215, + "timestamp": 8.376657424988366 + }, + { + "x": 5.148176232406587, + "y": 6.4638867259358275, + "heading": -3.007017625119319, + "angularVelocity": -0.18930015321164578, + "velocityX": 0.6378194175019449, + "velocityY": 0.035997822745898966, + "timestamp": 8.40435302848617 + }, + { + "x": 5.1683681200714915, + "y": 6.4647811736378795, + "heading": -3.013041442446997, + "angularVelocity": -0.21750085092589103, + "velocityX": 0.7290647292270105, + "velocityY": 0.03229565667788419, + "timestamp": 8.432048631983974 + }, + { + "x": 5.191082655981316, + "y": 6.465496908908166, + "heading": -3.019854870359249, + "angularVelocity": -0.24601117331826733, + "velocityX": 0.8201495198191305, + "velocityY": 0.02584292017118624, + "timestamp": 8.459744235481779 + }, + { + "x": 5.2163124585547775, + "y": 6.4659516638268535, + "heading": -3.02746651441355, + "angularVelocity": -0.27483221497246374, + "velocityX": 0.9109677850299317, + "velocityY": 0.016419751197107906, + "timestamp": 8.487439838979583 + }, + { + "x": 5.244046523573541, + "y": 6.4660566166949724, + "heading": -3.035884898958586, + "angularVelocity": -0.3039610436979258, + "velocityX": 1.0013887229777827, + "velocityY": 0.003789513672319083, + "timestamp": 8.515135442477387 + }, + { + "x": 5.274269401250127, + "y": 6.465715952734587, + "heading": -3.045118322394742, + "angularVelocity": -0.3333895012213158, + "velocityX": 1.091251818324991, + "velocityY": -0.012300290203546045, + "timestamp": 8.542831045975191 + }, + { + "x": 5.30696022060602, + "y": 6.464826483537375, + "heading": -3.0551746725109514, + "angularVelocity": -0.3631027616714286, + "velocityX": 1.1803613291360742, + "velocityY": -0.03211589873034425, + "timestamp": 8.570526649472995 + }, + { + "x": 5.3420915494206636, + "y": 6.463277371711745, + "heading": -3.0660611947523826, + "angularVelocity": -0.39307763206150964, + "velocityX": 1.268480349865999, + "velocityY": -0.05593349232317884, + "timestamp": 8.5982222529708 + }, + { + "x": 5.379628087904175, + "y": 6.460950022303807, + "heading": -3.077784206029261, + "angularVelocity": -0.4232805859532344, + "velocityX": 1.355324807653638, + "velocityY": -0.08403317183976639, + "timestamp": 8.625917856468604 + }, + { + "x": 5.419525211357798, + "y": 6.4577182183944455, + "heading": -3.0903487465047883, + "angularVelocity": -0.4536655240794423, + "velocityX": 1.4405580097500568, + "velocityY": -0.11669014215987741, + "timestamp": 8.653613459966408 + }, + { + "x": 5.4617274034297, + "y": 6.453448591734476, + "heading": -3.103758161460742, + "angularVelocity": -0.48417124967206376, + "velocityX": 1.5237866932651936, + "velocityY": -0.15416261502686032, + "timestamp": 8.681309063464212 + }, + { + "x": 5.506166658067458, + "y": 6.448001525164964, + "heading": -3.1180136047253373, + "angularVelocity": -0.5147186363252797, + "velocityX": 1.6045598949046982, + "velocityY": -0.1966762186621121, + "timestamp": 8.709004666962016 + }, + { + "x": 5.552760973114925, + "y": 6.441232574532317, + "heading": -3.13311345499563, + "angularVelocity": -0.5452074828949123, + "velocityX": 1.6823722599568172, + "velocityY": -0.24440524046294754, + "timestamp": 8.73670027045982 + }, + { + "x": 5.601413105189096, + "y": 6.432994465613015, + "heading": -3.149052639451952, + "angularVelocity": -0.5755131661090493, + "velocityX": 1.7566734762804503, + "velocityY": -0.2974518652375824, + "timestamp": 8.764395873957625 + }, + { + "x": 5.652009791405134, + "y": 6.423139660301141, + "heading": -3.1658218709441153, + "angularVelocity": -0.6054835199201767, + "velocityX": 1.8268851307049931, + "velocityY": -0.355825620938548, + "timestamp": 8.792091477455429 + }, + { + "x": 5.704421651102894, + "y": 6.411523397438684, + "heading": -3.1834068326121203, + "angularVelocity": -0.6349369375323259, + "velocityX": 1.892425261717684, + "velocityY": -0.4194262408247933, + "timestamp": 8.819787080953233 + }, + { + "x": 5.758503942727014, + "y": 6.398007010831586, + "heading": -3.201787389260581, + "angularVelocity": -0.6636633373928178, + "velocityX": 1.9527392363343576, + "velocityY": -0.48803365516730274, + "timestamp": 8.847482684451037 + }, + { + "x": 5.814098259824012, + "y": 6.382461236647001, + "heading": -3.220936956876279, + "angularVelocity": -0.6914298732366274, + "velocityX": 2.0073336586222608, + "velocityY": -0.5613083746601761, + "timestamp": 8.875178287948842 + }, + { + "x": 5.871035116712426, + "y": 6.364769176590407, + "heading": -3.2408221927556276, + "angularVelocity": -0.7179925102887033, + "velocityX": 2.055808492959182, + "velocityY": -0.6388039191129229, + "timestamp": 8.902873891446646 }, { "x": 5.929137229919434, "y": 6.3448286056518555, - "heading": -3.261403158823053, - "angularVelocity": -0.7431125690127658, - "velocityX": 2.097881664186096, - "velocityY": -0.7199904049594251, - "timestamp": 8.930570143401457 - }, - { - "x": 6.007302079253197, - "y": 6.314544148535294, - "heading": -3.2896107940616304, - "angularVelocity": -0.7739403089677718, - "velocityX": 2.1446295349515356, - "velocityY": -0.8309226172089168, - "timestamp": 8.967016927361062 - }, - { - "x": 6.087114829660797, - "y": 6.280193048985801, - "heading": -3.3189187673686584, - "angularVelocity": -0.8041305740312225, - "velocityX": 2.189843430247822, - "velocityY": -0.9425001555025164, - "timestamp": 9.003463711320666 - }, - { - "x": 6.168508639016323, - "y": 6.241748383978386, - "heading": -3.3493003097546983, - "angularVelocity": -0.8335863712889872, - "velocityX": 2.233223360550562, - "velocityY": -1.0548163879157417, - "timestamp": 9.039910495280271 - }, - { - "x": 6.251402252665518, - "y": 6.199179142701848, - "heading": -3.3807240473323636, - "angularVelocity": -0.862181354944645, - "velocityX": 2.2743738855278037, - "velocityY": -1.1679834721143234, - "timestamp": 9.076357279239875 - }, - { - "x": 6.335694920423886, - "y": 6.152449426910681, - "heading": -3.413152371425761, - "angularVelocity": -0.889744459465611, - "velocityX": 2.3127601011873846, - "velocityY": -1.2821355059190056, - "timestamp": 9.11280406319948 - }, - { - "x": 6.421258702601704, - "y": 6.101517611306378, - "heading": -3.446538850206088, - "angularVelocity": -0.9160336016843442, - "velocityX": 2.3476360019214253, - "velocityY": -1.3974296239896904, - "timestamp": 9.149250847159085 - }, - { - "x": 6.507926335867612, - "y": 6.046335751863277, - "heading": -3.4808239104526053, - "angularVelocity": -0.940688217773002, - "velocityX": 2.3779226546289447, - "velocityY": -1.5140391949057066, - "timestamp": 9.185697631118689 - }, - { - "x": 6.59547117634327, - "y": 5.986850182434709, - "heading": -3.515927196529912, - "angularVelocity": -0.963138095153033, - "velocityX": 2.4019908196204427, - "velocityY": -1.6321212180065312, - "timestamp": 9.222144415078294 - }, - { - "x": 6.683572317876966, - "y": 5.923006316810353, - "heading": -3.551733094358475, - "angularVelocity": -0.9824158386169006, - "velocityX": 2.41725419810277, - "velocityY": -1.7517009373205057, - "timestamp": 9.258591199037898 - }, - { - "x": 6.771751179698686, - "y": 5.8547676777551505, - "heading": -3.588061329459728, - "angularVelocity": -0.9967473437853483, - "velocityX": 2.4193866300920903, - "velocityY": -1.8722814921293554, - "timestamp": 9.295037982997503 - }, - { - "x": 6.859256922629332, - "y": 5.782183607463669, - "heading": -3.6246053528816105, - "angularVelocity": -1.002667984708512, - "velocityX": 2.4009180899921043, - "velocityY": -1.9915082321647621, - "timestamp": 9.331484766957107 - }, - { - "x": 6.944909301097948, - "y": 5.705612424409275, - "heading": -3.66082549221537, - "angularVelocity": -0.9937814917745361, - "velocityX": 2.350066841660152, - "velocityY": -2.1009036939792307, - "timestamp": 9.367931550916712 - }, - { - "x": 7.027210040237496, - "y": 5.626208101741732, - "heading": -3.695966962162754, - "angularVelocity": -0.9641857560418463, - "velocityX": 2.258107031631849, - "velocityY": -2.178637290893834, - "timestamp": 9.404378334876316 - }, - { - "x": 7.10523023177058, - "y": 5.5458858745426305, - "heading": -3.729586198529605, - "angularVelocity": -0.922419832820185, - "velocityX": 2.1406605208173795, - "velocityY": -2.2038220790105076, - "timestamp": 9.440825118835921 - }, - { - "x": 7.178929482816853, - "y": 5.46624650139777, - "heading": -3.761625249399457, - "angularVelocity": -0.8790638676203348, - "velocityX": 2.0221057399182083, - "velocityY": -2.1850864326775583, - "timestamp": 9.477271902795525 - }, - { - "x": 7.248572018663502, - "y": 5.388245426263194, - "heading": -3.7921242323865507, - "angularVelocity": -0.8368086199566389, - "velocityX": 1.9108005777365134, - "velocityY": -2.1401360191623633, - "timestamp": 9.51371868675513 - }, - { - "x": 7.314425791413534, - "y": 5.3124347260695295, - "heading": -3.8211367419380795, - "angularVelocity": -0.7960238572403343, - "velocityX": 1.8068472878984692, - "velocityY": -2.080038125659881, - "timestamp": 9.550165470714735 - }, - { - "x": 7.376706932700329, - "y": 5.239153810976348, - "heading": -3.848710463005587, - "angularVelocity": -0.7565474390845812, - "velocityX": 1.7088240585458914, - "velocityY": -2.010627746316465, - "timestamp": 9.586612254674339 - }, - { - "x": 7.435583508205619, - "y": 5.168626359627546, - "heading": -3.8748845295229897, - "angularVelocity": -0.7181447489691611, - "velocityX": 1.6154120915180508, - "velocityY": -1.9350802371746179, - "timestamp": 9.623059038633944 - }, - { - "x": 7.491186989763459, - "y": 5.1010086867569635, - "heading": -3.8996906746747757, - "angularVelocity": -0.6806127305849615, - "velocityX": 1.5256073517890731, - "velocityY": -1.8552438795567412, - "timestamp": 9.659505822593548 - }, - { - "x": 7.543621925479677, - "y": 5.036415277092429, - "heading": -3.9231548106792564, - "angularVelocity": -0.6437916725516183, - "velocityX": 1.4386711259444849, - "velocityY": -1.77226637434259, - "timestamp": 9.695952606553153 - }, - { - "x": 7.5929729609126495, - "y": 4.9749331712566045, - "heading": -3.9452983490202, - "angularVelocity": -0.6075580870314048, - "velocityX": 1.3540573425537872, - "velocityY": -1.686900712665603, - "timestamp": 9.732399390512757 - }, - { - "x": 7.639309796246505, - "y": 4.916630564506439, - "heading": -3.9661392022496167, - "angularVelocity": -0.5718159729131582, - "velocityX": 1.2713559414518842, - "velocityY": -1.5996639597827182, - "timestamp": 9.768846174472362 - }, - { - "x": 7.682690702150729, - "y": 4.861562214126618, - "heading": -3.985692529782674, - "angularVelocity": -0.5364897916570514, - "velocityX": 1.1902533280386327, - "velocityY": -1.5109248168743088, - "timestamp": 9.805292958431966 - }, - { - "x": 7.723165050651695, - "y": 4.809772989497631, - "heading": -4.0039712958577836, - "angularVelocity": -0.5015193136208964, - "velocityX": 1.1105053479019453, - "velocityY": -1.4209545809690254, - "timestamp": 9.841739742391571 - }, - { - "x": 7.760775169567723, - "y": 4.761300289482094, - "heading": -4.0209866925236675, - "angularVelocity": -0.4668559147699564, - "velocityX": 1.0319187272521548, - "velocityY": -1.3299582226312006, - "timestamp": 9.878186526351175 - }, - { - "x": 7.795557725829888, - "y": 4.716175740629966, - "heading": -4.036748465365555, - "angularVelocity": -0.432459908104854, - "velocityX": 0.9543381468366806, - "velocityY": -1.2380941183217342, - "timestamp": 9.91463331031078 - }, - { - "x": 7.827544775062806, - "y": 4.674426422561036, - "heading": -4.051265168296167, - "angularVelocity": -0.3982985973934382, - "velocityX": 0.8776370850270793, - "velocityY": -1.1454870233599284, - "timestamp": 9.951080094270385 - }, - { - "x": 7.856764570580477, - "y": 4.636075772943556, - "heading": -4.06454436578724, - "angularVelocity": -0.36434483508316046, - "velocityX": 0.8017112168266097, - "velocityY": -1.0522368629283385, - "timestamp": 9.987526878229989 - }, - { - "x": 7.883242196001707, - "y": 4.601144269537644, - "heading": -4.076592795479517, - "angularVelocity": -0.33057593519446465, - "velocityX": 0.7264735744744237, - "velocityY": -0.9584248488050204, - "timestamp": 10.023973662189594 - }, - { - "x": 7.907000066488958, - "y": 4.569649953472743, - "heading": -4.08741650039222, - "angularVelocity": -0.2969728392140157, - "velocityX": 0.6518509428317129, - "velocityY": -0.8641178354668736, - "timestamp": 10.060420446149198 - }, - { - "x": 7.928058330680547, - "y": 4.541608837107262, - "heading": -4.097020937393002, - "angularVelocity": -0.263519464746925, - "velocityX": 0.577781134679236, - "velocityY": -0.7693714868384814, - "timestamp": 10.096867230108803 - }, - { - "x": 7.946435196531025, - "y": 4.517035226431758, - "heading": -4.10541106680612, - "angularVelocity": -0.2302021880014778, - "velocityX": 0.504210902965987, - "velocityY": -0.6742326209835452, - "timestamp": 10.133314014068407 - }, - { - "x": 7.9621471981139855, - "y": 4.495941979152886, - "heading": -4.11259142677868, - "angularVelocity": -0.19700942559207696, - "velocityX": 0.43109432097973954, - "velocityY": -0.5787409748484375, - "timestamp": 10.169760798028012 - }, - { - "x": 7.975209416089089, - "y": 4.47834071364718, - "heading": -4.11856619512576, - "angularVelocity": -0.16393129099408016, - "velocityX": 0.3583915110200509, - "velocityY": -0.48293055225983417, - "timestamp": 10.206207581987616 - }, - { - "x": 7.985635661414927, - "y": 4.464241979882344, - "heading": -4.123339240724452, - "angularVelocity": -0.13095930779465687, - "velocityX": 0.2860676359646435, - "velocityY": -0.38683066743181205, - "timestamp": 10.242654365947221 - }, - { - "x": 7.993438629621695, - "y": 4.453655400537663, - "heading": -4.126914166049869, - "angularVelocity": -0.09808616665271669, - "velocityX": 0.2140920915111967, - "velocityY": -0.2904667626206573, - "timestamp": 10.279101149906825 - }, - { - "x": 7.998630031288323, - "y": 4.446589788513624, - "heading": -4.129294342092437, - "angularVelocity": -0.06530551626189512, - "velocityX": 0.14243785329269415, - "velocityY": -0.193861055940361, - "timestamp": 10.31554793386643 + "heading": -3.2614031475973326, + "angularVelocity": -0.74311270535547, + "velocityX": 2.097882185943911, + "velocityY": -0.7199904829708007, + "timestamp": 8.93056949494445 + }, + { + "x": 6.007302084591608, + "y": 6.314544151241208, + "heading": -3.289610783038514, + "angularVelocity": -0.7739404627397579, + "velocityX": 2.1446300921291948, + "velocityY": -0.8309227020914641, + "timestamp": 8.967016271924331 + }, + { + "x": 6.087114841402334, + "y": 6.280193054798532, + "heading": -3.3189187570009855, + "angularVelocity": -0.8041307460094369, + "velocityX": 2.1898440252970555, + "velocityY": -0.942500250752998, + "timestamp": 9.003463048904212 + }, + { + "x": 6.1685086583378625, + "y": 6.241748393148706, + "heading": -3.349300300529803, + "angularVelocity": -0.8335865622792533, + "velocityX": 2.233223996197488, + "velocityY": -1.0548164977948045, + "timestamp": 9.039909825884093 + }, + { + "x": 6.2514022808693275, + "y": 6.19917915529385, + "heading": -3.3807240397738494, + "angularVelocity": -0.8621815657771995, + "velocityX": 2.274374564785891, + "velocityY": -1.1679836019068028, + "timestamp": 9.076356602863974 + }, + { + "x": 6.335694958951068, + "y": 6.152449442751412, + "heading": -3.4131523660951144, + "angularVelocity": -0.8897446909823113, + "velocityX": 2.312760827336565, + "velocityY": -1.282135662317486, + "timestamp": 9.112803379843855 + }, + { + "x": 6.421258753043241, + "y": 6.101517629914425, + "heading": -3.446538847703636, + "angularVelocity": -0.9160338547068533, + "velocityX": 2.3476367784017027, + "velocityY": -1.3974298156762228, + "timestamp": 9.149250156823737 + }, + { + "x": 6.507926399966151, + "y": 6.046335772344393, + "heading": -3.480823911416441, + "angularVelocity": -0.9406884930245291, + "velocityX": 2.377923484722704, + "velocityY": -1.5140394334591976, + "timestamp": 9.185696933803618 + }, + { + "x": 6.595471255967786, + "y": 5.98685020332471, + "heading": -3.5159272016289207, + "angularVelocity": -0.963138393056194, + "velocityX": 2.4019917056029767, + "velocityY": -1.6321215193463872, + "timestamp": 9.222143710783499 + }, + { + "x": 6.683572414922371, + "y": 5.923006335834524, + "heading": -3.551733104267443, + "angularVelocity": -0.9824161587261235, + "velocityX": 2.417255138999483, + "velocityY": -1.7517013239724988, + "timestamp": 9.25859048776338 + }, + { + "x": 6.771751295777157, + "y": 5.854767691472866, + "heading": -3.588061344776338, + "angularVelocity": -0.996747683037885, + "velocityX": 2.4193876156309213, + "velocityY": -1.8722819962743453, + "timestamp": 9.29503726474326 + }, + { + "x": 6.85925705819262, + "y": 5.78218361088312, + "heading": -3.62460537385057, + "angularVelocity": -1.0026683318089968, + "velocityX": 2.400919084388938, + "velocityY": -1.991508896103873, + "timestamp": 9.331484041723142 + }, + { + "x": 6.944909453348972, + "y": 5.705612411431668, + "heading": -3.6608255179525564, + "angularVelocity": -0.9937818129153185, + "velocityX": 2.3500677495744626, + "velocityY": -2.1009045462022984, + "timestamp": 9.367930818703023 + }, + { + "x": 7.027210201354827, + "y": 5.62620806893484, + "heading": -3.695966990119588, + "angularVelocity": -0.9641860015888399, + "velocityX": 2.258107707336853, + "velocityY": -2.1786382521741054, + "timestamp": 9.404377595682904 + }, + { + "x": 7.105230393366097, + "y": 5.545885824395972, + "heading": -3.7295862270405054, + "angularVelocity": -0.922420024669837, + "velocityX": 2.140660943883689, + "velocityY": -2.203822976808266, + "timestamp": 9.440824372662785 + }, + { + "x": 7.178929639725794, + "y": 5.466246438659954, + "heading": -3.7616252777879366, + "angularVelocity": -0.8790640326061538, + "velocityX": 2.0221059985737635, + "velocityY": -2.1850871965984764, + "timestamp": 9.477271149642666 + }, + { + "x": 7.248572168134217, + "y": 5.388245355286236, + "heading": -3.792124260256352, + "angularVelocity": -0.8368087659781548, + "velocityX": 1.9108007395788675, + "velocityY": -2.1401366550676073, + "timestamp": 9.513717926622547 + }, + { + "x": 7.31442593199645, + "y": 5.3124346503317215, + "heading": -3.821136769002482, + "angularVelocity": -0.7960239875845612, + "velocityX": 1.8068473900609938, + "velocityY": -2.0800386546213447, + "timestamp": 9.550164703602428 + }, + { + "x": 7.376707063653561, + "y": 5.239153733180057, + "heading": -3.8487104890382855, + "angularVelocity": -0.7565475556597182, + "velocityX": 1.7088241215812134, + "velocityY": -2.0106281878399503, + "timestamp": 9.58661148058231 + }, + { + "x": 7.4355836291988595, + "y": 5.168626281863128, + "heading": -3.874884554340605, + "angularVelocity": -0.7181448531585788, + "velocityX": 1.615412127601827, + "velocityY": -1.9350806068767121, + "timestamp": 9.62305825756219 + }, + { + "x": 7.491187100722936, + "y": 5.101008610638961, + "heading": -3.8996906981294193, + "angularVelocity": -0.6806128235291476, + "velocityX": 1.525607368650723, + "velocityY": -1.8552441896712295, + "timestamp": 9.659505034542072 + }, + { + "x": 7.543622026501356, + "y": 5.036415203861435, + "heading": -3.9231548326544954, + "angularVelocity": -0.6437917552498216, + "velocityX": 1.4386711287904919, + "velocityY": -1.7722666345280043, + "timestamp": 9.695951811521953 + }, + { + "x": 7.592973052210523, + "y": 4.974933101854329, + "heading": -3.945298369428269, + "angularVelocity": -0.607558160382675, + "velocityX": 1.3540573350672032, + "velocityY": -1.686900930665162, + "timestamp": 9.732398588501834 + }, + { + "x": 7.639309878120076, + "y": 4.916630499631534, + "heading": -3.9661392210291537, + "angularVelocity": -0.5718160377360476, + "velocityX": 1.2713559263452057, + "velocityY": -1.5996641419069288, + "timestamp": 9.768845365481715 + }, + { + "x": 7.682690774963622, + "y": 4.861562154276881, + "heading": -3.98569254689674, + "angularVelocity": -0.5364898487012988, + "velocityX": 1.1902533073773187, + "velocityY": -1.5109249683463282, + "timestamp": 9.805292142461596 + }, + { + "x": 7.723165114817025, + "y": 4.809772935002484, + "heading": -4.003971311292077, + "angularVelocity": -0.5015193635757659, + "velocityX": 1.1105053233032058, + "velocityY": -1.4209547061729377, + "timestamp": 9.841738919441477 + }, + { + "x": 7.760775225537743, + "y": 4.761300240527998, + "heading": -4.020986706284907, + "angularVelocity": -0.4668559582709364, + "velocityX": 1.031918700012345, + "velocityY": -1.3299583252929026, + "timestamp": 9.878185696421358 + }, + { + "x": 7.79555777408847, + "y": 4.716175697280637, + "heading": -4.036748477480001, + "angularVelocity": -0.43245994573936725, + "velocityX": 0.9543381180159589, + "velocityY": -1.2380942016428516, + "timestamp": 9.91463247340124 + }, + { + "x": 7.827544816119829, + "y": 4.674426384773752, + "heading": -4.051265178808281, + "angularVelocity": -0.39829862970583335, + "velocityX": 0.8776370555074606, + "velocityY": -1.1454870901185914, + "timestamp": 9.95107925038112 + }, + { + "x": 7.856764604967555, + "y": 4.636075740582476, + "heading": -4.0645443747584675, + "angularVelocity": -0.3643448625791197, + "velocityX": 0.801711187352885, + "velocityY": -1.0522369155562157, + "timestamp": 9.987526027361001 + }, + { + "x": 7.883242224268873, + "y": 4.601144242384833, + "heading": -4.076592802987174, + "angularVelocity": -0.3305759583449084, + "velocityX": 0.7264735456837021, + "velocityY": -0.9584248894470645, + "timestamp": 10.023972804340882 + }, + { + "x": 7.907000089202039, + "y": 4.569649931237369, + "heading": -4.087416506528491, + "angularVelocity": -0.29697285845856597, + "velocityX": 0.6518509152752107, + "velocityY": -0.8641178660282948, + "timestamp": 10.060419581320764 + }, + { + "x": 7.92805834841907, + "y": 4.541608819433365, + "heading": -4.097020942264019, + "angularVelocity": -0.2635194804969814, + "velocityX": 0.5777811088386537, + "velocityY": -0.7693715090221326, + "timestamp": 10.096866358300645 + }, + { + "x": 7.946435209886507, + "y": 4.517035212904852, + "heading": -4.10541107053113, + "angularVelocity": -0.2302022006429521, + "velocityX": 0.5042108792660284, + "velocityY": -0.6742326363200164, + "timestamp": 10.133313135280526 + }, + { + "x": 7.9621472076885365, + "y": 4.495941969305627, + "heading": -4.112591429489288, + "angularVelocity": -0.1970094354878312, + "velocityX": 0.4310942997978278, + "velocityY": -0.5787409847205335, + "timestamp": 10.169759912260407 + }, + { + "x": 7.975209422494241, + "y": 4.478340706964249, + "heading": -4.118566196965234, + "angularVelocity": -0.16393129848610621, + "velocityX": 0.35839149269397597, + "velocityY": -0.4829305579226738, + "timestamp": 10.206206689240288 + }, + { + "x": 7.985635665270655, + "y": 4.464241975804708, + "heading": -4.123339241847092, + "angularVelocity": -0.13095931320603413, + "velocityX": 0.28606762079865283, + "velocityY": -0.38683067002947596, + "timestamp": 10.242653466220169 + }, + { + "x": 7.993438631555588, + "y": 4.453655398466285, + "heading": -4.126914166620439, + "angularVelocity": -0.0980861702893798, + "velocityX": 0.2140920797809049, + "velocityY": -0.2904667632000886, + "timestamp": 10.27910024320005 + }, + { + "x": 7.9986300319348755, + "y": 4.446589787812739, + "heading": -4.12929434228564, + "angularVelocity": -0.06530551841424088, + "velocityX": 0.14243784524907988, + "velocityY": -0.19386105546305826, + "timestamp": 10.315547020179931 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": -0.032611781036393526, - "velocityX": 0.07108094474255332, - "velocityY": -0.09703305984719977, - "timestamp": 10.351994717826035 + "angularVelocity": -0.0326117819807531, + "velocityX": 0.07108094061524496, + "velocityY": -0.09703305919912024, + "timestamp": 10.351993797159812 }, { "x": 8.001220703125, "y": 4.443053245544434, "heading": -4.1304829366304086, - "angularVelocity": 5.43498274287512e-28, - "velocityX": -9.773776117093748e-27, - "velocityY": -3.005417448336995e-26, - "timestamp": 10.388441501785639 - }, - { - "x": 7.9978628064592465, - "y": 4.441693189778957, - "heading": -4.12972677682109, - "angularVelocity": 0.022841316519794305, - "velocityX": -0.1014319719694858, - "velocityY": -0.04108319939911529, - "timestamp": 10.421546415360265 - }, - { - "x": 7.991138812092924, - "y": 4.438993628277519, - "heading": -4.128211445533363, - "angularVelocity": 0.04577360651647058, - "velocityX": -0.20311167256684373, - "velocityY": -0.081545644133843, - "timestamp": 10.45465132893489 - }, - { - "x": 7.981040039615165, - "y": 4.434976715873705, - "heading": -4.12593384407128, - "angularVelocity": 0.06879949881000491, - "velocityX": -0.3050535823026586, - "velocityY": -0.12133885789367849, - "timestamp": 10.487756242509516 - }, - { - "x": 7.967557291029649, - "y": 4.429666404764379, - "heading": -4.122890785038121, - "angularVelocity": 0.09192167278430328, - "velocityX": -0.40727333587877107, - "velocityY": -0.16040854773284244, - "timestamp": 10.520861156084141 - }, - { - "x": 7.950680809544412, - "y": 4.423088668530895, - "heading": -4.119078991959019, - "angularVelocity": 0.11514281922257556, - "velocityX": -0.5097878128330726, - "velocityY": -0.1986936536975387, - "timestamp": 10.553966069658767 - }, - { - "x": 7.930400235453064, - "y": 4.415271764180474, - "heading": -4.114495100547863, - "angularVelocity": 0.13846559063875805, - "velocityX": -0.6126152253994589, - "velocityY": -0.23612520035131226, - "timestamp": 10.587070983233392 - }, - { - "x": 7.90670455942382, - "y": 4.406246540435963, - "heading": -4.109135662098499, - "angularVelocity": 0.16189253710883125, - "velocityX": -0.7157751968096621, - "velocityY": -0.2726248997499001, - "timestamp": 10.620175896808018 - }, - { - "x": 7.879582073874223, - "y": 4.396046802675373, - "heading": -4.102997149666274, - "angularVelocity": 0.18542602198272123, - "velocityX": -0.8192888191191472, - "velocityY": -0.3081034402218639, - "timestamp": 10.653280810382643 - }, - { - "x": 7.849020323685139, - "y": 4.384709747772971, - "heading": -4.096075967969171, - "angularVelocity": 0.2090681095270295, - "velocityX": -0.923178673165617, - "velocityY": -0.34245837485262026, - "timestamp": 10.686385723957269 - }, - { - "x": 7.815006058419893, - "y": 4.372276485863039, - "heading": -4.088368468312413, - "angularVelocity": 0.23282041318080082, - "velocityX": -1.027468783102857, - "velocityY": -0.3755714958114766, - "timestamp": 10.719490637531894 - }, - { - "x": 7.777525189659056, - "y": 4.358792671072697, - "heading": -4.079870970377267, - "angularVelocity": 0.2566838882086457, - "velocityX": -1.132184461872942, - "velocityY": -0.4073055427239372, - "timestamp": 10.75259555110652 - }, - { - "x": 7.736562759355408, - "y": 4.3443092700230626, - "heading": -4.070579793488702, - "angularVelocity": 0.280658545373366, - "velocityX": -1.237351978319202, - "velocityY": -0.4375000411037426, - "timestamp": 10.785700464681145 - }, - { - "x": 7.692102928777451, - "y": 4.32888350603968, - "heading": -4.060491301098684, - "angularVelocity": 0.3047430517308739, - "velocityX": -1.3429979352682966, - "velocityY": -0.46596599470377864, - "timestamp": 10.818805378255771 - }, - { - "x": 7.644129003507531, - "y": 4.312580029465776, - "heading": -4.04960196385686, - "angularVelocity": 0.32893416916121687, - "velocityX": -1.449148180428791, - "velocityY": -0.49247905562876526, - "timestamp": 10.851910291830396 - }, - { - "x": 7.592623519547409, - "y": 4.2954723815055775, - "heading": -4.037908449029847, - "angularVelocity": 0.35322595845640614, - "velocityX": -1.555825960518466, - "velocityY": -0.5167706576739681, - "timestamp": 10.885015205405022 - }, - { - "x": 7.537568431341937, - "y": 4.277644842335571, - "heading": -4.025407747523989, - "angularVelocity": 0.37760864343229733, - "velocityX": -1.663048842624742, - "velocityY": -0.5385164087445838, - "timestamp": 10.918120118979648 - }, - { - "x": 7.478945468744125, - "y": 4.259194785924933, - "heading": -4.012097354853389, - "angularVelocity": 0.4020669814043128, - "velocityX": -1.7708236109924926, - "velocityY": -0.557320784694024, - "timestamp": 10.951225032554273 - }, - { - "x": 7.41673677407285, - "y": 4.240235706322923, - "heading": -3.9979755297163337, - "angularVelocity": 0.4265779188706207, - "velocityX": -1.8791378062668793, - "velocityY": -0.5726968463238129, - "timestamp": 10.984329946128899 - }, - { - "x": 7.350926005489431, - "y": 4.220901134197944, - "heading": -3.983041664129885, - "angularVelocity": 0.45110722167526907, - "velocityX": -1.9879456394008563, - "velocityY": -0.5840393475547041, - "timestamp": 11.017434859703524 - }, - { - "x": 7.281500221503902, - "y": 4.201349724406127, - "heading": -3.9672968128771577, - "angularVelocity": 0.47560466265031076, - "velocityX": -2.097144396073741, - "velocityY": -0.5905893621423952, - "timestamp": 11.05053977327815 - }, - { - "x": 7.208453081280606, - "y": 4.181771846596411, - "heading": -3.950744447003366, - "angularVelocity": 0.4999972537756106, - "velocityX": -2.2065346903453893, - "velocityY": -0.591388881459637, - "timestamp": 11.083644686852775 - }, - { - "x": 7.131790264139756, - "y": 4.162397991758564, - "heading": -3.9333915135611903, - "angularVelocity": 0.5241799953067018, - "velocityX": -2.3157534294127133, - "velocityY": -0.5852259603147614, - "timestamp": 11.1167496004274 - }, - { - "x": 7.051538595146062, - "y": 4.143509057085501, - "heading": -3.9152498946632917, - "angularVelocity": 0.5480038139052583, - "velocityX": -2.4241618638511357, - "velocityY": -0.5705779787185788, - "timestamp": 11.149854514002026 - }, - { - "x": 6.967761151528457, - "y": 4.125447705104888, - "heading": -3.8963383505125964, - "angularVelocity": 0.5712609431244915, - "velocityX": -2.5306649246720965, - "velocityY": -0.5455791914363196, - "timestamp": 11.182959427576652 - }, - { - "x": 6.880581207877887, - "y": 4.108627750977044, - "heading": -3.876684983625147, - "angularVelocity": 0.5936691797471845, - "velocityX": -2.6334442303873935, - "velocityY": -0.5080802911606311, - "timestamp": 11.216064341151277 - }, - { - "x": 6.790216608879877, - "y": 4.0935340018236515, - "heading": -3.856330118329937, - "angularVelocity": 0.6148593395154528, - "velocityX": -2.7296431025052987, - "velocityY": -0.45593682398137625, - "timestamp": 11.249169254725903 - }, - { - "x": 6.697019199323438, - "y": 4.080699197672285, - "heading": -3.83532911718854, - "angularVelocity": 0.6343771625942055, - "velocityX": -2.8152138004031935, - "velocityY": -0.3877008807902249, - "timestamp": 11.282274168300528 - }, - { - "x": 6.601498540052863, - "y": 4.07064612257462, - "heading": -3.813754414028283, - "angularVelocity": 0.6517069773229626, - "velocityX": -2.885392195791479, - "velocityY": -0.30367320171378936, - "timestamp": 11.315379081875154 - }, - { - "x": 6.504298225369728, - "y": 4.0638060169193, - "heading": -3.791697257810727, - "angularVelocity": 0.666280435012615, - "velocityX": -2.93612954052959, - "velocityY": -0.2066190458374174, - "timestamp": 11.34848399544978 - }, - { - "x": 6.406117512435041, - "y": 4.060457553922357, - "heading": -3.769268609747822, - "angularVelocity": 0.6775020877896717, - "velocityX": -2.965744426831601, - "velocityY": -0.10114700917115207, - "timestamp": 11.381588909024405 - }, - { - "x": 6.307619626153464, - "y": 4.060722723896358, - "heading": -3.7465929512301233, - "angularVelocity": 0.6849635316698022, - "velocityX": -2.975325280929776, - "velocityY": 0.008009988408604752, - "timestamp": 11.41469382259903 - }, - { - "x": 6.209374336917679, - "y": 4.064607085649101, - "heading": -3.7237946194075744, - "angularVelocity": 0.6886691237286258, - "velocityX": -2.9676950829163595, - "velocityY": 0.117334900874646, - "timestamp": 11.447798736173656 - }, - { - "x": 6.111843522629519, - "y": 4.072048543608375, - "heading": -3.70098589740335, - "angularVelocity": 0.6889829799074695, - "velocityX": -2.9461129408571565, - "velocityY": 0.22478409262418045, - "timestamp": 11.480903649748281 - }, - { - "x": 6.015391988393039, - "y": 4.082953827745876, - "heading": -3.6782618367430677, - "angularVelocity": 0.6864256150090193, - "velocityX": -2.9135111323900427, - "velocityY": 0.32941587697905805, - "timestamp": 11.514008563322907 - }, - { - "x": 5.920306236320189, - "y": 4.097220109283991, - "heading": -3.6557002049026477, - "angularVelocity": 0.68151912825755, - "velocityX": -2.872254955703382, - "velocityY": 0.43094151283481674, - "timestamp": 11.547113476897533 - }, - { - "x": 5.826812506445201, - "y": 4.11474607261669, - "heading": -3.6333637032024773, - "angularVelocity": 0.6747186229566627, - "velocityX": -2.824164747152575, - "velocityY": 0.5294067085597899, - "timestamp": 11.580218390472158 - }, - { - "x": 5.735091396535967, - "y": 4.135436875128028, - "heading": -3.611302700103551, - "angularVelocity": 0.6663966377437107, - "velocityX": -2.770619222505322, - "velocityY": 0.6250069937412039, - "timestamp": 11.613323304046784 + "angularVelocity": 3.521072073538637e-24, + "velocityX": 1.3091800468623773e-22, + "velocityY": 4.286584514522651e-22, + "timestamp": 10.388440574139693 + }, + { + "x": 7.997862807158953, + "y": 4.441693190015581, + "heading": -4.129726776956422, + "angularVelocity": 0.02284131688697609, + "velocityX": -0.10143197061746514, + "velocityY": -0.041083200264577825, + "timestamp": 10.421545481257297 + }, + { + "x": 7.9911388141737, + "y": 4.438993628966426, + "heading": -4.128211445929986, + "angularVelocity": 0.045773607551682645, + "velocityX": -0.20311167046523715, + "velocityY": -0.0815456463770018, + "timestamp": 10.454650388374901 + }, + { + "x": 7.9810400437385045, + "y": 4.43497671720804, + "heading": -4.125933844845356, + "angularVelocity": 0.0687995008274153, + "velocityX": -0.30505358010280076, + "velocityY": -0.12133886206402324, + "timestamp": 10.487755295492505 + }, + { + "x": 7.967557297835451, + "y": 4.429666406913068, + "heading": -4.122890786295556, + "angularVelocity": 0.09192167611254726, + "velocityX": -0.4072733342871634, + "velocityY": -0.16040855442089563, + "timestamp": 10.520860202610109 + }, + { + "x": 7.950680819649021, + "y": 4.423088671636749, + "heading": -4.119078993794958, + "angularVelocity": 0.1151428242059706, + "velocityX": -0.5097878126187516, + "velocityY": -0.19869366353910206, + "timestamp": 10.553965109727713 + }, + { + "x": 7.9304002494470245, + "y": 4.415271768358087, + "heading": -4.11449510304615, + "angularVelocity": 0.13846559763858526, + "velocityX": -0.6126152274027127, + "velocityY": -0.23612521403224035, + "timestamp": 10.587070016845317 + }, + { + "x": 7.906704577869307, + "y": 4.406246545769374, + "heading": -4.109135665331081, + "angularVelocity": 0.16189254650467774, + "velocityX": -0.7157752019524101, + "velocityY": -0.27262491801146155, + "timestamp": 10.62017492396292 + }, + { + "x": 7.879582097302059, + "y": 4.396046809215453, + "heading": -4.102997153692569, + "angularVelocity": 0.1854260341738729, + "velocityX": -0.8192888284173855, + "velocityY": -0.3081034638667474, + "timestamp": 10.653279831080525 + }, + { + "x": 7.849020352591328, + "y": 4.384709755534507, + "heading": -4.096075972835381, + "angularVelocity": 0.2090681249338963, + "velocityX": -0.9231786877444521, + "velocityY": -0.34245840475163225, + "timestamp": 10.686384738198129 + }, + { + "x": 7.8150060932615615, + "y": 4.372276494821474, + "heading": -4.088368474050785, + "angularVelocity": 0.23282043224634263, + "velocityX": -1.0274688042148068, + "velocityY": -0.37557153291095113, + "timestamp": 10.719489645315733 + }, + { + "x": 7.777525230849651, + "y": 4.358792681160471, + "heading": -4.079870977005314, + "angularVelocity": 0.2566839113997491, + "velocityX": -1.1321844909204, + "velocityY": -0.40730558805382683, + "timestamp": 10.752594552433337 + }, + { + "x": 7.736562807258985, + "y": 4.344309281125525, + "heading": -4.070579801008361, + "angularVelocity": 0.2806585731820932, + "velocityX": -1.2373520168822494, + "velocityY": -0.4375000957862593, + "timestamp": 10.78569945955094 + }, + { + "x": 7.692102983701815, + "y": 4.328883517990517, + "heading": -4.060491309495449, + "angularVelocity": 0.30474308467546074, + "velocityX": -1.342997985139448, + "velocityY": -0.4659660599622744, + "timestamp": 10.818804366668545 + }, + { + "x": 7.644129065695918, + "y": 4.312580042041941, + "heading": -4.04960197309887, + "angularVelocity": 0.3289342077866296, + "velocityX": -1.4491482436568, + "velocityY": -0.4924791327962167, + "timestamp": 10.851909273786148 + }, + { + "x": 7.592623589168311, + "y": 4.295472394421691, + "heading": -4.037908459066969, + "angularVelocity": 0.35322600333416404, + "velocityX": -1.5558260394640624, + "velocityY": -0.5167707481998554, + "timestamp": 10.885014180903752 + }, + { + "x": 7.537568508476518, + "y": 4.277644855237873, + "heading": -4.025407758286928, + "angularVelocity": 0.3776086951591106, + "velocityX": -1.6630489400321737, + "velocityY": -0.5385165141979279, + "timestamp": 10.918119088021356 + }, + { + "x": 7.478945553370504, + "y": 4.259194798384933, + "heading": -4.012097366252854, + "angularVelocity": 0.4020670405988502, + "velocityX": -1.7708237300820395, + "velocityY": -0.5573209067585142, + "timestamp": 10.95122399513896 + }, + { + "x": 7.416736866046282, + "y": 4.240235717831127, + "heading": -3.997975541642368, + "angularVelocity": 0.4265779861673775, + "velocityX": -1.8791379508550954, + "velocityY": -0.572696986777671, + "timestamp": 10.984328902256564 + }, + { + "x": 7.350926104517102, + "y": 4.220901144158427, + "heading": -3.9830416764514713, + "angularVelocity": 0.45110729771403824, + "velocityX": -1.9879458140568433, + "velocityY": -0.5840395082219955, + "timestamp": 11.017433809374168 + }, + { + "x": 7.281500327112687, + "y": 4.201349732133466, + "heading": -3.96729682544228, + "angularVelocity": 0.4756047480592185, + "velocityX": -2.097144606320271, + "velocityY": -0.5905895447917914, + "timestamp": 11.050538716491772 + }, + { + "x": 7.2084531927759015, + "y": 4.181771851317855, + "heading": -3.9507444596397754, + "angularVelocity": 0.4999973491453385, + "velocityX": -2.2065349429100904, + "velocityY": -0.5913890876075294, + "timestamp": 11.083643623609376 + }, + { + "x": 7.131790380553627, + "y": 4.162397992626754, + "heading": -3.9333915260781684, + "angularVelocity": 0.5241801011542423, + "velocityX": -2.3157537325186857, + "velocityY": -0.585226190856754, + "timestamp": 11.11674853072698 + }, + { + "x": 7.0515387151746305, + "y": 4.143509053211283, + "heading": -3.9152499068546014, + "angularVelocity": 0.5480039306293687, + "velocityX": -2.4241622274881247, + "velocityY": -0.5705782332621693, + "timestamp": 11.149853437844584 + }, + { + "x": 6.967761273464085, + "y": 4.12544769562606, + "heading": -3.896338362160399, + "angularVelocity": 0.5712610709650918, + "velocityX": -2.5306653606648495, + "velocityY": -0.545579467148517, + "timestamp": 11.182958344962188 + }, + { + "x": 6.880581329556192, + "y": 4.108627735185313, + "heading": -3.876684994503698, + "angularVelocity": 0.5936693187775344, + "velocityX": -2.6334447518064277, + "velocityY": -0.5080805809542204, + "timestamp": 11.216063252079792 + }, + { + "x": 6.790216727690451, + "y": 4.093533979368118, + "heading": -3.85633012820655, + "angularVelocity": 0.6148594897076288, + "velocityX": -2.729643721540304, + "velocityY": -0.4559371142040936, + "timestamp": 11.249168159197396 + }, + { + "x": 6.697019312366813, + "y": 4.080699168817031, + "heading": -3.8353291258180944, + "angularVelocity": 0.6343773239976459, + "velocityX": -2.8152145237127253, + "velocityY": -0.38770114972659575, + "timestamp": 11.282273066315 + }, + { + "x": 6.601498644505623, + "y": 4.070646088391479, + "heading": -3.813754421138034, + "angularVelocity": 0.6517071503453378, + "velocityX": -2.885393018076057, + "velocityY": -0.30367342188392765, + "timestamp": 11.315377973432604 + }, + { + "x": 6.504298318965137, + "y": 4.063805979232082, + "heading": -3.791697263090234, + "angularVelocity": 0.6662806202549634, + "velocityX": -2.9361304411816507, + "velocityY": -0.2066191919855685, + "timestamp": 11.348482880550208 + }, + { + "x": 6.406117593795898, + "y": 4.060457514963214, + "heading": -3.7692686128872914, + "angularVelocity": 0.6775022845787112, + "velocityX": -2.9657453748611045, + "velocityY": -0.10114706732064674, + "timestamp": 11.381587787667812 + }, + { + "x": 6.307619694810011, + "y": 4.060722685880049, + "heading": -3.746592951999944, + "angularVelocity": 0.6849637368500491, + "velocityX": -2.975326245017957, + "velocityY": 0.00801001845112039, + "timestamp": 11.414692694785415 + }, + { + "x": 6.209374393100852, + "y": 4.064607050480649, + "heading": -3.7237946177112957, + "angularVelocity": 0.6886693325451241, + "velocityX": -2.9676960385403794, + "velocityY": 0.11733500978574436, + "timestamp": 11.44779760190302 + }, + { + "x": 6.111843567014915, + "y": 4.072048512767596, + "heading": -3.7009858932799373, + "angularVelocity": 0.6889831876081538, + "velocityX": -2.946113871863876, + "velocityY": 0.22478426719373196, + "timestamp": 11.480902509020623 + }, + { + "x": 6.0153920218938275, + "y": 4.08295380228718, + "heading": -3.67826183034087, + "angularVelocity": 0.6864258177297179, + "velocityX": -2.9135120294537553, + "velocityY": 0.32941610380729425, + "timestamp": 11.514007416138227 + }, + { + "x": 5.920306259948002, + "y": 4.097220089886147, + "heading": -3.6557001964477682, + "angularVelocity": 0.6815193231913592, + "velocityX": -2.872255814161892, + "velocityY": 0.43094177996896244, + "timestamp": 11.547112323255831 + }, + { + "x": 5.826812521225562, + "y": 4.1147460596447285, + "heading": -3.633363692971576, + "angularVelocity": 0.6747188082069855, + "velocityX": -2.824165565253177, + "velocityY": 0.5294070059257744, + "timestamp": 11.580217230373435 + }, + { + "x": 5.73509140346026, + "y": 4.135436868691069, + "heading": -3.611302688403279, + "angularVelocity": 0.6663968121078352, + "velocityX": -2.7706200002152808, + "velocityY": 0.6250073130499223, + "timestamp": 11.61332213749104 }, { "x": 5.645288944244385, "y": 4.159205913543701, - "heading": -3.589557740824999, - "angularVelocity": 0.656849903248797, - "velocityX": -2.712662339055809, - "velocityY": 0.7179912541409452, - "timestamp": 11.64642821762141 - }, - { - "x": 5.556543272789032, - "y": 4.1863163780495505, - "heading": -3.567920606584658, - "angularVelocity": 0.6461920112656356, - "velocityX": -2.6503853648943725, - "velocityY": 0.8096527659711241, - "timestamp": 11.679912280969642 - }, - { - "x": 5.470146818109821, - "y": 4.21629829382191, - "heading": -3.546719854360496, - "angularVelocity": 0.633159482577573, - "velocityX": -2.5802261147546752, - "velocityY": 0.8954085249615271, - "timestamp": 11.713396344317875 - }, - { - "x": 5.38636992658066, - "y": 4.248906335893914, - "heading": -3.526034553779174, - "angularVelocity": 0.6177655431539323, - "velocityX": -2.5019929826880443, - "velocityY": 0.9738376651866179, - "timestamp": 11.746880407666108 - }, - { - "x": 5.305478349810334, - "y": 4.283844055187029, - "heading": -3.505938689685919, - "angularVelocity": 0.6001620497565967, - "velocityX": -2.415823191141911, - "velocityY": 1.0434133674209292, - "timestamp": 11.780364471014341 - }, - { - "x": 5.227719301839229, - "y": 4.32076498574019, - "heading": -3.4864965293384484, - "angularVelocity": 0.5806392176861178, - "velocityX": -2.322270363737359, - "velocityY": 1.1026418797857462, - "timestamp": 11.813848534362574 - }, - { - "x": 5.1533066354562695, - "y": 4.359280038599062, - "heading": -3.467759498175663, - "angularVelocity": 0.5595805672663093, - "velocityX": -2.2223308327030025, - "velocityY": 1.150250268562566, - "timestamp": 11.847332597710807 - }, - { - "x": 5.082408288831018, - "y": 4.3989712692340515, - "heading": -3.4497656171938673, - "angularVelocity": 0.5373864215540406, - "velocityX": -2.117375836018225, - "velocityY": 1.1853767633337151, - "timestamp": 11.88081666105904 - }, - { - "x": 5.01513906699728, - "y": 4.439409930939772, - "heading": -3.4325412407735434, - "angularVelocity": 0.514405203490123, - "velocityX": -2.008992192319671, - "velocityY": 1.207698757619713, - "timestamp": 11.914300724407273 - }, - { - "x": 4.951560246505482, - "y": 4.480175132009186, - "heading": -3.4161037850831852, - "angularVelocity": 0.490903852361318, - "velocityX": -1.8987785272826667, - "velocityY": 1.2174508405822064, - "timestamp": 11.947784787755506 - }, - { - "x": 4.891685240964086, - "y": 4.520869436323415, - "heading": -3.4004642391590387, - "angularVelocity": 0.4670743141743557, - "velocityX": -1.7881642654506853, - "velocityY": 1.2153335122744733, - "timestamp": 11.981268851103739 - }, - { - "x": 4.835488965074171, - "y": 4.561129265371178, - "heading": -3.3856290250526424, - "angularVelocity": 0.44305298171582685, - "velocityX": -1.678299174908268, - "velocityY": 1.2023579285782104, - "timestamp": 12.014752914451972 - }, - { - "x": 4.782918258230768, - "y": 4.600629876244802, - "heading": -3.3716013073356166, - "angularVelocity": 0.4189371394725309, - "velocityX": -1.5700217233694047, - "velocityY": 1.1796839129952525, - "timestamp": 12.048236977800205 - }, - { - "x": 4.733901443923004, - "y": 4.639085998252082, - "heading": -3.358381939905764, - "angularVelocity": 0.39479579561093997, - "velocityX": -1.4638848875057788, - "velocityY": 1.1484903014110828, - "timestamp": 12.081721041148437 - }, - { - "x": 4.688356082575613, - "y": 4.676249643136629, - "heading": -3.345970158873378, - "angularVelocity": 0.3706772652800276, - "velocityX": -1.3602101057365927, - "velocityY": 1.109890532043447, - "timestamp": 12.11520510449667 - }, - { - "x": 4.646194734008062, - "y": 4.7119064377976505, - "heading": -3.3343640770115957, - "angularVelocity": 0.34661509689190445, - "velocityX": -1.2591467209064442, - "velocityY": 1.0648885199562685, - "timestamp": 12.148689167844903 - }, - { - "x": 4.6073289583831585, - "y": 4.745871436865768, - "heading": -3.3235610235419317, - "angularVelocity": 0.32263269117946203, - "velocityX": -1.1607245877150678, - "velocityY": 1.014363122984295, - "timestamp": 12.182173231193136 - }, - { - "x": 4.57167193026909, - "y": 4.777984991592977, - "heading": -3.3135577714536746, - "angularVelocity": 0.29874665999236377, - "velocityX": -1.0648954920206877, - "velocityY": 0.9590698235524624, - "timestamp": 12.21565729454137 - }, - { - "x": 4.539140037844566, - "y": 4.808108969456149, - "heading": -3.304350688790571, - "angularVelocity": 0.27496909701041905, - "velocityX": -0.9715634594939336, - "velocityY": 0.8996512027194499, - "timestamp": 12.249141357889602 - }, - { - "x": 4.509653776241274, - "y": 4.836123440216494, - "heading": -3.29593584110889, - "angularVelocity": 0.25130903600816695, - "velocityX": -0.8806058361745399, - "velocityY": 0.8366508708634285, - "timestamp": 12.282625421237835 - }, - { - "x": 4.48313816887737, - "y": 4.861923843828622, - "heading": -3.2883090632845122, - "angularVelocity": 0.22777336624470876, - "velocityX": -0.7918873849969232, - "velocityY": 0.7705278580978897, - "timestamp": 12.316109484586068 - }, - { - "x": 4.459522884136782, - "y": 4.885418605956808, - "heading": -3.2814660119426646, - "angularVelocity": 0.20436741116752466, - "velocityX": -0.7052693842736527, - "velocityY": 0.7016699820401419, - "timestamp": 12.349593547934301 - }, - { - "x": 4.438742162822014, - "y": 4.906527146840758, - "heading": -3.275402205208727, - "angularVelocity": 0.18109530706814916, - "velocityX": -0.6206152789358182, - "velocityY": 0.6304055951759001, - "timestamp": 12.383077611282534 - }, - { - "x": 4.420734633898579, - "y": 4.925178225077248, - "heading": -3.2701130537081724, - "angularVelocity": 0.15796026442632197, - "velocityX": -0.5377940166985415, - "velocityY": 0.5570135871061982, - "timestamp": 12.416561674630767 - }, - { - "x": 4.405443069468726, - "y": 4.941308561350081, - "heading": -3.2655938851592956, - "angularVelocity": 0.13496475926106719, - "velocityX": -0.45668186297528196, - "velocityY": 0.4817317451910843, - "timestamp": 12.450045737979 - }, - { - "x": 4.392814111754166, - "y": 4.954861693705026, - "heading": -3.2618399640244657, - "angularVelocity": 0.1121106807076865, - "velocityX": -0.37716323682758857, - "velocityY": 0.40476366962971966, - "timestamp": 12.483529801327233 - }, - { - "x": 4.382797992684927, - "y": 4.965787023275837, - "heading": -3.2588465072023927, - "angularVelocity": 0.08939944925265392, - "velocityX": -0.2991309317830429, - "velocityY": 0.3262844612730617, - "timestamp": 12.517013864675466 - }, - { - "x": 4.375348258629927, - "y": 4.974039016306493, - "heading": -3.2566086964718237, - "angularVelocity": 0.06683211375202444, - "velocityX": -0.22248596227772716, - "velocityY": 0.2464453894031916, - "timestamp": 12.550497928023699 - }, - { - "x": 4.370421507535125, - "y": 4.979576534431501, - "heading": -3.2551216882351093, - "angularVelocity": 0.04440943207070345, - "velocityX": -0.14713719310477827, - "velocityY": 0.16537772215448024, - "timestamp": 12.583981991371932 + "heading": -3.5895577279773367, + "angularVelocity": 0.6568500660247814, + "velocityX": -2.712663077315302, + "velocityY": 0.7179915886244437, + "timestamp": 11.646427044608643 + }, + { + "x": 5.55654326392043, + "y": 4.186316385224252, + "heading": -3.5679205922393793, + "angularVelocity": 0.6461921616438002, + "velocityX": -2.6503860630907963, + "velocityY": 0.8096531126208885, + "timestamp": 11.679911102482258 + }, + { + "x": 5.47014680152862, + "y": 4.216298307971487, + "heading": -3.5467198389182046, + "angularVelocity": 0.6331596188608981, + "velocityX": -2.5802267669561205, + "velocityY": 0.8954088796644789, + "timestamp": 11.713395160355873 + }, + { + "x": 5.386369903571584, + "y": 4.248906356674734, + "heading": -3.526034537660783, + "angularVelocity": 0.6177656643498314, + "velocityX": -2.501993583730219, + "velocityY": 0.9738380224501408, + "timestamp": 11.746879218229488 + }, + { + "x": 5.305478321739699, + "y": 4.283844082081717, + "heading": -3.505938673301294, + "angularVelocity": 0.6001621558337007, + "velocityX": -2.415823737290412, + "velocityY": 1.0434137206086127, + "timestamp": 11.780363276103103 + }, + { + "x": 5.227719270089909, + "y": 4.3207650180463215, + "heading": -3.486496513053993, + "angularVelocity": 0.5806393096286306, + "velocityX": -2.322270853290538, + "velocityY": 1.1026422216794234, + "timestamp": 11.813847333976717 + }, + { + "x": 5.153306601354184, + "y": 4.359280075444413, + "heading": -3.4677594822906004, + "angularVelocity": 0.5595806468294645, + "velocityX": -2.2223312663176835, + "velocityY": 1.1502505921912554, + "timestamp": 11.847331391850332 + }, + { + "x": 5.082408253577596, + "y": 4.39897130961914, + "heading": -3.449765601932038, + "angularVelocity": 0.537386490803467, + "velocityX": -2.11737621659215, + "velocityY": 1.1853770628560039, + "timestamp": 11.880815449723947 + }, + { + "x": 5.015139031621627, + "y": 4.439409973799246, + "heading": -3.432541226289716, + "angularVelocity": 0.5144052643600046, + "velocityX": -2.008992524438854, + "velocityY": 1.2076990289749658, + "timestamp": 11.914299507597562 + }, + { + "x": 4.951560211842953, + "y": 4.480175176277809, + "heading": -3.4161037714769003, + "angularVelocity": 0.4909039064159544, + "velocityX": -1.8987788164341068, + "velocityY": 1.2174510817186697, + "timestamp": 11.947783565471177 + }, + { + "x": 4.89168520765914, + "y": 4.520869480993223, + "heading": -3.4004642264891163, + "angularVelocity": 0.4670743625762069, + "velocityX": -1.7881645172699678, + "velocityY": 1.2153337229619623, + "timestamp": 11.981267623344792 + }, + { + "x": 4.835488933599554, + "y": 4.5611293095322845, + "heading": -3.3856290133489932, + "angularVelocity": 0.44305302529694635, + "velocityX": -1.6782993946462035, + "velocityY": 1.2023581099704563, + "timestamp": 12.014751681218407 + }, + { + "x": 4.782918228914137, + "y": 4.600629919108832, + "heading": -3.3716012966078455, + "angularVelocity": 0.41893717882389225, + "velocityX": -1.5700219156186, + "velocityY": 1.1796840671355455, + "timestamp": 12.048235739092021 + }, + { + "x": 4.733901416974363, + "y": 4.639086039161345, + "heading": -3.3583819301491356, + "angularVelocity": 0.394795831156607, + "velocityX": -1.4638850561299048, + "velocityY": 1.1484904308093287, + "timestamp": 12.081719796965636 + }, + { + "x": 4.68835605811188, + "y": 4.676249681563439, + "heading": -3.3459701500728256, + "angularVelocity": 0.37067729733231536, + "velocityX": -1.3602102539182277, + "velocityY": 1.1098906393713428, + "timestamp": 12.115203854839251 + }, + { + "x": 4.646194712073395, + "y": 4.711906473337791, + "heading": -3.3343640691443137, + "angularVelocity": 0.34661512569112146, + "velocityX": -1.2591468512455393, + "velocityY": 1.0648886078544806, + "timestamp": 12.148687912712866 + }, + { + "x": 4.6073289389650105, + "y": 4.745871469229039, + "heading": -3.3235610165789797, + "angularVelocity": 0.32263271692188306, + "velocityX": -1.1607247023369474, + "velocityY": 1.0143631939548117, + "timestamp": 12.18217197058648 + }, + { + "x": 4.571671913310556, + "y": 4.777985020592715, + "heading": -3.3135577653609034, + "angularVelocity": 0.29874668284929173, + "velocityX": -1.0648955926740002, + "velocityY": 0.9590698799078438, + "timestamp": 12.215656028460096 + }, + { + "x": 4.539140023253754, + "y": 4.8081089949988245, + "heading": -3.3043506835291088, + "angularVelocity": 0.2749691171406556, + "velocityX": -0.9715635476319252, + "velocityY": 0.8996512465667004, + "timestamp": 12.24914008633371 + }, + { + "x": 4.509653763898365, + "y": 4.8361234622919635, + "heading": -3.295935836635349, + "angularVelocity": 0.25130905356578065, + "velocityX": -0.8806059130194128, + "velocityY": 0.8366509041072363, + "timestamp": 12.282624144207325 + }, + { + "x": 4.4831381586399495, + "y": 4.861923862501275, + "heading": -3.2883090595510325, + "angularVelocity": 0.22777338138357495, + "velocityX": -0.7918874515895754, + "velocityY": 0.7705278824536537, + "timestamp": 12.31610820208094 + }, + { + "x": 4.45952287584388, + "y": 4.885418621357682, + "heading": -3.281466008896871, + "angularVelocity": 0.20436742404372882, + "velocityX": -0.7052694415116886, + "velocityY": 0.7016699990511293, + "timestamp": 12.349592259954555 + }, + { + "x": 4.438742156297185, + "y": 4.906527159160586, + "heading": -3.275402202793641, + "angularVelocity": 0.18109531784102728, + "velocityX": -0.6206153276025074, + "velocityY": 0.6304056062313884, + "timestamp": 12.38307631782817 + }, + { + "x": 4.420734628952273, + "y": 4.925178234560356, + "heading": -3.2701130518621158, + "angularVelocity": 0.15796027325866763, + "velocityX": -0.5377940574849306, + "velocityY": 0.5570135934589632, + "timestamp": 12.416560375701785 + }, + { + "x": 4.405443065900129, + "y": 4.941308568289058, + "heading": -3.2655938838157965, + "angularVelocity": 0.13496476631885662, + "velocityX": -0.45668189649717433, + "velocityY": 0.48173174797346885, + "timestamp": 12.4500444335754 + }, + { + "x": 4.39281410935265, + "y": 4.954861698436055, + "heading": -3.261839963112179, + "angularVelocity": 0.11211068615955058, + "velocityX": -0.3771632636386863, + "velocityY": 0.4047636698680065, + "timestamp": 12.483528491449015 + }, + { + "x": 4.382797991231194, + "y": 4.9657870261746115, + "heading": -3.258846506645042, + "angularVelocity": 0.08939945326923995, + "velocityX": -0.2991309523852119, + "velocityY": 0.32628445990012805, + "timestamp": 12.51701254932263 + }, + { + "x": 4.375348257896936, + "y": 4.974039017784631, + "heading": -3.2566086961881613, + "angularVelocity": 0.06683211650533652, + "velocityX": -0.22248597712909673, + "velocityY": 0.24644538726955106, + "timestamp": 12.550496607196244 + }, + { + "x": 4.370421507288839, + "y": 4.979576534933385, + "heading": -3.255121688138895, + "angularVelocity": 0.04440943373347284, + "velocityX": -0.1471372026261985, + "velocityY": 0.16537772003787146, + "timestamp": 12.58398066506986 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": 0.02213193847444466, - "velocityX": -0.07300085344241602, - "velocityY": 0.08319587425074677, - "timestamp": 12.617466054720165 + "angularVelocity": 0.022131939219558208, + "velocityX": -0.07300085802266022, + "velocityY": 0.08319587286444159, + "timestamp": 12.617464722943474 }, { "x": 4.367977142333984, "y": 4.982362270355225, "heading": -3.254380621005212, - "angularVelocity": -4.226950965349435e-29, - "velocityX": 7.000195221592091e-27, - "velocityY": -1.7484350204553325e-27, - "timestamp": 12.650950118068398 + "angularVelocity": 2.730389824214373e-24, + "velocityX": -3.568292000859936e-22, + "velocityY": -3.1134132334801996e-22, + "timestamp": 12.650948780817089 } ], "eventMarkers": [ @@ -2055,7 +2055,7 @@ } }, { - "timestamp": 4.4591446544723965, + "timestamp": 4.459144371352818, "command": { "type": "named", "data": { @@ -2064,7 +2064,7 @@ } }, { - "timestamp": 8.210484334089376, + "timestamp": 8.21048380400154, "command": { "type": "parallel", "data": { @@ -2086,7 +2086,7 @@ } }, { - "timestamp": 9.430570143401457, + "timestamp": 9.43056949494445, "command": { "type": "named", "data": { @@ -2095,7 +2095,7 @@ } }, { - "timestamp": 11.388441501785639, + "timestamp": 11.388440574139693, "command": { "type": "named", "data": { @@ -2104,7 +2104,7 @@ } }, { - "timestamp": 12.650950118068398, + "timestamp": 12.650948780817089, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Start A.1.traj b/Robot/src/main/deploy/choreo/Amp Side Start A.1.traj index 67dafdf..fd995a6 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start A.1.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start A.1.traj @@ -230,6 +230,15 @@ "name": "Wait and Shoot" } } + }, + { + "timestamp": 1.345777924459432, + "command": { + "type": "named", + "data": { + "name": "Shoot" + } + } } ] } \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Start A.traj b/Robot/src/main/deploy/choreo/Amp Side Start A.traj index 67dafdf..fd995a6 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start A.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start A.traj @@ -230,6 +230,15 @@ "name": "Wait and Shoot" } } + }, + { + "timestamp": 1.345777924459432, + "command": { + "type": "named", + "data": { + "name": "Shoot" + } + } } ] } \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.1.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.1.traj index 09b94f6..357a26f 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start C.1.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.1.traj @@ -1,112 +1,148 @@ { "samples": [ { - "x": 1.373390793800354, - "y": 4.741092681884766, - "heading": 2.6399884969262475, - "angularVelocity": -3.6988129489772723e-28, - "velocityX": -6.858958396136724e-27, - "velocityY": -1.5418289496585915e-26, + "x": 1.2314672470092771, + "y": 4.670130729675293, + "heading": 2.414268531922355, + "angularVelocity": -5.2100101100154926e-30, + "velocityX": 5.347254929636904e-27, + "velocityY": 9.19140137657714e-27, "timestamp": 0 }, { - "x": 1.411237442090302, - "y": 4.725482025332623, - "heading": 2.644755988404159, - "angularVelocity": 0.0553306640200131, - "velocityX": 0.43924151527419975, - "velocityY": -0.18117452266465503, - "timestamp": 0.08616364112650379 + "x": 1.25427772593092, + "y": 4.663040954972958, + "heading": 2.4209562198461265, + "angularVelocity": 0.07860545105698431, + "velocityX": 0.26810880006649607, + "velocityY": -0.08333148088273383, + "timestamp": 0.08507918768792878 }, { - "x": 1.4869306891456044, - "y": 4.694260596197965, - "heading": 2.654289693354832, - "angularVelocity": 0.11064649573798489, - "velocityX": 0.878482455774716, - "velocityY": -0.3623503919573132, - "timestamp": 0.17232728225300759 + "x": 1.299898487748357, + "y": 4.648861096431842, + "heading": 2.4343273732150403, + "angularVelocity": 0.1571612721310791, + "velocityX": 0.5362152960930298, + "velocityY": -0.1666665952797718, + "timestamp": 0.17015837537585757 }, { - "x": 1.6004704665028786, - "y": 4.647428216491871, - "heading": 2.668587209347816, - "angularVelocity": 0.16593444527248416, - "velocityX": 1.3177226017013057, - "velocityY": -0.5435283269579504, - "timestamp": 0.2584909233795114 + "x": 1.3683293697300698, + "y": 4.6275906046406945, + "heading": 2.454369493563087, + "angularVelocity": 0.23557018928720364, + "velocityX": 0.8043198794130212, + "velocityY": -0.2500081673225167, + "timestamp": 0.25523756306378637 }, { - "x": 1.7518566827715065, - "y": 4.58498464715587, - "heading": 2.6876455596924695, - "angularVelocity": 0.22118784786116857, - "velocityX": 1.7569616869645228, - "velocityY": -0.7247090364289812, - "timestamp": 0.34465456450601517 + "x": 1.4595702265370212, + "y": 4.599228679736338, + "heading": 2.481062894448308, + "angularVelocity": 0.3137477168109834, + "velocityX": 1.0724227544534584, + "velocityY": -0.33335914076175294, + "timestamp": 0.34031675075171514 }, { - "x": 1.941089213909603, - "y": 4.5069295915038685, - "heading": 2.7114619454581304, - "angularVelocity": 0.2764087665549548, - "velocityX": 2.1961993326195337, - "velocityY": -0.9058931891864103, - "timestamp": 0.43081820563251894 + "x": 1.5736209091482751, + "y": 4.5637742614596535, + "heading": 2.5143822102441398, + "angularVelocity": 0.39162710295315967, + "velocityX": 1.340523877938196, + "velocityY": -0.41672257622782727, + "timestamp": 0.4253959384396439 }, { - "x": 2.1303192711002823, - "y": 4.428868248917787, - "heading": 2.7352473347586073, - "angularVelocity": 0.2760490270548816, - "velocityX": 2.196170620422779, - "velocityY": -0.9059661542328877, - "timestamp": 0.5169818467590227 + "x": 1.7104812390640793, + "y": 4.521226021274406, + "heading": 2.5542983242065618, + "angularVelocity": 0.469164257994969, + "velocityX": 1.6086229033804282, + "velocityY": -0.5001016269844418, + "timestamp": 0.5104751261275727 }, { - "x": 2.2817032282796483, - "y": 4.366418932119097, - "heading": 2.754276421488494, - "angularVelocity": 0.22084821951695574, - "velocityX": 1.7569354683735667, - "velocityY": -0.7247757404657851, - "timestamp": 0.6031454878855265 + "x": 1.8701509755218075, + "y": 4.471582359349749, + "heading": 2.600780705433162, + "angularVelocity": 0.5463425602639517, + "velocityX": 1.8767190989575278, + "velocityY": -0.5834994817622204, + "timestamp": 0.5955543138155015 }, { - "x": 2.3952411491674033, - "y": 4.319581824357118, - "heading": 2.7685487866211282, - "angularVelocity": 0.16564254882961663, - "velocityX": 1.317701055843969, - "velocityY": -0.5435831999394507, - "timestamp": 0.6893091290120302 + "x": 2.0298090975993626, + "y": 4.421877004084367, + "heading": 2.646315216105001, + "angularVelocity": 0.5352015211858865, + "velocityX": 1.876582586368622, + "velocityY": -0.5842246102266782, + "timestamp": 0.6806335015034303 }, { - "x": 2.470933081482251, - "y": 4.288357045534494, - "heading": 2.778063858835731, - "angularVelocity": 0.1104302474942169, - "velocityX": 0.8784671971292191, - "velocityY": -0.3623892678442039, - "timestamp": 0.775472770138534 + "x": 2.1666583517760736, + "y": 4.379270074305973, + "heading": 2.685326672139293, + "angularVelocity": 0.45853112957996595, + "velocityX": 1.6084927218472653, + "velocityY": -0.5007914501332125, + "timestamp": 0.765712689191359 + }, + { + "x": 2.2806989716360007, + "y": 4.343762747699759, + "heading": 2.717827419605436, + "angularVelocity": 0.38200585065945625, + "velocityX": 1.3404056028159197, + "velocityY": -0.4173444478155432, + "timestamp": 0.8507918768792878 + }, + { + "x": 2.3719311822566893, + "y": 4.315355961950949, + "heading": 2.7438246843650607, + "angularVelocity": 0.3055655027523666, + "velocityX": 1.0723211292910941, + "velocityY": -0.3338864241746834, + "timestamp": 0.9358710645672166 + }, + { + "x": 2.440355176758643, + "y": 4.29405041622838, + "heading": 2.763322145123904, + "angularVelocity": 0.22916839345434334, + "velocityX": 0.8042389256575113, + "velocityY": -0.2504201826740351, + "timestamp": 1.0209502522551455 + }, + { + "x": 2.4859711018991932, + "y": 4.279846572314698, + "heading": 2.776321113344305, + "angularVelocity": 0.1527866987644639, + "velocityX": 0.536158446973772, + "velocityY": -0.1669485134928884, + "timestamp": 1.1060294399430743 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": 0.05521427383525686, - "velocityX": 0.4392336134200937, - "velocityY": -0.18119463988808376, - "timestamp": 0.8616364112650378 + "angularVelocity": 0.07640186212250696, + "velocityX": 0.26807904071844774, + "velocityY": -0.08347419502425253, + "timestamp": 1.1911086276310032 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": -2.766219324607853e-28, - "velocityX": -9.297420403564632e-27, - "velocityY": -2.6804687000261814e-26, - "timestamp": 0.9478000523915415 + "angularVelocity": 1.3083302481141851e-23, + "velocityX": 3.175111039019461e-23, + "velocityY": -1.059107290269951e-22, + "timestamp": 1.276187815318932 } ], "eventMarkers": [ diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.2.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.2.traj index 1251d51..cef1a68 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start C.2.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.2.traj @@ -4,213 +4,159 @@ "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": -2.766219324607853e-28, - "velocityX": -9.297420403564632e-27, - "velocityY": -2.6804687000261814e-26, + "angularVelocity": 1.3083302481141851e-23, + "velocityX": 3.175111039019461e-23, + "velocityY": -1.059107290269951e-22, "timestamp": 0 }, { - "x": 2.485712247791879, - "y": 4.293165359703155, - "heading": 2.7875035435672006, - "angularVelocity": 0.06263155257733619, - "velocityX": -0.3085521387410952, - "velocityY": 0.27315672805697044, - "timestamp": 0.07475819555784646 - }, - { - "x": 2.439795645378961, - "y": 4.3342479362983335, - "heading": 2.796948863574697, - "angularVelocity": 0.12634494368163166, - "velocityX": -0.6142015878030177, - "velocityY": 0.5495394356246737, - "timestamp": 0.14951639111569293 - }, - { - "x": 2.37135097351757, - "y": 4.396340662085837, - "heading": 2.8112801553510027, - "angularVelocity": 0.19170194878789426, - "velocityX": -0.9155474038753352, - "velocityY": 0.8305808523623003, - "timestamp": 0.2242745866735394 - }, - { - "x": 2.2809036686278588, - "y": 4.479989853291562, - "heading": 2.8306966822828405, - "angularVelocity": 0.25972439258266794, - "velocityX": -1.2098647407791576, - "velocityY": 1.1189300461512346, - "timestamp": 0.29903278223138585 - }, - { - "x": 2.1694610822060914, - "y": 4.586171676149044, - "heading": 2.855565368951549, - "angularVelocity": 0.3326549883011264, - "velocityX": -1.4907072808563897, - "velocityY": 1.420336888352538, - "timestamp": 0.3737909777892323 - }, - { - "x": 2.0396783229737445, - "y": 4.717080893375947, - "heading": 2.8867637105218655, - "angularVelocity": 0.4173233628435488, - "velocityX": -1.7360338657709218, - "velocityY": 1.7511018858876508, - "timestamp": 0.4485491733470788 - }, - { - "x": 1.9083459965924492, - "y": 4.878682966459805, - "heading": 2.927751972703886, - "angularVelocity": 0.5482778426654837, - "velocityX": -1.7567615884959766, - "velocityY": 2.1616636393907322, - "timestamp": 0.5233073689049252 - }, - { - "x": 1.8072662278781861, - "y": 5.034315326748822, - "heading": 2.9680728874159334, - "angularVelocity": 0.539351096039333, - "velocityX": -1.3520894660445504, - "velocityY": 2.081810015981342, - "timestamp": 0.5980655644627717 - }, - { - "x": 1.7337783112249077, - "y": 5.176201891301336, - "heading": 3.005629932991069, - "angularVelocity": 0.5023803115482496, - "velocityX": -0.9830081652574799, - "velocityY": 1.8979399314517253, - "timestamp": 0.6728237600206182 - }, - { - "x": 1.6867607756102783, - "y": 5.302300031050603, - "heading": 3.039795163689665, - "angularVelocity": 0.4570098360942832, - "velocityX": -0.6289281765535397, - "velocityY": 1.6867467012589215, - "timestamp": 0.7475819555784646 - }, - { - "x": 1.66563929435333, - "y": 5.411689307516261, - "heading": 3.0702577432581744, - "angularVelocity": 0.40748147198038986, - "velocityX": -0.2825306456280759, - "velocityY": 1.4632412627056373, - "timestamp": 0.8223401511363111 - }, - { - "x": 1.6700678493315473, - "y": 5.503848245609138, - "heading": 3.096827358057357, - "angularVelocity": 0.3554073851156999, - "velocityX": 0.059238387780379306, - "velocityY": 1.2327603335685882, - "timestamp": 0.8970983466941576 + "x": 2.4961384531980824, + "y": 4.293147174010466, + "heading": 2.7879029651962903, + "angularVelocity": 0.0596298372930921, + "velocityX": -0.1483293088992677, + "velocityY": 0.23941050888166174, + "timestamp": 0.08521981134679257 + }, + { + "x": 2.4708572541131812, + "y": 4.333952271885203, + "heading": 2.7980693711600293, + "angularVelocity": 0.11929627398925077, + "velocityX": -0.2966587074691136, + "velocityY": 0.4788217344049931, + "timestamp": 0.17043962269358515 + }, + { + "x": 2.43293550597329, + "y": 4.39515996535009, + "heading": 2.81333132170297, + "angularVelocity": 0.17908923173783667, + "velocityX": -0.4449874687656011, + "velocityY": 0.7182331490480437, + "timestamp": 0.2556594340403777 + }, + { + "x": 2.3823733177577484, + "y": 4.4767702188313825, + "heading": 2.833707465015003, + "angularVelocity": 0.23910101407188608, + "velocityX": -0.5933149512592097, + "velocityY": 0.9576441462559535, + "timestamp": 0.3408792453871703 + }, + { + "x": 2.3191708434490903, + "y": 4.578782935778785, + "heading": 2.8592245757517496, + "angularVelocity": 0.29942697987100375, + "velocityX": -0.7416406268662431, + "velocityY": 1.1970540105078704, + "timestamp": 0.42609905673396287 + }, + { + "x": 2.2433282697859203, + "y": 4.701197946502626, + "heading": 2.889917854748574, + "angularVelocity": 0.36016600496710854, + "velocityX": -0.8899641112151426, + "velocityY": 1.4364618835599956, + "timestamp": 0.5113188680807554 + }, + { + "x": 2.1548458019426757, + "y": 4.844014991577765, + "heading": 2.92583130513466, + "angularVelocity": 0.42142137865032253, + "velocityX": -1.0382851879731971, + "velocityY": 1.6758667124239617, + "timestamp": 0.596538679427548 + }, + { + "x": 2.0537236539135044, + "y": 5.007233688756998, + "heading": 2.9670187669038475, + "angularVelocity": 0.48330853023811365, + "velocityX": -1.1866037536467386, + "velocityY": 1.915267055861383, + "timestamp": 0.6817584907743406 + }, + { + "x": 1.9652468625527026, + "y": 5.150036653856614, + "heading": 3.004999757447428, + "angularVelocity": 0.4456826404956622, + "velocityX": -1.038218578081046, + "velocityY": 1.675701492913359, + "timestamp": 0.7669783021211329 + }, + { + "x": 1.8894096037270685, + "y": 5.272438573207108, + "heading": 3.037623268634309, + "angularVelocity": 0.38281604560379573, + "velocityX": -0.8899017449947522, + "velocityY": 1.4363082646638674, + "timestamp": 0.8521981134679253 + }, + { + "x": 1.826211820751686, + "y": 5.374439786670781, + "heading": 3.0648511640007152, + "angularVelocity": 0.31950194369247265, + "velocityX": -0.7415855770697051, + "velocityY": 1.196919024481186, + "timestamp": 0.9374179248147176 + }, + { + "x": 1.775653508102984, + "y": 5.456040555547696, + "heading": 3.0866552681926986, + "angularVelocity": 0.25585722201676364, + "velocityX": -0.5932694739602328, + "velocityY": 0.9575328504876601, + "timestamp": 1.02263773616151 + }, + { + "x": 1.7377346923011106, + "y": 5.517241063340047, + "heading": 3.103016273246131, + "angularVelocity": 0.19198593372675934, + "velocityX": -0.4449530596537833, + "velocityY": 0.718148829775071, + "timestamp": 1.1078575475083023 + }, + { + "x": 1.7124554199802746, + "y": 5.558041412096877, + "heading": 3.113923384428593, + "angularVelocity": 0.1279879761535398, + "velocityX": -0.29663609812470576, + "velocityY": 0.4787660065427378, + "timestamp": 1.1930773588550947 }, { "x": 1.6998157501220703, "y": 5.578441619873047, "heading": 3.119374105883044, - "angularVelocity": 0.3015956666348506, - "velocityX": 0.3979216000138016, - "velocityY": 0.9977952745821669, - "timestamp": 0.971856542252004 - }, - { - "x": 1.7709826420562977, - "y": 5.642054671165342, - "heading": 3.1403920142026824, - "angularVelocity": 0.235935182853837, - "velocityX": 0.7988793844891111, - "velocityY": 0.714084230470965, - "timestamp": 1.0609399424698471 - }, - { - "x": 1.8769896454817743, - "y": 5.679202945892192, - "heading": 3.155122468211894, - "angularVelocity": 0.165355767440287, - "velocityX": 1.1899748232134009, - "velocityY": 0.41700557720079373, - "timestamp": 1.15002334268769 - }, - { - "x": 2.0158411922869908, - "y": 5.6874616166026, - "heading": 3.162677726672294, - "angularVelocity": 0.08481106964848781, - "velocityX": 1.5586691399932127, - "velocityY": 0.09270717878091565, - "timestamp": 1.239106742905533 - }, - { - "x": 2.179488895661179, - "y": 5.65973110035875, - "heading": 3.160185249129962, - "angularVelocity": -0.027979146914432176, - "velocityX": 1.837016806430909, - "velocityY": -0.31128713291183985, - "timestamp": 1.3281901431233758 - }, - { - "x": 2.302727279564493, - "y": 5.615213661893722, - "heading": 3.152124381433497, - "angularVelocity": -0.09048675372463387, - "velocityX": 1.3834045804487551, - "velocityY": -0.49972765247133827, - "timestamp": 1.4172735433412187 - }, - { - "x": 2.3835854229640785, - "y": 5.5816948392958325, - "heading": 3.1456792910205356, - "angularVelocity": -0.0723489493800244, - "velocityX": 0.9076679067239992, - "velocityY": -0.3762633949301785, - "timestamp": 1.5063569435590616 - }, - { - "x": 2.4236249923706055, - "y": 5.564, - "heading": 3.142185307179586, - "angularVelocity": -0.03922149168537586, - "velocityX": 0.4494616203312267, - "velocityY": -0.1986322844947736, - "timestamp": 1.5954403437769045 - }, - { - "x": 2.4236249923706055, - "y": 5.564, - "heading": 3.142185307179586, - "angularVelocity": -1.3163055540056727e-20, - "velocityX": -6.385708612136203e-20, - "velocityY": -2.8704334108285326e-20, - "timestamp": 1.6845237439947474 + "angularVelocity": 0.06396073129368503, + "velocityX": -0.14831844448432865, + "velocityY": 0.23938339517267646, + "timestamp": 1.278297170201887 + }, + { + "x": 1.6998157501220703, + "y": 5.578441619873047, + "heading": 3.119374105883044, + "angularVelocity": -3.4316659457512185e-22, + "velocityX": -1.2045271909880823e-19, + "velocityY": 2.513903520736929e-21, + "timestamp": 1.3635169815486794 } ], "eventMarkers": [ { - "timestamp": 1.6845237439947474, - "command": { - "type": "named", - "data": { - "name": "Wait and Shoot" - } - } - }, - { - "timestamp": 0.971856542252004, + "timestamp": 1.3635169815486794, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.3.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.3.traj index f8e1666..4591e80 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start C.3.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.3.traj @@ -1,204 +1,123 @@ { "samples": [ { - "x": 2.4236249923706055, - "y": 5.564, - "heading": 3.142185307179586, - "angularVelocity": -1.3163055540056727e-20, - "velocityX": -6.385708612136203e-20, - "velocityY": -2.8704334108285326e-20, + "x": 1.6998157501220703, + "y": 5.578441619873047, + "heading": 3.119374105883044, + "angularVelocity": -3.4316659457512185e-22, + "velocityX": -1.2045271909880823e-19, + "velocityY": 2.513903520736929e-21, "timestamp": 0 }, { - "x": 2.409612055518575, - "y": 5.58524376278675, - "heading": 3.148111521834478, - "angularVelocity": 0.08717591331517136, - "velocityX": -0.20613336496261087, - "velocityY": 0.31250039545180536, - "timestamp": 0.06797995489265674 - }, - { - "x": 2.3815864744249673, - "y": 5.6277314809234555, - "heading": 3.159971962699225, - "angularVelocity": 0.17446967835555188, - "velocityX": -0.4122624255615048, - "velocityY": 0.6250036235504083, - "timestamp": 0.13595990978531347 - }, - { - "x": 2.3395487510664066, - "y": 5.691463368053803, - "heading": 3.1777843874051737, - "angularVelocity": 0.2620246620356821, - "velocityX": -0.6183841019744774, - "velocityY": 0.9375099943943577, - "timestamp": 0.2039398646779702 - }, - { - "x": 2.283499791323817, - "y": 5.776439782459147, - "heading": 3.201576339928571, - "angularVelocity": 0.34998482362875394, - "velocityX": -0.8244924526809903, - "velocityY": 1.2500216356353748, - "timestamp": 0.27191981957062694 - }, - { - "x": 2.2134415121987265, - "y": 5.8826616080438106, - "heading": 3.2313857853388175, - "angularVelocity": 0.43850345969362503, - "velocityX": -1.0305726038758856, - "velocityY": 1.5625462793026774, - "timestamp": 0.3398997744632837 - }, - { - "x": 2.129379950303024, - "y": 6.010132186700346, - "heading": 3.267266255767484, - "angularVelocity": 0.527809565118472, - "velocityX": -1.2365639551900183, - "velocityY": 1.8751200829391979, - "timestamp": 0.4078797293559404 - }, - { - "x": 2.0652995239269436, - "y": 6.149747163890891, - "heading": 3.339691350620692, - "angularVelocity": 1.0653889807307233, - "velocityX": -0.9426370829057792, - "velocityY": 2.0537668406958973, - "timestamp": 0.47585968424859715 - }, - { - "x": 2.0152486713845863, - "y": 6.268131297939755, - "heading": 3.405944606191115, - "angularVelocity": 0.9745998754344565, - "velocityX": -0.736258984304856, - "velocityY": 1.7414564960478351, - "timestamp": 0.5438396391412539 - }, - { - "x": 1.9792219228775823, - "y": 6.3652817383289895, - "heading": 3.465961537990357, - "angularVelocity": 0.8828621892146225, - "velocityX": -0.529961347633911, - "velocityY": 1.429104219657847, - "timestamp": 0.6118195940339106 + "x": 1.7287681227432554, + "y": 5.577863962119422, + "heading": 3.120286516385215, + "angularVelocity": 0.009755413431152524, + "velocityX": 0.30955624037688323, + "velocityY": -0.006176266269302699, + "timestamp": 0.09352863500970177 }, { - "x": 1.9572180136114146, - "y": 6.441198107657332, - "heading": 3.5197002979628174, - "angularVelocity": 0.7905089089470001, - "velocityX": -0.32368231636681893, - "velocityY": 1.116746391612311, - "timestamp": 0.6797995489265674 + "x": 1.786672866957634, + "y": 5.576708644835487, + "heading": 3.122111340489658, + "angularVelocity": 0.01951086000831366, + "velocityX": 0.6191124697625702, + "velocityY": -0.01235255153477734, + "timestamp": 0.18705727001940353 }, { - "x": 1.949236712516745, - "y": 6.495880541543467, - "heading": 3.567133251485307, - "angularVelocity": 0.6977491173300784, - "velocityX": -0.11740668418025209, - "velocityY": 0.8043905585473795, - "timestamp": 0.7477795038192241 + "x": 1.87352998092093, + "y": 5.5749756652217295, + "heading": 3.1248485866529543, + "angularVelocity": 0.02926639700250132, + "velocityX": 0.9286686794294203, + "velocityY": -0.0185288667323963, + "timestamp": 0.2805859050291053 }, { - "x": 1.9552781581878664, - "y": 6.529329299926758, - "heading": 3.608243235262859, - "angularVelocity": 0.6047368498915096, - "velocityX": 0.08887098675868511, - "velocityY": 0.49203854924752166, - "timestamp": 0.8157594587118808 + "x": 1.9893394603702492, + "y": 5.572665018738519, + "heading": 3.1284982784106385, + "angularVelocity": 0.03902218563657427, + "velocityX": 1.2382248435177754, + "velocityY": -0.024705230467347593, + "timestamp": 0.37411454003880706 }, { - "x": 2.0006043407435827, - "y": 6.583133113105081, - "heading": 3.6496542119455833, - "angularVelocity": 0.4878402887555722, - "velocityX": 0.5339632087304119, - "velocityY": 0.6338335837419347, - "timestamp": 0.9006457988465981 + "x": 2.1341012843457174, + "y": 5.569776692693561, + "heading": 3.1330605100745275, + "angularVelocity": 0.048778982644361334, + "velocityX": 1.5477807835049844, + "velocityY": -0.030881729907188495, + "timestamp": 0.46764317504850883 }, { - "x": 2.083776428758392, - "y": 6.64875146963275, - "heading": 3.6808388847002447, - "angularVelocity": 0.36736974058689287, - "velocityX": 0.9798053241877831, - "velocityY": 0.7730143203668534, - "timestamp": 0.9855321389813154 + "x": 2.249910763173944, + "y": 5.5674660191857654, + "heading": 3.136710398653379, + "angularVelocity": 0.039024290031313275, + "velocityX": 1.2382248368771065, + "velocityY": -0.024705519411841684, + "timestamp": 0.5611718100582106 }, { - "x": 2.204973941262137, - "y": 6.7255300317827444, - "heading": 3.700977494901769, - "angularVelocity": 0.23724206002477527, - "velocityX": 1.4277622561109762, - "velocityY": 0.9044866586089649, - "timestamp": 1.0704184791160327 + "x": 2.336767876421202, + "y": 5.56573301061262, + "heading": 3.1394478461474296, + "angularVelocity": 0.029268549613353196, + "velocityX": 0.9286686717736026, + "velocityY": -0.018529176363649796, + "timestamp": 0.6547004450679124 }, { - "x": 2.3546609278681885, - "y": 6.778279098781838, - "heading": 3.666800571270185, - "angularVelocity": -0.4026198276111786, - "velocityX": 1.7633813210522657, - "velocityY": 0.6214081902385484, - "timestamp": 1.15530481925075 + "x": 2.39467262006123, + "y": 5.564577670368081, + "heading": 3.1412728202985685, + "angularVelocity": 0.019512464294487476, + "velocityX": 0.6191124636216653, + "velocityY": -0.012352797027553951, + "timestamp": 0.7482290800776141 }, { - "x": 2.4671462438769933, - "y": 6.817185614214145, - "heading": 3.640375034259479, - "angularVelocity": -0.3113049398615635, - "velocityX": 1.3251285875947652, - "velocityY": 0.45833658714189324, - "timestamp": 1.2401911593854673 - }, - { - "x": 2.542197289718945, - "y": 6.842935062369607, - "heading": 3.6225306420612564, - "angularVelocity": -0.2102151202408199, - "velocityX": 0.8841357245799891, - "velocityY": 0.3033403032171308, - "timestamp": 1.3250774995201846 - }, - { - "x": 2.5797407627105713, - "y": 6.855753421783447, - "heading": 3.6135389160282902, - "angularVelocity": -0.10592665461482069, - "velocityX": 0.4422793223508465, - "velocityY": 0.15100615002955248, - "timestamp": 1.4099638396549015 + "x": 2.4236249923706055, + "y": 5.564, + "heading": 3.142185307179586, + "angularVelocity": 0.009756230067115347, + "velocityX": 0.3095562370430423, + "velocityY": -0.006176401141967854, + "timestamp": 0.8417577150873159 }, { - "x": 2.5797407627105713, - "y": 6.855753421783447, - "heading": 3.6135389160282902, - "angularVelocity": -3.766803016126858e-21, - "velocityX": -3.2775605320598313e-21, - "velocityY": 2.0004094663730272e-21, - "timestamp": 1.4948501797896183 + "x": 2.4236249923706055, + "y": 5.564, + "heading": 3.142185307179586, + "angularVelocity": 3.3410580458147742e-22, + "velocityX": 1.2042686799658795e-19, + "velocityY": -2.4047952466491755e-21, + "timestamp": 0.9352863500970177 } ], "eventMarkers": [ { - "timestamp": 0, + "timestamp": 0.9352863500970177, "command": { "type": "named", "data": { "name": "Wait and Shoot" } } + }, + { + "timestamp": 0, + "command": { + "type": "named", + "data": { + "name": "Shoot" + } + } } ] } \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.4.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.4.traj new file mode 100644 index 0000000..49ac67a --- /dev/null +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.4.traj @@ -0,0 +1,150 @@ +{ + "samples": [ + { + "x": 2.4236249923706055, + "y": 5.564, + "heading": 3.142185307179586, + "angularVelocity": 3.3410580458147742e-22, + "velocityX": 1.2042686799658795e-19, + "velocityY": -2.4047952466491755e-21, + "timestamp": 0 + }, + { + "x": 2.4140779254680305, + "y": 5.583709309226524, + "heading": 3.151463363949818, + "angularVelocity": 0.11372307764511755, + "velocityX": -0.11702039096464664, + "velocityY": 0.24158111542184144, + "timestamp": 0.08158464370076501 + }, + { + "x": 2.3949829879765785, + "y": 5.62312756336461, + "heading": 3.1700362858815154, + "angularVelocity": 0.22765217924857556, + "velocityX": -0.23405063287998745, + "velocityY": 0.4831577653591796, + "timestamp": 0.16316928740153003 + }, + { + "x": 2.3663391576755437, + "y": 5.682253860614875, + "heading": 3.197942084713568, + "angularVelocity": 0.3420471986665186, + "velocityX": -0.35109340436778835, + "velocityY": 0.7247233617533075, + "timestamp": 0.24475393110229504 + }, + { + "x": 2.328145078144294, + "y": 5.7610867485151145, + "heading": 3.2352374385677356, + "angularVelocity": 0.45713693364843233, + "velocityX": -0.46815280178630153, + "velocityY": 0.9662711550151736, + "timestamp": 0.32633857480306006 + }, + { + "x": 2.2803989066713406, + "y": 5.859624221147295, + "heading": 3.2819935759092966, + "angularVelocity": 0.5730997307906688, + "velocityX": -0.5852347857039822, + "velocityY": 1.2077943613211701, + "timestamp": 0.40792321850382507 + }, + { + "x": 2.223098132213267, + "y": 5.977863741088111, + "heading": 3.3382899990774475, + "angularVelocity": 0.6900370046921317, + "velocityX": -0.7023475480047573, + "velocityY": 1.4492864659002822, + "timestamp": 0.48950786220458964 + }, + { + "x": 2.1562393685944863, + "y": 6.115802289227864, + "heading": 3.4042057129719607, + "angularVelocity": 0.8079426581340238, + "velocityX": -0.8195018153661886, + "velocityY": 1.6907415646219235, + "timestamp": 0.5710925059053547 + }, + { + "x": 2.098828464211886, + "y": 6.233956292510019, + "heading": 3.4624873051908924, + "angularVelocity": 0.714369635941493, + "velocityX": -0.7036974334676412, + "velocityY": 1.4482382703725323, + "timestamp": 0.6526771496061197 + }, + { + "x": 2.05098170212058, + "y": 6.3324155783553335, + "heading": 3.5110711178320413, + "angularVelocity": 0.5955019282714947, + "velocityX": -0.5864677459007784, + "velocityY": 1.2068360095613324, + "timestamp": 0.7342617933068847 + }, + { + "x": 2.012701638553593, + "y": 6.41118168027954, + "heading": 3.549941318600023, + "angularVelocity": 0.47644016085366725, + "velocityX": -0.4692067260523973, + "velocityY": 0.9654525453724375, + "timestamp": 0.8158464370076497 + }, + { + "x": 1.983990243171154, + "y": 6.470255634029948, + "heading": 3.579093105150347, + "angularVelocity": 0.3573195300974364, + "velocityX": -0.3519215636676191, + "velocityY": 0.7240817765544071, + "timestamp": 0.8974310807084147 + }, + { + "x": 1.9648488560972521, + "y": 6.509638074951002, + "heading": 3.5985266556625928, + "angularVelocity": 0.238201083325482, + "velocityX": -0.23461997510350763, + "velocityY": 0.48271879528578393, + "timestamp": 0.9790157244091797 + }, + { + "x": 1.9552781581878664, + "y": 6.529329299926758, + "heading": 3.608243235262859, + "angularVelocity": 0.11909814346808352, + "velocityX": -0.1173100411455963, + "velocityY": 0.24135945298700673, + "timestamp": 1.0606003681099447 + }, + { + "x": 1.9552781581878664, + "y": 6.529329299926758, + "heading": 3.608243235262859, + "angularVelocity": -9.888785845800769e-24, + "velocityX": -4.720252750565187e-22, + "velocityY": -2.4396364960678477e-22, + "timestamp": 1.1421850118107097 + } + ], + "eventMarkers": [ + { + "timestamp": 0, + "command": { + "type": "named", + "data": { + "name": "Wait and Shoot" + } + } + } + ] +} \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.5.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.5.traj new file mode 100644 index 0000000..f3df78f --- /dev/null +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.5.traj @@ -0,0 +1,104 @@ +{ + "samples": [ + { + "x": 1.9552781581878664, + "y": 6.529329299926758, + "heading": 3.608243235262859, + "angularVelocity": -9.888785845800769e-24, + "velocityX": -4.720252750565187e-22, + "velocityY": -2.4396364960678477e-22, + "timestamp": 0 + }, + { + "x": 1.9802566647379416, + "y": 6.54238626614273, + "heading": 3.6084550653858125, + "angularVelocity": 0.0022957571929635837, + "velocityX": 0.2707102525469008, + "velocityY": 0.14150784454371504, + "timestamp": 0.09227026429576224 + }, + { + "x": 2.0302136769874943, + "y": 6.5685001981039175, + "heading": 3.6088787250144767, + "angularVelocity": 0.004591507696416521, + "velocityX": 0.5414204958752578, + "velocityY": 0.28301568398549637, + "timestamp": 0.18454052859152448 + }, + { + "x": 2.1051491934031836, + "y": 6.607671094967555, + "heading": 3.609514212959391, + "angularVelocity": 0.0068872453088156165, + "velocityX": 0.8121307225856843, + "velocityY": 0.42452351429360885, + "timestamp": 0.2768107928872867 + }, + { + "x": 2.2050632103951786, + "y": 6.659898954789809, + "heading": 3.610361527196442, + "angularVelocity": 0.009182960984431228, + "velocityX": 1.0828409103904961, + "velocityY": 0.5660313235349994, + "timestamp": 0.36908105718304896 + }, + { + "x": 2.3299557099523103, + "y": 6.725183767963683, + "heading": 3.61142066210994, + "angularVelocity": 0.011478615798723989, + "velocityX": 1.3535509029951656, + "velocityY": 0.7075390286583688, + "timestamp": 0.4613513214788112 + }, + { + "x": 2.4298697271063556, + "y": 6.777411627477712, + "heading": 3.612267964972866, + "angularVelocity": 0.009182837714761008, + "velocityX": 1.0828409121467542, + "velocityY": 0.5660313201945365, + "timestamp": 0.5536215857745734 + }, + { + "x": 2.504805243696443, + "y": 6.816582524011431, + "heading": 3.6129034408171097, + "angularVelocity": 0.0068871141650438715, + "velocityX": 0.8121307244757614, + "velocityY": 0.42452351071804617, + "timestamp": 0.6458918500703357 + }, + { + "x": 2.5547622560844396, + "y": 6.842696455711132, + "heading": 3.613327090986633, + "angularVelocity": 0.004591405180818135, + "velocityX": 0.541420497375673, + "velocityY": 0.2830156811515774, + "timestamp": 0.7381621143660979 + }, + { + "x": 2.5797407627105713, + "y": 6.855753421783447, + "heading": 3.6135389160282902, + "angularVelocity": 0.0022957021232574135, + "velocityX": 0.2707102533711829, + "velocityY": 0.14150784298679514, + "timestamp": 0.8304323786618601 + }, + { + "x": 2.5797407627105713, + "y": 6.855753421783447, + "heading": 3.6135389160282902, + "angularVelocity": 1.7177582135515924e-25, + "velocityX": 2.3572095291926415e-22, + "velocityY": 1.2321856311211027e-22, + "timestamp": 0.9227026429576224 + } + ], + "eventMarkers": [] +} \ No newline at end of file diff --git a/Robot/src/main/deploy/choreo/Amp Side Start C.traj b/Robot/src/main/deploy/choreo/Amp Side Start C.traj index 9cec7bc..bfc0c83 100644 --- a/Robot/src/main/deploy/choreo/Amp Side Start C.traj +++ b/Robot/src/main/deploy/choreo/Amp Side Start C.traj @@ -1,481 +1,598 @@ { "samples": [ { - "x": 1.373390793800354, - "y": 4.741092681884766, - "heading": 2.6399884969262475, - "angularVelocity": -3.6988129489772723e-28, - "velocityX": -6.858958396136724e-27, - "velocityY": -1.5418289496585915e-26, + "x": 1.2314672470092771, + "y": 4.670130729675293, + "heading": 2.414268531922355, + "angularVelocity": -5.2100101100154926e-30, + "velocityX": 5.347254929636904e-27, + "velocityY": 9.19140137657714e-27, "timestamp": 0 }, { - "x": 1.411237442090302, - "y": 4.725482025332623, - "heading": 2.644755988404159, - "angularVelocity": 0.0553306640200131, - "velocityX": 0.43924151527419975, - "velocityY": -0.18117452266465503, - "timestamp": 0.08616364112650379 - }, - { - "x": 1.4869306891456044, - "y": 4.694260596197965, - "heading": 2.654289693354832, - "angularVelocity": 0.11064649573798489, - "velocityX": 0.878482455774716, - "velocityY": -0.3623503919573132, - "timestamp": 0.17232728225300759 - }, - { - "x": 1.6004704665028786, - "y": 4.647428216491871, - "heading": 2.668587209347816, - "angularVelocity": 0.16593444527248416, - "velocityX": 1.3177226017013057, - "velocityY": -0.5435283269579504, - "timestamp": 0.2584909233795114 - }, - { - "x": 1.7518566827715065, - "y": 4.58498464715587, - "heading": 2.6876455596924695, - "angularVelocity": 0.22118784786116857, - "velocityX": 1.7569616869645228, - "velocityY": -0.7247090364289812, - "timestamp": 0.34465456450601517 - }, - { - "x": 1.941089213909603, - "y": 4.5069295915038685, - "heading": 2.7114619454581304, - "angularVelocity": 0.2764087665549548, - "velocityX": 2.1961993326195337, - "velocityY": -0.9058931891864103, - "timestamp": 0.43081820563251894 - }, - { - "x": 2.1303192711002823, - "y": 4.428868248917787, - "heading": 2.7352473347586073, - "angularVelocity": 0.2760490270548816, - "velocityX": 2.196170620422779, - "velocityY": -0.9059661542328877, - "timestamp": 0.5169818467590227 - }, - { - "x": 2.2817032282796483, - "y": 4.366418932119097, - "heading": 2.754276421488494, - "angularVelocity": 0.22084821951695574, - "velocityX": 1.7569354683735667, - "velocityY": -0.7247757404657851, - "timestamp": 0.6031454878855265 - }, - { - "x": 2.3952411491674033, - "y": 4.319581824357118, - "heading": 2.7685487866211282, - "angularVelocity": 0.16564254882961663, - "velocityX": 1.317701055843969, - "velocityY": -0.5435831999394507, - "timestamp": 0.6893091290120302 - }, - { - "x": 2.470933081482251, - "y": 4.288357045534494, - "heading": 2.778063858835731, - "angularVelocity": 0.1104302474942169, - "velocityX": 0.8784671971292191, - "velocityY": -0.3623892678442039, - "timestamp": 0.775472770138534 + "x": 1.25427772593092, + "y": 4.663040954972958, + "heading": 2.4209562198461265, + "angularVelocity": 0.07860545105698431, + "velocityX": 0.26810880006649607, + "velocityY": -0.08333148088273383, + "timestamp": 0.08507918768792878 + }, + { + "x": 1.299898487748357, + "y": 4.648861096431842, + "heading": 2.4343273732150403, + "angularVelocity": 0.1571612721310791, + "velocityX": 0.5362152960930298, + "velocityY": -0.1666665952797718, + "timestamp": 0.17015837537585757 + }, + { + "x": 1.3683293697300698, + "y": 4.6275906046406945, + "heading": 2.454369493563087, + "angularVelocity": 0.23557018928720364, + "velocityX": 0.8043198794130212, + "velocityY": -0.2500081673225167, + "timestamp": 0.25523756306378637 + }, + { + "x": 1.4595702265370212, + "y": 4.599228679736338, + "heading": 2.481062894448308, + "angularVelocity": 0.3137477168109834, + "velocityX": 1.0724227544534584, + "velocityY": -0.33335914076175294, + "timestamp": 0.34031675075171514 + }, + { + "x": 1.5736209091482751, + "y": 4.5637742614596535, + "heading": 2.5143822102441398, + "angularVelocity": 0.39162710295315967, + "velocityX": 1.340523877938196, + "velocityY": -0.41672257622782727, + "timestamp": 0.4253959384396439 + }, + { + "x": 1.7104812390640793, + "y": 4.521226021274406, + "heading": 2.5542983242065618, + "angularVelocity": 0.469164257994969, + "velocityX": 1.6086229033804282, + "velocityY": -0.5001016269844418, + "timestamp": 0.5104751261275727 + }, + { + "x": 1.8701509755218075, + "y": 4.471582359349749, + "heading": 2.600780705433162, + "angularVelocity": 0.5463425602639517, + "velocityX": 1.8767190989575278, + "velocityY": -0.5834994817622204, + "timestamp": 0.5955543138155015 + }, + { + "x": 2.0298090975993626, + "y": 4.421877004084367, + "heading": 2.646315216105001, + "angularVelocity": 0.5352015211858865, + "velocityX": 1.876582586368622, + "velocityY": -0.5842246102266782, + "timestamp": 0.6806335015034303 + }, + { + "x": 2.1666583517760736, + "y": 4.379270074305973, + "heading": 2.685326672139293, + "angularVelocity": 0.45853112957996595, + "velocityX": 1.6084927218472653, + "velocityY": -0.5007914501332125, + "timestamp": 0.765712689191359 + }, + { + "x": 2.2806989716360007, + "y": 4.343762747699759, + "heading": 2.717827419605436, + "angularVelocity": 0.38200585065945625, + "velocityX": 1.3404056028159197, + "velocityY": -0.4173444478155432, + "timestamp": 0.8507918768792878 + }, + { + "x": 2.3719311822566893, + "y": 4.315355961950949, + "heading": 2.7438246843650607, + "angularVelocity": 0.3055655027523666, + "velocityX": 1.0723211292910941, + "velocityY": -0.3338864241746834, + "timestamp": 0.9358710645672166 + }, + { + "x": 2.440355176758643, + "y": 4.29405041622838, + "heading": 2.763322145123904, + "angularVelocity": 0.22916839345434334, + "velocityX": 0.8042389256575113, + "velocityY": -0.2504201826740351, + "timestamp": 1.0209502522551455 + }, + { + "x": 2.4859711018991932, + "y": 4.279846572314698, + "heading": 2.776321113344305, + "angularVelocity": 0.1527866987644639, + "velocityX": 0.536158446973772, + "velocityY": -0.1669485134928884, + "timestamp": 1.1060294399430743 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": 0.05521427383525686, - "velocityX": 0.4392336134200937, - "velocityY": -0.18119463988808376, - "timestamp": 0.8616364112650378 + "angularVelocity": 0.07640186212250696, + "velocityX": 0.26807904071844774, + "velocityY": -0.08347419502425253, + "timestamp": 1.1911086276310032 }, { "x": 2.5087790489196777, "y": 4.272744655609131, "heading": 2.7828213217115327, - "angularVelocity": -2.766219324607853e-28, - "velocityX": -9.297420403564632e-27, - "velocityY": -2.6804687000261814e-26, - "timestamp": 0.9478000523915415 - }, - { - "x": 2.485712247791879, - "y": 4.293165359703155, - "heading": 2.7875035435672006, - "angularVelocity": 0.06263155257733619, - "velocityX": -0.3085521387410952, - "velocityY": 0.27315672805697044, - "timestamp": 1.022558247949388 - }, - { - "x": 2.439795645378961, - "y": 4.3342479362983335, - "heading": 2.796948863574697, - "angularVelocity": 0.12634494368163166, - "velocityX": -0.6142015878030177, - "velocityY": 0.5495394356246737, - "timestamp": 1.0973164435072345 - }, - { - "x": 2.37135097351757, - "y": 4.396340662085837, - "heading": 2.8112801553510027, - "angularVelocity": 0.19170194878789426, - "velocityX": -0.9155474038753352, - "velocityY": 0.8305808523623003, - "timestamp": 1.172074639065081 - }, - { - "x": 2.2809036686278588, - "y": 4.479989853291562, - "heading": 2.8306966822828405, - "angularVelocity": 0.25972439258266794, - "velocityX": -1.2098647407791576, - "velocityY": 1.1189300461512346, - "timestamp": 1.2468328346229274 - }, - { - "x": 2.1694610822060914, - "y": 4.586171676149044, - "heading": 2.855565368951549, - "angularVelocity": 0.3326549883011264, - "velocityX": -1.4907072808563897, - "velocityY": 1.420336888352538, - "timestamp": 1.3215910301807738 - }, - { - "x": 2.0396783229737445, - "y": 4.717080893375947, - "heading": 2.8867637105218655, - "angularVelocity": 0.4173233628435488, - "velocityX": -1.7360338657709218, - "velocityY": 1.7511018858876508, - "timestamp": 1.3963492257386203 - }, - { - "x": 1.9083459965924492, - "y": 4.878682966459805, - "heading": 2.927751972703886, - "angularVelocity": 0.5482778426654837, - "velocityX": -1.7567615884959766, - "velocityY": 2.1616636393907322, - "timestamp": 1.4711074212964668 - }, - { - "x": 1.8072662278781861, - "y": 5.034315326748822, - "heading": 2.9680728874159334, - "angularVelocity": 0.539351096039333, - "velocityX": -1.3520894660445504, - "velocityY": 2.081810015981342, - "timestamp": 1.5458656168543132 - }, - { - "x": 1.7337783112249077, - "y": 5.176201891301336, - "heading": 3.005629932991069, - "angularVelocity": 0.5023803115482496, - "velocityX": -0.9830081652574799, - "velocityY": 1.8979399314517253, - "timestamp": 1.6206238124121597 - }, - { - "x": 1.6867607756102783, - "y": 5.302300031050603, - "heading": 3.039795163689665, - "angularVelocity": 0.4570098360942832, - "velocityX": -0.6289281765535397, - "velocityY": 1.6867467012589215, - "timestamp": 1.6953820079700062 - }, - { - "x": 1.66563929435333, - "y": 5.411689307516261, - "heading": 3.0702577432581744, - "angularVelocity": 0.40748147198038986, - "velocityX": -0.2825306456280759, - "velocityY": 1.4632412627056373, - "timestamp": 1.7701402035278526 - }, - { - "x": 1.6700678493315473, - "y": 5.503848245609138, - "heading": 3.096827358057357, - "angularVelocity": 0.3554073851156999, - "velocityX": 0.059238387780379306, - "velocityY": 1.2327603335685882, - "timestamp": 1.844898399085699 + "angularVelocity": 1.3083302481141851e-23, + "velocityX": 3.175111039019461e-23, + "velocityY": -1.059107290269951e-22, + "timestamp": 1.276187815318932 + }, + { + "x": 2.4961384531980824, + "y": 4.293147174010466, + "heading": 2.7879029651962903, + "angularVelocity": 0.0596298372930921, + "velocityX": -0.1483293088992677, + "velocityY": 0.23941050888166174, + "timestamp": 1.3614076266657247 + }, + { + "x": 2.4708572541131812, + "y": 4.333952271885203, + "heading": 2.7980693711600293, + "angularVelocity": 0.11929627398925077, + "velocityX": -0.2966587074691136, + "velocityY": 0.4788217344049931, + "timestamp": 1.4466274380125173 + }, + { + "x": 2.43293550597329, + "y": 4.39515996535009, + "heading": 2.81333132170297, + "angularVelocity": 0.17908923173783667, + "velocityX": -0.4449874687656011, + "velocityY": 0.7182331490480437, + "timestamp": 1.5318472493593098 + }, + { + "x": 2.3823733177577484, + "y": 4.4767702188313825, + "heading": 2.833707465015003, + "angularVelocity": 0.23910101407188608, + "velocityX": -0.5933149512592097, + "velocityY": 0.9576441462559535, + "timestamp": 1.6170670607061024 + }, + { + "x": 2.3191708434490903, + "y": 4.578782935778785, + "heading": 2.8592245757517496, + "angularVelocity": 0.29942697987100375, + "velocityX": -0.7416406268662431, + "velocityY": 1.1970540105078704, + "timestamp": 1.702286872052895 + }, + { + "x": 2.2433282697859203, + "y": 4.701197946502626, + "heading": 2.889917854748574, + "angularVelocity": 0.36016600496710854, + "velocityX": -0.8899641112151426, + "velocityY": 1.4364618835599956, + "timestamp": 1.7875066833996875 + }, + { + "x": 2.1548458019426757, + "y": 4.844014991577765, + "heading": 2.92583130513466, + "angularVelocity": 0.42142137865032253, + "velocityX": -1.0382851879731971, + "velocityY": 1.6758667124239617, + "timestamp": 1.8727264947464801 + }, + { + "x": 2.0537236539135044, + "y": 5.007233688756998, + "heading": 2.9670187669038475, + "angularVelocity": 0.48330853023811365, + "velocityX": -1.1866037536467386, + "velocityY": 1.915267055861383, + "timestamp": 1.9579463060932727 + }, + { + "x": 1.9652468625527026, + "y": 5.150036653856614, + "heading": 3.004999757447428, + "angularVelocity": 0.4456826404956622, + "velocityX": -1.038218578081046, + "velocityY": 1.675701492913359, + "timestamp": 2.043166117440065 + }, + { + "x": 1.8894096037270685, + "y": 5.272438573207108, + "heading": 3.037623268634309, + "angularVelocity": 0.38281604560379573, + "velocityX": -0.8899017449947522, + "velocityY": 1.4363082646638674, + "timestamp": 2.1283859287868574 + }, + { + "x": 1.826211820751686, + "y": 5.374439786670781, + "heading": 3.0648511640007152, + "angularVelocity": 0.31950194369247265, + "velocityX": -0.7415855770697051, + "velocityY": 1.196919024481186, + "timestamp": 2.2136057401336497 + }, + { + "x": 1.775653508102984, + "y": 5.456040555547696, + "heading": 3.0866552681926986, + "angularVelocity": 0.25585722201676364, + "velocityX": -0.5932694739602328, + "velocityY": 0.9575328504876601, + "timestamp": 2.298825551480442 + }, + { + "x": 1.7377346923011106, + "y": 5.517241063340047, + "heading": 3.103016273246131, + "angularVelocity": 0.19198593372675934, + "velocityX": -0.4449530596537833, + "velocityY": 0.718148829775071, + "timestamp": 2.3840453628272344 + }, + { + "x": 1.7124554199802746, + "y": 5.558041412096877, + "heading": 3.113923384428593, + "angularVelocity": 0.1279879761535398, + "velocityX": -0.29663609812470576, + "velocityY": 0.4787660065427378, + "timestamp": 2.469265174174027 }, { "x": 1.6998157501220703, "y": 5.578441619873047, "heading": 3.119374105883044, - "angularVelocity": 0.3015956666348506, - "velocityX": 0.3979216000138016, - "velocityY": 0.9977952745821669, - "timestamp": 1.9196565946435455 - }, - { - "x": 1.7709826420562977, - "y": 5.642054671165342, - "heading": 3.1403920142026824, - "angularVelocity": 0.235935182853837, - "velocityX": 0.7988793844891111, - "velocityY": 0.714084230470965, - "timestamp": 2.0087399948613887 - }, - { - "x": 1.8769896454817743, - "y": 5.679202945892192, - "heading": 3.155122468211894, - "angularVelocity": 0.165355767440287, - "velocityX": 1.1899748232134009, - "velocityY": 0.41700557720079373, - "timestamp": 2.0978233950792315 - }, - { - "x": 2.0158411922869908, - "y": 5.6874616166026, - "heading": 3.162677726672294, - "angularVelocity": 0.08481106964848781, - "velocityX": 1.5586691399932127, - "velocityY": 0.09270717878091565, - "timestamp": 2.1869067952970744 - }, - { - "x": 2.179488895661179, - "y": 5.65973110035875, - "heading": 3.160185249129962, - "angularVelocity": -0.027979146914432176, - "velocityX": 1.837016806430909, - "velocityY": -0.31128713291183985, - "timestamp": 2.2759901955149173 - }, - { - "x": 2.302727279564493, - "y": 5.615213661893722, - "heading": 3.152124381433497, - "angularVelocity": -0.09048675372463387, - "velocityX": 1.3834045804487551, - "velocityY": -0.49972765247133827, - "timestamp": 2.36507359573276 - }, - { - "x": 2.3835854229640785, - "y": 5.5816948392958325, - "heading": 3.1456792910205356, - "angularVelocity": -0.0723489493800244, - "velocityX": 0.9076679067239992, - "velocityY": -0.3762633949301785, - "timestamp": 2.454156995950603 + "angularVelocity": 0.06396073129368503, + "velocityX": -0.14831844448432865, + "velocityY": 0.23938339517267646, + "timestamp": 2.554484985520819 + }, + { + "x": 1.6998157501220703, + "y": 5.578441619873047, + "heading": 3.119374105883044, + "angularVelocity": -3.4316659457512185e-22, + "velocityX": -1.2045271909880823e-19, + "velocityY": 2.513903520736929e-21, + "timestamp": 2.6397047968676115 + }, + { + "x": 1.7287681227432554, + "y": 5.577863962119422, + "heading": 3.120286516385215, + "angularVelocity": 0.009755413431152524, + "velocityX": 0.30955624037688323, + "velocityY": -0.006176266269302699, + "timestamp": 2.7332334318773133 + }, + { + "x": 1.786672866957634, + "y": 5.576708644835487, + "heading": 3.122111340489658, + "angularVelocity": 0.01951086000831366, + "velocityX": 0.6191124697625702, + "velocityY": -0.01235255153477734, + "timestamp": 2.826762066887015 + }, + { + "x": 1.87352998092093, + "y": 5.5749756652217295, + "heading": 3.1248485866529543, + "angularVelocity": 0.02926639700250132, + "velocityX": 0.9286686794294203, + "velocityY": -0.0185288667323963, + "timestamp": 2.920290701896717 + }, + { + "x": 1.9893394603702492, + "y": 5.572665018738519, + "heading": 3.1284982784106385, + "angularVelocity": 0.03902218563657427, + "velocityX": 1.2382248435177754, + "velocityY": -0.024705230467347593, + "timestamp": 3.0138193369064186 + }, + { + "x": 2.1341012843457174, + "y": 5.569776692693561, + "heading": 3.1330605100745275, + "angularVelocity": 0.048778982644361334, + "velocityX": 1.5477807835049844, + "velocityY": -0.030881729907188495, + "timestamp": 3.1073479719161203 + }, + { + "x": 2.249910763173944, + "y": 5.5674660191857654, + "heading": 3.136710398653379, + "angularVelocity": 0.039024290031313275, + "velocityX": 1.2382248368771065, + "velocityY": -0.024705519411841684, + "timestamp": 3.200876606925822 + }, + { + "x": 2.336767876421202, + "y": 5.56573301061262, + "heading": 3.1394478461474296, + "angularVelocity": 0.029268549613353196, + "velocityX": 0.9286686717736026, + "velocityY": -0.018529176363649796, + "timestamp": 3.294405241935524 + }, + { + "x": 2.39467262006123, + "y": 5.564577670368081, + "heading": 3.1412728202985685, + "angularVelocity": 0.019512464294487476, + "velocityX": 0.6191124636216653, + "velocityY": -0.012352797027553951, + "timestamp": 3.3879338769452256 }, { "x": 2.4236249923706055, "y": 5.564, "heading": 3.142185307179586, - "angularVelocity": -0.03922149168537586, - "velocityX": 0.4494616203312267, - "velocityY": -0.1986322844947736, - "timestamp": 2.543240396168446 + "angularVelocity": 0.009756230067115347, + "velocityX": 0.3095562370430423, + "velocityY": -0.006176401141967854, + "timestamp": 3.4814625119549274 }, { "x": 2.4236249923706055, "y": 5.564, "heading": 3.142185307179586, - "angularVelocity": -1.3163055540056727e-20, - "velocityX": -6.385708612136203e-20, - "velocityY": -2.8704334108285326e-20, - "timestamp": 2.632323796386289 - }, - { - "x": 2.409612055518575, - "y": 5.58524376278675, - "heading": 3.148111521834478, - "angularVelocity": 0.08717591331517136, - "velocityX": -0.20613336496261087, - "velocityY": 0.31250039545180536, - "timestamp": 2.7003037512789456 - }, - { - "x": 2.3815864744249673, - "y": 5.6277314809234555, - "heading": 3.159971962699225, - "angularVelocity": 0.17446967835555188, - "velocityX": -0.4122624255615048, - "velocityY": 0.6250036235504083, - "timestamp": 2.7682837061716024 - }, - { - "x": 2.3395487510664066, - "y": 5.691463368053803, - "heading": 3.1777843874051737, - "angularVelocity": 0.2620246620356821, - "velocityX": -0.6183841019744774, - "velocityY": 0.9375099943943577, - "timestamp": 2.836263661064259 - }, - { - "x": 2.283499791323817, - "y": 5.776439782459147, - "heading": 3.201576339928571, - "angularVelocity": 0.34998482362875394, - "velocityX": -0.8244924526809903, - "velocityY": 1.2500216356353748, - "timestamp": 2.904243615956916 - }, - { - "x": 2.2134415121987265, - "y": 5.8826616080438106, - "heading": 3.2313857853388175, - "angularVelocity": 0.43850345969362503, - "velocityX": -1.0305726038758856, - "velocityY": 1.5625462793026774, - "timestamp": 2.9722235708495726 - }, - { - "x": 2.129379950303024, - "y": 6.010132186700346, - "heading": 3.267266255767484, - "angularVelocity": 0.527809565118472, - "velocityX": -1.2365639551900183, - "velocityY": 1.8751200829391979, - "timestamp": 3.0402035257422293 - }, - { - "x": 2.0652995239269436, - "y": 6.149747163890891, - "heading": 3.339691350620692, - "angularVelocity": 1.0653889807307233, - "velocityX": -0.9426370829057792, - "velocityY": 2.0537668406958973, - "timestamp": 3.108183480634886 - }, - { - "x": 2.0152486713845863, - "y": 6.268131297939755, - "heading": 3.405944606191115, - "angularVelocity": 0.9745998754344565, - "velocityX": -0.736258984304856, - "velocityY": 1.7414564960478351, - "timestamp": 3.1761634355275428 - }, - { - "x": 1.9792219228775823, - "y": 6.3652817383289895, - "heading": 3.465961537990357, - "angularVelocity": 0.8828621892146225, - "velocityX": -0.529961347633911, - "velocityY": 1.429104219657847, - "timestamp": 3.2441433904201995 - }, - { - "x": 1.9572180136114146, - "y": 6.441198107657332, - "heading": 3.5197002979628174, - "angularVelocity": 0.7905089089470001, - "velocityX": -0.32368231636681893, - "velocityY": 1.116746391612311, - "timestamp": 3.3121233453128562 - }, - { - "x": 1.949236712516745, - "y": 6.495880541543467, - "heading": 3.567133251485307, - "angularVelocity": 0.6977491173300784, - "velocityX": -0.11740668418025209, - "velocityY": 0.8043905585473795, - "timestamp": 3.380103300205513 + "angularVelocity": 3.3410580458147742e-22, + "velocityX": 1.2042686799658795e-19, + "velocityY": -2.4047952466491755e-21, + "timestamp": 3.574991146964629 + }, + { + "x": 2.4140779254680305, + "y": 5.583709309226524, + "heading": 3.151463363949818, + "angularVelocity": 0.11372307764511755, + "velocityX": -0.11702039096464664, + "velocityY": 0.24158111542184144, + "timestamp": 3.656575790665394 + }, + { + "x": 2.3949829879765785, + "y": 5.62312756336461, + "heading": 3.1700362858815154, + "angularVelocity": 0.22765217924857556, + "velocityX": -0.23405063287998745, + "velocityY": 0.4831577653591796, + "timestamp": 3.738160434366159 + }, + { + "x": 2.3663391576755437, + "y": 5.682253860614875, + "heading": 3.197942084713568, + "angularVelocity": 0.3420471986665186, + "velocityX": -0.35109340436778835, + "velocityY": 0.7247233617533075, + "timestamp": 3.819745078066924 + }, + { + "x": 2.328145078144294, + "y": 5.7610867485151145, + "heading": 3.2352374385677356, + "angularVelocity": 0.45713693364843233, + "velocityX": -0.46815280178630153, + "velocityY": 0.9662711550151736, + "timestamp": 3.901329721767689 + }, + { + "x": 2.2803989066713406, + "y": 5.859624221147295, + "heading": 3.2819935759092966, + "angularVelocity": 0.5730997307906688, + "velocityX": -0.5852347857039822, + "velocityY": 1.2077943613211701, + "timestamp": 3.9829143654684542 + }, + { + "x": 2.223098132213267, + "y": 5.977863741088111, + "heading": 3.3382899990774475, + "angularVelocity": 0.6900370046921317, + "velocityX": -0.7023475480047573, + "velocityY": 1.4492864659002822, + "timestamp": 4.064499009169219 + }, + { + "x": 2.1562393685944863, + "y": 6.115802289227864, + "heading": 3.4042057129719607, + "angularVelocity": 0.8079426581340238, + "velocityX": -0.8195018153661886, + "velocityY": 1.6907415646219235, + "timestamp": 4.146083652869984 + }, + { + "x": 2.098828464211886, + "y": 6.233956292510019, + "heading": 3.4624873051908924, + "angularVelocity": 0.714369635941493, + "velocityX": -0.7036974334676412, + "velocityY": 1.4482382703725323, + "timestamp": 4.227668296570749 + }, + { + "x": 2.05098170212058, + "y": 6.3324155783553335, + "heading": 3.5110711178320413, + "angularVelocity": 0.5955019282714947, + "velocityX": -0.5864677459007784, + "velocityY": 1.2068360095613324, + "timestamp": 4.309252940271514 + }, + { + "x": 2.012701638553593, + "y": 6.41118168027954, + "heading": 3.549941318600023, + "angularVelocity": 0.47644016085366725, + "velocityX": -0.4692067260523973, + "velocityY": 0.9654525453724375, + "timestamp": 4.390837583972279 + }, + { + "x": 1.983990243171154, + "y": 6.470255634029948, + "heading": 3.579093105150347, + "angularVelocity": 0.3573195300974364, + "velocityX": -0.3519215636676191, + "velocityY": 0.7240817765544071, + "timestamp": 4.472422227673044 + }, + { + "x": 1.9648488560972521, + "y": 6.509638074951002, + "heading": 3.5985266556625928, + "angularVelocity": 0.238201083325482, + "velocityX": -0.23461997510350763, + "velocityY": 0.48271879528578393, + "timestamp": 4.554006871373809 + }, + { + "x": 1.9552781581878664, + "y": 6.529329299926758, + "heading": 3.608243235262859, + "angularVelocity": 0.11909814346808352, + "velocityX": -0.1173100411455963, + "velocityY": 0.24135945298700673, + "timestamp": 4.635591515074574 }, { "x": 1.9552781581878664, "y": 6.529329299926758, "heading": 3.608243235262859, - "angularVelocity": 0.6047368498915096, - "velocityX": 0.08887098675868511, - "velocityY": 0.49203854924752166, - "timestamp": 3.4480832550981697 - }, - { - "x": 2.0006043407435827, - "y": 6.583133113105081, - "heading": 3.6496542119455833, - "angularVelocity": 0.4878402887555722, - "velocityX": 0.5339632087304119, - "velocityY": 0.6338335837419347, - "timestamp": 3.532969595232887 - }, - { - "x": 2.083776428758392, - "y": 6.64875146963275, - "heading": 3.6808388847002447, - "angularVelocity": 0.36736974058689287, - "velocityX": 0.9798053241877831, - "velocityY": 0.7730143203668534, - "timestamp": 3.6178559353676043 - }, - { - "x": 2.204973941262137, - "y": 6.7255300317827444, - "heading": 3.700977494901769, - "angularVelocity": 0.23724206002477527, - "velocityX": 1.4277622561109762, - "velocityY": 0.9044866586089649, - "timestamp": 3.7027422755023216 - }, - { - "x": 2.3546609278681885, - "y": 6.778279098781838, - "heading": 3.666800571270185, - "angularVelocity": -0.4026198276111786, - "velocityX": 1.7633813210522657, - "velocityY": 0.6214081902385484, - "timestamp": 3.787628615637039 - }, - { - "x": 2.4671462438769933, - "y": 6.817185614214145, - "heading": 3.640375034259479, - "angularVelocity": -0.3113049398615635, - "velocityX": 1.3251285875947652, - "velocityY": 0.45833658714189324, - "timestamp": 3.872514955771756 - }, - { - "x": 2.542197289718945, - "y": 6.842935062369607, - "heading": 3.6225306420612564, - "angularVelocity": -0.2102151202408199, - "velocityX": 0.8841357245799891, - "velocityY": 0.3033403032171308, - "timestamp": 3.9574012959064735 + "angularVelocity": -9.888785845800769e-24, + "velocityX": -4.720252750565187e-22, + "velocityY": -2.4396364960678477e-22, + "timestamp": 4.717176158775339 + }, + { + "x": 1.9802566647379416, + "y": 6.54238626614273, + "heading": 3.6084550653858125, + "angularVelocity": 0.0022957571929635837, + "velocityX": 0.2707102525469008, + "velocityY": 0.14150784454371504, + "timestamp": 4.809446423071101 + }, + { + "x": 2.0302136769874943, + "y": 6.5685001981039175, + "heading": 3.6088787250144767, + "angularVelocity": 0.004591507696416521, + "velocityX": 0.5414204958752578, + "velocityY": 0.28301568398549637, + "timestamp": 4.901716687366863 + }, + { + "x": 2.1051491934031836, + "y": 6.607671094967555, + "heading": 3.609514212959391, + "angularVelocity": 0.0068872453088156165, + "velocityX": 0.8121307225856843, + "velocityY": 0.42452351429360885, + "timestamp": 4.993986951662626 + }, + { + "x": 2.2050632103951786, + "y": 6.659898954789809, + "heading": 3.610361527196442, + "angularVelocity": 0.009182960984431228, + "velocityX": 1.0828409103904961, + "velocityY": 0.5660313235349994, + "timestamp": 5.086257215958388 + }, + { + "x": 2.3299557099523103, + "y": 6.725183767963683, + "heading": 3.61142066210994, + "angularVelocity": 0.011478615798723989, + "velocityX": 1.3535509029951656, + "velocityY": 0.7075390286583688, + "timestamp": 5.17852748025415 + }, + { + "x": 2.4298697271063556, + "y": 6.777411627477712, + "heading": 3.612267964972866, + "angularVelocity": 0.009182837714761008, + "velocityX": 1.0828409121467542, + "velocityY": 0.5660313201945365, + "timestamp": 5.270797744549912 + }, + { + "x": 2.504805243696443, + "y": 6.816582524011431, + "heading": 3.6129034408171097, + "angularVelocity": 0.0068871141650438715, + "velocityX": 0.8121307244757614, + "velocityY": 0.42452351071804617, + "timestamp": 5.363068008845675 + }, + { + "x": 2.5547622560844396, + "y": 6.842696455711132, + "heading": 3.613327090986633, + "angularVelocity": 0.004591405180818135, + "velocityX": 0.541420497375673, + "velocityY": 0.2830156811515774, + "timestamp": 5.455338273141437 }, { "x": 2.5797407627105713, "y": 6.855753421783447, "heading": 3.6135389160282902, - "angularVelocity": -0.10592665461482069, - "velocityX": 0.4422793223508465, - "velocityY": 0.15100615002955248, - "timestamp": 4.04228763604119 + "angularVelocity": 0.0022957021232574135, + "velocityX": 0.2707102533711829, + "velocityY": 0.14150784298679514, + "timestamp": 5.547608537437199 }, { "x": 2.5797407627105713, "y": 6.855753421783447, "heading": 3.6135389160282902, - "angularVelocity": -3.766803016126858e-21, - "velocityX": -3.2775605320598313e-21, - "velocityY": 2.0004094663730272e-21, - "timestamp": 4.127173976175907 + "angularVelocity": 1.7177582135515924e-25, + "velocityX": 2.3572095291926415e-22, + "velocityY": 1.2321856311211027e-22, + "timestamp": 5.639878801732961 } ], "eventMarkers": [ @@ -502,7 +619,7 @@ } }, { - "timestamp": 2.632323796386289, + "timestamp": 3.574991146964629, "command": { "type": "named", "data": { @@ -511,7 +628,7 @@ } }, { - "timestamp": 1.9196565946435455, + "timestamp": 2.6397047968676115, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Source End.1.traj b/Robot/src/main/deploy/choreo/Source End.1.traj index 93b8e11..23c96fa 100644 --- a/Robot/src/main/deploy/choreo/Source End.1.traj +++ b/Robot/src/main/deploy/choreo/Source End.1.traj @@ -4,1180 +4,1342 @@ "x": 2.9061648845672607, "y": 3.222510576248169, "heading": 2.450157821783761, - "angularVelocity": 2.2232245385438935e-21, - "velocityX": -1.0028629842919588e-22, - "velocityY": 3.595740872121164e-22, + "angularVelocity": -1.8632638174153823e-23, + "velocityX": -1.7042168177951542e-23, + "velocityY": 6.75310101580834e-24, "timestamp": 0 }, { - "x": 2.9128666879236222, - "y": 3.2133268252235805, - "heading": 2.451842096761156, - "angularVelocity": 0.037087232725719045, - "velocityX": 0.1475717113269897, - "velocityY": -0.20222345882665166, - "timestamp": 0.04541387570895476 - }, - { - "x": 2.9263863828772303, - "y": 3.195045804898136, - "heading": 2.4552496609939367, - "angularVelocity": 0.07503354821814583, - "velocityX": 0.2976996510989831, - "velocityY": -0.4025426158868783, - "timestamp": 0.09082775141790952 - }, - { - "x": 2.946854729402669, - "y": 3.1677677418967063, - "heading": 2.4604250779323276, - "angularVelocity": 0.11396113759500918, - "velocityX": 0.4507068865166789, - "velocityY": -0.6006548125565678, - "timestamp": 0.13624162712686427 - }, - { - "x": 2.9744200000662895, - "y": 3.131610016467351, - "heading": 2.4674194939213465, - "angularVelocity": 0.15401495423654998, - "velocityX": 0.6069790396283022, - "velocityY": -0.7961823311685926, - "timestamp": 0.18165550283581905 - }, - { - "x": 3.009251552705569, - "y": 3.0867117477645403, - "heading": 2.476291957644283, - "angularVelocity": 0.1953690052749055, - "velocityX": 0.7669804018160837, - "velocityY": -0.9886464874865684, - "timestamp": 0.22706937854477383 - }, - { - "x": 3.0515443573503513, - "y": 3.033240085853495, - "heading": 2.48711112302866, - "angularVelocity": 0.23823479532367425, - "velocityX": 0.9312749459179596, - "velocityY": -1.1774300492151524, - "timestamp": 0.2724832542537286 - }, - { - "x": 3.1015247627643214, - "y": 2.9713990389557963, - "heading": 2.499957473379582, - "angularVelocity": 0.28287280374946205, - "velocityX": 1.100553622295552, - "velocityY": -1.3617214107428572, - "timestamp": 0.3178971299626834 - }, - { - "x": 3.159457845655387, - "y": 2.9014421643575323, - "heading": 2.5149262615438457, - "angularVelocity": 0.3296082514558885, - "velocityX": 1.2756692087313235, - "velocityY": -1.540429516445558, - "timestamp": 0.36331100567163815 - }, - { - "x": 3.2256566848870794, - "y": 2.8236913081216124, - "heading": 2.5321314385861196, - "angularVelocity": 0.378852867624366, - "velocityX": 1.4576786983771988, - "velocityY": -1.712050667822423, - "timestamp": 0.40872488138059293 - }, - { - "x": 3.3004936793234267, - "y": 2.738565070443291, - "heading": 2.5517109344656403, - "angularVelocity": 0.43113466036241005, - "velocityX": 1.6478882999539048, - "velocityY": -1.8744543677327146, - "timestamp": 0.4541387570895477 - }, - { - "x": 3.3844130960333265, - "y": 2.646623264818412, - "heading": 2.573833701211917, - "angularVelocity": 0.4871367264061549, - "velocityX": 1.8478805299005152, - "velocityY": -2.0245311414094913, - "timestamp": 0.4995526327985025 - }, - { - "x": 3.477941004250027, - "y": 2.54863791213145, - "heading": 2.5987086778425676, - "angularVelocity": 0.5477395673090645, - "velocityX": 2.059456647481393, - "velocityY": -2.1576082454385443, - "timestamp": 0.5449665085074572 - }, - { - "x": 3.581679832328906, - "y": 2.4457069415518324, - "heading": 2.626594326343914, - "angularVelocity": 0.6140336640734679, - "velocityX": 2.2842980577943455, - "velocityY": -2.266509276576062, - "timestamp": 0.5903803842164119 - }, - { - "x": 3.6962513052431056, - "y": 2.3394269182506258, - "heading": 2.657801644299521, - "angularVelocity": 0.6871758348837222, - "velocityX": 2.522829666608007, - "velocityY": -2.34025441876676, - "timestamp": 0.6357942599253666 - }, - { - "x": 3.8221053363389577, - "y": 2.2321018628035514, - "heading": 2.6926688755591077, - "angularVelocity": 0.7677660343953339, - "velocityX": 2.7712682331368557, - "velocityY": -2.3632657149742413, - "timestamp": 0.6812081356343214 - }, - { - "x": 3.959102455546991, - "y": 2.1268027378876284, - "heading": 2.731472736807354, - "angularVelocity": 0.8544494527824409, - "velocityX": 3.0166357103280714, - "velocityY": -2.318655328841717, - "timestamp": 0.7266220113432761 - }, - { - "x": 4.106064548213917, - "y": 2.0268914551031214, - "heading": 2.7742549929607927, - "angularVelocity": 0.9420525221766646, - "velocityX": 3.236061454185624, - "velocityY": -2.200016651844701, - "timestamp": 0.7720358870522308 - }, - { - "x": 4.260926344497603, - "y": 1.9351158880352217, - "heading": 2.8206400124914244, - "angularVelocity": 1.0213842973434086, - "velocityX": 3.4100105720144724, - "velocityY": -2.0208706179596887, - "timestamp": 0.8174497627611855 - }, - { - "x": 4.421453103064402, - "y": 1.853180476458846, - "heading": 2.8699483284502496, - "angularVelocity": 1.0857544129205938, - "velocityX": 3.5347513521103315, - "velocityY": -1.804193328520933, - "timestamp": 0.8628636384701402 - }, - { - "x": 4.585742219859622, - "y": 1.78196927864388, - "heading": 2.9214858587438353, - "angularVelocity": 1.1348410477862687, - "velocityX": 3.6175973583075147, - "velocityY": -1.5680493396190038, - "timestamp": 0.908277514179095 - }, - { - "x": 4.752322755969812, - "y": 1.7218963963668528, - "heading": 2.9746787399025414, - "angularVelocity": 1.171291380185322, - "velocityX": 3.6680537282869157, - "velocityY": -1.3227869530893723, - "timestamp": 0.9536913898880497 - }, - { - "x": 4.920083939937902, - "y": 1.6731373714270672, - "heading": 3.0290817773026917, - "angularVelocity": 1.1979386597348438, - "velocityX": 3.6940512420306497, - "velocityY": -1.073659188488304, - "timestamp": 0.9991052655970044 - }, - { - "x": 5.088181109980999, - "y": 1.6357507554913027, - "heading": 3.0843519166705553, - "angularVelocity": 1.2170319864808536, - "velocityX": 3.701449555206138, - "velocityY": -0.8232421336457948, - "timestamp": 1.0445191413059591 - }, - { - "x": 5.255960575087693, - "y": 1.6097382203527058, - "heading": 3.140221355147231, - "angularVelocity": 1.2302283741367352, - "velocityX": 3.694453787250991, - "velocityY": -0.5727882664167325, - "timestamp": 1.089933017014914 - }, - { - "x": 5.422906233517842, - "y": 1.5950742253774643, - "heading": 3.196477145763251, - "angularVelocity": 1.2387357330289996, - "velocityX": 3.676093612887361, - "velocityY": -0.3228967963276029, - "timestamp": 1.1353468927238688 - }, - { - "x": 5.588602689207526, - "y": 1.591720887906522, - "heading": 3.25294680410691, - "angularVelocity": 1.243445036612991, - "velocityX": 3.6485865410736484, - "velocityY": -0.07383949109369516, - "timestamp": 1.1807607684328236 - }, - { - "x": 5.7527096924478425, - "y": 1.5996355504389552, - "heading": 3.3094882888224446, - "angularVelocity": 1.245026631901976, - "velocityX": 3.613587272137563, - "velocityY": 0.17427850869095848, - "timestamp": 1.2261746441417785 + "x": 2.9113055909652594, + "y": 3.215525752596394, + "heading": 2.4514582575843495, + "angularVelocity": 0.02539554914305498, + "velocityX": 0.10039023987290906, + "velocityY": -0.13640306751318104, + "timestamp": 0.05120723293924288 + }, + { + "x": 2.921663253533755, + "y": 3.201613287433786, + "heading": 2.454084517759628, + "angularVelocity": 0.05128689883310875, + "velocityX": 0.2022695227602883, + "velocityY": -0.27168945408776757, + "timestamp": 0.10241446587848577 + }, + { + "x": 2.9373223301857774, + "y": 3.1808380777696263, + "heading": 2.458065087425396, + "angularVelocity": 0.07773451985759916, + "velocityX": 0.3057981412626095, + "velocityY": -0.4057084999849448, + "timestamp": 0.15362169881772864 + }, + { + "x": 2.9583768302020736, + "y": 3.1532743423653993, + "heading": 2.463432031947695, + "angularVelocity": 0.10480832910199311, + "velocityX": 0.41116261918072106, + "velocityY": -0.5382781654484499, + "timestamp": 0.20482893175697153 + }, + { + "x": 2.9849319483474153, + "y": 3.119007689264869, + "heading": 2.4702215930058764, + "angularVelocity": 0.1325898836642352, + "velocityX": 0.5185813921414029, + "velocityY": -0.6691760349790243, + "timestamp": 0.25603616469621443 + }, + { + "x": 3.017106064531415, + "y": 3.0781378144243567, + "heading": 2.4784749288852317, + "angularVelocity": 0.16117519744032857, + "velocityX": 0.6283119461302282, + "velocityY": -0.7981269928996951, + "timestamp": 0.3072433976354573 + }, + { + "x": 3.05503320258041, + "y": 3.0307820798543887, + "heading": 2.488239041717323, + "angularVelocity": 0.19067839193100064, + "velocityX": 0.7406597832379636, + "velocityY": -0.9247860478256232, + "timestamp": 0.3584506305747002 + }, + { + "x": 3.098866061793619, + "y": 2.977080340140281, + "heading": 2.499567949189288, + "angularVelocity": 0.22123647035188507, + "velocityX": 0.8559896072731706, + "velocityY": -1.0487139537069792, + "timestamp": 0.4096578635139431 + }, + { + "x": 3.148779749957633, + "y": 2.9172015757078107, + "heading": 2.512524178104069, + "angularVelocity": 0.25301560289643715, + "velocityX": 0.974739022185334, + "velocityY": -1.169341926823425, + "timestamp": 0.460865096453186 + }, + { + "x": 3.2049763386889154, + "y": 2.8513531941180035, + "heading": 2.527180682548272, + "angularVelocity": 0.28621941868238787, + "velocityX": 1.0974345908899057, + "velocityY": -1.2859195432007804, + "timestamp": 0.5120723293924289 + }, + { + "x": 3.2676902851658904, + "y": 2.779794350173089, + "heading": 2.543623317646274, + "angularVelocity": 0.32109985551281023, + "velocityX": 1.2247087545500641, + "velocityY": -1.3974362572923749, + "timestamp": 0.5632795623316718 + }, + { + "x": 3.337194501529253, + "y": 2.7028554257460047, + "heading": 2.5619540171466797, + "angularVelocity": 0.3579709046601894, + "velocityX": 1.357312480559711, + "velocityY": -1.502501111871677, + "timestamp": 0.6144867952709147 + }, + { + "x": 3.413806113461603, + "y": 2.6209670488969037, + "heading": 2.582294779466242, + "angularVelocity": 0.3972243988206946, + "velocityX": 1.496109192684732, + "velocityY": -1.5991564501495594, + "timestamp": 0.6656940282101576 + }, + { + "x": 3.4978890280612576, + "y": 2.53470378007231, + "heading": 2.6047923014828496, + "angularVelocity": 0.43934266167634894, + "velocityX": 1.6420124613922928, + "velocityY": -1.6845914897792766, + "timestamp": 0.7169012611494004 + }, + { + "x": 3.5898457436249114, + "y": 2.4448492253220104, + "heading": 2.629622143800147, + "angularVelocity": 0.48488935824276863, + "velocityX": 1.7957759145619197, + "velocityY": -1.7547238855282683, + "timestamp": 0.7681084940886433 + }, + { + "x": 3.6900805658477336, + "y": 2.352487300280918, + "heading": 2.656988575201302, + "angularVelocity": 0.5344251159523686, + "velocityX": 1.957434847958887, + "velocityY": -1.8036890442934, + "timestamp": 0.8193157270278862 + }, + { + "x": 3.7988996355540694, + "y": 2.25910621274701, + "heading": 2.6871107034493438, + "angularVelocity": 0.588239717693429, + "velocityX": 2.1250722497630243, + "velocityY": -1.8235917501088947, + "timestamp": 0.8705229599671291 + }, + { + "x": 3.9163105803925973, + "y": 2.166642684771814, + "heading": 2.720181369851551, + "angularVelocity": 0.6458202192148362, + "velocityX": 2.2928586080375637, + "velocityY": -1.8056731963022379, + "timestamp": 0.921730192906372 + }, + { + "x": 4.041773646591577, + "y": 2.0773132019579514, + "heading": 2.7562901619168882, + "angularVelocity": 0.7051502296205008, + "velocityX": 2.450104389507651, + "velocityY": -1.7444700228159478, + "timestamp": 0.9729374258456149 + }, + { + "x": 4.174143364330658, + "y": 1.9931844907546805, + "heading": 2.7953180453804842, + "angularVelocity": 0.762155680427069, + "velocityX": 2.5849808736226247, + "velocityY": -1.642906799964944, + "timestamp": 1.0241446587848577 + }, + { + "x": 4.311947651714837, + "y": 1.9157918157649183, + "heading": 2.8369077401017524, + "angularVelocity": 0.8121839891371225, + "velocityX": 2.691109819342949, + "velocityY": -1.5113621757611504, + "timestamp": 1.0753518917241005 + }, + { + "x": 4.453747658858508, + "y": 1.8460867046987703, + "heading": 2.880588628450738, + "angularVelocity": 0.8530218455821048, + "velocityX": 2.769140197673169, + "velocityY": -1.361235651003692, + "timestamp": 1.1265591246633433 + }, + { + "x": 4.598324060406724, + "y": 1.7845956072657896, + "heading": 2.9259097626939266, + "angularVelocity": 0.8850533731623834, + "velocityX": 2.8233589914877046, + "velocityY": -1.2008283577036771, + "timestamp": 1.177766357602586 + }, + { + "x": 4.74470434375679, + "y": 1.7315896509686934, + "heading": 2.9724924215655713, + "angularVelocity": 0.9096890458212096, + "velocityX": 2.8585860814573887, + "velocityY": -1.0351263533412876, + "timestamp": 1.2289735905418289 + }, + { + "x": 4.892125717500927, + "y": 1.6871983627069491, + "heading": 3.0200325344629526, + "angularVelocity": 0.9283866783777883, + "velocityX": 2.878917006100534, + "velocityY": -0.8668948840569896, + "timestamp": 1.2801808234810717 + }, + { + "x": 5.039987681067959, + "y": 1.6514747812369852, + "heading": 3.0682877630201455, + "angularVelocity": 0.9423518082776987, + "velocityX": 2.887521060598398, + "velocityY": -0.697627647882282, + "timestamp": 1.3313880564203144 + }, + { + "x": 5.187811786772728, + "y": 1.6244309343056307, + "heading": 3.117063465229142, + "angularVelocity": 0.9525158734288245, + "velocityX": 2.886781753666743, + "velocityY": -0.52812552795895, + "timestamp": 1.3825952893595572 + }, + { + "x": 5.335211195327884, + "y": 1.606057043707228, + "heading": 3.166201249668279, + "angularVelocity": 0.9595867930891536, + "velocityX": 2.8784880590998623, + "velocityY": -0.3588143616391711, + "timestamp": 1.4338025222988 + }, + { + "x": 5.481868453157292, + "y": 1.5963320188418268, + "heading": 3.215570385851473, + "angularVelocity": 0.9641047435968806, + "velocityX": 2.863994975151585, + "velocityY": -0.18991506291581592, + "timestamp": 1.4850097552380428 + }, + { + "x": 5.627519369835149, + "y": 1.5952292624279771, + "heading": 3.2650615149375475, + "angularVelocity": 0.9664870809324044, + "velocityX": 2.8443426507866874, + "velocityY": -0.021535168970328783, + "timestamp": 1.5362169881772856 + }, + { + "x": 5.771941245363314, + "y": 1.6027199120891273, + "heading": 3.3145820545267926, + "angularVelocity": 0.9670614236859987, + "velocityX": 2.820341331458405, + "velocityY": 0.14628108630743103, + "timestamp": 1.5874242211165284 }, { "x": 5.914944171905518, "y": 1.618774652481079, - "heading": 3.3659829767052933, - "angularVelocity": 1.2439961796017462, - "velocityX": 3.57235485685901, - "velocityY": 0.42143731939508383, - "timestamp": 1.2715885198507333 - }, - { - "x": 6.035588806340424, - "y": 1.6394541292062057, - "heading": 3.4083265776392007, - "angularVelocity": 1.241563923199597, - "velocityX": 3.537441840994668, - "velocityY": 0.6063464534496739, - "timestamp": 1.3056935708615462 - }, - { - "x": 6.1549110861034935, - "y": 1.666413596824975, - "heading": 3.4505355738749044, - "angularVelocity": 1.2376171559550397, - "velocityX": 3.498668854805046, - "velocityY": 0.790483134308215, - "timestamp": 1.3397986218723592 - }, - { - "x": 6.272763015314017, - "y": 1.6996199600678876, - "heading": 3.4925517835068707, - "angularVelocity": 1.2319644271649108, - "velocityX": 3.4555564562316077, - "velocityY": 0.9736494231421837, - "timestamp": 1.3739036728831722 - }, - { - "x": 6.388977310142906, - "y": 1.7390313051664819, - "heading": 3.534309249026909, - "angularVelocity": 1.2243777470615422, - "velocityX": 3.4075391000600734, - "velocityY": 1.1555867512439428, - "timestamp": 1.4080087238939851 - }, - { - "x": 6.503363828841312, - "y": 1.7845940645868774, - "heading": 3.575732671697258, - "angularVelocity": 1.2145832198643007, - "velocityX": 3.3539465653383935, - "velocityY": 1.3359534165760587, - "timestamp": 1.442113774904798 - }, - { - "x": 6.615705247769987, - "y": 1.8362390822215717, - "heading": 3.616735445353753, - "angularVelocity": 1.2022492986008166, - "velocityX": 3.2939818472359588, - "velocityY": 1.5142923439205425, - "timestamp": 1.476218825915611 - }, - { - "x": 6.725751880441458, - "y": 1.8938760902116232, - "heading": 3.657217202680655, - "angularVelocity": 1.1869724902058387, - "velocityX": 3.2266960291770768, - "velocityY": 1.6899845120236898, - "timestamp": 1.510323876926424 - }, - { - "x": 6.833215615375313, - "y": 1.9573858820901124, - "heading": 3.697060805239955, - "angularVelocity": 1.1682610457514788, - "velocityX": 3.150962445409736, - "velocityY": 1.8621814070400662, - "timestamp": 1.544428927937237 - }, - { - "x": 6.937763164011495, - "y": 2.0266091584313166, - "heading": 3.7361287911659096, - "angularVelocity": 1.1455190585572865, - "velocityX": 3.065456451099711, - "velocityY": 2.029707456507175, - "timestamp": 1.57853397894805 - }, - { - "x": 7.039009309504076, - "y": 2.1013306580386533, - "heading": 3.7742595314428558, - "angularVelocity": 1.1180379195110097, - "velocityX": 2.9686554481469685, - "velocityY": 2.1909217958256537, - "timestamp": 1.6126390299588629 - }, - { - "x": 7.136511888628047, - "y": 2.1812569307410885, - "heading": 3.811263920998153, - "angularVelocity": 1.085011998473928, - "velocityX": 2.8588897020871724, - "velocityY": 2.343531832780279, - "timestamp": 1.6467440809696758 - }, - { - "x": 7.22977216790877, - "y": 2.265986470559125, - "heading": 3.846924654529132, - "angularVelocity": 1.0456144317061005, - "velocityX": 2.734500507011559, - "velocityY": 2.484369244636938, - "timestamp": 1.6808491319804888 - }, - { - "x": 7.318247196703315, - "y": 2.3549731397061673, - "heading": 3.881002263830399, - "angularVelocity": 0.9991953769681448, - "velocityX": 2.5941913638098484, - "velocityY": 2.609193257586063, - "timestamp": 1.7149541829913018 - }, - { - "x": 7.401383330480766, - "y": 2.4474898853243734, - "heading": 3.9132542500781606, - "angularVelocity": 0.9456659729826076, - "velocityX": 2.4376487151739696, - "velocityY": 2.712699230060463, - "timestamp": 1.7490592340021147 - }, - { - "x": 7.478677656627286, - "y": 2.5426104064994783, - "heading": 3.9434712501143188, - "angularVelocity": 0.8859977962377913, - "velocityX": 2.2663600802712174, - "velocityY": 2.7890449759171334, - "timestamp": 1.7831642850129277 - }, - { - "x": 7.54975931056459, - "y": 2.639234736979551, - "heading": 3.97151996138921, - "angularVelocity": 0.8224210327672106, - "velocityX": 2.0841972620057856, - "velocityY": 2.833138424259732, - "timestamp": 1.8172693360237406 - }, - { - "x": 7.614458496352838, - "y": 2.736173038995203, - "heading": 3.997364932300229, - "angularVelocity": 0.7578047868283583, - "velocityX": 1.8970558281157706, - "velocityY": 2.842344437043021, - "timestamp": 1.8513743870345536 - }, - { - "x": 7.672823839971332, - "y": 2.832264123512942, - "heading": 4.021053133675318, - "angularVelocity": 0.6945657805226282, - "velocityX": 1.7113401648333206, - "velocityY": 2.817503028723613, - "timestamp": 1.8854794380453666 - }, - { - "x": 7.725079842066262, - "y": 2.9264763498774746, - "heading": 4.0426799683616945, - "angularVelocity": 0.6341240973226909, - "velocityX": 1.5322071231725694, - "velocityY": 2.7624127093275055, - "timestamp": 1.9195844890561795 - }, - { - "x": 7.7715553968836195, - "y": 3.0179557069730056, - "heading": 4.062360688792578, - "angularVelocity": 0.5770617503150199, - "velocityX": 1.3627176456244698, - "velocityY": 2.682281784786863, - "timestamp": 1.9536895400669925 - }, - { - "x": 7.812619256840835, - "y": 3.106025341157235, - "heading": 4.080213037477331, - "angularVelocity": 0.5234517514456478, - "velocityX": 1.204040420411492, - "velocityY": 2.582304719506425, - "timestamp": 1.9877945910778054 - }, - { - "x": 7.84863769574921, - "y": 3.190159811701933, - "heading": 4.096348157574101, - "angularVelocity": 0.47310060001536125, - "velocityX": 1.0561027719019285, - "velocityY": 2.4669211172862338, - "timestamp": 2.0218996420886186 - }, - { - "x": 7.879952597637028, - "y": 3.2699532530767157, - "heading": 4.110866673835784, - "angularVelocity": 0.425699884075218, - "velocityX": 0.918189563120411, - "velocityY": 2.3396370628351777, - "timestamp": 2.056004693099432 - }, - { - "x": 7.906872911068676, - "y": 3.3450907499043514, - "heading": 4.123857749237068, - "angularVelocity": 0.3809135308774642, - "velocityX": 0.78933508772977, - "velocityY": 2.203119321059301, - "timestamp": 2.090109744110245 - }, - { - "x": 7.92967335872801, - "y": 3.415325596446574, - "heading": 4.135399630317554, - "angularVelocity": 0.3384214577725463, - "velocityX": 0.6685358028670148, - "velocityY": 2.059367878381269, - "timestamp": 2.124214795121058 - }, - { - "x": 7.9485965380562735, - "y": 3.4804621930055037, - "heading": 4.14556079129848, - "angularVelocity": 0.2979371289520607, - "velocityX": 0.5548497588308511, - "velocityY": 1.9098812237014051, - "timestamp": 2.1583198461318713 - }, - { - "x": 7.963856309062033, - "y": 3.540343468154577, - "heading": 4.154401215837848, - "angularVelocity": 0.25921159116767506, - "velocityX": 0.44743434047118863, - "velocityY": 1.755789051014386, - "timestamp": 2.1924248971426845 - }, - { - "x": 7.975641432659769, - "y": 3.5948416835203623, - "heading": 4.161973609771009, - "angularVelocity": 0.22203145014385386, - "velocityX": 0.3455536129824143, - "velocityY": 1.5979514397591115, - "timestamp": 2.2265299481534977 - }, - { - "x": 7.984118998461396, - "y": 3.643851691478983, - "heading": 4.168324469700783, - "angularVelocity": 0.1862146439177472, - "velocityX": 0.24857214841693745, - "velocityY": 1.4370307771444562, - "timestamp": 2.260634999164311 - }, - { - "x": 7.989437470121537, - "y": 3.6872859533917026, - "heading": 4.17349499336682, - "angularVelocity": 0.15160580362119816, - "velocityX": 0.1559438119138029, - "velocityY": 1.2735433792181823, - "timestamp": 2.294740050175124 - }, - { - "x": 7.991729312970037, - "y": 3.725070821508804, - "heading": 4.177521842923806, - "angularVelocity": 0.11807194059638135, - "velocityX": 0.06719951387181163, - "velocityY": 1.1078965430992342, - "timestamp": 2.3288451011859372 - }, - { - "x": 7.99111322809602, - "y": 3.7571437330128914, - "heading": 4.180437780593536, - "angularVelocity": 0.08549870424783614, - "velocityX": -0.018064329351725014, - "velocityY": 0.9404152919729587, - "timestamp": 2.3629501521967504 - }, - { - "x": 7.987696038925939, - "y": 3.7834510681367823, - "heading": 4.182272197135822, - "angularVelocity": 0.05378723936533091, - "velocityX": -0.10019598472373147, - "velocityY": 0.7713618465356136, - "timestamp": 2.3970552032075636 - }, - { - "x": 7.981574280773792, - "y": 3.8039464966481624, - "heading": 4.183051551698239, - "angularVelocity": 0.022851587648130094, - "velocityX": -0.17949711173882896, - "velocityY": 0.6009499444783675, - "timestamp": 2.431160254218377 + "heading": 3.3640528155632063, + "angularVelocity": 0.9660893236529856, + "velocityX": 2.7926313986126945, + "velocityY": 0.31352485714275447, + "timestamp": 1.6386314540557712 + }, + { + "x": 6.020777944796609, + "y": 1.6355085584506643, + "heading": 3.400904280098954, + "angularVelocity": 0.9643675166097004, + "velocityX": 2.769568428885968, + "velocityY": 0.43791028515067126, + "timestamp": 1.6768445459538697 + }, + { + "x": 6.125639580084532, + "y": 1.656977833256518, + "heading": 3.4376552290207467, + "angularVelocity": 0.9617371193044324, + "velocityX": 2.7441285192926665, + "velocityY": 0.5618303502659502, + "timestamp": 1.7150576378519682 + }, + { + "x": 6.229428776215976, + "y": 1.6831607086195022, + "heading": 3.474267250275643, + "angularVelocity": 0.9581015153792859, + "velocityX": 2.716063814156021, + "velocityY": 0.6851807603740969, + "timestamp": 1.7532707297500667 + }, + { + "x": 6.3320343621232995, + "y": 1.714030406969641, + "heading": 3.5106976603723656, + "angularVelocity": 0.9533489253858498, + "velocityX": 2.685089868700948, + "velocityY": 0.8078304271336628, + "timestamp": 1.7914838216481652 + }, + { + "x": 6.433332658705491, + "y": 1.749553806050537, + "heading": 3.546898805378257, + "angularVelocity": 0.9473492776357301, + "velocityX": 2.6508793596791667, + "velocityY": 0.9296133161803473, + "timestamp": 1.8296969135462637 + }, + { + "x": 6.53318556675295, + "y": 1.789689683941768, + "heading": 3.58281721914692, + "angularVelocity": 0.9399504720645423, + "velocityX": 2.6130549266658, + "velocityY": 1.0503174670675757, + "timestamp": 1.8679100054443623 + }, + { + "x": 6.631438355395581, + "y": 1.8343863962295928, + "heading": 3.6183926153660977, + "angularVelocity": 0.9309740314666345, + "velocityX": 2.5711813350418873, + "velocityY": 1.1696701331317512, + "timestamp": 1.9061230973424608 + }, + { + "x": 6.727917146196004, + "y": 1.8835787832994704, + "heading": 3.653556695194787, + "angularVelocity": 0.9202102756421789, + "velocityX": 2.5247575113183647, + "velocityY": 1.2873176345179635, + "timestamp": 1.9443361892405593 + }, + { + "x": 6.8224261353049895, + "y": 1.9371840367497888, + "heading": 3.6882317692807933, + "angularVelocity": 0.9074134639110804, + "velocityX": 2.473209688475594, + "velocityY": 1.4027981193792345, + "timestamp": 1.9825492811386578 + }, + { + "x": 6.914744691265183, + "y": 1.9950961730612478, + "heading": 3.722329234213893, + "angularVelocity": 0.8922979858323411, + "velocityX": 2.415888151798233, + "velocityY": 1.5155051170915799, + "timestamp": 2.020762373036756 + }, + { + "x": 7.0046246440390405, + "y": 2.0571786867448134, + "heading": 3.7557480315965552, + "angularVelocity": 0.8745379063222446, + "velocityX": 2.3520722430296175, + "velocityY": 1.6246398969525655, + "timestamp": 2.0589754649348544 + }, + { + "x": 7.091788391438202, + "y": 2.123254932680484, + "heading": 3.788373390594432, + "angularVelocity": 0.8537743840482023, + "velocityX": 2.280991750984126, + "velocityY": 1.7291520432807275, + "timestamp": 2.0971885568329527 + }, + { + "x": 7.175928944342895, + "y": 2.1930959306221323, + "heading": 3.8200764634573674, + "angularVelocity": 0.8296390396117933, + "velocityX": 2.2018776478246815, + "velocityY": 1.8276719959717111, + "timestamp": 2.135401648731051 + }, + { + "x": 7.256713710898279, + "y": 2.266405811115142, + "heading": 3.8507159408143004, + "angularVelocity": 0.8018057643343343, + "velocityX": 2.114059934506467, + "velocityY": 1.91844932853124, + "timestamp": 2.1736147406291493 + }, + { + "x": 7.3337944835848266, + "y": 2.3428063524565834, + "heading": 3.8801432687002584, + "angularVelocity": 0.7700849741348019, + "velocityX": 2.0171299640472826, + "velocityY": 1.9993289615291048, + "timestamp": 2.2118278325272476 + }, + { + "x": 7.406826105349172, + "y": 2.4218242186313876, + "heading": 3.908213144199668, + "angularVelocity": 0.7345617458608831, + "velocityX": 1.911167564223696, + "velocityY": 2.0678218445531384, + "timestamp": 2.250040924425346 + }, + { + "x": 7.475494494135224, + "y": 2.502887103811811, + "heading": 3.934799367276667, + "angularVelocity": 0.6957359835706366, + "velocityX": 1.7969859379389637, + "velocityY": 2.1213380324364, + "timestamp": 2.288254016323444 + }, + { + "x": 7.5395502270032555, + "y": 2.5853359669923646, + "heading": 3.9598120699093338, + "angularVelocity": 0.6545584612563531, + "velocityX": 1.6762771523133229, + "velocityY": 2.157607748685101, + "timestamp": 2.3264671082215425 + }, + { + "x": 7.598838235415281, + "y": 2.6684568263195323, + "heading": 3.9832084112667783, + "angularVelocity": 0.6122598354468323, + "velocityX": 1.5515103716319527, + "velocityY": 2.175193243949577, + "timestamp": 2.3646802001196408 + }, + { + "x": 7.653312233435752, + "y": 2.7515267667167436, + "heading": 4.0049909639065655, + "angularVelocity": 0.5700285310038007, + "velocityX": 1.4255323323675468, + "velocityY": 2.173860744342043, + "timestamp": 2.402893292017739 + }, + { + "x": 7.7030282649576645, + "y": 2.8338606563176305, + "heading": 4.025196298380201, + "angularVelocity": 0.5287542428525911, + "velocityX": 1.3010209080827217, + "velocityY": 2.154599000270482, + "timestamp": 2.4411063839158373 + }, + { + "x": 7.748121808317172, + "y": 2.9148450729972097, + "heading": 4.043881316781892, + "angularVelocity": 0.4889690279843902, + "velocityX": 1.1800548220425873, + "velocityY": 2.119284586956156, + "timestamp": 2.4793194758139356 + }, + { + "x": 7.788778861758571, + "y": 2.9939539404158495, + "heading": 4.061112406566655, + "angularVelocity": 0.45092110920288114, + "velocityX": 1.0639561318361235, + "velocityY": 2.0702032599088445, + "timestamp": 2.517532567712034 + }, + { + "x": 7.825210007677057, + "y": 3.0707487810478886, + "heading": 4.076958314450325, + "angularVelocity": 0.41467222610319826, + "velocityX": 0.9533681811363417, + "velocityY": 2.0096473961548327, + "timestamp": 2.5557456596101322 + }, + { + "x": 7.857631499196349, + "y": 3.144869951622929, + "heading": 4.091485913306106, + "angularVelocity": 0.3801733420190485, + "velocityX": 0.8484393674751142, + "velocityY": 1.939680012617054, + "timestamp": 2.5939587515082305 + }, + { + "x": 7.886253437175175, + "y": 3.2160244294016245, + "heading": 4.104757938931661, + "angularVelocity": 0.34731619364762556, + "velocityX": 0.7490086919726913, + "velocityY": 1.8620445047587648, + "timestamp": 2.632171843406329 + }, + { + "x": 7.911273388621043, + "y": 3.283973525115277, + "heading": 4.116831998207854, + "angularVelocity": 0.31596656215076, + "velocityX": 0.654748155752185, + "velocityY": 1.7781627274456175, + "timestamp": 2.670384935304427 + }, + { + "x": 7.932873600557423, + "y": 3.3485220534891567, + "heading": 4.1277603447712625, + "angularVelocity": 0.2859843582547855, + "velocityX": 0.5652568495106397, + "velocityY": 1.689173138515176, + "timestamp": 2.7085980272025254 + }, + { + "x": 7.951220358752493, + "y": 3.409509396144286, + "heading": 4.137590076238168, + "angularVelocity": 0.25723465384895294, + "velocityX": 0.48011708249084256, + "velocityY": 1.5959803205080123, + "timestamp": 2.7468111191006237 + }, + { + "x": 7.966464515315054, + "y": 3.4668023733883073, + "heading": 4.146363533085604, + "angularVelocity": 0.2295929591573598, + "velocityX": 0.39892497061509824, + "velocityY": 1.4993023175617965, + "timestamp": 2.785024210998722 + }, + { + "x": 7.978742584510864, + "y": 3.520289653410511, + "heading": 4.154118770391739, + "angularVelocity": 0.20294712939783252, + "velocityX": 0.3213053062691505, + "velocityY": 1.3997108678051104, + "timestamp": 2.8232373028968203 + }, + { + "x": 7.988178059570606, + "y": 3.569877396667095, + "heading": 4.160890032982404, + "angularVelocity": 0.17719745391765573, + "velocityX": 0.24691734144159244, + "velocityY": 1.2976637271021656, + "timestamp": 2.8614503947949186 + }, + { + "x": 7.994882760848184, + "y": 3.615485864920885, + "heading": 4.1667082001323665, + "angularVelocity": 0.15225585947028406, + "velocityX": 0.17545560813183597, + "velocityY": 1.1935299131358537, + "timestamp": 2.899663486693017 + }, + { + "x": 7.998958118835325, + "y": 3.657046773518291, + "heading": 4.171601185974506, + "angularVelocity": 0.12804475113364422, + "velocityX": 0.10664821360198111, + "velocityY": 1.0876091552139988, + "timestamp": 2.937876578591115 + }, + { + "x": 8.00049634854855, + "y": 3.6945012134134734, + "heading": 4.175594292348644, + "angularVelocity": 0.10449576770146222, + "velocityX": 0.040253997696058225, + "velocityY": 0.9801468040079241, + "timestamp": 2.9760896704892135 + }, + { + "x": 7.999581500886131, + "y": 3.727798009941937, + "heading": 4.178710516017615, + "angularVelocity": 0.08154858751763462, + "velocityX": -0.023940686737896708, + "velocityY": 0.8713452608664894, + "timestamp": 3.0143027623873118 + }, + { + "x": 7.99629039177413, + "y": 3.7568924174172387, + "heading": 4.180970814432266, + "angularVelocity": 0.05914984374145868, + "velocityX": -0.08612517199022549, + "velocityY": 0.7613727659851889, + "timestamp": 3.05251585428541 + }, + { + "x": 7.990693417298575, + "y": 3.7817450732193243, + "heading": 4.182394334940983, + "angularVelocity": 0.037252167726010275, + "velocityX": -0.14646745912318257, + "velocityY": 0.6503701890535178, + "timestamp": 3.0907289461835084 + }, + { + "x": 7.982855266066816, + "y": 3.802321153601619, + "heading": 4.182998612290459, + "angularVelocity": 0.015813359230053194, + "velocityX": -0.2051169073850163, + "velocityY": 0.5384563080413376, + "timestamp": 3.1289420380816066 }, { "x": 7.972835540771484, "y": 3.818589687347412, "heading": 4.182799738871681, - "angularVelocity": -0.007383446706423955, - "velocityX": -0.25623008156584126, - "velocityY": 0.4293554844590835, - "timestamp": 2.46526530522919 - }, - { - "x": 7.9637186612393265, - "y": 3.828871449615871, - "heading": 4.1820183188243725, - "angularVelocity": -0.03309906574350809, - "velocityX": -0.38616899585548714, - "velocityY": 0.4355106148798181, - "timestamp": 2.4888738280003215 - }, - { - "x": 7.951533900299869, - "y": 3.8392929926799955, - "heading": 4.180626994046899, - "angularVelocity": -0.05893315693492721, - "velocityX": -0.5161170420351017, - "velocityY": 0.44143139175423374, - "timestamp": 2.512482350771453 - }, - { - "x": 7.936281037210036, - "y": 3.8498483897527986, - "heading": 4.178622883313085, - "angularVelocity": -0.08488928990783955, - "velocityX": -0.6460744383584005, - "velocityY": 0.44710112424782095, - "timestamp": 2.5360908735425847 - }, - { - "x": 7.917959846822961, - "y": 3.8605312762810953, - "heading": 4.176003005913559, - "angularVelocity": -0.11097167853000488, - "velocityX": -0.776041371359331, - "velocityY": 0.45250126964154036, - "timestamp": 2.5596993963137162 - }, - { - "x": 7.896570100655752, - "y": 3.8713347995291443, - "heading": 4.172764264259679, - "angularVelocity": -0.1371852735250776, - "velocityX": -0.9060179823436121, - "velocityY": 0.4576111497012357, - "timestamp": 2.583307919084848 - }, - { - "x": 7.872111568382392, - "y": 3.8822515601370835, - "heading": 4.168903423841314, - "angularVelocity": -0.16353587455650437, - "velocityX": -1.0360043493810085, - "velocityY": 0.46240761075027864, - "timestamp": 2.6069164418559794 - }, - { - "x": 7.844584019895448, - "y": 3.8932735439961332, - "heading": 4.164417089967741, - "angularVelocity": -0.19003026648746557, - "velocityX": -1.1660004632143819, - "velocityY": 0.46686461350834163, - "timestamp": 2.630524964627111 - }, - { - "x": 7.813987228132184, - "y": 3.904392042354374, - "heading": 4.1593016805781176, - "angularVelocity": -0.21667638586345156, - "velocityX": -1.2960061948765607, - "velocityY": 0.47095273457066494, - "timestamp": 2.6541334873982425 - }, - { - "x": 7.780320972934565, - "y": 3.9155975575050164, - "heading": 4.153553394222869, - "angularVelocity": -0.2434835254613041, - "velocityX": -1.426021251900615, - "velocityY": 0.4746385557144377, - "timestamp": 2.677742010169374 - }, - { - "x": 7.7435850463173015, - "y": 3.926879690662087, - "heading": 4.147168172074516, - "angularVelocity": -0.27046258718739974, - "velocityX": -1.5560451186798385, - "velocityY": 0.4778839094018357, - "timestamp": 2.7013505329405056 - }, - { - "x": 7.703779259669669, - "y": 3.9382270076248616, - "heading": 4.140141652504649, - "angularVelocity": -0.29762639695773513, - "velocityX": -1.6860769745537036, - "velocityY": 0.48064493796511365, - "timestamp": 2.724959055711637 - }, - { - "x": 7.660903453639524, - "y": 3.949626876465817, - "heading": 4.1324691163318406, - "angularVelocity": -0.3249900998545743, - "velocityX": -1.8161155801997555, - "velocityY": 0.482870908589551, - "timestamp": 2.748567578482769 - }, - { - "x": 7.614957511778938, - "y": 3.961065269589929, - "heading": 4.124145420258021, - "angularVelocity": -0.35257166043431315, - "velocityX": -1.9461591182979985, - "velocityY": 0.48450270417155444, - "timestamp": 2.7721761012539003 - }, - { - "x": 7.565941379533382, - "y": 3.972526519867812, - "heading": 4.115164915200959, - "angularVelocity": -0.380392502492515, - "velocityX": -2.0762049671945992, - "velocityY": 0.4854708779958824, - "timestamp": 2.795784624025032 - }, - { - "x": 7.513855090932225, - "y": 3.9839930167730904, - "heading": 4.105521345095972, - "angularVelocity": -0.4084783363395984, - "velocityX": -2.2062493746896052, - "velocityY": 0.4856931124593558, - "timestamp": 2.8193931467961635 - }, - { - "x": 7.458698806563996, - "y": 3.995444822975592, - "heading": 4.095207720123672, - "angularVelocity": -0.43686024205255225, - "velocityX": -2.336286980042793, - "velocityY": 0.4850708497738249, - "timestamp": 2.843001669567295 - }, - { - "x": 7.400472868401379, - "y": 4.0068591837195235, - "heading": 4.084216155973937, - "angularVelocity": -0.46557610809832467, - "velocityX": -2.466310100257985, - "velocityY": 0.4834847505957555, - "timestamp": 2.8666101923384266 - }, - { - "x": 7.339177880333258, - "y": 4.018209888996166, - "heading": 4.072537667277958, - "angularVelocity": -0.4946725726634777, - "velocityX": -2.5963076411995325, - "velocityY": 0.4807884587562188, - "timestamp": 2.890218715109558 - }, - { - "x": 7.27481482889874, - "y": 4.029466429354311, - "heading": 4.06016189806287, - "angularVelocity": -0.524207691224974, - "velocityX": -2.7262633947272543, - "velocityY": 0.4767998602565998, - "timestamp": 2.9138272378806898 - }, - { - "x": 7.207385268714358, - "y": 4.040592855511578, - "heading": 4.047076763864054, - "angularVelocity": -0.5542546785187346, - "velocityX": -2.8561532984533065, - "velocityY": 0.4712885369884458, - "timestamp": 2.9374357606518213 - }, - { - "x": 7.136891615524657, - "y": 4.051546201216433, - "heading": 4.033267966939994, - "angularVelocity": -0.584907283608017, - "velocityX": -2.9859408770760103, - "velocityY": 0.46395726708693935, - "timestamp": 2.961044283422953 - }, - { - "x": 7.063337625419452, - "y": 4.062274241890114, - "heading": 4.018718324124552, - "angularVelocity": -0.6162877261102292, - "velocityX": -3.115569356806623, - "velocityY": 0.4544138901737024, - "timestamp": 2.9846528061940845 - }, - { - "x": 6.986729211328242, - "y": 4.0727122063788395, - "heading": 4.003406808949002, - "angularVelocity": -0.6485587990398427, - "velocityX": -3.24494737912542, - "velocityY": 0.4421269636355666, - "timestamp": 3.008261328965216 - }, - { - "x": 6.907075905402423, - "y": 4.0827777690377465, - "heading": 3.9873071408156635, - "angularVelocity": -0.681943054608452, - "velocityX": -3.3739216425358753, - "velocityY": 0.42635292163306987, - "timestamp": 3.0318698517363476 - }, - { - "x": 6.824393644375493, - "y": 4.092363079240797, - "heading": 3.970385621156536, - "angularVelocity": -0.7167547001212231, - "velocityX": -3.502220864408744, - "velocityY": 0.4060105876158922, - "timestamp": 3.055478374507479 - }, - { - "x": 6.738710497953685, - "y": 4.1013214071032555, - "heading": 3.95259764005598, - "angularVelocity": -0.7534559139086403, - "velocityX": -3.629331121326169, - "velocityY": 0.37945313009599524, - "timestamp": 3.0790868972786107 - }, - { - "x": 6.650079643932432, - "y": 4.109443461148631, - "heading": 3.9338816488629216, - "angularVelocity": -0.7927641798894928, - "velocityX": -3.754188895276186, - "velocityY": 0.3440305911605684, - "timestamp": 3.1026954200497423 - }, - { - "x": 6.5586124916873185, - "y": 4.116413273413615, - "heading": 3.9141479140434288, - "angularVelocity": -0.8358733416231714, - "velocityX": -3.8743276371765454, - "velocityY": 0.2952244124951097, - "timestamp": 3.126303942820874 - }, - { - "x": 6.46457504667221, - "y": 4.121728253195517, - "heading": 3.8932578414178582, - "angularVelocity": -0.8848530180429063, - "velocityX": -3.983199030568015, - "velocityY": 0.22512970563301316, - "timestamp": 3.1499124655920054 - }, - { - "x": 6.368678589791372, - "y": 4.124624521627842, - "heading": 3.8710237627532775, - "angularVelocity": -0.9417818675113662, - "velocityX": -4.061942282898786, - "velocityY": 0.12267893507825635, - "timestamp": 3.173520988363137 - }, - { - "x": 6.272525829089795, - "y": 4.124480807277699, - "heading": 3.8473779385258497, - "angularVelocity": -1.0015799995898869, - "velocityX": -4.0727986936627145, - "velocityY": -0.0060873927411320885, - "timestamp": 3.1971295111342686 - }, - { - "x": 6.17777722513879, - "y": 4.121614708086708, - "heading": 3.8226769599510275, - "angularVelocity": -1.0462737891006977, - "velocityX": -4.013322005342572, - "velocityY": -0.12140103888649843, - "timestamp": 3.2207380339054 + "angularVelocity": -0.005204326813122979, + "velocityX": -0.2622066102908217, + "velocityY": 0.4257319399638149, + "timestamp": 3.167155129979705 + }, + { + "x": 7.963451202002662, + "y": 3.8299573925524886, + "heading": 4.182187256834467, + "angularVelocity": -0.022887016371921386, + "velocityX": -0.35067071684037177, + "velocityY": 0.42478446604441783, + "timestamp": 3.1939162432354022 + }, + { + "x": 7.951699535558351, + "y": 3.8412962048515644, + "heading": 4.181099599512945, + "angularVelocity": -0.04064320161608694, + "velocityX": -0.439132196483299, + "velocityY": 0.42370480595245197, + "timestamp": 3.2206773564910995 + }, + { + "x": 7.937580621360099, + "y": 3.852602364647738, + "heading": 4.179534751300954, + "angularVelocity": -0.05847470533229181, + "velocityX": -0.5275906896454091, + "velocityY": 0.42248465854697903, + "timestamp": 3.247438469746797 + }, + { + "x": 7.921094550503366, + "y": 3.863871868563307, + "heading": 4.177490639391159, + "angularVelocity": -0.0763836649942111, + "velocityX": -0.6160457787840902, + "velocityY": 0.42111491431217335, + "timestamp": 3.274199583002494 + }, + { + "x": 7.902241427098489, + "y": 3.8751004449108475, + "heading": 4.174965124271339, + "angularVelocity": -0.09437257320683892, + "velocityX": -0.704496977563563, + "velocityY": 0.4195855471426245, + "timestamp": 3.3009606962581914 + }, + { + "x": 7.88102137046632, + "y": 3.886283525768321, + "heading": 4.171955988942259, + "angularVelocity": -0.11244432547808522, + "velocityX": -0.792943717602994, + "velocityY": 0.4178854874467351, + "timestamp": 3.3277218095138887 + }, + { + "x": 7.85743451777067, + "y": 3.897416215051291, + "heading": 4.168460926619584, + "angularVelocity": -0.13060227686648773, + "velocityX": -0.8813853321528802, + "velocityY": 0.41600247256526673, + "timestamp": 3.354482922769586 + }, + { + "x": 7.8314810271924085, + "y": 3.9084932518402047, + "heading": 4.164477526630598, + "angularVelocity": -0.14885030943689379, + "velocityX": -0.9698210358545546, + "velocityY": 0.41392286946641677, + "timestamp": 3.3812440360252833 + }, + { + "x": 7.803161081780004, + "y": 3.9195089680498767, + "heading": 4.1600032581515265, + "angularVelocity": -0.16719291295249908, + "velocityX": -1.05824989946468, + "velocityY": 0.4116314633258134, + "timestamp": 3.4080051492809806 + }, + { + "x": 7.772474894151133, + "y": 3.930457239309372, + "heading": 4.155035451348857, + "angularVelocity": -0.1856352818809576, + "velocityX": -1.1466708180511556, + "velocityY": 0.4091112038160546, + "timestamp": 3.434766262536678 + }, + { + "x": 7.739422712274089, + "y": 3.9413314276382687, + "heading": 4.149571275382789, + "angularVelocity": -0.2041834326494015, + "velocityX": -1.2350824706446473, + "velocityY": 0.4063428985555967, + "timestamp": 3.4615273757923752 + }, + { + "x": 7.704004826631203, + "y": 3.9521243141373215, + "heading": 4.143607712595044, + "angularVelocity": -0.2228443462260134, + "velocityX": -1.3234832685947802, + "velocityY": 0.40330483997174355, + "timestamp": 3.4882884890480725 + }, + { + "x": 7.666221579168315, + "y": 3.962828019427522, + "heading": 4.137141528026157, + "angularVelocity": -0.241626142645967, + "velocityX": -1.4118712888314486, + "velocityY": 0.3999723474851382, + "timestamp": 3.51504960230377 + }, + { + "x": 7.626073374576437, + "y": 3.9734339089269395, + "heading": 4.130169233174118, + "angularVelocity": -0.2605382961994449, + "velocityX": -1.500244186714977, + "velocityY": 0.39631720093564143, + "timestamp": 3.541810715559467 + }, + { + "x": 7.58356069465374, + "y": 3.983932479186973, + "heading": 4.122687042595275, + "angularVelocity": -0.2795919028984897, + "velocityX": -1.5885990809312174, + "velocityY": 0.3923069328140146, + "timestamp": 3.5685718288151644 + }, + { + "x": 7.538684116786936, + "y": 3.994313220324826, + "heading": 4.114690821529067, + "angularVelocity": -0.2988000158963987, + "velocityX": -1.6769323995612107, + "velocityY": 0.387903935036916, + "timestamp": 3.5953329420708617 + }, + { + "x": 7.491444338017231, + "y": 4.00456444794984, + "heading": 4.106176022154423, + "angularVelocity": -0.3181780702950364, + "velocityX": -1.7652396713969913, + "velocityY": 0.38306431900132476, + "timestamp": 3.622094055326559 + }, + { + "x": 7.4418422067924155, + "y": 4.014673095676399, + "heading": 4.097137605289561, + "angularVelocity": -0.3377444270909928, + "velocityX": -1.8535152387300855, + "velocityY": 0.3777364427994356, + "timestamp": 3.6488551685822563 + }, + { + "x": 7.389878765475513, + "y": 4.024624456021231, + "heading": 4.087569943223826, + "angularVelocity": -0.35752107822709445, + "velocityX": -1.9417518554030933, + "velocityY": 0.3718589824626068, + "timestamp": 3.6756162818379536 + }, + { + "x": 7.3355553081899885, + "y": 4.034401852682468, + "heading": 4.077466697757452, + "angularVelocity": -0.3775345730141747, + "velocityX": -2.0299401137192343, + "velocityY": 0.3653583678607193, + "timestamp": 3.702377395093651 + }, + { + "x": 7.278873460992411, + "y": 4.043986220059233, + "heading": 4.066820665162764, + "angularVelocity": -0.39781725419895203, + "velocityX": -2.1180676101175324, + "velocityY": 0.3581453164965952, + "timestamp": 3.7291385083493482 + }, + { + "x": 7.219835295323935, + "y": 4.053355555007508, + "heading": 4.055623576242335, + "angularVelocity": -0.41840893588553546, + "velocityX": -2.2061177016208897, + "velocityY": 0.35011005927721894, + "timestamp": 3.7558996216050455 + }, + { + "x": 7.158443492406841, + "y": 4.0624841888713705, + "heading": 4.043865834226526, + "angularVelocity": -0.4393592263320925, + "velocityX": -2.2940676021400144, + "velocityY": 0.3411156246243232, + "timestamp": 3.782660734860743 + }, + { + "x": 7.09470158805335, + "y": 4.071341800593327, + "heading": 4.031536164668173, + "angularVelocity": -0.46073081641055347, + "velocityX": -2.3818853776541133, + "velocityY": 0.33098816320999985, + "timestamp": 3.80942184811644 + }, + { + "x": 7.028614348964204, + "y": 4.079892046545646, + "heading": 4.018621137474081, + "angularVelocity": -0.48260425755428477, + "velocityX": -2.4695250327479035, + "velocityY": 0.31950262571743504, + "timestamp": 3.8361829613721374 + }, + { + "x": 6.960188373088244, + "y": 4.088090605115376, + "heading": 4.005104497423563, + "angularVelocity": -0.5050851181476842, + "velocityX": -2.5569181379773873, + "velocityY": 0.30636089356202295, + "timestamp": 3.8629440746278347 + }, + { + "x": 6.8894330908058015, + "y": 4.095882295321711, + "heading": 3.9909661972610597, + "angularVelocity": -0.5283150976349366, + "velocityX": -2.6439588520249506, + "velocityY": 0.2911571776512241, + "timestamp": 3.889705187883532 + }, + { + "x": 6.816362525944293, + "y": 4.103196669781287, + "heading": 3.9761809481036865, + "angularVelocity": -0.5524900633281915, + "velocityX": -2.7304755285528013, + "velocityY": 0.27332100834849943, + "timestamp": 3.9164663011392293 + }, + { + "x": 6.740998601423215, + "y": 4.109940977464476, + "heading": 3.9607159426745864, + "angularVelocity": -0.5778909599662544, + "velocityX": -2.8161729970270786, + "velocityY": 0.2520189507344823, + "timestamp": 3.9432274143949266 + }, + { + "x": 6.663377862518537, + "y": 4.115988372430229, + "heading": 3.9445270622102377, + "angularVelocity": -0.6049404712601872, + "velocityX": -2.900504854301995, + "velocityY": 0.22597695798279616, + "timestamp": 3.969988527650624 + }, + { + "x": 6.5835665711005085, + "y": 4.1211572050315874, + "heading": 3.9275520881376464, + "angularVelocity": -0.6343149446138038, + "velocityX": -2.9823606609877906, + "velocityY": 0.19314714421513643, + "timestamp": 3.9967496409063212 + }, + { + "x": 6.501698761089027, + "y": 4.125174012394954, + "heading": 3.9096978959603224, + "angularVelocity": -0.6671692618588209, + "velocityX": -3.0592079346344714, + "velocityY": 0.15009866461789562, + "timestamp": 4.023510754162018 + }, + { + "x": 6.418082461531196, + "y": 4.127617363423628, + "heading": 3.8908218948706237, + "angularVelocity": -0.7053518629566096, + "velocityX": -3.1245448856665323, + "velocityY": 0.0913022939413702, + "timestamp": 4.050271867417715 + }, + { + "x": 6.333468879031824, + "y": 4.127936187292477, + "heading": 3.8707699420597645, + "angularVelocity": -0.7492944190798996, + "velocityX": -3.161811008791136, + "velocityY": 0.011913699770386288, + "timestamp": 4.077032980673412 + }, + { + "x": 6.249185342560519, + "y": 4.125928681866208, + "heading": 3.8495306129865616, + "angularVelocity": -0.7936638834963641, + "velocityX": -3.1494779632668077, + "velocityY": -0.0750157666120823, + "timestamp": 4.103794093929109 + }, + { + "x": 6.166285601861295, + "y": 4.122007646444551, + "heading": 3.8274706354096204, + "angularVelocity": -0.8243295922020396, + "velocityX": -3.097768762724307, + "velocityY": -0.14651989191157552, + "timestamp": 4.1305552071848055 }, { "x": 6.085252285003662, "y": 4.116629123687744, - "heading": 3.7974224467067916, - "angularVelocity": -1.0697201806763073, - "velocityX": -3.9191329771917003, - "velocityY": -0.21117731284148858, - "timestamp": 3.2443465566765317 - }, - { - "x": 5.938861783887598, - "y": 4.1037244473818655, - "heading": 3.754861975503122, - "angularVelocity": -1.086887550109536, - "velocityX": -3.7384457600560106, - "velocityY": -0.3295530246351326, - "timestamp": 3.283504674919197 - }, - { - "x": 5.800760573779927, - "y": 4.092512730511137, - "heading": 3.712339212672838, - "angularVelocity": -1.0859245729523437, - "velocityX": -3.526758085050148, - "velocityY": -0.2863190922819579, - "timestamp": 3.3226627931618626 - }, - { - "x": 5.669860304643064, - "y": 4.085741390502388, - "heading": 3.6701248779070657, - "angularVelocity": -1.0780480947569435, - "velocityX": -3.342864136771513, - "velocityY": -0.17292301858807546, - "timestamp": 3.361820911404528 - }, - { - "x": 5.545377582842458, - "y": 4.084481715280869, - "heading": 3.6283363494098766, - "angularVelocity": -1.0671740720078278, - "velocityX": -3.1789760945400203, - "velocityY": -0.03216894166669459, - "timestamp": 3.4009790296471936 - }, - { - "x": 5.426822280051095, - "y": 4.089257297848366, - "heading": 3.587039929856771, - "angularVelocity": -1.054606845435952, - "velocityX": -3.0276046988945726, - "velocityY": 0.1219563855930542, - "timestamp": 3.440137147889859 - }, - { - "x": 5.3138701574626115, - "y": 4.100370049824379, - "heading": 3.5462794826588393, - "angularVelocity": -1.040919457501415, - "velocityX": -2.88451354808505, - "velocityY": 0.2837917774071924, - "timestamp": 3.4792952661325245 - }, - { - "x": 5.206293411755839, - "y": 4.118014128688355, - "heading": 3.506087166042516, - "angularVelocity": -1.0264108292244598, - "velocityX": -2.7472399220031574, - "velocityY": 0.45058546364884994, - "timestamp": 3.51845338437519 - }, - { - "x": 5.103924028303818, - "y": 4.14232411942007, - "heading": 3.4664882727991313, - "angularVelocity": -1.0112562865760766, - "velocityX": -2.6142569675496197, - "velocityY": 0.6208161122823261, - "timestamp": 3.5576115026178554 + "heading": 3.8049678199315378, + "angularVelocity": -0.8408774053258744, + "velocityX": -3.0280248838445276, + "velocityY": -0.2009827732283067, + "timestamp": 4.157316320440502 + }, + { + "x": 5.974992324878816, + "y": 4.106756362131966, + "heading": 3.772772862461783, + "angularVelocity": -0.8521811407903093, + "velocityX": -2.9185147609204627, + "velocityY": -0.2613260543442573, + "timestamp": 4.195095797043209 + }, + { + "x": 5.869427380748592, + "y": 4.097415560583956, + "heading": 3.740507406337221, + "angularVelocity": -0.854047197738348, + "velocityX": -2.7942405142443114, + "velocityY": -0.24724539321291195, + "timestamp": 4.232875273645915 + }, + { + "x": 5.768118803232247, + "y": 4.090126347890849, + "heading": 3.708345250781034, + "angularVelocity": -0.8513128938870157, + "velocityX": -2.681577052581149, + "velocityY": -0.19294107141179928, + "timestamp": 4.270654750248621 + }, + { + "x": 5.67065088965741, + "y": 4.085589027886395, + "heading": 3.676369898875793, + "angularVelocity": -0.8463683137143149, + "velocityX": -2.5799169903761094, + "velocityY": -0.12010012875955235, + "timestamp": 4.308434226851327 + }, + { + "x": 5.576731872491881, + "y": 4.084170563244895, + "heading": 3.644629809831453, + "angularVelocity": -0.8401410474296196, + "velocityX": -2.4859798390855907, + "velocityY": -0.037545905053554304, + "timestamp": 4.346213703454033 + }, + { + "x": 5.486157189161119, + "y": 4.086089175594324, + "heading": 3.6131569865293773, + "angularVelocity": -0.8330666841430566, + "velocityX": -2.397457335983126, + "velocityY": 0.05078451376130899, + "timestamp": 4.3839931800567395 + }, + { + "x": 5.398778197481823, + "y": 4.091487332597936, + "heading": 3.5819745162590415, + "angularVelocity": -0.8253812142040706, + "velocityX": -2.3128693019806765, + "velocityY": 0.14288596584815674, + "timestamp": 4.421772656659446 + }, + { + "x": 5.3144828836101885, + "y": 4.100464572741929, + "heading": 3.5511001516547482, + "angularVelocity": -0.8172258427233542, + "velocityX": -2.2312462069841628, + "velocityY": 0.2376221417358252, + "timestamp": 4.459552133262152 + }, + { + "x": 5.2331841516142665, + "y": 4.1130940414694965, + "heading": 3.52054821009081, + "angularVelocity": -0.8086914989645554, + "velocityX": -2.1519284888689807, + "velocityY": 0.3342944334666334, + "timestamp": 4.497331609864858 + }, + { + "x": 5.154812493825414, + "y": 4.129431607749487, + "heading": 3.4903306661884095, + "angularVelocity": -0.7998401941925376, + "velocityX": -2.0744505968947196, + "velocityY": 0.4324455431660657, + "timestamp": 4.535111086467564 + }, + { + "x": 5.079311226778378, + "y": 4.149521261213231, + "heading": 3.4604578201556584, + "angularVelocity": -0.7907162491131828, + "velocityX": -1.9984730821185472, + "velocityY": 0.531761031922558, + "timestamp": 4.5728905630702705 }, { "x": 5.006633281707764, "y": 4.173398494720459, - "heading": 3.427503698824361, - "angularVelocity": -0.9955681152291422, - "velocityX": -2.4845613365060037, - "velocityY": 0.7935615063987016, - "timestamp": 3.596769620860521 - }, - { - "x": 4.937656823275381, - "y": 4.200004533523932, - "heading": 3.3991245021119765, - "angularVelocity": -0.9837042847573768, - "velocityX": -2.390921716177865, - "velocityY": 0.9222415502684376, - "timestamp": 3.625618937827138 - }, - { - "x": 4.871513231042132, - "y": 4.230223128841872, - "heading": 3.371147875870923, - "angularVelocity": -0.9697500385685549, - "velocityX": -2.2927264555270552, - "velocityY": 1.0474631116189388, - "timestamp": 3.654468254793755 - }, - { - "x": 4.808351922297538, - "y": 4.263931274273916, - "heading": 3.3436428942859213, - "angularVelocity": -0.9534014831903603, - "velocityX": -2.1893519634340524, - "velocityY": 1.1684209186322614, - "timestamp": 3.683317571760372 - }, - { - "x": 4.748342933359481, - "y": 4.300975202346389, - "heading": 3.3166887915596823, - "angularVelocity": -0.9343064432835324, - "velocityX": -2.0800835252875274, - "velocityY": 1.2840487043535722, - "timestamp": 3.712166888726989 - }, - { - "x": 4.691679256160981, - "y": 4.341159950611299, - "heading": 3.2903763909228227, - "angularVelocity": -0.9120632099299534, - "velocityX": -1.9641254336825034, - "velocityY": 1.392918532920877, - "timestamp": 3.7410162056936063 - }, - { - "x": 4.638577930821313, - "y": 4.384234979098084, - "heading": 3.2648093675405647, - "angularVelocity": -0.8862262982462743, - "velocityX": -1.8406441095681965, - "velocityY": 1.4931039281322762, - "timestamp": 3.7698655226602233 - }, - { - "x": 4.589277916564578, - "y": 4.4298748189343184, - "heading": 3.24010500110691, - "angularVelocity": -0.8563241362782199, - "velocityX": -1.7088797739572847, - "velocityY": 1.5820076395236735, - "timestamp": 3.7987148396268404 - }, - { - "x": 4.5440310309587515, - "y": 4.477654622101576, - "heading": 3.2163939367958534, - "angularVelocity": -0.8218934381875912, - "velocityX": -1.5683867198029067, - "velocityY": 1.6561849011036218, - "timestamp": 3.8275641565934575 - }, - { - "x": 4.503080075782216, - "y": 4.527023624920059, - "heading": 3.193818301564307, - "angularVelocity": -0.782536212474967, - "velocityX": -1.4194774602089775, - "velocityY": 1.711271115208911, - "timestamp": 3.8564134735600746 - }, - { - "x": 4.46661789297568, - "y": 4.57728677898734, - "heading": 3.1725267154544348, - "angularVelocity": -0.7380273901981841, - "velocityX": -1.2638837463198034, - "velocityY": 1.7422649598757816, - "timestamp": 3.8852627905266917 - }, - { - "x": 4.434728523792188, - "y": 4.627614799328075, - "heading": 3.1526626177771173, - "angularVelocity": -0.6885465503499899, - "velocityX": -1.1053769217618672, - "velocityY": 1.7445134108016194, - "timestamp": 3.9141121074933087 - }, - { - "x": 4.407331531292003, - "y": 4.677102971954541, - "heading": 3.1343439647930738, - "angularVelocity": -0.6349770084761907, - "velocityX": -0.9496582720446234, - "velocityY": 1.7154018822609098, - "timestamp": 3.942961424459926 - }, - { - "x": 4.38416697035973, - "y": 4.724871159718963, - "heading": 3.1176453508036173, - "angularVelocity": -0.5788218143528088, - "velocityX": -0.8029500649557468, - "velocityY": 1.6557822779543205, - "timestamp": 3.971810741426543 - }, - { - "x": 4.364838650184773, - "y": 4.770158562720032, - "heading": 3.102596259666631, - "angularVelocity": -0.5216446252228655, - "velocityX": -0.6699749667322109, - "velocityY": 1.5697911688336352, - "timestamp": 4.0006600583931595 - }, - { - "x": 4.348888573038258, - "y": 4.812368956191183, - "heading": 3.089189215796109, - "angularVelocity": -0.46472656132675605, - "velocityX": -0.5528753822828192, - "velocityY": 1.4631332006921636, - "timestamp": 4.029509375359776 - }, - { - "x": 4.335861259266713, - "y": 4.85106463542958, - "heading": 3.077388704078398, - "angularVelocity": -0.4090395530461387, - "velocityX": -0.4515640278977055, - "velocityY": 1.3413031332136207, - "timestamp": 4.058358692326393 - }, - { - "x": 4.325340119447455, - "y": 4.8859350900174165, - "heading": 3.0671405005854333, - "angularVelocity": -0.35523210150256085, - "velocityX": -0.36469285672977003, - "velocityY": 1.2087098848195585, - "timestamp": 4.087208009293009 - }, - { - "x": 4.316960474710625, - "y": 4.9167626971561855, - "heading": 3.058380753694675, - "angularVelocity": -0.30363793017680446, - "velocityX": -0.29046250025703113, - "velocityY": 1.068573206583551, - "timestamp": 4.116057326259626 - }, - { - "x": 4.310409550752313, - "y": 4.9433947876173105, - "heading": 3.0510430147740575, - "angularVelocity": -0.25434705886134035, - "velocityX": -0.22707379747989975, - "velocityY": 0.9231445753790886, - "timestamp": 4.144906643226243 - }, - { - "x": 4.305421020948144, - "y": 4.965723440411237, - "heading": 3.0450626529491944, - "angularVelocity": -0.20729647886580527, - "velocityX": -0.1729167387201477, - "velocityY": 0.7739750934057472, - "timestamp": 4.173755960192859 - }, - { - "x": 4.301768102740837, - "y": 4.983671575861687, - "heading": 3.0403791563233025, - "angularVelocity": -0.1623434146226634, - "velocityX": -0.12662061328980811, - "velocityY": 0.6221338089639996, - "timestamp": 4.202605277159476 - }, - { - "x": 4.299256940796215, - "y": 4.997183546671836, - "heading": 3.0369370630877266, - "angularVelocity": -0.11931281560526409, - "velocityX": -0.08704406927651794, - "velocityY": 0.46836362974486884, - "timestamp": 4.231454594126093 - }, - { - "x": 4.297720871569226, - "y": 5.0062187774292, - "heading": 3.0346861151511018, - "angularVelocity": -0.0780243060599773, - "velocityX": -0.05324456134491601, - "velocityY": 0.3131869904518336, - "timestamp": 4.260303911092709 + "heading": 3.4309387268192957, + "angularVelocity": -0.7813526282216597, + "velocityX": -1.9237414492240437, + "velocityY": 0.6320159953067281, + "timestamp": 4.610670039672977 + }, + { + "x": 4.942868657450354, + "y": 4.198256846286876, + "heading": 3.404404470872184, + "angularVelocity": -0.7726521203159952, + "velocityX": -1.8567647885752279, + "velocityY": 0.723851389827387, + "timestamp": 4.645011828492841 + }, + { + "x": 4.881509496702508, + "y": 4.226188983081773, + "heading": 3.378217710449817, + "angularVelocity": -0.7625333834450684, + "velocityX": -1.786719994980448, + "velocityY": 0.8133570717999663, + "timestamp": 4.679353617312705 + }, + { + "x": 4.822674368879593, + "y": 4.25709776691911, + "heading": 3.352433635613109, + "angularVelocity": -0.7508075648579646, + "velocityX": -1.713222573568582, + "velocityY": 0.900034182827979, + "timestamp": 4.713695406132569 + }, + { + "x": 4.766496795353122, + "y": 4.290863870424898, + "heading": 3.32711485602231, + "angularVelocity": -0.7372586129279952, + "velocityX": -1.635837137696703, + "velocityY": 0.983236595009792, + "timestamp": 4.748037194952433 + }, + { + "x": 4.713126817534648, + "y": 4.327338953959474, + "heading": 3.302332355149848, + "angularVelocity": -0.72164269026451, + "velocityX": -1.5540826396207805, + "velocityY": 1.0621194989550988, + "timestamp": 4.782378983772297 + }, + { + "x": 4.662731869400387, + "y": 4.366336499085112, + "heading": 3.2781663522474465, + "angularVelocity": -0.7036908598198508, + "velocityX": -1.4674526245153463, + "velocityY": 1.1355711646296458, + "timestamp": 4.816720772592161 + }, + { + "x": 4.615495938030307, + "y": 4.407619714122828, + "heading": 3.25470688648321, + "angularVelocity": -0.6831171750339045, + "velocityX": -1.3754650818526581, + "velocityY": 1.2021276833965184, + "timestamp": 4.851062561412025 + }, + { + "x": 4.571615167814469, + "y": 4.450886271337786, + "heading": 3.2320538652482793, + "angularVelocity": -0.6596342827030635, + "velocityX": -1.2777660024062774, + "velocityY": 1.2598807080757402, + "timestamp": 4.885404350231889 + }, + { + "x": 4.531286947002188, + "y": 4.495750867878681, + "heading": 3.210316251948319, + "angularVelocity": -0.6329784803576448, + "velocityX": -1.1743191661860777, + "velocityY": 1.3064140827441386, + "timestamp": 4.919746139051753 + }, + { + "x": 4.49468875405066, + "y": 4.541729560722991, + "heading": 3.1896098329586398, + "angularVelocity": -0.6029510896561723, + "velocityX": -1.065704327270207, + "velocityY": 1.3388555000872755, + "timestamp": 4.954087927871617 + }, + { + "x": 4.461944703854708, + "y": 4.58823480395128, + "heading": 3.1700521077060673, + "angularVelocity": -0.5695022281792148, + "velocityX": -0.9534753814866304, + "velocityY": 1.3541881429714668, + "timestamp": 4.988429716691481 + }, + { + "x": 4.433084989818715, + "y": 4.634594075764574, + "heading": 3.15175191127338, + "angularVelocity": -0.5328841933272364, + "velocityX": -0.840367232684729, + "velocityY": 1.3499375951691615, + "timestamp": 5.022771505511345 + }, + { + "x": 4.408015136265837, + "y": 4.680099458997601, + "heading": 3.1347948929027134, + "angularVelocity": -0.4937721345737907, + "velocityX": -0.7300101251096751, + "velocityY": 1.3250731775132731, + "timestamp": 5.057113294331209 + }, + { + "x": 4.386515523359297, + "y": 4.7240761111554255, + "heading": 3.119233776621693, + "angularVelocity": -0.45312480263168503, + "velocityX": -0.6260481368431887, + "velocityY": 1.2805579927271504, + "timestamp": 5.091455083151073 + }, + { + "x": 4.3682750992900985, + "y": 4.7659405609732906, + "heading": 3.105089224757056, + "angularVelocity": -0.4118758035241259, + "velocityX": -0.531143679348733, + "velocityY": 1.21905268352387, + "timestamp": 5.1257968719709375 + }, + { + "x": 4.352940592262872, + "y": 4.805227096523998, + "heading": 3.0923557137916355, + "angularVelocity": -0.3707876439463567, + "velocityX": -0.44652615819354075, + "velocityY": 1.1439862890305763, + "timestamp": 5.1601386607908015 + }, + { + "x": 4.340158565629974, + "y": 4.841583652435461, + "heading": 3.0810074682882163, + "angularVelocity": -0.33045004041419795, + "velocityX": -0.3722003737179855, + "velocityY": 1.058668088088494, + "timestamp": 5.194480449610666 + }, + { + "x": 4.329600653798364, + "y": 4.874751978213288, + "heading": 3.0710045148132727, + "angularVelocity": -0.2912764249821968, + "velocityX": -0.30743628082363317, + "velocityY": 0.9658298800859751, + "timestamp": 5.22882223843053 + }, + { + "x": 4.320974113375607, + "y": 4.904544945118328, + "heading": 3.062298708280428, + "angularVelocity": -0.2535047483551423, + "velocityX": -0.25119659514553827, + "velocityY": 0.8675426624196874, + "timestamp": 5.263164027250394 + }, + { + "x": 4.314023414784346, + "y": 4.930827090495744, + "heading": 3.054838719869548, + "angularVelocity": -0.21722771781080963, + "velocityX": -0.20239768602969369, + "velocityY": 0.7653109019823413, + "timestamp": 5.297505816070258 + }, + { + "x": 4.308527535879405, + "y": 4.953499830547057, + "heading": 3.048573474005263, + "angularVelocity": -0.1824379591042448, + "velocityX": -0.1600347301000252, + "velocityY": 0.6602084757506164, + "timestamp": 5.331847604890122 + }, + { + "x": 4.3042957090143315, + "y": 4.972490820345766, + "heading": 3.0434541747536845, + "angularVelocity": -0.14906909125880094, + "velocityX": -0.12322674532980514, + "velocityY": 0.5529994345467729, + "timestamp": 5.366189393709986 + }, + { + "x": 4.301162979125563, + "y": 4.9877464707182675, + "heading": 3.039435315609642, + "angularVelocity": -0.1170253292606026, + "velocityX": -0.09122209402662507, + "velocityY": 0.44422992793192745, + "timestamp": 5.40053118252985 + }, + { + "x": 4.298986142785592, + "y": 4.999226717111559, + "heading": 3.0364750487374588, + "angularVelocity": -0.08620013615804763, + "velocityX": -0.06338738938113687, + "velocityY": 0.33429377990501713, + "timestamp": 5.434872971349714 + }, + { + "x": 4.2976402487172045, + "y": 5.006901351879666, + "heading": 3.034535187310271, + "angularVelocity": -0.05648690688080154, + "velocityX": -0.03919114625766282, + "velocityY": 0.22347801415830756, + "timestamp": 5.469214760169578 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": -0.0383058918727994, - "velocityX": -0.02444441261373577, - "velocityY": 0.15697616982684176, - "timestamp": 4.289153228059326 + "angularVelocity": -0.027784544960703036, + "velocityX": -0.018187222535483022, + "velocityY": 0.11199419020507764, + "timestamp": 5.503556548989442 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": 4.966568604592627e-21, - "velocityX": 7.617351748205077e-22, - "velocityY": 1.4083890100936048e-21, - "timestamp": 4.3180025450259425 + "angularVelocity": -8.769505529981165e-23, + "velocityX": -1.240876760933137e-21, + "velocityY": -2.1890549285133406e-22, + "timestamp": 5.537898337809306 } ], "eventMarkers": [ @@ -1191,7 +1353,7 @@ } }, { - "timestamp": 2.96526530522919, + "timestamp": 3.667155129979705, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Source End.traj b/Robot/src/main/deploy/choreo/Source End.traj index 93b8e11..23c96fa 100644 --- a/Robot/src/main/deploy/choreo/Source End.traj +++ b/Robot/src/main/deploy/choreo/Source End.traj @@ -4,1180 +4,1342 @@ "x": 2.9061648845672607, "y": 3.222510576248169, "heading": 2.450157821783761, - "angularVelocity": 2.2232245385438935e-21, - "velocityX": -1.0028629842919588e-22, - "velocityY": 3.595740872121164e-22, + "angularVelocity": -1.8632638174153823e-23, + "velocityX": -1.7042168177951542e-23, + "velocityY": 6.75310101580834e-24, "timestamp": 0 }, { - "x": 2.9128666879236222, - "y": 3.2133268252235805, - "heading": 2.451842096761156, - "angularVelocity": 0.037087232725719045, - "velocityX": 0.1475717113269897, - "velocityY": -0.20222345882665166, - "timestamp": 0.04541387570895476 - }, - { - "x": 2.9263863828772303, - "y": 3.195045804898136, - "heading": 2.4552496609939367, - "angularVelocity": 0.07503354821814583, - "velocityX": 0.2976996510989831, - "velocityY": -0.4025426158868783, - "timestamp": 0.09082775141790952 - }, - { - "x": 2.946854729402669, - "y": 3.1677677418967063, - "heading": 2.4604250779323276, - "angularVelocity": 0.11396113759500918, - "velocityX": 0.4507068865166789, - "velocityY": -0.6006548125565678, - "timestamp": 0.13624162712686427 - }, - { - "x": 2.9744200000662895, - "y": 3.131610016467351, - "heading": 2.4674194939213465, - "angularVelocity": 0.15401495423654998, - "velocityX": 0.6069790396283022, - "velocityY": -0.7961823311685926, - "timestamp": 0.18165550283581905 - }, - { - "x": 3.009251552705569, - "y": 3.0867117477645403, - "heading": 2.476291957644283, - "angularVelocity": 0.1953690052749055, - "velocityX": 0.7669804018160837, - "velocityY": -0.9886464874865684, - "timestamp": 0.22706937854477383 - }, - { - "x": 3.0515443573503513, - "y": 3.033240085853495, - "heading": 2.48711112302866, - "angularVelocity": 0.23823479532367425, - "velocityX": 0.9312749459179596, - "velocityY": -1.1774300492151524, - "timestamp": 0.2724832542537286 - }, - { - "x": 3.1015247627643214, - "y": 2.9713990389557963, - "heading": 2.499957473379582, - "angularVelocity": 0.28287280374946205, - "velocityX": 1.100553622295552, - "velocityY": -1.3617214107428572, - "timestamp": 0.3178971299626834 - }, - { - "x": 3.159457845655387, - "y": 2.9014421643575323, - "heading": 2.5149262615438457, - "angularVelocity": 0.3296082514558885, - "velocityX": 1.2756692087313235, - "velocityY": -1.540429516445558, - "timestamp": 0.36331100567163815 - }, - { - "x": 3.2256566848870794, - "y": 2.8236913081216124, - "heading": 2.5321314385861196, - "angularVelocity": 0.378852867624366, - "velocityX": 1.4576786983771988, - "velocityY": -1.712050667822423, - "timestamp": 0.40872488138059293 - }, - { - "x": 3.3004936793234267, - "y": 2.738565070443291, - "heading": 2.5517109344656403, - "angularVelocity": 0.43113466036241005, - "velocityX": 1.6478882999539048, - "velocityY": -1.8744543677327146, - "timestamp": 0.4541387570895477 - }, - { - "x": 3.3844130960333265, - "y": 2.646623264818412, - "heading": 2.573833701211917, - "angularVelocity": 0.4871367264061549, - "velocityX": 1.8478805299005152, - "velocityY": -2.0245311414094913, - "timestamp": 0.4995526327985025 - }, - { - "x": 3.477941004250027, - "y": 2.54863791213145, - "heading": 2.5987086778425676, - "angularVelocity": 0.5477395673090645, - "velocityX": 2.059456647481393, - "velocityY": -2.1576082454385443, - "timestamp": 0.5449665085074572 - }, - { - "x": 3.581679832328906, - "y": 2.4457069415518324, - "heading": 2.626594326343914, - "angularVelocity": 0.6140336640734679, - "velocityX": 2.2842980577943455, - "velocityY": -2.266509276576062, - "timestamp": 0.5903803842164119 - }, - { - "x": 3.6962513052431056, - "y": 2.3394269182506258, - "heading": 2.657801644299521, - "angularVelocity": 0.6871758348837222, - "velocityX": 2.522829666608007, - "velocityY": -2.34025441876676, - "timestamp": 0.6357942599253666 - }, - { - "x": 3.8221053363389577, - "y": 2.2321018628035514, - "heading": 2.6926688755591077, - "angularVelocity": 0.7677660343953339, - "velocityX": 2.7712682331368557, - "velocityY": -2.3632657149742413, - "timestamp": 0.6812081356343214 - }, - { - "x": 3.959102455546991, - "y": 2.1268027378876284, - "heading": 2.731472736807354, - "angularVelocity": 0.8544494527824409, - "velocityX": 3.0166357103280714, - "velocityY": -2.318655328841717, - "timestamp": 0.7266220113432761 - }, - { - "x": 4.106064548213917, - "y": 2.0268914551031214, - "heading": 2.7742549929607927, - "angularVelocity": 0.9420525221766646, - "velocityX": 3.236061454185624, - "velocityY": -2.200016651844701, - "timestamp": 0.7720358870522308 - }, - { - "x": 4.260926344497603, - "y": 1.9351158880352217, - "heading": 2.8206400124914244, - "angularVelocity": 1.0213842973434086, - "velocityX": 3.4100105720144724, - "velocityY": -2.0208706179596887, - "timestamp": 0.8174497627611855 - }, - { - "x": 4.421453103064402, - "y": 1.853180476458846, - "heading": 2.8699483284502496, - "angularVelocity": 1.0857544129205938, - "velocityX": 3.5347513521103315, - "velocityY": -1.804193328520933, - "timestamp": 0.8628636384701402 - }, - { - "x": 4.585742219859622, - "y": 1.78196927864388, - "heading": 2.9214858587438353, - "angularVelocity": 1.1348410477862687, - "velocityX": 3.6175973583075147, - "velocityY": -1.5680493396190038, - "timestamp": 0.908277514179095 - }, - { - "x": 4.752322755969812, - "y": 1.7218963963668528, - "heading": 2.9746787399025414, - "angularVelocity": 1.171291380185322, - "velocityX": 3.6680537282869157, - "velocityY": -1.3227869530893723, - "timestamp": 0.9536913898880497 - }, - { - "x": 4.920083939937902, - "y": 1.6731373714270672, - "heading": 3.0290817773026917, - "angularVelocity": 1.1979386597348438, - "velocityX": 3.6940512420306497, - "velocityY": -1.073659188488304, - "timestamp": 0.9991052655970044 - }, - { - "x": 5.088181109980999, - "y": 1.6357507554913027, - "heading": 3.0843519166705553, - "angularVelocity": 1.2170319864808536, - "velocityX": 3.701449555206138, - "velocityY": -0.8232421336457948, - "timestamp": 1.0445191413059591 - }, - { - "x": 5.255960575087693, - "y": 1.6097382203527058, - "heading": 3.140221355147231, - "angularVelocity": 1.2302283741367352, - "velocityX": 3.694453787250991, - "velocityY": -0.5727882664167325, - "timestamp": 1.089933017014914 - }, - { - "x": 5.422906233517842, - "y": 1.5950742253774643, - "heading": 3.196477145763251, - "angularVelocity": 1.2387357330289996, - "velocityX": 3.676093612887361, - "velocityY": -0.3228967963276029, - "timestamp": 1.1353468927238688 - }, - { - "x": 5.588602689207526, - "y": 1.591720887906522, - "heading": 3.25294680410691, - "angularVelocity": 1.243445036612991, - "velocityX": 3.6485865410736484, - "velocityY": -0.07383949109369516, - "timestamp": 1.1807607684328236 - }, - { - "x": 5.7527096924478425, - "y": 1.5996355504389552, - "heading": 3.3094882888224446, - "angularVelocity": 1.245026631901976, - "velocityX": 3.613587272137563, - "velocityY": 0.17427850869095848, - "timestamp": 1.2261746441417785 + "x": 2.9113055909652594, + "y": 3.215525752596394, + "heading": 2.4514582575843495, + "angularVelocity": 0.02539554914305498, + "velocityX": 0.10039023987290906, + "velocityY": -0.13640306751318104, + "timestamp": 0.05120723293924288 + }, + { + "x": 2.921663253533755, + "y": 3.201613287433786, + "heading": 2.454084517759628, + "angularVelocity": 0.05128689883310875, + "velocityX": 0.2022695227602883, + "velocityY": -0.27168945408776757, + "timestamp": 0.10241446587848577 + }, + { + "x": 2.9373223301857774, + "y": 3.1808380777696263, + "heading": 2.458065087425396, + "angularVelocity": 0.07773451985759916, + "velocityX": 0.3057981412626095, + "velocityY": -0.4057084999849448, + "timestamp": 0.15362169881772864 + }, + { + "x": 2.9583768302020736, + "y": 3.1532743423653993, + "heading": 2.463432031947695, + "angularVelocity": 0.10480832910199311, + "velocityX": 0.41116261918072106, + "velocityY": -0.5382781654484499, + "timestamp": 0.20482893175697153 + }, + { + "x": 2.9849319483474153, + "y": 3.119007689264869, + "heading": 2.4702215930058764, + "angularVelocity": 0.1325898836642352, + "velocityX": 0.5185813921414029, + "velocityY": -0.6691760349790243, + "timestamp": 0.25603616469621443 + }, + { + "x": 3.017106064531415, + "y": 3.0781378144243567, + "heading": 2.4784749288852317, + "angularVelocity": 0.16117519744032857, + "velocityX": 0.6283119461302282, + "velocityY": -0.7981269928996951, + "timestamp": 0.3072433976354573 + }, + { + "x": 3.05503320258041, + "y": 3.0307820798543887, + "heading": 2.488239041717323, + "angularVelocity": 0.19067839193100064, + "velocityX": 0.7406597832379636, + "velocityY": -0.9247860478256232, + "timestamp": 0.3584506305747002 + }, + { + "x": 3.098866061793619, + "y": 2.977080340140281, + "heading": 2.499567949189288, + "angularVelocity": 0.22123647035188507, + "velocityX": 0.8559896072731706, + "velocityY": -1.0487139537069792, + "timestamp": 0.4096578635139431 + }, + { + "x": 3.148779749957633, + "y": 2.9172015757078107, + "heading": 2.512524178104069, + "angularVelocity": 0.25301560289643715, + "velocityX": 0.974739022185334, + "velocityY": -1.169341926823425, + "timestamp": 0.460865096453186 + }, + { + "x": 3.2049763386889154, + "y": 2.8513531941180035, + "heading": 2.527180682548272, + "angularVelocity": 0.28621941868238787, + "velocityX": 1.0974345908899057, + "velocityY": -1.2859195432007804, + "timestamp": 0.5120723293924289 + }, + { + "x": 3.2676902851658904, + "y": 2.779794350173089, + "heading": 2.543623317646274, + "angularVelocity": 0.32109985551281023, + "velocityX": 1.2247087545500641, + "velocityY": -1.3974362572923749, + "timestamp": 0.5632795623316718 + }, + { + "x": 3.337194501529253, + "y": 2.7028554257460047, + "heading": 2.5619540171466797, + "angularVelocity": 0.3579709046601894, + "velocityX": 1.357312480559711, + "velocityY": -1.502501111871677, + "timestamp": 0.6144867952709147 + }, + { + "x": 3.413806113461603, + "y": 2.6209670488969037, + "heading": 2.582294779466242, + "angularVelocity": 0.3972243988206946, + "velocityX": 1.496109192684732, + "velocityY": -1.5991564501495594, + "timestamp": 0.6656940282101576 + }, + { + "x": 3.4978890280612576, + "y": 2.53470378007231, + "heading": 2.6047923014828496, + "angularVelocity": 0.43934266167634894, + "velocityX": 1.6420124613922928, + "velocityY": -1.6845914897792766, + "timestamp": 0.7169012611494004 + }, + { + "x": 3.5898457436249114, + "y": 2.4448492253220104, + "heading": 2.629622143800147, + "angularVelocity": 0.48488935824276863, + "velocityX": 1.7957759145619197, + "velocityY": -1.7547238855282683, + "timestamp": 0.7681084940886433 + }, + { + "x": 3.6900805658477336, + "y": 2.352487300280918, + "heading": 2.656988575201302, + "angularVelocity": 0.5344251159523686, + "velocityX": 1.957434847958887, + "velocityY": -1.8036890442934, + "timestamp": 0.8193157270278862 + }, + { + "x": 3.7988996355540694, + "y": 2.25910621274701, + "heading": 2.6871107034493438, + "angularVelocity": 0.588239717693429, + "velocityX": 2.1250722497630243, + "velocityY": -1.8235917501088947, + "timestamp": 0.8705229599671291 + }, + { + "x": 3.9163105803925973, + "y": 2.166642684771814, + "heading": 2.720181369851551, + "angularVelocity": 0.6458202192148362, + "velocityX": 2.2928586080375637, + "velocityY": -1.8056731963022379, + "timestamp": 0.921730192906372 + }, + { + "x": 4.041773646591577, + "y": 2.0773132019579514, + "heading": 2.7562901619168882, + "angularVelocity": 0.7051502296205008, + "velocityX": 2.450104389507651, + "velocityY": -1.7444700228159478, + "timestamp": 0.9729374258456149 + }, + { + "x": 4.174143364330658, + "y": 1.9931844907546805, + "heading": 2.7953180453804842, + "angularVelocity": 0.762155680427069, + "velocityX": 2.5849808736226247, + "velocityY": -1.642906799964944, + "timestamp": 1.0241446587848577 + }, + { + "x": 4.311947651714837, + "y": 1.9157918157649183, + "heading": 2.8369077401017524, + "angularVelocity": 0.8121839891371225, + "velocityX": 2.691109819342949, + "velocityY": -1.5113621757611504, + "timestamp": 1.0753518917241005 + }, + { + "x": 4.453747658858508, + "y": 1.8460867046987703, + "heading": 2.880588628450738, + "angularVelocity": 0.8530218455821048, + "velocityX": 2.769140197673169, + "velocityY": -1.361235651003692, + "timestamp": 1.1265591246633433 + }, + { + "x": 4.598324060406724, + "y": 1.7845956072657896, + "heading": 2.9259097626939266, + "angularVelocity": 0.8850533731623834, + "velocityX": 2.8233589914877046, + "velocityY": -1.2008283577036771, + "timestamp": 1.177766357602586 + }, + { + "x": 4.74470434375679, + "y": 1.7315896509686934, + "heading": 2.9724924215655713, + "angularVelocity": 0.9096890458212096, + "velocityX": 2.8585860814573887, + "velocityY": -1.0351263533412876, + "timestamp": 1.2289735905418289 + }, + { + "x": 4.892125717500927, + "y": 1.6871983627069491, + "heading": 3.0200325344629526, + "angularVelocity": 0.9283866783777883, + "velocityX": 2.878917006100534, + "velocityY": -0.8668948840569896, + "timestamp": 1.2801808234810717 + }, + { + "x": 5.039987681067959, + "y": 1.6514747812369852, + "heading": 3.0682877630201455, + "angularVelocity": 0.9423518082776987, + "velocityX": 2.887521060598398, + "velocityY": -0.697627647882282, + "timestamp": 1.3313880564203144 + }, + { + "x": 5.187811786772728, + "y": 1.6244309343056307, + "heading": 3.117063465229142, + "angularVelocity": 0.9525158734288245, + "velocityX": 2.886781753666743, + "velocityY": -0.52812552795895, + "timestamp": 1.3825952893595572 + }, + { + "x": 5.335211195327884, + "y": 1.606057043707228, + "heading": 3.166201249668279, + "angularVelocity": 0.9595867930891536, + "velocityX": 2.8784880590998623, + "velocityY": -0.3588143616391711, + "timestamp": 1.4338025222988 + }, + { + "x": 5.481868453157292, + "y": 1.5963320188418268, + "heading": 3.215570385851473, + "angularVelocity": 0.9641047435968806, + "velocityX": 2.863994975151585, + "velocityY": -0.18991506291581592, + "timestamp": 1.4850097552380428 + }, + { + "x": 5.627519369835149, + "y": 1.5952292624279771, + "heading": 3.2650615149375475, + "angularVelocity": 0.9664870809324044, + "velocityX": 2.8443426507866874, + "velocityY": -0.021535168970328783, + "timestamp": 1.5362169881772856 + }, + { + "x": 5.771941245363314, + "y": 1.6027199120891273, + "heading": 3.3145820545267926, + "angularVelocity": 0.9670614236859987, + "velocityX": 2.820341331458405, + "velocityY": 0.14628108630743103, + "timestamp": 1.5874242211165284 }, { "x": 5.914944171905518, "y": 1.618774652481079, - "heading": 3.3659829767052933, - "angularVelocity": 1.2439961796017462, - "velocityX": 3.57235485685901, - "velocityY": 0.42143731939508383, - "timestamp": 1.2715885198507333 - }, - { - "x": 6.035588806340424, - "y": 1.6394541292062057, - "heading": 3.4083265776392007, - "angularVelocity": 1.241563923199597, - "velocityX": 3.537441840994668, - "velocityY": 0.6063464534496739, - "timestamp": 1.3056935708615462 - }, - { - "x": 6.1549110861034935, - "y": 1.666413596824975, - "heading": 3.4505355738749044, - "angularVelocity": 1.2376171559550397, - "velocityX": 3.498668854805046, - "velocityY": 0.790483134308215, - "timestamp": 1.3397986218723592 - }, - { - "x": 6.272763015314017, - "y": 1.6996199600678876, - "heading": 3.4925517835068707, - "angularVelocity": 1.2319644271649108, - "velocityX": 3.4555564562316077, - "velocityY": 0.9736494231421837, - "timestamp": 1.3739036728831722 - }, - { - "x": 6.388977310142906, - "y": 1.7390313051664819, - "heading": 3.534309249026909, - "angularVelocity": 1.2243777470615422, - "velocityX": 3.4075391000600734, - "velocityY": 1.1555867512439428, - "timestamp": 1.4080087238939851 - }, - { - "x": 6.503363828841312, - "y": 1.7845940645868774, - "heading": 3.575732671697258, - "angularVelocity": 1.2145832198643007, - "velocityX": 3.3539465653383935, - "velocityY": 1.3359534165760587, - "timestamp": 1.442113774904798 - }, - { - "x": 6.615705247769987, - "y": 1.8362390822215717, - "heading": 3.616735445353753, - "angularVelocity": 1.2022492986008166, - "velocityX": 3.2939818472359588, - "velocityY": 1.5142923439205425, - "timestamp": 1.476218825915611 - }, - { - "x": 6.725751880441458, - "y": 1.8938760902116232, - "heading": 3.657217202680655, - "angularVelocity": 1.1869724902058387, - "velocityX": 3.2266960291770768, - "velocityY": 1.6899845120236898, - "timestamp": 1.510323876926424 - }, - { - "x": 6.833215615375313, - "y": 1.9573858820901124, - "heading": 3.697060805239955, - "angularVelocity": 1.1682610457514788, - "velocityX": 3.150962445409736, - "velocityY": 1.8621814070400662, - "timestamp": 1.544428927937237 - }, - { - "x": 6.937763164011495, - "y": 2.0266091584313166, - "heading": 3.7361287911659096, - "angularVelocity": 1.1455190585572865, - "velocityX": 3.065456451099711, - "velocityY": 2.029707456507175, - "timestamp": 1.57853397894805 - }, - { - "x": 7.039009309504076, - "y": 2.1013306580386533, - "heading": 3.7742595314428558, - "angularVelocity": 1.1180379195110097, - "velocityX": 2.9686554481469685, - "velocityY": 2.1909217958256537, - "timestamp": 1.6126390299588629 - }, - { - "x": 7.136511888628047, - "y": 2.1812569307410885, - "heading": 3.811263920998153, - "angularVelocity": 1.085011998473928, - "velocityX": 2.8588897020871724, - "velocityY": 2.343531832780279, - "timestamp": 1.6467440809696758 - }, - { - "x": 7.22977216790877, - "y": 2.265986470559125, - "heading": 3.846924654529132, - "angularVelocity": 1.0456144317061005, - "velocityX": 2.734500507011559, - "velocityY": 2.484369244636938, - "timestamp": 1.6808491319804888 - }, - { - "x": 7.318247196703315, - "y": 2.3549731397061673, - "heading": 3.881002263830399, - "angularVelocity": 0.9991953769681448, - "velocityX": 2.5941913638098484, - "velocityY": 2.609193257586063, - "timestamp": 1.7149541829913018 - }, - { - "x": 7.401383330480766, - "y": 2.4474898853243734, - "heading": 3.9132542500781606, - "angularVelocity": 0.9456659729826076, - "velocityX": 2.4376487151739696, - "velocityY": 2.712699230060463, - "timestamp": 1.7490592340021147 - }, - { - "x": 7.478677656627286, - "y": 2.5426104064994783, - "heading": 3.9434712501143188, - "angularVelocity": 0.8859977962377913, - "velocityX": 2.2663600802712174, - "velocityY": 2.7890449759171334, - "timestamp": 1.7831642850129277 - }, - { - "x": 7.54975931056459, - "y": 2.639234736979551, - "heading": 3.97151996138921, - "angularVelocity": 0.8224210327672106, - "velocityX": 2.0841972620057856, - "velocityY": 2.833138424259732, - "timestamp": 1.8172693360237406 - }, - { - "x": 7.614458496352838, - "y": 2.736173038995203, - "heading": 3.997364932300229, - "angularVelocity": 0.7578047868283583, - "velocityX": 1.8970558281157706, - "velocityY": 2.842344437043021, - "timestamp": 1.8513743870345536 - }, - { - "x": 7.672823839971332, - "y": 2.832264123512942, - "heading": 4.021053133675318, - "angularVelocity": 0.6945657805226282, - "velocityX": 1.7113401648333206, - "velocityY": 2.817503028723613, - "timestamp": 1.8854794380453666 - }, - { - "x": 7.725079842066262, - "y": 2.9264763498774746, - "heading": 4.0426799683616945, - "angularVelocity": 0.6341240973226909, - "velocityX": 1.5322071231725694, - "velocityY": 2.7624127093275055, - "timestamp": 1.9195844890561795 - }, - { - "x": 7.7715553968836195, - "y": 3.0179557069730056, - "heading": 4.062360688792578, - "angularVelocity": 0.5770617503150199, - "velocityX": 1.3627176456244698, - "velocityY": 2.682281784786863, - "timestamp": 1.9536895400669925 - }, - { - "x": 7.812619256840835, - "y": 3.106025341157235, - "heading": 4.080213037477331, - "angularVelocity": 0.5234517514456478, - "velocityX": 1.204040420411492, - "velocityY": 2.582304719506425, - "timestamp": 1.9877945910778054 - }, - { - "x": 7.84863769574921, - "y": 3.190159811701933, - "heading": 4.096348157574101, - "angularVelocity": 0.47310060001536125, - "velocityX": 1.0561027719019285, - "velocityY": 2.4669211172862338, - "timestamp": 2.0218996420886186 - }, - { - "x": 7.879952597637028, - "y": 3.2699532530767157, - "heading": 4.110866673835784, - "angularVelocity": 0.425699884075218, - "velocityX": 0.918189563120411, - "velocityY": 2.3396370628351777, - "timestamp": 2.056004693099432 - }, - { - "x": 7.906872911068676, - "y": 3.3450907499043514, - "heading": 4.123857749237068, - "angularVelocity": 0.3809135308774642, - "velocityX": 0.78933508772977, - "velocityY": 2.203119321059301, - "timestamp": 2.090109744110245 - }, - { - "x": 7.92967335872801, - "y": 3.415325596446574, - "heading": 4.135399630317554, - "angularVelocity": 0.3384214577725463, - "velocityX": 0.6685358028670148, - "velocityY": 2.059367878381269, - "timestamp": 2.124214795121058 - }, - { - "x": 7.9485965380562735, - "y": 3.4804621930055037, - "heading": 4.14556079129848, - "angularVelocity": 0.2979371289520607, - "velocityX": 0.5548497588308511, - "velocityY": 1.9098812237014051, - "timestamp": 2.1583198461318713 - }, - { - "x": 7.963856309062033, - "y": 3.540343468154577, - "heading": 4.154401215837848, - "angularVelocity": 0.25921159116767506, - "velocityX": 0.44743434047118863, - "velocityY": 1.755789051014386, - "timestamp": 2.1924248971426845 - }, - { - "x": 7.975641432659769, - "y": 3.5948416835203623, - "heading": 4.161973609771009, - "angularVelocity": 0.22203145014385386, - "velocityX": 0.3455536129824143, - "velocityY": 1.5979514397591115, - "timestamp": 2.2265299481534977 - }, - { - "x": 7.984118998461396, - "y": 3.643851691478983, - "heading": 4.168324469700783, - "angularVelocity": 0.1862146439177472, - "velocityX": 0.24857214841693745, - "velocityY": 1.4370307771444562, - "timestamp": 2.260634999164311 - }, - { - "x": 7.989437470121537, - "y": 3.6872859533917026, - "heading": 4.17349499336682, - "angularVelocity": 0.15160580362119816, - "velocityX": 0.1559438119138029, - "velocityY": 1.2735433792181823, - "timestamp": 2.294740050175124 - }, - { - "x": 7.991729312970037, - "y": 3.725070821508804, - "heading": 4.177521842923806, - "angularVelocity": 0.11807194059638135, - "velocityX": 0.06719951387181163, - "velocityY": 1.1078965430992342, - "timestamp": 2.3288451011859372 - }, - { - "x": 7.99111322809602, - "y": 3.7571437330128914, - "heading": 4.180437780593536, - "angularVelocity": 0.08549870424783614, - "velocityX": -0.018064329351725014, - "velocityY": 0.9404152919729587, - "timestamp": 2.3629501521967504 - }, - { - "x": 7.987696038925939, - "y": 3.7834510681367823, - "heading": 4.182272197135822, - "angularVelocity": 0.05378723936533091, - "velocityX": -0.10019598472373147, - "velocityY": 0.7713618465356136, - "timestamp": 2.3970552032075636 - }, - { - "x": 7.981574280773792, - "y": 3.8039464966481624, - "heading": 4.183051551698239, - "angularVelocity": 0.022851587648130094, - "velocityX": -0.17949711173882896, - "velocityY": 0.6009499444783675, - "timestamp": 2.431160254218377 + "heading": 3.3640528155632063, + "angularVelocity": 0.9660893236529856, + "velocityX": 2.7926313986126945, + "velocityY": 0.31352485714275447, + "timestamp": 1.6386314540557712 + }, + { + "x": 6.020777944796609, + "y": 1.6355085584506643, + "heading": 3.400904280098954, + "angularVelocity": 0.9643675166097004, + "velocityX": 2.769568428885968, + "velocityY": 0.43791028515067126, + "timestamp": 1.6768445459538697 + }, + { + "x": 6.125639580084532, + "y": 1.656977833256518, + "heading": 3.4376552290207467, + "angularVelocity": 0.9617371193044324, + "velocityX": 2.7441285192926665, + "velocityY": 0.5618303502659502, + "timestamp": 1.7150576378519682 + }, + { + "x": 6.229428776215976, + "y": 1.6831607086195022, + "heading": 3.474267250275643, + "angularVelocity": 0.9581015153792859, + "velocityX": 2.716063814156021, + "velocityY": 0.6851807603740969, + "timestamp": 1.7532707297500667 + }, + { + "x": 6.3320343621232995, + "y": 1.714030406969641, + "heading": 3.5106976603723656, + "angularVelocity": 0.9533489253858498, + "velocityX": 2.685089868700948, + "velocityY": 0.8078304271336628, + "timestamp": 1.7914838216481652 + }, + { + "x": 6.433332658705491, + "y": 1.749553806050537, + "heading": 3.546898805378257, + "angularVelocity": 0.9473492776357301, + "velocityX": 2.6508793596791667, + "velocityY": 0.9296133161803473, + "timestamp": 1.8296969135462637 + }, + { + "x": 6.53318556675295, + "y": 1.789689683941768, + "heading": 3.58281721914692, + "angularVelocity": 0.9399504720645423, + "velocityX": 2.6130549266658, + "velocityY": 1.0503174670675757, + "timestamp": 1.8679100054443623 + }, + { + "x": 6.631438355395581, + "y": 1.8343863962295928, + "heading": 3.6183926153660977, + "angularVelocity": 0.9309740314666345, + "velocityX": 2.5711813350418873, + "velocityY": 1.1696701331317512, + "timestamp": 1.9061230973424608 + }, + { + "x": 6.727917146196004, + "y": 1.8835787832994704, + "heading": 3.653556695194787, + "angularVelocity": 0.9202102756421789, + "velocityX": 2.5247575113183647, + "velocityY": 1.2873176345179635, + "timestamp": 1.9443361892405593 + }, + { + "x": 6.8224261353049895, + "y": 1.9371840367497888, + "heading": 3.6882317692807933, + "angularVelocity": 0.9074134639110804, + "velocityX": 2.473209688475594, + "velocityY": 1.4027981193792345, + "timestamp": 1.9825492811386578 + }, + { + "x": 6.914744691265183, + "y": 1.9950961730612478, + "heading": 3.722329234213893, + "angularVelocity": 0.8922979858323411, + "velocityX": 2.415888151798233, + "velocityY": 1.5155051170915799, + "timestamp": 2.020762373036756 + }, + { + "x": 7.0046246440390405, + "y": 2.0571786867448134, + "heading": 3.7557480315965552, + "angularVelocity": 0.8745379063222446, + "velocityX": 2.3520722430296175, + "velocityY": 1.6246398969525655, + "timestamp": 2.0589754649348544 + }, + { + "x": 7.091788391438202, + "y": 2.123254932680484, + "heading": 3.788373390594432, + "angularVelocity": 0.8537743840482023, + "velocityX": 2.280991750984126, + "velocityY": 1.7291520432807275, + "timestamp": 2.0971885568329527 + }, + { + "x": 7.175928944342895, + "y": 2.1930959306221323, + "heading": 3.8200764634573674, + "angularVelocity": 0.8296390396117933, + "velocityX": 2.2018776478246815, + "velocityY": 1.8276719959717111, + "timestamp": 2.135401648731051 + }, + { + "x": 7.256713710898279, + "y": 2.266405811115142, + "heading": 3.8507159408143004, + "angularVelocity": 0.8018057643343343, + "velocityX": 2.114059934506467, + "velocityY": 1.91844932853124, + "timestamp": 2.1736147406291493 + }, + { + "x": 7.3337944835848266, + "y": 2.3428063524565834, + "heading": 3.8801432687002584, + "angularVelocity": 0.7700849741348019, + "velocityX": 2.0171299640472826, + "velocityY": 1.9993289615291048, + "timestamp": 2.2118278325272476 + }, + { + "x": 7.406826105349172, + "y": 2.4218242186313876, + "heading": 3.908213144199668, + "angularVelocity": 0.7345617458608831, + "velocityX": 1.911167564223696, + "velocityY": 2.0678218445531384, + "timestamp": 2.250040924425346 + }, + { + "x": 7.475494494135224, + "y": 2.502887103811811, + "heading": 3.934799367276667, + "angularVelocity": 0.6957359835706366, + "velocityX": 1.7969859379389637, + "velocityY": 2.1213380324364, + "timestamp": 2.288254016323444 + }, + { + "x": 7.5395502270032555, + "y": 2.5853359669923646, + "heading": 3.9598120699093338, + "angularVelocity": 0.6545584612563531, + "velocityX": 1.6762771523133229, + "velocityY": 2.157607748685101, + "timestamp": 2.3264671082215425 + }, + { + "x": 7.598838235415281, + "y": 2.6684568263195323, + "heading": 3.9832084112667783, + "angularVelocity": 0.6122598354468323, + "velocityX": 1.5515103716319527, + "velocityY": 2.175193243949577, + "timestamp": 2.3646802001196408 + }, + { + "x": 7.653312233435752, + "y": 2.7515267667167436, + "heading": 4.0049909639065655, + "angularVelocity": 0.5700285310038007, + "velocityX": 1.4255323323675468, + "velocityY": 2.173860744342043, + "timestamp": 2.402893292017739 + }, + { + "x": 7.7030282649576645, + "y": 2.8338606563176305, + "heading": 4.025196298380201, + "angularVelocity": 0.5287542428525911, + "velocityX": 1.3010209080827217, + "velocityY": 2.154599000270482, + "timestamp": 2.4411063839158373 + }, + { + "x": 7.748121808317172, + "y": 2.9148450729972097, + "heading": 4.043881316781892, + "angularVelocity": 0.4889690279843902, + "velocityX": 1.1800548220425873, + "velocityY": 2.119284586956156, + "timestamp": 2.4793194758139356 + }, + { + "x": 7.788778861758571, + "y": 2.9939539404158495, + "heading": 4.061112406566655, + "angularVelocity": 0.45092110920288114, + "velocityX": 1.0639561318361235, + "velocityY": 2.0702032599088445, + "timestamp": 2.517532567712034 + }, + { + "x": 7.825210007677057, + "y": 3.0707487810478886, + "heading": 4.076958314450325, + "angularVelocity": 0.41467222610319826, + "velocityX": 0.9533681811363417, + "velocityY": 2.0096473961548327, + "timestamp": 2.5557456596101322 + }, + { + "x": 7.857631499196349, + "y": 3.144869951622929, + "heading": 4.091485913306106, + "angularVelocity": 0.3801733420190485, + "velocityX": 0.8484393674751142, + "velocityY": 1.939680012617054, + "timestamp": 2.5939587515082305 + }, + { + "x": 7.886253437175175, + "y": 3.2160244294016245, + "heading": 4.104757938931661, + "angularVelocity": 0.34731619364762556, + "velocityX": 0.7490086919726913, + "velocityY": 1.8620445047587648, + "timestamp": 2.632171843406329 + }, + { + "x": 7.911273388621043, + "y": 3.283973525115277, + "heading": 4.116831998207854, + "angularVelocity": 0.31596656215076, + "velocityX": 0.654748155752185, + "velocityY": 1.7781627274456175, + "timestamp": 2.670384935304427 + }, + { + "x": 7.932873600557423, + "y": 3.3485220534891567, + "heading": 4.1277603447712625, + "angularVelocity": 0.2859843582547855, + "velocityX": 0.5652568495106397, + "velocityY": 1.689173138515176, + "timestamp": 2.7085980272025254 + }, + { + "x": 7.951220358752493, + "y": 3.409509396144286, + "heading": 4.137590076238168, + "angularVelocity": 0.25723465384895294, + "velocityX": 0.48011708249084256, + "velocityY": 1.5959803205080123, + "timestamp": 2.7468111191006237 + }, + { + "x": 7.966464515315054, + "y": 3.4668023733883073, + "heading": 4.146363533085604, + "angularVelocity": 0.2295929591573598, + "velocityX": 0.39892497061509824, + "velocityY": 1.4993023175617965, + "timestamp": 2.785024210998722 + }, + { + "x": 7.978742584510864, + "y": 3.520289653410511, + "heading": 4.154118770391739, + "angularVelocity": 0.20294712939783252, + "velocityX": 0.3213053062691505, + "velocityY": 1.3997108678051104, + "timestamp": 2.8232373028968203 + }, + { + "x": 7.988178059570606, + "y": 3.569877396667095, + "heading": 4.160890032982404, + "angularVelocity": 0.17719745391765573, + "velocityX": 0.24691734144159244, + "velocityY": 1.2976637271021656, + "timestamp": 2.8614503947949186 + }, + { + "x": 7.994882760848184, + "y": 3.615485864920885, + "heading": 4.1667082001323665, + "angularVelocity": 0.15225585947028406, + "velocityX": 0.17545560813183597, + "velocityY": 1.1935299131358537, + "timestamp": 2.899663486693017 + }, + { + "x": 7.998958118835325, + "y": 3.657046773518291, + "heading": 4.171601185974506, + "angularVelocity": 0.12804475113364422, + "velocityX": 0.10664821360198111, + "velocityY": 1.0876091552139988, + "timestamp": 2.937876578591115 + }, + { + "x": 8.00049634854855, + "y": 3.6945012134134734, + "heading": 4.175594292348644, + "angularVelocity": 0.10449576770146222, + "velocityX": 0.040253997696058225, + "velocityY": 0.9801468040079241, + "timestamp": 2.9760896704892135 + }, + { + "x": 7.999581500886131, + "y": 3.727798009941937, + "heading": 4.178710516017615, + "angularVelocity": 0.08154858751763462, + "velocityX": -0.023940686737896708, + "velocityY": 0.8713452608664894, + "timestamp": 3.0143027623873118 + }, + { + "x": 7.99629039177413, + "y": 3.7568924174172387, + "heading": 4.180970814432266, + "angularVelocity": 0.05914984374145868, + "velocityX": -0.08612517199022549, + "velocityY": 0.7613727659851889, + "timestamp": 3.05251585428541 + }, + { + "x": 7.990693417298575, + "y": 3.7817450732193243, + "heading": 4.182394334940983, + "angularVelocity": 0.037252167726010275, + "velocityX": -0.14646745912318257, + "velocityY": 0.6503701890535178, + "timestamp": 3.0907289461835084 + }, + { + "x": 7.982855266066816, + "y": 3.802321153601619, + "heading": 4.182998612290459, + "angularVelocity": 0.015813359230053194, + "velocityX": -0.2051169073850163, + "velocityY": 0.5384563080413376, + "timestamp": 3.1289420380816066 }, { "x": 7.972835540771484, "y": 3.818589687347412, "heading": 4.182799738871681, - "angularVelocity": -0.007383446706423955, - "velocityX": -0.25623008156584126, - "velocityY": 0.4293554844590835, - "timestamp": 2.46526530522919 - }, - { - "x": 7.9637186612393265, - "y": 3.828871449615871, - "heading": 4.1820183188243725, - "angularVelocity": -0.03309906574350809, - "velocityX": -0.38616899585548714, - "velocityY": 0.4355106148798181, - "timestamp": 2.4888738280003215 - }, - { - "x": 7.951533900299869, - "y": 3.8392929926799955, - "heading": 4.180626994046899, - "angularVelocity": -0.05893315693492721, - "velocityX": -0.5161170420351017, - "velocityY": 0.44143139175423374, - "timestamp": 2.512482350771453 - }, - { - "x": 7.936281037210036, - "y": 3.8498483897527986, - "heading": 4.178622883313085, - "angularVelocity": -0.08488928990783955, - "velocityX": -0.6460744383584005, - "velocityY": 0.44710112424782095, - "timestamp": 2.5360908735425847 - }, - { - "x": 7.917959846822961, - "y": 3.8605312762810953, - "heading": 4.176003005913559, - "angularVelocity": -0.11097167853000488, - "velocityX": -0.776041371359331, - "velocityY": 0.45250126964154036, - "timestamp": 2.5596993963137162 - }, - { - "x": 7.896570100655752, - "y": 3.8713347995291443, - "heading": 4.172764264259679, - "angularVelocity": -0.1371852735250776, - "velocityX": -0.9060179823436121, - "velocityY": 0.4576111497012357, - "timestamp": 2.583307919084848 - }, - { - "x": 7.872111568382392, - "y": 3.8822515601370835, - "heading": 4.168903423841314, - "angularVelocity": -0.16353587455650437, - "velocityX": -1.0360043493810085, - "velocityY": 0.46240761075027864, - "timestamp": 2.6069164418559794 - }, - { - "x": 7.844584019895448, - "y": 3.8932735439961332, - "heading": 4.164417089967741, - "angularVelocity": -0.19003026648746557, - "velocityX": -1.1660004632143819, - "velocityY": 0.46686461350834163, - "timestamp": 2.630524964627111 - }, - { - "x": 7.813987228132184, - "y": 3.904392042354374, - "heading": 4.1593016805781176, - "angularVelocity": -0.21667638586345156, - "velocityX": -1.2960061948765607, - "velocityY": 0.47095273457066494, - "timestamp": 2.6541334873982425 - }, - { - "x": 7.780320972934565, - "y": 3.9155975575050164, - "heading": 4.153553394222869, - "angularVelocity": -0.2434835254613041, - "velocityX": -1.426021251900615, - "velocityY": 0.4746385557144377, - "timestamp": 2.677742010169374 - }, - { - "x": 7.7435850463173015, - "y": 3.926879690662087, - "heading": 4.147168172074516, - "angularVelocity": -0.27046258718739974, - "velocityX": -1.5560451186798385, - "velocityY": 0.4778839094018357, - "timestamp": 2.7013505329405056 - }, - { - "x": 7.703779259669669, - "y": 3.9382270076248616, - "heading": 4.140141652504649, - "angularVelocity": -0.29762639695773513, - "velocityX": -1.6860769745537036, - "velocityY": 0.48064493796511365, - "timestamp": 2.724959055711637 - }, - { - "x": 7.660903453639524, - "y": 3.949626876465817, - "heading": 4.1324691163318406, - "angularVelocity": -0.3249900998545743, - "velocityX": -1.8161155801997555, - "velocityY": 0.482870908589551, - "timestamp": 2.748567578482769 - }, - { - "x": 7.614957511778938, - "y": 3.961065269589929, - "heading": 4.124145420258021, - "angularVelocity": -0.35257166043431315, - "velocityX": -1.9461591182979985, - "velocityY": 0.48450270417155444, - "timestamp": 2.7721761012539003 - }, - { - "x": 7.565941379533382, - "y": 3.972526519867812, - "heading": 4.115164915200959, - "angularVelocity": -0.380392502492515, - "velocityX": -2.0762049671945992, - "velocityY": 0.4854708779958824, - "timestamp": 2.795784624025032 - }, - { - "x": 7.513855090932225, - "y": 3.9839930167730904, - "heading": 4.105521345095972, - "angularVelocity": -0.4084783363395984, - "velocityX": -2.2062493746896052, - "velocityY": 0.4856931124593558, - "timestamp": 2.8193931467961635 - }, - { - "x": 7.458698806563996, - "y": 3.995444822975592, - "heading": 4.095207720123672, - "angularVelocity": -0.43686024205255225, - "velocityX": -2.336286980042793, - "velocityY": 0.4850708497738249, - "timestamp": 2.843001669567295 - }, - { - "x": 7.400472868401379, - "y": 4.0068591837195235, - "heading": 4.084216155973937, - "angularVelocity": -0.46557610809832467, - "velocityX": -2.466310100257985, - "velocityY": 0.4834847505957555, - "timestamp": 2.8666101923384266 - }, - { - "x": 7.339177880333258, - "y": 4.018209888996166, - "heading": 4.072537667277958, - "angularVelocity": -0.4946725726634777, - "velocityX": -2.5963076411995325, - "velocityY": 0.4807884587562188, - "timestamp": 2.890218715109558 - }, - { - "x": 7.27481482889874, - "y": 4.029466429354311, - "heading": 4.06016189806287, - "angularVelocity": -0.524207691224974, - "velocityX": -2.7262633947272543, - "velocityY": 0.4767998602565998, - "timestamp": 2.9138272378806898 - }, - { - "x": 7.207385268714358, - "y": 4.040592855511578, - "heading": 4.047076763864054, - "angularVelocity": -0.5542546785187346, - "velocityX": -2.8561532984533065, - "velocityY": 0.4712885369884458, - "timestamp": 2.9374357606518213 - }, - { - "x": 7.136891615524657, - "y": 4.051546201216433, - "heading": 4.033267966939994, - "angularVelocity": -0.584907283608017, - "velocityX": -2.9859408770760103, - "velocityY": 0.46395726708693935, - "timestamp": 2.961044283422953 - }, - { - "x": 7.063337625419452, - "y": 4.062274241890114, - "heading": 4.018718324124552, - "angularVelocity": -0.6162877261102292, - "velocityX": -3.115569356806623, - "velocityY": 0.4544138901737024, - "timestamp": 2.9846528061940845 - }, - { - "x": 6.986729211328242, - "y": 4.0727122063788395, - "heading": 4.003406808949002, - "angularVelocity": -0.6485587990398427, - "velocityX": -3.24494737912542, - "velocityY": 0.4421269636355666, - "timestamp": 3.008261328965216 - }, - { - "x": 6.907075905402423, - "y": 4.0827777690377465, - "heading": 3.9873071408156635, - "angularVelocity": -0.681943054608452, - "velocityX": -3.3739216425358753, - "velocityY": 0.42635292163306987, - "timestamp": 3.0318698517363476 - }, - { - "x": 6.824393644375493, - "y": 4.092363079240797, - "heading": 3.970385621156536, - "angularVelocity": -0.7167547001212231, - "velocityX": -3.502220864408744, - "velocityY": 0.4060105876158922, - "timestamp": 3.055478374507479 - }, - { - "x": 6.738710497953685, - "y": 4.1013214071032555, - "heading": 3.95259764005598, - "angularVelocity": -0.7534559139086403, - "velocityX": -3.629331121326169, - "velocityY": 0.37945313009599524, - "timestamp": 3.0790868972786107 - }, - { - "x": 6.650079643932432, - "y": 4.109443461148631, - "heading": 3.9338816488629216, - "angularVelocity": -0.7927641798894928, - "velocityX": -3.754188895276186, - "velocityY": 0.3440305911605684, - "timestamp": 3.1026954200497423 - }, - { - "x": 6.5586124916873185, - "y": 4.116413273413615, - "heading": 3.9141479140434288, - "angularVelocity": -0.8358733416231714, - "velocityX": -3.8743276371765454, - "velocityY": 0.2952244124951097, - "timestamp": 3.126303942820874 - }, - { - "x": 6.46457504667221, - "y": 4.121728253195517, - "heading": 3.8932578414178582, - "angularVelocity": -0.8848530180429063, - "velocityX": -3.983199030568015, - "velocityY": 0.22512970563301316, - "timestamp": 3.1499124655920054 - }, - { - "x": 6.368678589791372, - "y": 4.124624521627842, - "heading": 3.8710237627532775, - "angularVelocity": -0.9417818675113662, - "velocityX": -4.061942282898786, - "velocityY": 0.12267893507825635, - "timestamp": 3.173520988363137 - }, - { - "x": 6.272525829089795, - "y": 4.124480807277699, - "heading": 3.8473779385258497, - "angularVelocity": -1.0015799995898869, - "velocityX": -4.0727986936627145, - "velocityY": -0.0060873927411320885, - "timestamp": 3.1971295111342686 - }, - { - "x": 6.17777722513879, - "y": 4.121614708086708, - "heading": 3.8226769599510275, - "angularVelocity": -1.0462737891006977, - "velocityX": -4.013322005342572, - "velocityY": -0.12140103888649843, - "timestamp": 3.2207380339054 + "angularVelocity": -0.005204326813122979, + "velocityX": -0.2622066102908217, + "velocityY": 0.4257319399638149, + "timestamp": 3.167155129979705 + }, + { + "x": 7.963451202002662, + "y": 3.8299573925524886, + "heading": 4.182187256834467, + "angularVelocity": -0.022887016371921386, + "velocityX": -0.35067071684037177, + "velocityY": 0.42478446604441783, + "timestamp": 3.1939162432354022 + }, + { + "x": 7.951699535558351, + "y": 3.8412962048515644, + "heading": 4.181099599512945, + "angularVelocity": -0.04064320161608694, + "velocityX": -0.439132196483299, + "velocityY": 0.42370480595245197, + "timestamp": 3.2206773564910995 + }, + { + "x": 7.937580621360099, + "y": 3.852602364647738, + "heading": 4.179534751300954, + "angularVelocity": -0.05847470533229181, + "velocityX": -0.5275906896454091, + "velocityY": 0.42248465854697903, + "timestamp": 3.247438469746797 + }, + { + "x": 7.921094550503366, + "y": 3.863871868563307, + "heading": 4.177490639391159, + "angularVelocity": -0.0763836649942111, + "velocityX": -0.6160457787840902, + "velocityY": 0.42111491431217335, + "timestamp": 3.274199583002494 + }, + { + "x": 7.902241427098489, + "y": 3.8751004449108475, + "heading": 4.174965124271339, + "angularVelocity": -0.09437257320683892, + "velocityX": -0.704496977563563, + "velocityY": 0.4195855471426245, + "timestamp": 3.3009606962581914 + }, + { + "x": 7.88102137046632, + "y": 3.886283525768321, + "heading": 4.171955988942259, + "angularVelocity": -0.11244432547808522, + "velocityX": -0.792943717602994, + "velocityY": 0.4178854874467351, + "timestamp": 3.3277218095138887 + }, + { + "x": 7.85743451777067, + "y": 3.897416215051291, + "heading": 4.168460926619584, + "angularVelocity": -0.13060227686648773, + "velocityX": -0.8813853321528802, + "velocityY": 0.41600247256526673, + "timestamp": 3.354482922769586 + }, + { + "x": 7.8314810271924085, + "y": 3.9084932518402047, + "heading": 4.164477526630598, + "angularVelocity": -0.14885030943689379, + "velocityX": -0.9698210358545546, + "velocityY": 0.41392286946641677, + "timestamp": 3.3812440360252833 + }, + { + "x": 7.803161081780004, + "y": 3.9195089680498767, + "heading": 4.1600032581515265, + "angularVelocity": -0.16719291295249908, + "velocityX": -1.05824989946468, + "velocityY": 0.4116314633258134, + "timestamp": 3.4080051492809806 + }, + { + "x": 7.772474894151133, + "y": 3.930457239309372, + "heading": 4.155035451348857, + "angularVelocity": -0.1856352818809576, + "velocityX": -1.1466708180511556, + "velocityY": 0.4091112038160546, + "timestamp": 3.434766262536678 + }, + { + "x": 7.739422712274089, + "y": 3.9413314276382687, + "heading": 4.149571275382789, + "angularVelocity": -0.2041834326494015, + "velocityX": -1.2350824706446473, + "velocityY": 0.4063428985555967, + "timestamp": 3.4615273757923752 + }, + { + "x": 7.704004826631203, + "y": 3.9521243141373215, + "heading": 4.143607712595044, + "angularVelocity": -0.2228443462260134, + "velocityX": -1.3234832685947802, + "velocityY": 0.40330483997174355, + "timestamp": 3.4882884890480725 + }, + { + "x": 7.666221579168315, + "y": 3.962828019427522, + "heading": 4.137141528026157, + "angularVelocity": -0.241626142645967, + "velocityX": -1.4118712888314486, + "velocityY": 0.3999723474851382, + "timestamp": 3.51504960230377 + }, + { + "x": 7.626073374576437, + "y": 3.9734339089269395, + "heading": 4.130169233174118, + "angularVelocity": -0.2605382961994449, + "velocityX": -1.500244186714977, + "velocityY": 0.39631720093564143, + "timestamp": 3.541810715559467 + }, + { + "x": 7.58356069465374, + "y": 3.983932479186973, + "heading": 4.122687042595275, + "angularVelocity": -0.2795919028984897, + "velocityX": -1.5885990809312174, + "velocityY": 0.3923069328140146, + "timestamp": 3.5685718288151644 + }, + { + "x": 7.538684116786936, + "y": 3.994313220324826, + "heading": 4.114690821529067, + "angularVelocity": -0.2988000158963987, + "velocityX": -1.6769323995612107, + "velocityY": 0.387903935036916, + "timestamp": 3.5953329420708617 + }, + { + "x": 7.491444338017231, + "y": 4.00456444794984, + "heading": 4.106176022154423, + "angularVelocity": -0.3181780702950364, + "velocityX": -1.7652396713969913, + "velocityY": 0.38306431900132476, + "timestamp": 3.622094055326559 + }, + { + "x": 7.4418422067924155, + "y": 4.014673095676399, + "heading": 4.097137605289561, + "angularVelocity": -0.3377444270909928, + "velocityX": -1.8535152387300855, + "velocityY": 0.3777364427994356, + "timestamp": 3.6488551685822563 + }, + { + "x": 7.389878765475513, + "y": 4.024624456021231, + "heading": 4.087569943223826, + "angularVelocity": -0.35752107822709445, + "velocityX": -1.9417518554030933, + "velocityY": 0.3718589824626068, + "timestamp": 3.6756162818379536 + }, + { + "x": 7.3355553081899885, + "y": 4.034401852682468, + "heading": 4.077466697757452, + "angularVelocity": -0.3775345730141747, + "velocityX": -2.0299401137192343, + "velocityY": 0.3653583678607193, + "timestamp": 3.702377395093651 + }, + { + "x": 7.278873460992411, + "y": 4.043986220059233, + "heading": 4.066820665162764, + "angularVelocity": -0.39781725419895203, + "velocityX": -2.1180676101175324, + "velocityY": 0.3581453164965952, + "timestamp": 3.7291385083493482 + }, + { + "x": 7.219835295323935, + "y": 4.053355555007508, + "heading": 4.055623576242335, + "angularVelocity": -0.41840893588553546, + "velocityX": -2.2061177016208897, + "velocityY": 0.35011005927721894, + "timestamp": 3.7558996216050455 + }, + { + "x": 7.158443492406841, + "y": 4.0624841888713705, + "heading": 4.043865834226526, + "angularVelocity": -0.4393592263320925, + "velocityX": -2.2940676021400144, + "velocityY": 0.3411156246243232, + "timestamp": 3.782660734860743 + }, + { + "x": 7.09470158805335, + "y": 4.071341800593327, + "heading": 4.031536164668173, + "angularVelocity": -0.46073081641055347, + "velocityX": -2.3818853776541133, + "velocityY": 0.33098816320999985, + "timestamp": 3.80942184811644 + }, + { + "x": 7.028614348964204, + "y": 4.079892046545646, + "heading": 4.018621137474081, + "angularVelocity": -0.48260425755428477, + "velocityX": -2.4695250327479035, + "velocityY": 0.31950262571743504, + "timestamp": 3.8361829613721374 + }, + { + "x": 6.960188373088244, + "y": 4.088090605115376, + "heading": 4.005104497423563, + "angularVelocity": -0.5050851181476842, + "velocityX": -2.5569181379773873, + "velocityY": 0.30636089356202295, + "timestamp": 3.8629440746278347 + }, + { + "x": 6.8894330908058015, + "y": 4.095882295321711, + "heading": 3.9909661972610597, + "angularVelocity": -0.5283150976349366, + "velocityX": -2.6439588520249506, + "velocityY": 0.2911571776512241, + "timestamp": 3.889705187883532 + }, + { + "x": 6.816362525944293, + "y": 4.103196669781287, + "heading": 3.9761809481036865, + "angularVelocity": -0.5524900633281915, + "velocityX": -2.7304755285528013, + "velocityY": 0.27332100834849943, + "timestamp": 3.9164663011392293 + }, + { + "x": 6.740998601423215, + "y": 4.109940977464476, + "heading": 3.9607159426745864, + "angularVelocity": -0.5778909599662544, + "velocityX": -2.8161729970270786, + "velocityY": 0.2520189507344823, + "timestamp": 3.9432274143949266 + }, + { + "x": 6.663377862518537, + "y": 4.115988372430229, + "heading": 3.9445270622102377, + "angularVelocity": -0.6049404712601872, + "velocityX": -2.900504854301995, + "velocityY": 0.22597695798279616, + "timestamp": 3.969988527650624 + }, + { + "x": 6.5835665711005085, + "y": 4.1211572050315874, + "heading": 3.9275520881376464, + "angularVelocity": -0.6343149446138038, + "velocityX": -2.9823606609877906, + "velocityY": 0.19314714421513643, + "timestamp": 3.9967496409063212 + }, + { + "x": 6.501698761089027, + "y": 4.125174012394954, + "heading": 3.9096978959603224, + "angularVelocity": -0.6671692618588209, + "velocityX": -3.0592079346344714, + "velocityY": 0.15009866461789562, + "timestamp": 4.023510754162018 + }, + { + "x": 6.418082461531196, + "y": 4.127617363423628, + "heading": 3.8908218948706237, + "angularVelocity": -0.7053518629566096, + "velocityX": -3.1245448856665323, + "velocityY": 0.0913022939413702, + "timestamp": 4.050271867417715 + }, + { + "x": 6.333468879031824, + "y": 4.127936187292477, + "heading": 3.8707699420597645, + "angularVelocity": -0.7492944190798996, + "velocityX": -3.161811008791136, + "velocityY": 0.011913699770386288, + "timestamp": 4.077032980673412 + }, + { + "x": 6.249185342560519, + "y": 4.125928681866208, + "heading": 3.8495306129865616, + "angularVelocity": -0.7936638834963641, + "velocityX": -3.1494779632668077, + "velocityY": -0.0750157666120823, + "timestamp": 4.103794093929109 + }, + { + "x": 6.166285601861295, + "y": 4.122007646444551, + "heading": 3.8274706354096204, + "angularVelocity": -0.8243295922020396, + "velocityX": -3.097768762724307, + "velocityY": -0.14651989191157552, + "timestamp": 4.1305552071848055 }, { "x": 6.085252285003662, "y": 4.116629123687744, - "heading": 3.7974224467067916, - "angularVelocity": -1.0697201806763073, - "velocityX": -3.9191329771917003, - "velocityY": -0.21117731284148858, - "timestamp": 3.2443465566765317 - }, - { - "x": 5.938861783887598, - "y": 4.1037244473818655, - "heading": 3.754861975503122, - "angularVelocity": -1.086887550109536, - "velocityX": -3.7384457600560106, - "velocityY": -0.3295530246351326, - "timestamp": 3.283504674919197 - }, - { - "x": 5.800760573779927, - "y": 4.092512730511137, - "heading": 3.712339212672838, - "angularVelocity": -1.0859245729523437, - "velocityX": -3.526758085050148, - "velocityY": -0.2863190922819579, - "timestamp": 3.3226627931618626 - }, - { - "x": 5.669860304643064, - "y": 4.085741390502388, - "heading": 3.6701248779070657, - "angularVelocity": -1.0780480947569435, - "velocityX": -3.342864136771513, - "velocityY": -0.17292301858807546, - "timestamp": 3.361820911404528 - }, - { - "x": 5.545377582842458, - "y": 4.084481715280869, - "heading": 3.6283363494098766, - "angularVelocity": -1.0671740720078278, - "velocityX": -3.1789760945400203, - "velocityY": -0.03216894166669459, - "timestamp": 3.4009790296471936 - }, - { - "x": 5.426822280051095, - "y": 4.089257297848366, - "heading": 3.587039929856771, - "angularVelocity": -1.054606845435952, - "velocityX": -3.0276046988945726, - "velocityY": 0.1219563855930542, - "timestamp": 3.440137147889859 - }, - { - "x": 5.3138701574626115, - "y": 4.100370049824379, - "heading": 3.5462794826588393, - "angularVelocity": -1.040919457501415, - "velocityX": -2.88451354808505, - "velocityY": 0.2837917774071924, - "timestamp": 3.4792952661325245 - }, - { - "x": 5.206293411755839, - "y": 4.118014128688355, - "heading": 3.506087166042516, - "angularVelocity": -1.0264108292244598, - "velocityX": -2.7472399220031574, - "velocityY": 0.45058546364884994, - "timestamp": 3.51845338437519 - }, - { - "x": 5.103924028303818, - "y": 4.14232411942007, - "heading": 3.4664882727991313, - "angularVelocity": -1.0112562865760766, - "velocityX": -2.6142569675496197, - "velocityY": 0.6208161122823261, - "timestamp": 3.5576115026178554 + "heading": 3.8049678199315378, + "angularVelocity": -0.8408774053258744, + "velocityX": -3.0280248838445276, + "velocityY": -0.2009827732283067, + "timestamp": 4.157316320440502 + }, + { + "x": 5.974992324878816, + "y": 4.106756362131966, + "heading": 3.772772862461783, + "angularVelocity": -0.8521811407903093, + "velocityX": -2.9185147609204627, + "velocityY": -0.2613260543442573, + "timestamp": 4.195095797043209 + }, + { + "x": 5.869427380748592, + "y": 4.097415560583956, + "heading": 3.740507406337221, + "angularVelocity": -0.854047197738348, + "velocityX": -2.7942405142443114, + "velocityY": -0.24724539321291195, + "timestamp": 4.232875273645915 + }, + { + "x": 5.768118803232247, + "y": 4.090126347890849, + "heading": 3.708345250781034, + "angularVelocity": -0.8513128938870157, + "velocityX": -2.681577052581149, + "velocityY": -0.19294107141179928, + "timestamp": 4.270654750248621 + }, + { + "x": 5.67065088965741, + "y": 4.085589027886395, + "heading": 3.676369898875793, + "angularVelocity": -0.8463683137143149, + "velocityX": -2.5799169903761094, + "velocityY": -0.12010012875955235, + "timestamp": 4.308434226851327 + }, + { + "x": 5.576731872491881, + "y": 4.084170563244895, + "heading": 3.644629809831453, + "angularVelocity": -0.8401410474296196, + "velocityX": -2.4859798390855907, + "velocityY": -0.037545905053554304, + "timestamp": 4.346213703454033 + }, + { + "x": 5.486157189161119, + "y": 4.086089175594324, + "heading": 3.6131569865293773, + "angularVelocity": -0.8330666841430566, + "velocityX": -2.397457335983126, + "velocityY": 0.05078451376130899, + "timestamp": 4.3839931800567395 + }, + { + "x": 5.398778197481823, + "y": 4.091487332597936, + "heading": 3.5819745162590415, + "angularVelocity": -0.8253812142040706, + "velocityX": -2.3128693019806765, + "velocityY": 0.14288596584815674, + "timestamp": 4.421772656659446 + }, + { + "x": 5.3144828836101885, + "y": 4.100464572741929, + "heading": 3.5511001516547482, + "angularVelocity": -0.8172258427233542, + "velocityX": -2.2312462069841628, + "velocityY": 0.2376221417358252, + "timestamp": 4.459552133262152 + }, + { + "x": 5.2331841516142665, + "y": 4.1130940414694965, + "heading": 3.52054821009081, + "angularVelocity": -0.8086914989645554, + "velocityX": -2.1519284888689807, + "velocityY": 0.3342944334666334, + "timestamp": 4.497331609864858 + }, + { + "x": 5.154812493825414, + "y": 4.129431607749487, + "heading": 3.4903306661884095, + "angularVelocity": -0.7998401941925376, + "velocityX": -2.0744505968947196, + "velocityY": 0.4324455431660657, + "timestamp": 4.535111086467564 + }, + { + "x": 5.079311226778378, + "y": 4.149521261213231, + "heading": 3.4604578201556584, + "angularVelocity": -0.7907162491131828, + "velocityX": -1.9984730821185472, + "velocityY": 0.531761031922558, + "timestamp": 4.5728905630702705 }, { "x": 5.006633281707764, "y": 4.173398494720459, - "heading": 3.427503698824361, - "angularVelocity": -0.9955681152291422, - "velocityX": -2.4845613365060037, - "velocityY": 0.7935615063987016, - "timestamp": 3.596769620860521 - }, - { - "x": 4.937656823275381, - "y": 4.200004533523932, - "heading": 3.3991245021119765, - "angularVelocity": -0.9837042847573768, - "velocityX": -2.390921716177865, - "velocityY": 0.9222415502684376, - "timestamp": 3.625618937827138 - }, - { - "x": 4.871513231042132, - "y": 4.230223128841872, - "heading": 3.371147875870923, - "angularVelocity": -0.9697500385685549, - "velocityX": -2.2927264555270552, - "velocityY": 1.0474631116189388, - "timestamp": 3.654468254793755 - }, - { - "x": 4.808351922297538, - "y": 4.263931274273916, - "heading": 3.3436428942859213, - "angularVelocity": -0.9534014831903603, - "velocityX": -2.1893519634340524, - "velocityY": 1.1684209186322614, - "timestamp": 3.683317571760372 - }, - { - "x": 4.748342933359481, - "y": 4.300975202346389, - "heading": 3.3166887915596823, - "angularVelocity": -0.9343064432835324, - "velocityX": -2.0800835252875274, - "velocityY": 1.2840487043535722, - "timestamp": 3.712166888726989 - }, - { - "x": 4.691679256160981, - "y": 4.341159950611299, - "heading": 3.2903763909228227, - "angularVelocity": -0.9120632099299534, - "velocityX": -1.9641254336825034, - "velocityY": 1.392918532920877, - "timestamp": 3.7410162056936063 - }, - { - "x": 4.638577930821313, - "y": 4.384234979098084, - "heading": 3.2648093675405647, - "angularVelocity": -0.8862262982462743, - "velocityX": -1.8406441095681965, - "velocityY": 1.4931039281322762, - "timestamp": 3.7698655226602233 - }, - { - "x": 4.589277916564578, - "y": 4.4298748189343184, - "heading": 3.24010500110691, - "angularVelocity": -0.8563241362782199, - "velocityX": -1.7088797739572847, - "velocityY": 1.5820076395236735, - "timestamp": 3.7987148396268404 - }, - { - "x": 4.5440310309587515, - "y": 4.477654622101576, - "heading": 3.2163939367958534, - "angularVelocity": -0.8218934381875912, - "velocityX": -1.5683867198029067, - "velocityY": 1.6561849011036218, - "timestamp": 3.8275641565934575 - }, - { - "x": 4.503080075782216, - "y": 4.527023624920059, - "heading": 3.193818301564307, - "angularVelocity": -0.782536212474967, - "velocityX": -1.4194774602089775, - "velocityY": 1.711271115208911, - "timestamp": 3.8564134735600746 - }, - { - "x": 4.46661789297568, - "y": 4.57728677898734, - "heading": 3.1725267154544348, - "angularVelocity": -0.7380273901981841, - "velocityX": -1.2638837463198034, - "velocityY": 1.7422649598757816, - "timestamp": 3.8852627905266917 - }, - { - "x": 4.434728523792188, - "y": 4.627614799328075, - "heading": 3.1526626177771173, - "angularVelocity": -0.6885465503499899, - "velocityX": -1.1053769217618672, - "velocityY": 1.7445134108016194, - "timestamp": 3.9141121074933087 - }, - { - "x": 4.407331531292003, - "y": 4.677102971954541, - "heading": 3.1343439647930738, - "angularVelocity": -0.6349770084761907, - "velocityX": -0.9496582720446234, - "velocityY": 1.7154018822609098, - "timestamp": 3.942961424459926 - }, - { - "x": 4.38416697035973, - "y": 4.724871159718963, - "heading": 3.1176453508036173, - "angularVelocity": -0.5788218143528088, - "velocityX": -0.8029500649557468, - "velocityY": 1.6557822779543205, - "timestamp": 3.971810741426543 - }, - { - "x": 4.364838650184773, - "y": 4.770158562720032, - "heading": 3.102596259666631, - "angularVelocity": -0.5216446252228655, - "velocityX": -0.6699749667322109, - "velocityY": 1.5697911688336352, - "timestamp": 4.0006600583931595 - }, - { - "x": 4.348888573038258, - "y": 4.812368956191183, - "heading": 3.089189215796109, - "angularVelocity": -0.46472656132675605, - "velocityX": -0.5528753822828192, - "velocityY": 1.4631332006921636, - "timestamp": 4.029509375359776 - }, - { - "x": 4.335861259266713, - "y": 4.85106463542958, - "heading": 3.077388704078398, - "angularVelocity": -0.4090395530461387, - "velocityX": -0.4515640278977055, - "velocityY": 1.3413031332136207, - "timestamp": 4.058358692326393 - }, - { - "x": 4.325340119447455, - "y": 4.8859350900174165, - "heading": 3.0671405005854333, - "angularVelocity": -0.35523210150256085, - "velocityX": -0.36469285672977003, - "velocityY": 1.2087098848195585, - "timestamp": 4.087208009293009 - }, - { - "x": 4.316960474710625, - "y": 4.9167626971561855, - "heading": 3.058380753694675, - "angularVelocity": -0.30363793017680446, - "velocityX": -0.29046250025703113, - "velocityY": 1.068573206583551, - "timestamp": 4.116057326259626 - }, - { - "x": 4.310409550752313, - "y": 4.9433947876173105, - "heading": 3.0510430147740575, - "angularVelocity": -0.25434705886134035, - "velocityX": -0.22707379747989975, - "velocityY": 0.9231445753790886, - "timestamp": 4.144906643226243 - }, - { - "x": 4.305421020948144, - "y": 4.965723440411237, - "heading": 3.0450626529491944, - "angularVelocity": -0.20729647886580527, - "velocityX": -0.1729167387201477, - "velocityY": 0.7739750934057472, - "timestamp": 4.173755960192859 - }, - { - "x": 4.301768102740837, - "y": 4.983671575861687, - "heading": 3.0403791563233025, - "angularVelocity": -0.1623434146226634, - "velocityX": -0.12662061328980811, - "velocityY": 0.6221338089639996, - "timestamp": 4.202605277159476 - }, - { - "x": 4.299256940796215, - "y": 4.997183546671836, - "heading": 3.0369370630877266, - "angularVelocity": -0.11931281560526409, - "velocityX": -0.08704406927651794, - "velocityY": 0.46836362974486884, - "timestamp": 4.231454594126093 - }, - { - "x": 4.297720871569226, - "y": 5.0062187774292, - "heading": 3.0346861151511018, - "angularVelocity": -0.0780243060599773, - "velocityX": -0.05324456134491601, - "velocityY": 0.3131869904518336, - "timestamp": 4.260303911092709 + "heading": 3.4309387268192957, + "angularVelocity": -0.7813526282216597, + "velocityX": -1.9237414492240437, + "velocityY": 0.6320159953067281, + "timestamp": 4.610670039672977 + }, + { + "x": 4.942868657450354, + "y": 4.198256846286876, + "heading": 3.404404470872184, + "angularVelocity": -0.7726521203159952, + "velocityX": -1.8567647885752279, + "velocityY": 0.723851389827387, + "timestamp": 4.645011828492841 + }, + { + "x": 4.881509496702508, + "y": 4.226188983081773, + "heading": 3.378217710449817, + "angularVelocity": -0.7625333834450684, + "velocityX": -1.786719994980448, + "velocityY": 0.8133570717999663, + "timestamp": 4.679353617312705 + }, + { + "x": 4.822674368879593, + "y": 4.25709776691911, + "heading": 3.352433635613109, + "angularVelocity": -0.7508075648579646, + "velocityX": -1.713222573568582, + "velocityY": 0.900034182827979, + "timestamp": 4.713695406132569 + }, + { + "x": 4.766496795353122, + "y": 4.290863870424898, + "heading": 3.32711485602231, + "angularVelocity": -0.7372586129279952, + "velocityX": -1.635837137696703, + "velocityY": 0.983236595009792, + "timestamp": 4.748037194952433 + }, + { + "x": 4.713126817534648, + "y": 4.327338953959474, + "heading": 3.302332355149848, + "angularVelocity": -0.72164269026451, + "velocityX": -1.5540826396207805, + "velocityY": 1.0621194989550988, + "timestamp": 4.782378983772297 + }, + { + "x": 4.662731869400387, + "y": 4.366336499085112, + "heading": 3.2781663522474465, + "angularVelocity": -0.7036908598198508, + "velocityX": -1.4674526245153463, + "velocityY": 1.1355711646296458, + "timestamp": 4.816720772592161 + }, + { + "x": 4.615495938030307, + "y": 4.407619714122828, + "heading": 3.25470688648321, + "angularVelocity": -0.6831171750339045, + "velocityX": -1.3754650818526581, + "velocityY": 1.2021276833965184, + "timestamp": 4.851062561412025 + }, + { + "x": 4.571615167814469, + "y": 4.450886271337786, + "heading": 3.2320538652482793, + "angularVelocity": -0.6596342827030635, + "velocityX": -1.2777660024062774, + "velocityY": 1.2598807080757402, + "timestamp": 4.885404350231889 + }, + { + "x": 4.531286947002188, + "y": 4.495750867878681, + "heading": 3.210316251948319, + "angularVelocity": -0.6329784803576448, + "velocityX": -1.1743191661860777, + "velocityY": 1.3064140827441386, + "timestamp": 4.919746139051753 + }, + { + "x": 4.49468875405066, + "y": 4.541729560722991, + "heading": 3.1896098329586398, + "angularVelocity": -0.6029510896561723, + "velocityX": -1.065704327270207, + "velocityY": 1.3388555000872755, + "timestamp": 4.954087927871617 + }, + { + "x": 4.461944703854708, + "y": 4.58823480395128, + "heading": 3.1700521077060673, + "angularVelocity": -0.5695022281792148, + "velocityX": -0.9534753814866304, + "velocityY": 1.3541881429714668, + "timestamp": 4.988429716691481 + }, + { + "x": 4.433084989818715, + "y": 4.634594075764574, + "heading": 3.15175191127338, + "angularVelocity": -0.5328841933272364, + "velocityX": -0.840367232684729, + "velocityY": 1.3499375951691615, + "timestamp": 5.022771505511345 + }, + { + "x": 4.408015136265837, + "y": 4.680099458997601, + "heading": 3.1347948929027134, + "angularVelocity": -0.4937721345737907, + "velocityX": -0.7300101251096751, + "velocityY": 1.3250731775132731, + "timestamp": 5.057113294331209 + }, + { + "x": 4.386515523359297, + "y": 4.7240761111554255, + "heading": 3.119233776621693, + "angularVelocity": -0.45312480263168503, + "velocityX": -0.6260481368431887, + "velocityY": 1.2805579927271504, + "timestamp": 5.091455083151073 + }, + { + "x": 4.3682750992900985, + "y": 4.7659405609732906, + "heading": 3.105089224757056, + "angularVelocity": -0.4118758035241259, + "velocityX": -0.531143679348733, + "velocityY": 1.21905268352387, + "timestamp": 5.1257968719709375 + }, + { + "x": 4.352940592262872, + "y": 4.805227096523998, + "heading": 3.0923557137916355, + "angularVelocity": -0.3707876439463567, + "velocityX": -0.44652615819354075, + "velocityY": 1.1439862890305763, + "timestamp": 5.1601386607908015 + }, + { + "x": 4.340158565629974, + "y": 4.841583652435461, + "heading": 3.0810074682882163, + "angularVelocity": -0.33045004041419795, + "velocityX": -0.3722003737179855, + "velocityY": 1.058668088088494, + "timestamp": 5.194480449610666 + }, + { + "x": 4.329600653798364, + "y": 4.874751978213288, + "heading": 3.0710045148132727, + "angularVelocity": -0.2912764249821968, + "velocityX": -0.30743628082363317, + "velocityY": 0.9658298800859751, + "timestamp": 5.22882223843053 + }, + { + "x": 4.320974113375607, + "y": 4.904544945118328, + "heading": 3.062298708280428, + "angularVelocity": -0.2535047483551423, + "velocityX": -0.25119659514553827, + "velocityY": 0.8675426624196874, + "timestamp": 5.263164027250394 + }, + { + "x": 4.314023414784346, + "y": 4.930827090495744, + "heading": 3.054838719869548, + "angularVelocity": -0.21722771781080963, + "velocityX": -0.20239768602969369, + "velocityY": 0.7653109019823413, + "timestamp": 5.297505816070258 + }, + { + "x": 4.308527535879405, + "y": 4.953499830547057, + "heading": 3.048573474005263, + "angularVelocity": -0.1824379591042448, + "velocityX": -0.1600347301000252, + "velocityY": 0.6602084757506164, + "timestamp": 5.331847604890122 + }, + { + "x": 4.3042957090143315, + "y": 4.972490820345766, + "heading": 3.0434541747536845, + "angularVelocity": -0.14906909125880094, + "velocityX": -0.12322674532980514, + "velocityY": 0.5529994345467729, + "timestamp": 5.366189393709986 + }, + { + "x": 4.301162979125563, + "y": 4.9877464707182675, + "heading": 3.039435315609642, + "angularVelocity": -0.1170253292606026, + "velocityX": -0.09122209402662507, + "velocityY": 0.44422992793192745, + "timestamp": 5.40053118252985 + }, + { + "x": 4.298986142785592, + "y": 4.999226717111559, + "heading": 3.0364750487374588, + "angularVelocity": -0.08620013615804763, + "velocityX": -0.06338738938113687, + "velocityY": 0.33429377990501713, + "timestamp": 5.434872971349714 + }, + { + "x": 4.2976402487172045, + "y": 5.006901351879666, + "heading": 3.034535187310271, + "angularVelocity": -0.05648690688080154, + "velocityX": -0.03919114625766282, + "velocityY": 0.22347801415830756, + "timestamp": 5.469214760169578 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": -0.0383058918727994, - "velocityX": -0.02444441261373577, - "velocityY": 0.15697616982684176, - "timestamp": 4.289153228059326 + "angularVelocity": -0.027784544960703036, + "velocityX": -0.018187222535483022, + "velocityY": 0.11199419020507764, + "timestamp": 5.503556548989442 }, { "x": 4.29701566696167, "y": 5.01074743270874, "heading": 3.0335810163347743, - "angularVelocity": 4.966568604592627e-21, - "velocityX": 7.617351748205077e-22, - "velocityY": 1.4083890100936048e-21, - "timestamp": 4.3180025450259425 + "angularVelocity": -8.769505529981165e-23, + "velocityX": -1.240876760933137e-21, + "velocityY": -2.1890549285133406e-22, + "timestamp": 5.537898337809306 } ], "eventMarkers": [ @@ -1191,7 +1353,7 @@ } }, { - "timestamp": 2.96526530522919, + "timestamp": 3.667155129979705, "command": { "type": "named", "data": { diff --git a/Robot/src/main/deploy/choreo/Source Side Start B.2.traj b/Robot/src/main/deploy/choreo/Source Side Start B.2.traj deleted file mode 100644 index 0c48a65..0000000 --- a/Robot/src/main/deploy/choreo/Source Side Start B.2.traj +++ /dev/null @@ -1,1031 +0,0 @@ -{ - "samples": [ - { - "x": 2.423624277114868, - "y": 4.3437066078186035, - "heading": 2.700841844640526, - "angularVelocity": 7.911924990211229e-28, - "velocityX": 8.83706494888309e-28, - "velocityY": 2.259390025280478e-27, - "timestamp": 0 - }, - { - "x": 2.4218446481518763, - "y": 4.339067586401205, - "heading": 2.7011999480073796, - "angularVelocity": 0.011932336921400104, - "velocityX": -0.05929889061945338, - "velocityY": -0.1545765040535065, - "timestamp": 0.030011167905525604 - }, - { - "x": 2.418424725161963, - "y": 4.329738511697419, - "heading": 2.701924937691114, - "angularVelocity": 0.02415732989854738, - "velocityX": -0.11395501170361201, - "velocityY": -0.3108534373988109, - "timestamp": 0.06002233581105121 - }, - { - "x": 2.4135244589313936, - "y": 4.315666519487515, - "heading": 2.7030261954720824, - "angularVelocity": 0.03669493251429407, - "velocityX": -0.16328142396840445, - "velocityY": -0.46889185566531505, - "timestamp": 0.09003350371657681 - }, - { - "x": 2.407328625518917, - "y": 4.296797897558937, - "heading": 2.7045136479524707, - "angularVelocity": 0.04956329873835278, - "velocityX": -0.20645092626789183, - "velocityY": -0.628720014761687, - "timestamp": 0.12004467162210242 - }, - { - "x": 2.400051990408271, - "y": 4.2730797975872, - "heading": 2.7063976331766058, - "angularVelocity": 0.06277613820514366, - "velocityX": -0.24246424309619674, - "velocityY": -0.790309129134914, - "timestamp": 0.15005583952762802 - }, - { - "x": 2.3919455647823002, - "y": 4.244463086408198, - "heading": 2.708688638062903, - "angularVelocity": 0.07633841153763746, - "velocityX": -0.2701136340808055, - "velocityY": -0.9535354061890378, - "timestamp": 0.18006700743315351 - }, - { - "x": 2.383303991217713, - "y": 4.210906951512413, - "heading": 2.711396833740652, - "angularVelocity": 0.09023959634875238, - "velocityX": -0.2879452606373326, - "velocityY": -1.1181215939818818, - "timestamp": 0.210078175338679 - }, - { - "x": 2.3744738330419453, - "y": 4.1723861337908215, - "heading": 2.714531311195081, - "angularVelocity": 0.10444370123468988, - "velocityX": -0.2942290751084647, - "velocityY": -1.283549438757413, - "timestamp": 0.2400893432442045 - }, - { - "x": 2.365861973186359, - "y": 4.128901910259223, - "heading": 2.7180989086998344, - "angularVelocity": 0.11887566375238655, - "velocityX": -0.2869551722444283, - "velocityY": -1.4489347321798978, - "timestamp": 0.27010051114973 - }, - { - "x": 2.357942271094841, - "y": 4.080497977885455, - "heading": 2.722102563248839, - "angularVelocity": 0.13340548963665938, - "velocityX": -0.26389183241548875, - "velocityY": -1.6128640020322589, - "timestamp": 0.3001116790552555 - }, - { - "x": 2.351257000567528, - "y": 4.027281702596226, - "heading": 2.7265392760343037, - "angularVelocity": 0.1478353924589409, - "velocityX": -0.22275942570305315, - "velocityY": -1.7732157394458175, - "timestamp": 0.330122846960781 - }, - { - "x": 2.3464078601875427, - "y": 3.9694490039949155, - "heading": 2.7313981094416873, - "angularVelocity": 0.16190084380183983, - "velocityX": -0.1615778631225111, - "velocityY": -1.9270392536327345, - "timestamp": 0.3601340148663065 - }, - { - "x": 2.344031208896142, - "y": 3.907306974122368, - "heading": 2.7366590278276743, - "angularVelocity": 0.17529868889303335, - "velocityX": -0.07919222933550124, - "velocityY": -2.0706301756789185, - "timestamp": 0.39014518277183197 - }, - { - "x": 2.34475642187958, - "y": 3.8412837977571765, - "heading": 2.7422934482808334, - "angularVelocity": 0.18774412481701075, - "velocityX": 0.024164770452157196, - "velocityY": -2.199953583047178, - "timestamp": 0.42015635067735746 - }, - { - "x": 2.349155583980889, - "y": 3.771915676908203, - "heading": 2.748266647826949, - "angularVelocity": 0.1990325589766905, - "velocityX": 0.1465841687720234, - "velocityY": -2.3114102412589363, - "timestamp": 0.45016751858288295 - }, - { - "x": 2.357701044046377, - "y": 3.6998095638332726, - "heading": 2.7545410540468627, - "angularVelocity": 0.20906904521893901, - "velocityX": 0.2847426695418434, - "velocityY": -2.40264268627995, - "timestamp": 0.48017868648840845 - }, - { - "x": 2.3707452552113213, - "y": 3.625593623296103, - "heading": 2.7610790786771546, - "angularVelocity": 0.21785305559829293, - "velocityX": 0.43464523626695145, - "velocityY": -2.4729440977038863, - "timestamp": 0.5101898543939339 - }, - { - "x": 2.388525093578297, - "y": 3.549872530220805, - "heading": 2.76784486241175, - "angularVelocity": 0.2254422005799301, - "velocityX": 0.5924407348273207, - "velocityY": -2.523097178812428, - "timestamp": 0.5402010222994594 - }, - { - "x": 2.4111818590996297, - "y": 3.4731983035128624, - "heading": 2.774805107826178, - "angularVelocity": 0.23192184443932218, - "velocityX": 0.7549444790904396, - "velocityY": -2.5548564770725086, - "timestamp": 0.5702121902049849 - }, - { - "x": 2.4387859678538315, - "y": 3.396057563844118, - "heading": 2.7819293965702707, - "angularVelocity": 0.23738792060740016, - "velocityX": 0.919794552517877, - "velocityY": -2.5704011223948977, - "timestamp": 0.6002233581105104 - }, - { - "x": 2.471359222890471, - "y": 3.318870535069176, - "heading": 2.789190245424361, - "angularVelocity": 0.24193823035968778, - "velocityX": 1.0853711238156265, - "velocityY": -2.5719435184237, - "timestamp": 0.6302345260160359 - }, - { - "x": 2.5088920316490753, - "y": 3.2419964100181318, - "heading": 2.7965630146241534, - "angularVelocity": 0.24566752027118796, - "velocityX": 1.2506280620853132, - "velocityY": -2.561517275603605, - "timestamp": 0.6602456939215614 - }, - { - "x": 2.5513556003570557, - "y": 3.165741205215454, - "heading": 2.8040257249027554, - "angularVelocity": 0.24866444058740178, - "velocityX": 1.4149255650981205, - "velocityY": -2.5408942778477357, - "timestamp": 0.6902568618270869 - }, - { - "x": 2.5916562324851804, - "y": 3.1005707701780487, - "heading": 2.810520258415773, - "angularVelocity": 0.2506895666077097, - "velocityX": 1.555607955824009, - "velocityY": -2.515584542356326, - "timestamp": 0.7161635383629353 - }, - { - "x": 2.6355994534018414, - "y": 3.0360672220185934, - "heading": 2.817060156122753, - "angularVelocity": 0.2524406284970807, - "velocityX": 1.6962122044429266, - "velocityY": -2.4898426500287876, - "timestamp": 0.7420702148987838 - }, - { - "x": 2.683183011796486, - "y": 2.9722427799398563, - "heading": 2.8236376817169115, - "angularVelocity": 0.2538930682620403, - "velocityX": 1.8367295522758709, - "velocityY": -2.463629095396315, - "timestamp": 0.7679768914346322 - }, - { - "x": 2.734404390550922, - "y": 2.9091108331538242, - "heading": 2.8302443693842423, - "angularVelocity": 0.2550187268594151, - "velocityX": 1.977149739124524, - "velocityY": -2.436898715999844, - "timestamp": 0.7938835679704807 - }, - { - "x": 2.789260758688475, - "y": 2.84668611670722, - "heading": 2.8368709112703656, - "angularVelocity": 0.2557851014565173, - "velocityX": 2.117460650023768, - "velocityY": -2.40959956249981, - "timestamp": 0.8197902445063291 - }, - { - "x": 2.847748911382655, - "y": 2.784984924237821, - "heading": 2.843507020511108, - "angularVelocity": 0.25615440218895175, - "velocityX": 2.25764785433774, - "velocityY": -2.3816714731439936, - "timestamp": 0.8456969210421775 - }, - { - "x": 2.909865194173314, - "y": 2.7240253678456576, - "heading": 2.8501412628603546, - "angularVelocity": 0.25608234001247837, - "velocityX": 2.397693996167581, - "velocityY": -2.35304425512901, - "timestamp": 0.871603597578026 - }, - { - "x": 2.9756054059802026, - "y": 2.663827698809717, - "heading": 2.8567608474317225, - "angularVelocity": 0.2555165484931389, - "velocityX": 2.537577975929126, - "velocityY": -2.32363533595835, - "timestamp": 0.8975102741138744 - }, - { - "x": 3.0449646731733835, - "y": 2.6044147079467006, - "heading": 2.8633513634299836, - "angularVelocity": 0.25439449900652045, - "velocityX": 2.6772738331450965, - "velocityY": -2.2933466892522345, - "timestamp": 0.9234169506497228 - }, - { - "x": 3.1179372833951167, - "y": 2.5458122317795313, - "heading": 2.8698964443750743, - "angularVelocity": 0.2526407019454538, - "velocityX": 2.8167491928483126, - "velocityY": -2.262060750481768, - "timestamp": 0.9493236271855713 - }, - { - "x": 3.194516462236587, - "y": 2.4880498016295127, - "heading": 2.876377333212251, - "angularVelocity": 0.25016288091637934, - "velocityX": 2.95596305977357, - "velocityY": -2.2296349001034406, - "timestamp": 0.9752303037214197 - }, - { - "x": 3.2746940668539857, - "y": 2.431161489371619, - "heading": 2.8827723091533883, - "angularVelocity": 0.2468466355492552, - "velocityX": 3.0948626122093623, - "velocityY": -2.195893872345006, - "timestamp": 1.001136980257268 - }, - { - "x": 3.358460155593385, - "y": 2.3751870294830306, - "heading": 2.8890559171246184, - "angularVelocity": 0.2425478220849751, - "velocityX": 3.233378415926405, - "velocityY": -2.1606190902616924, - "timestamp": 1.0270436567931167 - }, - { - "x": 3.445802366782149, - "y": 2.3201733384683263, - "heading": 2.895197907895658, - "angularVelocity": 0.23708138566289852, - "velocityX": 3.371417057989075, - "velocityY": -2.123533326962232, - "timestamp": 1.052950333328965 - }, - { - "x": 3.5367049932537316, - "y": 2.2661766211898033, - "heading": 2.901161741132037, - "angularVelocity": 0.23020448910639668, - "velocityX": 3.5088494020371996, - "velocityY": -2.0842780510192074, - "timestamp": 1.0788570098648136 - }, - { - "x": 3.6311475513374614, - "y": 2.2132653705441934, - "heading": 2.9069024046284504, - "angularVelocity": 0.22159011745368193, - "velocityX": 3.645491074590157, - "velocityY": -2.0423789432192923, - "timestamp": 1.1047636864006618 - }, - { - "x": 3.7291024680895952, - "y": 2.161524774105908, - "heading": 2.9123631192237394, - "angularVelocity": 0.2107840651707187, - "velocityX": 3.7810684290819254, - "velocityY": -1.9971915875310948, - "timestamp": 1.1306703629365105 - }, - { - "x": 3.8305311388944343, - "y": 2.111063422713889, - "heading": 2.9174701395417304, - "angularVelocity": 0.19713143486098045, - "velocityX": 3.915155642001684, - "velocityY": -1.9478126158788878, - "timestamp": 1.1565770394723587 - }, - { - "x": 3.935376756185106, - "y": 2.0620239422658777, - "heading": 2.9221241163764637, - "angularVelocity": 0.17964391643573643, - "velocityX": 4.047050077828058, - "velocityY": -1.8929282719901488, - "timestamp": 1.182483716008207 - }, - { - "x": 4.043550180616031, - "y": 2.014600571535173, - "heading": 2.9261848498906358, - "angularVelocity": 0.1567446719208769, - "velocityX": 4.175503727050469, - "velocityY": -1.8305462943146087, - "timestamp": 1.2083903925440551 - }, - { - "x": 4.154899254208162, - "y": 1.9690692177872684, - "heading": 2.9294424753545067, - "angularVelocity": 0.12574463032196206, - "velocityX": 4.298084064856884, - "velocityY": -1.757514271848055, - "timestamp": 1.2342970690799033 - }, - { - "x": 4.26913429270745, - "y": 1.9258376947300118, - "heading": 2.9315593258774433, - "angularVelocity": 0.08171061695264005, - "velocityX": 4.40948256489845, - "velocityY": -1.668740604277631, - "timestamp": 1.2602037456157515 - }, - { - "x": 4.385631522244675, - "y": 1.8855027476470778, - "heading": 2.931952832178578, - "angularVelocity": 0.015189377942410801, - "velocityX": 4.496803338553377, - "velocityY": -1.5569325161072074, - "timestamp": 1.2861104221515998 - }, - { - "x": 4.503415830982728, - "y": 1.848638575634127, - "heading": 2.93195284465719, - "angularVelocity": 4.81675520652989e-7, - "velocityX": 4.546484709262839, - "velocityY": -1.4229602921833742, - "timestamp": 1.312017098687448 - }, - { - "x": 4.622253096897382, - "y": 1.8153246708140436, - "heading": 2.931952847421509, - "angularVelocity": 1.0670295023336962e-7, - "velocityX": 4.587128949180836, - "velocityY": -1.2859196653026999, - "timestamp": 1.3379237752232962 - }, - { - "x": 4.742036325895742, - "y": 1.785591013485931, - "heading": 2.9319528500554277, - "angularVelocity": 1.0166950672760084e-7, - "velocityX": 4.623643207673125, - "velocityY": -1.1477217962315078, - "timestamp": 1.3638304517591444 - }, - { - "x": 4.862657675044524, - "y": 1.7594643465789406, - "heading": 2.9319528525781413, - "angularVelocity": 9.737696882708354e-8, - "velocityX": 4.655994719425783, - "velocityY": -1.0084916477355788, - "timestamp": 1.3897371282949926 - }, - { - "x": 4.984008540432593, - "y": 1.7369681180558878, - "heading": 2.9319528550061964, - "angularVelocity": 9.372314886152806e-8, - "velocityX": 4.684154110626651, - "velocityY": -0.8683564058061889, - "timestamp": 1.4156438048308408 - }, - { - "x": 5.1059794425964355, - "y": 1.71812105178833, - "heading": 2.9319528550061964, - "angularVelocity": 1.9634226529721317e-29, - "velocityX": 4.708087584876652, - "velocityY": -0.7274984207826963, - "timestamp": 1.441550481366689 - }, - { - "x": 5.414828035978192, - "y": 1.6456593782762903, - "heading": 2.9319528550061964, - "angularVelocity": 4.915394492292238e-30, - "velocityX": 4.6380218308875785, - "velocityY": -1.0881669233833104, - "timestamp": 1.5081410677509388 - }, - { - "x": 5.717175677480785, - "y": 1.549617451742239, - "heading": 2.9319528550061964, - "angularVelocity": 6.923330968795024e-30, - "velocityX": 4.540396141850234, - "velocityY": -1.4422748281544948, - "timestamp": 1.5747316541351886 - }, - { - "x": 6.013904470481557, - "y": 1.4494597297313143, - "heading": 2.9319528550061964, - "angularVelocity": 1.8224523238752317e-29, - "velocityX": 4.456017120626434, - "velocityY": -1.5040822952508803, - "timestamp": 1.6413222405194383 - }, - { - "x": 6.28736789835264, - "y": 1.356874136438099, - "heading": 2.9319528550061964, - "angularVelocity": 5.137768966734655e-30, - "velocityX": 4.106637930669482, - "velocityY": -1.390370596212587, - "timestamp": 1.707912826903688 - }, - { - "x": 6.53756594271752, - "y": 1.2718606917099966, - "heading": 2.9319528550061964, - "angularVelocity": 5.290657344655362e-29, - "velocityX": 3.7572584647498575, - "velocityY": -1.2766585991230999, - "timestamp": 1.7745034132879378 - }, - { - "x": 6.764498597471353, - "y": 1.1944194022261594, - "heading": 2.9319528550061964, - "angularVelocity": -1.8327033591155345e-29, - "velocityX": 3.4078789071529614, - "velocityY": -1.162946501731865, - "timestamp": 1.8410939996721876 - }, - { - "x": 6.968165859567374, - "y": 1.1245502713435156, - "heading": 2.9319528550061964, - "angularVelocity": -6.813865025769165e-29, - "velocityX": 3.058499303802382, - "velocityY": -1.0492343539291835, - "timestamp": 1.9076845860564373 - }, - { - "x": 7.148567727179843, - "y": 1.0622533010833368, - "heading": 2.9319528550061964, - "angularVelocity": 1.2146052898672008e-28, - "velocityX": 2.709119673034422, - "velocityY": -0.9355221757727793, - "timestamp": 1.974275172440687 - }, - { - "x": 7.3057041990927605, - "y": 1.0075284927966939, - "heading": 2.9319528550061964, - "angularVelocity": -3.926613605000432e-29, - "velocityX": 2.3597400240056077, - "velocityY": -0.8218099773271637, - "timestamp": 2.040865758824937 - }, - { - "x": 7.439575274438203, - "y": 0.9603758474506313, - "heading": 2.9319528550061964, - "angularVelocity": 7.571471478919027e-29, - "velocityX": 2.010360361943086, - "velocityY": -0.7080977643593045, - "timestamp": 2.1074563452091866 - }, - { - "x": 7.550180952565622, - "y": 0.9207953657716341, - "heading": 2.9319528550061964, - "angularVelocity": 1.822428879207964e-29, - "velocityX": 1.660980690111162, - "velocityY": -0.5943855404817211, - "timestamp": 2.1740469315934363 - }, - { - "x": 7.637521232969278, - "y": 0.8887870483255008, - "heading": 2.9319528550061964, - "angularVelocity": 7.274282718170277e-29, - "velocityX": 1.3116010106845064, - "velocityY": -0.4806733081074626, - "timestamp": 2.240637517977686 - }, - { - "x": 7.701596115244739, - "y": 0.8643508955653527, - "heading": 2.9319528550061964, - "angularVelocity": -8.603766973393188e-29, - "velocityX": 0.962221325184425, - "velocityY": -0.3669610689286224, - "timestamp": 2.307228104361936 - }, - { - "x": 7.742405599061205, - "y": 0.8474869078622296, - "heading": 2.9319528550061964, - "angularVelocity": 6.796771330004161e-29, - "velocityX": 0.6128416347166673, - "velocityY": -0.25324882417782413, - "timestamp": 2.3738186907461856 - }, - { - "x": 7.759949684143066, - "y": 0.8381950855255127, - "heading": 2.9319528550061964, - "angularVelocity": 9.843509510929218e-27, - "velocityX": 0.2634619401100666, - "velocityY": -0.13953657478100467, - "timestamp": 2.4404092771304353 - }, - { - "x": 7.761189197324535, - "y": 0.8353713613573083, - "heading": 2.9303007499452534, - "angularVelocity": -0.03670618496261611, - "velocityX": 0.027539289829798277, - "velocityY": -0.06273701597546273, - "timestamp": 2.485418178562865 - }, - { - "x": 7.751809887431759, - "y": 0.8360044455221002, - "heading": 2.9270157102132446, - "angularVelocity": -0.07298644551324211, - "velocityX": -0.20838788760167468, - "velocityY": 0.014065754653938578, - "timestamp": 2.530427079995295 - }, - { - "x": 7.731811527670228, - "y": 0.8400944927291146, - "heading": 2.9221192237600166, - "angularVelocity": -0.10878929050465, - "velocityX": -0.44432010391442206, - "velocityY": 0.09087196258621777, - "timestamp": 2.5754359814277246 - }, - { - "x": 7.701193865898705, - "y": 0.8476416716253821, - "heading": 2.9156354497527714, - "angularVelocity": -0.14405537129093204, - "velocityX": -0.6802579222576227, - "velocityY": 0.1676819174890929, - "timestamp": 2.6204448828601543 - }, - { - "x": 7.65995662187611, - "y": 0.8586461694535003, - "heading": 2.9075916609235435, - "angularVelocity": -0.17871551122622922, - "velocityX": -0.9162019669487641, - "velocityY": 0.24449603251567495, - "timestamp": 2.665453784292584 - }, - { - "x": 7.608099483952724, - "y": 0.8731081978542572, - "heading": 2.898018807723065, - "angularVelocity": -0.21268799939163016, - "velocityX": -1.152152935819518, - "velocityY": 0.3213148497407419, - "timestamp": 2.710462685725014 - }, - { - "x": 7.545622105063776, - "y": 0.891028000194864, - "heading": 2.8869522516139887, - "angularVelocity": -0.24587483268593244, - "velocityX": -1.3881116157154654, - "velocityY": 0.39813907405647636, - "timestamp": 2.7554715871574436 - }, - { - "x": 7.472524097859607, - "y": 0.9124058609568879, - "heading": 2.874432736766182, - "angularVelocity": -0.27815641904973254, - "velocityX": -1.6240789016792396, - "velocityY": 0.47496961893455136, - "timestamp": 2.8004804885898733 - }, - { - "x": 7.38880502879593, - "y": 0.9372421179482022, - "heading": 2.8605077042499873, - "angularVelocity": -0.3093839679046539, - "velocityX": -1.8600558200550832, - "velocityY": 0.5518076691696231, - "timestamp": 2.845489390022303 - }, - { - "x": 7.294464411041752, - "y": 0.965537178456902, - "heading": 2.8452331100502195, - "angularVelocity": -0.33936829635131227, - "velocityX": -2.0960435547578977, - "velocityY": 0.6286547684612614, - "timestamp": 2.890498291454733 - }, - { - "x": 7.189501696223928, - "y": 0.9972915410209859, - "heading": 2.828676005998382, - "angularVelocity": -0.3678628787839662, - "velocityX": -2.3320434731205553, - "velocityY": 0.7055129441840653, - "timestamp": 2.9355071928871626 - }, - { - "x": 7.073916265534662, - "y": 1.0325058253803299, - "heading": 2.810918317654634, - "angularVelocity": -0.39453725326770034, - "velocityX": -2.5680571400479546, - "velocityY": 0.7823848891804209, - "timestamp": 2.9805160943195923 - }, - { - "x": 6.9477074221839, - "y": 1.0711808146339925, - "heading": 2.7920625838694644, - "angularVelocity": -0.4189334372774477, - "velocityX": -2.804086288136484, - "velocityY": 0.8592742329364315, - "timestamp": 3.025524995752022 - }, - { - "x": 6.810874391352183, - "y": 1.1133175159961926, - "heading": 2.7722410912460433, - "angularVelocity": -0.44039050038087824, - "velocityX": -3.0401326510299103, - "velocityY": 0.9361859548040393, - "timestamp": 3.070533897184452 - }, - { - "x": 6.66341634637718, - "y": 1.1589172501625284, - "heading": 2.7516313058835906, - "angularVelocity": -0.45790465233623445, - "velocityX": -3.2761973805642794, - "velocityY": 1.0131270196583955, - "timestamp": 3.1155427986168815 - }, - { - "x": 6.50533252155403, - "y": 1.2079817830775184, - "heading": 2.7304841009364798, - "angularVelocity": -0.46984494786789455, - "velocityX": -3.512279122397081, - "velocityY": 1.090107319963117, - "timestamp": 3.160551700049311 - }, - { - "x": 6.3366226318866525, - "y": 1.2605135050250862, - "heading": 2.7091814580677815, - "angularVelocity": -0.4732984407690834, - "velocityX": -3.7483671962235388, - "velocityY": 1.1671407271833045, - "timestamp": 3.20556060148174 - }, - { - "x": 6.157288595746575, - "y": 1.316515532196566, - "heading": 2.688375873421064, - "angularVelocity": -0.46225488702389195, - "velocityX": -3.9844126480026296, - "velocityY": 1.2442433694044719, - "timestamp": 3.2505695029141695 - }, - { - "x": 5.967344188171313, - "y": 1.3759902044372894, - "heading": 2.6694387262879764, - "angularVelocity": -0.4207422649832398, - "velocityX": -4.220152048376917, - "velocityY": 1.3213979979051609, - "timestamp": 3.2955784043465988 - }, - { - "x": 5.766945602424512, - "y": 1.4389075248323433, - "heading": 2.657280336933087, - "angularVelocity": -0.27013299520634537, - "velocityX": -4.452421173790536, - "velocityY": 1.397886160130114, - "timestamp": 3.340587305779028 - }, - { - "x": 5.563040265543361, - "y": 1.5052315890441452, - "heading": 2.657280329084091, - "angularVelocity": -1.7438763163001646e-7, - "velocityX": -4.5303335649564005, - "velocityY": 1.4735766059825322, - "timestamp": 3.3855962072114574 - }, - { - "x": 5.359135467798499, - "y": 1.5715573107433196, - "heading": 2.6572803212354605, - "angularVelocity": -1.7437951944245796e-7, - "velocityX": -4.530321586519444, - "velocityY": 1.4736134317507603, - "timestamp": 3.4306051086438867 - }, - { - "x": 5.157026181948417, - "y": 1.6431680952251317, - "heading": 2.6572803133847924, - "angularVelocity": -1.7442478539675586e-7, - "velocityX": -4.490429213285748, - "velocityY": 1.5910360440438402, - "timestamp": 3.475614010076316 - }, - { - "x": 4.958922513008749, - "y": 1.7252120110174542, - "heading": 2.6572803054692016, - "angularVelocity": -1.7586723174536055e-7, - "velocityX": -4.4014331084502425, - "velocityY": 1.8228375539334645, - "timestamp": 3.5206229115087453 - }, - { - "x": 4.7653632164001465, - "y": 1.817467451095581, - "heading": 2.657280297386291, - "angularVelocity": -1.7958471716760798e-7, - "velocityX": -4.300467028709545, - "velocityY": 2.0497154372147186, - "timestamp": 3.5656318129411746 - }, - { - "x": 4.5708367406065795, - "y": 1.923391698439112, - "heading": 2.65728029007046, - "angularVelocity": -1.5734977077264072e-7, - "velocityX": -4.183899099335917, - "velocityY": 2.2782315941853444, - "timestamp": 3.6121258777297927 - }, - { - "x": 4.382293938231094, - "y": 2.0396332837070363, - "heading": 2.6572802727611715, - "angularVelocity": -3.7229028892794926e-7, - "velocityX": -4.055201523735976, - "velocityY": 2.5001381530396993, - "timestamp": 3.6586199425184107 - }, - { - "x": 4.203783895739139, - "y": 2.1585819115443003, - "heading": 2.6366733907181743, - "angularVelocity": -0.44321532515353584, - "velocityX": -3.839415703994404, - "velocityY": 2.558361553846803, - "timestamp": 3.705114007307029 - }, - { - "x": 4.035525429280669, - "y": 2.271482963815781, - "heading": 2.613434094827986, - "angularVelocity": -0.49983360232846846, - "velocityX": -3.618923559887576, - "velocityY": 2.428289563082435, - "timestamp": 3.751608072095647 - }, - { - "x": 3.877328685943965, - "y": 2.37797970869586, - "heading": 2.5898981388996227, - "angularVelocity": -0.5062142025088141, - "velocityX": -3.4025147952955472, - "velocityY": 2.290544940827557, - "timestamp": 3.798102136884265 - }, - { - "x": 3.729119626892867, - "y": 2.4779582204967756, - "heading": 2.5668442573504304, - "angularVelocity": -0.49584568813256213, - "velocityX": -3.187698466996136, - "velocityY": 2.1503499910248816, - "timestamp": 3.844596201672883 - }, - { - "x": 3.590859264191485, - "y": 2.5713626019802382, - "heading": 2.5446636923059294, - "angularVelocity": -0.4770622905384407, - "velocityX": -2.973720695963483, - "velocityY": 2.008952796622921, - "timestamp": 3.891090266461501 - }, - { - "x": 3.462523596147136, - "y": 2.658159703752241, - "heading": 2.523592249385762, - "angularVelocity": -0.4532071569987921, - "velocityX": -2.760259156256123, - "velocityY": 1.8668426210231008, - "timestamp": 3.937584331250119 - }, - { - "x": 3.3440963804229753, - "y": 2.7383276133945293, - "heading": 2.5037878939739318, - "angularVelocity": -0.4259544847685264, - "velocityX": -2.5471469587049596, - "velocityY": 1.7242611504665284, - "timestamp": 3.984078396038737 - }, - { - "x": 3.2355659045771534, - "y": 2.811850785507327, - "heading": 2.485364082378387, - "angularVelocity": -0.3962615804685417, - "velocityX": -2.3342866737775405, - "velocityY": 1.5813453275609368, - "timestamp": 4.030572460827355 - }, - { - "x": 3.136923327929974, - "y": 2.878717627832709, - "heading": 2.4684064320662844, - "angularVelocity": -0.3647272052723159, - "velocityX": -2.1216165352642262, - "velocityY": 1.43818017696209, - "timestamp": 4.077066525615973 - }, - { - "x": 3.0481617432981314, - "y": 2.9389191685697886, - "heading": 2.452981965412947, - "angularVelocity": -0.3317513046764856, - "velocityX": -1.9090949572894986, - "velocityY": 1.2948220597786195, - "timestamp": 4.123560590404591 - }, - { - "x": 2.969275606422631, - "y": 2.9924482604954545, - "heading": 2.4391446336108933, - "angularVelocity": -0.2976150152705379, - "velocityX": -1.6966926259114987, - "velocityY": 1.1513102192512406, - "timestamp": 4.170054655193209 - }, - { - "x": 2.9002603691636613, - "y": 3.039299076318459, - "heading": 2.4269388108920147, - "angularVelocity": -0.2625243194883304, - "velocityX": -1.4843881164777089, - "velocityY": 1.007673044634999, - "timestamp": 4.2165487199818275 - }, - { - "x": 2.8411122330215437, - "y": 3.0794667732053815, - "heading": 2.41640160654225, - "angularVelocity": -0.22663547267100062, - "velocityX": -1.272165305636958, - "velocityY": 0.863931709768585, - "timestamp": 4.2630427847704455 - }, - { - "x": 2.7918279774203825, - "y": 3.1129472610630304, - "heading": 2.4075644522250004, - "angularVelocity": -0.19007058981456224, - "velocityX": -1.0600117633342698, - "velocityY": 0.7201024046803638, - "timestamp": 4.309536849559064 - }, - { - "x": 2.7524048364214875, - "y": 3.139737037340502, - "heading": 2.4004542266752313, - "angularVelocity": -0.15292759585755633, - "velocityX": -0.8479177111773146, - "velocityY": 0.5761977663013351, - "timestamp": 4.356030914347682 - }, - { - "x": 2.7228404079176425, - "y": 3.159833066079614, - "heading": 2.3950940753534704, - "angularVelocity": -0.11528678652060953, - "velocityX": -0.6358753238344953, - "velocityY": 0.4322278301644953, - "timestamp": 4.4025249791363 - }, - { - "x": 2.7031325852606054, - "y": 3.1732326873310495, - "heading": 2.3915040237657625, - "angularVelocity": -0.07721526616418495, - "velocityX": -0.42387824653829087, - "velocityY": 0.2882006835142419, - "timestamp": 4.449019043924918 - }, - { - "x": 2.693279504776001, - "y": 3.179933547973633, - "heading": 2.3897014484579464, - "angularVelocity": -0.0387700089465447, - "velocityX": -0.21192125337718945, - "velocityY": 0.14412292564756654, - "timestamp": 4.495513108713536 - }, - { - "x": 2.693279504776001, - "y": 3.179933547973633, - "heading": 2.3897014484579464, - "angularVelocity": 3.8456180744027416e-28, - "velocityX": 1.7066797959499698e-27, - "velocityY": 8.91281778730739e-29, - "timestamp": 4.542007173502154 - } - ], - "eventMarkers": [] -} \ No newline at end of file