diff --git a/PathWeaver/Paths/FiveBallMidComplete b/PathWeaver/Paths/FiveBallMidComplete index c2f4041..6783265 100644 --- a/PathWeaver/Paths/FiveBallMidComplete +++ b/PathWeaver/Paths/FiveBallMidComplete @@ -1,4 +1,5 @@ X,Y,Tangent X,Tangent Y,Fixed Theta,Name 3.2,-2.3,0.5,0.0,true, -5.8746484146930245,-2.2145857763164236,0.9797262118384756,-0.6607896052402182,false, -6.5409266067515,-2.857068318658526,-0.24985432202192825,-0.10708042372368398,true, +5.910341889267586,-1.8695488554289974,0.2974456214546777,-0.16656954801461854,true, +6.374357058736883,-2.3097683751819202,-0.09518259886549707,-0.16656954801461987,true, +5.85085276497665,-2.4763379231965392,-0.22605867230555443,-0.11897824858187134,true, diff --git a/src/main/deploy/paths/FiveBallMidComplete.wpilib.json b/src/main/deploy/paths/FiveBallMidComplete.wpilib.json index 8b8d170..859b771 100644 --- a/src/main/deploy/paths/FiveBallMidComplete.wpilib.json +++ b/src/main/deploy/paths/FiveBallMidComplete.wpilib.json @@ -1 +1 @@ -[{"time":0.0,"velocity":0.0,"acceleration":2.7000000000000006,"pose":{"translation":{"x":3.2,"y":-2.3},"rotation":{"radians":0.0}},"curvature":0.0},{"time":0.16253437312191035,"velocity":0.43884280742915804,"acceleration":2.6999999999999993,"pose":{"translation":{"x":3.235655291298622,"y":-2.299233917261998},"rotation":{"radians":0.050203030073159544}},"curvature":1.48318905993772},{"time":0.26475953875061276,"velocity":0.7148507546266544,"acceleration":2.6999999999999997,"pose":{"translation":{"x":3.2944360548439127,"y":-2.2945352730858968},"rotation":{"radians":0.09912820467000355}},"curvature":0.4235442403261895},{"time":0.37690622350689507,"velocity":1.0176468034686166,"acceleration":2.699999999999998,"pose":{"translation":{"x":3.390973335372,"y":-2.28366884622584},"rotation":{"radians":0.12024382125741907}},"curvature":0.10475034952100395},{"time":0.43634063761718933,"velocity":1.178119721566411,"acceleration":2.7000000000000006,"pose":{"translation":{"x":3.455732936198907,"y":-2.2756673507299965},"rotation":{"radians":0.12502925945028812}},"curvature":0.04928050745126129},{"time":0.4972142356672923,"velocity":1.342478436301689,"acceleration":2.6999999999999975,"pose":{"translation":{"x":3.5318392672810157,"y":-2.265991501645676},"rotation":{"radians":0.12749945581685104}},"curvature":0.018712898811020638},{"time":0.5589028508420205,"velocity":1.5090376972734552,"acceleration":2.699999999999999,"pose":{"translation":{"x":3.6190725996188573,"y":-2.254762828521436},"rotation":{"radians":0.12827013383137298}},"curvature":6.382389439987909E-4},{"time":0.6208199608340345,"velocity":1.6762138942518927,"acceleration":0.20474125842093605,"pose":{"translation":{"x":3.716875586271945,"y":-2.2421666771189357},"rotation":{"radians":0.12771169861921847}},"curvature":-0.011011542191749546},{"time":0.6852310387503929,"velocity":1.689401499400737,"acceleration":-0.05305258852571156,"pose":{"translation":{"x":3.8243947783475503,"y":-2.22844328711919},"rotation":{"radians":0.12603866367906338}},"curvature":-0.019362727933097953},{"time":0.7545838260008766,"velocity":1.6857221545156258,"acceleration":-0.045806482602144795,"pose":{"translation":{"x":3.9405221409894784,"y":-2.2138788698288154},"rotation":{"radians":0.12336189171989319}},"curvature":-0.026141570374716056},{"time":0.8284141634951516,"velocity":1.6823402464456838,"acceleration":-0.0445672480823384,"pose":{"translation":{"x":4.063936569366847,"y":-2.198796685886281},"rotation":{"radians":0.11971802636802259}},"curvature":-0.032398566413562334},{"time":0.8667325821531024,"velocity":1.680632499975232,"acceleration":-0.04542286286009097,"pose":{"translation":{"x":4.127915543450831,"y":-2.191170385325926},"rotation":{"radians":0.11752858387876963}},"curvature":-0.03556770123464028},{"time":0.9058300099382188,"velocity":1.6788565828747664,"acceleration":-0.04739491083650032,"pose":{"translation":{"x":4.193145404662863,"y":-2.183548122968157},"rotation":{"radians":0.11508490225444941}},"curvature":-0.03887018160379375},{"time":0.9455848714943765,"velocity":1.6769724047559948,"acceleration":-0.050456872119439125,"pose":{"translation":{"x":4.259419576557454,"y":-2.1759767533084307},"rotation":{"radians":0.11237604173534803}},"curvature":-0.04238163050602945},{"time":0.9858730340914761,"velocity":1.6749395900879058,"acceleration":-0.05464666529357269,"pose":{"translation":{"x":4.326525950063592,"y":-2.1685037734953654},"rotation":{"radians":0.1093877910236385}},"curvature":-0.04617894557562544},{"time":1.0265686275990085,"velocity":1.6727157116105764,"acceleration":-0.06006268471382118,"pose":{"translation":{"x":4.394248180859394,"y":-2.1611770445090626},"rotation":{"radians":0.10610251404539708}},"curvature":-0.050343741049063785},{"time":1.0675448829204444,"velocity":1.670254567706452,"acceleration":-0.0668652748270841,"pose":{"translation":{"x":4.46236698674675,"y":-2.1540445123394276},"rotation":{"radians":0.10249890819515217}},"curvature":-0.05496580675182263},{"time":1.1086749898666093,"velocity":1.6675043918018293,"acceleration":-0.07528311421565198,"pose":{"translation":{"x":4.530661445025976,"y":-2.1471539291644883},"rotation":{"radians":0.09855167028286257}},"curvature":-0.0601468203169265},{"time":1.1498329761782073,"velocity":1.664405890417447,"acceleration":-0.08562453140808468,"pose":{"translation":{"x":4.598910289870464,"y":-2.140552574528716},"rotation":{"radians":0.09423106285647165}},"curvature":-0.06600455065774892},{"time":1.1908946101489744,"velocity":1.6608900072498498,"acceleration":-0.09829421482571662,"pose":{"translation":{"x":4.6668932097013265,"y":-2.1342869765213477},"rotation":{"radians":0.08950237001869939}},"curvature":-0.07267781348567748},{"time":1.231738330074408,"velocity":1.6568753058692178,"acceleration":-0.11381615220473237,"pose":{"translation":{"x":4.734392144562055,"y":-2.128402632954702},"rotation":{"radians":0.08432522818272103}},"curvature":-0.08033248328318213},{"time":1.2722462045685698,"velocity":1.6522648554603,"acceleration":-0.1328639423684381,"pose":{"translation":{"x":4.801192583493158,"y":-2.1229437325425042},"rotation":{"radians":0.07865281336102048}},"curvature":-0.08916893229125794},{"time":1.312304928648127,"velocity":1.6469424954528407,"acceleration":-0.15629981595439885,"pose":{"translation":{"x":4.86708486190682,"y":-2.117952876078204},"rotation":{"radians":0.07243086257884969}},"curvature":-0.09943135873654044},{"time":1.3518068613474916,"velocity":1.640768350642087,"acceleration":-0.18522365479157954,"pose":{"translation":{"x":4.931865458961542,"y":-2.1134707976132963},"rotation":{"radians":0.0655965030028932}},"curvature":-0.11141958736259769},{"time":1.3906511114248492,"velocity":1.6335734766751207,"acceleration":-0.24295562039015778,"pose":{"translation":{"x":4.9953382949368,"y":-2.109536085635641},"rotation":{"radians":0.058076858751224265}},"curvature":-0.12550407841834513},{"time":1.466022363588721,"velocity":1.6152616073460642,"acceleration":-0.3546562825081202,"pose":{"translation":{"x":5.117621354619559,"y":-2.1034507143452768},"rotation":{"radians":0.040630021789150914}},"curvature":-0.1619169599168633},{"time":1.537780719636484,"velocity":1.5898120555512705,"acceleration":-0.5275364639006982,"pose":{"translation":{"x":5.232563525846965,"y":-2.0999519636134742},"rotation":{"radians":0.019237266076289655}},"curvature":-0.21391600794008497},{"time":1.6054896443553452,"velocity":1.554093128830564,"acceleration":-0.7912251824906273,"pose":{"translation":{"x":5.338996383423962,"y":-2.099242861240941},"rotation":{"radians":-0.0072515924490507595}},"curvature":-0.28977018232314705},{"time":1.668946075148854,"velocity":1.503884802795766,"acceleration":-1.1751373492597204,"pose":{"translation":{"x":5.435995108057348,"y":-2.101465339128981},"rotation":{"radians":-0.04037803733154881}},"curvature":-0.40248682439394784},{"time":1.7282235242951927,"velocity":1.4342256583350599,"acceleration":-1.6778561230701603,"pose":{"translation":{"x":5.5229200023445495,"y":-2.1066913109857426},"rotation":{"radians":-0.08216377445719576}},"curvature":-0.5719401080374314},{"time":1.7836959264372831,"velocity":1.341150948739543,"acceleration":-2.20080945964638,"pose":{"translation":{"x":5.599458006762405,"y":-2.114913750032468},"rotation":{"radians":-0.1351143705125221}},"curvature":-0.825827101138403},{"time":1.8359975323484463,"velocity":1.226045079695558,"acceleration":-2.4790139320701097,"pose":{"translation":{"x":5.665664215655931,"y":-2.1260377667097456},"rotation":{"radians":-0.20191341877489544}},"curvature":-1.1931240150348847},{"time":1.885824507260314,"velocity":1.1025233146961304,"acceleration":-2.311980572815219,"pose":{"translation":{"x":5.722003393227111,"y":-2.139871686383754},"rotation":{"radians":-0.284297039501025}},"curvature":-1.6725848958928446},{"time":1.9099737856104797,"velocity":1.0466906523030397,"acceleration":-1.893950979741696,"pose":{"translation":{"x":5.746740320006809,"y":-2.147716301131953},"rotation":{"radians":-0.3309830197554157}},"curvature":-1.9264401293459859},{"time":1.9335585280660952,"velocity":1.002022306222271,"acceleration":-1.1632371776425636,"pose":{"translation":{"x":5.769391489523653,"y":-2.156118127052516},"rotation":{"radians":-0.380302946666284}},"curvature":-2.149904376291824},{"time":1.9564021415443753,"velocity":0.9754497657526388,"acceleration":0.011912567692432518,"pose":{"translation":{"x":5.790148704538905,"y":-2.1650220108051035},"rotation":{"radians":-0.4306688379447418}},"curvature":-2.2925487642707947},{"time":1.978186463436481,"velocity":0.9757092729618122,"acceleration":2.699999999999997,"pose":{"translation":{"x":5.809237156427796,"y":-2.1743650770521468},"rotation":{"radians":-0.47969473744756086}},"curvature":-2.291118132066251},{"time":2.016638423599818,"velocity":1.079529565402822,"acceleration":2.699999999999993,"pose":{"translation":{"x":5.843483263645056,"y":-2.194076972763101},"rotation":{"radians":-0.5605108950017286}},"curvature":-1.622465522268993},{"time":2.0498208647278267,"velocity":1.1691221564484455,"acceleration":2.6999999999999957,"pose":{"translation":{"x":5.874648414693021,"y":-2.2145857763164267},"rotation":{"radians":-0.5933810296164905}},"curvature":-3.247134184938767E-14},{"time":2.109378975559902,"velocity":1.329929055695049,"acceleration":2.699999999999996,"pose":{"translation":{"x":5.936258944700883,"y":-2.2563276903425025},"rotation":{"radians":-0.5994171739895844}},"curvature":-0.1487431329178877},{"time":2.164360211611288,"velocity":1.4783783930337904,"acceleration":1.8517760132138024,"pose":{"translation":{"x":5.999699981882348,"y":-2.300320873723265},"rotation":{"radians":-0.6141274879698528}},"curvature":-0.22030767448755514},{"time":2.2175748158508273,"velocity":1.5769199207172349,"acceleration":-0.014315562132053861,"pose":{"translation":{"x":6.065697950852353,"y":-2.347785174236805},"rotation":{"radians":-0.6331059611884475}},"curvature":-0.24089795741624495},{"time":2.2716979386639586,"velocity":1.5761451177898227,"acceleration":-0.02723730289590519,"pose":{"translation":{"x":6.133962927343928,"y":-2.3989766438490805},"rotation":{"radians":-0.6537784130941335}},"curvature":-0.24253360344491967},{"time":2.327683437678907,"velocity":1.5746202237953741,"acceleration":-0.5520101968227636,"pose":{"translation":{"x":6.203395553508525,"y":-2.453365069212477},"rotation":{"radians":-0.675248684023209}},"curvature":-0.24575742904074352},{"time":2.3848207185559724,"velocity":1.5430798621325077,"acceleration":-2.7,"pose":{"translation":{"x":6.272293953216331,"y":-2.509811502164368},"rotation":{"radians":-0.6977715414955855}},"curvature":-0.2633146109498168},{"time":2.4445608693304597,"velocity":1.381781455041392,"acceleration":-2.700000000000002,"pose":{"translation":{"x":6.338560647356597,"y":-2.5667457902256756},"rotation":{"radians":-0.7224590858174899}},"curvature":-0.30800993487295275},{"time":2.5084695729111095,"velocity":1.2092279553736378,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.399909469137951,"y":-2.6223441070994333},"rotation":{"radians":-0.7513632514930497}},"curvature":-0.40265674918292893},{"time":2.5758368121059863,"velocity":1.027336409547471,"acceleration":-2.7,"pose":{"translation":{"x":6.454072479388717,"y":-2.6747064831693455},"rotation":{"radians":-0.7880733683333389}},"curvature":-0.6004987770491809},{"time":2.645792282217101,"velocity":0.8384566402474619,"acceleration":-2.700000000000001,"pose":{"translation":{"x":6.499006881857241,"y":-2.722034335998349},"rotation":{"radians":-0.8393292542522007}},"curvature":-1.0462955538581296},{"time":2.7174508148262406,"velocity":0.6449786022027844,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":6.533101938512206,"y":-2.762808000827175},"rotation":{"radians":-0.9192964022695238}},"curvature":-2.204183013486819},{"time":2.753784984556833,"velocity":0.5468763439301851,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.545750418006628,"y":-2.780382073202902},"rotation":{"radians":-0.9791815976966345}},"curvature":-3.485726715025795},{"time":2.7906382659669196,"velocity":0.44737248412295083,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":6.555385884842951,"y":-2.79596426107291},"rotation":{"radians":-1.061990677947966}},"curvature":-5.881009321372131},{"time":2.809457424798199,"velocity":0.3965607552784971,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.559075092744607,"y":-2.8029963396245963},"rotation":{"radians":-1.1158613221217693}},"curvature":-7.827718392765945},{"time":2.8287835191728945,"velocity":0.34438030046681856,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":6.562020655111404,"y":-2.8095221084893103},"rotation":{"radians":-1.1809980974647505}},"curvature":-10.569436189018688},{"time":2.8490238264989167,"velocity":0.28973147068655825,"acceleration":-2.699999999999997,"pose":{"translation":{"x":6.5642344432613005,"y":-2.8155454789102445},"rotation":{"radians":-1.2602788043979845}},"curvature":-14.417182716046018},{"time":2.859729139788011,"velocity":0.26082712480600356,"acceleration":-2.700000000000001,"pose":{"translation":{"x":6.56507186128735,"y":-2.818370943824043},"rotation":{"radians":-1.306244968667926}},"curvature":-16.86263361015955},{"time":2.87106221383231,"velocity":0.23022782488639748,"acceleration":-2.3612718102537897,"pose":{"translation":{"x":6.565732845159796,"y":-2.8210738788275567},"rotation":{"radians":-1.3569924039235672}},"curvature":-19.70367342021235},{"time":2.8832346538097156,"velocity":0.2014853855057428,"acceleration":-1.8823900772771511,"pose":{"translation":{"x":6.566220182251913,"y":-2.823655790340661},"rotation":{"radians":-1.412912280427388}},"curvature":-22.95474232463341},{"time":2.8963628627940183,"velocity":0.17677297518127044,"acceleration":-1.4714194647731251,"pose":{"translation":{"x":6.5665369674856615,"y":-2.826118426247995},"rotation":{"radians":-1.474319022768083}},"curvature":-26.59523025516007},{"time":2.9104878075921956,"velocity":0.1559892564663864,"acceleration":-1.1254439629148367,"pose":{"translation":{"x":6.566686609646243,"y":-2.8284637813167604},"rotation":{"radians":-1.541389152233492}},"curvature":-30.54995815591113},{"time":2.925611064449408,"velocity":0.13896887833682636,"acceleration":-0.8377391423775556,"pose":{"translation":{"x":6.566672837696655,"y":-2.830694102614526},"rotation":{"radians":-1.6140863178872185}},"curvature":-34.669613418093725},{"time":2.941679457699172,"velocity":0.12550775635638367,"acceleration":-0.5989931096992901,"pose":{"translation":{"x":6.566499707092241,"y":-2.8328118949270262},"rotation":{"radians":-1.6920812424865532}},"curvature":-38.71907285207275},{"time":2.958571811664889,"velocity":0.11538935272431772,"acceleration":-0.39836294880725803,"pose":{"translation":{"x":6.56617160609525,"y":-2.8348199261759635},"rotation":{"radians":-1.7746838185185858}},"curvature":-42.38496435964513},{"time":2.9760924888977693,"velocity":0.10840976407672742,"acceleration":-0.2650213103080076,"pose":{"translation":{"x":6.565693262089384,"y":-2.8367212328368074},"rotation":{"radians":-1.8608117438581422}},"curvature":-45.31248254996997},{"time":2.985025684936199,"velocity":0.10604227675738442,"acceleration":-0.1827783906326452,"pose":{"translation":{"x":6.565399320548026,"y":-2.8376328881112363},"rotation":{"radians":-1.9047580036990877}},"curvature":-46.393030714121075},{"time":2.9940118538728644,"velocity":0.1043997992611877,"acceleration":-0.10338126455167747,"pose":{"translation":{"x":6.5650697478943565,"y":-2.838519125356596},"rotation":{"radians":-1.9490200030342122}},"curvature":-47.171469796300315},{"time":3.0030101711910997,"velocity":0.10346954183799129,"acceleration":-0.025273988080138532,"pose":{"translation":{"x":6.5647052332412,"y":-2.8393804020756814},"rotation":{"radians":-1.9933772497009323}},"curvature":-47.623320398873744},{"time":3.011978572681497,"velocity":0.10324287456562509,"acceleration":0.09326386027098398,"pose":{"translation":{"x":6.564306488080446,"y":-2.8402171935717373},"rotation":{"radians":-2.037602908125817}},"curvature":-47.73465242571826},{"time":3.0296236200714812,"velocity":0.10488851979987945,"acceleration":0.26257573607129786,"pose":{"translation":{"x":6.5634092652830445,"y":-2.841819312125811},"rotation":{"radians":-2.1247564340256364}},"curvature":-46.93729676286493},{"time":3.046662742188624,"velocity":0.10936257983179687,"acceleration":0.45877295584260974,"pose":{"translation":{"x":6.562384226517221,"y":-2.843329645887367},"rotation":{"radians":-2.208763935210407}},"curvature":-44.89080964582525},{"time":3.062823621750542,"velocity":0.1167767543174345,"acceleration":0.7007886401669247,"pose":{"translation":{"x":6.561237889492266,"y":-2.844752655367728},"rotation":{"radians":-2.288157818489723}},"curvature":-41.84472781061636},{"time":3.077899735774915,"velocity":0.12734192376357656,"acceleration":1.0140300260544806,"pose":{"translation":{"x":6.55997714892625,"y":-2.8460931021387887},"rotation":{"radians":-2.361820387383494}},"curvature":-38.11692809320769},{"time":3.0917554325870618,"velocity":0.14139201636300058,"acceleration":1.4356063758184543,"pose":{"translation":{"x":6.558609282860578,"y":-2.84735605425082},"rotation":{"radians":-2.4290117557070676}},"curvature":-34.022560762308004},{"time":3.104319349300483,"velocity":0.15942885530204032,"acceleration":2.0243220425740582,"pose":{"translation":{"x":6.557141958974539,"y":-2.8485468916502654},"rotation":{"radians":-2.489336635086955}},"curvature":-29.824269910378586},{"time":3.11557089520828,"velocity":0.18220560769622773,"acceleration":2.700000000000096,"pose":{"translation":{"x":6.555583240899867,"y":-2.849671311597545},"rotation":{"radians":-2.5426742752711875}},"curvature":-25.71024378865562},{"time":3.134558205623386,"velocity":0.2334713458170163,"acceleration":-1.1102273481572658,"pose":{"translation":{"x":6.55222589436107,"y":-2.851745307253974},"rotation":{"radians":-2.6287861328487576}},"curvature":-18.12857913974966},{"time":3.1528165809971296,"velocity":0.21320039814416503,"acceleration":-2.7,"pose":{"translation":{"x":6.548609911299899,"y":-2.8536301714594146},"rotation":{"radians":-2.6889048955956647}},"curvature":-11.538793868227126},{"time":3.2317796914208943,"velocity":0.0,"acceleration":-2.7,"pose":{"translation":{"x":6.540926606751496,"y":-2.857068318658525},"rotation":{"radians":-2.736700867304774}},"curvature":-1.0037780381732805E-12}] \ No newline at end of file +[{"time":0.0,"velocity":0.0,"acceleration":2.6999999999999997,"pose":{"translation":{"x":3.2,"y":-2.3},"rotation":{"radians":0.0}},"curvature":0.0},{"time":0.16408328867307112,"velocity":0.443024879417292,"acceleration":2.7000000000000006,"pose":{"translation":{"x":3.2363298344524436,"y":-2.298899802686018},"rotation":{"radians":0.0692577651470374}},"curvature":1.8950587512445145},{"time":0.27165252251845773,"velocity":0.733461810799836,"acceleration":2.6999999999999993,"pose":{"translation":{"x":3.2992357901794267,"y":-2.292058382559469},"rotation":{"radians":0.13336588761066984}},"curvature":0.5081353245388296},{"time":0.39146527816103716,"velocity":1.0569562510348003,"acceleration":2.700000000000003,"pose":{"translation":{"x":3.4052753217803797,"y":-2.2759406702466065},"rotation":{"radians":0.1622880652133495}},"curvature":0.14308012858303878},{"time":0.45511058967808826,"velocity":1.2287985921308384,"acceleration":2.6999999999999993,"pose":{"translation":{"x":3.4770070197266802,"y":-2.2638785389701312},"rotation":{"radians":0.17018012232912796}},"curvature":0.08218998056047282},{"time":0.5202669048089674,"velocity":1.404720642984212,"acceleration":2.6999999999999997,"pose":{"translation":{"x":3.5615193955328435,"y":-2.249097623342679},"rotation":{"radians":0.17564390475973646}},"curvature":0.04917485937853854},{"time":0.5862126558482816,"velocity":1.5827741707903604,"acceleration":1.5865644228393085,"pose":{"translation":{"x":3.658474466495589,"y":-2.231684860998854},"rotation":{"radians":0.17945016920991327}},"curvature":0.030140843221192568},{"time":0.6537218964528062,"velocity":1.6898819301463979,"acceleration":0.05788196551324373,"pose":{"translation":{"x":3.7671397522485237,"y":-2.211813471951235},"rotation":{"radians":0.18207557565508717}},"curvature":0.018479758912245518},{"time":0.7254285040062793,"velocity":1.6940324495318797,"acceleration":0.04142453277389165,"pose":{"translation":{"x":3.8864378767263954,"y":-2.1897319350134796},"rotation":{"radians":0.18381956783311507}},"curvature":0.010872498721873012},{"time":0.7633704400602459,"velocity":1.6956041765054521,"acceleration":0.03427111458881184,"pose":{"translation":{"x":3.949655472782524,"y":-2.177957876460112},"rotation":{"radians":0.18442327195140867}},"curvature":0.008001487996222786},{"time":0.8025567568325975,"velocity":1.6969471352578709,"acceleration":0.02906850160180063,"pose":{"translation":{"x":4.014996170129343,"y":-2.1657529642234286},"rotation":{"radians":0.18487131031758927}},"curvature":0.0055525725273563005},{"time":0.8428636062198919,"velocity":1.698118794973849,"acceleration":0.0253231394733626,"pose":{"translation":{"x":4.082250383218097,"y":-2.1531645157563517},"rotation":{"radians":0.185176376794578}},"curvature":0.0034191885570685615},{"time":0.8841591774035676,"velocity":1.6991645284825654,"acceleration":0.016949828884694675,"pose":{"translation":{"x":4.151196270887151,"y":-2.140242485266206},"rotation":{"radians":0.185348127438105}},"curvature":0.001517578640164743},{"time":0.9263077178976394,"velocity":1.6998789390316795,"acceleration":-0.020915772434514122,"pose":{"translation":{"x":4.2216012864233665,"y":-2.127039119227935},"rotation":{"radians":0.185393608906121}},"curvature":-2.1980680822174232E-4},{"time":0.9691872552083657,"velocity":1.6989820803871911,"acceleration":-0.019853875112120833,"pose":{"translation":{"x":4.293223727623496,"y":-2.1136086118973263},"rotation":{"radians":0.18531757186828496}},"curvature":-0.001849182069837596},{"time":1.0126678049640467,"velocity":1.6981188229825355,"acceleration":-0.019438079067074412,"pose":{"translation":{"x":4.365814286855553,"y":-2.100006760824233},"rotation":{"radians":0.1851226905021804}},"curvature":-0.003419137593420175},{"time":1.0565953995481074,"velocity":1.697264954925784,"acceleration":-0.01961598803052627,"pose":{"translation":{"x":4.439117601120204,"y":-2.0862906223657953},"rotation":{"radians":0.18480970272003633}},"curvature":-0.004973588312268373},{"time":1.1008137297010812,"velocity":1.6963975686907735,"acceleration":-0.020376770398937767,"pose":{"translation":{"x":4.512873802112148,"y":-2.072518167199662},"rotation":{"radians":0.18437748064958973}},"curvature":-0.006554250817816681},{"time":1.1451650787587457,"velocity":1.6954938314341423,"acceleration":-0.02174865906857091,"pose":{"translation":{"x":4.586820066281499,"y":-2.0587479358372143},"rotation":{"radians":0.1838230366305232}},"curvature":-0.008202877188079381},{"time":1.1894912691710187,"velocity":1.6945297962310573,"acceleration":-0.023800679579925297,"pose":{"translation":{"x":4.6606921648951705,"y":-2.0450386941367853},"rotation":{"radians":0.1831414662100924}},"curvature":-0.00996343941748574},{"time":1.2336346217613723,"velocity":1.6934791544404706,"acceleration":-0.02664873108330119,"pose":{"translation":{"x":4.734226014098256,"y":-2.031449088816883},"rotation":{"radians":0.18232582600629615}},"curvature":-0.011884448939914765},{"time":1.2774389289250685,"velocity":1.692311825238575,"acceleration":-0.03046680385892747,"pose":{"translation":{"x":4.807159224975414,"y":-2.018037302969414},"rotation":{"radians":0.1813669405494641}},"curvature":-0.014021608840024123},{"time":1.3207504437966078,"velocity":1.6909922618101507,"acceleration":-0.03550490906982497,"pose":{"translation":{"x":4.87923265361225,"y":-2.0048607115729036},"rotation":{"radians":0.18025312799179333}},"curvature":-0.016441033887417626},{"time":1.3634188884165654,"velocity":1.6894773225637683,"acceleration":-0.04211637972877536,"pose":{"translation":{"x":4.950191951156699,"y":-1.9919755370057164},"rotation":{"radians":0.17896982951364038}},"curvature":-0.019223341480108017},{"time":1.4052984851902914,"velocity":1.687713505563158,"acceleration":-0.05079880035097404,"pose":{"translation":{"x":5.019789113880411,"y":-1.9794365045592819},"rotation":{"radians":0.1774991208800654}},"curvature":-0.022469026289744613},{"time":1.446249017581491,"velocity":1.6856332676439514,"acceleration":-0.06225527958543467,"pose":{"translation":{"x":5.087784033240128,"y":-1.9672964979513143},"rotation":{"radians":0.17581907627481713}},"curvature":-0.026305702065901784},{"time":1.48613692819827,"velocity":1.683150034616425,"acceleration":-0.07748664065103303,"pose":{"translation":{"x":5.153946045939074,"y":-1.955606214839035},"rotation":{"radians":0.1739029433768764}},"curvature":-0.030898057172033474},{"time":1.5248364654577076,"velocity":1.6801513374794417,"acceleration":-0.09793124518239772,"pose":{"translation":{"x":5.218055483988332,"y":-1.944413822332393},"rotation":{"radians":0.17171807338504597}},"curvature":-0.036461777406136126},{"time":1.5622308942193142,"velocity":1.676489254507933,"acceleration":-0.14430405981446515,"pose":{"translation":{"x":5.27990522476823,"y":-1.9337646125072896},"rotation":{"radians":0.16922452850747088}},"curvature":-0.04328332502065509},{"time":1.6327045242352638,"velocity":1.666319623586769,"acceleration":-2.5496325060863407,"pose":{"translation":{"x":5.396069151255783,"y":-1.9142604671143888},"rotation":{"radians":0.16310370436497154}},"curvature":-0.062384057405159905},{"time":1.700004059382801,"velocity":1.4947305411301082,"acceleration":-2.699999999999999,"pose":{"translation":{"x":5.501090654161787,"y":-1.897385524088994},"rotation":{"radians":0.15498967537946623}},"curvature":-0.09338424002657549},{"time":1.766850386843393,"velocity":1.3142454569865103,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":5.593922492082721,"y":-1.8833634811611886},"rotation":{"radians":0.14401549016527215}},"curvature":-0.14664144594343798},{"time":1.8327108342658995,"velocity":1.136422248945742,"acceleration":-2.7000000000000024,"pose":{"translation":{"x":5.673866955415721,"y":-1.8723389647855806},"rotation":{"radians":0.12876563152136272}},"curvature":-0.24432674544242147},{"time":1.89674347147306,"velocity":0.9635341284864088,"acceleration":-2.700000000000001,"pose":{"translation":{"x":5.740625468322835,"y":-1.8643665065644082},"rotation":{"radians":0.10682738395944273}},"curvature":-0.43772210750117546},{"time":2.015399258918648,"velocity":0.6431635023833218,"acceleration":-2.7,"pose":{"translation":{"x":5.835683620117707,"y":-1.8572792752710763},"rotation":{"radians":0.02197361283131086}},"curvature":-1.8474877858052587},{"time":2.068104204745642,"velocity":0.500860148650437,"acceleration":-2.700000000000003,"pose":{"translation":{"x":5.865828193832404,"y":-1.8577238789494634},"rotation":{"radians":-0.06367453439929643}},"curvature":-4.361539640139643},{"time":2.09260418539275,"velocity":0.4347102009032456,"acceleration":-2.700000000000001,"pose":{"translation":{"x":5.87723983042111,"y":-1.8587835158903134},"rotation":{"radians":-0.12606797335766265}},"curvature":-6.765173997576896},{"time":2.1160800812268463,"velocity":0.37132528215118565,"acceleration":-2.699999999999999,"pose":{"translation":{"x":5.886575890703612,"y":-1.8603172471295863},"rotation":{"radians":-0.20493559496852556}},"curvature":-10.161883925389565},{"time":2.127589396456522,"velocity":0.3402501310310618,"acceleration":-2.6999999999999975,"pose":{"translation":{"x":5.890565694061718,"y":-1.8612389048670965},"rotation":{"radians":-0.2504220751916043}},"curvature":-12.085865426392672},{"time":2.1390945597750513,"velocity":0.30918619007103243,"acceleration":-1.8924820462055663,"pose":{"translation":{"x":5.894162125738611,"y":-1.8622502866084267},"rotation":{"radians":-0.29897795833341534}},"curvature":-13.883657658978745},{"time":2.150587779303661,"velocity":0.2874354784600397,"acceleration":-0.3671051506100357,"pose":{"translation":{"x":5.897412720882245,"y":-1.8633405156596639},"rotation":{"radians":-0.3489700280234347}},"curvature":-15.167811103722578},{"time":2.1617083394694956,"velocity":0.28335306354549294,"acceleration":2.6999999999999984,"pose":{"translation":{"x":5.900367833181723,"y":-1.864498083498372},"rotation":{"radians":-0.39786739118221953}},"curvature":-15.430809298875147},{"time":2.1804709377657456,"velocity":0.3340120789453682,"acceleration":2.6999999999999567,"pose":{"translation":{"x":5.905607407346868,"y":-1.8669659777145693},"rotation":{"radians":-0.47832444070195745}},"curvature":-11.041099262767903},{"time":2.1956824280374048,"velocity":0.3750831026788478,"acceleration":2.699999999999993,"pose":{"translation":{"x":5.910341889267582,"y":-1.8695488554289996},"rotation":{"radians":-0.5104883219168177}},"curvature":-3.7340349071888874E-13},{"time":2.2929148364286727,"velocity":0.63761060533527,"acceleration":2.7000000000000037,"pose":{"translation":{"x":5.952628765990579,"y":-1.8947627456207157},"rotation":{"radians":-0.5725205397695268}},"curvature":-1.2729792340387263},{"time":2.3940778583761566,"velocity":0.9107507645934767,"acceleration":2.6999999999999997,"pose":{"translation":{"x":6.016899459359807,"y":-1.939518290288375},"rotation":{"radians":-0.6341961814427468}},"curvature":-0.4951458179596235},{"time":2.499582823433522,"velocity":1.1956141702483631,"acceleration":2.700000000000001,"pose":{"translation":{"x":6.104929493165445,"y":-2.0073229658763747},"rotation":{"radians":-0.6751734667579602}},"curvature":-0.30598432766039185},{"time":2.549871630357917,"velocity":1.331393948944229,"acceleration":-2.3703085481660073,"pose":{"translation":{"x":6.154145099583976,"y":-2.0475121420294213},"rotation":{"radians":-0.6943965009615569}},"curvature":-0.30719753844441644},{"time":2.601064659117595,"velocity":1.210050675268655,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":6.203697633427262,"y":-2.0896586153054586},"rotation":{"radians":-0.7157907005915123}},"curvature":-0.36026510676615386},{"time":2.7165416194940355,"velocity":0.8982628822522657,"acceleration":-2.700000000000001,"pose":{"translation":{"x":6.293359406274425,"y":-2.171994264734542},"rotation":{"radians":-0.7777408162553153}},"curvature":-0.7709264287429204},{"time":2.778891049560791,"velocity":0.7299194210720268,"acceleration":-2.7,"pose":{"translation":{"x":6.328670510091029,"y":-2.208456747165414},"rotation":{"radians":-0.8305100864157245}},"curvature":-1.4222448009063526},{"time":2.842695131750204,"velocity":0.5576483991606114,"acceleration":-2.6999999999999993,"pose":{"translation":{"x":6.355220615825325,"y":-2.239798940322541},"rotation":{"radians":-0.9168250753018049}},"curvature":-3.1442989963643533},{"time":2.8749582012569603,"velocity":0.4705381114923698,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":6.36490619532735,"y":-2.2532634290570734},"rotation":{"radians":-0.9827537906480719}},"curvature":-5.034987197192603},{"time":2.891239770434675,"velocity":0.42657787471254105,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":6.3688352966753286,"y":-2.259419669934672},"rotation":{"radians":-1.0244849695664913}},"curvature":-6.4853718103581715},{"time":2.907713203045178,"velocity":0.3820996066641824,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":6.372160835205086,"y":-2.2651909502257763},"rotation":{"radians":-1.0737622012988202}},"curvature":-8.435878662280569},{"time":2.924526900044579,"velocity":0.3367026247657997,"acceleration":-2.700000000000001,"pose":{"translation":{"x":6.374893052354147,"y":-2.270580863405573},"rotation":{"radians":-1.1321258392888536}},"curvature":-11.04518545418917},{"time":2.941957874367017,"velocity":0.28963899409521776,"acceleration":-2.7,"pose":{"translation":{"x":6.377047337038721,"y":-2.2755966728813544},"rotation":{"radians":-1.2012322168330674}},"curvature":-14.476500929092555},{"time":2.96055398358937,"velocity":0.23942949919486523,"acceleration":-2.448027153795687,"pose":{"translation":{"x":6.3786444689861534,"y":-2.280249495489123},"rotation":{"radians":-1.2826082131505}},"curvature":-18.827812193648736},{"time":2.970567416073978,"velocity":0.21491634456984543,"acceleration":-1.9961771142903886,"pose":{"translation":{"x":6.379242130280754,"y":-2.2824443595580353},"rotation":{"radians":-1.3282237761827782}},"curvature":-21.327328725413906},{"time":2.981144665114215,"velocity":0.19380228210357486,"acceleration":-1.6000282816415057,"pose":{"translation":{"x":6.379710862067385,"y":-2.2845544849901995},"rotation":{"radians":-1.3771567268610405}},"curvature":-23.98711892404214},{"time":2.992268979172749,"velocity":0.17600306499605822,"acceleration":-1.2553869860651006,"pose":{"translation":{"x":6.380054886336579,"y":-2.286582426880274},"rotation":{"radians":-1.429290793886386}},"curvature":-26.72507006593706},{"time":3.0038952409682596,"velocity":0.16140760724138803,"acceleration":-0.9551676954781074,"pose":{"translation":{"x":6.380278807629404,"y":-2.288531015567824},"rotation":{"radians":-1.484358701225411}},"curvature":-29.420806330750263},{"time":3.0159445119389567,"velocity":0.14989853285611587,"acceleration":-0.6898335911409661,"pose":{"translation":{"x":6.380387620641595,"y":-2.290403362371591},"rotation":{"radians":-1.5419143492300567}},"curvature":-31.91668188022513},{"time":3.0283006223384077,"velocity":0.14137487284672845,"acceleration":-0.44743303545741403,"pose":{"translation":{"x":6.380386717827701,"y":-2.2922028653237634},"rotation":{"radians":-1.6013160616668083}},"curvature":-34.02706070206741},{"time":3.0408101331571995,"velocity":0.13577770444898907,"acceleration":-0.212921320679107,"pose":{"translation":{"x":6.380281897005218,"y":-2.2939332149042446},"rotation":{"radians":-1.6617277302102624}},"curvature":-35.55699082407614},{"time":3.0532866132644054,"velocity":0.13312119582713622,"acceleration":0.03378972806083901,"pose":{"translation":{"x":6.380079368958727,"y":-2.295598399774919},"rotation":{"radians":-1.7221425921088367}},"curvature":-36.3281418998923},{"time":3.065519296764733,"velocity":0.1335345348760666,"acceleration":0.32225443065354187,"pose":{"translation":{"x":6.379785765044043,"y":-2.2972027125139265},"rotation":{"radians":-1.781429772113809}},"curvature":-36.206139172711836},{"time":3.077285012514349,"velocity":0.13732608890619047,"acceleration":0.7012784582506274,"pose":{"translation":{"x":6.379408144792344,"y":-2.2987507553499262},"rotation":{"radians":-1.8383976967879823}},"curvature":-35.12127713858841},{"time":3.0883612496811925,"velocity":0.14509361542977273,"acceleration":1.2617209489418255,"pose":{"translation":{"x":6.3789540035143135,"y":-2.3002474458963693},"rotation":{"radians":-1.8918633161545486}},"curvature":-33.07584393236491},{"time":3.098537803842263,"velocity":0.157933587002836,"acceleration":2.7000000000000473,"pose":{"translation":{"x":6.378431279904281,"y":-2.3016980228857653},"rotation":{"radians":-1.940714098059974}},"curvature":-30.13585854641613},{"time":3.1153645172946947,"velocity":0.20336571332440306,"acceleration":2.6999999999999815,"pose":{"translation":{"x":6.3772141030085905,"y":-2.304483431124363},"rotation":{"radians":-2.0207139247079544}},"curvature":-22.0271903748647},{"time":3.1406589917681282,"velocity":0.2716607944026734,"acceleration":0.8024179910851177,"pose":{"translation":{"x":6.374357058736877,"y":-2.309768375181916},"rotation":{"radians":-2.089942441041602}},"curvature":-3.6876165474616885E-12},{"time":3.1622589055614276,"velocity":0.2889929538363045,"acceleration":-2.6999999999999984,"pose":{"translation":{"x":6.371273053807943,"y":-2.3149791695909654},"rotation":{"radians":-2.134140449789665}},"curvature":-13.455982774139883},{"time":3.1737418742140093,"velocity":0.25798893847433346,"acceleration":-1.4383587980679373,"pose":{"translation":{"x":6.369534239034446,"y":-2.3175943536800085},"rotation":{"radians":-2.1829835922357548}},"curvature":-17.25132655214485},{"time":3.186933448272058,"velocity":0.23901472186757433,"acceleration":0.1738347345922304,"pose":{"translation":{"x":6.367572227256497,"y":-2.3202205006717915},"rotation":{"radians":-2.242778936332965}},"curvature":-18.865841343006046},{"time":3.201357086015986,"velocity":0.2415220511066446,"acceleration":1.2074390857232837,"pose":{"translation":{"x":6.365327025522202,"y":-2.3228603994487775},"rotation":{"radians":-2.30822787316994}},"curvature":-18.637946847005626},{"time":3.2161458477403038,"velocity":0.2593785800420343,"acceleration":2.1336945716205817,"pose":{"translation":{"x":6.362745547798263,"y":-2.3255164261590364},"rotation":{"radians":-2.374763726729108}},"curvature":-17.142365443426765},{"time":3.2306694918655126,"velocity":0.2903676006721412,"acceleration":2.700000000000074,"pose":{"translation":{"x":6.359781371637524,"y":-2.3281905601724713},"rotation":{"radians":-2.4389742624979664}},"curvature":-14.983480497841681},{"time":3.2446628052837676,"velocity":0.3281495469014306,"acceleration":2.6999999999998945,"pose":{"translation":{"x":6.356394494846521,"y":-2.330884400037045},"rotation":{"radians":-2.4986892553126565}},"curvature":-12.6428063971659},{"time":3.2582435491927177,"velocity":0.364817555455595,"acceleration":2.7000000000000877,"pose":{"translation":{"x":6.352551092153018,"y":-2.333599179435007},"rotation":{"radians":-2.552808677946185}},"curvature":-10.425243073509822},{"time":3.2716173390145897,"velocity":0.400926787974651,"acceleration":2.7000000000000393,"pose":{"translation":{"x":6.34822327187356,"y":-2.336335783139118},"rotation":{"radians":-2.6010138665326594}},"curvature":-8.480273098517067},{"time":3.2981771443200105,"velocity":0.4726382622992881,"acceleration":2.6999999999999944,"pose":{"translation":{"x":6.338031019772121,"y":-2.341876353746762},"rotation":{"radians":-2.680649682418315}},"curvature":-5.526691285519326},{"time":3.3248223581697265,"velocity":0.5445803396935209,"acceleration":2.7000000000000046,"pose":{"translation":{"x":6.3257040302168415,"y":-2.3475068181889385},"rotation":{"radians":-2.7413418618503456}},"curvature":-3.621027769968688},{"time":3.3516517412505586,"velocity":0.6170196740117675,"acceleration":2.6999999999999864,"pose":{"translation":{"x":6.311207959025704,"y":-2.3532233214413143},"rotation":{"radians":-2.787500682952535}},"curvature":-2.421126879189059},{"time":3.4055288550540843,"velocity":0.7624878812812861,"acceleration":2.6999999999999966,"pose":{"translation":{"x":6.275921295893175,"y":-2.3648792811083497},"rotation":{"radians":-2.8500310809579763}},"curvature":-1.1659746173848968},{"time":3.458689461018175,"velocity":0.9060215173843309,"acceleration":2.700000000000006,"pose":{"translation":{"x":6.23318766752019,"y":-2.3767415682587734},"rotation":{"radians":-2.887571818016487}},"curvature":-0.6087466403424915},{"time":3.557675298971284,"velocity":1.1732832798577255,"acceleration":-1.7282800282634867,"pose":{"translation":{"x":6.133054298331776,"y":-2.4004892897255963},"rotation":{"radians":-2.922362067786142}},"curvature":-0.15135507094459147},{"time":3.654622402712532,"velocity":1.005731536663738,"acceleration":-2.699999999999999,"pose":{"translation":{"x":6.029885473338478,"y":-2.423133209081552},"rotation":{"radians":-2.9237451596146884}},"curvature":0.1383938594851771},{"time":3.7573878685624846,"velocity":0.7282647788688656,"acceleration":-2.7000000000000015,"pose":{"translation":{"x":5.943142240414719,"y":-2.443479477201466},"rotation":{"radians":-2.8895449379618605}},"curvature":0.7880473353914925},{"time":3.809391276974363,"velocity":0.5878555761567938,"acceleration":-2.6999999999999997,"pose":{"translation":{"x":5.910154408569832,"y":-2.452584709951119},"rotation":{"radians":-2.850242690365192}},"curvature":1.6400683797905078},{"time":3.861155536589642,"velocity":0.44809207519554023,"acceleration":-2.7000000000000006,"pose":{"translation":{"x":5.884695555551516,"y":-2.4609965262266837},"rotation":{"radians":-2.787675545983974}},"curvature":3.22050410776737},{"time":3.915948019182654,"velocity":0.30015237219440816,"acceleration":-2.7,"pose":{"translation":{"x":5.8657554437247095,"y":-2.468837742167634},"rotation":{"radians":-2.7058643030528273}},"curvature":4.433577634625505},{"time":4.027115564439842,"velocity":0.0,"acceleration":-2.7,"pose":{"translation":{"x":5.850852764976659,"y":-2.476337923196535},"rotation":{"radians":-2.657114724552762}},"curvature":7.099564484227281E-14}] \ No newline at end of file diff --git a/src/main/java/frc4388/robot/commands/auto/FiveBallAutoMiddle.java b/src/main/java/frc4388/robot/commands/auto/FiveBallAutoMiddle.java index 5e5e18f..bce3980 100644 --- a/src/main/java/frc4388/robot/commands/auto/FiveBallAutoMiddle.java +++ b/src/main/java/frc4388/robot/commands/auto/FiveBallAutoMiddle.java @@ -21,7 +21,8 @@ public class FiveBallAutoMiddle extends SequentialCommandGroup { public FiveBallAutoMiddle(Drive drive, RamseteCommand[] paths) { // Use addRequirements() here to declare subsystem dependencies. addCommands( - paths[0] + paths[0], + new TankDriveVelocity(drive, -3.1, -0.3, 0.97) ); } }