diff --git a/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallGetTerminalBalls.path b/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallGetTerminalBalls.path
index 8b9a16eb..042e63f5 100644
--- a/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallGetTerminalBalls.path
+++ b/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallGetTerminalBalls.path
@@ -1,3 +1,3 @@
 X,Y,Tangent X,Tangent Y,Fixed Theta,Reversed,Name
 5.3,-6.2296,-2.0,0.0,true,false,
-1.01,-7.159599999999999,-2.5,-3.0,true,false,
+0.8,-6.9596,-2.5,-3.0,true,false,
diff --git a/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallShootTerminalBalls.path b/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallShootTerminalBalls.path
index 861b74f3..b0cd4007 100644
--- a/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallShootTerminalBalls.path
+++ b/PathWeaver/FiveBallAuton/PathWeaver/Paths/FiveBallShootTerminalBalls.path
@@ -1,3 +1,3 @@
 X,Y,Tangent X,Tangent Y,Fixed Theta,Reversed,Name
-1.01,-7.159599999999999,-2.0,-2.0,true,true,
+0.8,-6.9596,-2.0,-2.0,true,true,
 7.6,-6.579599999999999,-0.5,-3.0,true,true,
diff --git a/src/main/deploy/FiveBallAuton/output/FiveBallGetTerminalBalls.wpilib.json b/src/main/deploy/FiveBallAuton/output/FiveBallGetTerminalBalls.wpilib.json
index 8749b3ab..eaf020ff 100644
--- a/src/main/deploy/FiveBallAuton/output/FiveBallGetTerminalBalls.wpilib.json
+++ b/src/main/deploy/FiveBallAuton/output/FiveBallGetTerminalBalls.wpilib.json
@@ -1,6 +1,6 @@
 [
 {
-"acceleration": 3.1000000000000005,
+"acceleration": 3.1,
 "curvature": -0.0,
 "pose": {
 "rotation": {
@@ -15,798 +15,813 @@
 "velocity": 0.0
 },
 {
-"acceleration": 3.1000000000000005,
-"curvature": -0.097668795123179,
+"acceleration": 3.1,
+"curvature": -0.1743800502912488,
+"pose": {
+"rotation": {
+"radians": 3.1355030792715306
+},
+"translation": {
+"x": 5.23683011829853,
+"y": 2.000133985877037
+}
+},
+"time": 0.20187831498693584,
+"velocity": 0.6258227764595011
+},
+{
+"acceleration": 3.0999999999999988,
+"curvature": -0.23343780635560019,
 "pose": {
 "rotation": {
-"radians": 3.138158504507217
+"radians": 3.1212070787735633
 },
 "translation": {
-"x": 5.236891238689423,
-"y": 2.0000757759809495
+"x": 5.169890689849853,
+"y": 2.0009985160827632
 }
 },
-"time": 0.20178047286105172,
-"velocity": 0.6255194658692604
+"time": 0.2897329524213118,
+"velocity": 0.8981721525060666
 },
 {
-"acceleration": 3.0999999999999996,
-"curvature": -0.1274629666229784,
+"acceleration": 3.1000000000000023,
+"curvature": -0.2084853519180116,
 "pose": {
 "rotation": {
-"radians": 3.1303025885841103
+"radians": 3.1045690691298002
 },
 "translation": {
-"x": 5.170356521606445,
-"y": 2.0005548667907718
+"x": 5.096077236533165,
+"y": 2.0031297999620437
 }
 },
-"time": 0.2892094326954559,
-"velocity": 0.8965492413559135
+"time": 0.3627486919408025,
+"velocity": 1.1245209450164877
 },
 {
 "acceleration": 3.099999999999999,
-"curvature": -0.10898493756680977,
+"curvature": -0.15267310816638918,
 "pose": {
 "rotation": {
-"radians": 3.1215163860749153
+"radians": 3.089523257056628
 },
 "translation": {
-"x": 5.09757337808609,
-"y": 2.0017049032449723
+"x": 5.012966918945312,
+"y": 2.006867065429687
 }
 },
-"time": 0.36139289447590434,
-"velocity": 1.1203179728753037
+"time": 0.4304188162024508,
+"velocity": 1.3342983302275977
 },
 {
-"acceleration": 3.1000000000000036,
-"curvature": -0.07269469870399006,
+"acceleration": 3.100000000000001,
+"curvature": -0.09747804039931392,
 "pose": {
 "rotation": {
-"radians": 3.114123237595181
+"radians": 3.0778438949541087
 },
 "translation": {
-"x": 5.016337890625,
-"y": 2.0036566162109377
+"x": 4.918770256638527,
+"y": 2.012369081377983
 }
 },
-"time": 0.4278199854107588,
-"velocity": 1.3262419547733524
+"time": 0.49612093050811706,
+"velocity": 1.537974884575163
 },
 {
-"acceleration": 3.0999999999999974,
-"curvature": -0.03689486999713424,
+"acceleration": 3.100000000000001,
+"curvature": -0.05333377612186632,
 "pose": {
 "rotation": {
-"radians": 3.1091894539004326
+"radians": 3.0699514532940864
 },
 "translation": {
-"x": 4.925020921230316,
-"y": 2.006416067481041
+"x": 4.812282848358154,
+"y": 2.0196306800842283
 }
 },
-"time": 0.49190548517264615,
-"velocity": 1.5249070040352035
+"time": 0.5612460091489347,
+"velocity": 1.7398626283616978
 },
 {
-"acceleration": 3.100000000000003,
-"curvature": -0.007879960393418416,
+"acceleration": 3.0999999999999925,
+"curvature": -0.020648433725744018,
 "pose": {
 "rotation": {
-"radians": 3.1069860929916064
+"radians": 3.065659987203779
 },
 "translation": {
-"x": 4.822524337768554,
-"y": 2.009876880645752
+"x": 4.692837092280388,
+"y": 2.028499279618263
 }
 },
-"time": 0.5550995575329072,
-"velocity": 1.7208086283520125
+"time": 0.6263154000088499,
+"velocity": 1.9415777400274348
 },
 {
-"acceleration": 3.1,
-"curvature": 0.014035631822515026,
+"acceleration": 3.1000000000000094,
+"curvature": -0.007814138896064873,
 "pose": {
 "rotation": {
-"radians": 3.1074210998754643
+"radians": 3.064751637746488
 },
 "translation": {
-"x": 4.708237240314483,
-"y": 2.0138324719667438
+"x": 4.628181107994169,
+"y": 2.033452280331403
 }
 },
-"time": 0.6179913270923933,
-"velocity": 1.91577311398642
+"time": 0.658867767652855,
+"velocity": 2.0424900797238505
 },
 {
-"acceleration": 3.0999999999999983,
-"curvature": 0.03045319535645603,
+"acceleration": 3.0999999999999948,
+"curvature": 0.003173201997771572,
 "pose": {
 "rotation": {
-"radians": 3.110295155852353
+"radians": 3.0646060174000205
 },
 "translation": {
-"x": 4.5819921875,
-"y": 2.01798828125
+"x": 4.56025390625,
+"y": 2.03869140625
 }
 },
-"time": 0.6807391715687406,
-"velocity": 2.1102914318630965
+"time": 0.6914194772062576,
+"velocity": 2.1434003793393988
 },
 {
-"acceleration": 3.099999999999995,
-"curvature": 0.037171457379483804,
+"acceleration": 3.100000000000001,
+"curvature": 0.012652937994929449,
 "pose": {
 "rotation": {
-"radians": 3.1125864006185675
+"radians": 3.0651812699078587
 },
 "translation": {
-"x": 4.5144435881823295,
-"y": 2.0200281714461745
+"x": 4.489101512078196,
+"y": 2.04416348202154
 }
 },
-"time": 0.7120431366135809,
-"velocity": 2.207333723502101
+"time": 0.7239483530364712,
+"velocity": 2.244239894413061
 },
 {
-"acceleration": 3.100000000000003,
-"curvature": 0.043166925395171016,
+"acceleration": 3.1000000000000023,
+"curvature": 0.020924839704608025,
 "pose": {
 "rotation": {
-"radians": 3.115421405302118
+"radians": 3.066441195840964
 },
 "translation": {
-"x": 4.444021422863006,
-"y": 2.0219740027189257
+"x": 4.414794448018074,
+"y": 2.049809216856956
 }
 },
-"time": 0.7432741242205317,
-"velocity": 2.3041497850836485
+"time": 0.7564254308063678,
+"velocity": 2.3449188354997403
 },
 {
-"acceleration": 3.0999999999999917,
-"curvature": 0.04861282136103557,
+"acceleration": 3.0999999999999903,
+"curvature": 0.028247666459014074,
 "pose": {
 "rotation": {
-"radians": 3.1187861926526934
+"radians": 3.068355857784233
 },
 "translation": {
-"x": 4.370809991136193,
-"y": 2.02376965822652
+"x": 4.337426225375384,
+"y": 2.0555637208558615
 }
 },
-"time": 0.7744054561141964,
-"velocity": 2.400656913954009
+"time": 0.7888170204816628,
+"velocity": 2.445332763493155
 },
 {
-"acceleration": 3.099999999999993,
-"curvature": 0.053659429106060905,
+"acceleration": 3.099999999999998,
+"curvature": 0.034842250676270975,
 "pose": {
 "rotation": {
-"radians": 3.122671310508632
+"radians": 3.0709017535183785
 },
 "translation": {
-"x": 4.294913101196289,
-"y": 2.025355815887451
+"x": 4.257111835479736,
+"y": 2.061357021331787
 }
 },
-"time": 0.8054068772496384,
-"velocity": 2.496761319473879
+"time": 0.8210862649843168,
+"velocity": 2.545367421451382
 },
 {
-"acceleration": 3.099999999999999,
-"curvature": 0.058436916906075276,
+"acceleration": 3.100000000000005,
+"curvature": 0.04089650803483377,
 "pose": {
 "rotation": {
-"radians": 3.127071855911057
+"radians": 3.0740617494362215
 },
 "translation": {
-"x": 4.21645270191133,
-"y": 2.026670330595225
+"x": 4.173986240942031,
+"y": 2.0671145791374146
 }
 },
-"time": 0.8362457498378809,
-"velocity": 2.5923618244974307
+"time": 0.8531943258607587,
+"velocity": 2.644902410168352
 },
 {
-"acceleration": 3.1000000000000076,
-"curvature": 0.06305867419495068,
+"acceleration": 3.1000000000000014,
+"curvature": 0.04657097153566687,
 "pose": {
 "rotation": {
-"radians": 3.1319874184694427
+"radians": 3.0778248976716656
 },
 "translation": {
-"x": 4.135567514896392,
-"y": 2.0276486164331438
+"x": 4.088202866911888,
+"y": 2.0727578049898145
 }
 },
-"time": 0.8668879757024882,
-"velocity": 2.687352724677713
+"time": 0.8851012906332338,
+"velocity": 2.7438140009630247
 },
 {
-"acceleration": 3.0999999999999983,
-"curvature": 0.06762466608425435,
+"acceleration": 3.100000000000001,
+"curvature": 0.05200414878783667,
 "pose": {
 "rotation": {
-"radians": 3.137421993270068
+"radians": 3.0821862142588103
 },
 "translation": {
-"x": 4.052411666586995,
-"y": 2.02822402888909
+"x": 3.999932092335075,
+"y": 2.07820457579568
 }
 },
-"time": 0.8972987134763817,
-"velocity": 2.7816260117767833
+"time": 0.9167668711536254,
+"velocity": 2.8419773005762385
 },
 {
-"acceleration": 3.100000000000002,
-"curvature": 0.07222457032635177,
+"acceleration": 3.100000000000005,
+"curvature": 0.05731739890100731,
 "pose": {
 "rotation": {
-"radians": -3.13980141269264
+"radians": 3.087146465301358
 },
 "translation": {
-"x": 3.9671533203125,
-"y": 2.028328247070313
+"x": 3.9093597412109373,
+"y": 2.083369750976562
 }
 },
-"time": 0.927442940020851,
-"velocity": 2.875073114064638
+"time": 0.9481509443863481,
+"velocity": 2.9392679275976787
 },
 {
-"acceleration": 3.100000000000004,
-"curvature": 0.07694060797540873,
+"acceleration": 3.1000000000000125,
+"curvature": 0.06261923995533034,
 "pose": {
 "rotation": {
-"radians": -3.133299619035644
+"radians": 3.092711988537286
 },
 "translation": {
-"x": 3.879973308369517,
-"y": 2.0278916559182107
+"x": 3.816685573849827,
+"y": 2.0881656887941062
 }
 },
-"time": 0.9572858931799216,
-"velocity": 2.9675862688577572
+"time": 0.9792139741914004,
+"velocity": 3.0355633199933414
 },
 {
-"acceleration": 3.099999999999999,
-"curvature": 0.08185005672010105,
+"acceleration": 2.8476524666660676,
+"curvature": 0.06800910660962954,
 "pose": {
 "rotation": {
-"radians": -3.1262411530932095
+"radians": 3.098894565199379
 },
 "translation": {
-"x": 3.7910637640953064,
-"y": 2.0268437284231187
+"x": 3.722121778130531,
+"y": 2.0925027626752852
 }
 },
-"time": 0.9867934240519499,
-"velocity": 3.059059614561045
+"time": 1.0099173433086142,
+"velocity": 3.130743764256704
 },
 {
-"acceleration": 1.6272026425977104,
-"curvature": 0.08702747313636752,
+"acceleration": -0.21057628940619633,
+"curvature": 0.07358062624972514,
 "pose": {
 "rotation": {
-"radians": -3.1186050255365854
+"radians": 3.1057113491748636
 },
 "translation": {
-"x": 3.7006267539411786,
-"y": 2.0251134078390898
+"x": 3.6258914607577024,
+"y": 2.0962898775376377
 }
 },
-"time": 1.0159322803709614,
-"velocity": 3.1493900691499808
+"time": 1.0402596400192126,
+"velocity": 3.217148080328953
 },
 {
-"acceleration": -0.22062811238399185,
-"curvature": 0.09254666411914501,
+"acceleration": -0.21963790618923232,
+"curvature": 0.07942449824769209,
 "pose": {
 "rotation": {
-"radians": -3.110366007552696
+"radians": 3.11318485542549
 },
 "translation": {
-"x": 3.6088729095458985,
-"y": 2.022629489898682
+"x": 3.528227138519287,
+"y": 2.0994349861145016
 }
 },
-"time": 1.044860611590346,
-"velocity": 3.196462326156105
+"time": 1.0706630510407313,
+"velocity": 3.2107458428507503
 },
 {
-"acceleration": -0.23518996440096127,
-"curvature": 0.09848244846829173,
+"acceleration": -0.23201609883416024,
+"curvature": 0.08563105969083809,
 "pose": {
 "rotation": {
-"radians": -3.10149456870264
+"radians": 3.121343006252909
 },
 "translation": {
-"x": 3.5160200598090885,
-"y": 2.0193210050277415
+"x": 3.429369229543954,
+"y": 2.10184560528025
 }
 },
-"time": 1.0739568923635094,
-"velocity": 3.1900428686517275
+"time": 1.1014944190496243,
+"velocity": 3.2039741057363273
 },
 {
-"acceleration": -0.25263201774746075,
-"curvature": 0.10491224247309447,
+"acceleration": -0.24775491774381544,
+"curvature": 0.0922926105153065,
 "pose": {
 "rotation": {
-"radians": -3.0919567872542895
+"radians": 3.1302192314470036
 },
 "translation": {
-"x": 3.42229186296463,
-"y": 2.0151176005601883
+"x": 3.329564544558525,
+"y": 2.1034293323755264
 }
 },
-"time": 1.103399865271933,
-"velocity": 3.183118176901537
+"time": 1.132683840908546,
+"velocity": 3.1967376577517275
 },
 {
-"acceleration": -0.2730927935812474,
-"curvature": 0.11191749098023901,
+"acceleration": -0.26699168410343865,
+"curvature": 0.0995055552152711,
 "pose": {
 "rotation": {
-"radians": -3.08171424001687
+"radians": 3.139852616019214
 },
 "translation": {
-"x": 3.3279164386540656,
-"y": 2.009949922952802
+"x": 3.2290647781454025,
+"y": 2.1040943615324794
 }
 },
-"time": 1.133128084368887,
-"velocity": 3.175607876927035
+"time": 1.164161152433495,
+"velocity": 3.1889389990240673
 },
 {
-"acceleration": -0.2967613874775945,
-"curvature": 0.11958494865371351,
+"acceleration": -0.28994481846347714,
+"curvature": 0.1073723984085931,
 "pose": {
 "rotation": {
-"radians": -3.070723881472128
+"radians": -3.132897220578015
 },
 "translation": {
-"x": 3.2331250000000002,
-"y": 2.00375
+"x": 3.128125,
+"y": 2.10375
 }
 },
-"time": 1.1630802958492055,
-"velocity": 3.1674281438199383
+"time": 1.1958564826656097,
+"velocity": 3.1804766094271804
 },
 {
-"acceleration": -0.3238658319528871,
-"curvature": 0.12800779453754033,
+"acceleration": -0.3169026289960889,
+"curvature": 0.11600360697520595,
 "pose": {
 "rotation": {
-"radians": -3.0589379254443987
+"radians": -3.121608682942734
 },
 "translation": {
-"x": 3.1381504856795077,
-"y": 1.9964516230486336
+"x": 3.0270021461881695,
+"y": 2.1023071844689545
 }
 },
-"time": 1.1931959276749315,
-"velocity": 3.1584909871345714
+"time": 1.2277008159783422,
+"velocity": 3.1712435099857297
 },
 {
-"acceleration": -0.3546591452624163,
-"curvature": 0.13728653531965862,
+"acceleration": -0.3482108716320027,
+"curvature": 0.12551932037182645,
 "pose": {
 "rotation": {
-"radians": -3.0463037470081344
+"radians": -3.109409820436564
 },
 "translation": {
-"x": 3.0432261919975283,
-"y": 1.9879907292127612
+"x": 2.925953510403633,
+"y": 2.0996789973974224
 }
 },
-"time": 1.223415580796137,
-"velocity": 3.1487038740351445
+"time": 1.2596265606022459,
+"velocity": 3.161126157581757
 },
 {
-"acceleration": -0.38940106513313383,
-"curvature": 0.1475296168682973,
+"acceleration": -0.38425655918139395,
+"curvature": 0.13605085003092132,
 "pose": {
 "rotation": {
-"radians": -3.032763828142663
+"radians": -3.096236889571578
 },
 "translation": {
-"x": 2.948584404960275,
-"y": 1.9783057835884401
+"x": 2.825235235225409,
+"y": 2.09578118333593
 }
 },
-"time": 1.2536815194387692,
-"velocity": 3.137969782105584
+"time": 1.2915681214070598,
+"velocity": 3.150003758852626
 },
 {
-"acceleration": -0.42833311436116944,
-"curvature": 0.1588536171060735,
+"acceleration": -0.42544495880576433,
+"curvature": 0.14774185430109926,
 "pose": {
 "rotation": {
-"radians": -3.0182557781832475
+"radians": -3.0820194972928956
 },
 "translation": {
-"x": 2.8544550323486333,
-"y": 1.9673381614685068
+"x": 2.725100803375244,
+"y": 2.0905326652526854
 }
 },
-"time": 1.2839381569553905,
-"velocity": 3.1261878152292644
+"time": 1.3234624737427079,
+"velocity": 3.1377481447668107
 },
 {
-"acceleration": -0.4716442426776109,
-"curvature": 0.17138283317054925,
+"acceleration": -0.47216600266439296,
+"curvature": 0.1607490018812933,
 "pose": {
 "rotation": {
-"radians": -3.002712469776927
+"radians": -3.06668052500909
 },
 "translation": {
-"x": 2.7610642357915642,
-"y": 1.9550325305573653
+"x": 2.6257995289750395,
+"y": 2.0838560608588157
 }
 },
-"time": 1.314132532457759,
-"velocity": 3.1132545643341443
+"time": 1.3552497337136111,
+"velocity": 3.1242244152579417
 },
 {
-"acceleration": -0.5194239167008977,
-"curvature": 0.18524799916957377,
+"acceleration": -0.52474551520026,
+"curvature": 0.17524183787286424,
 "pose": {
 "rotation": {
-"radians": -2.986062343212742
+"radians": -3.050136198538828
 },
 "translation": {
-"x": 2.668633062839509,
-"y": 1.9413372331857692
+"x": 2.527575048804283,
+"y": 2.075678198933602
 }
 },
-"time": 1.3442147718068738,
-"velocity": 3.0990664493382845
+"time": 1.3868737183346627,
+"velocity": 3.1092926448510996
 },
 {
-"acceleration": -0.5715993270062777,
-"curvature": 0.20058377552697462,
+"acceleration": -0.5833758841142493,
+"curvature": 0.19140143573080007,
 "pose": {
 "rotation": {
-"radians": -2.9682299469656614
+"radians": -3.032296381451369
 },
 "translation": {
-"x": 2.577376079037787,
-"y": 1.9262046685256076
+"x": 2.4306638135574756,
+"y": 2.0659306356497114
 }
 },
-"time": 1.3741385244624444,
-"velocity": 3.083523336531539
+"time": 1.4182824864694241,
+"velocity": 3.0928110346344186
 },
 {
-"acceleration": -0.6278535694789914,
-"curvature": 0.2175245369007364,
+"acceleration": -0.6480203542940749,
+"curvature": 0.20941724975603182,
 "pose": {
 "rotation": {
-"radians": -2.949136800188931
+"radians": -3.0130651938864594
 },
 "translation": {
-"x": 2.4875000000000003,
-"y": 1.9095916748046893
+"x": 2.3352935791015628,
+"y": 2.0545501708984375
 }
 },
-"time": 1.403861365139101,
-"velocity": 3.0665337808040474
+"time": 1.4494288481560391,
+"velocity": 3.0746409983485474
 },
 {
-"acceleration": -0.6875225544990435,
-"curvature": 0.23619785731294046,
+"acceleration": -0.7182854759710283,
+"curvature": 0.22948137417768905,
 "pose": {
 "rotation": {
-"radians": -2.928702683448671
+"radians": -2.992342089051852
 },
 "translation": {
-"x": 2.399202323481442,
-"y": 1.8914599115215252
+"x": 2.2416818977333604,
+"y": 2.0414793646149345
 }
 },
-"time": 1.4333451461633553,
-"velocity": 3.0480222836462323
+"time": 1.4802708257772583,
+"velocity": 3.054654769083315
 },
 {
-"acceleration": -0.7494704063838151,
-"curvature": 0.25671496077655753,
+"acceleration": -0.7932580871141434,
+"curvature": 0.2517791727274346,
 "pose": {
 "rotation": {
-"radians": -2.9068474862880045
+"radians": -2.9700235549112493
 },
 "translation": {
-"x": 2.3126699614524853,
-"y": 1.87177624166012
+"x": 2.1500346094369887,
+"y": 2.0266670531034476
 }
 },
-"time": 1.46255628292044,
-"velocity": 3.0279389682831805
+"time": 1.5107720454801201,
+"velocity": 3.032746185971348
 },
 {
-"acceleration": -2.418057517083859,
-"curvature": 0.27915729865405264,
+"acceleration": -1.7582926181075553,
+"curvature": 0.276474990023978,
 "pose": {
 "rotation": {
-"radians": -2.883493762230572
+"radians": -2.9460056474858027
 },
 "translation": {
-"x": 2.2280778721720003,
-"y": 1.8505131139047464
+"x": 2.060544333141297,
+"y": 2.0100688653625554
 }
 },
-"time": 1.491465950981172,
-"velocity": 3.0062720276132824
+"time": 1.540902031375396,
+"velocity": 3.0088453309952854
 },
 {
-"acceleration": -3.099999999999989,
-"curvature": 0.30355837590962037,
+"acceleration": -3.0999999999999845,
+"curvature": 0.3036914450876162,
 "pose": {
 "rotation": {
-"radians": -2.858570159975163
+"radians": -2.920187600881952
 },
 "translation": {
-"x": 2.1455876922607438,
-"y": 1.8276489448547384
+"x": 1.9733889579772947,
+"y": 1.9916477394104009
 }
 },
-"time": 1.52027358427706,
-"velocity": 2.936613513372765
+"time": 1.5707689959043452,
+"velocity": 2.956330467738754
 },
 {
-"acceleration": -3.1000000000000023,
-"curvature": 0.32988004781412533,
+"acceleration": -3.1000000000000036,
+"curvature": 0.3334807347612867,
 "pose": {
 "rotation": {
-"radians": -2.832015907980561
+"radians": -2.892476790390049
 },
 "translation": {
-"x": 2.0653463687747733,
-"y": 1.8031685012392717
+"x": 1.8887301345355807,
+"y": 1.9713744386099288
 }
 },
-"time": 1.5492856407287943,
-"velocity": 2.8466761383723895
+"time": 1.600684308848215,
+"velocity": 2.863592997612758
 },
 {
-"acceleration": -3.0999999999999983,
-"curvature": 0.35798284626940097,
+"acceleration": -3.1000000000000068,
+"curvature": 0.3657865989125134,
 "pose": {
 "rotation": {
-"radians": -2.8037865198541367
+"radians": -2.8627953367203407
 },
 "translation": {
-"x": 1.98748479127884,
-"y": 1.7770632821321506
+"x": 1.8067117661237724,
+"y": 1.9492280679941185
 }
 },
-"time": 1.5786017330045654,
-"velocity": 2.755796252317499
+"time": 1.630844191748853,
+"velocity": 2.7700973606207797
 },
 {
-"acceleration": -3.1000000000000085,
-"curvature": 0.38759059398156576,
+"acceleration": -3.099999999999995,
+"curvature": 0.4003963474234572,
 "pose": {
 "rotation": {
-"radians": -2.7738608485406964
+"radians": -2.8310886136132316
 },
 "translation": {
-"x": 1.912116423919799,
-"y": 1.74933190116659
+"x": 1.727458500023932,
+"y": 1.9251965905912236
 }
 },
-"time": 1.608237304482674,
-"velocity": 2.663925980735362
+"time": 1.6612584323461304,
+"velocity": 2.67581321476922
 },
 {
-"acceleration": -3.0999999999999943,
-"curvature": 0.4182507474199292,
+"acceleration": -3.0999999999999996,
+"curvature": 0.4368838985354978,
 "pose": {
 "rotation": {
-"radians": -2.7422495347737748
+"radians": -2.7973358335482046
 },
 "translation": {
-"x": 1.8393359375000014,
-"y": 1.7199804687500029
+"x": 1.6510742187500007,
+"y": 1.8992773437500023
 }
 },
-"time": 1.638219166653082,
-"velocity": 2.570982208007097
+"time": 1.6919489156009846,
+"velocity": 2.580672716679172
 },
 {
-"acceleration": -3.1000000000000085,
-"curvature": 0.4492936420736973,
+"acceleration": -3.1000000000000036,
+"curvature": 0.47454738096956,
 "pose": {
 "rotation": {
-"radians": -2.7090047564312547
+"radians": -2.7615627093215167
 },
 "translation": {
-"x": 1.7692178415507103,
-"y": 1.6890229742787808
+"x": 1.5776405313052235,
+"y": 1.8714775554649554
 }
 },
-"time": 1.6685879066172553,
-"velocity": 2.4768391141181603
+"time": 1.7229522727127484,
+"velocity": 2.4845623096327043
 },
 {
-"acceleration": -3.1000000000000023,
-"curvature": 0.47979601396488814,
+"acceleration": -3.0999999999999934,
+"curvature": 0.5123485704426508,
 "pose": {
 "rotation": {
-"radians": -2.6742309822622334
+"radians": -2.7238558984977286
 },
 "translation": {
-"x": 1.7018151164054887,
-"y": 1.6564816683530834
+"x": 1.5072152644395826,
+"y": 1.8418148607015628
 }
 },
-"time": 1.6994007918399767,
-"velocity": 2.3813191699277234
+"time": 1.7543230408071362,
+"velocity": 2.387312928540102
 },
 {
-"acceleration": -3.100000000000003,
-"curvature": 0.5085564908760237,
+"acceleration": -3.0999999999999983,
+"curvature": 0.5488658743211727,
 "pose": {
 "rotation": {
-"radians": -2.638096170404712
+"radians": -2.6843785255472223
 },
 "translation": {
-"x": 1.6371578452736175,
-"y": 1.6223874449916211
+"x": 1.4398309539072214,
+"y": 1.8103178177215185
 }
 },
-"time": 1.730735338110548,
-"velocity": 2.284182076488953
+"time": 1.7861374825762457,
+"velocity": 2.2886881590558623
 },
 {
-"acceleration": -3.099999999999999,
-"curvature": 0.5340924725629522,
+"acceleration": -3.100000000000009,
+"curvature": 0.582276606707743,
 "pose": {
 "rotation": {
-"radians": -2.6008425553310683
+"radians": -2.643385571474581
 },
 "translation": {
-"x": 1.5752518463134804,
-"y": 1.5867802238464384
+"x": 1.3754933357238768,
+"y": 1.7770264244079623
 }
 },
-"time": 1.7626938041983438,
-"velocity": 2.1851108316167855
+"time": 1.818498305881348,
+"velocity": 2.188369606810045
 },
 {
-"acceleration": -3.0999999999999943,
-"curvature": 0.5546678953502758,
+"acceleration": -3.0999999999999988,
+"curvature": 0.6103858882616928,
 "pose": {
 "rotation": {
-"radians": -2.56279589158731
+"radians": -2.6012374082905008
 },
 "translation": {
-"x": 1.5160773047059815,
-"y": 1.5497093324177005
+"x": 1.3141798374243097,
+"y": 1.7419926345907184
 }
 },
-"time": 1.7954090453208118,
-"velocity": 2.0836935841371345
+"time": 1.851540685817712,
+"velocity": 2.0859382290073167
 },
 {
-"acceleration": -3.1000000000000005,
-"curvature": 0.5683586647559494,
+"acceleration": -3.1000000000000045,
+"curvature": 0.6307161144805933,
 "pose": {
 "rotation": {
-"radians": -2.5243718531275148
+"radians": -2.5584093870964577
 },
 "translation": {
-"x": 1.45958740472794,
-"y": 1.5112338882684746
+"x": 1.2558380693197266,
+"y": 1.7052808743715326
 }
 },
-"time": 1.8290524540974937,
-"velocity": 1.9793990169294204
+"time": 1.8854402845531917,
+"velocity": 1.9808494729273298
 },
 {
-"acceleration": -3.0999999999999988,
-"curvature": 0.5731563856745092,
+"acceleration": -3.1000000000000045,
+"curvature": 0.6406606324672105,
 "pose": {
 "rotation": {
-"radians": -2.4860783214344466
+"radians": -2.515495360684787
 },
 "translation": {
-"x": 1.4057069618254951,
-"y": 1.471423181239519
+"x": 1.2003843157552199,
+"y": 1.6669685584493017
 }
 },
-"time": 1.8638452526212121,
-"velocity": 1.871541341505893
+"time": 1.920424499915247,
+"velocity": 1.8723984053049578
 },
 {
-"acceleration": -3.099999999999999,
-"curvature": 0.5671019934811893,
+"acceleration": -3.1000000000000005,
+"curvature": 0.6376885163958657,
 "pose": {
 "rotation": {
-"radians": -2.4485126127943415
+"radians": -2.4732035122482716
 },
 "translation": {
-"x": 1.3543310546875036,
-"y": 1.430357055664067
+"x": 1.147702026367189,
+"y": 1.6271466064453168
 }
 },
-"time": 1.9000754012385137,
-"velocity": 1.7592278807922586
+"time": 1.9567891825662844,
+"velocity": 1.759667889086742
 },
 {
 "acceleration": -3.0999999999999988,
-"curvature": 0.5484312916654068,
+"curvature": 0.6195684815954238,
 "pose": {
 "rotation": {
-"radians": -2.41235330818869
+"radians": -2.4323439281095482
 },
 "translation": {
-"x": 1.3053236573189553,
-"y": 1.388126292582606
+"x": 1.0976403073407726,
+"y": 1.585919959228491
 }
 },
-"time": 1.9381243677345876,
-"velocity": 1.6412760846544292
+"time": 1.9949250534502097,
+"velocity": 1.641446689346574
 },
 {
-"acceleration": -3.1000000000000005,
-"curvature": 0.5157079731071784,
+"acceleration": -3.1,
+"curvature": 0.584566880962836,
 "pose": {
 "rotation": {
-"radians": -2.378347165663295
+"radians": -2.3938088344508675
 },
 "translation": {
-"x": 1.2585162711143552,
-"y": 1.34483299195767
+"x": 1.050012412667276,
+"y": 1.5434080952405989
 }
 },
-"time": 1.9785121906437761,
-"velocity": 1.516073833635945
+"time": 2.035362262636539,
+"velocity": 1.5160913408689536
 },
 {
-"acceleration": -3.0999999999999996,
-"curvature": 0.40452673718079507,
+"acceleration": -3.1000000000000014,
+"curvature": 0.46014385592970725,
 "pose": {
 "rotation": {
-"radians": -2.3200202310468887
+"radians": -2.32754212946249
 },
 "translation": {
-"x": 1.1706569671630893,
-"y": 1.2555260658264213
+"x": 0.9611227989196776,
+"y": 1.455082416534431
 }
 },
-"time": 2.0696357584419385,
-"velocity": 1.2335907734616411
+"time": 2.126509784909156,
+"velocity": 1.2335340218238409
 },
 {
 "acceleration": -3.1,
-"curvature": 0.23106820310933107,
+"curvature": 0.2630497271102327,
 "pose": {
 "rotation": {
-"radians": -2.2802038060790797
+"radians": -2.2822343588821643
 },
 "translation": {
-"x": 1.0887037205696215,
-"y": 1.163493979573257
+"x": 0.878764840960506,
+"y": 1.3634357696771708
 }
 },
-"time": 2.1867739163281197,
-"velocity": 0.87046248401448
+"time": 2.2436355423074072,
+"velocity": 0.8704441738892608
 },
 {
 "acceleration": -3.1,
-"curvature": 4.2952449810433575e-15,
+"curvature": -6.6814921927341896e-15,
 "pose": {
 "rotation": {
-"radians": -2.2655346029915977
+"radians": -2.265534602991606
 },
 "translation": {
-"x": 1.0100000000000078,
-"y": 1.0700000000000074
+"x": 0.8000000000000034,
+"y": 1.2700000000000102
 }
 },
-"time": 2.46756826601021,
+"time": 2.5244239854974913,
 "velocity": 0.0
 }
 ]
\ No newline at end of file
diff --git a/src/main/deploy/FiveBallAuton/output/FiveBallShootTerminalBalls.wpilib.json b/src/main/deploy/FiveBallAuton/output/FiveBallShootTerminalBalls.wpilib.json
index ada5f2b1..dcc29bd7 100644
--- a/src/main/deploy/FiveBallAuton/output/FiveBallShootTerminalBalls.wpilib.json
+++ b/src/main/deploy/FiveBallAuton/output/FiveBallShootTerminalBalls.wpilib.json
@@ -1,1442 +1,1487 @@
 [
 {
-"acceleration": -3.0999999999999996,
+"acceleration": -3.099999999999999,
 "curvature": -0.0,
 "pose": {
 "rotation": {
 "radians": -2.356194490192345
 },
 "translation": {
-"x": 1.01,
-"y": 1.0700000000000003
+"x": 0.8,
+"y": 1.2699999999999996
 }
 },
 "time": 0.0,
 "velocity": -0.0
 },
 {
-"acceleration": -3.099999999999999,
-"curvature": 0.9794968213399388,
+"acceleration": -3.0999999999999983,
+"curvature": 1.036301094141045,
 "pose": {
 "rotation": {
-"radians": -2.4031808695593275
+"radians": -2.405925512253108
 },
 "translation": {
-"x": 1.07400914311409,
-"y": 1.1319712257385257
+"x": 0.8640702635049821,
+"y": 1.3319130158424377
 }
 },
-"time": 0.239748830530959,
-"velocity": -0.7432213746459728
+"time": 0.23975348919856265,
+"velocity": -0.743235816515544
 },
 {
-"acceleration": -3.1,
-"curvature": 1.274896817481633,
+"acceleration": -3.0999999999999988,
+"curvature": 1.3467739924395081,
 "pose": {
 "rotation": {
-"radians": -2.455539202743793
+"radians": -2.4613069359191044
 },
 "translation": {
-"x": 1.108719686381519,
-"y": 1.162009482383728
+"x": 0.8989210567437113,
+"y": 1.3618177010864017
 }
 },
-"time": 0.2951178988693152,
-"velocity": -0.9148654864948771
+"time": 0.2951425056141551,
+"velocity": -0.9149417674038807
 },
 {
-"acceleration": -3.099999999999998,
-"curvature": 1.4189479059674606,
+"acceleration": -3.1000000000000005,
+"curvature": 1.4941118540295046,
 "pose": {
 "rotation": {
-"radians": -2.520277879063845
+"radians": -2.5296785646823037
 },
 "translation": {
-"x": 1.1464906692504884,
-"y": 1.190977478027344
+"x": 0.9369565010070802,
+"y": 1.390533828735351
 }
 },
-"time": 0.3432265548587831,
-"velocity": -1.0640023200622275
+"time": 0.34330215797916225,
+"velocity": -1.0642366897354028
 },
 {
 "acceleration": -3.1000000000000028,
-"curvature": 1.426269140685639,
+"curvature": 1.494006501735554,
 "pose": {
 "rotation": {
-"radians": -2.591888450533808
+"radians": -2.6050981956482655
 },
 "translation": {
-"x": 1.188135079331696,
-"y": 1.218592293262482
+"x": 0.9790227578021586,
+"y": 1.417746885195374
 }
 },
-"time": 0.3873526895262995,
-"velocity": -1.200793337531528
+"time": 0.3875302093565382,
+"velocity": -1.2013436490052682
 },
 {
-"acceleration": -3.0999999999999988,
-"curvature": 1.3315418243924337,
+"acceleration": -3.1000000000000045,
+"curvature": 1.3850280546320657,
 "pose": {
 "rotation": {
-"radians": -2.6653837232198314
+"radians": -2.6821900431248102
 },
 "translation": {
-"x": 1.234366716146469,
-"y": 1.2446063423156737
+"x": 1.0258628576993942,
+"y": 1.4431814455986016
 }
 },
-"time": 0.42926291560280033,
-"velocity": -1.3307150383686808
+"time": 0.4296124905120928,
+"velocity": -1.3317987205874877
 },
 {
-"acceleration": -3.1000000000000005,
-"curvature": 1.177185638511997,
+"acceleration": -3.1,
+"curvature": 1.2143891765231536,
 "pose": {
 "rotation": {
-"radians": -2.7368350444250673
+"radians": -2.7567586977282597
 },
 "translation": {
-"x": 1.2858037718757986,
-"y": 1.2688060855865482
+"x": 1.0781204218976201,
+"y": 1.4665997522324323
 }
 },
-"time": 0.4700437164509463,
-"velocity": -1.457135520997933
+"time": 0.47065060954761656,
+"velocity": -1.4590168895976114
 },
 {
-"acceleration": -3.100000000000004,
-"curvature": 1.0008440183144818,
+"acceleration": -3.0999999999999983,
+"curvature": 1.0233869981947041,
 "pose": {
 "rotation": {
-"radians": -2.803598893913312
+"radians": -2.826040733713435
 },
 "translation": {
-"x": 1.3429724121093751,
-"y": 1.2910107421875
+"x": 1.1363433837890624,
+"y": 1.4878002929687497
 }
 },
-"time": 0.5104003095303514,
-"velocity": -1.5822409595440892
+"time": 0.5113589071242242,
+"velocity": -1.5852126120850951
 },
 {
 "acceleration": -3.1000000000000023,
-"curvature": 0.8286370991815178,
+"curvature": 0.8398728732920482,
 "pose": {
 "rotation": {
-"radians": -2.8642318019775033
+"radians": -2.888593444851112
 },
 "translation": {
-"x": 1.4063103565946222,
-"y": 1.3110710024833683
+"x": 1.2009877105243505,
+"y": 1.50661637969315
 }
 },
-"time": 0.5507923330606411,
-"velocity": -1.7074562324879874
+"time": 0.552199918528654,
+"velocity": -1.7118197474388275
 },
 {
 "acceleration": -3.0999999999999983,
-"curvature": 0.6747422393343973,
+"curvature": 0.6782137424689267,
 "pose": {
 "rotation": {
-"radians": -2.918219509435729
+"radians": -2.943975459304376
 },
 "translation": {
-"x": 1.476170459985733,
-"y": 1.3288677406311038
+"x": 1.2724211245775223,
+"y": 1.522914726734161
 }
 },
-"time": 0.5915088511774201,
-"velocity": -1.8336774386500025
+"time": 0.5934603366843488,
+"velocity": -1.8397270437214814
 },
 {
-"acceleration": -3.1000000000000014,
-"curvature": 0.5444161244236161,
+"acceleration": -3.099999999999993,
+"curvature": 0.5430662309681106,
 "pose": {
 "rotation": {
-"radians": -2.9656632157999345
+"radians": -2.9923889611326855
 },
 "translation": {
-"x": 1.5528242925927043,
-"y": 1.3443107271194457
+"x": 1.350926825311035,
+"y": 1.5365940292924636
 }
 },
-"time": 0.6327167132545717,
-"velocity": -1.9614218110891724
+"time": 0.6353008362824425,
+"velocity": -1.9694325924755718
 },
 {
-"acceleration": -3.100000000000003,
-"curvature": 0.43759946952971307,
+"acceleration": -3.0999999999999974,
+"curvature": 0.43356378727676553,
 "pose": {
 "rotation": {
-"radians": -3.0070125365286517
+"radians": -3.034384298071467
 },
 "translation": {
-"x": 1.636465721130371,
-"y": 1.357337341308594
+"x": 1.4367072105407717,
+"y": 1.5475835418701172
 }
 },
-"time": 0.6744947629482708,
-"velocity": -2.09093376513964
+"time": 0.677791742690157,
+"velocity": -2.1011544023394864
 },
 {
-"acceleration": -3.0999999999999956,
-"curvature": 0.3516975909060018,
+"acceleration": -3.1,
+"curvature": 0.3463921698685697,
 "pose": {
 "rotation": {
-"radians": -3.042875344829017
+"radians": -3.0706562681222627
 },
 "translation": {
-"x": 1.7272144894674422,
-"y": 1.367911283969879
+"x": 1.5298875981010496,
+"y": 1.5558416566997764
 }
 },
-"time": 0.7168590361633997,
-"velocity": -2.2222630121065396
+"time": 0.7209394237315632,
+"velocity": -2.2349122135678456
+},
+{
+"acceleration": -3.0999999999999974,
+"curvature": 0.2775890964402677,
+"pose": {
+"rotation": {
+"radians": -3.1019213339581175
+},
+"translation": {
+"x": 1.63051994740963,
+"y": 1.5613544821739191
+}
+},
+"time": 0.7647058887404262,
+"velocity": -2.370588255095321
 },
 {
 "acceleration": -3.100000000000001,
-"curvature": 0.28328870849192367,
+"curvature": 0.22341689604434475,
 "pose": {
 "rotation": {
-"radians": -3.073898887698457
+"radians": -3.12885261232334
 },
 "translation": {
-"x": 1.8251197993755341,
-"y": 1.3760212898254398
+"x": 1.7385865810327232,
+"y": 1.5641344212740655
 }
 },
-"time": 0.7597815021772568,
-"velocity": -2.3553226567494963
+"time": 0.8090232194667248,
+"velocity": -2.5079719803468468
 },
 {
-"acceleration": -3.099999999999997,
-"curvature": 0.22900379805715693,
+"acceleration": -3.1,
+"curvature": 0.18069216405956412,
 "pose": {
 "rotation": {
-"radians": -3.100703778859191
+"radians": 3.131134178218059
 },
 "translation": {
-"x": 1.9301638912782073,
-"y": 1.381679840087891
+"x": 1.85400390625,
+"y": 1.5642187499999993
 }
 },
-"time": 0.803203940263754,
-"velocity": -2.4899322148176375
+"time": 0.8538040641590876,
+"velocity": -2.6467925988931715
 },
 {
-"acceleration": -3.099999999999997,
-"curvature": 0.18589539882042716,
+"acceleration": -3.1000000000000116,
+"curvature": 0.14684294979881743,
 "pose": {
 "rotation": {
-"radians": -3.1238524090530158
+"radians": 3.1111475966495616
 },
 "translation": {
-"x": 2.0422656249999998,
-"y": 1.3849218749999999
+"x": 1.9766261366195976,
+"y": 1.561668195798993
 }
 },
-"time": 0.8470481143651308,
-"velocity": -2.6258491545319056
+"time": 0.8989491687334795,
+"velocity": -2.7867424230737865
 },
 {
-"acceleration": -3.099999999999996,
-"curvature": 0.1515353861316915,
+"acceleration": -3.100000000000016,
+"curvature": 0.13259662053068694,
 "pose": {
 "rotation": {
-"radians": 3.139347591225313
+"radians": 3.102217442327232
 },
 "translation": {
-"x": 2.161284060515463,
-"y": 1.3858035063743595
+"x": 2.0405774427315917,
+"y": 1.5594298775936473
 }
 },
-"time": 0.8912231494568985,
-"velocity": -2.762791763316385
+"time": 0.921625617585207,
+"velocity": -2.857039414514142
 },
 {
-"acceleration": -3.0999999999999934,
-"curvature": 0.12398834215744799,
+"acceleration": -3.0999999999999917,
+"curvature": 0.11985007222262825,
 "pose": {
 "rotation": {
-"radians": 3.1221023296916806
+"radians": 3.0939297824533245
 },
 "translation": {
-"x": 2.287022038698196,
-"y": 1.3844007301330565
+"x": 2.1062490135431293,
+"y": 1.5565655159950254
 }
 },
-"time": 0.9356308174478816,
-"velocity": -2.9004555340884326
+"time": 0.9443531205399865,
+"velocity": -2.927494673673959
 },
 {
-"acceleration": -3.0999999999999783,
-"curvature": 0.1122820036879245,
+"acceleration": -3.0999999999999948,
+"curvature": 0.10842162349182353,
 "pose": {
 "rotation": {
-"radians": 3.1143927784461702
+"radians": 3.0862401469585885
 },
 "translation": {
-"x": 2.3523347528523297,
-"y": 1.3828715581074356
+"x": 2.1736067910242127,
+"y": 1.5530886646104047
 }
 },
-"time": 0.9578902907693716,
-"velocity": -2.9694599013850516
+"time": 0.9671180387954534,
+"velocity": -2.998065920265906
 },
 {
-"acceleration": -3.0999999999999917,
-"curvature": 0.10173904763213155,
+"acceleration": -3.099999999999993,
+"curvature": 0.0981521174807289,
 "pose": {
 "rotation": {
-"radians": 3.107238363712352
+"radians": 3.0791079046124166
 },
 "translation": {
-"x": 2.4192297620698806,
-"y": 1.3808081388473514
+"x": 2.2426135278306902,
+"y": 1.5490140762180085
 }
 },
-"time": 0.9801695803167582,
-"velocity": -3.0385256989819496
+"time": 0.9899067219645384,
+"velocity": -3.0687108380900696
 },
 {
-"acceleration": -3.099999999999996,
-"curvature": 0.09222244449819793,
+"acceleration": -3.0761643561180585,
+"curvature": 0.08890219948493788,
 "pose": {
 "rotation": {
-"radians": 3.1006031340158624
+"radians": 3.07249597963656
 },
 "translation": {
-"x": 2.4876682043902107,
-"y": 1.3782249909266833
+"x": 2.313228903603158,
+"y": 1.544357658342924
 }
 },
-"time": 1.0024558244158501,
-"velocity": -3.107613055689135
+"time": 1.0127055668212679,
+"velocity": -3.139387257145931
 },
 {
-"acceleration": -1.7000879446453943,
-"curvature": 0.08361168752613425,
+"acceleration": -0.3600616287296283,
+"curvature": 0.0805498490640445,
 "pose": {
 "rotation": {
-"radians": 3.0944542392396404
+"radians": 3.066370578223738
 },
 "translation": {
-"x": 2.557608375549316,
-"y": 1.375137634277344
+"x": 2.385409641265869,
+"y": 1.5391364288330074
 }
 },
-"time": 1.0247362159928712,
-"velocity": -3.1766822695779005
+"time": 1.0355029948778534,
+"velocity": -3.209515892744765
 },
 {
-"acceleration": -0.3445390317784229,
-"curvature": 0.07580078030315253,
+"acceleration": -0.3227141483404981,
+"curvature": 0.07298817137790722,
 "pose": {
 "rotation": {
-"radians": 3.0887617005437744
+"radians": 3.0607009290345766
 },
 "translation": {
-"x": 2.629005840878235,
-"y": 1.3715625499561428
+"x": 2.4591096233256398,
+"y": 1.5333684714348053
 }
 },
-"time": 1.047105954111979,
-"velocity": -3.21471279167907
+"time": 1.0585064890489775,
+"velocity": -3.2177985683224923
 },
 {
-"acceleration": -0.3105583218651874,
-"curvature": 0.06869643113959,
+"acceleration": -0.29019593995186116,
+"curvature": 0.06612343889051392,
 "pose": {
 "rotation": {
-"radians": 3.0834981921467692
+"radians": 3.0554590400566495
 },
 "translation": {
-"x": 2.7018135472014544,
-"y": 1.3675171399116515
+"x": 2.5342800081707537,
+"y": 1.5270728913694622
 }
 },
-"time": 1.0697616590548873,
-"velocity": -3.222518566324357
+"time": 1.0819215928041452,
+"velocity": -3.2253549535891457
 },
 {
-"acceleration": -0.28088707222375786,
-"curvature": 0.0622164466585916,
+"acceleration": -0.2618704736918245,
+"curvature": 0.05987336684173289,
 "pose": {
 "rotation": {
-"radians": 3.0786388368085165
+"radians": 3.0506194730105523
 },
 "translation": {
-"x": 2.7759819347353183,
-"y": 1.363019686751068
+"x": 2.610869346369873,
+"y": 1.5202697709086346
 }
 },
-"time": 1.092794031413447,
-"velocity": -3.2296714612326056
+"time": 1.1057355935705118,
+"velocity": -3.232265679925556
 },
 {
-"acceleration": -0.25497598295715135,
-"curvature": 0.05628831145069817,
+"acceleration": -0.23718898004431016,
+"curvature": 0.054165602020068516,
 "pose": {
 "rotation": {
-"radians": 3.0741610159426007
+"radians": 3.04615913565413
 },
 "translation": {
-"x": 2.8514590489864347,
-"y": 1.3580893135070804
+"x": 2.68882369697094,
+"y": 1.512980124950409
 }
 },
-"time": 1.1161899409195881,
-"velocity": -3.2362430697557976
+"time": 1.1299346462688875,
+"velocity": -3.238602697318573
 },
 {
-"acceleration": -0.2323501850996307,
-"curvature": 0.05084793781395936,
+"acceleration": -0.21567937949688556,
+"curvature": 0.04893640299699597,
 "pose": {
 "rotation": {
-"radians": 3.0700441946453285
+"radians": 3.042057091771254
 },
 "translation": {
-"x": 2.9281906526500823,
-"y": 1.3527459434047344
+"x": 2.768086743800086,
+"y": 1.5052258565952066
 }
 },
-"time": 1.139935235332492,
-"velocity": -3.2422975495393347
+"time": 1.1545038387124607,
+"velocity": -3.2444302390147763
 },
 {
-"acceleration": -0.21260007729993333,
-"curvature": 0.045838568573914176,
+"acceleration": -0.19693628848410216,
+"curvature": 0.04412949015918066,
 "pose": {
 "rotation": {
-"radians": 3.066269761491201
+"radians": 3.038294388263502
 },
 "translation": {
-"x": 3.0061203375086185,
-"y": 1.3470102596282958
+"x": 2.848599911760539,
+"y": 1.4970297127217052
 }
 },
-"time": 1.1640148000990769,
-"velocity": -3.247892440869969
+"time": 1.179427254557166,
+"velocity": -3.2498057058791052
 },
 {
-"acceleration": -0.19537306062903323,
-"curvature": 0.041209816085739016,
+"acceleration": -0.1806121391986525,
+"curvature": 0.03969504496006895,
 "pose": {
 "rotation": {
-"radians": 3.062820882656256
+"radians": 3.0348538985372224
 },
 "translation": {
-"x": 3.085189636329887,
-"y": 1.340903665088117
+"x": 2.930302483131527,
+"y": 1.4884152395627464
 }
 },
-"time": 1.1884126159661934,
-"velocity": -3.2530794184092677
+"time": 1.204688033953441,
+"velocity": -3.2547804700176233
 },
 {
-"acceleration": -0.18036619277217036,
-"curvature": 0.036916821305556104,
+"acceleration": -0.16640938421969545,
+"curvature": 0.035588839383295864,
 "pose": {
 "rotation": {
-"radians": 3.0596823697516116
+"radians": 3.031720181254409
 },
 "translation": {
-"x": 3.1653381347656246,
-"y": 1.3344482421875004
+"x": 3.013131713867187,
+"y": 1.4794067382812504
 }
 },
-"time": 1.213111814663371,
-"velocity": -3.25790497645382
+"time": 1.2302684320576782,
+"velocity": -3.2594006004407827
 },
 {
-"acceleration": -0.16731973456256405,
-"curvature": 0.03291951797216004,
+"acceleration": -0.15407371874722983,
+"curvature": 0.03177147839232014,
 "pose": {
 "rotation": {
-"radians": 3.056840560649406
+"radians": 3.028879353463493
 },
 "translation": {
-"x": 3.2465035832498685,
-"y": 1.3276667125895623
+"x": 3.0970229498954724,
+"y": 1.47002922054613
 }
 },
-"time": 1.2380947327819984,
-"velocity": -3.2624110502792156
+"time": 1.256149875562653,
+"velocity": -3.2637075155171624
 },
 {
-"acceleration": -0.1560115341547139,
-"curvature": 0.029181988262068262,
+"acceleration": -0.14338823408447643,
+"curvature": 0.02820773996051943,
 "pose": {
 "rotation": {
-"radians": 3.0542832125397257
+"radians": 3.026318977123712
 },
 "translation": {
-"x": 3.328622008897364,
-"y": 1.3205823969841006
+"x": 3.1819097434170542,
+"y": 1.4603083641082044
 }
 },
-"time": 1.2633429639779246,
-"velocity": -3.2666355776210922
+"time": 1.2823130174021058,
+"velocity": -3.267738568074478
 },
 {
-"acceleration": -0.14625218038324753,
-"curvature": 0.02567189764027361,
+"acceleration": -0.1341684092185938,
+"curvature": 0.02486599902908148,
 "pose": {
 "rotation": {
-"radians": 3.0519994064532656
+"radians": 3.024027958068046
 },
 "translation": {
-"x": 3.411627827401971,
-"y": 1.3132191748544573
+"x": 3.2677239692042352,
+"y": 1.450270468376111
 }
 },
-"time": 1.288837409621433,
-"velocity": -3.27061300519836
+"time": 1.3087377897772405,
+"velocity": -3.271527569521433
 },
 {
-"acceleration": -0.13788085224160057,
-"curvature": 0.02235999794630547,
+"acceleration": -0.1262578483113866,
+"curvature": 0.021717723367296063,
 "pose": {
 "rotation": {
-"radians": 3.049979462508236
+"radians": 3.021996456503354
 },
 "translation": {
-"x": 3.4954539549350745,
-"y": 1.3056014442443846
+"x": 3.354395940899849,
+"y": 1.4399424099922182
 }
 },
-"time": 1.3145583280129194,
-"velocity": -3.2743747455945744
+"time": 1.3354034556434422,
+"velocity": -3.275105259491456
 },
 {
-"acceleration": -0.13076179261547022,
-"curvature": 0.019219688983420413,
+"acceleration": -0.11952467750473268,
+"curvature": 0.018737030781709633,
 "pose": {
 "rotation": {
-"radians": 3.04821486518244
+"radians": 3.0202158082140413
 },
 "translation": {
-"x": 3.580031920043985,
-"y": 1.297754081524909
+"x": 3.4418545273161723,
+"y": 1.4293515984085383
 }
 },
-"time": 1.3404853822751095,
-"velocity": -3.2779495899323594
+"time": 1.3622886587849197,
+"velocity": -3.2784997273915133
 },
 {
-"acceleration": -0.12478133915880141,
-"curvature": 0.016226629993117206,
+"acceleration": -0.11385852260089453,
+"curvature": 0.015900298426211497,
 "pose": {
 "rotation": {
-"radians": 3.046698197966126
+"radians": 3.018678455711613
 },
 "translation": {
-"x": 3.6652919755503532,
-"y": 1.2897024011611942
+"x": 3.5300272687338294,
+"y": 1.4185259314626455
 }
 },
-"time": 1.3665976870242749,
-"velocity": -3.2813640817106817
+"time": 1.389371472593838,
+"velocity": -3.281736791977945
 },
 {
-"acceleration": -0.1198454519928667,
-"curvature": 0.013358393386991714,
+"acceleration": -0.10916799857810994,
+"curvature": 0.01318581610496624,
 "pose": {
 "rotation": {
-"radians": 3.0454230868136727
+"radians": 3.017377888652881
 },
 "translation": {
-"x": 3.751163210448576,
-"y": 1.28147211547941
+"x": 3.618840493200696,
+"y": 1.4074937509535808
 }
 },
-"time": 1.3928738539139311,
-"velocity": -3.284642857003133
+"time": 1.4166294476593162,
+"velocity": -3.2848403447479924
 },
 {
-"acceleration": -0.11587768578048814,
-"curvature": 0.010594153971227205,
+"acceleration": -0.10537865172684102,
+"curvature": 0.010573476441136077,
 "pose": {
 "rotation": {
-"radians": 3.0443841518792283
+"radians": 3.0163085929317943
 },
 "translation": {
-"x": 3.8375736618042,
-"y": 1.2730892944335936
+"x": 3.708219432830811,
+"y": 1.3962837982177732
 }
 },
-"time": 1.419292036135301,
-"velocity": -3.287808955992283
+"time": 1.4440396582605572,
+"velocity": -3.2878326625799343
 },
 {
-"acceleration": -0.11281756208488992,
-"curvature": 0.007914407638827146,
+"acceleration": -0.10243130498865108,
+"curvature": 0.008044495616728323,
 "pose": {
 "rotation": {
-"radians": 3.0435769670910813
+"radians": 3.0154660079322553
 },
 "translation": {
-"x": 3.924450426652329,
-"y": 1.264580325372517
+"x": 3.798088340103277,
+"y": 1.3849251697049478
 }
 },
-"time": 1.4458299719497756,
-"velocity": -3.2908841105798556
+"time": 1.4715787478476348,
+"velocity": -3.2907346947104053
 },
 {
-"acceleration": -0.1106193064502237,
-"curvature": 0.005300714126733919,
+"acceleration": -0.10028076663026206,
+"curvature": 0.005581159083904738,
 "pose": {
 "rotation": {
-"radians": 3.0429980271904795
+"radians": 3.014846491510954
 },
 "translation": {
-"x": 4.011719773896038,
-"y": 1.2559718728065494
+"x": 3.8883706041611727,
+"y": 1.3734472725540403
 }
 },
-"time": 1.472465027319546,
-"velocity": -3.293889012592669
+"time": 1.499222973583167,
+"velocity": -3.2935663288278967
 },
 {
-"acceleration": -0.10925092320429457,
-"curvature": 0.0027354589458685854,
+"acceleration": -0.09889487163521568,
+"curvature": 0.0031665872167587336,
 "pose": {
 "rotation": {
-"radians": 3.0426447219321306
+"radians": 3.0144472923598644
 },
 "translation": {
-"x": 4.099307256204774,
-"y": 1.2472908381745214
+"x": 3.9789888671104565,
+"y": 1.3618797801691107
 }
 },
-"time": 1.499174237693857,
-"velocity": -3.2968435669201086
+"time": 1.5269482500081522,
+"velocity": -3.29634664080283
 },
 {
-"acceleration": 0.09107142381865388,
-"curvature": 0.00020162999839460325,
+"acceleration": 0.033025291088186755,
+"curvature": 0.0007845163248334967,
 "pose": {
 "rotation": {
-"radians": 3.042515317215455
+"radians": 3.014266529477623
 },
 "translation": {
-"x": 4.187137821912765,
-"y": 1.238564319610596
+"x": 4.06986514031887,
+"y": 1.3502525877952571
 }
 },
-"time": 1.5259343489998625,
-"velocity": -3.2997671337853394
+"time": 1.5547301918857779,
+"velocity": -3.299094132378595
 },
 {
-"acceleration": 0.10812592521841485,
-"curvature": -0.0023173952961977086,
+"acceleration": 0.09778086988551758,
+"curvature": -0.0015809092061345724,
 "pose": {
 "rotation": {
-"radians": 3.042608942987894
+"radians": 3.014303178557855
 },
 "translation": {
-"x": 4.275135926917429,
-"y": 1.2298195717111229
+"x": 4.160920920714853,
+"y": 1.3385957680945282
 }
 },
-"time": 1.5527435945044583,
-"velocity": -3.297325577625732
+"time": 1.5825595526163208,
+"velocity": -3.2981750596396706
 },
 {
-"acceleration": 0.10859935087062234,
-"curvature": -0.004838056331950738,
+"acceleration": 0.09812347091202799,
+"curvature": -0.0039453376382162265,
 "pose": {
 "rotation": {
-"radians": 3.042925587834513
+"radians": 3.014557065181236
 },
 "translation": {
-"x": 4.363225646577775,
-"y": 1.2210839653015135
+"x": 4.252077307086438,
+"y": 1.3269395267218353
 }
 },
-"time": 1.5796019680556874,
-"velocity": -3.2944214911356435
+"time": 1.6104345435243106,
+"velocity": -3.2954494187806365
 },
 {
-"acceleration": 0.10987587539913167,
-"curvature": -0.007376812949380152,
+"acceleration": 0.09920146780386405,
+"curvature": -0.0063244073169134475,
 "pose": {
 "rotation": {
-"radians": 3.043466100242311
+"radians": 3.015028864777332
 },
 "translation": {
-"x": 4.451330787612823,
-"y": 1.2123849472031
+"x": 4.343255116380169,
+"y": 1.3153141579008656
 }
 },
-"time": 1.606487658419741,
-"velocity": -3.2915017226143988
+"time": 1.6383379154217033,
+"velocity": -3.292711443079915
 },
 {
-"acceleration": 0.11197152059131824,
-"curvature": -0.00995035018634689,
+"acceleration": 0.10102876089560726,
+"curvature": -0.008733944615773254,
 "pose": {
 "rotation": {
-"radians": 3.044232196603755
+"radians": 3.0157201094030217
 },
 "translation": {
-"x": 4.539375,
-"y": 1.2037499999999994
+"x": 4.434375,
+"y": 1.30375
 }
 },
-"time": 1.6333770133200813,
-"velocity": -3.288547231205806
+"time": 1.66624482281816,
+"velocity": -3.28994303690432
 },
 {
-"acceleration": 0.11491541083617796,
-"curvature": -0.012575788026240976,
+"acceleration": 0.10363145672655853,
+"curvature": -0.011190166234097297,
 "pose": {
 "rotation": {
-"radians": 3.0452264761029477
+"radians": 3.016633201467472
 },
 "translation": {
-"x": 4.627281888873549,
-"y": 1.1952066018059853
+"x": 4.525357560106204,
+"y": 1.2922773911082182
 }
 },
-"time": 1.6602464727114392,
-"velocity": -3.285538616980289
+"time": 1.6941305085428395,
+"velocity": -3.2871257806288314
 },
 {
-"acceleration": 0.11875038074724499,
-"curvature": -0.015270900183127836,
+"acceleration": 0.10704843470247284,
+"curvature": -0.013709889838216922,
 "pose": {
 "rotation": {
-"radians": 3.0464524427104362
+"radians": 3.017771434620507
 },
 "translation": {
-"x": 4.714975126422941,
-"y": 1.1867821860313414
+"x": 4.616123465914279,
+"y": 1.2809266246110198
 }
 },
-"time": 1.687072610254266,
-"velocity": -3.282455880363407
+"time": 1.7219703467383352,
+"velocity": -3.2842406976416005
 },
 {
-"acceleration": 0.1235339145271546,
-"curvature": -0.018054346227106426,
+"acceleration": 0.11133223187691152,
+"curvature": -0.01631075728917315,
 "pose": {
 "rotation": {
-"radians": 3.047914534600123
+"radians": 3.019139022112879
 },
 "translation": {
-"x": 4.80237856379128,
-"y": 1.1785041011497377
+"x": 4.706593569993856,
+"y": 1.2697279047663326
 }
 },
-"time": 1.7138321756915595,
-"velocity": -3.2792781717790978
+"time": 1.7497398867560738,
+"velocity": -3.281268011850294
 },
 {
-"acceleration": 0.1293394416341096,
-"curvature": -0.02094592172965768,
+"acceleration": 0.11655027061849714,
+"curvature": -0.019011475067699974,
 "pose": {
 "rotation": {
-"radians": 3.0496181613952063
+"radians": 3.0207411330350014
 },
 "translation": {
-"x": 4.889416342973708,
-"y": 1.1703995704650874
+"x": 4.796689024567604,
+"y": 1.2587113022804255
 }
 },
-"time": 1.7405021381995636,
-"velocity": -3.2759835269101916
+"time": 1.7774148980246072,
+"velocity": -3.2781868910785494
 },
 {
-"acceleration": 0.1362580238594326,
-"curvature": -0.02396683161118373,
+"acceleration": 0.1227864646884987,
+"curvature": -0.021832077004552138,
 "pose": {
 "rotation": {
-"radians": 3.0515697497509278
+"radians": 3.022583936946506
 },
 "translation": {
-"x": 4.9760130087158165,
-"y": 1.162495651878416
+"x": 4.886331397810136,
+"y": 1.2479067098838277
 }
 },
-"time": 1.7670597307965712,
-"velocity": -3.2725485827125484
+"time": 1.8049714159753576,
+"velocity": -3.274975171454086
 },
 {
-"acceleration": 0.14440048020009313,
-"curvature": -0.027139992518055368,
+"acceleration": 0.13014325092710152,
+"curvature": -0.02479421506814541,
 "pose": {
 "rotation": {
-"radians": 3.053776797891519
+"radians": 3.02467465752441
 },
 "translation": {
-"x": 5.0620936204120515,
-"y": 1.1548191976547235
+"x": 4.975442790146917,
+"y": 1.2373437979072328
 }
 },
-"time": 1.793482495908155,
-"velocity": -3.268948268953542
+"time": 1.8323857891252013,
+"velocity": -3.2716090574933654
 },
 {
-"acceleration": 0.15390000814243832,
-"curvature": -0.030490370865442477,
+"acceleration": 0.13874410664444134,
+"curvature": -0.027921484774725648,
 "pose": {
 "rotation": {
-"radians": 3.0562479398387676
+"radians": 3.027021635984427
 },
 "translation": {
-"x": 5.147583864004117,
-"y": 1.1473968141898512
+"x": 5.06394595055317,
+"y": 1.2270519698574205
 }
 },
-"time": 1.8197483322029604,
-"velocity": -3.265155469579715
+"time": 1.859634727431646,
+"velocity": -3.2680627920778527
 },
 {
-"acceleration": 0.16491537332224138,
-"curvature": -0.034045364181108054,
+"acceleration": 0.14873662719773198,
+"curvature": -0.031239792797121885,
 "pose": {
 "rotation": {
-"radians": 3.058993020201579
+"radians": 3.0296344051701705
 },
 "translation": {
-"x": 5.232410163879393,
-"y": 1.1402548217773436
+"x": 5.151764392852782,
+"y": 1.2170603179931643
 }
 },
-"time": 1.8458355428305937,
-"velocity": -3.261140647651709
+"time": 1.8866953520547762,
+"velocity": -3.264308289889276
 },
 {
-"acceleration": 0.17763475406416931,
-"curvature": -0.03783523460593343,
+"acceleration": 0.16029625433114697,
+"curvature": -0.03477777559141123,
 "pose": {
 "rotation": {
-"radians": 3.0620231805416944
+"radians": 3.0325237753607786
 },
 "translation": {
-"x": 5.316499794769333,
-"y": 1.1334192143753175
+"x": 5.238822512017213,
+"y": 1.207397578901146
 }
 },
-"time": 1.871722885212883,
-"velocity": -3.256871426918413
+"time": 1.9135452466808944,
+"velocity": -3.2603147271219726
 },
 {
-"acceleration": 0.19228034294503987,
-"curvature": -0.04189360488722028,
+"acceleration": 0.17363076376594444,
+"curvature": -0.03856727937895256,
 "pose": {
 "rotation": {
-"radians": 3.0653509584918806
+"radians": 3.035701933021188
 },
 "translation": {
-"x": 5.399780993647871,
-"y": 1.126915619373321
+"x": 5.325045700464398,
+"y": 1.1980920890718698
 }
 },
-"time": 1.897389622561607,
-"velocity": -3.2523121223418427
+"time": 1.940162510586053,
+"velocity": -3.256048079417432
 },
 {
-"acceleration": 0.2091138239334505,
-"curvature": -0.046258028985777244,
+"acceleration": 0.1889856401995709,
+"curvature": -0.042643913665463065,
 "pose": {
 "rotation": {
-"radians": 3.0689904009813667
+"radians": 3.0391825539133492
 },
 "translation": {
-"x": 5.4821830716298425,
-"y": 1.120769257359207
+"x": 5.410360464357654,
+"y": 1.189171740475576
 }
 },
-"time": 1.922815577320483,
-"velocity": -3.247423211041101
+"time": 1.966525813644073,
+"velocity": -3.251470598972075
 },
 {
-"acceleration": 0.22844286011381493,
-"curvature": -0.050970651559799005,
+"acceleration": 0.20665048893819363,
+"curvature": -0.047047692710147,
 "pose": {
 "rotation": {
-"radians": 3.072957193120397
+"radians": 3.042980932203494
 },
 "translation": {
-"x": 5.563636525869368,
-"y": 1.1150049018859862
+"x": 5.494694539904594,
+"y": 1.1806639361381528
 }
 },
-"time": 1.9479811867565102,
-"velocity": -3.2421607342203176
+"time": 1.9926144535132324,
+"velocity": -3.246540220664466
 },
 {
-"acceleration": 0.25062874218461445,
-"curvature": -0.05607897314748896,
+"acceleration": 0.2269666550165035,
+"curvature": -0.05182378204829128,
 "pose": {
 "rotation": {
-"radians": 3.0772688045128542
+"radians": 3.047114127442524
 },
 "translation": {
-"x": 5.6440731514582865,
-"y": 1.109646839238703
+"x": 5.577977009656023,
+"y": 1.1725955457170496
 }
 },
-"time": 1.9728675609564432,
-"velocity": -3.2364756197202222
+"time": 2.018408415269295,
+"velocity": -3.2412098858559224
 },
 {
-"acceleration": 0.27609535959849446,
-"curvature": -0.06163674091302479,
+"acceleration": 0.25033624125243986,
+"curvature": -0.057023370403681044,
 "pose": {
 "rotation": {
-"radians": 3.08194465500345
+"radians": 3.051601131565702
 },
 "translation": {
-"x": 5.723426153324544,
-"y": 1.1047188282012934
+"x": 5.660138418804855,
+"y": 1.1649928610771898
 }
 },
-"time": 1.9974565435180014,
-"velocity": -3.2303129139492195
+"time": 2.0438884337900407,
+"velocity": -3.23542677128251
 },
 {
-"acceleration": 0.3053396607978645,
-"curvature": -0.06770498841866313,
+"acceleration": 0.2772327334658639,
+"curvature": -0.06270469119751292,
 "pose": {
 "rotation": {
-"radians": 3.0870063021235787
+"radians": 3.0564630583554444
 },
 "translation": {
-"x": 5.801630258130606,
-"y": 1.1002440598234537
+"x": 5.741110891485005,
+"y": 1.1578815518668844
 }
 },
-"time": 2.0217307752627844,
-"velocity": -3.2236109112066664
+"time": 2.06903605923839,
+"velocity": -3.2291314092513463
 },
 {
-"acceleration": 0.33894376090022615,
-"curvature": -0.0743532521124688,
+"acceleration": 0.3082134494979496,
+"curvature": -0.06893422247282165,
 "pose": {
 "rotation": {
-"radians": 3.092477652775438
+"radians": 3.0617233581374372
 },
 "translation": {
-"x": 5.878621826171875,
-"y": 1.0962451171875003
+"x": 5.820828247070312,
+"y": 1.1512866210937496
 }
 },
-"time": 2.045673761338537,
-"velocity": -3.216300167959808
+"time": 2.0938337260378668,
+"velocity": -3.2222566843009517
 },
 {
-"acceleration": 0.3775888259136141,
-"curvature": -0.08166099714309749,
+"acceleration": 0.3439340214422979,
+"curvature": -0.07578809951805088,
 "pose": {
 "rotation": {
-"radians": 3.098385201982878
+"radians": 3.0674080608338294
 },
 "translation": {
-"x": 5.954338963275076,
-"y": 1.09274393517524
+"x": 5.899226116473437,
+"y": 1.1452323607006107
 }
 },
-"time": 2.069269942122177,
-"velocity": -3.2083023897021197
+"time": 2.1182648257854084,
+"velocity": -3.2147266907727334
 },
 {
-"acceleration": 0.42207079948801735,
-"curvature": -0.08971929077816167,
+"acceleration": 0.3851650864475087,
+"curvature": -0.08335378089770248,
 "pose": {
 "rotation": {
-"radians": 3.104758301831301
+"radians": 3.073546050873371
 },
 "translation": {
-"x": 6.028721632696687,
-"y": 1.0897617602348326
+"x": 5.976242058444767,
+"y": 1.1397423071414234
 }
 },
-"time": 2.0925047683811657,
-"velocity": -3.1995291789346814
+"time": 2.142313784602275,
+"velocity": -3.2064554356553483
 },
 {
-"acceleration": 0.47331792291801594,
-"curvature": -0.09863276811881469,
+"acceleration": 0.4328112836532524,
+"curvature": -0.0917320160709595,
 "pose": {
 "rotation": {
-"radians": 3.1116294640038342
+"radians": 3.0801693778477808
 },
 "translation": {
-"x": 6.1017117670213334,
-"y": 1.0873191101476545
+"x": 6.051815675871331,
+"y": 1.1348391969571825
 }
 },
-"time": 2.1153647811979677,
-"velocity": -3.1898806350487874
+"time": 2.165966145483287,
+"velocity": -3.1973453720319256
 },
 {
-"acceleration": 0.5324098053190985,
-"curvature": -0.10852194190391,
+"acceleration": 0.48793250829079843,
+"curvature": -0.10103917134451215,
 "pose": {
 "rotation": {
-"radians": 3.1190346995750957
+"radians": 3.0873136071903864
 },
 "translation": {
-"x": 6.173253380060194,
-"y": 1.0854357337951654
+"x": 6.12588873207569,
+"y": 1.1305449223518371
 }
 },
-"time": 2.1378376972085595,
-"velocity": -3.179243801120743
+"time": 2.1892086562663633,
+"velocity": -3.187285751104578
 },
 {
-"acceleration": 2.4983858291409087,
-"curvature": -0.11952591578752127,
+"acceleration": 1.4262374018107784,
+"curvature": -0.1114099805169207,
 "pose": {
 "rotation": {
-"radians": 3.127013899913406
+"radians": 3.095018215510723
 },
 "translation": {
-"x": 6.243292678749421,
-"y": 1.0841305709257716
+"x": 6.198405267114867,
+"y": 1.1268804867682043
 }
 },
-"time": 2.159912499747578,
-"velocity": -3.167490959798487
+"time": 2.2120293639057746,
+"velocity": -3.176150785985109
 },
 {
-"acceleration": 3.1,
-"curvature": -0.13180556814569977,
+"acceleration": 3.0999999999999948,
+"curvature": -0.12300079701900807,
 "pose": {
 "rotation": {
-"radians": 3.1356112626170676
+"radians": 3.103327035505994
 },
 "translation": {
-"x": 6.311778175048529,
-"y": 1.0834217119216918
+"x": 6.2693117140792305,
+"y": 1.1238659604638803
 }
 },
-"time": 2.1817226276316726,
-"velocity": -3.1130008453611135
+"time": 2.234487419081624,
+"velocity": -3.144120267721382
 },
 {
-"acceleration": 3.1000000000000054,
-"curvature": -0.14554728047086768,
+"acceleration": 3.1000000000000094,
+"curvature": -0.1359934351484935,
 "pose": {
 "rotation": {
-"radians": -3.1383095408833386
+"radians": 3.1122887555236196
 },
 "translation": {
-"x": 6.378660797838819,
-"y": 1.08332635756582
+"x": 6.338557015391415,
+"y": 1.121520436087157
 }
 },
-"time": 2.203442475915329,
-"velocity": -3.0456693156817796
+"time": 2.2567685353186056,
+"velocity": -3.07504880738674
 },
 {
-"acceleration": 3.1000000000000036,
-"curvature": -0.16096728945337557,
+"acceleration": 3.0999999999999988,
+"curvature": -0.1505996981857391,
 "pose": {
 "rotation": {
-"radians": -3.1283236095778824
+"radians": 3.1219574787737425
 },
 "translation": {
-"x": 6.443894004821777,
-"y": 1.0838607788085923
+"x": 6.406092739105225,
+"y": 1.1198619842529292
 }
 },
-"time": 2.2251002566517926,
-"velocity": -2.9785301953987413
+"time": 2.2789864656365935,
+"velocity": -3.0061732234009777
 },
 {
-"acceleration": 3.0999999999999948,
-"curvature": -0.19788753231297815,
+"acceleration": 3.1000000000000014,
+"curvature": -0.16706669906438038,
 "pose": {
 "rotation": {
-"radians": -3.1059402305861217
+"radians": 3.1323933467461167
 },
 "translation": {
-"x": 6.569239317663012,
-"y": 1.0868791413307184
+"x": 6.471873195204533,
+"y": 1.1189076091186143
 }
 },
-"time": 2.268160289198184,
-"velocity": -2.845044094504928
+"time": 2.301123225590175,
+"velocity": -2.9375492675448744
+},
+{
+"acceleration": 3.1000000000000023,
+"curvature": -0.1856830819832526,
+"pose": {
+"rotation": {
+"radians": -3.1395220768114442
+},
+"translation": {
+"x": 6.535855551902205,
+"y": 1.1186732039600598
+}
+},
+"time": 2.3231604829381345,
+"velocity": -2.8692337697662
+},
+{
+"acceleration": 3.1000000000000014,
+"curvature": -0.23077064864894042,
+"pose": {
+"rotation": {
+"radians": -3.114174500545864
+},
+"translation": {
+"x": 6.658269628882407,
+"y": 1.1204220557212832
+}
+},
+"time": 2.3668608752429057,
+"velocity": -2.7337625536214096
 },
 {
 "acceleration": 3.100000000000003,
-"curvature": -0.2451052398385904,
+"curvature": -0.2893037388772479,
 "pose": {
 "rotation": {
-"radians": -3.0798599654549537
+"radians": -3.0844850060526747
 },
 "translation": {
-"x": 6.687496603727338,
-"y": 1.0925868415832518
+"x": 6.773053899686782,
+"y": 1.1252117799967527
 }
 },
-"time": 2.3107635870077488,
-"velocity": -2.7129738712952776
+"time": 2.4099371422468603,
+"velocity": -2.600226125909151
 },
 {
-"acceleration": 3.0999999999999974,
-"curvature": -0.3060442141996308,
+"acceleration": 3.0999999999999948,
+"curvature": -0.3659598882934683,
 "pose": {
 "rotation": {
-"radians": -3.0493912166074484
+"radians": -3.0495910306342893
 },
 "translation": {
-"x": 6.798395975790919,
-"y": 1.1010764694213853
+"x": 6.879980468750001,
+"y": 1.1331250000000015
 }
 },
-"time": 2.3527686769150598,
-"velocity": -2.5827580925826137
+"time": 2.4522382831266576,
+"velocity": -2.4690925891817788
 },
 {
-"acceleration": 3.1000000000000045,
-"curvature": -0.38528349114008476,
+"acceleration": 3.1,
+"curvature": -0.4670026590461745,
 "pose": {
 "rotation": {
-"radians": -3.013689968612969
+"radians": -3.00843813520101
 },
 "translation": {
-"x": 6.901718749999999,
-"y": 1.112421874999999
+"x": 6.978878336865452,
+"y": 1.1442223001271463
 }
 },
-"time": 2.394035970061535,
-"velocity": -2.4548294838285414
+"time": 2.4936189467276564,
+"velocity": -2.340812532018683
 },
 {
-"acceleration": 3.100000000000001,
-"curvature": -0.48882609768066615,
+"acceleration": 3.099999999999994,
+"curvature": -0.6005497073158732,
 "pose": {
 "rotation": {
-"radians": -2.971736847047559
+"radians": -2.959757931045576
 },
 "translation": {
-"x": 6.997301026619967,
-"y": 1.1266768813133226
+"x": 7.069637122750282,
+"y": 1.1585408043861367
 }
 },
-"time": 2.434433460305116,
-"velocity": -2.3295972640734397
+"time": 2.533947790648377,
+"velocity": -2.2157931158644493
 },
 {
-"acceleration": 3.099999999999997,
-"curvature": -0.624228417837864,
+"acceleration": 3.099999999999993,
+"curvature": -0.7764439247642648,
 "pose": {
 "rotation": {
-"radians": -2.922324752263944
+"radians": -2.902070564382231
 },
 "translation": {
-"x": 7.085037270784378,
-"y": 1.1438739967346176
+"x": 7.15221078461036,
+"y": 1.1760927548259499
 }
 },
-"time": 2.4738451400957486,
-"velocity": -2.207421056722479
+"time": 2.573119708354357,
+"velocity": -2.094360170975911
 },
 {
-"acceleration": 3.099999999999995,
-"curvature": -0.8002599914456736,
+"acceleration": 3.1000000000000023,
+"curvature": -1.0050279823097374,
 "pose": {
 "rotation": {
-"radians": -2.8640748678358507
+"radians": -2.8337453232580536
 },
 "translation": {
-"x": 7.164883893243966,
-"y": 1.164023127555847
+"x": 7.226621341705321,
+"y": 1.1968640899658194
 }
 },
-"time": 2.512183029892423,
-"velocity": -2.088573598352789
+"time": 2.611073063623708,
+"velocity": -1.9767047696409243
 },
 {
-"acceleration": 3.1000000000000005,
-"curvature": -1.0254259117142377,
+"acceleration": 3.1000000000000054,
+"curvature": -1.2935564272331594,
 "pose": {
 "rotation": {
-"radians": -2.7955134970439155
+"radians": -2.7531765932403487
 },
 "translation": {
-"x": 7.236862831115728,
-"y": 1.1871102905273432
+"x": 7.29296259591356,
+"y": 1.220813023224471
 }
 },
-"time": 2.549403766021589,
-"velocity": -1.9731893163523742
+"time": 2.6478129282687157,
+"velocity": -1.8628111892414003
 },
 {
-"acceleration": 3.1000000000000014,
-"curvature": -1.304267303868695,
+"acceleration": 3.1000000000000028,
+"curvature": -1.45996543999987,
 "pose": {
 "rotation": {
-"radians": -2.7152611033746448
+"radians": -2.707891816327158
 },
 "translation": {
-"x": 7.301065128631892,
-"y": 1.2130963253974905
+"x": 7.323157091435859,
+"y": 1.2339580999198354
 }
 },
-"time": 2.58553048391272,
-"velocity": -1.8611964908898688
+"time": 2.6657594475565203,
+"velocity": -1.807176979449206
 },
 {
-"acceleration": 3.0999999999999956,
-"curvature": -1.4624955225339453,
+"acceleration": 3.100000000000009,
+"curvature": -1.6386703885389147,
 "pose": {
 "rotation": {
-"radians": -2.670430659019588
+"radians": -2.6591536210760554
 },
 "translation": {
-"x": 7.330298266255996,
-"y": 1.2271569810435157
+"x": 7.351403853297231,
+"y": 1.2478686213493315
 }
 },
-"time": 2.6032201105229626,
-"velocity": -1.8063586483981169
+"time": 2.683450766921324,
+"velocity": -1.7523338894183145
 },
 {
-"acceleration": 3.1,
-"curvature": -1.6303486679196115,
+"acceleration": 3.1000000000000063,
+"curvature": -1.8256729360070982,
 "pose": {
 "rotation": {
-"radians": -2.6223966283012436
+"radians": -2.606975273284697
 },
 "translation": {
-"x": 7.357654517889026,
-"y": 1.241915607452393
+"x": 7.377736452853422,
+"y": 1.2625309334625463
 }
 },
-"time": 2.620689789187114,
-"velocity": -1.7522026445392478
+"time": 2.700920345270058,
+"velocity": -1.6981781965372391
 },
 {
-"acceleration": 3.0999999999999983,
-"curvature": -1.8036949730309115,
+"acceleration": 3.1000000000000094,
+"curvature": -2.014847742036237,
 "pose": {
 "rotation": {
-"radians": -2.5712101120548296
+"radians": -2.55148552812997
 },
 "translation": {
-"x": 7.383166294988479,
-"y": 1.2573596552386874
+"x": 7.4021936456672845,
+"y": 1.2779293828457554
 }
 },
-"time": 2.637973946990161,
-"velocity": -1.698621755349802
+"time": 2.7182120723041603,
+"velocity": -1.6445738427315222
 },
 {
-"acceleration": 3.0999999999999885,
-"curvature": -1.9765783389658242,
+"acceleration": 3.0999999999999934,
+"curvature": -2.19785427848422,
 "pose": {
 "rotation": {
-"radians": -2.517031410330085
+"radians": -2.4929552036811096
 },
 "translation": {
-"x": 7.406870999597009,
-"y": 1.2734747600555405
+"x": 7.424819487807688,
+"y": 1.2940462722978534
 }
 },
-"time": 2.6551168124657867,
-"velocity": -1.6454788723753622
+"time": 2.735381318990563,
+"velocity": -1.5913491780036733
 },
 {
 "acceleration": 3.100000000000002,
-"curvature": -2.141243864426999,
+"curvature": -2.3644473431238238,
 "pose": {
 "rotation": {
-"radians": -2.460151062279025
+"radians": -2.431817616889912
 },
 "translation": {
-"x": 7.428811136240833,
-"y": 1.290244702361523
+"x": 7.445663452148437,
+"y": 1.3108618164062484
 }
 },
-"time": 2.6721733410136275,
-"velocity": -1.5926036338770557
+"time": 2.752495865812855,
+"velocity": -1.538294082854569
 },
 {
-"acceleration": 3.100000000000002,
-"curvature": -2.288508509350573,
+"acceleration": 3.1000000000000054,
+"curvature": -2.503301280389336,
 "pose": {
 "rotation": {
-"radians": -2.4010044344296526
+"radians": -2.3686770814910028
 },
 "translation": {
-"x": 7.449034423828129,
-"y": 1.307651367187498
+"x": 7.4647805446671525,
+"y": 1.3283540971227907
 }
 },
-"time": 2.6892100438917095,
-"velocity": -1.539789854955002
+"time": 2.769636685346866,
+"velocity": -1.4851575422991345
 },
 {
 "acceleration": 3.1000000000000036,
-"curvature": -2.408539520660982,
+"curvature": -2.603330239891513,
 "pose": {
 "rotation": {
-"radians": -2.340175294065437
+"radians": -2.3043001517398536
 },
 "translation": {
-"x": 7.467593907547416,
-"y": 1.325674703903493
+"x": 7.482231420744209,
+"y": 1.3464990193396797
 }
 },
-"time": 2.7063057173266367,
-"velocity": -1.486793267306727
+"time": 2.7868986075790723,
+"velocity": -1.4316455833792956
 },
 {
-"acceleration": 3.099999999999999,
-"curvature": -2.4919899957643055,
+"acceleration": 3.1000000000000054,
+"curvature": -2.6552899846163456,
 "pose": {
 "rotation": {
-"radians": -2.2783845783877164
+"radians": -2.239586769412119
 },
 "translation": {
-"x": 7.48454807076603,
-"y": 1.3442926859855628
+"x": 7.498082501461613,
+"y": 1.3652702664653749
 }
 },
-"time": 2.723552118945699,
-"velocity": -1.433329422287635
+"time": 2.804390982655465,
+"velocity": -1.377419220642478
 },
 {
-"acceleration": 3.1000000000000063,
-"curvature": -2.5312941585031523,
+"acceleration": 3.1000000000000028,
+"curvature": -2.653268218498106,
 "pose": {
 "rotation": {
-"radians": -2.21646283739216
+"radians": -2.175522773124447
 },
 "translation": {
-"x": 7.499960946928477,
-"y": 1.363481270782648
+"x": 7.512406089901918,
+"y": 1.3846392560005185
 }
 },
-"time": 2.741054718522355,
-"velocity": -1.3790713636000003
+"time": 2.822238580937307,
+"velocity": -1.3220916659687676
 },
 {
-"acceleration": 3.1000000000000045,
-"curvature": -2.521809294618355,
+"acceleration": 3.100000000000001,
+"curvature": -2.5956216095410385,
 "pose": {
 "rotation": {
-"radians": -2.15530829605989
+"radians": -2.1131201610386983
 },
 "translation": {
-"x": 7.5139022314548445,
-"y": 1.3832143592834463
+"x": 7.525280487447165,
+"y": 1.4045750951138274
 }
 },
-"time": 2.7589337636063456,
-"velocity": -1.3236463238396292
+"time": 2.840583139792973,
+"velocity": -1.2652235335162036
 },
 {
-"acceleration": 3.1000000000000045,
-"curvature": -2.4624807470523127,
+"acceleration": 3.1000000000000036,
+"curvature": -2.485061443956009,
 "pose": {
 "rotation": {
-"radians": -2.0958361511500954
+"radians": -2.0533551622435224
 },
 "translation": {
-"x": 7.526447393639247,
-"y": 1.4034637558832745
+"x": 7.536790110077706,
+"y": 1.425044536218044
 }
 },
-"time": 2.777326055903142,
-"velocity": -1.2666302177195599
+"time": 2.8595861979939827,
+"velocity": -1.2063140530930732
 },
 {
-"acceleration": 3.0999999999999983,
-"curvature": -2.3558315669634595,
+"acceleration": 3.1000000000000028,
+"curvature": -2.327875800241867,
 "pose": {
 "rotation": {
-"radians": -2.0389272164299754
+"radians": -1.9971149432977107
 },
 "translation": {
-"x": 7.537677788548168,
-"y": 1.4241991281509385
+"x": 7.547025604671215,
+"y": 1.4460119325458027
 }
 },
-"time": 2.7963880531528753,
-"velocity": -1.207538026245386
+"time": 2.8794342053142232,
+"velocity": -1.1447852304003279
 },
 {
-"acceleration": 3.1000000000000028,
-"curvature": -2.2072924800979115,
+"acceleration": 3.100000000000002,
+"curvature": -2.1325599861018967,
 "pose": {
 "rotation": {
-"radians": -1.9853843037265297
+"radians": -1.9451612970922298
 },
 "translation": {
-"x": 7.547680768918946,
-"y": 1.4453879665955878
+"x": 7.5560839653015135,
+"y": 1.467439193725582
 }
 },
-"time": 2.816301251562248,
-"velocity": -1.1458071111763302
+"time": 2.9003474930915307,
+"velocity": -1.0799540382906745
 },
 {
-"acceleration": 3.1000000000000023,
-"curvature": -2.024088424991855,
+"acceleration": 3.099999999999994,
+"curvature": -1.9082698641270197,
 "pose": {
 "rotation": {
-"radians": -1.9359026577907883
+"radians": -1.898115073192671
 },
 "translation": {
-"x": 7.556549797058105,
-"y": 1.4669955444335923
+"x": 7.564068649537506,
+"y": 1.4892857413575946
 }
 },
-"time": 2.837281403970424,
-"velocity": -1.080768638710985
+"time": 2.9225958638634304,
+"velocity": -1.0109840888977861
 },
 {
-"acceleration": 3.1,
-"curvature": -1.5842408077804602,
+"acceleration": 3.099999999999999,
+"curvature": -1.6634730798220347,
 "pose": {
 "rotation": {
-"radians": -1.8513060486833621
+"radians": -1.8564603263857018
 },
 "translation": {
-"x": 7.571291065104306,
-"y": 1.511316683292387
+"x": 7.571089694742116,
+"y": 1.5115084645897117
 }
 },
-"time": 2.8835722966275656,
-"velocity": -0.937266871473846
+"time": 2.946526089267553,
+"velocity": -0.9368003901450069
 },
 {
 "acceleration": 3.1,
-"curvature": -1.0876476121122782,
+"curvature": -1.1376333932097509,
 "pose": {
 "rotation": {
-"radians": -1.7884374463461612
+"radians": -1.7907038567922569
 },
 "translation": {
-"x": 7.582775734663004,
-"y": 1.5568388557434076
+"x": 7.582714614272116,
+"y": 1.5568970656394967
 }
 },
-"time": 2.9386865904258084,
-"velocity": -0.7664125606992929
+"time": 3.001550064722659,
+"velocity": -0.766226066234178
 },
 {
 "acceleration": 3.1,
-"curvature": -1.2628379048231224e-14,
+"curvature": 2.020540647717047e-15,
 "pose": {
 "rotation": {
-"radians": -1.7359450042095144
+"radians": -1.7359450042095252
 },
 "translation": {
-"x": 7.599999999999996,
-"y": 1.6499999999999986
+"x": 7.599999999999997,
+"y": 1.649999999999995
 }
 },
-"time": 3.185916448715903,
+"time": 3.2487197635078777,
 "velocity": -0.0
 }
 ]
\ No newline at end of file