diff --git a/PathWeaver/Paths/Barrel b/PathWeaver/Paths/Barrel new file mode 100644 index 0000000..83d06d8 --- /dev/null +++ b/PathWeaver/Paths/Barrel @@ -0,0 +1,21 @@ +X,Y,Tangent X,Tangent Y,Fixed Theta,Name +1.2561734200863233,-2.456091477162919,0.5504778715454488,0.4453304129356437,true, +2.9447179024673065,-2.1159085228370804,0.9107458620729512,-0.10178337482746132,false, +3.996192488565354,-2.4437211879147065,0.41325189721031075,-0.4547588891338594,false, +4.268338852026026,-3.396233460027056,-0.31154791056112574,-0.27942584130171033,false, +3.6127135218707718,-3.557047220253817,-0.2879329131005023,0.15605044058073636,false, +3.3281968691618884,-3.1797533981833404,-0.06233434485711871,0.3054382027854879,false, +3.587972943374347,-2.6292755266378918,0.055666301616955405,0.19173948334729118,true, +4.255968562777813,-2.4313508986664947,0.8589703669838744,0.23215891428473245,false, +6.1919188301230434,-2.0478719319719123,0.7942729164617968,0.5464826399783518,false, +6.8970253172711455,-1.330395155575597,-0.18228040758538172,0.33251716672160114,false, +6.210474263995361,-0.9840270566256523,-0.42352801124381567,-0.038909318843301545,false, +5.622885524705275,-1.3736911679443404,-0.5225119504158948,-0.5710665615882562,false, +6.303251433356953,-2.9756436255878373,0.7461533734181975,-0.6566658397700645,false, +7.719649552277264,-3.4890106293886487,0.6320693037609113,0.28886118193638116,false, +8.294868002319138,-2.9756436255878373,0.03665613098771699,0.37827064262095067,false, +7.991795915737936,-2.3880548862977515,-0.4476410086145891,0.4897347710221099,false, +6.525916639824776,-2.363314307801327,-1.108161550250234,0.10975004292544946,false, +4.676558397217033,-1.9798353411067444,-1.3182005483288322,0.19662716982004538,false, +2.56742408039683,-1.8004661470076657,-1.2087931465936643,0.00827931264915486,false, +1.0520636474908198,-1.8746878824969397,-0.9648825613605618,-0.0061851446241067976,true, diff --git a/PathWeaver/Paths/Slalom b/PathWeaver/Paths/Slalom new file mode 100644 index 0000000..7952cc9 --- /dev/null +++ b/PathWeaver/Paths/Slalom @@ -0,0 +1,15 @@ +X,Y,Tangent X,Tangent Y,Fixed Theta,Name +1.2994694324550664,-3.8910450299555492,3.048,0.0,true, +2.8704961669780324,-2.4313508986664947,1.0081785737293036,0.7607727887650584,true, +4.336375442891193,-1.7942810023835594,1.5833970237711776,0.10514745860980468,true, +6.031105069896283,-2.1777599690781417,0.9629650370580306,-0.6119074379656407,false, +7.144431102235392,-3.748786703601108,0.9129332006861199,-0.3193197571926916,false, +8.449496617921792,-3.7116758358564708,0.43075407969515506,0.45701597777948244,false, +8.653606390517297,-2.647830960510211,-0.23623592828539644,0.5373704622107232,false, +7.82479701088707,-2.0664273658442305,-0.5725748756955894,0.05867536270547524,false, +6.946506474263994,-2.3942400309218574,-0.5467714376131736,-0.43799557830063024,false, +6.420769181214971,-3.6127135218707718,-0.675970094877858,-0.6987407651139694,false, +4.565225793983121,-4.027118211685885,-1.1465338797118756,0.025296532830716423,false, +2.9818287702119433,-3.6621946788636217,-1.3050655156864006,0.7607727887650593,true, +1.58398608516395,-2.3076480061843716,-0.717476776396315,0.26596121883656565,true, +0.5572520775623268,-2.140649101333505,-0.7236619210204216,0.04948115699284905,true, diff --git a/PathWeaver/pathweaver.json b/PathWeaver/pathweaver.json index ddd52e0..fb75537 100644 --- a/PathWeaver/pathweaver.json +++ b/PathWeaver/pathweaver.json @@ -4,6 +4,6 @@ "maxVelocity": 1.7, "maxAcceleration": 2.7, "wheelBase": 0.648, - "gameName": "Infinite Recharge", + "gameName": "Barrel Racing Path", "outputDir": ".." } \ No newline at end of file diff --git a/src/main/deploy/paths/Barrel.wpilib.json b/src/main/deploy/paths/Barrel.wpilib.json new file mode 100644 index 0000000..43e5c76 --- /dev/null +++ b/src/main/deploy/paths/Barrel.wpilib.json @@ -0,0 +1 @@ +[{"time":0.0,"velocity":0.0,"acceleration":2.7,"pose":{"translation":{"x":1.2561734200863233,"y":-2.456091477162919},"rotation":{"radians":0.6801979139768951}},"curvature":0.0},{"time":0.18487439554623936,"velocity":0.49916086797484627,"acceleration":2.7,"pose":{"translation":{"x":1.2927884251170252,"y":-2.4280141512759763},"rotation":{"radians":0.6100065657754644}},"curvature":-2.3520229087615254},{"time":0.23180730489092016,"velocity":0.6258797232054845,"acceleration":2.7,"pose":{"translation":{"x":1.3148884324936458,"y":-2.41357159694366},"rotation":{"radians":0.5482268871330336}},"curvature":-2.2373994200470264},{"time":0.27567676955568055,"velocity":0.7443272778003376,"acceleration":2.6999999999999984,"pose":{"translation":{"x":1.341019794508704,"y":-2.398723621112152},"rotation":{"radians":0.4874404342695319}},"curvature":-1.7957381326419801},{"time":0.3187009278452808,"velocity":0.8604925051822583,"acceleration":2.7,"pose":{"translation":{"x":1.3719654634698253,"y":-2.3834199024542895},"rotation":{"radians":0.43374007391991043}},"curvature":-1.3363990123365883},{"time":0.36177678749221115,"velocity":0.9767973262289702,"acceleration":2.700000000000001,"pose":{"translation":{"x":1.408257608696955,"y":-2.367647222515827},"rotation":{"radians":0.3886261325643775}},"curvature":-0.9695560649349536},{"time":0.4489831001089372,"velocity":1.2122543702941306,"acceleration":2.7,"pose":{"translation":{"x":1.4978794203144765,"y":-2.33480593729803},"rotation":{"radians":0.3208784251922051}},"curvature":-0.5208478948259417},{"time":0.5369643032678646,"velocity":1.4498036188232346,"acceleration":2.6999999999999997,"pose":{"translation":{"x":1.6099080143183382,"y":-2.300698755654235},"rotation":{"radians":0.27428222439735434}},"curvature":-0.30744546627338676},{"time":0.5806864414959962,"velocity":1.56785339203919,"acceleration":0.588976768352016,"pose":{"translation":{"x":1.6735765263842466,"y":-2.2834286358400497},"rotation":{"radians":0.256132319650547}},"curvature":-0.24714463531517747},{"time":0.6251167760690446,"velocity":1.5940218269128228,"acceleration":0.30765214365134713,"pose":{"translation":{"x":1.7416691681172507,"y":-2.2661870385821574},"rotation":{"radians":0.24034825126993473}},"curvature":-0.20519990459965265},{"time":0.6712519367855658,"velocity":1.60821540800496,"acceleration":0.20513419690496568,"pose":{"translation":{"x":1.813538168034889,"y":-2.2491192826522917},"rotation":{"radians":0.22633809909561806}},"curvature":-0.17614915038893525},{"time":0.7188367933449545,"velocity":1.6179766893401082,"acceleration":0.1292542230022274,"pose":{"translation":{"x":1.8884494116988353,"y":-2.232378880299553},"rotation":{"radians":0.21362806245957644}},"curvature":-0.1564660157974736},{"time":0.7674743505020551,"velocity":1.6242632989991757,"acceleration":0.06924534967750202,"pose":{"translation":{"x":1.965602996718877,"y":-2.2161239235759616},"rotation":{"radians":0.20182917816491627}},"curvature":-0.14391462895614146},{"time":0.8167292422595738,"velocity":1.6276739712022525,"acceleration":0.0172559181646842,"pose":{"translation":{"x":2.0441537877568927,"y":-2.200513470662015},"rotation":{"radians":0.19061051151712066}},"curvature":-0.13714569864306475},{"time":0.8661444879027328,"velocity":1.6285266766371587,"acceleration":-0.03305959027652398,"pose":{"translation":{"x":2.123231971530828,"y":-2.1857039321922445},"rotation":{"radians":0.1796774394721746}},"curvature":-0.13545782222083672},{"time":0.9152575326256345,"velocity":1.626903019501387,"acceleration":-0.0876669224079572,"pose":{"translation":{"x":2.201963611818674,"y":-2.171845457580771},"rotation":{"radians":0.16875343897348746}},"curvature":-0.13867327173013472},{"time":0.9636158566802643,"velocity":1.6226635940587109,"acceleration":-0.15315271041635128,"pose":{"translation":{"x":2.2794912044624427,"y":-2.1590783213468603},"rotation":{"radians":0.1575639639126893}},"curvature":-0.14709925816038716},{"time":1.0107923787544868,"velocity":1.6154383818350269,"acceleration":-0.23771185934530953,"pose":{"translation":{"x":2.354994232372148,"y":-2.1475293094404804},"rotation":{"radians":0.14582129117510875}},"curvature":-0.16156150032838396},{"time":1.0564007900450625,"velocity":1.6045967215853585,"acceleration":-0.35209685955220227,"pose":{"translation":{"x":2.4277097205297773,"y":-2.1373081055678576},"rotation":{"radians":0.13320964327433094}},"curvature":-0.18350689556266103},{"time":1.1001107948402946,"velocity":1.5892065661659456,"acceleration":-0.6148857508045121,"pose":{"translation":{"x":2.496952790993273,"y":-2.128503677517032},"rotation":{"radians":0.11937064958000783}},"curvature":-0.21517343936143302},{"time":1.1809922381870828,"velocity":1.5394737191475032,"acceleration":-1.1826766444396157,"pose":{"translation":{"x":2.6227959824732645,"y":-2.1153757583953428},"rotation":{"radians":0.08629564137414232}},"curvature":-0.32183172596606885},{"time":1.252338801428142,"velocity":1.4550938051412685,"acceleration":-1.7808057504705732,"pose":{"translation":{"x":2.729387814945864,"y":-2.108305656387152},"rotation":{"radians":0.04268368312858198}},"curvature":-0.5194739437378304},{"time":1.314329864938848,"velocity":1.3446997627636168,"acceleration":-0.6176598387431925,"pose":{"translation":{"x":2.8161573700146123,"y":-2.1068907459488218},"rotation":{"radians":-0.014392774895603448}},"curvature":-0.815502241354552},{"time":1.3667729682513845,"velocity":1.3123077640284029,"acceleration":2.7000000000000015,"pose":{"translation":{"x":2.885756562880113,"y":-2.1100500340991344},"rotation":{"radians":-0.07771881721199408}},"curvature":-0.9118142923637237},{"time":1.4100013516807668,"velocity":1.4290243992877352,"acceleration":1.8203858118830758,"pose":{"translation":{"x":2.9447179024673074,"y":-2.1159085228370857},"rotation":{"radians":-0.11129643466108585}},"curvature":-7.357288529138078E-14},{"time":1.4899224788115377,"velocity":1.5745116851862941,"acceleration":-0.11800736821074434,"pose":{"translation":{"x":3.0639021564576363,"y":-2.130073015041691},"rotation":{"radians":-0.13017405478036956}},"curvature":-0.24598713192574556},{"time":1.5333459755775236,"velocity":1.5693873926144324,"acceleration":0.07858160407498015,"pose":{"translation":{"x":3.1315051538742695,"y":-2.1395176072517583},"rotation":{"radians":-0.14755522912603886}},"curvature":-0.2568679558240702},{"time":1.5812961275199102,"velocity":1.5731553924697042,"acceleration":0.03579116276221304,"pose":{"translation":{"x":3.2059195138608403,"y":-2.151308526415594},"rotation":{"radians":-0.16662578117274554}},"curvature":-0.2488601597324653},{"time":1.6333780115723693,"velocity":1.5750194636587884,"acceleration":-0.0811004397251518,"pose":{"translation":{"x":3.286623884128552,"y":-2.165722441448404},"rotation":{"radians":-0.18679476637472292}},"curvature":-0.2449127804546406},{"time":1.688815350169846,"velocity":1.570523471121341,"acceleration":-0.23242073904254942,"pose":{"translation":{"x":3.3721182792772812,"y":-2.1828353196337864},"rotation":{"radians":-0.20844906716898737}},"curvature":-0.25444950275517536},{"time":1.7465293983788375,"velocity":1.5571095293834698,"acceleration":-0.4315434543198954,"pose":{"translation":{"x":3.460191512539821,"y":-2.20255644409488},"rotation":{"radians":-0.23254958669717682}},"curvature":-0.28322989662345266},{"time":1.8052766919200531,"velocity":1.5317575193967488,"acceleration":-0.7181505128768769,"pose":{"translation":{"x":3.5481886275261187,"y":-2.2246624312655183},"rotation":{"radians":-0.2605290426566478}},"curvature":-0.3390007288142029},{"time":1.863828116003282,"velocity":1.4897087841617065,"acceleration":-1.1485060191274257,"pose":{"translation":{"x":3.6332783299675198,"y":-2.2488312483613786},"rotation":{"radians":-0.29438880619069663}},"curvature":-0.4356871419195546},{"time":1.9211741786130552,"velocity":1.4238464860811237,"acceleration":-1.7652213648993094,"pose":{"translation":{"x":3.7127204194610037,"y":-2.274676230851134},"rotation":{"radians":-0.33692663742466267}},"curvature":-0.5986078334816243},{"time":1.9767333704643142,"velocity":1.3257722136087418,"acceleration":-2.6706799109725865,"pose":{"translation":{"x":3.7841332212134295,"y":-2.3017800999276044},"rotation":{"radians":-0.39200447331439825}},"curvature":-0.8712085079289885},{"time":2.0307091535600454,"velocity":1.1816201740159586,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":3.8457610177857715,"y":-2.3297289799789076},"rotation":{"radians":-0.46451403242101924}},"curvature":-1.3152460103076868},{"time":2.057191337063941,"velocity":1.1101182785554404,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":3.872593850924541,"y":-2.3439002650396636},"rotation":{"radians":-0.5088065848198653}},"curvature":-1.6162789365948451},{"time":2.0832743347252545,"velocity":1.039694184869895,"acceleration":-2.609767951503138,"pose":{"translation":{"x":3.8967414808373615,"y":-2.358146416059611},"rotation":{"radians":-0.5588122912746324}},"curvature":-1.9601734246021711},{"time":2.1089606472593285,"velocity":0.9726588696261753,"acceleration":-1.8223462587625698,"pose":{"translation":{"x":3.9182795840488076,"y":-2.372431804141063},"rotation":{"radians":-0.6139749006861892}},"curvature":-2.307982893201558},{"time":2.1340741179200458,"velocity":0.926893430323074,"acceleration":-0.2945820842244929,"pose":{"translation":{"x":3.937373102870131,"y":-2.3867273913618816},"rotation":{"radians":-0.6724510171444433}},"curvature":-2.5743319672252363},{"time":2.158048364920909,"velocity":0.919831046673847,"acceleration":2.7000000000000237,"pose":{"translation":{"x":3.9542846026412684,"y":-2.401011793821448},"rotation":{"radians":-0.7304915868093712}},"curvature":-2.617794731975814},{"time":2.179924175344754,"velocity":0.9788957348182286,"acceleration":2.7000000000000095,"pose":{"translation":{"x":3.9693826289728493,"y":-2.4152723446866387},"rotation":{"radians":-0.7820573920788718}},"curvature":-2.2641964803184567},{"time":2.2178719747150444,"velocity":1.0813547931180127,"acceleration":0.018210451394749676,"pose":{"translation":{"x":3.996192488565364,"y":-2.443721187914704},"rotation":{"radians":-0.8331802867641575}},"curvature":2.0066829573627327E-13},{"time":2.2544396098186095,"velocity":1.0820207062596872,"acceleration":0.4170531541764355,"pose":{"translation":{"x":4.022340194299782,"y":-2.4734007558867477},"rotation":{"radians":-0.8756753410013142}},"curvature":-1.7627606275593122},{"time":2.2962786438711396,"velocity":1.0994698073789901,"acceleration":2.699999999999998,"pose":{"translation":{"x":4.050074099319709,"y":-2.509642309070984},"rotation":{"radians":-0.9586417211451482}},"curvature":-1.6858018623074158},{"time":2.3441010183755298,"velocity":1.2285902185408433,"acceleration":2.7000000000000015,"pose":{"translation":{"x":4.080139703179138,"y":-2.5564914140709254},"rotation":{"radians":-1.0367157953624235}},"curvature":-1.1412535340112555},{"time":2.39600153498458,"velocity":1.368721613385278,"acceleration":1.512467372158397,"pose":{"translation":{"x":4.112503515529674,"y":-2.615613886234474},"rotation":{"radians":-1.0987621233813893}},"curvature":-0.7449965695708815},{"time":2.4518483471307224,"velocity":1.4531880945953777,"acceleration":0.7491547508909007,"pose":{"translation":{"x":4.146505006905684,"y":-2.6866977656031756},"rotation":{"radians":-1.147640006618408}},"curvature":-0.5242027119344295},{"time":2.511613214469422,"velocity":1.497961228898529,"acceleration":0.24399331289513249,"pose":{"translation":{"x":4.181008559509457,"y":-2.767855292861475},"rotation":{"radians":-1.1883999745995548}},"curvature":-0.4162834404435219},{"time":2.5742697071073875,"velocity":1.5132489941116556,"acceleration":-0.16215241510233952,"pose":{"translation":{"x":4.214555417996354,"y":-2.8560248852859678},"rotation":{"radians":-1.2255076760538595}},"curvature":-0.3808969942986235},{"time":2.638227381207032,"velocity":1.50287810279207,"acceleration":-1.8591498889697078,"pose":{"translation":{"x":4.245515640259976,"y":-2.9473731126946543},"rotation":{"radians":-1.2629167514507849}},"curvature":-0.40482386174775564},{"time":2.7035418659753527,"velocity":1.3814486856869328,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":4.272240048217316,"y":-3.0376966733961916},"rotation":{"radians":-1.3048202108892462}},"curvature":-0.5000666612815092},{"time":2.771522573313932,"velocity":1.197900775872769,"acceleration":-2.7,"pose":{"translation":{"x":4.293212178593921,"y":-3.1228243701391483},"rotation":{"radians":-1.3567843335611025}},"curvature":-0.7161462605755893},{"time":2.8417506200636717,"velocity":1.008285049648472,"acceleration":-2.699999999999997,"pose":{"translation":{"x":4.307200233709043,"y":-3.1990190860612566},"rotation":{"radians":-1.4276368349578048}},"curvature":-1.1857315982835626},{"time":2.8771989990576055,"velocity":0.9125744263648515,"acceleration":-2.6999999999999975,"pose":{"translation":{"x":4.311305528655132,"y":-3.2328163448202067},"rotation":{"radians":-1.4745873491965407}},"curvature":-1.608174289097109},{"time":2.9126263537463464,"velocity":0.8169205687052514,"acceleration":-2.700000000000001,"pose":{"translation":{"x":4.313409032260809,"y":-3.263379760638665},"rotation":{"radians":-1.5328397625877912}},"curvature":-2.251655113897048},{"time":2.947938294627659,"velocity":0.7215783283257071,"acceleration":-2.6999999999999935,"pose":{"translation":{"x":4.313504497598228,"y":-3.2905432839332},"rotation":{"radians":-1.6061409773354187}},"curvature":-3.232805356880885},{"time":2.965568892780268,"velocity":0.6739757133136621,"acceleration":-2.7000000000000033,"pose":{"translation":{"x":4.312809789246676,"y":-3.302825879388385},"rotation":{"radians":-1.6498073845442498}},"curvature":-3.894586951820426},{"time":2.9832236220278814,"velocity":0.6263079443451067,"acceleration":-2.7,"pose":{"translation":{"x":4.3116319601113675,"y":-3.3142433656351926},"rotation":{"radians":-1.6989024114794935}},"curvature":-4.691977561202608},{"time":3.0009713029609912,"velocity":0.57838920582571,"acceleration":-2.699999999999997,"pose":{"translation":{"x":4.3099840252879495,"y":-3.324805875657332},"rotation":{"radians":-1.753901244092698}},"curvature":-5.630536365418882},{"time":3.018926950780991,"velocity":0.5299089567117109,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":4.307882486078064,"y":-3.334531518939241},"rotation":{"radians":-1.8150787332327767}},"curvature":-6.69529450581109},{"time":3.0372757119057283,"velocity":0.48036730167491926,"acceleration":-2.3599351230271615,"pose":{"translation":{"x":4.305347478378783,"y":-3.3434467740207223},"rotation":{"radians":-1.8823455085438583}},"curvature":-7.8362920175779305},{"time":3.0561731131028838,"velocity":0.43577066085581634,"acceleration":-1.631909354889731,"pose":{"translation":{"x":4.302402921072051,"y":-3.351586881051582},"rotation":{"radians":-1.955044832750056}},"curvature":-8.95411911647039},{"time":3.075510939989544,"velocity":0.40421308025623764,"acceleration":-0.87258261782898,"pose":{"translation":{"x":4.299076664414123,"y":-3.3589962343462663},"rotation":{"radians":-2.031748352973028}},"curvature":-9.894143807402033},{"time":3.094893408019119,"velocity":0.38730027556300467,"acceleration":0.0034955346799340962,"pose":{"translation":{"x":4.295400638424999,"y":-3.3657287749385025},"rotation":{"radians":-2.1101226812258003}},"curvature":-10.460984964402254},{"time":3.1137538058923764,"velocity":0.387366202737848,"acceleration":1.2223588438550386,"pose":{"translation":{"x":4.291411001277867,"y":-3.3718483831359323},"rotation":{"radians":-2.1869520729657745}},"curvature":-10.458679285400914},{"time":3.131392066560043,"velocity":0.4089264866551908,"acceleration":2.700000000000088,"pose":{"translation":{"x":4.28714828768854,"y":-3.377429271074753},"rotation":{"radians":-2.2583635099720683}},"curvature":-9.744526031726831},{"time":3.147231155588616,"velocity":0.45169202703233857,"acceleration":2.699999999999929,"pose":{"translation":{"x":4.282657557304897,"y":-3.3825563752743553},"rotation":{"radians":-2.32020879145545}},"curvature":-8.268373808836666},{"time":3.161406838698988,"velocity":0.4899663714303424,"acceleration":2.6999999999999575,"pose":{"translation":{"x":4.277988543096316,"y":-3.387325749191963},"rotation":{"radians":-2.368472220779638}},"curvature":-6.074530105134501},{"time":3.186477933841157,"velocity":0.5576583283141973,"acceleration":2.699999999999982,"pose":{"translation":{"x":4.268338852026009,"y":-3.3962334600270534},"rotation":{"radians":-2.4104955335193683}},"curvature":-9.26128511828502E-13},{"time":3.2299906808123295,"velocity":0.6751427451363629,"acceleration":2.700000000000038,"pose":{"translation":{"x":4.248083252367835,"y":-3.413814466108533},"rotation":{"radians":-2.4557450667204157}},"curvature":-2.822730222086065},{"time":3.2507071272861134,"velocity":0.7310771506155807,"acceleration":2.7000000000000335,"pose":{"translation":{"x":4.236614285209178,"y":-3.422793852989324},"rotation":{"radians":-2.4995717871792023}},"curvature":-3.0860714752970915},{"time":3.2715356112986553,"velocity":0.7873140574494447,"acceleration":2.6999999999999758,"pose":{"translation":{"x":4.223725851267683,"y":-3.431955505209811},"rotation":{"radians":-2.5471121086615596}},"curvature":-2.876252520897808},{"time":3.29276339709107,"velocity":0.8446290790889646,"acceleration":2.699999999999979,"pose":{"translation":{"x":4.2091495979269276,"y":-3.4413128136538207},"rotation":{"radians":-2.593492199646287}},"curvature":-2.4698911609046443},{"time":3.314515634529587,"velocity":0.9033601201729606,"acceleration":2.6999999999999904,"pose":{"translation":{"x":4.192708539860972,"y":-3.45085862866183},"rotation":{"radians":-2.636246163339205}},"curvature":-2.0387403875224983},{"time":3.359548048132816,"velocity":1.024947636901678,"acceleration":2.7000000000000193,"pose":{"translation":{"x":4.153935085930723,"y":-3.470397239101967},"rotation":{"radians":-2.7084561858013734}},"curvature":-1.3548673701773837},{"time":3.4059362633181554,"velocity":1.1501958179020948,"acceleration":2.7000000000000073,"pose":{"translation":{"x":4.107526767127105,"y":-3.4901841549377517},"rotation":{"radians":-2.765262060959203}},"curvature":-0.9452796511161875},{"time":3.452441642676205,"velocity":1.2757603421688286,"acceleration":0.916845081460815,"pose":{"translation":{"x":4.054578004186969,"y":-3.5096396748105803},"rotation":{"radians":-2.811637401216542}},"curvature":-0.7270863324747803},{"time":3.545614671546138,"velocity":1.361185575413033,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":3.9368363435951768,"y":-3.5446835091845688},"rotation":{"radians":-2.890983923414541}},"curvature":-0.6262683252341292},{"time":3.593081075697038,"velocity":1.2330262842056028,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":3.8768987018264482,"y":-3.558762402311281},"rotation":{"radians":-2.9316551777932482}},"curvature":-0.7122073311647261},{"time":3.6430826344673015,"velocity":1.098022075525892,"acceleration":-2.700000000000001,"pose":{"translation":{"x":3.819642394126128,"y":-3.569627185653569},"rotation":{"radians":-2.9785289882572688}},"curvature":-0.9259520734972607},{"time":3.694370601772548,"velocity":0.959544563801726,"acceleration":-2.700000000000002,"pose":{"translation":{"x":3.7673620549574998,"y":-3.576756525977875},"rotation":{"radians":-3.0374015418412488}},"curvature":-1.3647100045411313},{"time":3.7455922107098694,"velocity":0.8212462196709582,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":3.721859261187735,"y":-3.579844957066794},"rotation":{"radians":-3.116799406046911}},"curvature":-2.2395779225638517},{"time":3.7707971012552983,"velocity":0.7531930151982997,"acceleration":-2.700000000000001,"pose":{"translation":{"x":3.7020174790246,"y":-3.57985414983139},"rotation":{"radians":3.1153821326652626}},"curvature":-2.9505901608927894},{"time":3.795593509501531,"velocity":0.6862427129334712,"acceleration":-2.700000000000001,"pose":{"translation":{"x":3.6841981653074276,"y":-3.5788709441827864},"rotation":{"radians":3.0547230313180256}},"curvature":-3.9068933293045784},{"time":3.8199854151209767,"velocity":0.6203845677609675,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":3.668379025113782,"y":-3.576948179398597},"rotation":{"radians":2.983381929710971}},"curvature":-5.100658522586089},{"time":3.8441327490945087,"velocity":0.5551867660324308,"acceleration":-1.9335361617960969,"pose":{"translation":{"x":3.654461128650132,"y":-3.574164948531894},"rotation":{"radians":2.9020513849385043}},"curvature":-6.364298277790453},{"time":3.868003837153262,"velocity":0.5090311540494122,"acceleration":0.8499675815914516,"pose":{"translation":{"x":3.6422612747899645,"y":-3.5706287254256943},"rotation":{"radians":2.8150279374451848}},"curvature":-7.221227506824884},{"time":3.8902420950125562,"velocity":0.5279329523008836,"acceleration":2.700000000000041,"pose":{"translation":{"x":3.6315043546118915,"y":-3.5664774917274538},"rotation":{"radians":2.7322171892468674}},"curvature":-6.852178618883649},{"time":3.909596135621019,"velocity":0.5801888619437336,"acceleration":2.7000000000000566,"pose":{"translation":{"x":3.621815714937764,"y":-3.561881863903558},"rotation":{"radians":2.669430424511601}},"curvature":-4.457451503698926},{"time":3.9266809762503785,"velocity":0.6263179316430056,"acceleration":2.7000000000000384,"pose":{"translation":{"x":3.6127135218707784,"y":-3.557047220253813},"rotation":{"radians":2.6449369107050744}},"curvature":-1.1784056611468292E-12},{"time":3.9578147509123034,"velocity":0.7103791232302036,"acceleration":2.700000000000028,"pose":{"translation":{"x":3.5945284328917886,"y":-3.5469336529236215},"rotation":{"radians":2.614103321725111}},"curvature":-2.5913645169358},{"time":3.987918524421208,"velocity":0.7916593117042466,"acceleration":2.7,"pose":{"translation":{"x":3.5753791478336905,"y":-3.5349149293738504},"rotation":{"radians":2.546211648839168}},"curvature":-3.1243502723586385},{"time":4.018660607902018,"velocity":0.8746629371024335,"acceleration":2.6999999999999695,"pose":{"translation":{"x":3.5547392846052848,"y":-3.519748275480184},"rotation":{"radians":2.4717464484786467}},"curvature":-2.625336493170504},{"time":4.050491143762827,"velocity":0.9606053839266164,"acceleration":2.700000000000034,"pose":{"translation":{"x":3.5324917969550405,"y":-3.5008220361712037},"rotation":{"radians":2.4047199470675267}},"curvature":-1.9921789882789365},{"time":4.083156509074266,"velocity":1.048801870267503,"acceleration":2.7000000000000215,"pose":{"translation":{"x":3.5088538671092167,"y":-3.4780550478722834},"rotation":{"radians":2.347798213566307}},"curvature":-1.516093633291293},{"time":4.116040959785374,"velocity":1.1375898871874948,"acceleration":2.0756027443537044,"pose":{"translation":{"x":3.484301798409985,"y":-3.4517960109494705},"rotation":{"radians":2.2992076648955164}},"curvature":-1.2174493015708048},{"time":4.180444019801748,"velocity":1.2712650553022575,"acceleration":-2.7,"pose":{"translation":{"x":3.4352054192283012,"y":-3.391742147063071},"rotation":{"radians":2.2156675238997945}},"curvature":-1.0125128621314547},{"time":4.245684972127055,"velocity":1.0951144840239295,"acceleration":-2.6999999999999957,"pose":{"translation":{"x":3.3913414287143713,"y":-3.3282234791216294},"rotation":{"radians":2.131802001330838}},"curvature":-1.2401281046470396},{"time":4.279501863856673,"velocity":1.003808876353962,"acceleration":-2.7,"pose":{"translation":{"x":3.373174939606379,"y":-3.2977360135658547},"rotation":{"radians":2.0826338207263717}},"curvature":-1.564459892524469},{"time":4.313093552481865,"velocity":0.9131113170659451,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":3.358187662867177,"y":-3.269240701194355},"rotation":{"radians":2.0245367443093847}},"curvature":-2.09080955049009},{"time":4.345829775287926,"velocity":0.8247235154895821,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":3.3465667435178257,"y":-3.2432777183867474},"rotation":{"radians":1.9553194001718952}},"curvature":-2.814096068879947},{"time":4.377464263373538,"velocity":0.7393103976584291,"acceleration":-2.699999999999999,"pose":{"translation":{"x":3.338157588800294,"y":-3.220012085014421},"rotation":{"radians":1.8773169199086854}},"curvature":-3.428693889552534},{"time":4.408525399392649,"velocity":0.6554453304068287,"acceleration":-2.7,"pose":{"translation":{"x":3.3323887608155904,"y":-3.1991330368844215},"rotation":{"radians":1.8051812484759904}},"curvature":-2.902561294762815},{"time":4.440940479940097,"velocity":0.5679246129287183,"acceleration":-2.700000000000004,"pose":{"translation":{"x":3.328196869161883,"y":-3.179753398183342},"rotation":{"radians":1.772113490984512}},"curvature":8.114431487581289E-13},{"time":4.458985985641666,"velocity":0.5192017475344809,"acceleration":-2.699999999999998,"pose":{"translation":{"x":3.326329043768648,"y":-3.170124005295184},"rotation":{"radians":1.7437776736904074}},"curvature":-5.407707531045379},{"time":4.479757380152356,"velocity":0.4631189823556181,"acceleration":-1.3913145723220113,"pose":{"translation":{"x":3.3249125241250725,"y":-3.16002073726456},"rotation":{"radians":1.6715993348543001}},"curvature":-8.243095512210855},{"time":4.491562193592042,"velocity":0.44669477339343966,"acceleration":0.3398641135979788,"pose":{"translation":{"x":3.32449324461731,"y":-3.1546670394610734},"rotation":{"radians":1.6259360622813377}},"curvature":-8.659662567034076},{"time":4.504067546571058,"velocity":0.4509448940988827,"acceleration":1.5355071376935812,"pose":{"translation":{"x":3.3243202197924915,"y":-3.149057056624422},"rotation":{"radians":1.5774286665114827}},"curvature":-8.548956650790494},{"time":4.516875539063179,"velocity":0.47061165799005983,"acceleration":2.5083622558306096,"pose":{"translation":{"x":3.3244275464167097,"y":-3.143156387919769},"rotation":{"radians":1.5282718021173034}},"curvature":-8.062716676418983},{"time":4.529685937053911,"velocity":0.5027447767921798,"acceleration":2.7000000000001774,"pose":{"translation":{"x":3.324844649699657,"y":-3.1369358144301955},"rotation":{"radians":1.4801599930557383}},"curvature":-7.350115487966588},{"time":4.542395297509923,"velocity":0.5370600500234172,"acceleration":2.7000000000000033,"pose":{"translation":{"x":3.3255964597236933,"y":-3.1303710967243306},"rotation":{"radians":1.4342796435586527}},"curvature":-6.535376389860048},{"time":4.5550564747658555,"velocity":0.5712452286144347,"acceleration":2.70000000000007,"pose":{"translation":{"x":3.3267035878729128,"y":-3.123442772423985},"rotation":{"radians":1.391365534235996}},"curvature":-5.7085019699393},{"time":4.580440540612485,"velocity":0.6397822064003362,"acceleration":2.6999999999999997,"pose":{"translation":{"x":3.330045709166361,"y":-3.1084401251987877},"rotation":{"radians":1.3156643464805708}},"curvature":-4.219115072308735},{"time":4.6060812116489105,"velocity":0.7090120181986865,"acceleration":2.7000000000000046,"pose":{"translation":{"x":3.334956234992028,"y":-3.0918600223627006},"rotation":{"radians":1.253369335391424}},"curvature":-3.064456133460656},{"time":4.632010964479643,"velocity":0.7790223508416656,"acceleration":2.700000000000006,"pose":{"translation":{"x":3.3414625790500367,"y":-3.073698090703135},"rotation":{"radians":1.2029071575738641}},"curvature":-2.228320124409277},{"time":4.6843414098702505,"velocity":0.9203145533963059,"acceleration":2.7,"pose":{"translation":{"x":3.3591172124850344,"y":-3.0328897669450328},"rotation":{"radians":1.1294013249275023}},"curvature":-1.222474947316091},{"time":4.736244764956574,"velocity":1.0604536121293775,"acceleration":2.618404628350088,"pose":{"translation":{"x":3.382287302580564,"y":-2.987003554050009},"rotation":{"radians":1.081297936444653}},"curvature":-0.71371661951111},{"time":4.833489341421855,"velocity":1.3150792612280156,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":3.4396473052565435,"y":-2.886749037498398},"rotation":{"radians":1.0292773203250978}},"curvature":-0.26510829196024693},{"time":4.930273656547842,"velocity":1.0537616103878507,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":3.499744139332678,"y":-2.789131576207195},"rotation":{"radians":1.013522278728187}},"curvature":-0.002271320612067236},{"time":5.031580680686861,"velocity":0.7802326452125006,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":3.548433652044705,"y":-2.710015103618188},"rotation":{"radians":1.033187414021597}},"curvature":0.5880086167651827},{"time":5.078960801609538,"velocity":0.6523063187212699,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":3.56540881043646,"y":-2.6806287201678507},"rotation":{"radians":1.0658417817084862}},"curvature":1.5153932142704185},{"time":5.121236436765688,"velocity":0.5381621037996654,"acceleration":-2.699999999999996,"pose":{"translation":{"x":3.5770072133010276,"y":-2.658297147607646},"rotation":{"radians":1.1269135041680542}},"curvature":3.765600053666733},{"time":5.14007171373654,"velocity":0.487306855978367,"acceleration":-2.7,"pose":{"translation":{"x":3.580972375940913,"y":-2.649491200009923},"rotation":{"radians":1.171345195879143}},"curvature":5.5241277068967},{"time":5.157534371540127,"velocity":0.4401576799086824,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":3.58393806496272,"y":-2.641955799639864},"rotation":{"radians":1.2222379006966406}},"curvature":6.8746961751408975},{"time":5.19125332262472,"velocity":0.3491165119802786,"acceleration":-2.699999999999999,"pose":{"translation":{"x":3.587972943374347,"y":-2.6292755266378984},"rotation":{"radians":1.2882413743252545}},"curvature":-1.1457952261038979E-12},{"time":5.210640226554217,"velocity":0.29677187137063793,"acceleration":-2.700000000000003,"pose":{"translation":{"x":3.589797964663591,"y":-2.6232865353976917},"rotation":{"radians":1.249328413748904}},"curvature":-11.885254966404938},{"time":5.2219140872957395,"velocity":0.26633244736852624,"acceleration":-2.699999999999997,"pose":{"translation":{"x":3.590865119680631,"y":-2.620297121106866},"rotation":{"radians":1.204124717985767}},"curvature":-16.387587851460477},{"time":5.234908223063078,"velocity":0.23124828079671267,"acceleration":-1.1267696311103768,"pose":{"translation":{"x":3.592109411800221,"y":-2.6173133592339686},"rotation":{"radians":1.1455477945660035}},"curvature":-19.603104952437373},{"time":5.249807572204852,"velocity":0.2144601466604512,"acceleration":-0.1855939098830954,"pose":{"translation":{"x":3.5935804970935785,"y":-2.614336641312019},"rotation":{"radians":1.0770738785517477}},"curvature":-21.37926145599252},{"time":5.265972127151756,"velocity":0.21146010370633506,"acceleration":0.46457883652771476,"pose":{"translation":{"x":3.595323501500487,"y":-2.611368124466453},"rotation":{"radians":1.0024684488122808}},"curvature":-21.726362839385768},{"time":5.282704614772193,"velocity":0.21923366333725203,"acceleration":1.042650151696542,"pose":{"translation":{"x":3.597379162099422,"y":-2.608408740819333},"rotation":{"radians":0.9254396397901249}},"curvature":-20.846554318397615},{"time":5.299400552186885,"velocity":0.23664168501539617,"acceleration":1.649909827489576,"pose":{"translation":{"x":3.5997839683776816,"y":-2.605459206893553},"rotation":{"radians":0.8492530627490443}},"curvature":-19.085978063915036},{"time":5.315600142086058,"velocity":0.2633695475913437,"acceleration":2.3390472220236567,"pose":{"translation":{"x":3.6025703035015137,"y":-2.6025200330170484},"rotation":{"radians":0.7764431136127097}},"curvature":-16.835828768934302},{"time":5.331006011259913,"velocity":0.2994046030853096,"acceleration":2.7000000000000823,"pose":{"translation":{"x":3.6057665855862453,"y":-2.599591532727001},"rotation":{"radians":0.7087024075586872}},"curvature":-14.438072276022115},{"time":5.345602492410351,"velocity":0.33881510219149336,"acceleration":2.6999999999997653,"pose":{"translation":{"x":3.6093974089664087,"y":-2.596673832174048},"rotation":{"radians":0.6469417685785392}},"curvature":-12.134712058956364},{"time":5.359620466245247,"velocity":0.37666363154570903,"acceleration":2.6999999999999282,"pose":{"translation":{"x":3.6134836854658734,"y":-2.5937668795264908},"rotation":{"radians":0.5914536038370002}},"curvature":-10.063273260012005},{"time":5.373290692592425,"velocity":0.4135732426830877,"acceleration":2.699999999999861,"pose":{"translation":{"x":3.61804278566797,"y":-2.5908704543745},"rotation":{"radians":0.542103916214172}},"curvature":-8.279270953044453},{"time":5.386754650799271,"velocity":0.4499259298415706,"acceleration":2.7000000000000606,"pose":{"translation":{"x":3.623088680185623,"y":-2.5879841771343255},"rotation":{"radians":0.49850294385014454}},"curvature":-6.785499607041185},{"time":5.413381326234972,"velocity":0.5218179535179637,"acceleration":2.69999999999997,"pose":{"translation":{"x":3.6346805823880195,"y":-2.582239808610058},"rotation":{"radians":0.42643920058463547}},"curvature":-4.556285254859114},{"time":5.439881904279952,"velocity":0.5933695142394086,"acceleration":2.700000000000056,"pose":{"translation":{"x":3.6483085258331625,"y":-2.576527911165134},"rotation":{"radians":0.37092646399792006}},"curvature":-3.090633433665522},{"time":5.466375443097052,"velocity":0.6649020690455805,"acceleration":2.7000000000000064,"pose":{"translation":{"x":3.6639762860428338,"y":-2.570840677097534},"rotation":{"radians":0.3281277713660724}},"curvature":-2.1291503392765283},{"time":5.519283013541141,"velocity":0.8077525092446217,"acceleration":2.6999999999999984,"pose":{"translation":{"x":3.7012466915159363,"y":-2.5595010493267667},"rotation":{"radians":0.2694067356549212}},"curvature":-1.0558504345290696},{"time":5.622647517932981,"velocity":1.0868366711025883,"acceleration":2.6999999999999935,"pose":{"translation":{"x":3.796454492862498,"y":-2.5366287487361685},"rotation":{"radians":0.21446642664454996}},"curvature":-0.2591584346924106},{"time":5.718294124851764,"velocity":1.3450825097833023,"acceleration":2.6999999999999984,"pose":{"translation":{"x":3.910293614084513,"y":-2.512818985758105},"rotation":{"radians":0.20330839714865373}},"curvature":0.026904037653727994},{"time":5.802457783425082,"velocity":1.5723243879312607,"acceleration":-0.0054267838800895925,"pose":{"translation":{"x":4.030400252959785,"y":-2.487386255613993},"rotation":{"radians":0.2173568451409832}},"curvature":0.19012578901542646},{"time":5.8784387004517145,"velocity":1.5719120559155462,"acceleration":-1.0771240949619354,"pose":{"translation":{"x":4.146686316952366,"y":-2.4600716269010454},"rotation":{"radians":0.24536891513253703}},"curvature":0.25149826879101655},{"time":5.952184730278954,"velocity":1.4924784302808451,"acceleration":-2.699999999999999,"pose":{"translation":{"x":4.255968562777806,"y":-2.4313508986664956},"rotation":{"radians":0.26396888904080656}},"curvature":-1.9902664551003634E-14},{"time":5.992511639969563,"velocity":1.3835957741161997,"acceleration":1.3863211448600001,"pose":{"translation":{"x":4.312099673337394,"y":-2.416779584007891},"rotation":{"radians":0.2371845225743331}},"curvature":-0.7058103753978102},{"time":6.0422464148733726,"velocity":1.4525441442002032,"acceleration":1.8363092413492652,"pose":{"translation":{"x":4.381028610178082,"y":-2.4018492646283462},"rotation":{"radians":0.19179767151743823}},"curvature":-0.5258033942768282},{"time":6.102632250834608,"velocity":1.56343121282242,"acceleration":0.9845956542624781,"pose":{"translation":{"x":4.470739860555917,"y":-2.386228289398962},"rotation":{"radians":0.15687804165798624}},"curvature":-0.26960482747366976},{"time":6.174635306910405,"velocity":1.6343251089282673,"acceleration":0.5554040214528627,"pose":{"translation":{"x":4.584659465079119,"y":-2.3696184940666076},"rotation":{"radians":0.13543634360257478}},"curvature":-0.12402690259009637},{"time":6.215124514599027,"velocity":1.656812977703968,"acceleration":0.38784059564341195,"pose":{"translation":{"x":4.650709041008162,"y":-2.360859756244573},"rotation":{"radians":0.12872427251946308}},"curvature":-0.08045161432533929},{"time":6.258531639366124,"velocity":1.6736480228288069,"acceleration":0.2815511037607428,"pose":{"translation":{"x":4.7224167332255504,"y":-2.3517592125068147},"rotation":{"radians":0.12413175892958923}},"curvature":-0.04859639647324628},{"time":6.304618553754269,"velocity":1.6866238444437158,"acceleration":0.2161381331819582,"pose":{"translation":{"x":4.7992679351289835,"y":-2.342290796766555},"rotation":{"radians":0.1213520611411324}},"curvature":-0.02447755666758579},{"time":6.353046637009598,"velocity":1.697090999952103,"acceleration":-0.061527826533656224,"pose":{"translation":{"x":4.880605958860198,"y":-2.332431287976671},"rotation":{"radians":0.12016522126241555}},"curvature":-0.005290461860802775},{"time":6.403572117424254,"velocity":1.6939822769576205,"acceleration":-0.1539413895427487,"pose":{"translation":{"x":4.965655838914891,"y":-2.3221604354813445},"rotation":{"radians":0.12042784463858867}},"curvature":0.010964234702597529},{"time":6.455964882894244,"velocity":1.6859168618391829,"acceleration":-0.14632230604021826,"pose":{"translation":{"x":5.053548135752637,"y":-2.311461084367716},"rotation":{"radians":0.12206347077674182}},"curvature":0.0257820992178541},{"time":6.509760495223101,"velocity":1.678045363788379,"acceleration":-0.15146922876924415,"pose":{"translation":{"x":5.143342739406809,"y":-2.300319300817539},"rotation":{"radians":0.1250559828274568}},"curvature":0.040381043526972596},{"time":6.564391919783912,"velocity":1.6697703840435878,"acceleration":-0.1690069650261506,"pose":{"translation":{"x":5.234052673094503,"y":-2.288724497458831},"rotation":{"radians":0.12944677363307489}},"curvature":0.05587671497092022},{"time":6.619290635671001,"velocity":1.660492118687678,"acceleration":-0.20066082266456248,"pose":{"translation":{"x":5.324667896826456,"y":-2.2766695587175287},"rotation":{"radians":0.13533587929334218}},"curvature":0.07343479918550559},{"time":6.673901911773253,"velocity":1.6495337750982384,"acceleration":-0.2503779699042536,"pose":{"translation":{"x":5.414179111016967,"y":-2.2641509661691384},"rotation":{"radians":0.14288727538981635}},"curvature":0.09442665300455738},{"time":6.727701013462522,"velocity":1.6360636652346068,"acceleration":-0.32483580325232614,"pose":{"translation":{"x":5.501601560093819,"y":-2.25116892389039},"rotation":{"radians":0.15233868074257573}},"curvature":0.12061533469209994},{"time":6.780210441052683,"velocity":1.6190067231450371,"acceleration":-0.4342176678991667,"pose":{"translation":{"x":5.585998836108203,"y":-2.2377274838108905},"rotation":{"radians":0.16401633812638913}},"curvature":0.15440284835059329},{"time":6.831018265689578,"velocity":1.5969450680201744,"acceleration":-0.5928996306042885,"pose":{"translation":{"x":5.666506682344631,"y":-2.2238346710647763},"rotation":{"radians":0.17835511139431867}},"curvature":0.19917452646623718},{"time":6.879797434759459,"velocity":1.568023916697458,"acceleration":-0.8189774235406614,"pose":{"translation":{"x":5.742356796930863,"y":-2.2095026093423673},"rotation":{"radians":0.19592338889935415}},"curvature":0.25977511318696095},{"time":6.92632534621687,"velocity":1.5299186076493398,"acceleration":-1.129976194069788,"pose":{"translation":{"x":5.812900636447829,"y":-2.194747646241817},"rotation":{"radians":0.21744966428369158}},"curvature":0.34311797134755584},{"time":6.970501572526865,"velocity":1.4800005235752056,"acceleration":-1.743085506178466,"pose":{"translation":{"x":5.877633219539545,"y":-2.179590478620769},"rotation":{"radians":0.24384096454853804}},"curvature":0.4587908712801557},{"time":7.0523050594057946,"velocity":1.3374100512416822,"acceleration":-2.3560163094836173,"pose":{"translation":{"x":5.988505322998268,"y":-2.14817481565511},"rotation":{"radians":0.31555718995445137}},"curvature":0.8367701282634015},{"time":7.090068636440995,"velocity":1.2484384478423094,"acceleration":-2.4190292751281097,"pose":{"translation":{"x":6.034566923458042,"y":-2.131980588488104},"rotation":{"radians":0.36287638693814367}},"curvature":1.116361400694301},{"time":7.126079286054143,"velocity":1.1613276322117225,"acceleration":-1.8018218311275263,"pose":{"translation":{"x":6.074709034897941,"y":-2.1155129438591147},"rotation":{"radians":0.4180081175283741}},"curvature":1.4316106758066602},{"time":7.160213617512388,"velocity":1.0998236485993147,"acceleration":0.11655105252333868,"pose":{"translation":{"x":6.1095015404262405,"y":-2.0988162051980206},"rotation":{"radians":0.4785133975098883}},"curvature":1.6842665173253355},{"time":7.191695399984404,"velocity":1.103492883481739,"acceleration":2.7000000000000206,"pose":{"translation":{"x":6.139800706873832,"y":-2.0819397973041074},"rotation":{"radians":0.5378251662621004}},"curvature":1.6684034621679094},{"time":7.244685477446198,"velocity":1.2465660926285824,"acceleration":2.699999999999984,"pose":{"translation":{"x":6.191918830123046,"y":-2.0478719319719114},"rotation":{"radians":0.6026463351683073}},"curvature":-6.297627033637872E-15},{"time":7.3370317217556975,"velocity":1.4959009522642295,"acceleration":2.110255795164596,"pose":{"translation":{"x":6.295821437813171,"y":-1.9754912312828774},"rotation":{"radians":0.6183055792464454}},"curvature":0.19313058869351735},{"time":7.383852876377318,"velocity":1.5947055651408029,"acceleration":0.008610218892512537,"pose":{"translation":{"x":6.354475457986172,"y":-1.933127973984864},"rotation":{"radians":0.6328291174151472}},"curvature":0.20378860571092494},{"time":7.433896489772388,"velocity":1.5951364516063067,"acceleration":-0.05307302720749919,"pose":{"translation":{"x":6.418449889444145,"y":-1.885401631433069},"rotation":{"radians":0.6490561533622994}},"curvature":0.20289983770047346},{"time":7.488116231200804,"velocity":1.5922588457942928,"acceleration":-0.1841211212752262,"pose":{"translation":{"x":6.486825890689869,"y":-1.832568035566053},"rotation":{"radians":0.6667611744291694}},"curvature":0.20884445229440146},{"time":7.545444641511472,"velocity":1.5817034746069663,"acceleration":-0.3775053102148016,"pose":{"translation":{"x":6.557767243486634,"y":-1.7756073263587107},"rotation":{"radians":0.6866164359659935}},"curvature":0.23083513348497586},{"time":7.60447035020614,"velocity":1.5594209561355372,"acceleration":-2.333312788172267,"pose":{"translation":{"x":6.62879440010665,"y":-1.71603308025112},"rotation":{"radians":0.7099679837622039}},"curvature":0.2782352873649396},{"time":7.665696368797538,"velocity":1.416561503987355,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":6.697058530579465,"y":-1.6557014385773874},"rotation":{"radians":0.7389701133076884}},"curvature":0.3683194444230205},{"time":7.730433432613058,"velocity":1.2417714316854516,"acceleration":-2.700000000000001,"pose":{"translation":{"x":6.75961556994037,"y":-1.5966202359944957},"rotation":{"radians":0.7771077842133685}},"curvature":0.5387419179508882},{"time":7.798014282951074,"velocity":1.0593031357728062,"acceleration":-2.699999999999998,"pose":{"translation":{"x":6.8137002654788175,"y":-1.54075812891115},"rotation":{"radians":0.8303469016272262}},"curvature":0.8780826432583752},{"time":7.867202945784941,"velocity":0.8724937461213674,"acceleration":-2.6999999999999975,"pose":{"translation":{"x":6.857000223986832,"y":-1.4898537239166263},"rotation":{"radians":0.9095345455713776}},"curvature":1.610687193213286},{"time":7.902061270193409,"velocity":0.778376270218504,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":6.874074574062206,"y":-1.4666940977136076},"rotation":{"radians":0.9646860526587712}},"curvature":2.283286632442649},{"time":7.9370066097300995,"velocity":0.6840238534694393,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":6.887929959007418,"y":-1.445224706209617},"rotation":{"radians":1.035113680480484}},"curvature":3.32628975279076},{"time":7.954543809041497,"velocity":0.6366734153286657,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":6.893635137822238,"y":-1.4351468715805251},"rotation":{"radians":1.0776088422551275}},"curvature":4.046153464173535},{"time":7.972172933654512,"velocity":0.5890747788735252,"acceleration":-2.7000000000000037,"pose":{"translation":{"x":6.898526733071877,"y":-1.4255131762200706},"rotation":{"radians":1.1259117927999653}},"curvature":4.935254633091203},{"time":7.989970188917209,"velocity":0.5410221896642463,"acceleration":-2.6999999999999966,"pose":{"translation":{"x":6.9026123071276375,"y":-1.4163241883598472},"rotation":{"radians":1.180758936596042}},"curvature":6.018423639414055},{"time":8.008062420426597,"velocity":0.49217316458889554,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":6.90590493808298,"y":-1.4075769680270784},"rotation":{"radians":1.2428105527234092}},"curvature":7.3075007569029315},{"time":8.026657654240104,"velocity":0.4419660332924297,"acceleration":-2.6979835845035725,"pose":{"translation":{"x":6.908423487377785,"y":-1.3992648806466015},"rotation":{"radians":1.3125115964011242}},"curvature":8.78533776900184},{"time":8.046101447436167,"velocity":0.38950699842897285,"acceleration":-1.9998601376901606,"pose":{"translation":{"x":6.910192867422626,"y":-1.391377410642847},"rotation":{"radians":1.3898890929985133}},"curvature":10.3842331527912},{"time":8.06656221420109,"velocity":0.3485883265892269,"acceleration":-1.5045523130271372,"pose":{"translation":{"x":6.911244309223024,"y":-1.3838999750418182},"rotation":{"radians":1.4743005915121488}},"curvature":11.965471489473252},{"time":8.077132606781669,"velocity":0.33268461798251203,"acceleration":-1.1925197210496854,"pose":{"translation":{"x":6.911512356572252,"y":-1.380309304912309},"rotation":{"radians":1.5186985981640586}},"curvature":12.685014502171883},{"time":8.087850216024774,"velocity":0.3199036575976044,"acceleration":-0.888295973141262,"pose":{"translation":{"x":6.911615630003727,"y":-1.3768137370730782},"rotation":{"radians":1.5641907447223253}},"curvature":13.315123197844207},{"time":8.098652849056439,"velocity":0.3103077221762549,"acceleration":-0.5855601456254582,"pose":{"translation":{"x":6.911559929674402,"y":-1.3734102216912012},"rotation":{"radians":1.6104182435204006}},"curvature":13.822323424328498},{"time":8.109466582675374,"velocity":0.303975630743596,"acceleration":-0.27502416226771687,"pose":{"translation":{"x":6.911351500832964,"y":-1.3700954197717248},"rotation":{"radians":1.6569608828283373}},"curvature":14.174548066642172},{"time":8.120207507411724,"velocity":0.30102161691600093,"acceleration":0.05649006836589489,"pose":{"translation":{"x":6.910997042183094,"y":-1.3668656973327256},"rotation":{"radians":1.7033467573725736}},"curvature":14.343935030075372},{"time":8.130784261816677,"velocity":0.301619098495426,"acceleration":0.4277650743531514,"pose":{"translation":{"x":6.910503714246722,"y":-1.3637171195803757},"rotation":{"radians":1.749066137871914}},"curvature":14.309406991374466},{"time":8.141101125493467,"velocity":0.3060322924532195,"acceleration":0.8663164027646818,"pose":{"translation":{"x":6.909879147727288,"y":-1.3606454450840013},"rotation":{"radians":1.7935882407510315}},"curvature":14.058547329264746},{"time":8.151061331236367,"velocity":0.3146609820632045,"acceleration":1.7751063230474873,"pose":{"translation":{"x":6.909131451873002,"y":-1.357646119951148},"rotation":{"radians":1.8363791031499799}},"curvature":13.58839498194479},{"time":8.169440937869815,"velocity":0.34728673801336474,"acceleration":2.699999999999855,"pose":{"translation":{"x":6.90730155205609,"y":-1.351844704947641},"rotation":{"radians":1.9147142606524616}},"curvature":12.021884152388358},{"time":8.185685671029066,"velocity":0.39114751754334165,"acceleration":2.700000000000026,"pose":{"translation":{"x":6.905088777480826,"y":-1.3462699728469163},"rotation":{"radians":1.9803002629802633}},"curvature":9.733406427224596},{"time":8.200179081794415,"velocity":0.4302797266097843,"acceleration":2.700000000000133,"pose":{"translation":{"x":6.902576082796862,"y":-1.340873649741479},"rotation":{"radians":2.0300179349033822}},"curvature":6.886714495975598},{"time":8.225694971549238,"velocity":0.4991726289478118,"acceleration":2.699999999999937,"pose":{"translation":{"x":6.897025317271133,"y":-1.330395155575597},"rotation":{"radians":2.0722438037811575}},"curvature":4.843367108917548E-13},{"time":8.269498387508156,"velocity":0.6174418520368844,"acceleration":2.289702479893139,"pose":{"translation":{"x":6.8847247107762,"y":-1.309257996665874},"rotation":{"radians":2.1425617183197243}},"curvature":4.660619962454478},{"time":8.290647000959309,"velocity":0.6658658847022906,"acceleration":2.699999999999857,"pose":{"translation":{"x":6.8770137794199275,"y":-1.2980915795937735},"rotation":{"radians":2.2079983977941424}},"curvature":4.793415662408421},{"time":8.312309485268734,"velocity":0.7243545923377375,"acceleration":2.7000000000000113,"pose":{"translation":{"x":6.867640135216695,"y":-1.2863071586940826},"rotation":{"radians":2.275859423823148}},"curvature":4.157088701726884},{"time":8.33469888555881,"velocity":0.7848059731209415,"acceleration":2.699999999999875,"pose":{"translation":{"x":6.856276339435392,"y":-1.2738054926196953},"rotation":{"radians":2.338854626348398}},"curvature":3.312750852917663},{"time":8.357962075795285,"velocity":0.8476165867594208,"acceleration":2.7000000000000277,"pose":{"translation":{"x":6.842696500222847,"y":-1.260534475576318},"rotation":{"radians":2.394106787239032}},"curvature":2.5452064761410735},{"time":8.38209236093282,"velocity":0.912768356630764,"acceleration":2.700000000000017,"pose":{"translation":{"x":6.826768040435651,"y":-1.2464848551398355},"rotation":{"radians":2.4413288391266077}},"curvature":1.9401146181087425},{"time":8.406981337409094,"velocity":0.9799685931167065,"acceleration":2.700000000000007,"pose":{"translation":{"x":6.8084434654719646,"y":-1.2316859500736776},"rotation":{"radians":2.4813905937826033}},"curvature":1.4925112850252384},{"time":8.45831796069054,"velocity":1.1185774759766112,"acceleration":2.700000000000011,"pose":{"translation":{"x":6.764792011306529,"y":-1.200124723947971},"rotation":{"radians":2.54489077325647}},"curvature":0.9417339612005049},{"time":8.510347536956022,"velocity":1.2590573318934124,"acceleration":2.7000000000000277,"pose":{"translation":{"x":6.712751009352268,"y":-1.1666940481174286},"rotation":{"radians":2.5934822859158464}},"curvature":0.6669487813981273},{"time":8.561399155040986,"velocity":1.3968967007228166,"acceleration":1.3141247990066374,"pose":{"translation":{"x":6.654163793136235,"y":-1.1325802528124091},"rotation":{"radians":2.6337103618941016}},"curvature":0.5393947863283485},{"time":8.611106933863995,"velocity":1.4622189255776705,"acceleration":-0.2947712879926896,"pose":{"translation":{"x":6.591444728704884,"y":-1.0991757177311086},"rotation":{"radians":2.6702540300622024}},"curvature":0.501903095473378},{"time":8.660131729840813,"velocity":1.4477678233240052,"acceleration":-2.6046123151095357,"pose":{"translation":{"x":6.527315785242143,"y":-1.0679418421952696},"rotation":{"radians":2.7068887376848583}},"curvature":0.5377204548374263},{"time":8.709728011922769,"velocity":1.3185887362296957,"acceleration":-2.7,"pose":{"translation":{"x":6.464543105687493,"y":-1.0402720153058884},"rotation":{"radians":2.7473326056496448}},"curvature":0.6595803185773276},{"time":8.760250953862537,"velocity":1.1821767929923208,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":6.4056735773540465,"y":-1.0173545860989253},"rotation":{"radians":2.79603323449013}},"curvature":0.9153225598008626},{"time":8.810185110121887,"velocity":1.0473545710920762,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":6.352771402546618,"y":-1.0000358337010111},"rotation":{"radians":2.8589031248787657}},"curvature":1.406565563088564},{"time":8.858016937314229,"velocity":0.9182086376727548,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.307154669179806,"y":-0.9886829374851575},"rotation":{"radians":2.943276946232646}},"curvature":2.28546904500588},{"time":8.880820414169534,"velocity":0.856639250163429,"acceleration":-2.700000000000002,"pose":{"translation":{"x":6.28722140153191,"y":-0.9851937029724452},"rotation":{"radians":2.9953478229252575}},"curvature":2.8835279932048263},{"time":8.902850210483535,"velocity":0.7971588001156243,"acceleration":-2.1306964578046452,"pose":{"translation":{"x":6.269131921396065,"y":-0.983046947226464},"rotation":{"radians":3.0534643388064344}},"curvature":3.4955982582381395},{"time":8.9240699549367,"velocity":0.7519459657737457,"acceleration":1.272819582064318,"pose":{"translation":{"x":6.252723836692711,"y":-0.9820927997605986},"rotation":{"radians":3.1146581508866453}},"curvature":3.8913603256295892},{"time":8.943673196851227,"velocity":0.7768973559545002,"acceleration":2.699999999999969,"pose":{"translation":{"x":6.237738730183786,"y":-0.982125753257828},"rotation":{"radians":-3.110790908072076}},"curvature":3.667256958556559},{"time":8.976930504687711,"velocity":0.8666920871130055,"acceleration":2.6999999999999695,"pose":{"translation":{"x":6.210474263995367,"y":-0.9840270566256517},"rotation":{"radians":-3.0499802836707692}},"curvature":-5.867351177061296E-14},{"time":9.006585103722403,"velocity":0.9467595045066713,"acceleration":-1.592829372572771,"pose":{"translation":{"x":6.183726210736496,"y":-0.9867725828344351},"rotation":{"radians":-3.0193767328550463}},"curvature":2.0533292776367946},{"time":9.037560761088976,"velocity":0.8974205676184431,"acceleration":0.9284474101834387,"pose":{"translation":{"x":6.155512931678617,"y":-0.9912243732317005},"rotation":{"radians":-2.947511219002233}},"curvature":2.760240964943554},{"time":9.072058794087356,"velocity":0.9294501770122124,"acceleration":2.4684280678924915,"pose":{"translation":{"x":6.124884046596015,"y":-0.998631135267123},"rotation":{"radians":-2.86227062047093}},"curvature":2.558760279170406},{"time":9.108310163198574,"velocity":1.0189340740258748,"acceleration":2.6999999999999473,"pose":{"translation":{"x":6.091379308503554,"y":-1.0097952804139558},"rotation":{"radians":-2.7805842704336845}},"curvature":2.062994437682583},{"time":9.14528964793048,"velocity":1.1187786828020225,"acceleration":2.493835533596143,"pose":{"translation":{"x":6.054949935533344,"y":-1.0251310666815385},"rotation":{"radians":-2.708781254030456}},"curvature":1.5944537583365312},{"time":9.18278905211805,"velocity":1.2122960294536687,"acceleration":1.8893954163846938,"pose":{"translation":{"x":6.015879942811402,"y":-1.044722741127802},"rotation":{"radians":-2.6473525023244533}},"curvature":1.2416597363857012},{"time":9.220831944025942,"velocity":1.2841740950504594,"acceleration":1.3404641731957911,"pose":{"translation":{"x":5.974707474334325,"y":-1.0683826823717764},"rotation":{"radians":-2.594593741764638}},"curvature":0.9994075506022949},{"time":9.259440297111237,"velocity":1.3359272091473895,"acceleration":0.715181756857879,"pose":{"translation":{"x":5.932146134845955,"y":-1.0957095431060973},"rotation":{"radians":-2.5483763329477482}},"curvature":0.84112476005781},{"time":9.337761895727752,"velocity":1.3919413876458662,"acceleration":-0.9165116605292362,"pose":{"translation":{"x":5.846116556806937,"y":-1.1590388592593852},"rotation":{"radians":-2.4684375996330474}},"curvature":0.6830734359341363},{"time":9.417551883826427,"velocity":1.3188129331599419,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":5.764019872903364,"y":-1.2294348080761055},"rotation":{"radians":-2.398204357588943}},"curvature":0.6198316751568268},{"time":9.503801511073453,"velocity":1.08593893959297,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":5.689857359406911,"y":-1.3019230140228035},"rotation":{"radians":-2.339311889335182}},"curvature":0.48136250947129305},{"time":9.607586151182888,"velocity":0.8057204112974979,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":5.622885524705272,"y":-1.3736911679443409},"rotation":{"radians":-2.311823882613657}},"curvature":8.191669211600454E-15},{"time":9.63940153882595,"velocity":0.7198188646612272,"acceleration":-2.7000000000000055,"pose":{"translation":{"x":5.606760612685381,"y":-1.3918271514514338},"rotation":{"radians":-2.269963805315889}},"curvature":3.2878389595958577},{"time":9.65706710370474,"velocity":0.672121839488494,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":5.599065564665838,"y":-1.4014160051582787},"rotation":{"radians":-2.221640228836817}},"curvature":4.513918580141442},{"time":9.676436129360901,"velocity":0.6198254702168593,"acceleration":-1.5218568088264282,"pose":{"translation":{"x":5.591789754771981,"y":-1.4115948920758636},"rotation":{"radians":-2.159320163295659}},"curvature":5.378727021877778},{"time":9.697704974333787,"velocity":0.5874573336790003,"acceleration":-0.21823965802921186,"pose":{"translation":{"x":5.585048858094577,"y":-1.4225216460373495},"rotation":{"radians":-2.0868064989326367}},"curvature":5.845145621010932},{"time":9.72043512064832,"velocity":0.5824967143203627,"acceleration":0.7178445257164718,"pose":{"translation":{"x":5.578946967604866,"y":-1.4343354878734613},"rotation":{"radians":-2.0081475656177776}},"curvature":5.921208017602095},{"time":9.743959135768007,"velocity":0.599383299796901,"acceleration":1.4808144576069648,"pose":{"translation":{"x":5.573576975393826,"y":-1.4471576879759533},"rotation":{"radians":-1.9272611188575393}},"curvature":5.667433719349019},{"time":9.767720891226396,"velocity":0.6345700508178065,"acceleration":2.1392601783532403,"pose":{"translation":{"x":5.569020953911443,"y":-1.4610922288610777},"rotation":{"radians":-1.8475289342469352}},"curvature":5.182034727998714},{"time":9.791322887569843,"velocity":0.6850608617249814,"acceleration":2.6995536006077865,"pose":{"translation":{"x":5.565350537205965,"y":-1.4762264677330488},"rotation":{"radians":-1.7715108731973805}},"curvature":4.572627600801525},{"time":9.814536133221118,"velocity":0.7477262626046751,"acceleration":2.6999999999999216,"pose":{"translation":{"x":5.562627302163168,"y":-1.492631799047511},"rotation":{"radians":-1.7008580525961663}},"curvature":3.930738587680555},{"time":9.837417920918426,"velocity":0.809507089387406,"acceleration":2.700000000000026,"pose":{"translation":{"x":5.560903149745627,"y":-1.510364317075005},"rotation":{"radians":-1.6364043724916308}},"curvature":3.3192922733630086},{"time":9.860166030614282,"velocity":0.870926985566219,"acceleration":2.6999999999999313,"pose":{"translation":{"x":5.5602206862319665,"y":-1.5294654784644335},"rotation":{"radians":-1.5783566036728185}},"curvature":2.7727454424744113},{"time":9.882903968091455,"velocity":0.9323194167545841,"acceleration":2.700000000000024,"pose":{"translation":{"x":5.560613604456133,"y":-1.5499627648065288},"rotation":{"radians":-1.5265028144634054}},"curvature":2.3039822926484663},{"time":9.905703726610803,"velocity":0.9938787647568219,"acceleration":2.7000000000000384,"pose":{"translation":{"x":5.562107065046657,"y":-1.5718703451973188},"rotation":{"radians":-1.4803899195962005}},"curvature":1.9124624775099355},{"time":9.951598901345102,"velocity":1.117795736539435,"acceleration":2.700000000000029,"pose":{"translation":{"x":5.56845588224938,"y":-1.6199104774163704},"rotation":{"radians":-1.403100159874514}},"curvature":1.3289097527946605},{"time":9.997890207957337,"velocity":1.2427822643924675,"acceleration":2.699999999999994,"pose":{"translation":{"x":5.579312265852025,"y":-1.6734581554074472},"rotation":{"radians":-1.3419069245626725}},"curvature":0.9449011624894597},{"time":10.04439538357599,"velocity":1.3683462385628298,"acceleration":1.7950930416960253,"pose":{"translation":{"x":5.594609227892647,"y":-1.732215063602993},"rotation":{"radians":-1.2928462271300758}},"curvature":0.692548947532817},{"time":10.09151245213496,"velocity":1.4529257604781516,"acceleration":0.9671100861959177,"pose":{"translation":{"x":5.614179864091905,"y":-1.7957334926129616},"rotation":{"radians":-1.2528347085627005}},"curvature":0.5248546306234378},{"time":10.14007354118107,"velocity":1.4998896794913021,"acceleration":0.6730955187294226,"pose":{"translation":{"x":5.637769553509474,"y":-1.8634375412557462},"rotation":{"radians":-1.2195636864339958}},"curvature":0.4117799158561922},{"time":10.190345571290024,"velocity":1.5337275576750686,"acceleration":0.4655074571551493,"pose":{"translation":{"x":5.665048158200482,"y":-1.9346443185891053},"rotation":{"radians":-1.1913174450316089}},"curvature":0.3346008538592826},{"time":10.24210769719873,"velocity":1.5578232132837746,"acceleration":0.31707453334474694,"pose":{"translation":{"x":5.6956222228719255,"y":-2.0085851459410913},"rotation":{"radians":-1.1668096232923624}},"curvature":0.281686162594996},{"time":10.295025480779854,"velocity":1.574602094818398,"acceleration":0.20706641377144558,"pose":{"translation":{"x":5.729047174539104,"y":-2.0844267589409764},"rotation":{"radians":-1.1450567416368815}},"curvature":0.2457957936305113},{"time":10.348685026145443,"velocity":1.5857131844418566,"acceleration":0.12039299704229167,"pose":{"translation":{"x":5.7648395221820365,"y":-2.161292509550181},"rotation":{"radians":-1.125285144212007}},"curvature":0.22244696488422971},{"time":10.40262195364287,"velocity":1.5922068127945246,"acceleration":0.04577089030921462,"pose":{"translation":{"x":5.802489056401893,"y":-2.2382835680932027},"rotation":{"radians":-1.1068629659224853}},"curvature":0.20895214086868485},{"time":10.456346726772123,"velocity":1.594665843492311,"acceleration":-0.02603749553344534,"pose":{"translation":{"x":5.84147104907742,"y":-2.3145001252885384},"rotation":{"radians":-1.0892493990097543}},"curvature":0.20387056175232815},{"time":10.509367551642553,"velocity":1.5932853140015677,"acceleration":-0.10374667649698552,"pose":{"translation":{"x":5.88125845302136,"y":-2.3890625942796184},"rotation":{"radians":-1.0719552904326186}},"curvature":0.20672149044213964},{"time":10.561211746133132,"velocity":1.5879066511275068,"acceleration":-0.19689404177455438,"pose":{"translation":{"x":5.921334101636883,"y":-2.4611328126657277},"rotation":{"radians":-1.0545107672447855}},"curvature":0.2178762371856135},{"time":10.61144617788697,"velocity":1.5780157908232457,"acceleration":-0.3170025955280905,"pose":{"translation":{"x":5.96120290857401,"y":-2.529935244532939},"rotation":{"radians":-1.0364370358322745}},"curvature":0.2385872657024199},{"time":10.659697043555603,"velocity":1.562720141169812,"acceleration":-0.4781936964556094,"pose":{"translation":{"x":6.000404067386037,"y":-2.594778182485035},"rotation":{"radians":-1.0172210387171088}},"curvature":0.2711318916496678},{"time":10.705668767242173,"velocity":1.5407367526876952,"acceleration":-0.6959800406678565,"pose":{"translation":{"x":6.0385232511859614,"y":-2.6550749496744377},"rotation":{"radians":-0.9962939663717582}},"curvature":0.3190377795479394},{"time":10.749160861197073,"velocity":1.5104671233682334,"acceleration":-1.143787586002519,"pose":{"translation":{"x":6.075204812302908,"y":-2.7103651018331396},"rotation":{"radians":-0.9730190540085591}},"curvature":0.3872828512752511},{"time":10.828613748302285,"velocity":1.419589897425232,"acceleration":-1.7173353367601463,"pose":{"translation":{"x":6.143199069823552,"y":-2.8048421590697927},"rotation":{"radians":-0.9166652303157483}},"curvature":0.6096572546208449},{"time":10.898096375756207,"velocity":1.3002649260076704,"acceleration":-0.5942675164135904,"pose":{"translation":{"x":6.203178829847664,"y":-2.8778561288174966},"rotation":{"radians":-0.8441316049993572}},"curvature":0.9488452727549075},{"time":10.9571199714002,"velocity":1.2651891204145151,"acceleration":2.6999999999999784,"pose":{"translation":{"x":6.25565572774419,"y":-2.9324304369511696},"rotation":{"radians":-0.7640893316767332}},"curvature":1.0607180112091363},{"time":11.005440237142608,"velocity":1.3956538379190149,"acceleration":-0.7929061929510893,"pose":{"translation":{"x":6.303251433356936,"y":-2.975643625587835},"rotation":{"radians":-0.721693272632182}},"curvature":-1.3801184199187165E-13},{"time":11.05165411876184,"velocity":1.359010564982817,"acceleration":-0.29007603499904255,"pose":{"translation":{"x":6.351472338357745,"y":-3.0171924466628646},"rotation":{"radians":-0.6924522830649504}},"curvature":0.7744137940856395},{"time":11.104698077771024,"velocity":1.3436237836727813,"acceleration":1.2215957437951925,"pose":{"translation":{"x":6.407986297242314,"y":-3.0612841919142766},"rotation":{"radians":-0.6322841019506875}},"curvature":0.818626915486632},{"time":11.166087308597229,"velocity":1.4186166067649326,"acceleration":1.0539405108203865,"pose":{"translation":{"x":6.477942720589568,"y":-3.1091877279759905},"rotation":{"radians":-0.5715475064117093}},"curvature":0.612193075232413},{"time":11.234843413022094,"velocity":1.491081450584495,"acceleration":0.6392591655735907,"pose":{"translation":{"x":6.563515579191833,"y":-3.1609877000164968},"rotation":{"radians":-0.5201044544393127}},"curvature":0.43244474502007557},{"time":11.310617605034116,"velocity":1.5395207973421132,"acceleration":0.38785548312289947,"pose":{"translation":{"x":6.664402792255458,"y":-3.215810757177851},"rotation":{"radians":-0.47753673847821154}},"curvature":0.3217275024137219},{"time":11.350833404153965,"velocity":1.5551187155389161,"acceleration":0.2585530169042255,"pose":{"translation":{"x":6.719940732421716,"y":-3.2438767411638874},"rotation":{"radians":-0.45865064948045975}},"curvature":0.2875436156385399},{"time":11.392376575861064,"velocity":1.5658598279155567,"acceleration":0.15127274578820937,"pose":{"translation":{"x":6.778325615601421,"y":-3.272051778014667},"rotation":{"radians":-0.44081890891931785}},"curvature":0.26439970514791433},{"time":11.434992284027013,"velocity":1.5723064231035289,"acceleration":0.05790571335757265,"pose":{"translation":{"x":6.839045675994891,"y":-3.300058003506313},"rotation":{"radians":-0.4236492462607365}},"curvature":0.25066104945217654},{"time":11.478386368390414,"velocity":1.5748191885140903,"acceleration":-0.02954320497392369,"pose":{"translation":{"x":6.901528029865937,"y":-3.327600095933107},"rotation":{"radians":-0.406761576088328}},"curvature":0.24533643741161604},{"time":11.522237605629712,"velocity":1.5735236824239696,"acceleration":-0.11908151242569748,"pose":{"translation":{"x":6.965154281423127,"y":-3.35437234565246},"rotation":{"radians":-0.38977779633540466}},"curvature":0.2480795231902414},{"time":11.56621092890977,"velocity":1.568287272581396,"acceleration":-0.21936160634378352,"pose":{"translation":{"x":7.029276128701058,"y":-3.380065724629876},"rotation":{"radians":-0.37230703623010397}},"curvature":0.25921320076042825},{"time":11.60997143372808,"velocity":1.5586878979500367,"acceleration":-0.3405813722881615,"pose":{"translation":{"x":7.093230969441625,"y":-3.4043749559839256},"rotation":{"radians":-0.35392718962560643}},"curvature":0.27981770031754694},{"time":11.653199247885192,"velocity":1.54396530968339,"acceleration":-0.495508030771831,"pose":{"translation":{"x":7.156357506975286,"y":-3.4270055835312108},"rotation":{"radians":-0.3341623527885943}},"curvature":0.31191669096416624},{"time":11.695605492715192,"velocity":1.5229526748152489,"acceleration":-0.7003425945506951,"pose":{"translation":{"x":7.218011356102336,"y":-3.447681041331336},"rotation":{"radians":-0.31245504336966684}},"curvature":0.358804558222809},{"time":11.736949628046615,"velocity":1.493997615807785,"acceleration":-1.1507912759192496,"pose":{"translation":{"x":7.277580648974171,"y":-3.4661497232318745},"rotation":{"radians":-0.2881317080480612}},"curvature":0.42557619973842853},{"time":11.816032778852247,"velocity":1.4029894157884568,"acceleration":-2.658689860196489,"pose":{"translation":{"x":7.388274316600922,"y":-3.4956275509341475},"rotation":{"radians":-0.2281002234430797}},"curvature":0.6533900567390061},{"time":11.891478010104189,"velocity":1.2024039444587369,"acceleration":-2.700000000000001,"pose":{"translation":{"x":7.48478693757701,"y":-3.514194055886819},"rotation":{"radians":-0.14461926861442181}},"curvature":1.1112435026142253},{"time":11.92834818282547,"velocity":1.1028544781112781,"acceleration":-2.700000000000002,"pose":{"translation":{"x":7.526985950421189,"y":-3.5192232267297703},"rotation":{"radians":-0.08995545134471471}},"curvature":1.4882511913521048},{"time":11.964459990689342,"velocity":1.0053525968788224,"acceleration":-2.6999999999999966,"pose":{"translation":{"x":7.564985993642774,"y":-3.5214560348241797},"rotation":{"radians":-0.024181598345953223}},"curvature":2.0006342207589443},{"time":11.999814892003151,"velocity":0.9098943633315374,"acceleration":-2.700000000000002,"pose":{"translation":{"x":7.598839785526418,"y":-3.521013539792528},"rotation":{"radians":0.05396578858750863}},"curvature":2.6458312857918305},{"time":12.0172746648167,"velocity":0.8627529767349573,"acceleration":-2.601246015746601,"pose":{"translation":{"x":7.614270914285618,"y":-3.519848981000226},"rotation":{"radians":0.09758706201301133}},"curvature":2.995174540686496},{"time":12.03464257798692,"velocity":0.8175747617990886,"acceleration":-2.006309634943756,"pose":{"translation":{"x":7.628757408758028,"y":-3.5180983174050144},"rotation":{"radians":0.14376165533191312}},"curvature":3.3312362527092843},{"time":12.051871348560015,"velocity":0.7830085134000553,"acceleration":-1.198321698173938,"pose":{"translation":{"x":7.6423526778069775,"y":-3.5158007677234693},"rotation":{"radians":0.19172087218713824}},"curvature":3.614546443900709},{"time":12.068785431338206,"velocity":0.7627400010022379,"acceleration":-0.07983600707077576,"pose":{"translation":{"x":7.655121916306034,"y":-3.513001529124522},"rotation":{"radians":0.24027746840183797}},"curvature":3.7926131720944882},{"time":12.085124957706455,"velocity":0.7614355184595692,"acceleration":1.5878530203646875,"pose":{"translation":{"x":7.667142592822794,"y":-3.5097519981527365},"rotation":{"radians":0.28778596989205824}},"curvature":3.804398251912535},{"time":12.100547063695734,"velocity":0.78592355603503,"acceleration":2.7000000000000846,"pose":{"translation":{"x":7.678504937302663,"y":-3.506109991651592},"rotation":{"radians":0.33216230468048996}},"curvature":3.589692115499753},{"time":12.128133613924113,"velocity":0.8604072416516564,"acceleration":2.699999999999959,"pose":{"translation":{"x":7.699682282925197,"y":-3.4979132464693854},"rotation":{"radians":0.40164129720467945}},"curvature":2.3223355062035163},{"time":12.152603087654255,"velocity":0.9264748207230366,"acceleration":2.700000000000004,"pose":{"translation":{"x":7.719649552277254,"y":-3.4890106293886585},"rotation":{"radians":0.42866706911165464}},"curvature":-1.4672541185616427E-13},{"time":12.23947742475858,"velocity":1.1610355309047136,"acceleration":2.7000000000000046,"pose":{"translation":{"x":7.801434256660243,"y":-3.4498530566654693},"rotation":{"radians":0.47600289773940896}},"curvature":0.7808480194783732},{"time":12.323446821671867,"velocity":1.38775290257059,"acceleration":0.5811999187416641,"pose":{"translation":{"x":7.894458795447899,"y":-3.3969607165696596},"rotation":{"radians":0.5556930990961845}},"curvature":0.669337722543839},{"time":12.411393124019991,"velocity":1.4388672863489496,"acceleration":-0.09118962622791665,"pose":{"translation":{"x":7.997449372444396,"y":-3.3273741752327006},"rotation":{"radians":0.6304378230525973}},"curvature":0.5601386404681951},{"time":12.457051926640617,"velocity":1.4347036772039605,"acceleration":-1.0961346745209726,"pose":{"translation":{"x":8.049721937806517,"y":-3.287735951086874},"rotation":{"radians":0.6672588066468256}},"curvature":0.5707212047400938},{"time":12.503444233703593,"velocity":1.3838514608012067,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":8.100292085544012,"y":-3.246297355720206},"rotation":{"radians":0.7064267436195267}},"curvature":0.6386075731006526},{"time":12.551252039696468,"velocity":1.2547703846204439,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":8.147382569506297,"y":-3.2043362410749396},"rotation":{"radians":0.7508584304978863}},"curvature":0.7883357822832994},{"time":12.60073627245289,"velocity":1.1211629561781031,"acceleration":-2.6999999999999975,"pose":{"translation":{"x":8.18932516695089,"y":-3.1631468304545285},"rotation":{"radians":0.8045697867403263}},"curvature":1.071790843934593},{"time":12.650897236271677,"velocity":0.9857283538673778,"acceleration":-2.700000000000003,"pose":{"translation":{"x":8.224726061050278,"y":-3.1239162589118417},"rotation":{"radians":0.8732927693582957}},"curvature":1.591195655750382},{"time":12.675925548277988,"velocity":0.9181519114503377,"acceleration":-2.700000000000001,"pose":{"translation":{"x":8.239653534055595,"y":-3.1053468529163077},"rotation":{"radians":0.9156889667091929}},"curvature":1.9919005676584465},{"time":12.70077835199407,"velocity":0.8510493414169172,"acceleration":-2.7,"pose":{"translation":{"x":8.252631223398781,"y":-3.0876011136373704},"rotation":{"radians":0.9649784286951272}},"curvature":2.5231141005787268},{"time":12.725395748433634,"velocity":0.7845823710300924,"acceleration":-2.7000000000000024,"pose":{"translation":{"x":8.26363572553757,"y":-3.0707423362777857},"rotation":{"radians":1.0223014824165382}},"curvature":3.207600935145048},{"time":12.749783815671059,"velocity":0.7187345894890458,"acceleration":-2.7,"pose":{"translation":{"x":8.272691796519421,"y":-3.054803974347436},"rotation":{"radians":1.0884298168783126}},"curvature":4.040582688423067},{"time":12.77405420117219,"velocity":0.6532045486359936,"acceleration":-2.3562412566377375,"pose":{"translation":{"x":8.279877520184854,"y":-3.039785781550461},"rotation":{"radians":1.1631369910510851}},"curvature":4.9461537971183285},{"time":12.798309831258686,"velocity":0.5960524323204445,"acceleration":-0.7209925497964931,"pose":{"translation":{"x":8.28532947637079,"y":-3.025649953672393},"rotation":{"radians":1.2442124145431899}},"curvature":5.716352110154822},{"time":12.821962525583055,"velocity":0.578999015929961,"acceleration":2.3287410733392497,"pose":{"translation":{"x":8.289247909113897,"y":-3.0123172704672845},"rotation":{"radians":1.3263106481753093}},"curvature":5.975622557675659},{"time":12.843371334951403,"velocity":0.6288545896373231,"acceleration":2.700000000000098,"pose":{"translation":{"x":8.291901894853916,"y":-2.99966323754484},"rotation":{"radians":1.4002785167832748}},"curvature":5.257184104958006},{"time":12.879114608483869,"velocity":0.7253614281749864,"acceleration":2.4502222557051567,"pose":{"translation":{"x":8.294868002319127,"y":-2.975643625587824},"rotation":{"radians":1.4741934466371187}},"curvature":9.174566888690325E-13},{"time":12.910644934794707,"velocity":0.8026177354314475,"acceleration":-2.7,"pose":{"translation":{"x":8.296828013085245,"y":-2.9516346562330438},"rotation":{"radians":1.5173066925874403}},"curvature":3.171528619865886},{"time":12.926836909375655,"velocity":0.7588994040628876,"acceleration":-0.7850390771224895,"pose":{"translation":{"x":8.297228966854638,"y":-2.9389989932324987},"rotation":{"radians":1.5622185774977355}},"curvature":3.8274262087851203},{"time":12.944538482944234,"velocity":0.7450029770849945,"acceleration":1.2733677627742497,"pose":{"translation":{"x":8.29699687162528,"y":-2.9256902975556733},"rotation":{"radians":1.6145256700919197}},"curvature":3.956389123700542},{"time":12.963234264859528,"velocity":0.7688095830757885,"acceleration":2.4723260757096925,"pose":{"translation":{"x":8.295987942610536,"y":-2.911575355743072},"rotation":{"radians":1.6692600483111446}},"curvature":3.738304724534559},{"time":12.982331761550263,"velocity":0.8160248221250717,"acceleration":2.6999999999999345,"pose":{"translation":{"x":8.294089063349732,"y":-2.8965617771256356},"rotation":{"radians":1.7229494254681947}},"curvature":3.343425807962852},{"time":13.001598837104009,"velocity":0.8680459261201828,"acceleration":2.6999999999998674,"pose":{"translation":{"x":8.291215691876086,"y":-2.880594698226019},"rotation":{"radians":1.7735272452852804}},"curvature":2.8946819814134637},{"time":13.02103954914792,"velocity":0.9205358486387392,"acceleration":2.7000000000000246,"pose":{"translation":{"x":8.287309766884606,"y":-2.8636534871598625},"rotation":{"radians":1.8200121141195422}},"curvature":2.4639554956800036},{"time":13.060428832926338,"velocity":1.026886914840468,"acceleration":2.700000000000049,"pose":{"translation":{"x":8.276287851444645,"y":-2.8269175253630525},"rotation":{"radians":1.900102061366787}},"curvature":1.7665003844634892},{"time":13.100200979330195,"velocity":1.1342717101308857,"acceleration":2.699999999999988,"pose":{"translation":{"x":8.261008874206519,"y":-2.786748235768413},"rotation":{"radians":1.9650989766400093}},"curvature":1.3002072038341623},{"time":13.139772951985424,"velocity":1.241116036300005,"acceleration":2.505377365278507,"pose":{"translation":{"x":8.241748077682049,"y":-2.743876749578403},"rotation":{"radians":2.0187116943504297}},"curvature":1.0084514823426403},{"time":13.178598069685787,"velocity":1.3383876073907666,"acceleration":0.6431597971115541,"pose":{"translation":{"x":8.219003387091398,"y":-2.699265526005476},"rotation":{"radians":2.0644130327210313}},"curvature":0.8339046367037358},{"time":13.255355315448625,"velocity":1.387754782002435,"acceleration":-1.3483955227056308,"pose":{"translation":{"x":8.165765422373195,"y":-2.6091975886551095},"rotation":{"radians":2.142480745169529}},"curvature":0.6944453163720166},{"time":13.332217794701796,"velocity":1.2841137591134053,"acceleration":-2.700000000000002,"pose":{"translation":{"x":8.107185936162045,"y":-2.5248632095650483},"rotation":{"radians":2.2134471186770908}},"curvature":0.6997907808660903},{"time":13.412102012925113,"velocity":1.0684263699104526,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":8.048430639786861,"y":-2.451533036550468},"rotation":{"radians":2.2782882345707343}},"curvature":0.6342783626769937},{"time":13.501916704040376,"velocity":0.8259267038992429,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":7.991795915737944,"y":-2.388054886297754},"rotation":{"radians":2.3113186753445496}},"curvature":-1.1871748985941687E-13},{"time":13.528254116353281,"velocity":0.7548156906543971,"acceleration":-2.700000000000002,"pose":{"translation":{"x":7.977587056053807,"y":-2.3728421288653965},"rotation":{"radians":2.342891572111763}},"curvature":2.88356071872867},{"time":13.558097187911335,"velocity":0.6742393974476537,"acceleration":-2.095720071457441,"pose":{"translation":{"x":7.962136027418247,"y":-2.3581463555969737},"rotation":{"radians":2.4260411708359855}},"curvature":4.695554424200174},{"time":13.57490865317783,"velocity":0.6390072722580464,"acceleration":-0.5342795390081707,"pose":{"translation":{"x":7.953613193614656,"y":-2.3511309142037695},"rotation":{"radians":2.480553880143268}},"curvature":5.124619163115591},{"time":13.592887886300007,"velocity":0.6294013358738099,"acceleration":0.5385824578028289,"pose":{"translation":{"x":7.944409342901804,"y":-2.3443999188373903},"rotation":{"radians":2.539985494684901}},"curvature":5.24993621120864},{"time":13.611581152397319,"velocity":0.6394692010728623,"acceleration":1.3702302581295505,"pose":{"translation":{"x":7.934428647948702,"y":-2.3379938719593714},"rotation":{"radians":2.6016969120666453}},"curvature":5.118687813382712},{"time":13.630604381191807,"velocity":0.6655354047743904,"acceleration":2.063047058014758,"pose":{"translation":{"x":7.923587748320566,"y":-2.3319482097644975},"rotation":{"radians":2.663392019674575}},"curvature":4.797328493222974},{"time":13.649664775411278,"velocity":0.704857894993473,"acceleration":2.6513284764538585,"pose":{"translation":{"x":7.911815289153618,"y":-2.326293486583901},"rotation":{"radians":2.723248647039322}},"curvature":4.357511310912658},{"time":13.668566667233188,"velocity":0.7549730190397553,"acceleration":2.7000000000001316,"pose":{"translation":{"x":7.899051459829893,"y":-2.321055559288156},"rotation":{"radians":2.779965689003613}},"curvature":3.863383018568155},{"time":13.68729710449894,"velocity":0.805545199657291,"acceleration":2.700000000000109,"pose":{"translation":{"x":7.885247532652044,"y":-2.316255771690376},"rotation":{"radians":2.8327325646598385}},"curvature":3.364116075753104},{"time":13.705959214541302,"velocity":0.8559328967716677,"acceleration":2.6999999999999313,"pose":{"translation":{"x":7.870365401518141,"y":-2.311911138949307},"rotation":{"radians":2.8811477919324364}},"curvature":2.8921578097122516},{"time":13.743349857255405,"velocity":0.9568876320997437,"acceleration":2.700000000000083,"pose":{"translation":{"x":7.837264443000389,"y":-2.304634861819037},"rotation":{"radians":2.9647584320323124}},"curvature":2.0909464784288723},{"time":13.781060320147287,"velocity":1.0587058819078259,"acceleration":2.700000000000078,"pose":{"translation":{"x":7.799638637012161,"y":-2.2992832833976466},"rotation":{"radians":3.0321014291465964}},"curvature":1.4958137760603276},{"time":13.81912851759833,"velocity":1.1614900150256455,"acceleration":2.700000000000062,"pose":{"translation":{"x":7.757518457003163,"y":-2.295855502513718},"rotation":{"radians":3.08571487951424}},"curvature":1.0731467945663693},{"time":13.85744363131819,"velocity":1.2649408220692742,"acceleration":2.7000000000000335,"pose":{"translation":{"x":7.7110600347309965,"y":-2.294299062223183},"rotation":{"radians":3.1282051100967063}},"curvature":0.7767531906441147},{"time":13.934024661126744,"velocity":1.4717096025523677,"acceleration":1.4572794645678941,"pose":{"translation":{"x":7.606292707529443,"y":-2.2963680021771706},"rotation":{"radians":-3.0948860053019134}},"curvature":0.418126067723014},{"time":14.01126294527337,"velocity":1.5842673679177057,"acceleration":0.8087763064112419,"pose":{"translation":{"x":7.488537904187961,"y":-2.3042635664186144},"rotation":{"radians":-3.0581457172818074}},"curvature":0.2254666661505277},{"time":14.050444926259814,"velocity":1.6159568257777976,"acceleration":0.6812099271109087,"pose":{"translation":{"x":7.426094919301412,"y":-2.309885585825974},"rotation":{"radians":-3.0461321235246888}},"curvature":0.1605194575087964},{"time":14.089940213628916,"velocity":1.642861407607728,"acceleration":0.6060163430474821,"pose":{"translation":{"x":7.362062612411925,"y":-2.3163119832844354},"rotation":{"radians":-3.0375688035152058}},"curvature":0.10734543973484746},{"time":14.129444670101341,"velocity":1.6668017538532252,"acceleration":0.5752419363160877,"pose":{"translation":{"x":7.2970633760567525,"y":-2.3232946366152696},"rotation":{"radians":-3.032083008839994}},"curvature":0.06147325105601822},{"time":14.168621382907125,"velocity":1.6893378419861236,"acceleration":-0.02780066053831405,"pose":{"translation":{"x":7.231727161830859,"y":-2.330581075059635},"rotation":{"radians":-3.029435269552829}},"curvature":0.01947975963521127},{"time":14.20738452859225,"velocity":1.6882602009315342,"acceleration":-0.5906997428365126,"pose":{"translation":{"x":7.166676717980646,"y":-2.3379203801776502},"rotation":{"radians":-3.029496766276137}},"curvature":-0.021462300492652457},{"time":14.245884923462295,"velocity":1.6655180275826946,"acceleration":-0.6727544362191361,"pose":{"translation":{"x":7.102512826997682,"y":-2.3450690867474577},"rotation":{"radians":-3.0322333261746435}},"curvature":-0.06389954298400319},{"time":14.321569782042086,"velocity":1.6146007032185223,"acceleration":-0.8939223535478376,"pose":{"translation":{"x":6.979049430387953,"y":-2.357893514839557},"rotation":{"radians":-3.0459946335751953}},"curvature":-0.16324660082250014},{"time":14.393811676611486,"velocity":1.5500220588002889,"acceleration":-1.173717791084151,"pose":{"translation":{"x":6.86514294539911,"y":-2.367479936086158},"rotation":{"radians":-3.071833537308979}},"curvature":-0.2986376081668801},{"time":14.461327684403813,"velocity":1.4707773192714595,"acceleration":-1.1419760975709021,"pose":{"translation":{"x":6.763303099349715,"y":-2.3727508362662233},"rotation":{"radians":-3.111032851233153}},"curvature":-0.4810227900484848},{"time":14.52335667884947,"velocity":1.3999416902581596,"acceleration":0.32262609509877466,"pose":{"translation":{"x":6.674270976478693,"y":-2.3733144389576157},"rotation":{"radians":3.120955426065494}},"curvature":-0.6615317628651792},{"time":14.578586455157865,"velocity":1.4177602573217158,"acceleration":2.6999999999999917,"pose":{"translation":{"x":6.596546620944583,"y":-2.369653534307263},"rotation":{"radians":3.068580890516465}},"curvature":-0.6144270954201344},{"time":14.626425512874658,"velocity":1.5469257131570577,"acceleration":-0.5227038196267028,"pose":{"translation":{"x":6.525916639824769,"y":-2.3633143078013226},"rotation":{"radians":3.0428766210204286}},"curvature":-1.3745087990328181E-14},{"time":14.6727542176196,"velocity":1.522709522228519,"acceleration":-0.19190566186192182,"pose":{"translation":{"x":6.455195668545268,"y":-2.355923541925758},"rotation":{"radians":3.02776724841157}},"curvature":-0.35935470596335345},{"time":14.724842220780467,"velocity":1.512713539506867,"acceleration":0.7827970406039597,"pose":{"translation":{"x":6.376799780285132,"y":-2.3457397981283044},"rotation":{"radians":2.9968441067264147}},"curvature":-0.3821243190168597},{"time":14.784817213459158,"velocity":1.5596617862859903,"acceleration":0.6978075359909331,"pose":{"translation":{"x":6.285855891087947,"y":-2.3309861568532866},"rotation":{"radians":2.966325200386983}},"curvature":-0.27771574499572865},{"time":14.852777359336004,"velocity":1.6070848882258963,"acceleration":0.45719777957768987,"pose":{"translation":{"x":6.180150345558281,"y":-2.3108503732705126},"rotation":{"radians":2.942171145382456}},"curvature":-0.1784442367922486},{"time":14.928578674122464,"velocity":1.6417410810353352,"acceleration":0.3186759847732791,"pose":{"translation":{"x":6.059692088649724,"y":-2.2853267494338727},"rotation":{"radians":2.9248214622000925}},"curvature":-0.10952486988545537},{"time":14.969151363335369,"velocity":1.654670622725158,"acceleration":0.2539193491804058,"pose":{"translation":{"x":5.994433730316507,"y":-2.270724342702338},"rotation":{"radians":2.91836824011743}},"curvature":-0.08455186397505596},{"time":15.011280512507415,"velocity":1.6653680288644481,"acceleration":0.20682580812743837,"pose":{"translation":{"x":5.926275837452924,"y":-2.2550580064399304},"rotation":{"radians":2.91319546165836}},"curvature":-0.06418329038895346},{"time":15.054723977822476,"velocity":1.674353258686092,"acceleration":0.17385230529079998,"pose":{"translation":{"x":5.855650109463198,"y":-2.2384834534101565},"rotation":{"radians":2.909173734010673}},"curvature":-0.04727593092013274},{"time":15.099199065957482,"velocity":1.6820853552863744,"acceleration":0.15213116013352013,"pose":{"translation":{"x":5.783045252983621,"y":-2.2211771565865153},"rotation":{"radians":2.906197797537375}},"curvature":-0.03287116978926779},{"time":15.144390915381456,"velocity":1.6889604437678227,"acceleration":0.13964183277144215,"pose":{"translation":{"x":5.70899333100093,"y":-2.2033314076574526},"rotation":{"radians":2.9041874314948948}},"curvature":-0.02017377289446118},{"time":15.189961218363123,"velocity":1.6953239643961329,"acceleration":0.06991686836170262,"pose":{"translation":{"x":5.634056111970686,"y":-2.1851493755313163},"rotation":{"radians":2.9030867107910083}},"curvature":-0.00851295030153828},{"time":15.235597001241203,"velocity":1.6985146754202027,"acceleration":-0.13610323939431931,"pose":{"translation":{"x":5.5588114189356475,"y":-2.166840164841316},"rotation":{"radians":2.902862727650498}},"curvature":0.0026990259131539876},{"time":15.281105324013001,"velocity":1.6923208452715586,"acceleration":-0.14367586106638294,"pose":{"translation":{"x":5.48383947864415,"y":-2.148613874450473},"rotation":{"radians":2.9035042717525434}},"curvature":0.014005083555574328},{"time":15.326259846236113,"velocity":1.685833230410112,"acceleration":-0.15893057004038433,"pose":{"translation":{"x":5.409709270668479,"y":-2.1306766559565835},"rotation":{"radians":2.9050205803608042}},"curvature":0.025936490461169665},{"time":15.370727722698923,"velocity":1.6787659254553922,"acceleration":-0.18257499270630528,"pose":{"translation":{"x":5.336964876523247,"y":-2.113225772197169},"rotation":{"radians":2.9074399798509583}},"curvature":0.039038954817485615},{"time":15.414203548008421,"velocity":1.67082832696661,"acceleration":-0.2154712881773802,"pose":{"translation":{"x":5.266111828783769,"y":-2.096444655754434},"rotation":{"radians":2.9108079320094817}},"curvature":0.05388706094317525},{"time":15.456417236707122,"velocity":1.661732489083982,"acceleration":-0.2580234836625894,"pose":{"translation":{"x":5.197603460204441,"y":-2.080497967460223},"rotation":{"radians":2.915183571311626}},"curvature":0.07107618245928089},{"time":15.49714127794726,"velocity":1.6512247300943823,"acceleration":-0.3088927477640322,"pose":{"translation":{"x":5.131827252837113,"y":-2.0655266549009763},"rotation":{"radians":2.9206331631162206}},"curvature":0.09116927196833773},{"time":15.536196851173509,"velocity":1.639160746765027,"acceleration":-0.38286696303189605,"pose":{"translation":{"x":5.069091187149469,"y":-2.0516430109226844},"rotation":{"radians":2.927217912983788}},"curvature":0.11455586239362545},{"time":15.608869322318615,"velocity":1.6113368584416774,"acceleration":-0.3596555083712172,"pose":{"translation":{"x":4.953491989473371,"y":-2.0274149774204218},"rotation":{"radians":2.9438663511838454}},"curvature":0.16982896533562356},{"time":15.673988025625478,"velocity":1.5879165580993728,"acceleration":0.2231125941220733,"pose":{"translation":{"x":4.851160945732529,"y":-2.0079513381007184},"rotation":{"radians":2.964259632747473}},"curvature":0.2178556217652093},{"time":15.7317783866974,"velocity":1.6008103154733804,"acceleration":1.9323196084996057,"pose":{"translation":{"x":4.760307452712698,"y":-1.9926148325808635},"rotation":{"radians":2.984100762744224}},"curvature":0.19124127241448902},{"time":15.783110311338804,"velocity":1.6999999999999913,"acceleration":-1.0277731630865006,"pose":{"translation":{"x":4.676558397217044,"y":-1.9798353411067455},"rotation":{"radians":2.9935210754859525}},"curvature":-1.5759088522115337E-14},{"time":15.833979277095422,"velocity":1.6477182421613739,"acceleration":-0.09605139997508176,"pose":{"translation":{"x":4.592320906702872,"y":-1.967420070836291},"rotation":{"radians":2.9984027563925406}},"curvature":0.09793145817670242},{"time":15.891618967415594,"velocity":1.6421818692119912,"acceleration":0.18155597773628954,"pose":{"translation":{"x":4.498409278847477,"y":-1.9543671463020762},"rotation":{"radians":3.0087130888951097}},"curvature":0.10866702665294607},{"time":15.958655755629618,"velocity":1.6543527988404887,"acceleration":0.17400423286519315,"pose":{"translation":{"x":4.388808482714465,"y":-1.9403417883034715},"rotation":{"radians":3.019476469596657}},"curvature":0.08516105115581762},{"time":15.996085431959862,"velocity":1.6608657209567252,"acceleration":0.14115251248732566,"pose":{"translation":{"x":4.327207982918644,"y":-1.9329384901635882},"rotation":{"radians":3.02436258991187}},"curvature":0.07272400793026276},{"time":16.036165226579406,"velocity":1.6665230846672499,"acceleration":0.10855919596104582,"pose":{"translation":{"x":4.260967373291312,"y":-1.9252916140782543},"rotation":{"radians":3.028839281945693}},"curvature":0.06199962887164675},{"time":16.078823072953817,"velocity":1.6711539861710858,"acceleration":0.08089849690702101,"pose":{"translation":{"x":4.190213729470875,"y":-1.9174300718498818},"rotation":{"radians":3.032927461604743}},"curvature":0.0532751066724564},{"time":16.123907375532735,"velocity":1.6748012384838216,"acceleration":0.05882896506530205,"pose":{"translation":{"x":4.115218038319781,"y":-1.9093938233090941},"rotation":{"radians":3.0366744245702897}},"curvature":0.04643772258447499},{"time":16.171194497447214,"velocity":1.6775830909269671,"acceleration":0.04154331044404979,"pose":{"translation":{"x":4.036377052512975,"y":-1.9012322258774288},"rotation":{"radians":3.040137762601881}},"curvature":0.04124266114766373},{"time":16.220397823252966,"velocity":1.6796271599657953,"acceleration":0.02787701232919239,"pose":{"translation":{"x":3.9541951451263477,"y":-1.8930023841300396},"rotation":{"radians":3.043377204763658}},"curvature":0.0374363652879485},{"time":16.271177747872123,"velocity":1.681042752550479,"acceleration":0.016712466090873058,"pose":{"translation":{"x":3.8692661642251873,"y":-1.8847674993583996},"rotation":{"radians":3.0464510648293044}},"curvature":0.034805791169544915},{"time":16.323152179508607,"velocity":1.681911373476796,"acceleration":0.0070767743199007475,"pose":{"translation":{"x":3.78225528745263,"y":-1.8765952191330042},"rotation":{"radians":3.0494152273142197}},"curvature":0.03319383832455511},{"time":16.375907316976196,"velocity":1.6822847096788696,"acceleration":-0.001881186074678164,"pose":{"translation":{"x":3.6938808766181097,"y":-1.8685559868660728},"rotation":{"radians":3.05232348349219}},"curvature":0.03250152703892489},{"time":16.429008570627687,"velocity":1.6821848163399524,"acceleration":-0.010957767551450972,"pose":{"translation":{"x":3.6048963322858114,"y":-1.8607213913742529},"rotation":{"radians":3.0552285724545367}},"curvature":0.03268673823418971},{"time":16.482011559063096,"velocity":1.681604021913145,"acceleration":-0.02097924672364048,"pose":{"translation":{"x":3.516071948363119,"y":-1.8531625164413217},"rotation":{"radians":3.058183594346453}},"curvature":0.033764018998966736},{"time":16.534473147228784,"velocity":1.680503417311503,"acceleration":-0.03289894329098939,"pose":{"translation":{"x":3.4281767666890697,"y":-1.8459482903808893},"rotation":{"radians":3.061243627917121}},"curvature":0.03580750702889276},{"time":16.58596250543605,"velocity":1.6788094718357527,"acceleration":-0.047907495491258494,"pose":{"translation":{"x":3.341960431622801,"y":-1.8391438355991014},"rotation":{"radians":3.0644674533133305}},"curvature":0.03895788402536831},{"time":16.6360721671494,"velocity":1.6764088434431519,"acceleration":-0.06755047713030489,"pose":{"translation":{"x":3.258135044632003,"y":-1.8328088181573414},"rotation":{"radians":3.067919273437849}},"curvature":0.043433445176572855},{"time":16.684429044102625,"velocity":1.6731423133324301,"acceleration":-0.09381950670537091,"pose":{"translation":{"x":3.1773570188813727,"y":-1.8269957973349344},"rotation":{"radians":3.071670233537929}},"curvature":0.04954395928693704},{"time":16.730705311334884,"velocity":1.6688006967685338,"acceleration":-0.12910648001206262,"pose":{"translation":{"x":3.1002089338210586,"y":-1.8217485751918487},"rotation":{"radians":3.075799314558812}},"curvature":0.05770260400933074},{"time":16.774628983300545,"velocity":1.663129866091843,"acceleration":-0.17572649261498707,"pose":{"translation":{"x":3.027181389775115,"y":-1.8171005461313985},"rotation":{"radians":3.08039272779481}},"curvature":0.06842322533746892},{"time":16.81599383334936,"velocity":1.65586096607522,"acceleration":-0.2657223007254603,"pose":{"translation":{"x":2.9586548625299542,"y":-1.8130730464629474},"rotation":{"radians":3.085540103967001}},"curvature":0.08227235799301018},{"time":16.890627588399276,"velocity":1.6360291129715758,"acceleration":-0.3467672917789097,"pose":{"translation":{"x":2.835967266430111,"y":-1.8068947874459593},"rotation":{"radians":3.0977994429983866}},"curvature":0.1206830659561853},{"time":16.954468831863057,"velocity":1.613891057871843,"acceleration":0.06338522292102514,"pose":{"translation":{"x":2.7322979354210775,"y":-1.8030806101194756},"rotation":{"radians":3.11261130977596}},"curvature":0.16467551425198063},{"time":17.00859267512216,"velocity":1.617321709742164,"acceleration":1.7705208848050547,"pose":{"translation":{"x":2.6448753604609543,"y":-1.801198768971845},"rotation":{"radians":3.127472578620052}},"curvature":0.15777931296295936},{"time":17.05528983129093,"velocity":1.6999999999999778,"acceleration":-1.7288375315077378,"pose":{"translation":{"x":2.5674240803968287,"y":-1.8004661470076597},"rotation":{"radians":3.1347435221154885}},"curvature":-4.0115260289040856E-14},{"time":17.101334480274517,"velocity":1.6203962827120566,"acceleration":-0.4012550577971657,"pose":{"translation":{"x":2.4909816276336416,"y":-1.8001190757660865},"rotation":{"radians":3.141301161597606}},"curvature":0.15162370345938048},{"time":17.1516921877586,"velocity":1.6001899978849978,"acceleration":0.20113860788307072,"pose":{"translation":{"x":2.4098928007993488,"y":-1.8006659517526427},"rotation":{"radians":-3.1272787625006777}},"curvature":0.1925118657725037},{"time":17.206857893908754,"velocity":1.6112859512229265,"acceleration":0.33447446415601234,"pose":{"translation":{"x":2.3213338258984884,"y":-1.8026709687380102},"rotation":{"radians":-3.110980717019133}},"curvature":0.1699318437636831},{"time":17.266811239893,"velocity":1.6313388144953667,"acceleration":0.30032896037119494,"pose":{"translation":{"x":2.224201726196461,"y":-1.8063855739909007},"rotation":{"radians":-3.096409537968105}},"curvature":0.129903878537571},{"time":17.33111409835746,"velocity":1.6506508251268943,"acceleration":0.2388157043604255,"pose":{"translation":{"x":2.118820079115714,"y":-1.8118001512748505},"rotation":{"radians":-3.084766780440973}},"curvature":0.09227406899648827},{"time":17.398868515268223,"velocity":1.6668316439249677,"acceleration":0.1935063481632005,"pose":{"translation":{"x":2.006644773131923,"y":-1.818695703845009},"rotation":{"radians":-3.076207480118306}},"curvature":0.06141680219504629},{"time":17.46874749156219,"velocity":1.6803536694409964,"acceleration":0.1736470906509052,"pose":{"translation":{"x":1.8899697646701756,"y":-1.8266955374449292},"rotation":{"radians":-3.0705544021097753}},"curvature":0.0360857501701686},{"time":17.539102211103724,"velocity":1.6925705618029439,"acceleration":0.033295847696323676,"pose":{"translation":{"x":1.7716328350011523,"y":-1.8353169433033558},"rotation":{"radians":-3.067622879792275}},"curvature":0.013547656637311997},{"time":17.608319666309672,"velocity":1.6948752156494082,"acceleration":-0.9849416497582903,"pose":{"translation":{"x":1.654721347137309,"y":-1.8440228811310158},"rotation":{"radians":-3.0673503192434386}},"curvature":-0.009332389490345941},{"time":17.67617919563692,"velocity":1.6280375388820072,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":1.5422780027290592,"y":-1.852273662117406},"rotation":{"radians":-3.069845091334417}},"curvature":-0.03615169296887673},{"time":17.744913826045273,"velocity":1.4424540367794552,"acceleration":-2.700000000000002,"pose":{"translation":{"x":1.4370065989609573,"y":-1.859578631927584},"rotation":{"radians":-3.0753935019329246}},"curvature":-0.07125056256120184},{"time":17.81639800607208,"velocity":1.2494467507070757,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":1.3409777854478797,"y":-1.8655478536989563},"rotation":{"radians":-3.084395341843094}},"curvature":-0.11910925923430017},{"time":17.89105521040833,"velocity":1.047872298999203,"acceleration":-2.700000000000002,"pose":{"translation":{"x":1.255334821131206,"y":-1.869943791038068},"rotation":{"radians":-3.097090339871331}},"curvature":-0.17962571493853913},{"time":17.971292503617764,"velocity":0.8312316073337257,"acceleration":-2.699999999999999,"pose":{"translation":{"x":1.1799993311750048,"y":-1.872732991017392},"rotation":{"radians":-3.1127502049388487}},"curvature":-0.23148071922046054},{"time":18.06603831632598,"velocity":0.5754179130215418,"acceleration":-2.7,"pose":{"translation":{"x":1.1133770638622127,"y":-1.8741377671721182},"rotation":{"radians":-3.1279784326646287}},"curvature":-0.20249213348642955},{"time":18.279156061889513,"velocity":0.0,"acceleration":-2.7,"pose":{"translation":{"x":1.0520636474908165,"y":-1.8746878824969433},"rotation":{"radians":-3.1351824849794667}},"curvature":4.5593804745977266E-14}] \ No newline at end of file diff --git a/src/main/deploy/paths/Slalom.wpilib.json b/src/main/deploy/paths/Slalom.wpilib.json new file mode 100644 index 0000000..e30abf7 --- /dev/null +++ b/src/main/deploy/paths/Slalom.wpilib.json @@ -0,0 +1 @@ +[{"time":0.0,"velocity":0.0,"acceleration":2.7,"pose":{"translation":{"x":1.2994694324550664,"y":-3.8910450299555492},"rotation":{"radians":0.0}},"curvature":0.0},{"time":0.26535272369803575,"velocity":0.7164523539846965,"acceleration":2.700000000000001,"pose":{"translation":{"x":1.3945251268895944,"y":-3.8907080438212076},"rotation":{"radians":0.010515038829821324}},"curvature":0.21658218579968452},{"time":0.3741963347843701,"velocity":1.0103301039177994,"acceleration":2.6999999999999997,"pose":{"translation":{"x":1.48847311439089,"y":-3.88847092808057},"rotation":{"radians":0.04017597533410765}},"curvature":0.41315026320545933},{"time":0.4563107606898583,"velocity":1.2320390538626176,"acceleration":1.7765116818445703,"pose":{"translation":{"x":1.580361122415344,"y":-3.8827580461824684},"rotation":{"radians":0.08690219160192927}},"curvature":0.6017687005451788},{"time":0.525610196191289,"velocity":1.3551503105761435,"acceleration":-0.8836218157792299,"pose":{"translation":{"x":1.6693975273004042,"y":-3.8723266999708468},"rotation":{"radians":0.14909664211510673}},"curvature":0.7854116882657819},{"time":0.5912457517540826,"velocity":1.2971533017900694,"acceleration":-0.7473972844496172,"pose":{"translation":{"x":1.7549415467661893,"y":-3.8562439702532223},"rotation":{"radians":0.22509121884449124}},"curvature":0.9585251065582977},{"time":0.624390824789351,"velocity":1.2723807642106255,"acceleration":-0.6449543938720222,"pose":{"translation":{"x":1.7962424996309085,"y":-3.8458708051260073},"rotation":{"radians":0.26760913520216617}},"curvature":1.0372779071042038},{"time":0.6576836472066343,"velocity":1.2509084121081977,"acceleration":-0.5332043589302082,"pose":{"translation":{"x":1.8364934324171018,"y":-3.8338635573691557},"rotation":{"radians":0.3126976411742549}},"curvature":1.108062856079279},{"time":0.6910812731724678,"velocity":1.2331006523652945,"acceleration":-0.41323968822677004,"pose":{"translation":{"x":1.8756523040770348,"y":-3.8201824242327573},"rotation":{"radians":0.3599574291633311}},"curvature":1.1686372612639098},{"time":0.7245381103996416,"velocity":1.2192749593804835,"acceleration":-0.287072777563963,"pose":{"translation":{"x":1.9136846622434431,"y":-3.804802621758714},"rotation":{"radians":0.4089383679139964}},"curvature":1.2168865191205342},{"time":0.7580058921977137,"velocity":1.2096672703008062,"acceleration":-0.1573983323042494,"pose":{"translation":{"x":1.9505633367452069,"y":-3.787713661048502},"rotation":{"radians":0.45914847960290095}},"curvature":1.2510651975828426},{"time":0.7914344980023539,"velocity":1.2044056634958997,"acceleration":-0.0273318079413617,"pose":{"translation":{"x":1.986268133123027,"y":-3.7689186245309374},"rotation":{"radians":0.510068185814771}},"curvature":1.2700140791966814},{"time":0.8247734427514808,"velocity":1.203494449861049,"acceleration":0.09985777704236123,"pose":{"translation":{"x":2.0207855261450995,"y":-3.748433442229942},"rotation":{"radians":0.5611684683348345}},"curvature":1.2733125089549238},{"time":0.8579737378180614,"velocity":1.2068097575235481,"acceleration":0.22100421932540326,"pose":{"translation":{"x":2.054108353322793,"y":-3.7262861680323054},"rotation":{"radians":0.6119309062216802}},"curvature":1.2613355973624536},{"time":0.8909897666323751,"velocity":1.2141064391968805,"acceleration":0.33327576441725115,"pose":{"translation":{"x":2.0862355084263213,"y":-3.702516255955451},"rotation":{"radians":0.6618672242538605}},"curvature":1.2352059387414687},{"time":0.9237808354961027,"velocity":1.225034907738498,"acceleration":0.434369074702445,"pose":{"translation":{"x":2.117171635000421,"y":-3.677173836415202},"rotation":{"radians":0.7105361245346835}},"curvature":1.1966529553746725},{"time":0.9563121482571586,"velocity":1.2391655039613738,"acceleration":0.5226528140066072,"pose":{"translation":{"x":2.146926819880027,"y":-3.650318992493541},"rotation":{"radians":0.7575557328647348}},"curvature":1.1478117224295943},{"time":0.9885550842592329,"velocity":1.2560173651946929,"acceleration":0.6278673584365828,"pose":{"translation":{"x":2.175516286705946,"y":-3.622021036206381},"rotation":{"radians":0.8026108075708217}},"curvature":1.0910014559217847},{"time":1.0520514156873864,"velocity":1.2958846390789014,"acceleration":0.7236775045399038,"pose":{"translation":{"x":2.229282805883369,"y":-3.561414836875435},"rotation":{"radians":0.885906807967894}},"curvature":0.962485081510859},{"time":1.114188660961461,"velocity":1.3408519656778277,"acceleration":0.7755046849281434,"pose":{"translation":{"x":2.2786840713722745,"y":-3.496066811403255},"rotation":{"radians":0.9592047441268828}},"curvature":0.8266994536221995},{"time":1.1748605441525328,"velocity":1.387903295335917,"acceleration":0.7992683894462744,"pose":{"translation":{"x":2.323995535909442,"y":-3.4267898768505036},"rotation":{"radians":1.0221042335559531}},"curvature":0.6940407428856666},{"time":1.2339470232059484,"velocity":1.4351292502869915,"acceleration":0.8135896123858865,"pose":{"translation":{"x":2.365545418630461,"y":-3.354475134926074},"rotation":{"radians":1.0747367043496014}},"curvature":0.5696367165295794},{"time":1.291282391995837,"velocity":1.4817767107567588,"acceleration":0.8378296096662603,"pose":{"translation":{"x":2.4037048975713455,"y":-3.280068712555562},"rotation":{"radians":1.1174998390306374}},"curvature":0.45454127171417935},{"time":1.3466387120396672,"velocity":1.5281558747716417,"acceleration":0.8928517202195574,"pose":{"translation":{"x":2.4388783021701457,"y":-3.2045486024497265},"rotation":{"radians":1.150855083245952}},"curvature":0.34707395450475087},{"time":1.3997226574632553,"velocity":1.5755519667591333,"acceleration":1.0048180369630437,"pose":{"translation":{"x":2.471493305768563,"y":-3.128901503672959},"rotation":{"radians":1.1751897048689157}},"curvature":0.24378686081516332},{"time":1.4501817685701026,"velocity":1.6262541917284157,"acceleration":1.2130296028253107,"pose":{"translation":{"x":2.5019911181135654,"y":-3.0540996622117462},"rotation":{"radians":1.1907281548335737}},"curvature":0.13995998935125437},{"time":1.49761644527495,"velocity":1.6837938587718437,"acceleration":-0.7525919018955056,"pose":{"translation":{"x":2.5308166778590007,"y":-2.9810777115431404},"rotation":{"radians":1.1974758548039044}},"curvature":0.029706103361353858},{"time":1.5429654208870998,"velocity":1.6496645869668831,"acceleration":-1.6227492916771926,"pose":{"translation":{"x":2.558408845067208,"y":-2.91070951320322},"rotation":{"radians":1.1951841748143466}},"curvature":-0.09417442448153525},{"time":1.5876435701039984,"velocity":1.5771631519717129,"acceleration":-1.8133474172826933,"pose":{"translation":{"x":2.5851905937106348,"y":-2.8437849973555585},"rotation":{"radians":1.1833348070108674}},"curvature":-0.2403848160460825},{"time":1.631957212358424,"velocity":1.496807123239261,"acceleration":-2.021800907258785,"pose":{"translation":{"x":2.6115592041734494,"y":-2.78098700335969},"rotation":{"radians":1.1611555179552169}},"curvature":-0.41898418225295503},{"time":1.6758842639478715,"velocity":1.4079953704825126,"acceleration":-2.179892816580349,"pose":{"translation":{"x":2.6378764557531555,"y":-2.722868120339575},"rotation":{"radians":1.1277004203641492}},"curvature":-0.6400936220597103},{"time":1.7194936435698756,"velocity":1.3129315971089806,"acceleration":-2.191023597071626,"pose":{"translation":{"x":2.6644588191622045,"y":-2.6698275277520658},"rotation":{"radians":1.0820589953086446}},"curvature":-0.9099145508486775},{"time":1.7628787302607596,"velocity":1.2178738484082556,"acceleration":-1.9499865717262774,"pose":{"translation":{"x":2.6915676490296114,"y":-2.622087835955371},"rotation":{"radians":1.023792258390017}},"curvature":-1.2218372861008138},{"time":1.8060251088054722,"velocity":1.1337389896274472,"acceleration":-1.364952286902034,"pose":{"translation":{"x":2.719399376402569,"y":-2.5796719267775234},"rotation":{"radians":0.9536948045543433}},"curvature":-1.5415533767528196},{"time":1.8486103755906511,"velocity":1.075612132340684,"acceleration":-0.3261906753415307,"pose":{"translation":{"x":2.748075701248057,"y":-2.542379794084847},"rotation":{"radians":0.8748601456356045}},"curvature":-1.7916523906601256},{"time":1.889789008254714,"velocity":1.0621800463423525,"acceleration":1.4738007827120958,"pose":{"translation":{"x":2.777633784954465,"y":-2.509765384350416},"rotation":{"radians":0.793700448600237}},"curvature":-1.853339375617618},{"time":1.9280883440870527,"velocity":1.1186256374694068,"acceleration":2.7000000000000046,"pose":{"translation":{"x":2.808016442833196,"y":-2.4811134372225325},"rotation":{"radians":0.7202010024194194}},"curvature":-1.604080271673124},{"time":1.994215695100312,"velocity":1.2971694852052074,"acceleration":2.6999999999999997,"pose":{"translation":{"x":2.870496166978028,"y":-2.4313508986664925},"rotation":{"radians":0.6464393961257787}},"curvature":2.857517797535585E-14},{"time":2.05204380099587,"velocity":1.4533053711232136,"acceleration":2.6999999999999953,"pose":{"translation":{"x":2.9340206782766076,"y":-2.3835048963417367},"rotation":{"radians":0.6436960248818164}},"curvature":-0.0705823783433183},{"time":2.1061729433712992,"velocity":1.5994540555368728,"acceleration":-0.005453831040357717,"pose":{"translation":{"x":3.0003020953833497,"y":-2.3341783656050445},"rotation":{"radians":0.6349044881149161}},"curvature":-0.13974792755689597},{"time":2.1609991883802535,"velocity":1.5991550424600167,"acceleration":-0.3420813477343101,"pose":{"translation":{"x":3.071261089457653,"y":-2.282668356879903},"rotation":{"radians":0.6201066296507709}},"curvature":-0.19463395398595157},{"time":2.219937869446222,"velocity":1.5789932190072875,"acceleration":-0.25985837933692224,"pose":{"translation":{"x":3.1480122507227177,"y":-2.228992778357115},"rotation":{"radians":0.5998149018963801}},"curvature":-0.23652902027541006},{"time":2.2833962514070776,"velocity":1.5625030267155962,"acceleration":-0.23281500022807652,"pose":{"translation":{"x":3.2309808810142586,"y":-2.173750244936347},"rotation":{"radians":0.5744429279308227}},"curvature":-0.2715984334613535},{"time":2.3509767590316475,"velocity":1.5467692708175684,"acceleration":-0.23854272383254166,"pose":{"translation":{"x":3.3200197863292193,"y":-2.1179799271676756},"rotation":{"radians":0.5441122148457088}},"curvature":-0.30575623543291364},{"time":2.422045570930125,"velocity":1.529816322847763,"acceleration":-0.26120734026360304,"pose":{"translation":{"x":3.41452606937448,"y":-2.0630214001931364},"rotation":{"radians":0.5086640241559398}},"curvature":-0.3433472731143135},{"time":2.4958237527105553,"velocity":1.5105449202154122,"acceleration":-0.2881819362150481,"pose":{"translation":{"x":3.5135579221155706,"y":-2.010374492688269},"rotation":{"radians":0.46775691308735007}},"curvature":-0.3871039468897947},{"time":2.571464561074246,"velocity":1.4887466056042924,"acceleration":-0.30468224660200655,"pose":{"translation":{"x":3.6159514183253814,"y":-1.9615591358036633},"rotation":{"radians":0.4210197202657405}},"curvature":-0.43796348345312236},{"time":2.6481105886211793,"velocity":1.4653939217381735,"acceleration":-0.28830132714766576,"pose":{"translation":{"x":3.7204373061328737,"y":-1.9179752121065066},"rotation":{"radians":0.3682858507195661}},"curvature":-0.49412845474516415},{"time":2.7249170794195554,"velocity":1.4432505085074467,"acceleration":-0.20364297836381517,"pose":{"translation":{"x":3.8257578005717923,"y":-1.880762404522131},"rotation":{"radians":0.30996221157234755}},"curvature":-0.5490638648428517},{"time":2.801025977499113,"velocity":1.4277514658225376,"acceleration":0.0037712103797162755,"pose":{"translation":{"x":3.9307833761293747,"y":-1.8506600452755597},"rotation":{"radians":0.24758337221186918}},"curvature":-0.5885290778882551},{"time":2.875484119153208,"velocity":1.428032263139198,"acceleration":0.4197250698057074,"pose":{"translation":{"x":4.034629559295063,"y":-1.8278669648330523},"rotation":{"radians":0.18454292404622963}},"curvature":-0.58780646412298},{"time":2.9471262299689736,"velocity":1.4581022531023735,"acceleration":1.1957106582070967,"pose":{"translation":{"x":4.1367737211092175,"y":-1.8119013408436535},"rotation":{"radians":0.1268499818345733}},"curvature":-0.5120340378484513},{"time":3.014492157043907,"velocity":1.5386524101058734,"acceleration":2.6268491358560286,"pose":{"translation":{"x":4.237171869711822,"y":-1.801460547080739},"rotation":{"radians":0.0835533993481977}},"curvature":-0.32365099829652433},{"time":3.0759146375707704,"velocity":1.699999999999998,"acceleration":-2.223643630201365,"pose":{"translation":{"x":4.336375442891201,"y":-1.7942810023835618},"rotation":{"radians":0.06630889491981859}},"curvature":-3.6017659536381824E-15},{"time":3.1371543489344806,"velocity":1.5638247059107133,"acceleration":-0.8060999052506441,"pose":{"translation":{"x":4.43612611642638,"y":-1.788167469351561},"rotation":{"radians":0.05162242636138587}},"curvature":-0.2687603770236911},{"time":3.204751302855901,"velocity":1.5093348077594242,"acceleration":-0.09607832216143022,"pose":{"translation":{"x":4.53993082777799,"y":-1.7845389175825197},"rotation":{"radians":0.016184353605763625}},"curvature":-0.3898888520505986},{"time":3.277924516579965,"velocity":1.5023044481576564,"acceleration":0.16843256572658694,"pose":{"translation":{"x":4.65011454069362,"y":-1.7851942044942983},"rotation":{"radians":-0.028354264781803428}},"curvature":-0.4061569923804792},{"time":3.3557459990171266,"velocity":1.515412120113194,"acceleration":0.21597189070058848,"pose":{"translation":{"x":4.767379096709581,"y":-1.7912648995629663},"rotation":{"radians":-0.07448746938324301}},"curvature":-0.37594768518838745},{"time":3.437294715406185,"velocity":1.533024350575945,"acceleration":0.19080905736790563,"pose":{"translation":{"x":4.891092669601073,"y":-1.803304616200938},"rotation":{"radians":-0.11871093375899419}},"curvature":-0.33617009571519224},{"time":3.479142933523619,"velocity":1.5410093696274592,"acceleration":0.15965583986952814,"pose":{"translation":{"x":4.954876949832561,"y":-1.811599810955523},"rotation":{"radians":-0.1397486857109934}},"curvature":-0.31843532674697617},{"time":3.521513672322026,"velocity":1.5477741055162113,"acceleration":0.12339899012339876,"pose":{"translation":{"x":5.019579219832354,"y":-1.8213783436351134},"rotation":{"radians":-0.16008113387059553}},"curvature":-0.3035539914975622},{"time":3.564244346159575,"velocity":1.5530470275150572,"acceleration":0.08406962249097977,"pose":{"translation":{"x":5.084874304949385,"y":-1.8325866463753429},"rotation":{"radians":-0.17979044209541617}},"curvature":-0.29204431611965165},{"time":3.607159946832781,"velocity":1.5566549258626272,"acceleration":0.04235777989839056,"pose":{"translation":{"x":5.150407949006919,"y":-1.8451517787850171},"rotation":{"radians":-0.19899552647292235}},"curvature":-0.28421396481307754},{"time":3.650076177392898,"velocity":1.5584727621107612,"acceleration":-0.001962548758050523,"pose":{"translation":{"x":5.215805859754131,"y":-1.8589842195673063},"rotation":{"radians":-0.21784035313810296}},"curvature":-0.2802823849352992},{"time":3.6928034961532394,"velocity":1.5583889076643933,"acceleration":-0.04974100038920146,"pose":{"translation":{"x":5.280682754317667,"y":-1.8739806581409373},"rotation":{"radians":-0.2364864884343343}},"curvature":-0.28046354186119904},{"time":3.7351517743726674,"velocity":1.5562824619409987,"acceleration":-0.10223172020909632,"pose":{"translation":{"x":5.344651404653217,"y":-1.8900267862613855},"rotation":{"radians":-0.25510851401273105}},"curvature":-0.28502065606845284},{"time":3.776935309691369,"velocity":1.5520108592489503,"acceleration":-0.19349447175654919,"pose":{"translation":{"x":5.40733168299708,"y":-1.907000089642066},"rotation":{"radians":-0.27389109068295714}},"curvature":-0.2942998784669327},{"time":3.8581495257700453,"velocity":1.5362963574096846,"acceleration":-0.34123062245575403,"pose":{"translation":{"x":5.527396386767396,"y":-1.9432138845546387},"rotation":{"radians":-0.3127114345206577}},"curvature":-0.3288806575020805},{"time":3.935209627747191,"velocity":1.5100010908455193,"acceleration":-0.5051480662240553,"pose":{"translation":{"x":5.638321576290778,"y":-1.9815838893500728},"rotation":{"radians":-0.35449956603190413}},"curvature":-0.38835494214835276},{"time":4.007243009562158,"velocity":1.4736135673181097,"acceleration":-0.590712913675419,"pose":{"translation":{"x":5.738244475619492,"y":-2.0211193175831084},"rotation":{"radians":-0.4005552463986998}},"curvature":-0.47415657208679923},{"time":4.073706864489142,"velocity":1.4343525099200907,"acceleration":-0.2963537803801828,"pose":{"translation":{"x":5.82628427664608,"y":-2.0609660817699464},"rotation":{"radians":-0.45105682635515376}},"curvature":-0.5716165691975804},{"time":4.134147377969175,"velocity":1.4164407352621637,"acceleration":0.2682725765980759,"pose":{"translation":{"x":5.9028315935535325,"y":-2.1004961252663894},"rotation":{"radians":-0.5030352793524036}},"curvature":-0.6178747151715702},{"time":4.188567211226466,"velocity":1.4310400841481348,"acceleration":-2.700000000000001,"pose":{"translation":{"x":5.96983791726546,"y":-2.13939675414598},"rotation":{"radians":-0.5470998701544088}},"curvature":-0.46989721231891285},{"time":4.24174889679087,"velocity":1.2874495331242422,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.031105069896272,"y":-2.1777599690781413},"rotation":{"radians":-0.5660722222460515}},"curvature":-8.028981102517362E-14},{"time":4.302229196246196,"velocity":1.1241527245948637,"acceleration":-0.869634511037211,"pose":{"translation":{"x":6.091667580838684,"y":-2.2183870624564146},"rotation":{"radians":-0.6350443473545073}},"curvature":-1.5810186344670705},{"time":4.337750741739665,"velocity":1.0932619627483646,"acceleration":0.9360551830300561,"pose":{"translation":{"x":6.122593219519022,"y":-2.242772005167579},"rotation":{"radians":-0.7011761768047131}},"curvature":-1.7128998601713514},{"time":4.376160341944952,"velocity":1.129215468098636,"acceleration":1.743234852111858,"pose":{"translation":{"x":6.154199281874159,"y":-2.271457018488949},"rotation":{"radians":-0.7716837309767326}},"curvature":-1.5600925631871299},{"time":4.41637523731521,"velocity":1.1993194752821008,"acceleration":1.9818512957889949,"pose":{"translation":{"x":6.186612517291731,"y":-2.305244269588808},"rotation":{"radians":-0.838481837012438}},"curvature":-1.2884892585534924},{"time":4.457967699565587,"velocity":1.2817495504880656,"acceleration":1.8795666740478285,"pose":{"translation":{"x":6.219915089564622,"y":-2.3446546389239318},"rotation":{"radians":-0.8974938776207996}},"curvature":-1.0071362604491332},{"time":4.500912569235421,"velocity":1.3624672963408138,"acceleration":1.611994154016839,"pose":{"translation":{"x":6.254148340071278,"y":-2.3899514398322372},"rotation":{"radians":-0.9474577889791369}},"curvature":-0.7646184291426721},{"time":4.5453423909042865,"velocity":1.434087909135036,"acceleration":1.3044024136832106,"pose":{"translation":{"x":6.289316550956004,"y":-2.4411641381254325},"rotation":{"radians":-0.9886475251911256}},"curvature":-0.5722915064008502},{"time":4.5913853274245575,"velocity":1.4941464266651399,"acceleration":1.0259667745990104,"pose":{"translation":{"x":6.3253907083092775,"y":-2.4981120716816627},"rotation":{"radians":-1.0219793609562908}},"curvature":-0.4252264193424514},{"time":4.639081918373299,"velocity":1.5430815442401884,"acceleration":0.8028569563772872,"pose":{"translation":{"x":6.362312265348054,"y":-2.5604281700381617},"rotation":{"radians":-1.0485167068321346}},"curvature":-0.31386301215816564},{"time":4.688354112502162,"velocity":1.5826400680525177,"acceleration":0.6374201271003154,"pose":{"translation":{"x":6.399996905596068,"y":-2.6275826739838997},"rotation":{"radians":-1.0692410011322828}},"curvature":-0.22887200917977002},{"time":4.739003001347589,"velocity":1.6149246892178595,"acceleration":0.5226770250546899,"pose":{"translation":{"x":6.438338306064148,"y":-2.6989068551522313},"rotation":{"radians":-1.0849666263652789}},"curvature":-0.16259465314456},{"time":4.790720156283131,"velocity":1.6419560579038608,"acceleration":0.4503081716876449,"pose":{"translation":{"x":6.4772119004305155,"y":-2.7736167356135453},"rotation":{"radians":-1.0963228362461668}},"curvature":-0.10910643349446876},{"time":4.843104322173673,"velocity":1.6655450758714132,"acceleration":0.41426257645802733,"pose":{"translation":{"x":6.516478642221096,"y":-2.850836807467913},"rotation":{"radians":-1.1037616338343617}},"curvature":-0.0638483821075366},{"time":4.895679406767071,"velocity":1.687324965872573,"acceleration":0.07433064476634242,"pose":{"translation":{"x":6.555988767989823,"y":-2.9296237524377364},"rotation":{"radians":-1.1075717727786927}},"curvature":-0.02318490894947697},{"time":4.948184571227077,"velocity":1.6912277086004481,"acceleration":-0.41703164244403756,"pose":{"translation":{"x":6.595585560498947,"y":-3.0089901614603987},"rotation":{"radians":-1.107889902956209}},"curvature":0.0160090644906782},{"time":5.0007235849772265,"velocity":1.6693172774038332,"acceleration":-0.45434355138663535,"pose":{"translation":{"x":6.635109111899337,"y":-3.0879282542809094},"rotation":{"radians":-1.1047048613761907}},"curvature":0.056729635750586656},{"time":5.053152277558523,"velocity":1.6454966390218888,"acceleration":-0.5310068057966337,"pose":{"translation":{"x":6.674400086910793,"y":-3.165433599044558},"rotation":{"radians":-1.0978530972965348}},"curvature":0.10223068582652008},{"time":5.104983010107149,"velocity":1.6179741672891435,"acceleration":-0.6560148001114142,"pose":{"translation":{"x":6.713303486002349,"y":-3.240528831889559},"rotation":{"radians":-1.0870038156568576}},"curvature":0.15647107071327374},{"time":5.155799262010652,"velocity":1.5846379539542552,"acceleration":-0.8430160477489057,"pose":{"translation":{"x":6.751672408572579,"y":-3.312287376539701},"rotation":{"radians":-1.0716325678191094}},"curvature":0.2246921429488429},{"time":5.205278794801401,"velocity":1.5429259137765352,"acceleration":-1.108041296955858,"pose":{"translation":{"x":6.789371816129908,"y":-3.3798571638969976},"rotation":{"radians":-1.0509825594380722}},"curvature":0.3142059888225552},{"time":5.25321899861927,"velocity":1.4898061881618554,"acceleration":-1.4622506961508006,"pose":{"translation":{"x":6.826282295472909,"y":-3.4424843516343335},"rotation":{"radians":-1.0240152687373207}},"curvature":0.4354568654559104},{"time":5.299562555521373,"velocity":1.4220402898196518,"acceleration":-1.8951084497251651,"pose":{"translation":{"x":6.862303821870621,"y":-3.4995370437881164},"rotation":{"radians":-0.9893590387909972}},"curvature":0.6032883499887367},{"time":5.344417867679718,"velocity":1.3370346087333114,"acceleration":-2.346484951980595,"pose":{"translation":{"x":6.897359522242847,"y":-3.550529010350921},"rotation":{"radians":-0.9452824951234681}},"curvature":0.8378717693430323},{"time":5.38806075937912,"velocity":1.2346272200997461,"acceleration":-2.689449828036015,"pose":{"translation":{"x":6.931399438340464,"y":-3.595143406864141},"rotation":{"radians":-0.8897611118684877}},"curvature":1.1633760515314415},{"time":5.43089542654586,"velocity":1.1194255318541761,"acceleration":-2.7,"pose":{"translation":{"x":6.96440428992573,"y":-3.6332564940106415},"rotation":{"radians":-0.8207866914591161}},"curvature":1.5992968790305606},{"time":5.473294696489077,"velocity":1.00494750300749,"acceleration":-2.4306237682404093,"pose":{"translation":{"x":6.996389237952585,"y":-3.664961357207398},"rotation":{"radians":-0.737188607079875}},"curvature":2.13466250697648},{"time":5.494409880644,"velocity":0.9536244345297626,"acceleration":-2.0589949739595457,"pose":{"translation":{"x":7.012014329538222,"y":-3.678504919274166},"rotation":{"radians":-0.6901556784433198}},"curvature":2.415655686952189},{"time":5.515409191618742,"velocity":0.9103869587761547,"acceleration":-1.5290958468076985,"pose":{"translation":{"x":7.027407647746968,"y":-3.6905916261981533},"rotation":{"radians":-0.6402819188153057}},"curvature":2.6769685837812447},{"time":5.536175134006103,"velocity":0.8786338425165927,"acceleration":-0.8099454061244883,"pose":{"translation":{"x":7.042582450074457,"y":-3.701304658244051},"rotation":{"radians":-0.5885201042836204}},"curvature":2.885252775732463},{"time":5.5565108613348,"velocity":0.8621630135865145,"acceleration":0.1741794715060177,"pose":{"translation":{"x":7.057554852187112,"y":-3.710745194646063},"rotation":{"radians":-0.536271252396949}},"curvature":2.9993360698411515},{"time":5.576135408540052,"velocity":0.8655812068472701,"acceleration":1.5999775703244141,"pose":{"translation":{"x":7.072343945521527,"y":-3.7190331548451554},"rotation":{"radians":-0.48539511227061943}},"curvature":2.9753033281688777},{"time":5.594691288745531,"velocity":0.8952701989736618,"acceleration":2.6999999999999766,"pose":{"translation":{"x":7.086971914883856,"y":-3.7263079397263477},"rotation":{"radians":-0.4381532418824353}},"curvature":2.7742841844086272},{"time":5.6280191694133705,"velocity":0.9852554767768282,"acceleration":2.699999999999996,"pose":{"translation":{"x":7.1158493933609535,"y":-3.738477441718933},"rotation":{"radians":-0.3648122234116654}},"curvature":1.7591904069487663},{"time":5.657654603690658,"velocity":1.0652711493255052,"acceleration":2.700000000000008,"pose":{"translation":{"x":7.144431102235375,"y":-3.7487867036011098},"rotation":{"radians":-0.33647294173409764}},"curvature":-4.012651811233313E-14},{"time":5.711794835604165,"velocity":1.2114497754919742,"acceleration":2.6853399901821398,"pose":{"translation":{"x":7.20278002868475,"y":-3.768630977331649},"rotation":{"radians":-0.3121199101287416}},"curvature":0.682405470387508},{"time":5.7646720062371255,"velocity":1.3534429563603474,"acceleration":0.9120203548243089,"pose":{"translation":{"x":7.2678294893588555,"y":-3.7877896140913294},"rotation":{"radians":-0.2596234324602954}},"curvature":0.7902959633681634},{"time":5.8211082151057605,"velocity":1.4049139275976583,"acceleration":0.9727702573008663,"pose":{"translation":{"x":7.34360722392396,"y":-3.8055692647962274},"rotation":{"radians":-0.20319662818211826}},"curvature":0.6482671036514216},{"time":5.883402706937466,"velocity":1.4655121564452136,"acceleration":0.6569942775062056,"pose":{"translation":{"x":7.431620467942739,"y":-3.8212879782709193},"rotation":{"radians":-0.15257367662044355}},"curvature":0.49383958299030795},{"time":5.950966874013953,"velocity":1.5099014275789386,"acceleration":0.34734874541790534,"pose":{"translation":{"x":7.5312907518305545,"y":-3.8342969934835107},"rotation":{"radians":-0.1087558210950866}},"curvature":0.38858429976762066},{"time":6.022911871780103,"velocity":1.5348914322921048,"acceleration":0.09795982322372175,"pose":{"translation":{"x":7.6403886998117025,"y":-3.84400253178066},"rotation":{"radians":-0.06972690682929965}},"curvature":0.3320067687240001},{"time":6.0978069192473665,"velocity":1.5422281379023302,"acceleration":-0.13158242064653386,"pose":{"translation":{"x":7.755468828875678,"y":-3.849887589122605},"rotation":{"radians":-0.0327718855132756}},"curvature":0.31574459037026975},{"time":6.173818527426688,"velocity":1.5322263465008592,"acceleration":-0.4088265705329177,"pose":{"translation":{"x":7.872304347733433,"y":-3.8515337283181914},"rotation":{"radians":0.005024220211629608}},"curvature":0.33795262650963287},{"time":6.249009732321938,"velocity":1.501486184069296,"acceleration":-0.8278335425268275,"pose":{"translation":{"x":7.9863219557736285,"y":-3.8486428712598966},"rotation":{"radians":0.046995011566603205}},"curvature":0.4080603399816627},{"time":6.321719061205104,"velocity":1.4412949627651965,"acceleration":-1.9626635093976688,"pose":{"translation":{"x":8.0930366420189,"y":-3.8410590911588582},"rotation":{"radians":0.09747326121453227}},"curvature":0.5539964807845756},{"time":6.391836388565865,"velocity":1.3036782429777403,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":8.188486484082107,"y":-3.8287904047798995},"rotation":{"radians":0.1627060141063836}},"curvature":0.8387543111250311},{"time":6.426219981855333,"velocity":1.2108425410961785,"acceleration":-2.7,"pose":{"translation":{"x":8.23099902114149,"y":-3.820951918223507},"rotation":{"radians":0.20361765497703344}},"curvature":1.0696664025734495},{"time":6.46028806228692,"velocity":1.118858723930894,"acceleration":-2.700000000000004,"pose":{"translation":{"x":8.2696674471226,"y":-3.812030564676556},"rotation":{"radians":0.25198468185556167}},"curvature":1.3895879850268245},{"time":6.493887171936662,"velocity":1.0281411278765904,"acceleration":-2.6999999999999953,"pose":{"translation":{"x":8.304337261803258,"y":-3.802083159713785},"rotation":{"radians":0.3094511919632042}},"curvature":1.8250127417488498},{"time":6.526945509680236,"velocity":0.9388836159689415,"acceleration":-2.7,"pose":{"translation":{"x":8.334968182802468,"y":-3.791180851426103},"rotation":{"radians":0.3775096382146669}},"curvature":2.3928292555137025},{"time":6.559531388621807,"velocity":0.8509017428267004,"acceleration":-2.7000000000000024,"pose":{"translation":{"x":8.361647733047809,"y":-3.7794098014279385},"rotation":{"radians":0.45680767902151453}},"curvature":3.068597234616654},{"time":6.575731104732754,"velocity":0.8071625093271448,"acceleration":-2.305188954748715,"pose":{"translation":{"x":8.373571385607509,"y":-3.7732296966439214},"rotation":{"radians":0.5003371255723379}},"curvature":3.4140228710646574},{"time":6.591879948177645,"velocity":0.7699363737860166,"acceleration":-1.6514060105042287,"pose":{"translation":{"x":8.384604828242807,"y":-3.76687186586458},"rotation":{"radians":0.5458521318306618}},"curvature":3.7283168392974506},{"time":6.607873372702443,"velocity":0.7435247363972199,"acceleration":-0.7890983487326749,"pose":{"translation":{"x":8.394800997231759,"y":-3.76035160510629},"rotation":{"radians":0.592528855165097}},"curvature":3.9703913029532907},{"time":6.623526941522394,"velocity":0.7311725310896229,"acceleration":1.2777853376222477,"pose":{"translation":{"x":8.404223364334332,"y":-3.753685276419524},"rotation":{"radians":0.6391871287025122}},"curvature":4.089606912504738},{"time":6.652477057251592,"velocity":0.7681645644908588,"acceleration":2.6999999999999282,"pose":{"translation":{"x":8.42105580497997,"y":-3.7399853213218184},"rotation":{"radians":0.72591700860171}},"curvature":3.7440353639425465},{"time":6.677898412568699,"velocity":0.8368022238470469,"acceleration":2.7000000000000055,"pose":{"translation":{"x":8.435836769015408,"y":-3.725925026353405},"rotation":{"radians":0.7902339416846071}},"curvature":2.3659961816006247},{"time":6.700651875455897,"velocity":0.8982365736424812,"acceleration":1.562257964025974,"pose":{"translation":{"x":8.449496617921824,"y":-3.711675835856468},"rotation":{"radians":0.8149714086323635}},"curvature":-4.749653014592201E-13},{"time":6.743832247128978,"velocity":0.9656954531783541,"acceleration":-1.5410303513154142,"pose":{"translation":{"x":8.476498018455363,"y":-3.681836359478753},"rotation":{"radians":0.8714644668169833}},"curvature":2.3468807382620276},{"time":6.766898960865417,"velocity":0.9301489472053979,"acceleration":1.3250011433751228,"pose":{"translation":{"x":8.490117247793227,"y":-3.6647303810638827},"rotation":{"radians":0.9260621216901801}},"curvature":2.554519363182102},{"time":6.79201547514123,"velocity":0.9634283573384479,"acceleration":2.60015429812679,"pose":{"translation":{"x":8.503834776384835,"y":-3.6453056733575284},"rotation":{"radians":0.985000940747284}},"curvature":2.3596661341319667},{"time":6.818211494987983,"velocity":1.0315420509367972,"acceleration":2.699999999999997,"pose":{"translation":{"x":8.517636774844428,"y":-3.6231180829037357},"rotation":{"radians":1.0420497223742753}},"curvature":2.000055951400777},{"time":6.845177681736926,"velocity":1.104350755158943,"acceleration":2.6999999999999758,"pose":{"translation":{"x":8.531489533674495,"y":-3.5978702841357624},"rotation":{"radians":1.0940913740428793}},"curvature":1.6246913676263741},{"time":6.901311177706434,"velocity":1.2559111942766132,"acceleration":2.227435421988015,"pose":{"translation":{"x":8.55912685050054,"y":-3.5376659446838072},"rotation":{"radians":1.180356870367473}},"curvature":1.0403530197745938},{"time":6.960135533259215,"velocity":1.386938647510494,"acceleration":1.1510241597602804,"pose":{"translation":{"x":8.586166573802089,"y":-3.464788565285758},"rotation":{"radians":1.2462551528554453}},"curvature":0.6966701403742167},{"time":7.02181106845142,"velocity":1.4579286785828673,"acceleration":0.5723960515937875,"pose":{"translation":{"x":8.611857205832223,"y":-3.380905124825816},"rotation":{"radians":1.2982802422332504}},"curvature":0.5124624537901239},{"time":7.086153322582339,"velocity":1.4947579307980492,"acceleration":0.16311578715915676,"pose":{"translation":{"x":8.635349272709004,"y":-3.2888645819746434},"rotation":{"radians":1.3421198472073015}},"curvature":0.4237898080333488},{"time":7.151942110555827,"velocity":1.5054891207345915,"acceleration":-0.19659317595938558,"pose":{"translation":{"x":8.655768692966504,"y":-3.1923087863757216},"rotation":{"radians":1.3822499721861214}},"curvature":0.39876888626204865},{"time":7.217598990641967,"velocity":1.4925814261548727,"acceleration":-0.6271938806772547,"pose":{"translation":{"x":8.672290146105832,"y":-3.0952833898317142},"rotation":{"radians":1.4225087053528391}},"curvature":0.4289084483128157},{"time":7.281565416027638,"velocity":1.452462075584182,"acceleration":-1.4493850748287271,"pose":{"translation":{"x":8.684210441146158,"y":-3.0018487574908206},"rotation":{"radians":1.4668065761427809}},"curvature":0.526007496097762},{"time":7.34294898607371,"velocity":1.363493645319701,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":8.691021885175742,"y":-2.915690879033138},"rotation":{"radians":1.5198801321652462}},"curvature":0.7282452576249367},{"time":7.402136642066854,"velocity":1.2036869741382104,"acceleration":-2.700000000000004,"pose":{"translation":{"x":8.692485651902963,"y":-2.8397322798570173},"rotation":{"radians":1.5880110282586117}},"curvature":1.1144432444082712},{"time":7.4309569614778574,"velocity":1.1258721117285024,"acceleration":-2.699999999999998,"pose":{"translation":{"x":8.691229096820347,"y":-2.806186487096756},"rotation":{"radians":1.630128833122837}},"curvature":1.41295714413391},{"time":7.459035026621569,"velocity":1.0500613358404822,"acceleration":-2.7,"pose":{"translation":{"x":8.688705150207339,"y":-2.7757429322654246},"rotation":{"radians":1.678851808873725}},"curvature":1.7972764049110403},{"time":7.486288123940075,"velocity":0.9764779730805154,"acceleration":-2.6999999999999975,"pose":{"translation":{"x":8.684992249447273,"y":-2.748378940596252},"rotation":{"radians":1.7345709029413237}},"curvature":2.2541159768766232},{"time":7.512749335022508,"velocity":0.9050327031579475,"acceleration":-1.6253660259643052,"pose":{"translation":{"x":8.68019939269056,"y":-2.7239511666522995},"rotation":{"radians":1.796419167229914}},"curvature":2.711065312302665},{"time":7.538202582324709,"velocity":0.8636618597424814,"acceleration":1.2649085839092575,"pose":{"translation":{"x":8.674468431621897,"y":-2.702183435301035},"rotation":{"radians":1.861112270606821}},"curvature":2.988774515433657},{"time":7.561629092359282,"velocity":0.8932942533762485,"acceleration":2.699999999999984,"pose":{"translation":{"x":8.667976364227505,"y":-2.6826545826889077},"rotation":{"radians":1.9217004131763595}},"curvature":2.7872479218325132},{"time":7.601409557513918,"velocity":1.0007015092937643,"acceleration":-1.2021344339460414,"pose":{"translation":{"x":8.653606390517286,"y":-2.647830960510211},"rotation":{"radians":1.9849803096406982}},"curvature":2.550029625688712E-13},{"time":7.639848213156446,"velocity":0.9544930777512871,"acceleration":-1.8063830978770692,"pose":{"translation":{"x":8.63782066444016,"y":-2.613729915193915},"rotation":{"radians":2.0389024200241535}},"curvature":2.4106484840224773},{"time":7.661620227054434,"velocity":0.9151644798392177,"acceleration":1.2393842050849544,"pose":{"translation":{"x":8.628171469007015,"y":-2.5958094822383},"rotation":{"radians":2.0913303387023903}},"curvature":2.646881413900226},{"time":7.685353982087214,"velocity":0.9445797209542006,"acceleration":2.6231615581210144,"pose":{"translation":{"x":8.616648407383138,"y":-2.5769872731906873},"rotation":{"radians":2.1482777168623683}},"curvature":2.468340172255359},{"time":7.710098271075424,"velocity":1.0094879886111083,"acceleration":2.6999999999999993,"pose":{"translation":{"x":8.602879318393082,"y":-2.557115394723585},"rotation":{"radians":2.2037448267008655}},"curvature":2.111179068733952},{"time":7.735551491716006,"velocity":1.0782116843406808,"acceleration":2.6999999999999735,"pose":{"translation":{"x":8.586605170611964,"y":-2.5361134435560064},"rotation":{"radians":2.2546275632844277}},"curvature":1.728278140726375},{"time":7.788528453472654,"velocity":1.2212494810836316,"acceleration":2.6588989761754513,"pose":{"translation":{"x":8.54601658140146,"y":-2.490698676089403},"rotation":{"radians":2.339472161075722}},"curvature":1.1178022698351024},{"time":7.843584191128685,"velocity":1.3676371255698352,"acceleration":1.3268611992953216,"pose":{"translation":{"x":8.494726927950794,"y":-2.4412184792620173},"rotation":{"radians":2.4044976496166415}},"curvature":0.7500610517621258},{"time":7.9007440068990045,"velocity":1.4434802672743412,"acceleration":0.6945122484551162,"pose":{"translation":{"x":8.433807744298731,"y":-2.3888390381441624},"rotation":{"radians":2.4556807077251768}},"curvature":0.5484852048832685},{"time":7.960179648462585,"velocity":1.4847590483350357,"acceleration":0.24542419626146156,"pose":{"translation":{"x":8.365266395238896,"y":-2.335222632332885},"rotation":{"radians":2.4984052197925295}},"curvature":0.4474287768354185},{"time":8.020868930693009,"velocity":1.4996536666481224,"acceleration":-0.13621943686969035,"pose":{"translation":{"x":8.291754661235025,"y":-2.2823330538795257},"rotation":{"radians":2.5369048106685828}},"curvature":0.4123304563364636},{"time":8.08144097446465,"velocity":1.4914025769555033,"acceleration":-0.5684122122587151,"pose":{"translation":{"x":8.216277323336227,"y":-2.2322410252172813},"rotation":{"radians":2.5747200938899173}},"curvature":0.4316870688541576},{"time":8.140501657808752,"velocity":1.4578317632783708,"acceleration":-1.1741679434591492,"pose":{"translation":{"x":8.141900748092228,"y":-2.1869296170887655},"rotation":{"radians":2.6152935346097657}},"curvature":0.5127017041437745},{"time":8.196958220738333,"velocity":1.3915422768885728,"acceleration":-2.510515123589002,"pose":{"translation":{"x":8.071461472468638,"y":-2.1480996664735694},"rotation":{"radians":2.662556347048879}},"curvature":0.6841545710934978},{"time":8.250840329513721,"velocity":1.2562704279170935,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":8.007274788762206,"y":-2.116975194515823},"rotation":{"radians":2.7213944192976176}},"curvature":1.0038098448572472},{"time":8.30213529334724,"velocity":1.117774025566594,"acceleration":-2.700000000000007,"pose":{"translation":{"x":7.950843329516068,"y":-2.094108824451757},"rotation":{"radians":2.7972782360194564}},"curvature":1.5443438113927963},{"time":8.326560992502078,"velocity":1.051824637848531,"acceleration":-2.700000000000002,"pose":{"translation":{"x":7.925711454652953,"y":-2.0857136515938453},"rotation":{"radians":2.842658562480391}},"curvature":1.890770214344747},{"time":8.350137894675465,"velocity":0.9881670019803881,"acceleration":-1.4533537067555096,"pose":{"translation":{"x":7.902565652435012,"y":-2.079187199537263},"rotation":{"radians":2.8921981954611304}},"curvature":2.2233240146487505},{"time":8.37265038400572,"velocity":0.9554483921639689,"acceleration":1.6767314235851531,"pose":{"translation":{"x":7.881235420594512,"y":-2.0743230656958085},"rotation":{"radians":2.9432572396678096}},"curvature":2.4051521866217236},{"time":8.393308340503747,"velocity":0.9900862369712667,"acceleration":2.7000000000000433,"pose":{"translation":{"x":7.861444825300728,"y":-2.0708364009754545},"rotation":{"radians":2.990528456987154}},"curvature":2.2130313293743735},{"time":8.42886606016353,"velocity":1.0860920800526805,"acceleration":-0.3424345856523786,"pose":{"translation":{"x":7.824797010887067,"y":-2.0664273658442296},"rotation":{"radians":3.0394728110287135}},"curvature":-6.470603775807473E-14},{"time":8.462774162437217,"velocity":1.074480773100332,"acceleration":-1.5265314774706857,"pose":{"translation":{"x":7.788310412083789,"y":-2.063184080351655},"rotation":{"radians":3.0774465490249305}},"curvature":1.7967886873097225},{"time":8.50120323065697,"velocity":1.0158175908130118,"acceleration":2.097501982261252,"pose":{"translation":{"x":7.748157874338372,"y":-2.0622200360086604},"rotation":{"radians":-3.123736808043525}},"curvature":2.07879261151492},{"time":8.544723426641886,"velocity":1.1071012881597735,"acceleration":2.6678112942526093,"pose":{"translation":{"x":7.702054716574165,"y":-2.06513031778844},"rotation":{"radians":-3.03674328024524}},"curvature":1.6529059403813806},{"time":8.590593499635952,"velocity":1.2294739869615348,"acceleration":2.199914164050796,"pose":{"translation":{"x":7.649024196119884,"y":-2.072849896501622},"rotation":{"radians":-2.9615601598952477}},"curvature":1.181188700520552},{"time":8.638346766779149,"velocity":1.3345270757295562,"acceleration":1.5054118676132593,"pose":{"translation":{"x":7.589178731516956,"y":-2.0857484906291237},"rotation":{"radians":-2.9004688142241486}},"curvature":0.8452453855759359},{"time":8.687981631591356,"velocity":1.409247990265233,"acceleration":0.9081634341302646,"pose":{"translation":{"x":7.523501125326847,"y":-2.1037254281549966},"rotation":{"radians":-2.8507253424680528}},"curvature":0.636781284978852},{"time":8.739242744283414,"velocity":1.4558014584049916,"acceleration":0.4527206447905996,"pose":{"translation":{"x":7.453625786938398,"y":-2.126304508399278},"rotation":{"radians":-2.8088219246125563}},"curvature":0.5177211481018152},{"time":8.791504691816202,"velocity":1.4794615209900477,"acceleration":0.08692443710880228,"pose":{"translation":{"x":7.381619955375154,"y":-2.15272886385084},"rotation":{"radians":-2.771662401963276}},"curvature":0.46008247478883263},{"time":8.843881957661397,"velocity":1.4840143853409393,"acceleration":-0.254994135680084,"pose":{"translation":{"x":7.309764922102707,"y":-2.1820558220002377},"rotation":{"radians":-2.736654031219335}},"curvature":0.44920202529781117},{"time":8.895399445688886,"velocity":1.4708777280089609,"acceleration":-0.6238437150719603,"pose":{"translation":{"x":7.240337253836017,"y":-2.213251767172558},"rotation":{"radians":-2.701539057666239}},"curvature":0.48077926035526586},{"time":8.945159231114367,"velocity":1.4398353986079448,"acceleration":-1.0189333596470294,"pose":{"translation":{"x":7.175390015346758,"y":-2.245287002360271},"rotation":{"radians":-2.6642551963112693}},"curvature":0.5576867783405137},{"time":8.992460283295133,"velocity":1.3916387785945588,"acceleration":-1.4421640299028808,"pose":{"translation":{"x":7.116533992270641,"y":-2.2772306110560763},"rotation":{"radians":-2.623016286822631}},"curvature":0.6838931046408323},{"time":9.036914670605878,"velocity":1.3275282602436302,"acceleration":-2.699999999999997,"pose":{"translation":{"x":7.0647189139147555,"y":-2.308345319085754},"rotation":{"radians":-2.576972633539228}},"curvature":0.8444883519439439},{"time":9.079221172134982,"velocity":1.2133007061150476,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":7.020014676064896,"y":-2.3381823564410142},"rotation":{"radians":-2.5281598583293086}},"curvature":0.9498730823595691},{"time":9.16327437253769,"velocity":0.9863570650277339,"acceleration":-2.7,"pose":{"translation":{"x":6.946506474263991,"y":-2.3942400309218606},"rotation":{"radians":-2.4662069846324957}},"curvature":3.7238916103586064E-14},{"time":9.21172387050677,"velocity":0.8555434205112212,"acceleration":-1.5490429864418336,"pose":{"translation":{"x":6.912492658628538,"y":-2.4231185175536285},"rotation":{"radians":-2.3862820551986044}},"curvature":3.0464233668006737},{"time":9.240368152882505,"velocity":0.8111721957954307,"acceleration":1.0290556073030974,"pose":{"translation":{"x":6.89575527999312,"y":-2.4401385575041776},"rotation":{"radians":-2.308050953734574}},"curvature":3.381890683887842},{"time":9.271460637342713,"velocity":0.8431680912741916,"acceleration":2.4249918235918972,"pose":{"translation":{"x":6.879298084340957,"y":-2.4599025674773163},"rotation":{"radians":-2.2233359719365504}},"curvature":3.136436204754446},{"time":9.303355817194161,"velocity":0.9205136416259456,"acceleration":2.7000000000000246,"pose":{"translation":{"x":6.863167973852614,"y":-2.4829442258609147},"rotation":{"radians":-2.1422368906768354}},"curvature":2.6135648457067586},{"time":9.335513685471764,"velocity":1.0073398859754712,"acceleration":2.7000000000000064,"pose":{"translation":{"x":6.847391279330069,"y":-2.5096268300895925},"rotation":{"radians":-2.07026463655363}},"curvature":2.0435491465403537},{"time":9.368047578918766,"velocity":1.0951813982823801,"acceleration":2.700000000000019,"pose":{"translation":{"x":6.831975597691697,"y":-2.540157246391499},"rotation":{"radians":-2.009352330707406}},"curvature":1.541946247005455},{"time":9.401032074681568,"velocity":1.1842395368419463,"acceleration":2.699999999999971,"pose":{"translation":{"x":6.816911629467265,"y":-2.574599859535099},"rotation":{"radians":-1.9593348342159804}},"curvature":1.1419697432047926},{"time":9.4680233380225,"velocity":1.3651159478624586,"acceleration":2.700000000000021,"pose":{"translation":{"x":6.787728178406189,"y":-2.654850506603511},"rotation":{"radians":-1.8873424291777199}},"curvature":0.608418448182074},{"time":9.535256162296552,"velocity":1.5466445734024024,"acceleration":1.3699443091701744,"pose":{"translation":{"x":6.759498427422431,"y":-2.7485743106265987},"rotation":{"radians":-1.8442806489395138}},"curvature":0.30411922262559415},{"time":9.60283549723686,"velocity":1.639224498721383,"acceleration":0.6721403475741796,"pose":{"translation":{"x":6.731727135253214,"y":-2.8525798913752896},"rotation":{"radians":-1.8225479098219377}},"curvature":0.11443137153963127},{"time":9.671199289048976,"velocity":1.685174561511467,"acceleration":-1.0010468221658793,"pose":{"translation":{"x":6.703825117937088,"y":-2.962735340956731},"rotation":{"radians":-1.817869226715477}},"curvature":-0.027152988921298825},{"time":9.741067869161508,"velocity":1.6152328414205757,"acceleration":-1.075744110900926,"pose":{"translation":{"x":6.6751680486536085,"y":-3.0744146157113525},"rotation":{"radians":-1.828666195258849}},"curvature":-0.1619748100357139},{"time":9.812479033364319,"velocity":1.5384127020768226,"acceleration":-1.352326751908637,"pose":{"translation":{"x":6.645155257563037,"y":-3.1829439281099274},"rotation":{"radians":-1.855551539003105}},"curvature":-0.32418233903339805},{"time":9.883613929017951,"velocity":1.442215079690186,"acceleration":-1.7372921254519156,"pose":{"translation":{"x":6.613268531646019,"y":-3.2840481386506353},"rotation":{"radians":-1.9010605381848522}},"curvature":-0.5516739363610972},{"time":9.953455685803503,"velocity":1.3208795455989195,"acceleration":-1.9591957859773999,"pose":{"translation":{"x":6.579130914543283,"y":-3.3742971477561254},"rotation":{"radians":-1.9691391078104796}},"curvature":-0.8858679530327882},{"time":9.987751856068073,"velocity":1.2536866333414114,"acceleration":-1.9450654469867061,"pose":{"translation":{"x":6.561153318076035,"y":-3.414619965513007},"rotation":{"radians":-2.0128016632684957}},"curvature":-1.0987677097985284},{"time":10.021621383965634,"velocity":1.187808184922112,"acceleration":-1.7003523117245682,"pose":{"translation":{"x":6.542565506395319,"y":-3.4515522876705784},"rotation":{"radians":-2.062952075998754}},"curvature":-1.330887390314826},{"time":10.054950947654616,"velocity":1.1311361842547814,"acceleration":-1.1113009003143888,"pose":{"translation":{"x":6.523386272695484,"y":-3.48510180315209},"rotation":{"radians":-2.1187283605888947}},"curvature":-1.5522025925542173},{"time":10.087444275233299,"velocity":1.09502632006238,"acceleration":0.01020845641176925,"pose":{"translation":{"x":6.503654263682076,"y":-3.515412714356767},"rotation":{"radians":-2.1779348894589883}},"curvature":-1.7051669732929187},{"time":10.118515828783995,"velocity":1.0953435126624482,"acceleration":2.124110965381601,"pose":{"translation":{"x":6.483429817066828,"y":-3.5427796869065977},"rotation":{"radians":-2.236522483120569}},"curvature":-1.703779412372876},{"time":10.147226929856393,"velocity":1.156329077278507,"acceleration":0.9206491803267031,"pose":{"translation":{"x":6.462796799062646,"y":-3.567661799393118},"rotation":{"radians":-2.288343529206002}},"curvature":-1.4511411224005597},{"time":10.199424291912349,"velocity":1.2043845358705387,"acceleration":-2.700000000000002,"pose":{"translation":{"x":6.420769181214953,"y":-3.6127135218707798},"rotation":{"radians":-2.3396320342251364}},"curvature":-8.785730072248707E-14},{"time":10.25457573583154,"velocity":1.0554756372887206,"acceleration":-0.8752119788787013,"pose":{"translation":{"x":6.376315085610258,"y":-3.6563858958322046},"rotation":{"radians":-2.4102355879426707}},"curvature":-1.8847168557367389},{"time":10.287186095882683,"velocity":1.0269346595364135,"acceleration":1.1549720875248313,"pose":{"translation":{"x":6.350299838596863,"y":-3.678205293550359},"rotation":{"radians":-2.477888188324217}},"curvature":-2.022876667598723},{"time":10.322612614036894,"velocity":1.0678512991627183,"acceleration":2.025770306638546,"pose":{"translation":{"x":6.32025329339525,"y":-3.699977345411494},"rotation":{"radians":-2.5499513716156486}},"curvature":-1.8271048025899352},{"time":10.359752625546953,"velocity":1.143088431668011,"acceleration":2.2539696144836014,"pose":{"translation":{"x":6.285387135310254,"y":-3.7216577904520323},"rotation":{"radians":-2.6183875516373663}},"curvature":-1.503700691567667},{"time":10.39820946590684,"velocity":1.229768981308244,"acceleration":2.09991803212859,"pose":{"translation":{"x":6.245161582364793,"y":-3.7431906510113553},"rotation":{"radians":-2.6793541751944927}},"curvature":-1.180164995754114},{"time":10.438008167821941,"velocity":1.3133429931150742,"acceleration":1.7646614094518072,"pose":{"translation":{"x":6.199265123004631,"y":-3.7645098996189983},"rotation":{"radians":-2.7318382797356637}},"curvature":-0.9086627255598744},{"time":10.479337721053204,"velocity":1.3862756607721693,"acceleration":1.2168632821218373,"pose":{"translation":{"x":6.147594253803128,"y":-3.785541125881846},"rotation":{"radians":-2.776305612797448}},"curvature":-0.6984794042170638},{"time":10.567482712129001,"velocity":1.493536063915263,"acceleration":0.7850835151636603,"pose":{"translation":{"x":6.027433739036054,"y":-3.826409956510616},"rotation":{"radians":-2.8455080275124303}},"curvature":-0.4266615222945548},{"time":10.614200104520263,"velocity":1.5302131185530752,"acceleration":0.5787035339577858,"pose":{"translation":{"x":5.95959476659799,"y":-3.846071827461813},"rotation":{"radians":-2.872484959923957}},"curvature":-0.3424579088749689},{"time":10.662646373954473,"velocity":1.5582491458817236,"acceleration":0.42525687665854406,"pose":{"translation":{"x":5.887242205983105,"y":-3.865097543013155},"rotation":{"radians":-2.8956588719414804}},"curvature":-0.2807655228458109},{"time":10.712617768614138,"velocity":1.579499825096964,"acceleration":0.31179751036263537,"pose":{"translation":{"x":5.8110086599740765,"y":-3.883395781466203},"rotation":{"radians":-2.9157917059534637}},"curvature":-0.2354632233329098},{"time":10.763829120994037,"velocity":1.5954673972713205,"acceleration":0.2270298228580042,"pose":{"translation":{"x":5.73161316570971,"y":-3.9008768395230398},"rotation":{"radians":-2.9335059450671466}},"curvature":-0.2022175385439517},{"time":10.815931415711656,"velocity":1.607296172011557,"acceleration":0.16205326479114002,"pose":{"translation":{"x":5.649840932389695,"y":-3.9174542991734635},"rotation":{"radians":-2.9493103840895123}},"curvature":-0.17801506086595623},{"time":10.86852915409452,"velocity":1.6158198072371306,"acceleration":0.11007048049600118,"pose":{"translation":{"x":5.566523078979362,"y":-3.9330466945821847},"rotation":{"radians":-2.963624962822164}},"curvature":-0.16079479196767424},{"time":10.921197019322982,"velocity":1.6216169844695258,"acceleration":0.06580449574539403,"pose":{"translation":{"x":5.482516371914434,"y":-3.9475791789760195},"rotation":{"radians":-2.976802370932379}},"curvature":-0.14918620719730213},{"time":10.97349577133028,"velocity":1.6250584774734795,"acceleration":0.024904059779576708,"pose":{"translation":{"x":5.398682962805785,"y":-3.9609851915310874},"rotation":{"radians":-2.989146120817061}},"curvature":-0.14233395207527094},{"time":11.024987454418012,"velocity":1.6263408294272474,"acceleration":-0.016587038571925374,"pose":{"translation":{"x":5.315870126144195,"y":-3.9732081242600046},"rotation":{"radians":-3.00092548700416}},"curvature":-0.1397881150974787},{"time":11.07525002594381,"velocity":1.625507122214625,"acceleration":-0.06268240420387107,"pose":{"translation":{"x":5.234889997005103,"y":-3.9842029888990793},"rotation":{"radians":-3.012387816429518}},"curvature":-0.14144280656721547},{"time":11.123891470092946,"velocity":1.6224581595514087,"acceleration":-0.11778535310334978,"pose":{"translation":{"x":5.156499308753365,"y":-3.9939380837955083},"rotation":{"radians":-3.0237684961697475}},"curvature":-0.1475086840559134},{"time":11.170563356104577,"velocity":1.6169608949775296,"acceleration":-0.18672774078641635,"pose":{"translation":{"x":5.081379130748006,"y":-4.002396660794571},"rotation":{"radians":-3.035298361514186}},"curvature":-0.15850323580245387},{"time":11.214973608450492,"velocity":1.6086682688892222,"acceleration":-0.27401822244366575,"pose":{"translation":{"x":5.010114606046979,"y":-4.009578592126826},"rotation":{"radians":-3.047207399876443}},"curvature":-0.17523069512555497},{"time":11.256897913616264,"velocity":1.5971802453105115,"acceleration":-0.4378202221337657,"pose":{"translation":{"x":4.943174689111917,"y":-4.015502037295304},"rotation":{"radians":-3.0597219312633457}},"curvature":-0.19869073813860108},{"time":11.332830785651485,"velocity":1.5639352984087966,"acceleration":-0.5871126779966352,"pose":{"translation":{"x":4.823441979633157,"y":-4.0237475448385975},"rotation":{"radians":-3.087340779085486}},"curvature":-0.26852311800633544},{"time":11.398004781833178,"velocity":1.5256708189748203,"acceleration":0.1441405295650814,"pose":{"translation":{"x":4.722838898859122,"y":-4.027707546611592},"rotation":{"radians":-3.118600865487617}},"curvature":-0.3526665262019231},{"time":11.452903029594097,"velocity":1.5335838814792742,"acceleration":2.700000000000026,"pose":{"translation":{"x":4.638867538900432,"y":-4.028355682941507},"rotation":{"radians":3.134193406278902}},"curvature":-0.3349213575059871},{"time":11.499054226605415,"velocity":1.6581921134098325,"acceleration":-0.2763521812051717,"pose":{"translation":{"x":4.565225793983127,"y":-4.027118211685881},"rotation":{"radians":3.119532747890574}},"curvature":1.0445111381716666E-14},{"time":11.542942392482681,"velocity":1.6460635230405554,"acceleration":-0.714593188853118,"pose":{"translation":{"x":4.492736692986186,"y":-4.025425587399811},"rotation":{"radians":3.1157274098743724}},"curvature":-0.10113255385917395},{"time":11.59014011657135,"velocity":1.6123363508774233,"acceleration":-0.292805319955336,"pose":{"translation":{"x":4.415878538643393,"y":-4.023060694580309},"rotation":{"radians":3.1050863323492646}},"curvature":-0.16781040639089778},{"time":11.642547572933546,"velocity":1.5969911688492449,"acceleration":-0.11008105142662906,"pose":{"translation":{"x":4.331863989735447,"y":-4.019352463536454},"rotation":{"radians":3.0894485216049983}},"curvature":-0.19907968021834835},{"time":11.700667930724148,"velocity":1.5905932187543637,"acceleration":-0.0673265662020392,"pose":{"translation":{"x":4.239407988637887,"y":-4.013648680023455},"rotation":{"radians":3.070309535161586}},"curvature":-0.21229516558770364},{"time":11.764420500083641,"velocity":1.5863009771728316,"acceleration":-0.08403806036612671,"pose":{"translation":{"x":4.138482218723533,"y":-4.005335287622396},"rotation":{"radians":3.048355541605678}},"curvature":-0.2212208874672857},{"time":11.833271196054255,"velocity":1.5805148982286032,"acceleration":-0.1242909843858384,"pose":{"translation":{"x":4.030069561764939,"y":-3.9938556901199824},"rotation":{"radians":3.0236208750960203}},"curvature":-0.23332977039324315},{"time":11.906336325379367,"velocity":1.5714335613805064,"acceleration":-0.17594029486250287,"pose":{"translation":{"x":3.9159185553368276,"y":-3.978730053888288},"rotation":{"radians":2.9957206331802015}},"curvature":-0.2525146499929524},{"time":11.982496441526122,"velocity":1.558033928088884,"acceleration":-0.23498460394896387,"pose":{"translation":{"x":3.7982978502185523,"y":-3.959574610264494},"rotation":{"radians":2.9640140038545777}},"curvature":-0.28123064633901756},{"time":12.060517973576868,"velocity":1.539700069280448,"acceleration":-0.2962637576844658,"pose":{"translation":{"x":3.6797506677965313,"y":-3.936120957930634},"rotation":{"radians":2.9277241053275245}},"curvature":-0.3213306815154098},{"time":12.139168113263256,"velocity":1.5163988833545503,"acceleration":-0.3448555990754039,"pose":{"translation":{"x":3.562849257466702,"y":-3.908235365293341},"rotation":{"radians":2.8860852561275623}},"curvature":-0.37369462568428025},{"time":12.217301484643633,"velocity":1.4894541527593894,"acceleration":-0.3440193068411701,"pose":{"translation":{"x":3.4499493540369652,"y":-3.875938072863587},"rotation":{"radians":2.838615334614565}},"curvature":-0.4362892678837039},{"time":12.293888323080651,"velocity":1.4631068016871298,"acceleration":-0.21778671556392187,"pose":{"translation":{"x":3.342944635129632,"y":-3.8394225956364316},"rotation":{"radians":2.7856479754983257}},"curvature":-0.4997255468989406},{"time":12.36794933304478,"velocity":1.4469772975756952,"acceleration":0.17349733312162724,"pose":{"translation":{"x":3.24302117858387,"y":-3.799075025470763},"rotation":{"radians":2.7292736447688255}},"curvature":-0.5397004279542463},{"time":12.438386615639988,"velocity":1.4591979782582982,"acceleration":1.0755636426903583,"pose":{"translation":{"x":3.1504119198581533,"y":-3.755493333469042},"rotation":{"radians":2.6747054774040295}},"curvature":-0.5093319258664528},{"time":12.503800695796702,"velocity":1.5295549845948928,"acceleration":1.0293689523546892,"pose":{"translation":{"x":3.0641511094327045,"y":-3.7095066723570476},"rotation":{"radians":2.6315859281745646}},"curvature":-0.34393327971846144},{"time":12.564632020107858,"velocity":1.592172861171415,"acceleration":-2.700000000000003,"pose":{"translation":{"x":2.9818287702119473,"y":-3.6621946788636204},"rotation":{"radians":2.61381292958755}},"curvature":-1.9027825223710256E-15},{"time":12.628316965519623,"velocity":1.420223508559651,"acceleration":-0.48168462802390927,"pose":{"translation":{"x":2.8995436358693594,"y":-3.612897464236379},"rotation":{"radians":2.580081886630966}},"curvature":-0.6080083060351892},{"time":12.702429745827596,"velocity":1.3845245215451873,"acceleration":0.6797364608625057,"pose":{"translation":{"x":2.8135661463895683,"y":-3.5545012842586403},"rotation":{"radians":2.508327195086527}},"curvature":-0.7032665244748748},{"time":12.78544786977689,"velocity":1.4409549673059254,"acceleration":0.8263588704484359,"pose":{"translation":{"x":2.7217864266842637,"y":-3.481482205293185},"rotation":{"radians":2.4337497128618377}},"curvature":-0.5548554423881346},{"time":12.829670401187924,"velocity":1.4774986484111179,"acceleration":0.770913483861659,"pose":{"translation":{"x":2.673474716836495,"y":-3.438701481059494},"rotation":{"radians":2.4008973418097064}},"curvature":-0.4647940405027476},{"time":12.875519829143231,"velocity":1.5128445906492085,"acceleration":0.6768113260755564,"pose":{"translation":{"x":2.623579636617841,"y":-3.3916912444437286},"rotation":{"radians":2.3719616601432105}},"curvature":-0.38182385414048},{"time":12.922900343349916,"velocity":1.5449122592995765,"acceleration":0.5765686284933887,"pose":{"translation":{"x":2.5722115693647036,"y":-3.3406154474101024},"rotation":{"radians":2.3470019232044663}},"curvature":-0.3098336902163917},{"time":12.97167367042207,"velocity":1.5730334295966284,"acceleration":0.4865297203430967,"pose":{"translation":{"x":2.519540533396691,"y":-3.285776777314025},"rotation":{"radians":2.325836768792591}},"curvature":-0.24911875583921378},{"time":13.021641770816437,"velocity":1.5973443955075755,"acceleration":0.41336107365808844,"pose":{"translation":{"x":2.4657878870912824,"y":-3.2275986071445737},"rotation":{"radians":2.308186745275199}},"curvature":-0.19835314560938297},{"time":13.072541834871789,"velocity":1.618384500634761,"acceleration":0.358814214280737,"pose":{"translation":{"x":2.411218033958493,"y":-3.166606945766967},"rotation":{"radians":2.293757287760986}},"curvature":-0.15564885186436597},{"time":13.12404910627547,"velocity":1.6368660417532173,"acceleration":0.32278989353165793,"pose":{"translation":{"x":2.3561301277155406,"y":-3.103412388165035},"rotation":{"radians":2.2822838444841196}},"curvature":-0.11904327590222011},{"time":13.175784224273231,"velocity":1.6535656149835622,"acceleration":0.30520031817025983,"pose":{"translation":{"x":2.3008497773615084,"y":-3.0386920656836898},"rotation":{"radians":2.273555213149328}},"curvature":-0.08667088976603955},{"time":13.227322899882406,"velocity":1.669295235177556,"acceleration":0.30721636223396187,"pose":{"translation":{"x":2.2457207522520135,"y":-2.9731715962714027},"rotation":{"radians":2.267425667238858}},"curvature":-0.05677113949934914},{"time":13.278206560442488,"velocity":1.684927528271972,"acceleration":0.2733353037508124,"pose":{"translation":{"x":2.1910966871738706,"y":-2.9076070347226706},"rotation":{"radians":2.263822494215176}},"curvature":-0.02760948093532069},{"time":13.327996176729838,"velocity":1.6985367881635114,"acceleration":-0.37425694598751763,"pose":{"translation":{"x":2.1373327874197585,"y":-2.84276682292049},"rotation":{"radians":2.2627531020751186}},"curvature":0.0026588095980958166},{"time":13.376719692503276,"velocity":1.6803016739523704,"acceleration":-0.4402806091227806,"pose":{"translation":{"x":2.084777533862883,"y":-2.77941374007883},"rotation":{"radians":2.2643144932083827}},"curvature":0.0361823734146111},{"time":13.424399990926025,"velocity":1.6593089631196465,"acceleration":-0.5493463855974177,"pose":{"translation":{"x":2.0337643880316456,"y":-2.718286852985102},"rotation":{"radians":2.2687072740699055}},"curvature":0.07568790550312685},{"time":13.470669145453295,"velocity":1.6338911703154428,"acceleration":-0.7181563300254432,"pose":{"translation":{"x":1.9846034971843065,"y":-2.660083466242634},"rotation":{"radians":2.2762561427406975}},"curvature":0.12487955226078513},{"time":13.515229971355744,"velocity":1.601889531122437,"acceleration":-0.970183333115712,"pose":{"translation":{"x":1.9375733993836521,"y":-2.605441072513141},"rotation":{"radians":2.287438617946777}},"curvature":0.1890330657920605},{"time":13.55787576392116,"velocity":1.5605152939479603,"acceleration":-2.127926314925411,"pose":{"translation":{"x":1.8929127285716572,"y":-2.5549193027591963},"rotation":{"radians":2.3029230215036987}},"curvature":0.2758757659614612},{"time":13.63869712132812,"velocity":1.3885334007136982,"acceleration":-2.700000000000001,"pose":{"translation":{"x":1.8114049135254957,"y":-2.467978551987378},"rotation":{"radians":2.350695972076689}},"curvature":0.5685185025617454},{"time":13.714016313486416,"velocity":1.185171581886299,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":1.7408758340027208,"y":-2.4014951368588893},"rotation":{"radians":2.4301259998546376}},"curvature":1.1594399953861771},{"time":13.749460927709931,"velocity":1.089471123482807,"acceleration":-2.7,"pose":{"translation":{"x":1.7096645182619052,"y":-2.375982308924407},"rotation":{"radians":2.485619323674266}},"curvature":1.6227413819043401},{"time":13.783364145191781,"velocity":0.9979324362818115,"acceleration":-2.531052349917399,"pose":{"translation":{"x":1.6809519308058656,"y":-2.3553020086373926},"rotation":{"radians":2.552435770930835}},"curvature":2.171364631391899},{"time":13.815891055418348,"velocity":0.9156051237173057,"acceleration":-0.1892452918602197,"pose":{"translation":{"x":1.654465118821541,"y":-2.3389634418556433},"rotation":{"radians":2.6277965526160827}},"curvature":2.64412220690692},{"time":13.846267083429165,"velocity":0.9098566034308444,"acceleration":2.6999999999999726,"pose":{"translation":{"x":1.6298248659723855,"y":-2.326253554677601},"rotation":{"radians":2.703167052135317}},"curvature":2.6803280624068115},{"time":13.896843739604801,"velocity":1.0464135751050583,"acceleration":2.7000000000000295,"pose":{"translation":{"x":1.583986085163955,"y":-2.3076480061843827},"rotation":{"radians":2.786606260429607}},"curvature":8.592995633694338E-14},{"time":13.983018627548391,"velocity":1.279085772552753,"acceleration":2.061978481265625,"pose":{"translation":{"x":1.4893755323265903,"y":-2.274650312466343},"rotation":{"radians":2.8372142395833095}},"curvature":0.7239459086926191},{"time":14.071137051705898,"velocity":1.4607840669685688,"acceleration":1.087644078749372,"pose":{"translation":{"x":1.3728395025224664,"y":-2.2431570011535302},"rotation":{"radians":2.913326885158181}},"curvature":0.5054277340889791},{"time":14.118166449060281,"velocity":1.5119353125282151,"acceleration":0.8182761628478303,"pose":{"translation":{"x":1.304503846050622,"y":-2.228439270155428},"rotation":{"radians":2.944175432520685}},"curvature":0.3839096563597912},{"time":14.16736179075609,"velocity":1.5521906879610494,"acceleration":0.5775729352751698,"pose":{"translation":{"x":1.230408464762658,"y":-2.2146347035242937},"rotation":{"radians":2.9694897785813184}},"curvature":0.29390820593466904},{"time":14.21799278558485,"velocity":1.5814337802601985,"acceleration":0.39793963473829264,"pose":{"translation":{"x":1.152109707849354,"y":-2.201889645862831},"rotation":{"radians":2.9901526424611977}},"curvature":0.23140085106408814},{"time":14.269105139391018,"velocity":1.6017734116644398,"acceleration":-1.3137247913085353,"pose":{"translation":{"x":1.0715855102106553,"y":-2.1903235440958575},"rotation":{"radians":3.0071444066477278}},"curvature":0.18927051748357565},{"time":14.320909641603823,"velocity":1.5337165528060785,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":0.9910251658679915,"y":-2.18002257696765},"rotation":{"radians":3.0213152676744084}},"curvature":0.161650865965686},{"time":14.37493529334109,"velocity":1.3878472931154562,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":0.9126191013765993,"y":-2.1710332845392846},"rotation":{"radians":3.0333397100662767}},"curvature":0.1444134068491366},{"time":14.431890747030911,"velocity":1.2340675681529418,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":0.8383486492378404,"y":-2.1633561976859843},"rotation":{"radians":3.0437220192865366}},"curvature":0.13458710682425928},{"time":14.49160014738355,"velocity":1.0728521872008154,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":0.7697758213115222,"y":-2.1569394675944564},"rotation":{"radians":3.0527956523357824}},"curvature":0.12927593512599192},{"time":14.62284469458929,"velocity":0.7184919097453182,"acceleration":-2.7,"pose":{"translation":{"x":0.6526131228015871,"y":-2.147379560985048},"rotation":{"radians":3.0671897751563013}},"curvature":0.10812957711028834},{"time":14.888952809309778,"velocity":0.0,"acceleration":-2.7,"pose":{"translation":{"x":0.5572520775623289,"y":-2.140649101333506},"rotation":{"radians":3.0733228465329727}},"curvature":3.765668400713878E-14}] \ 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 2bc3f90..680f1c1 100644 --- a/src/main/java/frc4388/robot/RobotContainer.java +++ b/src/main/java/frc4388/robot/RobotContainer.java @@ -39,9 +39,11 @@ import frc4388.robot.commands.auto.DriveOffLineForward; import frc4388.robot.commands.auto.EightBallAutoMiddle; import frc4388.robot.commands.auto.FiveBallAutoMiddle; import frc4388.robot.commands.auto.SixBallAutoMiddle; +import frc4388.robot.commands.auto.Slalom; import frc4388.robot.commands.auto.TenBallAutoMiddle; import frc4388.robot.commands.InterruptSubystem; import frc4388.robot.commands.auto.AutoPath1FromCenter; +import frc4388.robot.commands.auto.Barrel; import frc4388.robot.commands.auto.Wait; import frc4388.robot.commands.climber.DisengageRachet; import frc4388.robot.commands.climber.RunClimberWithTriggers; @@ -119,6 +121,10 @@ public class RobotContainer { TenBallAutoMiddle m_tenBallAutoMiddle; + Slalom m_slalom; + + Barrel m_barrel; + /** * The container for the robot. Contains subsystems, OI devices, and commands. @@ -177,7 +183,7 @@ public class RobotContainer { // B driver test button new JoystickButton(getDriverJoystick(), XboxController.B_BUTTON) - .whenPressed(new TurnDegrees(m_robotDrive, m_robotDrive.m_currentAngleYaw + 5)); + .whenPressed(new TurnDegrees(m_robotDrive, 45)); // Y driver test button new JoystickButton(getDriverJoystick(), XboxController.Y_BUTTON) .whenPressed(new Wait(m_robotDrive, 0, 0)); @@ -276,6 +282,18 @@ public class RobotContainer { m_sixBallAutoMiddle = new SixBallAutoMiddle(m_robotDrive, buildPaths(sixBallAutoMiddlePaths)); + String[] slalom = new String[]{ + "Slalom" + }; + + m_slalom = new Slalom(m_robotDrive, buildPaths(slalom)); + + String[] barrel = new String[]{ + "Barrel" + }; + + m_barrel = new Barrel(m_robotDrive, buildPaths(barrel)); + String[] eightBallAutoMiddlePaths = new String[]{ "EightBallMidComplete" }; @@ -324,10 +342,12 @@ public class RobotContainer { //return m_sixBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); //return m_eightBallAutoMiddle.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); - return m_driveOffLineForward.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); + //return m_driveOffLineForward.andThen(() -> m_robotDrive.tankDriveVelocity(0, 0)); //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 m_slalom.andThen(()-> m_robotDrive.tankDriveVelocity(0, 0)); + return m_barrel.andThen(()-> m_robotDrive.tankDriveVelocity(0, 0)); } catch (Exception e) { System.err.println("ERROR"); @@ -454,6 +474,7 @@ public class RobotContainer { return m_driverXbox; } + /** * Used for analog inputs like triggers and axises. * @return The IHandController interface for the Operator Controller. diff --git a/src/main/java/frc4388/robot/commands/auto/Barrel.java b/src/main/java/frc4388/robot/commands/auto/Barrel.java new file mode 100644 index 0000000..54908bf --- /dev/null +++ b/src/main/java/frc4388/robot/commands/auto/Barrel.java @@ -0,0 +1,28 @@ +/*----------------------------------------------------------------------------*/ +/* Copyright (c) 2019 FIRST. All Rights Reserved. */ +/* Open Source Software - may be modified and shared by FRC teams. The code */ +/* must be accompanied by the FIRST BSD license file in the root directory of */ +/* the project. */ +/*----------------------------------------------------------------------------*/ + +package frc4388.robot.commands.auto; + +import edu.wpi.first.wpilibj2.command.RamseteCommand; +import edu.wpi.first.wpilibj2.command.SequentialCommandGroup; +import frc4388.robot.subsystems.Drive; + +// NOTE: Consider using this command inline, rather than writing a subclass. For more +// information, see: +// https://docs.wpilib.org/en/latest/docs/software/commandbased/convenience-features.html +public class Barrel extends SequentialCommandGroup { + /** + * Creates a new Barrel. + */ + public Barrel(Drive drive, RamseteCommand[] paths) { + // Add your commands in the super() call, e.g. + // super(new FooCommand(), new BarCommand()); + addCommands( + paths[0] + ); + } +} diff --git a/src/main/java/frc4388/robot/commands/auto/Slalom.java b/src/main/java/frc4388/robot/commands/auto/Slalom.java new file mode 100644 index 0000000..40159d1 --- /dev/null +++ b/src/main/java/frc4388/robot/commands/auto/Slalom.java @@ -0,0 +1,28 @@ +/*----------------------------------------------------------------------------*/ +/* Copyright (c) 2019 FIRST. All Rights Reserved. */ +/* Open Source Software - may be modified and shared by FRC teams. The code */ +/* must be accompanied by the FIRST BSD license file in the root directory of */ +/* the project. */ +/*----------------------------------------------------------------------------*/ + +package frc4388.robot.commands.auto; + +import edu.wpi.first.wpilibj2.command.RamseteCommand; +import edu.wpi.first.wpilibj2.command.SequentialCommandGroup; +import frc4388.robot.subsystems.Drive; + +// NOTE: Consider using this command inline, rather than writing a subclass. For more +// information, see: +// https://docs.wpilib.org/en/latest/docs/software/commandbased/convenience-features.html +public class Slalom extends SequentialCommandGroup { + /** + * Creates a new Slalom. + */ + public Slalom(Drive drive, RamseteCommand[] paths) { + // Add your commands in the super() call, e.g. + // super(new FooCommand(), new BarCommand()); + addCommands( + paths[0] + ); + } +} diff --git a/src/main/java/frc4388/robot/commands/drive/TurnDegrees.java b/src/main/java/frc4388/robot/commands/drive/TurnDegrees.java index b9f7d35..8b5d199 100644 --- a/src/main/java/frc4388/robot/commands/drive/TurnDegrees.java +++ b/src/main/java/frc4388/robot/commands/drive/TurnDegrees.java @@ -38,6 +38,7 @@ public class TurnDegrees extends CommandBase { public void initialize() { m_targetAngleTicksIn = (m_targetAngle / 360) * DriveConstants.TICKS_PER_GYRO_REV; m_currentYawInTicks = (m_drive.getGyroYaw() / 360) * DriveConstants.TICKS_PER_GYRO_REV; + SmartDashboard.putNumber("Current Yaw Ticks", m_currentYawInTicks); m_targetAngleTicksOut = m_targetAngleTicksIn + m_currentYawInTicks; i = 0; @@ -48,7 +49,7 @@ public class TurnDegrees extends CommandBase { public void execute() { m_currentYawInTicks = (m_drive.getGyroYaw() / 360) * DriveConstants.TICKS_PER_GYRO_REV; - m_drive.runTurningPID(m_targetAngleTicksOut); + m_drive.runTurningPID(m_targetAngleTicksIn); SmartDashboard.putNumber("Turning Error", Math.abs(m_currentYawInTicks - m_targetAngleTicksOut)); SmartDashboard.putNumber("Turning Target", m_targetAngleTicksOut);