diff --git a/src/main/deploy/paths/FigureEight3.wpilib.json b/src/main/deploy/paths/FigureEight3.wpilib.json new file mode 100644 index 0000000..3ee5daa --- /dev/null +++ b/src/main/deploy/paths/FigureEight3.wpilib.json @@ -0,0 +1 @@ +[{"time":0.0,"velocity":0.0,"acceleration":2.7000000000000006,"pose":{"translation":{"x":0.0,"y":0.0},"rotation":{"radians":0.0}},"curvature":0.0},{"time":0.2405915837300212,"velocity":0.6495972760710574,"acceleration":2.700000000000001,"pose":{"translation":{"x":0.07814381358912215,"y":-2.831307938322425E-5},"rotation":{"radians":-0.0010826509167209514}},"curvature":-0.02748258627930911},{"time":0.3403687473786084,"velocity":0.9189956179222429,"acceleration":2.7,"pose":{"translation":{"x":0.15639844350516796,"y":-2.2414140403270721E-4},"rotation":{"radians":-0.004261296220402157}},"curvature":-0.05347409186319095},{"time":0.4171073902948127,"velocity":1.1261899537959945,"acceleration":2.6999999999999997,"pose":{"translation":{"x":0.23486907390179113,"y":-7.485484820790589E-4},"rotation":{"radians":-0.0094212046777475}},"curvature":-0.07770893881369795},{"time":0.4820198850766026,"velocity":1.3014536897068272,"acceleration":2.6999999999999993,"pose":{"translation":{"x":0.3136548399925232,"y":-0.0017556548118591309},"rotation":{"radians":-0.01643557600211064}},"curvature":-0.0999786645789153},{"time":0.5394608356419908,"velocity":1.4565442562333752,"acceleration":2.6999999999999997,"pose":{"translation":{"x":0.39284893282456324,"y":-0.0033927426557056606},"rotation":{"radians":-0.0251682723352039}},"curvature":-0.12012966946706},{"time":0.5916708442330667,"velocity":1.5975112794292803,"acceleration":0.4372208985685985,"pose":{"translation":{"x":0.4725387040525675,"y":-0.005800360813736916},"rotation":{"radians":-0.03547638991817513}},"curvature":-0.13806039182086433},{"time":0.6416172926181855,"velocity":1.619348910472532,"acceleration":-0.1327710001684345,"pose":{"translation":{"x":0.552805770712439,"y":-0.009112429397646338},"rotation":{"radians":-0.047212672643734674}},"curvature":-0.15371802470468285},{"time":0.691763244869097,"velocity":1.61269098223778,"acceleration":-0.10816235523707908,"pose":{"translation":{"x":0.6337261199951172,"y":-0.013456344604492188},"rotation":{"radians":-0.06022776783721897}},"curvature":-0.1670947999411318},{"time":0.7425904865170331,"velocity":1.607193388070935,"acceleration":-0.08527371232841424,"pose":{"translation":{"x":0.7153702140203677,"y":-0.018953083490487188},"rotation":{"radians":-0.07437232026484512}},"curvature":-0.1782238294413945},{"time":0.7941232830888397,"velocity":1.602798995200592,"acceleration":-0.06425369682292294,"pose":{"translation":{"x":0.7978030946105719,"y":-0.02571730874478817},"rotation":{"radians":-0.08949889521362152}},"curvature":-0.18717450044020895},{"time":0.8463856188020151,"velocity":1.59944094692642,"acceleration":-0.045195912914832825,"pose":{"translation":{"x":0.8810844880645163,"y":-0.033857473463285714},"rotation":{"radians":-0.10546371724200888}},"curvature":-0.19404745661562758},{"time":0.8994014127537447,"velocity":1.5970448497198668,"acceleration":-0.028144903720509953,"pose":{"translation":{"x":0.9652689099311829,"y":-0.0434759259223938},"rotation":{"radians":-0.12212820899172197}},"curvature":-0.19896924595594245},{"time":0.9531946524545232,"velocity":1.595530844167674,"acceleration":-0.013101546569886206,"pose":{"translation":{"x":1.0504057697835378,"y":-0.05466901435283944},"rotation":{"radians":-0.1393603148117705}},"curvature":-0.20208676461993152},{"time":1.0077894527571787,"velocity":1.5948155678490352,"acceleration":-2.8300772275892307E-5,"pose":{"translation":{"x":1.136539475992322,"y":-0.06752719171345234},"rotation":{"radians":-0.15703559687254381}},"curvature":-0.20356166296129774},{"time":1.0632100485727427,"velocity":1.5948139994033736,"acceleration":0.011145438289388458,"pose":{"translation":{"x":1.22370954049984,"y":-0.08213512046495453},"rotation":{"radians":-0.17503809651401303}},"curvature":-0.20356489854681434},{"time":1.11948073014329,"velocity":1.59544116081232,"acceleration":0.020517784327446633,"pose":{"translation":{"x":1.31195068359375,"y":-0.09857177734375},"rotation":{"radians":-0.19326096007443874}},"curvature":-0.20227161900745516},{"time":1.1766257299402767,"velocity":1.5966136495935466,"acceleration":0.028208643483979043,"pose":{"translation":{"x":1.4012929386808537,"y":-0.11691055813571438},"rotation":{"radians":-0.2116068355586935}},"curvature":-0.199856536473444},{"time":1.2346690704589236,"velocity":1.5982509734928563,"acceleration":0.03435396942968972,"pose":{"translation":{"x":1.4917617570608854,"y":-0.13721938244998455},"rotation":{"radians":-0.22998805342187695}},"curvature":-0.1964899195916967},{"time":1.2936343821175844,"velocity":1.60027666600699,"acceleration":0.03910017590330624,"pose":{"translation":{"x":1.5833781127003022,"y":-0.1595607984927483},"rotation":{"radians":-0.2483266107864853}},"curvature":-0.19233428470069036},{"time":1.3535447002134353,"velocity":1.6026191699829608,"acceleration":0.042598904638657606,"pose":{"translation":{"x":1.676158607006073,"y":-0.18399208784103394},"rotation":{"radians":-0.26655398309896333}},"curvature":-0.18754182089294194},{"time":1.4144222493608867,"velocity":1.6052124868937283,"acceleration":0.04500232668776041,"pose":{"translation":{"x":1.770115573599469,"y":-0.21056537021650001},"rotation":{"radians":-0.2846107903049497}},"curvature":-0.18225253988851078},{"time":1.4762882231020171,"velocity":1.607996599654883,"acceleration":0.04645911315598688,"pose":{"translation":{"x":1.8652571830898523,"y":-0.2393277082592249},"rotation":{"radians":-0.30244634603314535}},"curvature":-0.17659310488419677},{"time":1.5391625654678787,"velocity":1.6109176858414669,"acceleration":0.047111157975952694,"pose":{"translation":{"x":1.9615875478484668,"y":-0.2703212123014964},"rotation":{"radians":-0.3200181181490893}},"curvature":-0.17067626514133666},{"time":1.603063760245367,"velocity":1.6139281451234813,"acceleration":0.04709108007037938,"pose":{"translation":{"x":2.0591068267822266,"y":-0.30358314514160156},"rotation":{"radians":-0.33729112761652036}},"curvature":-0.1646008057287766},{"time":1.6680086326282912,"velocity":1.6169864693090261,"acceleration":0.04652048240038413,"pose":{"translation":{"x":2.1578113301075064,"y":-0.3391460268176161},"rotation":{"radians":-0.3542373101961703}},"curvature":-0.15845191395296837},{"time":1.7340121668609523,"velocity":1.6200569855616598,"acceleration":0.04550890564454909,"pose":{"translation":{"x":2.257693624123931,"y":-0.3770377393811941},"rotation":{"radians":-0.3708348624485024}},"curvature":-0.15230186412129473},{"time":1.8010873424668827,"velocity":1.6231095033994016,"acceleration":0.04415338673725915,"pose":{"translation":{"x":2.3587426359881647,"y":-0.4172816316713579},"rotation":{"radians":-0.38706759009738423}},"curvature":-0.14621092848984082},{"time":1.8692449907312363,"velocity":1.6261188944023197,"acceleration":0.04253851724936418,"pose":{"translation":{"x":2.4609437584877014,"y":-0.45989662408828735},"rotation":{"radians":-0.4029242733210075}},"curvature":-0.1402284325466594},{"time":1.9384936722968376,"velocity":1.6290646306375938,"acceleration":0.04073689217796292,"pose":{"translation":{"x":2.564278954814654,"y":-0.5048973133671097},"rotation":{"radians":-0.41839806017259407}},"curvature":-0.13439388534690774},{"time":2.008839576053657,"velocity":1.6319303041340967,"acceleration":0.03880984385024885,"pose":{"translation":{"x":2.6687268633395433,"y":-0.5522940773516893},"rotation":{"radians":-0.4334858962447088}},"curvature":-0.1287381289353431},{"time":2.080286438951921,"velocity":1.6347031457267684,"acceleration":0.03680836577891133,"pose":{"translation":{"x":2.7742629023850895,"y":-0.602093179768417},"rotation":{"radians":-0.448187995969697}},"curvature":-0.12328446383071472},{"time":2.152835485944844,"velocity":1.6373735575853954,"acceleration":0.03477414499532014,"pose":{"translation":{"x":2.880859375,"y":-0.654296875},"rotation":{"radians":-0.4625073586397917}},"curvature":-0.11804971934383038},{"time":2.2264853889572405,"velocity":1.6399346699916397,"acceleration":0.032740636566912784,"pose":{"translation":{"x":2.98848557373276,"y":-0.7089035128592514},"rotation":{"radians":-0.47644933034151526}},"curvature":-0.11304524771977777},{"time":2.301232243567186,"velocity":1.6423819295929438,"acceleration":0.030734129097070333,"pose":{"translation":{"x":3.0971078854054213,"y":-0.7659076433628798},"rotation":{"radians":-0.490021211510979}},"curvature":-0.10827782955645215},{"time":2.3770695619636633,"velocity":1.6447127235269168,"acceleration":0.028774763928721563,"pose":{"translation":{"x":3.2066898958873935,"y":-0.8253001215052791},"rotation":{"radians":-0.5032319086929682}},"curvature":-0.10375048466516042},{"time":2.453988280688158,"velocity":1.6469260414999138,"acceleration":0.027344752776362884,"pose":{"translation":{"x":3.317192494869232,"y":-0.8870682120323181},"rotation":{"radians":-0.5160916282809809}},"curvature":-0.09946318763650631},{"time":2.4928496108418328,"velocity":1.6479886949655267,"acceleration":0.02641341993660787,"pose":{"translation":{"x":3.3727760816236696,"y":-0.9188381762487552},"rotation":{"radians":-0.5223933499305692}},"curvature":-0.09740887163401273},{"time":2.53197673400173,"velocity":1.6490221761004604,"acceleration":0.02550085277916446,"pose":{"translation":{"x":3.428573980636429,"y":-0.9511956942151301},"rotation":{"radians":-0.5286116094776955}},"curvature":-0.09541349105745087},{"time":2.571367804568202,"velocity":1.6500266819917897,"acceleration":0.024607920377304648,"pose":{"translation":{"x":3.4845805914756056,"y":-0.9841382109243568},"rotation":{"radians":-0.5347479353268761}},"curvature":-0.09347644950906146},{"time":2.611020821933997,"velocity":1.651002460285847,"acceleration":0.02373530153336793,"pose":{"translation":{"x":3.5407901648432016,"y":-1.0176629666239023},"rotation":{"radians":-0.5408038933963395}},"curvature":-0.09159706182401153},{"time":2.650933632064671,"velocity":1.6519498028693427,"acceleration":0.02288350430585584,"pose":{"translation":{"x":3.5971968058493076,"y":-1.051767000089967},"rotation":{"radians":-0.546781081651562}},"curvature":-0.08977456657954339},{"time":2.6911039292123218,"velocity":1.6528690400370885,"acceleration":0.022052884108780306,"pose":{"translation":{"x":3.653794477286283,"y":-1.086447151901666},"rotation":{"radians":-0.5526811250772102}},"curvature":-0.08800813754015926},{"time":2.731529257753552,"velocity":1.6537605351224676,"acceleration":0.021243660430409737,"pose":{"translation":{"x":3.7105770029029372,"y":-1.12170006771521},"rotation":{"radians":-0.5585056710629697}},"curvature":-0.08629689410238194},{"time":2.772207014143035,"velocity":1.6546246795662767,"acceleration":0.020455932226803017,"pose":{"translation":{"x":3.767538070678711,"y":-1.157522201538086},"rotation":{"radians":-0.5642563851793584}},"curvature":-0.08463991080199534},{"time":2.8131344489743197,"velocity":1.6554618883994023,"acceleration":0.01968969204989398,"pose":{"translation":{"x":3.8246712360978563,"y":-1.1939098190032382},"rotation":{"radians":-0.5699349473203195}},"curvature":-0.08303622594547336},{"time":2.8543086691401407,"velocity":1.6562725961148619,"acceleration":0.018944838974633928,"pose":{"translation":{"x":3.8819699254236184,"y":-1.2308590006432496},"rotation":{"radians":-0.5755430481901774}},"curvature":-0.08148484942566686},{"time":2.895726640084726,"velocity":1.6570572529050631,"acceleration":0.018221190390968898,"pose":{"translation":{"x":3.939427438972416,"y":-1.268365645164522},"rotation":{"radians":-0.5810823861133668}},"curvature":-0.07998476977982921},{"time":2.937385188141221,"velocity":1.6578163212406118,"acceleration":0.017518492728726003,"pose":{"translation":{"x":3.9970369543880224,"y":-1.3064254727214575},"rotation":{"radians":-0.5865546641462306}},"curvature":-0.07853496054580741},{"time":2.9792810029475167,"velocity":1.65855027276766,"acceleration":0.016836431182176145,"pose":{"translation":{"x":4.054791529915747,"y":-1.3450340281906392},"rotation":{"radians":-0.5919615874710755}},"curvature":-0.07713438596977641},{"time":3.021410639934429,"velocity":1.6592595855015202,"acceleration":0.01617463850185506,"pose":{"translation":{"x":4.112684107676614,"y":-1.3841866844450124},"rotation":{"radians":-0.5973048610536026}},"curvature":-0.07578200611631837},{"time":3.0637705228802665,"velocity":1.65994474129515,"acceleration":0.01553270291821187,"pose":{"translation":{"x":4.1707075169415475,"y":-1.423878645628065},"rotation":{"radians":-0.6025861875457454}},"curvature":-0.07447678142898713},{"time":3.1063569465264984,"velocity":1.660606223561996,"acceleration":0.014910175261208886,"pose":{"translation":{"x":4.228854477405548,"y":-1.464104950428009},"rotation":{"radians":-0.6078072654168749}},"curvature":-0.07321767678680903},{"time":3.1491660792493343,"velocity":1.661244515233674,"acceleration":0.014306575336558616,"pose":{"translation":{"x":4.287117602461876,"y":-1.5048604753519612},"rotation":{"radians":-0.6129697872972361}},"curvature":-0.072003665099477},{"time":3.1921939657825407,"velocity":1.661860096933934,"acceleration":0.013721397617188226,"pose":{"translation":{"x":4.3454894024762325,"y":-1.546139938000124},"rotation":{"radians":-0.6180754385183802}},"curvature":-0.07083373048133693},{"time":3.235436529987009,"velocity":1.6624534453513704,"acceleration":0.013154116305517162,"pose":{"translation":{"x":4.403962288060939,"y":-1.5879379003399663},"rotation":{"radians":-0.6231258958362255}},"curvature":-0.06970687104165842},{"time":3.2788895776630684,"velocity":1.6630250317943305,"acceleration":0.012604189819139052,"pose":{"translation":{"x":4.462528573349118,"y":-1.6302487719804049},"rotation":{"radians":-0.6281228263232281}},"curvature":-0.06862210132615378},{"time":3.322548799401602,"velocity":1.6635753209124788,"acceleration":0.012071064749408054,"pose":{"translation":{"x":4.521180479268878,"y":-1.6730668134459847},"rotation":{"radians":-0.6330678864169678}},"curvature":-0.06757845444226444},{"time":3.3664097734705654,"velocity":1.6641047695704374,"acceleration":0.011554179339399952,"pose":{"translation":{"x":4.579910136817489,"y":-1.7163861394510604},"rotation":{"radians":-0.6379627211132425}},"curvature":-0.066574983898393},{"time":3.4104679687335056,"velocity":1.6646138258598757,"acceleration":0.01105296652453745,"pose":{"translation":{"x":4.638709590335566,"y":-1.7602007221739768},"rotation":{"radians":-0.6428089632925209}},"curvature":-0.06561076518502294},{"time":3.4547187475972008,"velocity":1.6651029282373409,"acceleration":0.0105668565762716,"pose":{"translation":{"x":4.69757080078125,"y":-1.80450439453125},"rotation":{"radians":-0.647608233169335}},"curvature":-0.06468489712354483},{"time":3.499157368985429,"velocity":1.6655725047759975,"acceleration":0.010095279386269354,"pose":{"translation":{"x":4.756485649004389,"y":-1.8492908534517483},"rotation":{"radians":-0.6523621378548796}},"curvature":-0.06379650300659852},{"time":3.5437789913365902,"velocity":1.666022972520301,"acceleration":0.009637666425594585,"pose":{"translation":{"x":4.815445939020719,"y":-1.894553663150873},"rotation":{"radians":-0.6570722710237484}},"curvature":-0.06294473155184836},{"time":3.588578675622476,"velocity":1.6664547369334204,"acceleration":0.009193452410798338,"pose":{"translation":{"x":4.874443401286044,"y":-1.9402862584047398},"rotation":{"radians":-0.6617402126763631}},"curvature":-0.062128757689329704},{"time":3.633551388386291,"velocity":1.666868191427999,"acceleration":0.008762076706344615,"pose":{"translation":{"x":4.933469695970416,"y":-1.986481947824359},"rotation":{"radians":-0.6663675289892359}},"curvature":-0.06134778320084009},{"time":3.678692004797843,"velocity":1.6672637169715687,"acceleration":0.008342984489951926,"pose":{"translation":{"x":4.99251641623232,"y":-2.033133917129817},"rotation":{"radians":-0.6709557722457755}},"curvature":-0.060601037228293915},{"time":3.723995311723959,"velocity":1.6676416817585968,"acceleration":0.007935627705738952,"pose":{"translation":{"x":5.05157509149285,"y":-2.0802352324244566},"rotation":{"radians":-0.6755064808408625}},"curvature":-0.05988777666651089},{"time":3.7694560108127284,"velocity":1.668002440941808,"acceleration":0.007539465827406847,"pose":{"translation":{"x":5.110637190709895,"y":-2.127778843469059},"rotation":{"radians":-0.6800211793529247}},"curvature":-0.059207286454563475},{"time":3.8150687215898125,"velocity":1.6683463364160072,"acceleration":0.0071539664518024465,"pose":{"translation":{"x":5.169694125652313,"y":-2.175757586956024},"rotation":{"radians":-0.6845013786777033}},"curvature":-0.058558879778560675},{"time":3.8608279845655145,"velocity":1.6686736966481945,"acceleration":0.006778605741540854,"pose":{"translation":{"x":5.228737254174121,"y":-2.2241641897835507},"rotation":{"radians":-0.6889485762183403}},"curvature":-0.057941898197592274},{"time":3.9067282643515098,"velocity":1.6689848365482902,"acceleration":0.006412868733427135,"pose":{"translation":{"x":5.287757883488666,"y":-2.2729912723298185},"rotation":{"radians":-0.6933642561268223}},"curvature":-0.05735571170349064},{"time":3.9527639527857867,"velocity":1.6692800573752722,"acceleration":0.006056249527731615,"pose":{"translation":{"x":5.346747273442816,"y":-2.3222313517271687},"rotation":{"radians":-0.697749889592203}},"curvature":-0.05679971872408576},{"time":3.9989293720651164,"velocity":1.6695596466739802,"acceleration":0.005708251372146678,"pose":{"translation":{"x":5.405696639791131,"y":-2.371876845136285},"rotation":{"radians":-0.702106935171379}},"curvature":-0.056273346078724217},{"time":4.045218777883857,"velocity":1.6698238782382608,"acceleration":0.005368386652712271,"pose":{"translation":{"x":5.4645971574700525,"y":-2.421920073020374},"rotation":{"radians":-0.7064368391585247}},"curvature":-0.055776048893992014},{"time":4.091626362578495,"velocity":1.6700730120965201,"acceleration":0.005036176802774174,"pose":{"translation":{"x":5.523439963872079,"y":-2.4723532624193467},"rotation":{"radians":-0.7107410359896046}},"curvature":-0.05530731048681846},{"time":4.138146258276857,"velocity":1.6703072945161037,"acceleration":0.004711152139866201,"pose":{"translation":{"x":5.582216162119948,"y":-2.5231685502239998},"rotation":{"radians":-0.7150209486786628}},"curvature":-0.05486664222143903},{"time":4.184772540051715,"velocity":1.6705269580232613,"acceleration":0.0043928516394809835,"pose":{"translation":{"x":5.64091682434082,"y":-2.5743579864501953},"rotation":{"radians":-0.7192779892828582}},"curvature":-0.05445358334605495},{"time":4.231499229077968,"velocity":1.6707322214357578,"acceleration":0.004080822653578123,"pose":{"translation":{"x":5.699532994940455,"y":-2.6259135375130427},"rotation":{"radians":-0.7235135593934571}},"curvature":-0.05406770081444218},{"time":4.278320295792755,"velocity":1.6709232899054722,"acceleration":0.003774620580993549,"pose":{"translation":{"x":5.758055693877395,"y":-2.677827089501079},"rotation":{"radians":-0.7277290506502201}},"curvature":-0.053708589097225895},{"time":4.3252296630584075,"velocity":1.6711003549685945,"acceleration":0.003473808495880602,"pose":{"translation":{"x":5.816475919937147,"y":-2.730090451450451},"rotation":{"radians":-0.7319258452768336}},"curvature":-0.05337586998704912},{"time":4.372221209327352,"velocity":1.6712635946012582,"acceleration":0.0031779567398719836,"pose":{"translation":{"x":5.874784654006362,"y":-2.782695358619094},"rotation":{"radians":-0.7361053166352199}},"curvature":-0.05306919240141616},{"time":4.419288771809292,"velocity":1.671413173278677,"acceleration":0.002886642483009199,"pose":{"translation":{"x":5.932972862347015,"y":-2.8356334757609147},"rotation":{"radians":-0.7402688297967409}},"curvature":-0.05278823218658412},{"time":4.466426149639281,"velocity":1.6715492420360587,"acceleration":0.0025994492574276926,"pose":{"translation":{"x":5.991031499870587,"y":-2.8888964003999718},"rotation":{"radians":-0.744417742128466}},"curvature":-0.052532691925503534},{"time":4.513627107047846,"velocity":1.6716719385297443,"acceleration":0.0023159664681472866,"pose":{"translation":{"x":6.0489515134122485,"y":-2.942475666104656},"rotation":{"radians":-0.7485534038928245}},"curvature":-0.052302300752467605},{"time":4.560885376531426,"velocity":1.671781387097211,"acceleration":0.002035788883939062,"pose":{"translation":{"x":6.106723845005035,"y":-2.9963627457618713},"rotation":{"radians":-0.7526771588590875}},"curvature":-0.052096814176818704},{"time":4.608194662024063,"velocity":1.671877698814724,"acceleration":0.0017585161115803924,"pose":{"translation":{"x":6.164339435154034,"y":-3.050549054851217},"rotation":{"radians":-0.7567903449252481}},"curvature":-0.05191601391777436},{"time":4.655548642070016,"velocity":1.6719609715515822,"acceleration":0.0014837520559655183,"pose":{"translation":{"x":6.221789226110559,"y":-3.105025954719167},"rotation":{"radians":-0.7608942947489714}},"curvature":-0.05175970775217297},{"time":4.70294097299591,"velocity":1.6720312900200305,"acceleration":0.0012111043684684662,"pose":{"translation":{"x":6.2790641651463375,"y":-3.159784755853252},"rotation":{"radians":-0.7649903363863789}},"curvature":-0.05162772937669655},{"time":4.750365292084858,"velocity":1.6720887258200507,"acceleration":9.401838856545614E-4,"pose":{"translation":{"x":6.336155207827687,"y":-3.2148167211562395},"rotation":{"radians":-0.7690797939375139}},"curvature":-0.05151993828590486},{"time":4.797815220749009,"velocity":1.6721333374783562,"acceleration":6.706040601600467E-4,"pose":{"translation":{"x":6.393053321289699,"y":-3.270113069220315},"rotation":{"radians":-0.7731639881974063}},"curvature":-0.05143621966720566},{"time":4.845284367704559,"velocity":1.672165170481037,"acceleration":4.0198038547065336E-4,"pose":{"translation":{"x":6.449749487510417,"y":-3.3256649776012637},"rotation":{"radians":-0.7772442373117127}},"curvature":-0.05137648431369161},{"time":4.892766332144535,"velocity":1.6721842572994055,"acceleration":1.339298160045948E-4,"pose":{"translation":{"x":6.506234706585019,"y":-3.38146358609265},"rotation":{"radians":-0.7813218574359585}},"curvature":-0.05134066855558977},{"time":4.940254706913932,"velocity":1.6721906174087007,"acceleration":-1.339298160045948E-4,"pose":{"translation":{"x":6.5625,"y":-3.4375},"rotation":{"radians":-0.7853981633974483}},"curvature":-0.05132873421089494},{"time":4.9877430816833295,"velocity":1.6721842572994055,"acceleration":-4.0198038547065336E-4,"pose":{"translation":{"x":6.61853641390735,"y":-3.493765293414981},"rotation":{"radians":-0.7894744693589382}},"curvature":-0.05134066855558977},{"time":5.035225046123306,"velocity":1.672165170481037,"acceleration":-6.706040601600467E-4,"pose":{"translation":{"x":6.674335022398736,"y":-3.5502505124895833},"rotation":{"radians":-0.793552089483184}},"curvature":-0.05137648431369161},{"time":5.082694193078855,"velocity":1.6721333374783562,"acceleration":-9.401838856545614E-4,"pose":{"translation":{"x":6.729886930779685,"y":-3.606946678710301},"rotation":{"radians":-0.7976323385974903}},"curvature":-0.05143621966720566},{"time":5.130144121743006,"velocity":1.6720887258200507,"acceleration":-0.0012111043684684662,"pose":{"translation":{"x":6.7851832788437605,"y":-3.6638447921723127},"rotation":{"radians":-0.8017165328573828}},"curvature":-0.05151993828590486},{"time":5.177568440831954,"velocity":1.6720312900200305,"acceleration":-0.0014837520559655183,"pose":{"translation":{"x":6.840215244146748,"y":-3.7209358348536625},"rotation":{"radians":-0.8058059904085177}},"curvature":-0.05162772937669655},{"time":5.224960771757848,"velocity":1.6719609715515822,"acceleration":-0.0017585161115803924,"pose":{"translation":{"x":6.894974045280833,"y":-3.778210773889441},"rotation":{"radians":-0.8099020320459251}},"curvature":-0.05175970775217297},{"time":5.272314751803801,"velocity":1.671877698814724,"acceleration":-0.002035788883939062,"pose":{"translation":{"x":6.949450945148783,"y":-3.8356605648459663},"rotation":{"radians":-0.8140059818696486}},"curvature":-0.05191601391777436},{"time":5.319624037296438,"velocity":1.671781387097211,"acceleration":-0.0023159664681472606,"pose":{"translation":{"x":7.003637254238129,"y":-3.8932761549949646},"rotation":{"radians":-0.8181191679358092}},"curvature":-0.052096814176818704},{"time":5.3668823067800195,"velocity":1.6716719385297443,"acceleration":-0.0025994492574276636,"pose":{"translation":{"x":7.057524333895344,"y":-3.9510484865877515},"rotation":{"radians":-0.8222429229020721}},"curvature":-0.052302300752467605},{"time":5.4140832641885845,"velocity":1.6715492420360587,"acceleration":-0.0028866424830091665,"pose":{"translation":{"x":7.111103599600028,"y":-4.008968500129413},"rotation":{"radians":-0.8263785846664307}},"curvature":-0.052532691925503534},{"time":5.461220642018574,"velocity":1.671413173278677,"acceleration":-0.0031779567398720196,"pose":{"translation":{"x":7.164366524239085,"y":-4.067027137652985},"rotation":{"radians":-0.8305274969981558}},"curvature":-0.05278823218658412},{"time":5.508288204500514,"velocity":1.6712635946012582,"acceleration":-0.0034738084958805624,"pose":{"translation":{"x":7.217304641380906,"y":-4.125215345993638},"rotation":{"radians":-0.8346910101596766}},"curvature":-0.05306919240141616},{"time":5.555279750769459,"velocity":1.6711003549685945,"acceleration":-0.0037746205809935916,"pose":{"translation":{"x":7.269909548549549,"y":-4.183524080062853},"rotation":{"radians":-0.838870481518063}},"curvature":-0.05337586998704912},{"time":5.602189118035111,"velocity":1.6709232899054722,"acceleration":-0.004080822653578123,"pose":{"translation":{"x":7.322172910498921,"y":-4.241944306122605},"rotation":{"radians":-0.8430672761446766}},"curvature":-0.053708589097225895},{"time":5.649010184749898,"velocity":1.6707322214357578,"acceleration":-0.004392851639480933,"pose":{"translation":{"x":7.374086462486957,"y":-4.300467005059545},"rotation":{"radians":-0.8472827674014396}},"curvature":-0.05406770081444218},{"time":5.695736873776151,"velocity":1.6705269580232613,"acceleration":-0.0047111521398662546,"pose":{"translation":{"x":7.425642013549805,"y":-4.35908317565918},"rotation":{"radians":-0.8515183375120384}},"curvature":-0.05445358334605495},{"time":5.7423631555510095,"velocity":1.6703072945161037,"acceleration":-0.005036176802774117,"pose":{"translation":{"x":7.476831449776,"y":-4.417783837880052},"rotation":{"radians":-0.8557753781162338}},"curvature":-0.05486664222143903},{"time":5.788883051249372,"velocity":1.6700730120965201,"acceleration":-0.005368386652712331,"pose":{"translation":{"x":7.527646737580653,"y":-4.476560036127921},"rotation":{"radians":-0.8600552908052921}},"curvature":-0.05530731048681846},{"time":5.83529063594401,"velocity":1.6698238782382608,"acceleration":-0.005708251372146744,"pose":{"translation":{"x":7.578079926979626,"y":-4.5354028425299475},"rotation":{"radians":-0.8643594876363718}},"curvature":-0.055776048893992014},{"time":5.88158004176275,"velocity":1.6695596466739802,"acceleration":-0.006056249527731615,"pose":{"translation":{"x":7.628123154863715,"y":-4.594303360208869},"rotation":{"radians":-0.8686893916235175}},"curvature":-0.056273346078724217},{"time":5.92774546104208,"velocity":1.6692800573752722,"acceleration":-0.006412868733427062,"pose":{"translation":{"x":7.677768648272831,"y":-4.653252726557184},"rotation":{"radians":-0.8730464372026936}},"curvature":-0.05679971872408576},{"time":5.973781149476357,"velocity":1.6689848365482902,"acceleration":-0.006778605741540775,"pose":{"translation":{"x":7.7270087276701815,"y":-4.712242116511334},"rotation":{"radians":-0.8774320706680744}},"curvature":-0.05735571170349064},{"time":6.019681429262353,"velocity":1.6686736966481945,"acceleration":-0.007153966451802529,"pose":{"translation":{"x":7.775835810216449,"y":-4.771262745825879},"rotation":{"radians":-0.8818477505765563}},"curvature":-0.057941898197592274},{"time":6.065440692238055,"velocity":1.6683463364160072,"acceleration":-0.007539465827406847,"pose":{"translation":{"x":7.824242413043976,"y":-4.830305874347687},"rotation":{"radians":-0.8862949481171933}},"curvature":-0.058558879778560675},{"time":6.1110534030151396,"velocity":1.668002440941808,"acceleration":-0.007935627705738952,"pose":{"translation":{"x":7.872221156530941,"y":-4.889362809290105},"rotation":{"radians":-0.890775147441972}},"curvature":-0.059207286454563475},{"time":6.156514102103909,"velocity":1.6676416817585968,"acceleration":-0.008342984489951926,"pose":{"translation":{"x":7.919764767575543,"y":-4.94842490850715},"rotation":{"radians":-0.895289845954034}},"curvature":-0.05988777666651089},{"time":6.201817409030025,"velocity":1.6672637169715687,"acceleration":-0.008762076706344615,"pose":{"translation":{"x":7.966866082870183,"y":-5.00748358376768},"rotation":{"radians":-0.899840554549121}},"curvature":-0.060601037228293915},{"time":6.246958025441577,"velocity":1.666868191427999,"acceleration":-0.009193452410798338,"pose":{"translation":{"x":8.013518052175641,"y":-5.066530304029584},"rotation":{"radians":-0.9044287978056607}},"curvature":-0.06134778320084009},{"time":6.291930738205392,"velocity":1.6664547369334204,"acceleration":-0.0096376664255947,"pose":{"translation":{"x":8.05971374159526,"y":-5.125556598713956},"rotation":{"radians":-0.9090561141185335}},"curvature":-0.062128757689329704},{"time":6.336730422491277,"velocity":1.666022972520301,"acceleration":-0.010095279386269354,"pose":{"translation":{"x":8.105446336849127,"y":-5.184554060979281},"rotation":{"radians":-0.9137240557711481}},"curvature":-0.06294473155184836},{"time":6.381352044842438,"velocity":1.6655725047759975,"acceleration":-0.010566856576271473,"pose":{"translation":{"x":8.150709146548252,"y":-5.243514350995611},"rotation":{"radians":-0.918434188940017}},"curvature":-0.06379650300659852},{"time":6.425790666230667,"velocity":1.6651029282373409,"acceleration":-0.01105296652453745,"pose":{"translation":{"x":8.19549560546875,"y":-5.30242919921875},"rotation":{"radians":-0.9231880936255615}},"curvature":-0.06468489712354483},{"time":6.470041445094362,"velocity":1.6646138258598757,"acceleration":-0.011554179339400093,"pose":{"translation":{"x":8.239799277826023,"y":-5.361290409664434},"rotation":{"radians":-0.9279873635023757}},"curvature":-0.06561076518502294},{"time":6.514099640357302,"velocity":1.6641047695704374,"acceleration":-0.012071064749407907,"pose":{"translation":{"x":8.28361386054894,"y":-5.420089863182511},"rotation":{"radians":-0.9328336056816542}},"curvature":-0.066574983898393},{"time":6.557960614426266,"velocity":1.6635753209124788,"acceleration":-0.012604189819139052,"pose":{"translation":{"x":8.326933186554015,"y":-5.478819520731122},"rotation":{"radians":-0.9377284403779288}},"curvature":-0.06757845444226444},{"time":6.6016198361648,"velocity":1.6630250317943305,"acceleration":-0.013154116305517162,"pose":{"translation":{"x":8.369751228019595,"y":-5.537471426650882},"rotation":{"radians":-0.9426735004716684}},"curvature":-0.06862210132615378},{"time":6.64507288384086,"velocity":1.6624534453513704,"acceleration":-0.013721397617188056,"pose":{"translation":{"x":8.412062099660034,"y":-5.596037711939061},"rotation":{"radians":-0.9476704309586711}},"curvature":-0.06970687104165842},{"time":6.688315448045329,"velocity":1.661860096933934,"acceleration":-0.014306575336558616,"pose":{"translation":{"x":8.453860061999876,"y":-5.6545105975237675},"rotation":{"radians":-0.9527208882765165}},"curvature":-0.07083373048133693},{"time":6.731343334578535,"velocity":1.661244515233674,"acceleration":-0.014910175261208886,"pose":{"translation":{"x":8.495139524648039,"y":-5.712882397538124},"rotation":{"radians":-0.9578265394976606}},"curvature":-0.072003665099477},{"time":6.774152467301372,"velocity":1.660606223561996,"acceleration":-0.01553270291821187,"pose":{"translation":{"x":8.535895049571991,"y":-5.771145522594452},"rotation":{"radians":-0.9629890613780216}},"curvature":-0.07321767678680903},{"time":6.816738890947604,"velocity":1.65994474129515,"acceleration":-0.01617463850185506,"pose":{"translation":{"x":8.576121354371935,"y":-5.8292924830584525},"rotation":{"radians":-0.9682101392491511}},"curvature":-0.07447678142898713},{"time":6.859098773893441,"velocity":1.6592595855015202,"acceleration":-0.016836431182175933,"pose":{"translation":{"x":8.615813315554988,"y":-5.887315892323386},"rotation":{"radians":-0.9734914657412941}},"curvature":-0.07578200611631837},{"time":6.901228410880354,"velocity":1.65855027276766,"acceleration":-0.017518492728726003,"pose":{"translation":{"x":8.65496597180936,"y":-5.945208470084253},"rotation":{"radians":-0.9788347393238211}},"curvature":-0.07713438596977641},{"time":6.94312422568665,"velocity":1.6578163212406118,"acceleration":-0.018221190390968898,"pose":{"translation":{"x":8.693574527278543,"y":-6.002963045611978},"rotation":{"radians":-0.9842416626486661}},"curvature":-0.07853496054580741},{"time":6.984782773743145,"velocity":1.6570572529050631,"acceleration":-0.018944838974633928,"pose":{"translation":{"x":8.731634354835478,"y":-6.060572561027584},"rotation":{"radians":-0.9897139406815298}},"curvature":-0.07998476977982921},{"time":7.02620074468773,"velocity":1.6562725961148619,"acceleration":-0.019689692049893723,"pose":{"translation":{"x":8.76914099935675,"y":-6.118030074576382},"rotation":{"radians":-0.9952532786047192}},"curvature":-0.08148484942566686},{"time":7.067374964853552,"velocity":1.6554618883994023,"acceleration":-0.020455932226803017,"pose":{"translation":{"x":8.806090180996762,"y":-6.175328763902144},"rotation":{"radians":-1.000861379474577}},"curvature":-0.08303622594547336},{"time":7.1083023996848365,"velocity":1.6546246795662767,"acceleration":-0.021243660430409737,"pose":{"translation":{"x":8.842477798461914,"y":-6.232461929321289},"rotation":{"radians":-1.0065399416155383}},"curvature":-0.08463991080199534},{"time":7.14898015607432,"velocity":1.6537605351224676,"acceleration":-0.022052884108780306,"pose":{"translation":{"x":8.87829993228479,"y":-6.289422997097063},"rotation":{"radians":-1.012290655731927}},"curvature":-0.08629689410238194},{"time":7.189405484615549,"velocity":1.6528690400370885,"acceleration":-0.022883504305855687,"pose":{"translation":{"x":8.913552848098334,"y":-6.346205522713717},"rotation":{"radians":-1.0181152017176864}},"curvature":-0.08800813754015926},{"time":7.2295757817632005,"velocity":1.6519498028693427,"acceleration":-0.02373530153336793,"pose":{"translation":{"x":8.948232999910033,"y":-6.402803194150692},"rotation":{"radians":-1.0240152451433346}},"curvature":-0.08977456657954339},{"time":7.269488591893874,"velocity":1.651002460285847,"acceleration":-0.024607920377304814,"pose":{"translation":{"x":8.982337033376098,"y":-6.459209835156798},"rotation":{"radians":-1.029992433398557}},"curvature":-0.09159706182401153},{"time":7.30914160925967,"velocity":1.6500266819917897,"acceleration":-0.02550085277916446,"pose":{"translation":{"x":9.015861789075643,"y":-6.515419408524394},"rotation":{"radians":-1.0360483914680205}},"curvature":-0.09347644950906146},{"time":7.348532679826142,"velocity":1.6490221761004604,"acceleration":-0.026413419936608052,"pose":{"translation":{"x":9.04880430578487,"y":-6.571426019363571},"rotation":{"radians":-1.0421847173172012}},"curvature":-0.09541349105745087},{"time":7.387659802986039,"velocity":1.6479886949655267,"acceleration":-0.027344752776362502,"pose":{"translation":{"x":9.081161823751245,"y":-6.62722391837633},"rotation":{"radians":-1.0484029768643275}},"curvature":-0.09740887163401273},{"time":7.426521133139714,"velocity":1.6469260414999138,"acceleration":-0.028774763928721664,"pose":{"translation":{"x":9.112931787967682,"y":-6.682807505130768},"rotation":{"radians":-1.0547046985139157}},"curvature":-0.09946318763650631},{"time":7.503439851864208,"velocity":1.6447127235269168,"acceleration":-0.030734129097070226,"pose":{"translation":{"x":9.174699878494721,"y":-6.7933101041126065},"rotation":{"radians":-1.0675644181019284}},"curvature":-0.10375048466516042},{"time":7.579277170260685,"velocity":1.6423819295929438,"acceleration":-0.03274063656691302,"pose":{"translation":{"x":9.23409235663712,"y":-6.902892114594579},"rotation":{"radians":-1.0807751152839176}},"curvature":-0.10827782955645215},{"time":7.65402402487063,"velocity":1.6399346699916397,"acceleration":-0.03477414499532001,"pose":{"translation":{"x":9.291096487140749,"y":-7.01151442626724},"rotation":{"radians":-1.0943469964533814}},"curvature":-0.11304524771977777},{"time":7.727673927883027,"velocity":1.6373735575853954,"acceleration":-0.03680836577891133,"pose":{"translation":{"x":9.345703125,"y":-7.119140625},"rotation":{"radians":-1.108288968155105}},"curvature":-0.11804971934383038},{"time":7.8002229748759495,"velocity":1.6347031457267684,"acceleration":-0.0388098438502487,"pose":{"translation":{"x":9.397906820231583,"y":-7.2257370976149105},"rotation":{"radians":-1.1226083308251997}},"curvature":-0.12328446383071472},{"time":7.871669837774214,"velocity":1.6319303041340967,"acceleration":-0.04073689217796276,"pose":{"translation":{"x":9.44770592264831,"y":-7.331273136660457},"rotation":{"radians":-1.1373104305501878}},"curvature":-0.1287381289353431},{"time":7.9420157415310335,"velocity":1.6290646306375938,"acceleration":-0.04253851724936385,"pose":{"translation":{"x":9.49510268663289,"y":-7.435721045185346},"rotation":{"radians":-1.1523982666223025}},"curvature":-0.13439388534690774},{"time":8.011264423096636,"velocity":1.6261188944023197,"acceleration":-0.04415338673725898,"pose":{"translation":{"x":9.540103375911713,"y":-7.539056241512299},"rotation":{"radians":-1.1678720534738891}},"curvature":-0.1402284325466594},{"time":8.07942207136099,"velocity":1.6231095033994016,"acceleration":-0.04550890564454946,"pose":{"translation":{"x":9.582718368328642,"y":-7.641257364011835},"rotation":{"radians":-1.1837287366975124}},"curvature":-0.14621092848984082},{"time":8.14649724696692,"velocity":1.6200569855616598,"acceleration":-0.046520482400384325,"pose":{"translation":{"x":9.622962260618806,"y":-7.742306375876069},"rotation":{"radians":-1.1999614643463943}},"curvature":-0.15230186412129473},{"time":8.21250078119958,"velocity":1.6169864693090261,"acceleration":-0.04709108007037938,"pose":{"translation":{"x":9.660853973182384,"y":-7.842188669892494},"rotation":{"radians":-1.2165590165987263}},"curvature":-0.15845191395296837},{"time":8.277445653582504,"velocity":1.6139281451234813,"acceleration":-0.04711115797595239,"pose":{"translation":{"x":9.696416854858398,"y":-7.940893173217773},"rotation":{"radians":-1.2335051991783763}},"curvature":-0.1646008057287766},{"time":8.341346848359992,"velocity":1.6109176858414669,"acceleration":-0.046459113155986775,"pose":{"translation":{"x":9.729678787698504,"y":-8.038412452151533},"rotation":{"radians":-1.2507782086458072}},"curvature":-0.17067626514133666},{"time":8.404221190725853,"velocity":1.607996599654883,"acceleration":-0.045002326687760316,"pose":{"translation":{"x":9.760672291740775,"y":-8.134742816910148},"rotation":{"radians":-1.2683499807617513}},"curvature":-0.17659310488419677},{"time":8.466087164466984,"velocity":1.6052124868937283,"acceleration":-0.04259890463865741,"pose":{"translation":{"x":9.7894346297835,"y":-8.229884426400531},"rotation":{"radians":-1.2861855364899468}},"curvature":-0.18225253988851078},{"time":8.526964713614436,"velocity":1.6026191699829608,"acceleration":-0.039100175903306514,"pose":{"translation":{"x":9.816007912158966,"y":-8.323841392993927},"rotation":{"radians":-1.3042423436959334}},"curvature":-0.18754182089294194},{"time":8.586875031710287,"velocity":1.60027666600699,"acceleration":-0.03435396942968964,"pose":{"translation":{"x":9.840439201507252,"y":-8.416621887299698},"rotation":{"radians":-1.3224697160084113}},"curvature":-0.19233428470069036},{"time":8.645840343368947,"velocity":1.5982509734928563,"acceleration":-0.028208643483979248,"pose":{"translation":{"x":9.862780617550015,"y":-8.508238242939115},"rotation":{"radians":-1.3408082733730198}},"curvature":-0.1964899195916967},{"time":8.703883683887593,"velocity":1.5966136495935466,"acceleration":-0.020517784327446734,"pose":{"translation":{"x":9.883089441864286,"y":-8.598707061319146},"rotation":{"radians":-1.359189491236203}},"curvature":-0.199856536473444},{"time":8.761028683684579,"velocity":1.59544116081232,"acceleration":-0.011145438289388403,"pose":{"translation":{"x":9.90142822265625,"y":-8.68804931640625},"rotation":{"radians":-1.377535366720458}},"curvature":-0.20227161900745516},{"time":8.817299365255126,"velocity":1.5948139994033736,"acceleration":2.8300772275892165E-5,"pose":{"translation":{"x":9.917864879535045,"y":-8.77629045950016},"rotation":{"radians":-1.3957582302808835}},"curvature":-0.20356489854681434},{"time":8.87271996107069,"velocity":1.5948155678490352,"acceleration":0.013101546569886274,"pose":{"translation":{"x":9.932472808286548,"y":-8.863460524007678},"rotation":{"radians":-1.4137607299223527}},"curvature":-0.20356166296129774},{"time":8.927314761373346,"velocity":1.595530844167674,"acceleration":0.028144903720509915,"pose":{"translation":{"x":9.94533098564716,"y":-8.949594230216462},"rotation":{"radians":-1.4314360119831262}},"curvature":-0.20208676461993152},{"time":8.981108001074125,"velocity":1.5970448497198668,"acceleration":0.04519591291483318,"pose":{"translation":{"x":9.956524074077606,"y":-9.034731090068817},"rotation":{"radians":-1.4486681178031746}},"curvature":-0.19896924595594245},{"time":9.034123795025854,"velocity":1.59944094692642,"acceleration":0.06425369682292277,"pose":{"translation":{"x":9.966142526536714,"y":-9.118915511935484},"rotation":{"radians":-1.4653326095528878}},"curvature":-0.19404745661562758},{"time":9.08638613073903,"velocity":1.602798995200592,"acceleration":0.08527371232841367,"pose":{"translation":{"x":9.974282691255212,"y":-9.202196905389428},"rotation":{"radians":-1.481297431581275}},"curvature":-0.18717450044020895},{"time":9.137918927310837,"velocity":1.607193388070935,"acceleration":0.10816235523708011,"pose":{"translation":{"x":9.981046916509513,"y":-9.284629785979632},"rotation":{"radians":-1.4964240065300516}},"curvature":-0.1782238294413945},{"time":9.188746168958772,"velocity":1.61269098223778,"acceleration":0.13277100016843377,"pose":{"translation":{"x":9.986543655395508,"y":-9.366273880004883},"rotation":{"radians":-1.5105685589576776}},"curvature":-0.1670947999411318},{"time":9.238892121209684,"velocity":1.619348910472532,"acceleration":-0.43722089856853985,"pose":{"translation":{"x":9.990887570602354,"y":-9.447194229287561},"rotation":{"radians":-1.523583654151162}},"curvature":-0.15371802470468285},{"time":9.288838569594802,"velocity":1.5975112794292834,"acceleration":-2.699999999999996,"pose":{"translation":{"x":9.994199639186263,"y":-9.527461295947433},"rotation":{"radians":-1.5353199368767214}},"curvature":-0.13806039182086433},{"time":9.341048578185877,"velocity":1.4565442562333788,"acceleration":-2.700000000000001,"pose":{"translation":{"x":9.996607257344294,"y":-9.607151067175437},"rotation":{"radians":-1.5456280544596928}},"curvature":-0.12012966946706},{"time":9.398489528751265,"velocity":1.3014536897068296,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":9.99824434518814,"y":-9.686345160007477},"rotation":{"radians":-1.554360750792786}},"curvature":-0.0999786645789153},{"time":9.463402023533055,"velocity":1.1261899537959958,"acceleration":-2.7,"pose":{"translation":{"x":9.999251451517921,"y":-9.765130926098209},"rotation":{"radians":-1.561375122117149}},"curvature":-0.07770893881369795},{"time":9.54014066644926,"velocity":0.9189956179222442,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":9.999775858595967,"y":-9.843601556494832},"rotation":{"radians":-1.5665350305744945}},"curvature":-0.05347409186319095},{"time":9.639917830097847,"velocity":0.6495972760710598,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":9.999971686920617,"y":-9.921856186410878},"rotation":{"radians":-1.5697136758781756}},"curvature":-0.02748258627930911},{"time":9.88050941382787,"velocity":0.0,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":10.0,"y":-10.0},"rotation":{"radians":-1.5707963267948966}},"curvature":0.0}] \ No newline at end of file diff --git a/src/main/java/frc4388/robot/RobotContainer.java b/src/main/java/frc4388/robot/RobotContainer.java index 0015d47..40f69d1 100644 --- a/src/main/java/frc4388/robot/RobotContainer.java +++ b/src/main/java/frc4388/robot/RobotContainer.java @@ -169,8 +169,8 @@ public class RobotContainer { // continually sends updates to the Blinkin LED controller to keep the lights on m_robotLED.setDefaultCommand(new RunCommand(() -> m_robotLED.updateLED(), m_robotLED)); // runs the storage not - //m_robotStorage.setDefaultCommand(new RunCommand(() -> m_robotStorage.runStorage(0), m_robotStorage)); - m_robotStorage.setDefaultCommand(new ManageStorage(m_robotStorage, StorageMode.IDLE)); + m_robotStorage.setDefaultCommand(new RunCommand(() -> m_robotStorage.runStorage(0), m_robotStorage)); + //m_robotStorage.setDefaultCommand(new ManageStorage(m_robotStorage, StorageMode.IDLE)); //m_robotLime.setDefaultCommand(new RunCommand(() -> m_robotLime.limeOff(), m_robotLime)); } @@ -359,7 +359,13 @@ public class RobotContainer { //return m_driveOffLineBackward.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); //return m_fiveBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); //return m_tenBallAutoMiddle.andThen(()-> m_robotDrive.tankDriveVelocity(0, 0)); - return new ParallelRaceGroup(m_sixBallAutoMiddle, new RunIntake(m_robotIntake));//, new RunCommand(() -> m_robotStorage.runStorage(1), m_robotStorage)); + return new SequentialCommandGroup( + m_sixBallAuto0, + m_sixBallAuto1 + /**new ParallelRaceGroup( + m_sixBallAuto0, + new RunIntake(m_robotIntake) + )**/); //ParallelRaceGroup(m_sixBallAuto0, new RunIntake(m_robotIntake)); } catch (Exception e) { System.err.println("ERROR"); }