From f1647ee393ff4b865c5a929f850ff5158ea91a48 Mon Sep 17 00:00:00 2001
From: superpenguin612 <74030080+superpenguin612@users.noreply.github.com>
Date: Sun, 21 Apr 2024 17:23:56 -0400
Subject: [PATCH] Updates to 543 traj

---
 src/main/deploy/choreo/543.1.traj |  406 ++--
 src/main/deploy/choreo/543.2.traj |  436 ++--
 src/main/deploy/choreo/543.3.traj |  642 ++---
 src/main/deploy/choreo/543.4.traj |  626 ++---
 src/main/deploy/choreo/543.5.traj |  714 +++---
 src/main/deploy/choreo/543.6.traj |  707 +++---
 src/main/deploy/choreo/543.traj   | 3605 ++++++++++++++--------------
 trajectories.chor                 | 3641 ++++++++++++++---------------
 8 files changed, 5375 insertions(+), 5402 deletions(-)

diff --git a/src/main/deploy/choreo/543.1.traj b/src/main/deploy/choreo/543.1.traj
index 5e1064f..3365129 100644
--- a/src/main/deploy/choreo/543.1.traj
+++ b/src/main/deploy/choreo/543.1.traj
@@ -4,288 +4,288 @@
       "x": 1.3906110525131226,
       "y": 3.773930549621582,
       "heading": 2.146011906845138,
-      "angularVelocity": -4.607415814404034e-24,
-      "velocityX": -1.7254345385809295e-24,
-      "velocityY": -1.05174879071868e-23,
+      "angularVelocity": 5.794330982484493e-26,
+      "velocityX": -7.992490165005739e-26,
+      "velocityY": -3.398096319318013e-26,
       "timestamp": 0
     },
     {
-      "x": 1.4188356238691378,
-      "y": 3.760942213943607,
-      "heading": 2.153530791915604,
-      "angularVelocity": 0.08908449280361179,
-      "velocityX": 0.33440750859809526,
-      "velocityY": -0.15388708370877877,
-      "timestamp": 0.08440172732465938
+      "x": 1.4188356238691382,
+      "y": 3.7609422139436073,
+      "heading": 2.1535307919155904,
+      "angularVelocity": 0.08908449280344664,
+      "velocityX": 0.3344075085981018,
+      "velocityY": -0.15388708370877402,
+      "timestamp": 0.08440172732465939
     },
     {
-      "x": 1.475288932367314,
-      "y": 3.734962941794519,
-      "heading": 2.168364325366795,
-      "angularVelocity": 0.17574916913882777,
-      "velocityX": 0.6688643738418175,
-      "velocityY": -0.30780498187147287,
-      "timestamp": 0.16880345464931876
+      "x": 1.4752889323673153,
+      "y": 3.73496294179452,
+      "heading": 2.1683643253667535,
+      "angularVelocity": 0.1757491691385009,
+      "velocityX": 0.6688643738418307,
+      "velocityY": -0.30780498187146277,
+      "timestamp": 0.16880345464931878
     },
     {
-      "x": 1.5599758288607513,
-      "y": 3.695989670782734,
-      "heading": 2.1902666180765573,
-      "angularVelocity": 0.2595005268732581,
-      "velocityX": 1.0033787124720934,
-      "velocityY": -0.4617591635520705,
-      "timestamp": 0.2532051819739781
+      "x": 1.5599758288607544,
+      "y": 3.695989670782737,
+      "heading": 2.1902666180764747,
+      "angularVelocity": 0.2595005268727734,
+      "velocityX": 1.0033787124721134,
+      "velocityY": -0.4617591635520542,
+      "timestamp": 0.2532051819739782
     },
     {
-      "x": 1.6729020410079392,
-      "y": 3.6440187494301686,
-      "heading": 2.218934937634643,
-      "angularVelocity": 0.3396650811162915,
-      "velocityX": 1.3379609129657555,
-      "velocityY": -0.6157566083055958,
-      "timestamp": 0.3376069092986375
+      "x": 1.6729020410079447,
+      "y": 3.644018749430173,
+      "heading": 2.2189349376345064,
+      "angularVelocity": 0.339665081115654,
+      "velocityX": 1.3379609129657823,
+      "velocityY": -0.6157566083055724,
+      "timestamp": 0.33760690929863757
     },
     {
-      "x": 1.8140744209466089,
-      "y": 3.5790457513290828,
-      "heading": 2.2539866117999128,
-      "angularVelocity": 0.41529569685748813,
-      "velocityX": 1.6726242982639008,
-      "velocityY": -0.7698064975751115,
-      "timestamp": 0.4220086366232969
+      "x": 1.814074420946617,
+      "y": 3.5790457513290903,
+      "heading": 2.2539866117997107,
+      "angularVelocity": 0.4152956968567039,
+      "velocityX": 1.6726242982639348,
+      "velocityY": -0.7698064975750799,
+      "timestamp": 0.42200863662329696
     },
     {
-      "x": 1.9835012543622998,
-      "y": 3.5010652014864134,
-      "heading": 2.294922249726516,
-      "angularVelocity": 0.48500948054226534,
-      "velocityX": 2.0073858531825324,
-      "velocityY": -0.9239212551031034,
-      "timestamp": 0.5064103639479562
+      "x": 1.9835012543623114,
+      "y": 3.5010652014864245,
+      "heading": 2.294922249726236,
+      "angularVelocity": 0.4850094805413429,
+      "velocityX": 2.0073858531825732,
+      "velocityY": -0.923921255103062,
+      "timestamp": 0.5064103639479564
     },
     {
-      "x": 2.1811926014666385,
-      "y": 3.410070177872789,
-      "heading": 2.3410635990000292,
-      "angularVelocity": 0.5466872626436459,
-      "velocityX": 2.342266602481963,
-      "velocityY": -1.078118025518638,
-      "timestamp": 0.5908120912726156
+      "x": 2.181192601466654,
+      "y": 3.4100701778728046,
+      "heading": 2.34106359899966,
+      "angularVelocity": 0.5466872626425968,
+      "velocityX": 2.342266602482012,
+      "velocityY": -1.0781180255185847,
+      "timestamp": 0.5908120912726158
     },
     {
-      "x": 2.4071604854884874,
-      "y": 3.306051768554538,
-      "heading": 2.391439626548247,
-      "angularVelocity": 0.5968601490161605,
-      "velocityX": 2.677289804184235,
-      "velocityY": -1.2324203854043734,
-      "timestamp": 0.6752138185972749
+      "x": 2.407160485488508,
+      "y": 3.3060517685545587,
+      "heading": 2.39143962654778,
+      "angularVelocity": 0.5968601490150018,
+      "velocityX": 2.6772898041842925,
+      "velocityY": -1.2324203854043054,
+      "timestamp": 0.6752138185972751
     },
     {
-      "x": 2.6614180186191594,
-      "y": 3.188998550481633,
-      "heading": 2.4445515358009664,
-      "angularVelocity": 0.6292751456189901,
-      "velocityX": 3.0124683604240237,
-      "velocityY": -1.3868580867148388,
-      "timestamp": 0.7596155459219343
+      "x": 2.6614180186191856,
+      "y": 3.1889985504816614,
+      "heading": 2.444551535800395,
+      "angularVelocity": 0.6292751456177489,
+      "velocityX": 3.0124683604240907,
+      "velocityY": -1.3868580867147517,
+      "timestamp": 0.7596155459219345
     },
     {
-      "x": 2.9439724015872475,
-      "y": 3.0588976398796266,
-      "heading": 2.497791194825149,
-      "angularVelocity": 0.6307887375265607,
-      "velocityX": 3.3477322316072415,
-      "velocityY": -1.5414484362572416,
-      "timestamp": 0.8440172732465936
+      "x": 2.94397240158728,
+      "y": 3.058897639879665,
+      "heading": 2.4977911948244698,
+      "angularVelocity": 0.6307887375252847,
+      "velocityX": 3.3477322316073206,
+      "velocityY": -1.5414484362571284,
+      "timestamp": 0.8440172732465938
     },
     {
-      "x": 3.2547705207438518,
-      "y": 2.9157523875003513,
-      "heading": 2.5454529495785527,
-      "angularVelocity": 0.5647011769091861,
-      "velocityX": 3.6823668070333375,
-      "velocityY": -1.695999085761044,
-      "timestamp": 0.9284190005712529
+      "x": 3.254770520743893,
+      "y": 2.9157523875004028,
+      "heading": 2.5454529495777716,
+      "angularVelocity": 0.5647011769079837,
+      "velocityX": 3.6823668070334374,
+      "velocityY": -1.6959990857608904,
+      "timestamp": 0.9284190005712532
     },
     {
-      "x": 3.5925128012400935,
-      "y": 2.7599542956015277,
-      "heading": 2.5628561343461667,
-      "angularVelocity": 0.20619465168847934,
-      "velocityX": 4.001603891317103,
-      "velocityY": -1.8459111778545862,
-      "timestamp": 1.0128207278959123
+      "x": 3.592512801240152,
+      "y": 2.759954295601597,
+      "heading": 2.5628561343453486,
+      "angularVelocity": 0.2061946516880405,
+      "velocityX": 4.001603891317303,
+      "velocityY": -1.8459111778543746,
+      "timestamp": 1.0128207278959125
     },
     {
-      "x": 3.9351974184342486,
-      "y": 2.6023709673223303,
-      "heading": 2.562856153970607,
-      "angularVelocity": 2.3251230459987665e-7,
-      "velocityX": 4.060161184568953,
-      "velocityY": -1.867062834781069,
-      "timestamp": 1.0972224552205716
+      "x": 3.9351974184343876,
+      "y": 2.602370967322575,
+      "heading": 2.562856153969789,
+      "angularVelocity": 2.3251230463668793e-7,
+      "velocityX": 4.060161184569908,
+      "velocityY": -1.867062834778992,
+      "timestamp": 1.0972224552205718
     },
     {
-      "x": 4.277882042528265,
-      "y": 2.444787654047679,
-      "heading": 2.562856173594968,
-      "angularVelocity": 2.325113720761536e-7,
-      "velocityX": 4.060161266319199,
-      "velocityY": -1.8670626570057298,
-      "timestamp": 1.181624182545231
+      "x": 4.2778820425282325,
+      "y": 2.4447876540475497,
+      "heading": 2.56285617359415,
+      "angularVelocity": 2.3251137262525053e-7,
+      "velocityX": 4.060161266317163,
+      "velocityY": -1.8670626570101556,
+      "timestamp": 1.1816241825452312
     },
     {
-      "x": 4.6205666666222935,
+      "x": 4.620566666622319,
       "y": 2.287204340773051,
-      "heading": 2.56285619321933,
-      "angularVelocity": 2.3251137344363183e-7,
-      "velocityX": 4.06016126631933,
-      "velocityY": -1.8670626570054454,
-      "timestamp": 1.2660259098698903
+      "heading": 2.5628561932185114,
+      "angularVelocity": 2.3251137330597664e-7,
+      "velocityX": 4.060161266320031,
+      "velocityY": -1.867062657003921,
+      "timestamp": 1.2660259098698905
     },
     {
-      "x": 4.963251290716338,
-      "y": 2.12962102749846,
-      "heading": 2.562856212843691,
-      "angularVelocity": 2.325113733001605e-7,
-      "velocityX": 4.060161266319529,
-      "velocityY": -1.8670626570050126,
-      "timestamp": 1.3504276371945496
+      "x": 4.963251290716406,
+      "y": 2.129621027498552,
+      "heading": 2.562856212842873,
+      "angularVelocity": 2.325113741533684e-7,
+      "velocityX": 4.06016126632003,
+      "velocityY": -1.8670626570039215,
+      "timestamp": 1.3504276371945498
     },
     {
-      "x": 5.305935914810376,
-      "y": 1.9720377142238548,
-      "heading": 2.5628562324680524,
-      "angularVelocity": 2.3251137288700666e-7,
-      "velocityX": 4.060161266319452,
-      "velocityY": -1.8670626570051803,
-      "timestamp": 1.434829364519209
+      "x": 5.305935914810306,
+      "y": 1.9720377142236445,
+      "heading": 2.5628562324672344,
+      "angularVelocity": 2.325113718451583e-7,
+      "velocityX": 4.060161266317804,
+      "velocityY": -1.8670626570087616,
+      "timestamp": 1.4348293645192092
     },
     {
-      "x": 5.6486205335479065,
-      "y": 1.8144543893009162,
-      "heading": 2.562856252092488,
-      "angularVelocity": 2.3251224680194668e-7,
-      "velocityX": 4.060161202855022,
-      "velocityY": -1.8670627950157828,
-      "timestamp": 1.5192310918438683
+      "x": 5.648620533547862,
+      "y": 1.8144543893007625,
+      "heading": 2.56285625209167,
+      "angularVelocity": 2.3251224808098197e-7,
+      "velocityX": 4.060161202855331,
+      "velocityY": -1.8670627950151129,
+      "timestamp": 1.5192310918438685
     },
     {
-      "x": 5.98670407076577,
-      "y": 1.6586057446575901,
-      "heading": 2.579360195393005,
-      "angularVelocity": 0.19554034998636466,
-      "velocityX": 4.005647134653921,
-      "velocityY": -1.8465101317635249,
-      "timestamp": 1.6036328191685276
+      "x": 5.986704070765734,
+      "y": 1.6586057446574787,
+      "heading": 2.5793601953922063,
+      "angularVelocity": 0.19554034998659195,
+      "velocityX": 4.0056471346540325,
+      "velocityY": -1.8465101317630266,
+      "timestamp": 1.6036328191685278
     },
     {
-      "x": 6.297588553428444,
-      "y": 1.515443031462974,
-      "heading": 2.623278535257842,
-      "angularVelocity": 0.5203488276478101,
-      "velocityX": 3.6833900503816404,
-      "velocityY": -1.6962059632254551,
-      "timestamp": 1.688034546493187
+      "x": 6.297588553428419,
+      "y": 1.5154430314628888,
+      "heading": 2.623278535257151,
+      "angularVelocity": 0.5203488276490896,
+      "velocityX": 3.6833900503817576,
+      "velocityY": -1.6962059632251454,
+      "timestamp": 1.6880345464931872
     },
     {
-      "x": 6.580221781390715,
-      "y": 1.3853244468495944,
-      "heading": 2.6723827473448787,
-      "angularVelocity": 0.5817915538405133,
-      "velocityX": 3.348666394884248,
-      "velocityY": -1.5416578396892986,
-      "timestamp": 1.7724362738178463
+      "x": 6.580221781390697,
+      "y": 1.385324446849529,
+      "heading": 2.6723827473443014,
+      "angularVelocity": 0.5817915538418572,
+      "velocityX": 3.3486663948843316,
+      "velocityY": -1.5416578396890646,
+      "timestamp": 1.7724362738178465
     },
     {
-      "x": 6.834557352214876,
-      "y": 1.2682518474424065,
-      "heading": 2.7214165995037427,
-      "angularVelocity": 0.5809579224634863,
-      "velocityX": 3.0133929587226977,
-      "velocityY": -1.3870877186773325,
-      "timestamp": 1.8568380011425056
+      "x": 6.834557352214864,
+      "y": 1.2682518474423568,
+      "heading": 2.7214165995032737,
+      "angularVelocity": 0.5809579224647721,
+      "velocityX": 3.013392958722759,
+      "velocityY": -1.3870877186771464,
+      "timestamp": 1.8568380011425059
     },
     {
-      "x": 7.060600794430822,
-      "y": 1.164213692766984,
-      "heading": 2.7679660552881162,
-      "angularVelocity": 0.5515225488847675,
-      "velocityX": 2.678185025129261,
-      "velocityY": -1.2326543303459838,
-      "timestamp": 1.941239728467165
+      "x": 7.060600794430814,
+      "y": 1.1642136927669469,
+      "heading": 2.7679660552877468,
+      "angularVelocity": 0.5515225488859516,
+      "velocityX": 2.6781850251293067,
+      "velocityY": -1.2326543303458337,
+      "timestamp": 1.9412397284671652
     },
     {
-      "x": 7.258362981468531,
-      "y": 1.0731997707175525,
-      "heading": 2.810637820160032,
-      "angularVelocity": 0.5055792840326011,
-      "velocityX": 2.3431059210079694,
-      "velocityY": -1.0783419360523008,
+      "x": 7.258362981468526,
+      "y": 1.0731997707175256,
+      "heading": 2.810637820159753,
+      "angularVelocity": 0.5055792840336621,
+      "velocityX": 2.3431059210080036,
+      "velocityY": -1.078341936052179,
       "timestamp": 2.0256414557918245
     },
     {
-      "x": 7.4278539951534555,
-      "y": 0.9952020001334562,
-      "heading": 2.848524374960913,
-      "angularVelocity": 0.44888364257222324,
-      "velocityX": 2.0081462673501975,
-      "velocityY": -0.9241252881480766,
+      "x": 7.427853995153451,
+      "y": 0.9952020001334377,
+      "heading": 2.8485243749607116,
+      "angularVelocity": 0.4488836425731485,
+      "velocityX": 2.0081462673502224,
+      "velocityY": -0.9241252881479789,
       "timestamp": 2.110043183116484
     },
     {
-      "x": 7.569082320847809,
-      "y": 0.930214000728212,
-      "heading": 2.8809880838803004,
-      "angularVelocity": 0.3846332290631053,
-      "velocityX": 1.6732871491018833,
-      "velocityY": -0.7699842345081582,
+      "x": 7.569082320847807,
+      "y": 0.9302140007282002,
+      "heading": 2.880988083880165,
+      "angularVelocity": 0.38463322906388664,
+      "velocityX": 1.673287149101901,
+      "velocityY": -0.7699842345080813,
       "timestamp": 2.194444910441143
     },
     {
-      "x": 7.682054982165758,
-      "y": 0.8782306591629105,
-      "heading": 2.9075567665885504,
-      "angularVelocity": 0.31478837638063123,
-      "velocityX": 1.3385112473277885,
-      "velocityY": -0.6159037642125805,
+      "x": 7.6820549821657576,
+      "y": 0.8782306591629035,
+      "heading": 2.9075567665884687,
+      "angularVelocity": 0.3147883763812628,
+      "velocityX": 1.338511247327801,
+      "velocityY": -0.615903764212522,
       "timestamp": 2.2788466377658025
     },
     {
       "x": 7.766777816162518,
-      "y": 0.8392478073722182,
-      "heading": 2.927866772500761,
-      "angularVelocity": 0.24063495565779372,
-      "velocityX": 1.0038045035602847,
-      "velocityY": -0.4618726775666696,
+      "y": 0.8392478073722147,
+      "heading": 2.92786677250072,
+      "angularVelocity": 0.24063495565827153,
+      "velocityX": 1.0038045035602927,
+      "velocityY": -0.46187267756662764,
       "timestamp": 2.363248365090462
     },
     {
       "x": 7.823255725612272,
-      "y": 0.8132619936429646,
-      "heading": 2.9416291988019947,
-      "angularVelocity": 0.16305858585447291,
-      "velocityX": 0.6691558483454472,
-      "velocityY": -0.3078824871592573,
+      "y": 0.8132619936429635,
+      "heading": 2.941629198801981,
+      "angularVelocity": 0.16305858585479388,
+      "velocityX": 0.6691558483454518,
+      "velocityY": -0.30788248715923044,
       "timestamp": 2.447650092415121
     },
     {
       "x": 7.851492881774902,
       "y": 0.8002703189849854,
       "heading": 2.948608540855105,
-      "angularVelocity": 0.08269193385419325,
-      "velocityX": 0.33455661462961894,
-      "velocityY": -0.15392664427358824,
+      "angularVelocity": 0.08269193385435476,
+      "velocityX": 0.334556614629621,
+      "velocityY": -0.15392664427357527,
       "timestamp": 2.5320518197397806
     },
     {
       "x": 7.851492881774902,
       "y": 0.8002703189849854,
       "heading": 2.948608540855105,
-      "angularVelocity": 5.402032347351411e-23,
-      "velocityX": -1.1123337120346699e-22,
-      "velocityY": 3.0651678544995594e-23,
+      "angularVelocity": -1.2062609516459865e-26,
+      "velocityX": 1.2103314188915662e-26,
+      "velocityY": -7.234631053601379e-26,
       "timestamp": 2.61645354706444
     }
   ],
diff --git a/src/main/deploy/choreo/543.2.traj b/src/main/deploy/choreo/543.2.traj
index 2adeeb5..721a94b 100644
--- a/src/main/deploy/choreo/543.2.traj
+++ b/src/main/deploy/choreo/543.2.traj
@@ -4,235 +4,235 @@
       "x": 7.851492881774902,
       "y": 0.8002703189849854,
       "heading": 2.948608540855105,
-      "angularVelocity": 5.402032347351411e-23,
-      "velocityX": -1.1123337120346699e-22,
-      "velocityY": 3.0651678544995594e-23,
+      "angularVelocity": -1.2062609516459865e-26,
+      "velocityX": 1.2103314188915662e-26,
+      "velocityY": -7.234631053601379e-26,
       "timestamp": 0
     },
     {
-      "x": 7.822568882035389,
-      "y": 0.8134565460364541,
-      "heading": 2.9419859459707647,
-      "angularVelocity": -0.07760298691601544,
-      "velocityX": -0.3389288960814876,
-      "velocityY": 0.15451505387509465,
-      "timestamp": 0.08533943276574352
-    },
-    {
-      "x": 7.7647170451374405,
-      "y": 0.8398310193474777,
-      "heading": 2.9289537678985185,
-      "angularVelocity": -0.15270992142659134,
-      "velocityX": -0.6779027587018491,
-      "velocityY": 0.3090537686537181,
-      "timestamp": 0.17067886553148703
-    },
-    {
-      "x": 7.677932914287794,
-      "y": 0.8793960863330212,
-      "heading": 2.9097686653736,
-      "angularVelocity": -0.22480935135321586,
-      "velocityX": -1.0169288456353933,
-      "velocityY": 0.4636199902353415,
-      "timestamp": 0.25601829829723055
-    },
-    {
-      "x": 7.562211255465081,
-      "y": 0.9321545004865132,
-      "heading": 2.8847464233438402,
-      "angularVelocity": -0.29320844091436304,
-      "velocityX": -1.3560162643729914,
-      "velocityY": 0.6182184770118369,
-      "timestamp": 0.34135773106297407
-    },
-    {
-      "x": 7.417545860204267,
-      "y": 0.9981095206504768,
-      "heading": 2.8542852498864897,
-      "angularVelocity": -0.35694136309724944,
-      "velocityX": -1.6951764333601793,
-      "velocityY": 0.7728551506196457,
-      "timestamp": 0.4266971638287176
-    },
-    {
-      "x": 7.243929314298609,
-      "y": 1.0772650341717676,
-      "heading": 2.81890263652658,
-      "angularVelocity": -0.414610364906394,
-      "velocityX": -2.034423481372746,
-      "velocityY": 0.9275373758174913,
-      "timestamp": 0.5120365965944611
-    },
-    {
-      "x": 7.041352783402235,
-      "y": 1.1696256928089817,
-      "heading": 2.779297618081299,
-      "angularVelocity": -0.46408813794200654,
-      "velocityX": -2.373774049476592,
-      "velocityY": 1.0822741099152131,
-      "timestamp": 0.5973760293602046
-    },
-    {
-      "x": 6.809806051541585,
-      "y": 1.2751969821493576,
-      "heading": 2.736465537770621,
-      "angularVelocity": -0.5019025662878775,
-      "velocityX": -2.713244327464013,
-      "velocityY": 1.2370751236438273,
-      "timestamp": 0.6827154621259481
-    },
-    {
-      "x": 6.549278874556655,
-      "y": 1.3939848079923727,
-      "heading": 2.6919369879711237,
-      "angularVelocity": -0.5217816471985232,
-      "velocityX": -3.05283464562131,
-      "velocityY": 1.3919453410135438,
-      "timestamp": 0.7680548948916917
-    },
-    {
-      "x": 6.259769303119967,
-      "y": 1.525992204929741,
-      "heading": 2.648375507048617,
-      "angularVelocity": -0.5104496187838855,
-      "velocityX": -3.3924478058272545,
-      "velocityY": 1.5468511174632342,
-      "timestamp": 0.8533943276574352
-    },
-    {
-      "x": 5.941344077941224,
-      "y": 1.6711937644032617,
-      "heading": 2.6116438214579167,
-      "angularVelocity": -0.43041867516894305,
-      "velocityX": -3.7312789042413628,
-      "velocityY": 1.7014591586529397,
-      "timestamp": 0.9387337604231787
-    },
-    {
-      "x": 5.595435536591844,
-      "y": 1.8290722409965166,
-      "heading": 2.607733432493964,
-      "angularVelocity": -0.045821595447992164,
-      "velocityX": -4.053325996422999,
-      "velocityY": 1.8500061633480882,
-      "timestamp": 1.0240731931889222
-    },
-    {
-      "x": 5.2496529439780035,
-      "y": 1.9869633522762045,
-      "heading": 2.6034613630785652,
-      "angularVelocity": -0.05005973530578218,
-      "velocityX": -4.05185014016924,
-      "velocityY": 1.8501542154972939,
-      "timestamp": 1.1094126259546657
-    },
-    {
-      "x": 4.931253772917131,
-      "y": 2.1321611295912564,
-      "heading": 2.5655322472298923,
-      "angularVelocity": -0.4444500580732541,
-      "velocityX": -3.7309736043697175,
-      "velocityY": 1.7014148396512054,
-      "timestamp": 1.1947520587204092
-    },
-    {
-      "x": 4.641767327132308,
-      "y": 2.2641652661660645,
-      "heading": 2.520640978635251,
-      "angularVelocity": -0.5260319542768441,
-      "velocityX": -3.3921768214638104,
-      "velocityY": 1.5468129128202641,
-      "timestamp": 1.2800914914861528
-    },
-    {
-      "x": 4.3812632098082105,
-      "y": 2.3829495591894077,
-      "heading": 2.47480035700841,
-      "angularVelocity": -0.537156389973591,
-      "velocityX": -3.052564434534983,
-      "velocityY": 1.3919039437419969,
-      "timestamp": 1.3654309242518963
-    },
-    {
-      "x": 4.149739035406864,
-      "y": 2.48851732367813,
-      "heading": 2.4307407651450164,
-      "angularVelocity": -0.5162864391697761,
-      "velocityX": -2.71298000113124,
-      "velocityY": 1.2370338197408188,
-      "timestamp": 1.4507703570176398
-    },
-    {
-      "x": 3.9471838536286543,
-      "y": 2.580874783829144,
-      "heading": 2.3900276970993897,
-      "angularVelocity": -0.4770721661272781,
-      "velocityX": -2.373523882379488,
-      "velocityY": 1.0822366303340143,
-      "timestamp": 1.5361097897833833
-    },
-    {
-      "x": 3.773586819419269,
-      "y": 2.6600276124979123,
-      "heading": 2.3536756719868617,
-      "angularVelocity": -0.4259698469324771,
-      "velocityX": -2.0341948450244476,
-      "velocityY": 0.9275059149507459,
-      "timestamp": 1.6214492225491268
-    },
-    {
-      "x": 3.6289385773839675,
-      "y": 2.725980527941314,
-      "heading": 2.3223946646011053,
-      "angularVelocity": -0.3665481052776955,
-      "velocityX": -1.694975433365738,
-      "velocityY": 0.7728304876884101,
-      "timestamp": 1.7067886553148703
-    },
-    {
-      "x": 3.5132312818952185,
-      "y": 2.7787374037595027,
-      "heading": 2.29670882734183,
-      "angularVelocity": -0.3009843917029925,
-      "velocityX": -1.3558479560833883,
-      "velocityY": 0.6182004509334662,
-      "timestamp": 1.7921280880806139
-    },
-    {
-      "x": 3.4264583605812398,
-      "y": 2.8183014403250346,
-      "heading": 2.277020911631921,
-      "angularVelocity": -0.23070127222373424,
-      "velocityX": -1.0167974932780486,
-      "velocityY": 0.4636079158638751,
-      "timestamp": 1.8774675208463574
-    },
-    {
-      "x": 3.3686142652512063,
-      "y": 2.8446753119826385,
-      "heading": 2.2636502919705843,
-      "angularVelocity": -0.15667575033031875,
-      "velocityX": -0.6778120436869518,
-      "velocityY": 0.3090467185316375,
-      "timestamp": 1.962806953612101
+      "x": 7.822569410321687,
+      "y": 0.8134570127208937,
+      "heading": 2.942250346546477,
+      "angularVelocity": -0.07451133821509169,
+      "velocityX": -0.3389526112595688,
+      "velocityY": 0.15453415690077843,
+      "timestamp": 0.08533190331749818
+    },
+    {
+      "x": 7.764718890043133,
+      "y": 0.839832272440097,
+      "heading": 2.9297405462516477,
+      "angularVelocity": -0.14660167895568676,
+      "velocityX": -0.6779471455512713,
+      "velocityY": 0.30909025456830386,
+      "timestamp": 0.17066380663499636
+    },
+    {
+      "x": 7.677937167802769,
+      "y": 0.8793982739906296,
+      "heading": 2.911328060299494,
+      "angularVelocity": -0.2157749357077613,
+      "velocityX": -1.0169903502265918,
+      "velocityY": 0.4636718508822873,
+      "timestamp": 0.25599570995249454
+    },
+    {
+      "x": 7.562219369891921,
+      "y": 0.9321575688208921,
+      "heading": 2.887319090771594,
+      "angularVelocity": -0.28135982668250875,
+      "velocityX": -1.3560906696325765,
+      "velocityY": 0.6182833474832815,
+      "timestamp": 0.3413276132699927
+    },
+    {
+      "x": 7.417559721625072,
+      "y": 0.998113175702274,
+      "heading": 2.8580996423497167,
+      "angularVelocity": -0.3424211494868395,
+      "velocityX": -1.6952586622685288,
+      "velocityY": 0.7729302209043448,
+      "timestamp": 0.4266595165874909
+    },
+    {
+      "x": 7.243951337087096,
+      "y": 1.0772686940136758,
+      "heading": 2.8241711861092553,
+      "angularVelocity": -0.3976057596444594,
+      "velocityX": -2.034507350574668,
+      "velocityY": 0.9276192752537634,
+      "timestamp": 0.5119914199049891
+    },
+    {
+      "x": 7.041386028561067,
+      "y": 1.1696284268040618,
+      "heading": 2.786210932104745,
+      "angularVelocity": -0.4448541814808713,
+      "velocityX": -2.373851990296467,
+      "velocityY": 1.0823587568032942,
+      "timestamp": 0.5973233232224873
+    },
+    {
+      "x": 6.809854361139004,
+      "y": 1.275197436064349,
+      "heading": 2.745182930692885,
+      "angularVelocity": -0.4808049488736419,
+      "velocityX": -2.7133071971990876,
+      "velocityY": 1.2371575595529873,
+      "timestamp": 0.6826552265399854
+    },
+    {
+      "x": 6.54934695925946,
+      "y": 1.3939811321605526,
+      "heading": 2.702569215300316,
+      "angularVelocity": -0.49938784599723113,
+      "velocityX": -3.0528722758036095,
+      "velocityY": 1.3920197660919402,
+      "timestamp": 0.7679871298574836
+    },
+    {
+      "x": 6.259862392041541,
+      "y": 1.5259821373575067,
+      "heading": 2.660947042906878,
+      "angularVelocity": -0.48776800675091764,
+      "velocityX": -3.39245412282464,
+      "velocityY": 1.546912702811892,
+      "timestamp": 0.8533190331749818
+    },
+    {
+      "x": 5.941463784169146,
+      "y": 1.6711762227772475,
+      "heading": 2.6259775148098465,
+      "angularVelocity": -0.4098060249156608,
+      "velocityX": -3.731296215059398,
+      "velocityY": 1.7015217026100005,
+      "timestamp": 0.93865093649248
+    },
+    {
+      "x": 5.595461000648761,
+      "y": 1.8290711503385564,
+      "heading": 2.6224591054778523,
+      "angularVelocity": -0.04123205032592272,
+      "velocityX": -4.0547880695101535,
+      "velocityY": 1.8503621907251089,
+      "timestamp": 1.0239828398099782
+    },
+    {
+      "x": 5.24956334725571,
+      "y": 1.986975195185791,
+      "heading": 2.6186328254708116,
+      "angularVelocity": -0.04483997026064621,
+      "velocityX": -4.053556055184374,
+      "velocityY": 1.8504690357100606,
+      "timestamp": 1.1093147431274764
+    },
+    {
+      "x": 4.931186691253366,
+      "y": 2.1321663984246007,
+      "heading": 2.58261703355146,
+      "angularVelocity": -0.4220671345551227,
+      "velocityX": -3.731038962271196,
+      "velocityY": 1.7014879264861869,
+      "timestamp": 1.1946466464449745
+    },
+    {
+      "x": 4.641721554882089,
+      "y": 2.2641649180815384,
+      "heading": 2.5398323894162624,
+      "angularVelocity": -0.5013909507679347,
+      "velocityX": -3.392226413774599,
+      "velocityY": 1.546883574901704,
+      "timestamp": 1.2799785497624727
+    },
+    {
+      "x": 4.381233513115829,
+      "y": 2.3829458675377655,
+      "heading": 2.4960705108691763,
+      "angularVelocity": -0.512843108447488,
+      "velocityX": -3.0526453956740087,
+      "velocityY": 1.3919875783653128,
+      "timestamp": 1.365310453079971
+    },
+    {
+      "x": 4.149720790549715,
+      "y": 2.4885121054416337,
+      "heading": 2.4539667442415882,
+      "angularVelocity": -0.4934117837607673,
+      "velocityX": -2.7130851834479257,
+      "velocityY": 1.2371250821756956,
+      "timestamp": 1.450642356397469
+    },
+    {
+      "x": 3.9471734283435462,
+      "y": 2.5808693126971836,
+      "heading": 2.4150338091170536,
+      "angularVelocity": -0.4562529793771927,
+      "velocityX": -2.3736416783362024,
+      "velocityY": 1.0823291601959537,
+      "timestamp": 1.5359742597149673
+    },
+    {
+      "x": 3.773581464458937,
+      "y": 2.6600227125745386,
+      "heading": 2.3802529914030197,
+      "angularVelocity": -0.4075945380548163,
+      "velocityX": -2.034314917818226,
+      "velocityY": 0.9275944494387498,
+      "timestamp": 1.6213061630324654
+    },
+    {
+      "x": 3.6289362693248974,
+      "y": 2.7259766668551513,
+      "heading": 2.3503116341483112,
+      "angularVelocity": -0.35088116039442224,
+      "velocityX": -1.6950892867800245,
+      "velocityY": 0.772910854164535,
+      "timestamp": 1.7066380663499636
+    },
+    {
+      "x": 3.5132305875893466,
+      "y": 2.7787347643176643,
+      "heading": 2.3257175786127346,
+      "angularVelocity": -0.288216418237719,
+      "velocityX": -1.3559486808238648,
+      "velocityY": 0.6182693155948199,
+      "timestamp": 1.7919699696674618
+    },
+    {
+      "x": 3.426458330792868,
+      "y": 2.8182999738021985,
+      "heading": 2.306861275231502,
+      "angularVelocity": -0.22097600836433876,
+      "velocityX": -1.0168794251971758,
+      "velocityY": 0.4636625687033173,
+      "timestamp": 1.87730187298496
+    },
+    {
+      "x": 3.3686143533074815,
+      "y": 2.844674778468884,
+      "heading": 2.2940524576726125,
+      "angularVelocity": -0.15010584624172035,
+      "velocityX": -0.6778704709089147,
+      "velocityY": 0.30908492183224257,
+      "timestamp": 1.9626337763024582
     },
     {
       "x": 3.3396942615509033,
       "y": 2.857861280441284,
-      "heading": 2.256856869928089,
-      "angularVelocity": -0.07960472459599503,
-      "velocityX": -0.33888207084394817,
-      "velocityY": 0.15451202370703507,
-      "timestamp": 2.0481463863778444
+      "heading": 2.287543209286567,
+      "angularVelocity": -0.0762815328497496,
+      "velocityX": -0.3389130047758784,
+      "velocityY": 0.15453190963450955,
+      "timestamp": 2.0479656796199563
     },
     {
       "x": 3.3396942615509033,
       "y": 2.857861280441284,
-      "heading": 2.256856869928089,
-      "angularVelocity": -5.437621548215379e-23,
-      "velocityX": 1.126114853157674e-22,
-      "velocityY": -4.5016812727452064e-23,
-      "timestamp": 2.133485819143588
+      "heading": 2.287543209286567,
+      "angularVelocity": -5.746242802708337e-26,
+      "velocityX": 2.4125661857863508e-26,
+      "velocityY": -5.00362558177337e-27,
+      "timestamp": 2.1332975829374545
     }
   ],
   "eventMarkers": []
diff --git a/src/main/deploy/choreo/543.3.traj b/src/main/deploy/choreo/543.3.traj
index 39f6863..e774a99 100644
--- a/src/main/deploy/choreo/543.3.traj
+++ b/src/main/deploy/choreo/543.3.traj
@@ -3,344 +3,344 @@
     {
       "x": 3.3396942615509033,
       "y": 2.857861280441284,
-      "heading": 2.256856869928089,
-      "angularVelocity": -5.437621548215379e-23,
-      "velocityX": 1.126114853157674e-22,
-      "velocityY": -4.5016812727452064e-23,
+      "heading": 2.287543209286567,
+      "angularVelocity": -5.746242802708337e-26,
+      "velocityX": 2.4125661857863508e-26,
+      "velocityY": -5.00362558177337e-27,
       "timestamp": 0
     },
     {
-      "x": 3.351644043460381,
-      "y": 2.8456827633555766,
-      "heading": 2.2599985645312386,
-      "angularVelocity": 0.050261094910594425,
-      "velocityX": 0.1911736176110555,
-      "velocityY": -0.19483294222852873,
-      "timestamp": 0.06250748434226772
-    },
-    {
-      "x": 3.375805096988204,
-      "y": 2.821589634193531,
-      "heading": 2.266346205797599,
-      "angularVelocity": 0.10155009969051512,
-      "velocityX": 0.38653056961188503,
-      "velocityY": -0.3854439098863877,
-      "timestamp": 0.12501496868453543
-    },
-    {
-      "x": 3.4124780907077805,
-      "y": 2.7859000800493376,
-      "heading": 2.2759735457087524,
-      "angularVelocity": 0.1540189948844771,
-      "velocityX": 0.5866976427777654,
-      "velocityY": -0.5709644936080076,
-      "timestamp": 0.18752245302680315
-    },
-    {
-      "x": 3.4620112120736506,
-      "y": 2.7390039778926036,
-      "heading": 2.2889657812850372,
-      "angularVelocity": 0.2078508791866281,
-      "velocityX": 0.7924350481719095,
-      "velocityY": -0.7502477927274819,
-      "timestamp": 0.25002993736907086
-    },
-    {
-      "x": 3.524810340388698,
-      "y": 2.6813880030564383,
-      "heading": 2.3054218546593743,
-      "angularVelocity": 0.2632656480659119,
-      "velocityX": 1.0046657448439726,
-      "velocityY": -0.921745218871413,
-      "timestamp": 0.3125374217113386
-    },
-    {
-      "x": 3.6013509003736557,
-      "y": 2.6136727622292386,
-      "heading": 2.3254569789759962,
-      "angularVelocity": 0.3205236065319362,
-      "velocityX": 1.224502326247042,
-      "velocityY": -1.0833141269358477,
-      "timestamp": 0.3750449060536063
-    },
-    {
-      "x": 3.6921900643990977,
-      "y": 2.5366690761295727,
-      "heading": 2.349204872167281,
-      "angularVelocity": 0.37992079574423454,
-      "velocityX": 1.4532525981695328,
-      "velocityY": -1.2319114568428715,
-      "timestamp": 0.437552390395874
-    },
-    {
-      "x": 3.7979745951175046,
-      "y": 2.451465011623651,
-      "heading": 2.376818153439006,
-      "angularVelocity": 0.44175959986687446,
-      "velocityX": 1.6923498334882667,
-      "velocityY": -1.3631018013679077,
-      "timestamp": 0.5000598747381417
-    },
-    {
-      "x": 3.919430507100887,
-      "y": 2.3595611737368243,
-      "heading": 2.40846281175274,
-      "angularVelocity": 0.506253909379225,
-      "velocityX": 1.9430619110878742,
-      "velocityY": -1.4702853402897413,
-      "timestamp": 0.5625673590804094
-    },
-    {
-      "x": 4.057297923271103,
-      "y": 2.2630736309568915,
-      "heading": 2.444297103991139,
-      "angularVelocity": 0.5732800258315275,
-      "velocityX": 2.2056145375377016,
-      "velocityY": -1.5436158372908153,
-      "timestamp": 0.6250748434226772
-    },
-    {
-      "x": 4.212127945253694,
-      "y": 2.1649943582593476,
-      "heading": 2.4844167991527084,
-      "angularVelocity": 0.6418382627892845,
-      "velocityX": 2.476983734216506,
-      "velocityY": -1.569080466596581,
-      "timestamp": 0.6875823277649449
-    },
-    {
-      "x": 4.383820693252035,
-      "y": 2.069358793134477,
-      "heading": 2.5287485383649866,
-      "angularVelocity": 0.7092228983258065,
-      "velocityX": 2.7467550454952905,
-      "velocityY": -1.5299858269964235,
-      "timestamp": 0.7500898121072126
-    },
-    {
-      "x": 4.570979270017924,
-      "y": 1.9808954420903548,
-      "heading": 2.5769092562000195,
-      "angularVelocity": 0.7704792208773401,
-      "velocityX": 2.9941786769257464,
-      "velocityY": -1.415244141961144,
-      "timestamp": 0.8125972964494803
-    },
-    {
-      "x": 4.770751425736408,
-      "y": 1.9039231820267064,
-      "heading": 2.6281541085992433,
-      "angularVelocity": 0.8198194654359416,
-      "velocityX": 3.195971775549396,
-      "velocityY": -1.2314087004713992,
-      "timestamp": 0.875104780791748
-    },
-    {
-      "x": 4.979639835251487,
-      "y": 1.8413910789934598,
-      "heading": 2.6815711170435192,
-      "angularVelocity": 0.854569800822325,
-      "velocityX": 3.3418143717204245,
-      "velocityY": -1.0003938518921032,
-      "timestamp": 0.9376122651340157
-    },
-    {
-      "x": 5.1944404545831935,
-      "y": 1.7948889188778072,
-      "heading": 2.736334014493798,
-      "angularVelocity": 0.8761014465150618,
-      "velocityX": 3.436398402398313,
-      "velocityY": -0.7439454747694548,
-      "timestamp": 1.0001197494762835
-    },
-    {
-      "x": 5.412600696471709,
-      "y": 1.7651426093363154,
-      "heading": 2.791791924356713,
-      "angularVelocity": 0.887220313638733,
-      "velocityX": 3.4901459270693214,
-      "velocityY": -0.4758839658081921,
-      "timestamp": 1.0626272338185512
+      "x": 3.3516435621879443,
+      "y": 2.845682470433759,
+      "heading": 2.2905998350495063,
+      "angularVelocity": 0.048902527346193034,
+      "velocityX": 0.19117518678796644,
+      "velocityY": -0.19484707505193644,
+      "timestamp": 0.06250445383528902
+    },
+    {
+      "x": 3.375803728180644,
+      "y": 2.82158872757552,
+      "heading": 2.2967757258080246,
+      "angularVelocity": 0.09880721099960219,
+      "velocityX": 0.38653511086371894,
+      "velocityY": -0.38547241644140595,
+      "timestamp": 0.12500890767057804
+    },
+    {
+      "x": 3.412475519518133,
+      "y": 2.785898212552426,
+      "heading": 2.3061427774759617,
+      "angularVelocity": 0.14986214730586908,
+      "velocityX": 0.5867068518689256,
+      "velocityY": -0.5710075495923139,
+      "timestamp": 0.18751336150586706
+    },
+    {
+      "x": 3.4620072362728327,
+      "y": 2.739000780362959,
+      "heading": 2.3187840455780817,
+      "angularVelocity": 0.20224587731671442,
+      "velocityX": 0.7924509969357517,
+      "velocityY": -0.7503054472414145,
+      "timestamp": 0.2500178153411561
+    },
+    {
+      "x": 3.5248048977787745,
+      "y": 2.6813830942336088,
+      "heading": 2.334796000084425,
+      "angularVelocity": 0.25617301686272975,
+      "velocityX": 1.0046909884442055,
+      "velocityY": -0.9218172881117153,
+      "timestamp": 0.3125222691764451
+    },
+    {
+      "x": 3.6013441038202685,
+      "y": 2.613665768416081,
+      "heading": 2.354291010287888,
+      "angularVelocity": 0.3118979369827916,
+      "velocityX": 1.2245400342700232,
+      "velocityY": -1.083400008517403,
+      "timestamp": 0.3750267230117341
+    },
+    {
+      "x": 3.6921822448448554,
+      "y": 2.5366596684882037,
+      "heading": 2.3773995605243607,
+      "angularVelocity": 0.3697104577118356,
+      "velocityX": 1.4533066917753177,
+      "velocityY": -1.2320098041461673,
+      "timestamp": 0.43753117684702314
+    },
+    {
+      "x": 3.7979663486343616,
+      "y": 2.4514529745156497,
+      "heading": 2.4042706940551257,
+      "angularVelocity": 0.4299075006970781,
+      "velocityX": 1.6924250561130743,
+      "velocityY": -1.3632099593588929,
+      "timestamp": 0.5000356306823122
+    },
+    {
+      "x": 3.919422728848772,
+      "y": 2.359546524255324,
+      "heading": 2.4350666770591682,
+      "angularVelocity": 0.49270061754632183,
+      "velocityX": 1.9431636109399608,
+      "velocityY": -1.4703984215671488,
+      "timestamp": 0.5625400845176012
+    },
+    {
+      "x": 4.057291778395416,
+      "y": 2.2630568077934385,
+      "heading": 2.46994235759142,
+      "angularVelocity": 0.5579711267321186,
+      "velocityX": 2.205747608161725,
+      "velocityY": -1.5437254554076125,
+      "timestamp": 0.6250445383528902
+    },
+    {
+      "x": 4.212124670100329,
+      "y": 2.1649764518129966,
+      "heading": 2.5089912150282228,
+      "angularVelocity": 0.6247371993634814,
+      "velocityX": 2.4771497422076023,
+      "velocityY": -1.569173874215458,
+      "timestamp": 0.6875489921881792
+    },
+    {
+      "x": 4.383821100314581,
+      "y": 2.069341640095549,
+      "heading": 2.552140235385777,
+      "angularVelocity": 0.6903351314973505,
+      "velocityX": 2.7469471322268335,
+      "velocityY": -1.5300479541740037,
+      "timestamp": 0.7500534460234682
+    },
+    {
+      "x": 4.57098306636943,
+      "y": 1.9808811883739248,
+      "heading": 2.5990137961096176,
+      "angularVelocity": 0.7499235310072663,
+      "velocityX": 2.994378073409875,
+      "velocityY": -1.4152663737328883,
+      "timestamp": 0.8125578998587573
+    },
+    {
+      "x": 4.770757132781262,
+      "y": 1.9039132129567853,
+      "heading": 2.6488865297070845,
+      "angularVelocity": 0.7979068776265251,
+      "velocityX": 3.1961573000585606,
+      "velocityY": -1.2313998554401338,
+      "timestamp": 0.8750623536940463
+    },
+    {
+      "x": 4.979645659161256,
+      "y": 1.8413854433641312,
+      "heading": 2.700871838493138,
+      "angularVelocity": 0.8317056720956911,
+      "velocityX": 3.341978268147973,
+      "velocityY": -1.0003730255355316,
+      "timestamp": 0.9375668075293353
+    },
+    {
+      "x": 5.194445000550818,
+      "y": 1.794886668519366,
+      "heading": 2.7541661254761425,
+      "angularVelocity": 0.852647830880101,
+      "velocityX": 3.436544569377394,
+      "velocityY": -0.74392738423566,
+      "timestamp": 1.0000712613646243
+    },
+    {
+      "x": 5.41260313772344,
+      "y": 1.7651422981078766,
+      "heading": 2.80813619301323,
+      "angularVelocity": 0.8634595492876254,
+      "velocityX": 3.490281472541287,
+      "velocityY": -0.47587601500961113,
+      "timestamp": 1.0625757151999133
     },
     {
       "x": 5.632181167602539,
       "y": 1.7524278163909912,
-      "heading": 2.8474537083946774,
-      "angularVelocity": 0.8904819098650865,
-      "velocityX": 3.5128668741248528,
-      "velocityY": -0.20341232860536554,
-      "timestamp": 1.125134718160819
-    },
-    {
-      "x": 5.8440548234983485,
-      "y": 1.7560753750562226,
-      "heading": 2.9010181770052657,
-      "angularVelocity": 0.8879122072577887,
-      "velocityX": 3.5121267949821284,
-      "velocityY": 0.060463810237589344,
-      "timestamp": 1.1854610298983452
-    },
-    {
-      "x": 6.054389053331998,
-      "y": 1.7755662495775102,
-      "heading": 2.954051932515814,
-      "angularVelocity": 0.8791148336946817,
-      "velocityX": 3.486608476062547,
-      "velocityY": 0.3230907701782012,
-      "timestamp": 1.2457873416358716
-    },
-    {
-      "x": 6.261238142657165,
-      "y": 1.8105864214888754,
-      "heading": 3.0060676791923955,
-      "angularVelocity": 0.8622397951808591,
-      "velocityX": 3.4288369928058486,
-      "velocityY": 0.580512398366648,
-      "timestamp": 1.306113653373398
-    },
-    {
-      "x": 6.462109517822259,
-      "y": 1.8603513524817452,
-      "heading": 3.056444759125243,
-      "angularVelocity": 0.8350764116333455,
-      "velocityX": 3.3297473254964793,
-      "velocityY": 0.8249291156633646,
-      "timestamp": 1.3664399651109242
-    },
-    {
-      "x": 6.654010184213206,
-      "y": 1.9232453521028667,
-      "heading": 3.104446433482699,
-      "angularVelocity": 0.7957004659311325,
-      "velocityX": 3.1810442386381634,
-      "velocityY": 1.0425633162320176,
-      "timestamp": 1.4267662768484506
-    },
-    {
-      "x": 6.833858375306977,
-      "y": 1.9964918469597606,
-      "heading": 3.14932595328394,
-      "angularVelocity": 0.7439460246883234,
-      "velocityX": 2.9812562033673333,
-      "velocityY": 1.2141716068368684,
-      "timestamp": 1.487092588585977
-    },
-    {
-      "x": 6.999254693304601,
-      "y": 2.076309931658828,
-      "heading": 3.1905011120826616,
-      "angularVelocity": 0.682540629665392,
-      "velocityX": 2.741694514944779,
-      "velocityY": 1.3231056631863822,
-      "timestamp": 1.5474189003235033
-    },
-    {
-      "x": 7.148994960466567,
-      "y": 2.158718271752955,
-      "heading": 3.2276763371225257,
-      "angularVelocity": 0.6162356684693461,
-      "velocityX": 2.4821717563883468,
-      "velocityY": 1.366043070106414,
-      "timestamp": 1.6077452120610296
-    },
-    {
-      "x": 7.282888276645903,
-      "y": 2.2403059232688856,
-      "heading": 3.2608205631276768,
-      "angularVelocity": 0.549415753267966,
-      "velocityX": 2.219484538718249,
-      "velocityY": 1.3524389137348638,
-      "timestamp": 1.668071523798556
-    },
-    {
-      "x": 7.401284262943972,
-      "y": 2.318469756879384,
-      "heading": 3.290049267440689,
-      "angularVelocity": 0.4845100499460918,
-      "velocityX": 1.9625928204130767,
-      "velocityY": 1.2956839455158753,
-      "timestamp": 1.7283978355360823
-    },
-    {
-      "x": 7.504726503640908,
-      "y": 2.3913046004079064,
-      "heading": 3.3155261667453493,
-      "angularVelocity": 0.4223181986577886,
-      "velocityX": 1.7147118349784642,
-      "velocityY": 1.207347862495227,
-      "timestamp": 1.7887241472736086
-    },
-    {
-      "x": 7.593783054881719,
-      "y": 2.4574176139035644,
-      "heading": 3.337415785304815,
-      "angularVelocity": 0.3628535862544627,
-      "velocityX": 1.4762472406449565,
-      "velocityY": 1.09592334739955,
-      "timestamp": 1.849050459011135
-    },
-    {
-      "x": 7.668980952466653,
-      "y": 2.515773590456062,
-      "heading": 3.3558669674797814,
-      "angularVelocity": 0.30585629460069885,
-      "velocityX": 1.2465190630601162,
-      "velocityY": 0.9673387096230766,
-      "timestamp": 1.9093767707486613
-    },
-    {
-      "x": 7.730787601696288,
-      "y": 2.5655858755396013,
-      "heading": 3.3710094475828405,
-      "angularVelocity": 0.2510095457010997,
-      "velocityX": 1.0245388363629793,
-      "velocityY": 0.8257140814486926,
-      "timestamp": 1.9697030824861876
-    },
-    {
-      "x": 7.779610612054574,
-      "y": 2.606242990697603,
-      "heading": 3.3829549992996975,
-      "angularVelocity": 0.1980156149580433,
-      "velocityX": 0.8093153543135553,
-      "velocityY": 0.6739532715823396,
-      "timestamp": 2.030029394223714
-    },
-    {
-      "x": 7.815803885955238,
-      "y": 2.637259478202497,
-      "heading": 3.391799843863087,
-      "angularVelocity": 0.14661669690454437,
-      "velocityX": 0.5999583408668668,
-      "velocityY": 0.5141452645048762,
-      "timestamp": 2.0903557059612403
-    },
-    {
-      "x": 7.839675112054325,
-      "y": 2.6582425491647967,
-      "heading": 3.3976271358840906,
-      "angularVelocity": 0.09659619249320384,
-      "velocityX": 0.3957017329842471,
-      "velocityY": 0.34782618658331665,
-      "timestamp": 2.1506820176987667
+      "heading": 2.8623042167051507,
+      "angularVelocity": 0.8666266220750221,
+      "velocityX": 3.512998137024418,
+      "velocityY": -0.20341721168207155,
+      "timestamp": 1.1250801690352024
+    },
+    {
+      "x": 5.844052633999474,
+      "y": 1.7560741482181919,
+      "heading": 2.9144309181641597,
+      "angularVelocity": 0.8641203781884118,
+      "velocityX": 3.512258526740335,
+      "velocityY": 0.06044636528553216,
+      "timestamp": 1.1854035947693466
+    },
+    {
+      "x": 6.054385084094644,
+      "y": 1.775562351216045,
+      "heading": 2.966040820049239,
+      "angularVelocity": 0.8555532325457329,
+      "velocityX": 3.48674577969332,
+      "velocityY": 0.32306194087420037,
+      "timestamp": 1.245727020503491
+    },
+    {
+      "x": 6.26123327956607,
+      "y": 1.810578663020331,
+      "heading": 3.0166596950957345,
+      "angularVelocity": 0.8391246755378504,
+      "velocityX": 3.4289862181077373,
+      "velocityY": 0.5804761811540523,
+      "timestamp": 1.3060504462376352
+    },
+    {
+      "x": 6.462105137626569,
+      "y": 1.860339123757078,
+      "heading": 3.0656834710845464,
+      "angularVelocity": 0.8126822273799312,
+      "velocityX": 3.3299146329284577,
+      "velocityY": 0.8248944772475333,
+      "timestamp": 1.3663738719717795
+    },
+    {
+      "x": 6.654007902194967,
+      "y": 1.923229033256814,
+      "heading": 3.1123949171108847,
+      "angularVelocity": 0.7743500217014212,
+      "velocityX": 3.181231208820061,
+      "velocityY": 1.0425453915184284,
+      "timestamp": 1.4266972977059238
+    },
+    {
+      "x": 6.833859400320409,
+      "y": 1.9964729638714147,
+      "heading": 3.1560670771443236,
+      "angularVelocity": 0.7239668421006098,
+      "velocityX": 2.9814536548053483,
+      "velocityY": 1.2141871872031882,
+      "timestamp": 1.487020723440068
+    },
+    {
+      "x": 6.9992591804507365,
+      "y": 2.0762906150910156,
+      "heading": 3.196134058178292,
+      "angularVelocity": 0.6642026799099766,
+      "velocityX": 2.7418830763901587,
+      "velocityY": 1.323161777505331,
+      "timestamp": 1.5473441491742124
+    },
+    {
+      "x": 7.149002064381009,
+      "y": 2.158700328766707,
+      "heading": 3.2323093855933887,
+      "angularVelocity": 0.5996895397573637,
+      "velocityX": 2.4823338878368153,
+      "velocityY": 1.366131194850996,
+      "timestamp": 1.6076675749083567
+    },
+    {
+      "x": 7.28289676997483,
+      "y": 2.240290393761693,
+      "heading": 3.264563171309931,
+      "angularVelocity": 0.53468093570631,
+      "velocityX": 2.2196137564189082,
+      "velocityY": 1.3525436263279895,
+      "timestamp": 1.667991000642501
+    },
+    {
+      "x": 7.401293019643784,
+      "y": 2.3184570273209686,
+      "heading": 3.293007501257009,
+      "angularVelocity": 0.471530414609361,
+      "velocityX": 1.9626910810859457,
+      "velocityY": 1.2957923494559103,
+      "timestamp": 1.7283144263766452
+    },
+    {
+      "x": 7.504734676211669,
+      "y": 2.3912946510869886,
+      "heading": 3.317801309695562,
+      "angularVelocity": 0.411014595686653,
+      "velocityX": 1.7147841872205727,
+      "velocityY": 1.2074517134857092,
+      "timestamp": 1.7886378521107895
+    },
+    {
+      "x": 7.593790089197515,
+      "y": 2.4574102058192864,
+      "heading": 3.3391044114920563,
+      "angularVelocity": 0.3531480770071126,
+      "velocityX": 1.4762989983083836,
+      "velocityY": 1.0960179056090211,
+      "timestamp": 1.8489612778449338
+    },
+    {
+      "x": 7.668986549958961,
+      "y": 2.51576837810098,
+      "heading": 3.3570614630429048,
+      "angularVelocity": 0.297679571945867,
+      "velocityX": 1.246554880567463,
+      "velocityY": 0.9674213884816201,
+      "timestamp": 1.909284703579078
+    },
+    {
+      "x": 7.73079167331363,
+      "y": 2.5655824702880596,
+      "heading": 3.37179859188409,
+      "angularVelocity": 0.24430192187914104,
+      "velocityX": 1.0245625576215516,
+      "velocityY": 0.8257835423110678,
+      "timestamp": 1.9696081293132224
+    },
+    {
+      "x": 7.779613237498961,
+      "y": 2.6062409955381525,
+      "heading": 3.3834244875514194,
+      "angularVelocity": 0.1927260517094479,
+      "velocityX": 0.8093301000592581,
+      "velocityY": 0.6740088904977358,
+      "timestamp": 2.0299315550473667
+    },
+    {
+      "x": 7.815805280749054,
+      "y": 2.6372585064369205,
+      "heading": 3.392032727236094,
+      "angularVelocity": 0.14270143944762578,
+      "velocityX": 0.5999666433003645,
+      "velocityY": 0.5141868274435829,
+      "timestamp": 2.090254980781511
+    },
+    {
+      "x": 7.839675601727849,
+      "y": 2.6582422341725844,
+      "heading": 3.397704184310039,
+      "angularVelocity": 0.09401748997048373,
+      "velocityX": 0.3957056597547123,
+      "velocityY": 0.3478537148759254,
+      "timestamp": 2.1505784065156552
     },
     {
       "x": 7.851492881774902,
       "y": 2.6688690185546875,
       "heading": 3.4005091591002805,
-      "angularVelocity": 0.047773900528336063,
-      "velocityX": 0.19589743480415714,
-      "velocityY": 0.17614982722838615,
-      "timestamp": 2.211008329436293
+      "angularVelocity": 0.04649893065761563,
+      "velocityX": 0.1958986894931053,
+      "velocityY": 0.17616347634064075,
+      "timestamp": 2.2109018322497995
     },
     {
       "x": 7.851492881774902,
       "y": 2.6688690185546875,
       "heading": 3.4005091591002805,
-      "angularVelocity": 9.276573292600319e-26,
-      "velocityX": -1.5083414418709853e-26,
-      "velocityY": 1.2473322363600933e-26,
-      "timestamp": 2.2713346411738193
+      "angularVelocity": -1.5889815326108731e-28,
+      "velocityX": -3.357307726516775e-27,
+      "velocityY": -2.0645613226978418e-27,
+      "timestamp": 2.271225257983944
     }
   ],
   "eventMarkers": []
diff --git a/src/main/deploy/choreo/543.4.traj b/src/main/deploy/choreo/543.4.traj
index 7cb87ec..e5cf0dc 100644
--- a/src/main/deploy/choreo/543.4.traj
+++ b/src/main/deploy/choreo/543.4.traj
@@ -4,334 +4,334 @@
       "x": 7.851492881774902,
       "y": 2.6688690185546875,
       "heading": 3.4005091591002805,
-      "angularVelocity": 9.276573292600319e-26,
-      "velocityX": -1.5083414418709853e-26,
-      "velocityY": 1.2473322363600933e-26,
+      "angularVelocity": -1.5889815326108731e-28,
+      "velocityX": -3.357307726516775e-27,
+      "velocityY": -2.0645613226978418e-27,
       "timestamp": 0
     },
     {
-      "x": 7.8398706908734885,
-      "y": 2.659045579836875,
-      "heading": 3.397670399128096,
-      "angularVelocity": -0.048087115146296475,
-      "velocityX": -0.1968738595741256,
-      "velocityY": -0.1664039345998305,
-      "timestamp": 0.059033692571248686
-    },
-    {
-      "x": 7.816406714095507,
-      "y": 2.6396661861972013,
-      "heading": 3.391938122786304,
-      "angularVelocity": -0.09710177514092747,
-      "velocityX": -0.3974675436347192,
-      "velocityY": -0.3282768330353808,
-      "timestamp": 0.11806738514249737
-    },
-    {
-      "x": 7.780852662322508,
-      "y": 2.6110489157431105,
-      "heading": 3.3832503902407196,
-      "angularVelocity": -0.1471656636606117,
-      "velocityX": -0.6022671160217185,
-      "velocityY": -0.4847616540258291,
-      "timestamp": 0.17710107771374606
-    },
-    {
-      "x": 7.732926709877436,
-      "y": 2.5735771170694988,
-      "heading": 3.371536801646899,
-      "angularVelocity": -0.1984220888721078,
-      "velocityX": -0.8118406685678751,
-      "velocityY": -0.6347527495148073,
-      "timestamp": 0.23613477028499474
-    },
-    {
-      "x": 7.6723081853265365,
-      "y": 2.5277198244659425,
-      "heading": 3.356717057617367,
-      "angularVelocity": -0.25103874387742214,
-      "velocityX": -1.026846228155873,
-      "velocityY": -0.7767986484702889,
-      "timestamp": 0.29516846285624343
-    },
-    {
-      "x": 7.5986324175748425,
-      "y": 2.474060659554904,
-      "heading": 3.338699486712251,
-      "angularVelocity": -0.3052082653201855,
-      "velocityX": -1.2480291261261385,
-      "velocityY": -0.9089583011646543,
-      "timestamp": 0.3542021554274921
-    },
-    {
-      "x": 7.511487405741507,
-      "y": 2.4133393759459825,
-      "heading": 3.317379927830016,
-      "angularVelocity": -0.36114222156278913,
-      "velocityX": -1.476191104396181,
-      "velocityY": -1.0285869130689465,
-      "timestamp": 0.4132358479987408
-    },
-    {
-      "x": 7.4104163777069365,
-      "y": 2.3465120960997368,
-      "heading": 3.292641982912585,
-      "angularVelocity": -0.4190479002744803,
-      "velocityX": -1.7120905644278663,
-      "velocityY": -1.1320193085599486,
-      "timestamp": 0.4722695405699895
-    },
-    {
-      "x": 7.294935610990268,
-      "y": 2.274838006810846,
-      "heading": 3.2643611388836136,
-      "angularVelocity": -0.47906276563741024,
-      "velocityX": -1.9561840313020116,
-      "velocityY": -1.2141217356916356,
-      "timestamp": 0.5313032331412382
-    },
-    {
-      "x": 7.164587802676699,
-      "y": 2.1999985571515315,
-      "heading": 3.232418514985885,
-      "angularVelocity": -0.5410914090995878,
-      "velocityX": -2.208023971332143,
-      "velocityY": -1.2677412914496198,
-      "timestamp": 0.5903369257124869
-    },
-    {
-      "x": 7.019069460404565,
-      "y": 2.1242390065298777,
-      "heading": 3.1967356179090185,
-      "angularVelocity": -0.6044496883504356,
-      "velocityX": -2.4650049138719563,
-      "velocityY": -1.283327322447578,
-      "timestamp": 0.6493706182837355
-    },
-    {
-      "x": 6.858482408304033,
-      "y": 2.0504663765671833,
-      "heading": 3.157343833838982,
-      "angularVelocity": -0.6672763019608559,
-      "velocityX": -2.7202610086895374,
-      "velocityY": -1.2496699215224816,
-      "timestamp": 0.7084043108549842
-    },
-    {
-      "x": 6.683696731414882,
-      "y": 1.9821321374647565,
-      "heading": 3.1144766897750107,
-      "angularVelocity": -0.7261470898543997,
-      "velocityX": -2.960778316182739,
-      "velocityY": -1.1575464133461344,
-      "timestamp": 0.7674380034262329
-    },
-    {
-      "x": 6.496590119927003,
-      "y": 1.9227240477896728,
-      "heading": 3.068611211883559,
-      "angularVelocity": -0.7769373029833073,
-      "velocityX": -3.1694885299959403,
-      "velocityY": -1.0063420919059627,
-      "timestamp": 0.8264716959974816
-    },
-    {
-      "x": 6.299809989168005,
-      "y": 1.8750739339769262,
-      "heading": 3.0203961806049864,
-      "angularVelocity": -0.8167375134188262,
-      "velocityX": -3.333352907265656,
-      "velocityY": -0.8071681058276496,
-      "timestamp": 0.8855053885687303
-    },
-    {
-      "x": 6.096166852667886,
-      "y": 1.841025283234324,
-      "heading": 2.970514787317599,
-      "angularVelocity": -0.8449648177976474,
-      "velocityX": -3.449608649405423,
-      "velocityY": -0.5767664067686196,
-      "timestamp": 0.944539081139979
-    },
-    {
-      "x": 5.888159130049816,
-      "y": 1.8215785590507176,
-      "heading": 2.919575403832584,
-      "angularVelocity": -0.862886620611375,
-      "velocityX": -3.5235424646192124,
-      "velocityY": -0.32941737737539917,
-      "timestamp": 1.0035727737112277
+      "x": 7.839871736672402,
+      "y": 2.659044902527838,
+      "heading": 3.397879005222776,
+      "angularVelocity": -0.04455940593353878,
+      "velocityX": -0.19688251948443478,
+      "velocityY": -0.16643770454749696,
+      "timestamp": 0.05902578417287607
+    },
+    {
+      "x": 7.816409675527677,
+      "y": 2.639664097331194,
+      "heading": 3.3925680599821177,
+      "angularVelocity": -0.08997669942179426,
+      "velocityX": -0.39748834299276414,
+      "velocityY": -0.3283447304974564,
+      "timestamp": 0.11805156834575214
+    },
+    {
+      "x": 7.78085819927372,
+      "y": 2.6110446305437054,
+      "heading": 3.3845190322360748,
+      "angularVelocity": -0.13636460504224676,
+      "velocityX": -0.602304175236922,
+      "velocityY": -0.4848638131374468,
+      "timestamp": 0.17707735251862822
+    },
+    {
+      "x": 7.732935229810911,
+      "y": 2.5735698133578784,
+      "heading": 3.373666801655185,
+      "angularVelocity": -0.18385576291719186,
+      "velocityX": -0.811898903747731,
+      "velocityY": -0.6348889338948905,
+      "timestamp": 0.2361031366915043
+    },
+    {
+      "x": 7.672319790339265,
+      "y": 2.5277086671674183,
+      "heading": 3.359937097674719,
+      "angularVelocity": -0.23260519403273167,
+      "velocityX": -1.026931540530051,
+      "velocityY": -0.7769680120833478,
+      "timestamp": 0.29512892086438036
+    },
+    {
+      "x": 7.598646839413137,
+      "y": 2.474044844547294,
+      "heading": 3.343245157116424,
+      "angularVelocity": -0.2827906616099751,
+      "velocityX": -1.2481486177354881,
+      "velocityY": -0.9091589950410944,
+      "timestamp": 0.35415470503725643
+    },
+    {
+      "x": 7.511503929455819,
+      "y": 2.4133182068213186,
+      "heading": 3.3234947258008027,
+      "angularVelocity": -0.33460684330386586,
+      "velocityX": -1.4763532781214996,
+      "velocityY": -1.0288154334064903,
+      "timestamp": 0.4131804892101325
+    },
+    {
+      "x": 7.410433762027863,
+      "y": 2.3464851163906575,
+      "heading": 3.3005783521017755,
+      "angularVelocity": -0.38824344344006334,
+      "velocityX": -1.7123053737319145,
+      "velocityY": -1.1322694203421133,
+      "timestamp": 0.4722062733830086
+    },
+    {
+      "x": 7.2949520343132965,
+      "y": 2.274805221808202,
+      "heading": 3.2743812863631283,
+      "angularVelocity": -0.4438241034108166,
+      "velocityX": -1.9564624059265545,
+      "velocityY": -1.214382758092934,
+      "timestamp": 0.5312320575558847
+    },
+    {
+      "x": 7.164600915240746,
+      "y": 2.19996078160869,
+      "heading": 3.244794267206559,
+      "angularVelocity": -0.501255842191178,
+      "velocityX": -2.208375897061781,
+      "velocityY": -1.2679956945647022,
+      "timestamp": 0.5902578417287607
+    },
+    {
+      "x": 7.019076723662156,
+      "y": 2.124198312448077,
+      "heading": 3.2117455235213295,
+      "angularVelocity": -0.5599035090907978,
+      "velocityX": -2.4654342778805964,
+      "velocityY": -1.2835487104875807,
+      "timestamp": 0.6492836259016368
+    },
+    {
+      "x": 6.858481968394699,
+      "y": 2.050426351752548,
+      "heading": 3.175264297565607,
+      "angularVelocity": -0.6180557610022694,
+      "velocityX": -2.7207559800832732,
+      "velocityY": -1.2498260163636987,
+      "timestamp": 0.7083094100745129
+    },
+    {
+      "x": 6.683688673153273,
+      "y": 1.9820972458441994,
+      "heading": 3.135565218611889,
+      "angularVelocity": -0.6725718177236996,
+      "velocityX": -2.9613040756813716,
+      "velocityY": -1.157614538558684,
+      "timestamp": 0.7673351942473889
+    },
+    {
+      "x": 6.4965769519072785,
+      "y": 1.922697862826189,
+      "heading": 3.0930877819878293,
+      "angularVelocity": -0.7196420550661587,
+      "velocityX": -3.169999752955046,
+      "velocityY": -1.0063294177344664,
+      "timestamp": 0.826360978420265
+    },
+    {
+      "x": 6.299795589898969,
+      "y": 1.8750576451758807,
+      "heading": 3.0484322857695423,
+      "angularVelocity": -0.7565421932811351,
+      "velocityX": -3.3338203763963823,
+      "velocityY": -0.8071085936068,
+      "timestamp": 0.8853867625931411
+    },
+    {
+      "x": 6.0961549426702675,
+      "y": 1.8410176211789118,
+      "heading": 3.0022319656530985,
+      "angularVelocity": -0.7827142114898721,
+      "velocityX": -3.450028662597266,
+      "velocityY": -0.5766975309853047,
+      "timestamp": 0.9444125467660172
+    },
+    {
+      "x": 5.8881524104280425,
+      "y": 1.8215766031247145,
+      "heading": 2.955050627350933,
+      "angularVelocity": -0.7993343750246449,
+      "velocityX": -3.5239266221863828,
+      "velocityY": -0.3293648415963126,
+      "timestamp": 1.0034383309388932
     },
     {
       "x": 5.677816390991211,
       "y": 1.8171948194503784,
-      "heading": 2.868072689693009,
-      "angularVelocity": -0.8724291484462967,
-      "velocityX": -3.563096426752226,
-      "velocityY": -0.07425826522791971,
-      "timestamp": 1.0626064662824755
-    },
-    {
-      "x": 5.442365912429816,
-      "y": 1.831235505391545,
-      "heading": 2.810430444000349,
-      "angularVelocity": -0.8757353156168458,
-      "velocityX": -3.5771038528666774,
-      "velocityY": 0.21331446036513985,
-      "timestamp": 1.1284280046682573
-    },
-    {
-      "x": 5.207967241132597,
-      "y": 1.8641978412146734,
-      "heading": 2.753052044025448,
-      "angularVelocity": -0.8717268143841358,
-      "velocityX": -3.5611241706840544,
-      "velocityY": 0.5007834309483129,
-      "timestamp": 1.1942495430540392
-    },
-    {
-      "x": 4.977322209976329,
-      "y": 1.915733472956131,
-      "heading": 2.6965967084381495,
-      "angularVelocity": -0.8577030706333759,
-      "velocityX": -3.504096634819568,
-      "velocityY": 0.7829600007129153,
-      "timestamp": 1.260071081439821
-    },
-    {
-      "x": 4.754056144303332,
-      "y": 1.9847152153370575,
-      "heading": 2.6419511097713526,
-      "angularVelocity": -0.8302084698555116,
-      "velocityX": -3.3919909979074836,
-      "velocityY": 1.048011700617232,
-      "timestamp": 1.325892619825603
-    },
-    {
-      "x": 4.542560603740239,
-      "y": 2.0685214884350387,
-      "heading": 2.5901946725019775,
-      "angularVelocity": -0.7863146097562858,
-      "velocityX": -3.2131661724997835,
-      "velocityY": 1.2732347975033529,
-      "timestamp": 1.3917141582113848
-    },
-    {
-      "x": 4.346947756601267,
-      "y": 2.162593065499909,
-      "heading": 2.5423282505574454,
-      "angularVelocity": -0.7272151809030252,
-      "velocityX": -2.971866837758739,
-      "velocityY": 1.4291914071274503,
-      "timestamp": 1.4575356965971666
-    },
-    {
-      "x": 4.169641642267927,
-      "y": 2.26135754407989,
-      "heading": 2.4989196149597426,
-      "angularVelocity": -0.6594898366440953,
-      "velocityX": -2.6937400535086446,
-      "velocityY": 1.5004887610058348,
-      "timestamp": 1.5233572349829485
-    },
-    {
-      "x": 4.011229101161916,
-      "y": 2.3598659918928777,
-      "heading": 2.4601095427398985,
-      "angularVelocity": -0.5896257239139054,
-      "velocityX": -2.4066976401789413,
-      "velocityY": 1.4965989891580096,
-      "timestamp": 1.5891787733687304
-    },
-    {
-      "x": 3.8713053457808018,
-      "y": 2.454465693871717,
-      "heading": 2.42581281294347,
-      "angularVelocity": -0.5210563386624898,
-      "velocityX": -2.125804999588662,
-      "velocityY": 1.437214995255607,
-      "timestamp": 1.6550003117545122
-    },
-    {
-      "x": 3.7491504704503686,
-      "y": 2.542621118074636,
-      "heading": 2.3958642561820227,
-      "angularVelocity": -0.45499630509875777,
-      "velocityX": -1.8558495946186861,
-      "velocityY": 1.3393096904881925,
-      "timestamp": 1.720821850140294
-    },
-    {
-      "x": 3.6440254618022103,
-      "y": 2.6225670711356144,
-      "heading": 2.370088465420997,
-      "angularVelocity": -0.39160115963794145,
-      "velocityX": -1.5971217207354962,
-      "velocityY": 1.2145865171429433,
-      "timestamp": 1.786643388526076
-    },
-    {
-      "x": 3.555266392414835,
-      "y": 2.6930420764383802,
-      "heading": 2.3483250557484934,
-      "angularVelocity": -0.33064267724869734,
-      "velocityX": -1.3484806275288594,
-      "velocityY": 1.0706982399850524,
-      "timestamp": 1.8524649269118578
-    },
-    {
-      "x": 3.482301944919266,
-      "y": 2.753116019704283,
-      "heading": 2.330434726775575,
-      "angularVelocity": -0.2718005293048944,
-      "velocityX": -1.1085193279427956,
-      "velocityY": 0.9126791129342325,
-      "timestamp": 1.9182864652976397
-    },
-    {
-      "x": 3.4246464401914216,
-      "y": 2.8020823678924462,
-      "heading": 2.316298479297474,
-      "angularVelocity": -0.21476628812970447,
-      "velocityX": -0.8759367547735366,
-      "velocityY": 0.743925915270608,
-      "timestamp": 1.9841080036834216
-    },
-    {
-      "x": 3.381886982990636,
-      "y": 2.8393900377748,
-      "heading": 2.3058148947987087,
-      "angularVelocity": -0.1592728574242708,
-      "velocityX": -0.6496271319301332,
-      "velocityY": 0.5668003331020922,
-      "timestamp": 2.0499295420692034
-    },
-    {
-      "x": 3.3536707768732223,
-      "y": 2.864599234964658,
-      "heading": 2.298897214798888,
-      "angularVelocity": -0.10509751320723953,
-      "velocityX": -0.4286774027072638,
-      "velocityY": 0.38299313276614483,
-      "timestamp": 2.1157510804549853
+      "heading": 2.907346545445461,
+      "angularVelocity": -0.8081905657662355,
+      "velocityX": -3.563459975742036,
+      "velocityY": -0.0742350776993099,
+      "timestamp": 1.0624641151117693
+    },
+    {
+      "x": 5.442371655977857,
+      "y": 1.8312329857861205,
+      "heading": 2.8539540674037878,
+      "angularVelocity": -0.8112707617342358,
+      "velocityX": -3.5774595322493767,
+      "velocityY": 0.21330259081926167,
+      "timestamp": 1.1282775038841404
+    },
+    {
+      "x": 5.207978052246513,
+      "y": 1.8641881677109164,
+      "heading": 2.8008045056785926,
+      "angularVelocity": -0.8075797754317682,
+      "velocityX": -3.5614881425121783,
+      "velocityY": 0.500736742773998,
+      "timestamp": 1.1940908926565115
+    },
+    {
+      "x": 4.977335594971118,
+      "y": 1.9157126949064627,
+      "heading": 2.748508031198271,
+      "angularVelocity": -0.7946175611956366,
+      "velocityX": -3.5044914352172007,
+      "velocityY": 0.782888226189873,
+      "timestamp": 1.2599042814288826
+    },
+    {
+      "x": 4.754067600876142,
+      "y": 1.9846814915867437,
+      "heading": 2.6978851936191504,
+      "angularVelocity": -0.7691875243532816,
+      "velocityX": -3.392440326499412,
+      "velocityY": 1.0479447718278632,
+      "timestamp": 1.3257176702012536
+    },
+    {
+      "x": 4.542564948081897,
+      "y": 2.068476988403223,
+      "heading": 2.649933573452933,
+      "angularVelocity": -0.7285997737036102,
+      "velocityX": -3.2136721226401024,
+      "velocityY": 1.2732287210783588,
+      "timestamp": 1.3915310589736247
+    },
+    {
+      "x": 4.346942427891662,
+      "y": 2.1625437031056833,
+      "heading": 2.6055779926025404,
+      "angularVelocity": -0.6739598382299568,
+      "velocityX": -2.9723818183384134,
+      "velocityY": 1.4292945015764016,
+      "timestamp": 1.4573444477459958
+    },
+    {
+      "x": 4.1696279422067075,
+      "y": 2.2613093610310995,
+      "heading": 2.565350469760314,
+      "angularVelocity": -0.6112361571497512,
+      "velocityX": -2.6942008152510084,
+      "velocityY": 1.5006924847315846,
+      "timestamp": 1.523157836518367
+    },
+    {
+      "x": 4.011210200789988,
+      "y": 2.3598229084456155,
+      "heading": 2.5293884262899673,
+      "angularVelocity": -0.546424430365192,
+      "velocityX": -2.4070746754074355,
+      "velocityY": 1.496861797456512,
+      "timestamp": 1.588971225290738
+    },
+    {
+      "x": 3.871284494174842,
+      "y": 2.4544295481535148,
+      "heading": 2.497613892197236,
+      "angularVelocity": -0.48279741683914584,
+      "velocityX": -2.1260978841115015,
+      "velocityY": 1.4374983794728338,
+      "timestamp": 1.654784614063109
+    },
+    {
+      "x": 3.749130246258036,
+      "y": 2.5425923526977727,
+      "heading": 2.469872126114301,
+      "angularVelocity": -0.4215216174156515,
+      "velocityX": -1.8560698696020823,
+      "velocityY": 1.3395876764405317,
+      "timestamp": 1.7205980028354801
+    },
+    {
+      "x": 3.6440076258991128,
+      "y": 2.622545326222263,
+      "heading": 2.4459987512831027,
+      "angularVelocity": -0.362743436806896,
+      "velocityX": -1.5972832020929764,
+      "velocityY": 1.2148435905803896,
+      "timestamp": 1.7864113916078512
+    },
+    {
+      "x": 3.5552519630245114,
+      "y": 2.6930265682484116,
+      "heading": 2.4258437576324656,
+      "angularVelocity": -0.3062445807242533,
+      "velocityX": -1.3485958485070668,
+      "velocityY": 1.070925587343959,
+      "timestamp": 1.8522247803802223
+    },
+    {
+      "x": 3.4822913234359776,
+      "y": 2.753105759149151,
+      "heading": 2.409277081736245,
+      "angularVelocity": -0.2517219703352401,
+      "velocityX": -1.1085987357509106,
+      "velocityY": 0.9128718642423238,
+      "timestamp": 1.9180381691525934
+    },
+    {
+      "x": 3.4246395297726133,
+      "y": 2.8020762823137697,
+      "heading": 2.3961877488562684,
+      "angularVelocity": -0.19888556301588897,
+      "velocityX": -0.8759888335603617,
+      "velocityY": 0.7440814715375484,
+      "timestamp": 1.9838515579249645
+    },
+    {
+      "x": 3.3818832860452783,
+      "y": 2.8393870378309063,
+      "heading": 2.386481246318591,
+      "angularVelocity": -0.14748522631541322,
+      "velocityX": -0.6496587476328872,
+      "velocityY": 0.5669174040890574,
+      "timestamp": 2.0496649466973356
+    },
+    {
+      "x": 3.3536694716552815,
+      "y": 2.864598250774754,
+      "heading": 2.380076747643575,
+      "angularVelocity": -0.09731300567377486,
+      "velocityX": -0.4286941444024425,
+      "velocityY": 0.3830711867921795,
+      "timestamp": 2.1154783354697066
     },
     {
       "x": 3.3396942615509033,
       "y": 2.877351999282837,
-      "heading": 2.2954707540735027,
-      "angularVelocity": -0.05205683138706078,
-      "velocityX": -0.21233954211768968,
-      "velocityY": 0.19374758826563127,
-      "timestamp": 2.181572618840767
+      "heading": 2.3769046726239993,
+      "angularVelocity": -0.048198019867158104,
+      "velocityX": -0.2123460038308339,
+      "velocityY": 0.19378653410774088,
+      "timestamp": 2.1812917242420777
     },
     {
       "x": 3.3396942615509033,
       "y": 2.877351999282837,
-      "heading": 2.2954707540735027,
-      "angularVelocity": -2.2138058328679337e-25,
-      "velocityX": 3.908937921937773e-26,
-      "velocityY": -5.142843079725612e-27,
-      "timestamp": 2.247394157226549
+      "heading": 2.3769046726239993,
+      "angularVelocity": 8.699347294583009e-29,
+      "velocityX": 8.966370263182221e-27,
+      "velocityY": 9.299144171685505e-27,
+      "timestamp": 2.247105113014449
     }
   ],
   "eventMarkers": []
diff --git a/src/main/deploy/choreo/543.5.traj b/src/main/deploy/choreo/543.5.traj
index ce02deb..b1ff5ae 100644
--- a/src/main/deploy/choreo/543.5.traj
+++ b/src/main/deploy/choreo/543.5.traj
@@ -3,380 +3,380 @@
     {
       "x": 3.3396942615509033,
       "y": 2.877351999282837,
-      "heading": 2.2954707540735027,
-      "angularVelocity": -2.2138058328679337e-25,
-      "velocityX": 3.908937921937773e-26,
-      "velocityY": -5.142843079725612e-27,
+      "heading": 2.3769046726239993,
+      "angularVelocity": 8.699347294583009e-29,
+      "velocityX": 8.966370263182221e-27,
+      "velocityY": 9.299144171685505e-27,
       "timestamp": 0
     },
     {
-      "x": 3.3516645476191473,
-      "y": 2.8617630229365867,
-      "heading": 2.298537948781302,
-      "angularVelocity": 0.04572936123680092,
-      "velocityX": 0.1784671623000002,
-      "velocityY": -0.23241887084535387,
-      "timestamp": 0.06707276517414407
-    },
-    {
-      "x": 3.376003702841053,
-      "y": 2.8309022396479997,
-      "heading": 2.3048120923274715,
-      "angularVelocity": 0.09354234210979048,
-      "velocityX": 0.3628768719868968,
-      "velocityY": -0.4601090056219035,
-      "timestamp": 0.13414553034828813
-    },
-    {
-      "x": 3.413188351414955,
-      "y": 2.7851720067926857,
-      "heading": 2.3144615113821967,
-      "angularVelocity": 0.14386493578536452,
-      "velocityX": 0.5543926581431038,
-      "velocityY": -0.6818003214357108,
-      "timestamp": 0.2012182955224322
-    },
-    {
-      "x": 3.463795860207917,
-      "y": 2.725096311990658,
-      "heading": 2.3276920106910532,
-      "angularVelocity": 0.1972559096751932,
-      "velocityX": 0.7545165114568831,
-      "velocityY": -0.8956794109509365,
-      "timestamp": 0.26829106069657627
-    },
-    {
-      "x": 3.5285345689846737,
-      "y": 2.6513792453542453,
-      "heading": 2.344759157342521,
-      "angularVelocity": 0.254457179559477,
-      "velocityX": 0.9652011305732239,
-      "velocityY": -1.099061093500722,
-      "timestamp": 0.33536382587072033
-    },
-    {
-      "x": 3.608282029663586,
-      "y": 2.5650027653656142,
-      "heading": 2.365984707549641,
-      "angularVelocity": 0.31645557108032524,
-      "velocityX": 1.1889693301276525,
-      "velocityY": -1.2878025792490757,
-      "timestamp": 0.4024365910448644
-    },
-    {
-      "x": 3.7041249846999373,
-      "y": 2.467396548832097,
-      "heading": 2.391775895173838,
-      "angularVelocity": 0.3845254859738355,
-      "velocityX": 1.4289399697106506,
-      "velocityY": -1.4552287546233942,
-      "timestamp": 0.46950935621900847
-    },
-    {
-      "x": 3.817367854577491,
-      "y": 2.360738630218002,
-      "heading": 2.4226367432261977,
-      "angularVelocity": 0.46010997119671315,
-      "velocityX": 1.6883584504610083,
-      "velocityY": -1.590182219820124,
-      "timestamp": 0.5365821213931525
-    },
-    {
-      "x": 3.949385432841112,
-      "y": 2.2484593214367075,
-      "heading": 2.459128147951867,
-      "angularVelocity": 0.5440569600928907,
-      "velocityX": 1.968273977088275,
-      "velocityY": -1.6739925436170393,
-      "timestamp": 0.6036548865672966
-    },
-    {
-      "x": 4.100985215141024,
-      "y": 2.135844091585944,
-      "heading": 2.5016794738291117,
-      "angularVelocity": 0.6344054217351344,
-      "velocityX": 2.2602286025677487,
-      "velocityY": -1.679000851662739,
-      "timestamp": 0.6707276517414407
-    },
-    {
-      "x": 4.271035246020557,
-      "y": 2.029803920822179,
-      "heading": 2.55023405409309,
-      "angularVelocity": 0.7239090283204185,
-      "velocityX": 2.535306699194872,
-      "velocityY": -1.5809721052717514,
-      "timestamp": 0.7378004169155847
-    },
-    {
-      "x": 4.455854041914051,
-      "y": 1.9366653659853252,
-      "heading": 2.60397591092134,
-      "angularVelocity": 0.801247073811809,
-      "velocityX": 2.7554968907818176,
-      "velocityY": -1.3886195774847423,
-      "timestamp": 0.8048731820897288
-    },
-    {
-      "x": 4.650909282787146,
-      "y": 1.8602874196738752,
-      "heading": 2.6616516476615515,
-      "angularVelocity": 0.8598980016772068,
-      "velocityX": 2.908113902366535,
-      "velocityY": -1.1387326303477394,
-      "timestamp": 0.8719459472638729
-    },
-    {
-      "x": 4.852413526913252,
-      "y": 1.8024799152254807,
-      "heading": 2.722142252767918,
-      "angularVelocity": 0.9018653838008867,
-      "velocityX": 3.0042632595052488,
-      "velocityY": -0.8618625502960255,
-      "timestamp": 0.9390187124380169
-    },
-    {
-      "x": 5.057594824272398,
-      "y": 1.763994130666435,
-      "heading": 2.7846105473763534,
-      "angularVelocity": 0.9313511146624962,
-      "velocityX": 3.059085111914244,
-      "velocityY": -0.5737915301258724,
-      "timestamp": 1.006091477612161
-    },
-    {
-      "x": 5.264464307067692,
-      "y": 1.7451094274340988,
-      "heading": 2.848447740477815,
-      "angularVelocity": 0.9517602701441944,
-      "velocityX": 3.0842545742402043,
-      "velocityY": -0.28155545970566304,
-      "timestamp": 1.073164242786305
-    },
-    {
-      "x": 5.471568697214922,
-      "y": 1.745899571938889,
-      "heading": 2.913204372628034,
-      "angularVelocity": 0.9654683533933353,
-      "velocityX": 3.087756850481914,
-      "velocityY": 0.01178040748340537,
-      "timestamp": 1.1402370079604491
+      "x": 3.3516625830764935,
+      "y": 2.861762565335628,
+      "heading": 2.3798027568533566,
+      "angularVelocity": 0.04321176422934021,
+      "velocityX": 0.1784531597618389,
+      "velocityY": -0.23244560574593578,
+      "timestamp": 0.06706701938796122
+    },
+    {
+      "x": 3.3759979879487325,
+      "y": 2.8309006486888566,
+      "heading": 2.3857310557967786,
+      "angularVelocity": 0.08839365454917242,
+      "velocityX": 0.3628520410526427,
+      "velocityY": -0.4601653231112726,
+      "timestamp": 0.13413403877592245
+    },
+    {
+      "x": 3.4131773512442836,
+      "y": 2.7851683566473224,
+      "heading": 2.3948487463537145,
+      "angularVelocity": 0.13594894540031874,
+      "velocityX": 0.5543613483175733,
+      "velocityY": -0.6818894362516296,
+      "timestamp": 0.20120105816388367
+    },
+    {
+      "x": 3.463778400038,
+      "y": 2.7250893961159655,
+      "heading": 2.407350522660198,
+      "angularVelocity": 0.18640721505998045,
+      "velocityX": 0.7544848310762926,
+      "velocityY": -0.895804839392364,
+      "timestamp": 0.2682680775518449
+    },
+    {
+      "x": 3.5285100034686807,
+      "y": 2.6513675596934068,
+      "heading": 2.423478332665211,
+      "angularVelocity": 0.2404730395385411,
+      "velocityX": 0.9651778776126764,
+      "velocityY": -1.0992263722963704,
+      "timestamp": 0.3353350969398061
+    },
+    {
+      "x": 3.608250506819797,
+      "y": 2.5649845398562943,
+      "heading": 2.443537205147885,
+      "angularVelocity": 0.29908698292732966,
+      "velocityX": 1.1889674549251013,
+      "velocityY": -1.2880104204037197,
+      "timestamp": 0.40240211632776735
+    },
+    {
+      "x": 3.704087845598115,
+      "y": 2.4673699165153473,
+      "heading": 2.467914194177291,
+      "angularVelocity": 0.36347207989657143,
+      "velocityX": 1.4289786493109158,
+      "velocityY": -1.4554787767781576,
+      "timestamp": 0.46946913571572857
+    },
+    {
+      "x": 3.8173281503467877,
+      "y": 2.3607021391611296,
+      "heading": 2.4970905528957617,
+      "angularVelocity": 0.43503288180580346,
+      "velocityX": 1.6884648487748337,
+      "velocityY": -1.5904654527313735,
+      "timestamp": 0.5365361551036898
+    },
+    {
+      "x": 3.949348217986618,
+      "y": 2.248413089529829,
+      "heading": 2.531605230749573,
+      "angularVelocity": 0.5146296669925818,
+      "velocityX": 1.9684797213983332,
+      "velocityY": -1.674281198956299,
+      "timestamp": 0.603603174491651
+    },
+    {
+      "x": 4.100956630482294,
+      "y": 2.1357913846970256,
+      "heading": 2.5718681396894523,
+      "angularVelocity": 0.6003384272524676,
+      "velocityX": 2.2605509217380098,
+      "velocityY": -1.6792412404869688,
+      "timestamp": 0.6706701938796122
+    },
+    {
+      "x": 4.271019524465303,
+      "y": 2.02975174701908,
+      "heading": 2.617805882913228,
+      "angularVelocity": 0.6849528075497259,
+      "velocityX": 2.5357156995340735,
+      "velocityY": -1.5810996022432426,
+      "timestamp": 0.7377372132675735
+    },
+    {
+      "x": 4.455850074444798,
+      "y": 1.936621120126799,
+      "heading": 2.6686369840979474,
+      "angularVelocity": 0.7579150176732569,
+      "velocityX": 2.755908219363514,
+      "velocityY": -1.3886203344381607,
+      "timestamp": 0.8048042326555347
+    },
+    {
+      "x": 4.650912904466248,
+      "y": 1.8602546060912546,
+      "heading": 2.7231836593037944,
+      "angularVelocity": 0.8133159294035703,
+      "velocityX": 2.908476204870152,
+      "velocityY": -1.138659727723825,
+      "timestamp": 0.8718712520434959
+    },
+    {
+      "x": 4.852420678438731,
+      "y": 1.8024586285174926,
+      "heading": 2.7803910249763573,
+      "angularVelocity": 0.8529880438198227,
+      "velocityX": 3.004573273292882,
+      "velocityY": -0.8617645170636102,
+      "timestamp": 0.9389382714314571
+    },
+    {
+      "x": 5.05760246636137,
+      "y": 1.7639825860583975,
+      "heading": 2.839468056705675,
+      "angularVelocity": 0.8808656217085786,
+      "velocityX": 3.059354505315471,
+      "velocityY": -0.5736954289935475,
+      "timestamp": 1.0060052908194184
+    },
+    {
+      "x": 5.264470410929027,
+      "y": 1.7451049209511764,
+      "heading": 2.8998392064876755,
+      "angularVelocity": 0.9001615150477019,
+      "velocityX": 3.0844958737616186,
+      "velocityY": -0.2814746395395884,
+      "timestamp": 1.0730723102073796
+    },
+    {
+      "x": 5.4715720463226285,
+      "y": 1.745898973757099,
+      "heading": 2.9610795307026567,
+      "angularVelocity": 0.9131213042393547,
+      "velocityX": 3.0879803110912887,
+      "velocityY": 0.011839691299369801,
+      "timestamp": 1.1401393295953408
     },
     {
       "x": 5.677816390991211,
       "y": 1.7663486003875732,
-      "heading": 2.9785400944393525,
-      "angularVelocity": 0.9741021059991204,
-      "velocityX": 3.0749842091763746,
-      "velocityY": 0.3048782675888085,
-      "timestamp": 1.2073097731345932
-    },
-    {
-      "x": 5.869498283497575,
-      "y": 1.8026990212845277,
-      "heading": 3.040009892901514,
-      "angularVelocity": 0.978495765710481,
-      "velocityX": 3.051253214963835,
-      "velocityY": 0.5786375393984518,
-      "timestamp": 1.2701304828568567
-    },
-    {
-      "x": 6.059212183017009,
-      "y": 1.856199315511381,
-      "heading": 3.101605164447669,
-      "angularVelocity": 0.9804930860933324,
-      "velocityX": 3.019926077852052,
-      "velocityY": 0.8516346673475012,
-      "timestamp": 1.3329511925791202
-    },
-    {
-      "x": 6.246366657416464,
-      "y": 1.9267712723501649,
-      "heading": 3.1631385311618336,
-      "angularVelocity": 0.9795076653258243,
-      "velocityX": 2.9791843362942707,
-      "velocityY": 1.12338681225969,
-      "timestamp": 1.3957719023013837
-    },
-    {
-      "x": 6.430212631499626,
-      "y": 2.014285410480658,
-      "heading": 3.2243713465018264,
-      "angularVelocity": 0.9747233931407323,
-      "velocityX": 2.92651857796523,
-      "velocityY": 1.3930778324123159,
-      "timestamp": 1.4585926120236472
-    },
-    {
-      "x": 6.609777595601999,
-      "y": 2.118521635924677,
-      "heading": 3.284991437728681,
-      "angularVelocity": 0.9649698561965084,
-      "velocityX": 2.858372102070309,
-      "velocityY": 1.6592653267506663,
-      "timestamp": 1.5214133217459107
-    },
-    {
-      "x": 6.783764646274751,
-      "y": 2.239091051762057,
-      "heading": 3.3445780348502288,
-      "angularVelocity": 0.9485183689421323,
-      "velocityX": 2.7695811053706194,
-      "velocityY": 1.9192622364572296,
-      "timestamp": 1.5842340314681742
-    },
-    {
-      "x": 6.950401684609891,
-      "y": 2.3752716608654083,
-      "heading": 3.402547014524198,
-      "angularVelocity": 0.9227686208935938,
-      "velocityX": 2.6525812756949354,
-      "velocityY": 2.167766166689632,
-      "timestamp": 1.6470547411904377
-    },
-    {
-      "x": 7.107252334800024,
-      "y": 2.525651797665975,
-      "heading": 3.4580758800306346,
-      "angularVelocity": 0.8839261089525424,
-      "velocityX": 2.496798442481599,
-      "velocityY": 2.3937987562606944,
-      "timestamp": 1.7098754509127012
-    },
-    {
-      "x": 7.25116745034712,
-      "y": 2.6874080724763414,
-      "heading": 3.510064675427793,
-      "angularVelocity": 0.8275741491461444,
-      "velocityX": 2.290886495605672,
-      "velocityY": 2.5748877324931376,
-      "timestamp": 1.7726961606349647
-    },
-    {
-      "x": 7.379049043556767,
-      "y": 2.855386112012741,
-      "heading": 3.557350238869835,
-      "angularVelocity": 0.7527066098281388,
-      "velocityX": 2.0356597971437416,
-      "velocityY": 2.673927758521817,
-      "timestamp": 1.8355168703572282
-    },
-    {
-      "x": 7.48976542528158,
-      "y": 3.0226940652081797,
-      "heading": 3.5992337594928014,
-      "angularVelocity": 0.666715177337827,
-      "velocityX": 1.7624185115752826,
-      "velocityY": 2.6632611114252915,
-      "timestamp": 1.8983375800794917
-    },
-    {
-      "x": 7.584603731721159,
-      "y": 3.183437719649434,
-      "heading": 3.6358032566417093,
-      "angularVelocity": 0.5821248647235219,
-      "velocityX": 1.5096662686376792,
-      "velocityY": 2.558768519997944,
-      "timestamp": 1.9611582898017552
-    },
-    {
-      "x": 7.665647899394972,
-      "y": 3.3339132583126054,
-      "heading": 3.66757214697857,
-      "angularVelocity": 0.5057072815209269,
-      "velocityX": 1.2900867887694702,
-      "velocityY": 2.3953173933952745,
-      "timestamp": 2.0239789995240187
-    },
-    {
-      "x": 7.734758840021845,
-      "y": 3.4719883665738904,
-      "heading": 3.695057946928366,
-      "angularVelocity": 0.4375276890584947,
-      "velocityX": 1.1001298923940959,
-      "velocityY": 2.1979234057006147,
-      "timestamp": 2.086799709246282
-    },
-    {
-      "x": 7.793387895501397,
-      "y": 3.596402025341782,
-      "heading": 3.7186750616098347,
-      "angularVelocity": 0.37594472883039054,
-      "velocityX": 0.9332759171100913,
-      "velocityY": 1.9804561157926779,
-      "timestamp": 2.1496204189685457
-    },
-    {
-      "x": 7.842641745167335,
-      "y": 3.706364225843829,
-      "heading": 3.7387425543728092,
-      "angularVelocity": 0.3194407202926423,
-      "velocityX": 0.7840384147790729,
-      "velocityY": 1.7504132154539842,
-      "timestamp": 2.2124411286908092
-    },
-    {
-      "x": 7.883372973162177,
-      "y": 3.801350711025084,
-      "heading": 3.755507752795704,
-      "angularVelocity": 0.26687375066304414,
-      "velocityX": 0.6483726174842498,
-      "velocityY": 1.5120250248875047,
-      "timestamp": 2.2752618384130727
-    },
-    {
-      "x": 7.916250955707456,
-      "y": 3.8809958185462916,
-      "heading": 3.7691658139622635,
-      "angularVelocity": 0.21741335344575932,
-      "velocityX": 0.5233621633795045,
-      "velocityY": 1.2678161051240537,
-      "timestamp": 2.3380825481353362
-    },
-    {
-      "x": 7.941811781791086,
-      "y": 3.9450337141673115,
-      "heading": 3.7798737136826723,
-      "angularVelocity": 0.1704517470074654,
-      "velocityX": 0.4068853439675645,
-      "velocityY": 1.0193755515360785,
-      "timestamp": 2.4009032578575997
-    },
-    {
-      "x": 7.960492791122214,
-      "y": 3.993264403965962,
-      "heading": 3.7877599997554308,
-      "angularVelocity": 0.12553640523363524,
-      "velocityX": 0.2973702368807853,
-      "velocityY": 0.7677514312061038,
-      "timestamp": 2.4637239675798632
-    },
-    {
-      "x": 7.972656678308661,
-      "y": 4.025533086521562,
-      "heading": 3.7929316378195392,
-      "angularVelocity": 0.08232377645800033,
-      "velocityX": 0.19362861769987666,
-      "velocityY": 0.5136631327195069,
-      "timestamp": 2.5265446773021267
+      "heading": 3.022867248231808,
+      "angularVelocity": 0.9212831894575391,
+      "velocityX": 3.0751977134323645,
+      "velocityY": 0.30491330637760916,
+      "timestamp": 1.207206348983302
+    },
+    {
+      "x": 5.869498315560729,
+      "y": 1.8026975491019477,
+      "heading": 3.0809998241533054,
+      "angularVelocity": 0.9254361464923138,
+      "velocityX": 3.051462606188219,
+      "velocityY": 0.5786537151338974,
+      "timestamp": 1.2700227584588095
+    },
+    {
+      "x": 6.0592123423789275,
+      "y": 1.8561940082480726,
+      "heading": 3.1392509157059085,
+      "angularVelocity": 0.9273228450810435,
+      "velocityX": 3.0201348405971915,
+      "velocityY": 0.8516319158130763,
+      "timestamp": 1.332839167934317
+    },
+    {
+      "x": 6.246367362862811,
+      "y": 1.9267598042730498,
+      "heading": 3.197443332957825,
+      "angularVelocity": 0.9263887849974373,
+      "velocityX": 2.9793969767860897,
+      "velocityY": 1.1233656398729925,
+      "timestamp": 1.3956555774098245
+    },
+    {
+      "x": 6.430214724431651,
+      "y": 2.014265565864972,
+      "heading": 3.25535141192564,
+      "angularVelocity": 0.9218622880760795,
+      "velocityX": 2.9267410077063314,
+      "velocityY": 1.393039849341311,
+      "timestamp": 1.458471986885332
+    },
+    {
+      "x": 6.609782474245099,
+      "y": 2.11849145104989,
+      "heading": 3.312679976603456,
+      "angularVelocity": 0.9126367641271997,
+      "velocityX": 2.8586121256017254,
+      "velocityY": 1.6592143049111507,
+      "timestamp": 1.5212883963608395
+    },
+    {
+      "x": 6.783774433001653,
+      "y": 2.2390490978953044,
+      "heading": 3.3690311941233704,
+      "angularVelocity": 0.8970779767647533,
+      "velocityX": 2.7698488374187553,
+      "velocityY": 1.9192062687444857,
+      "timestamp": 1.584104805836347
+    },
+    {
+      "x": 6.9504193672294985,
+      "y": 2.3752176143671733,
+      "heading": 3.4238528114702502,
+      "angularVelocity": 0.8727276487882547,
+      "velocityX": 2.652888562387848,
+      "velocityY": 2.1677220587553996,
+      "timestamp": 1.6469212153118544
+    },
+    {
+      "x": 7.107281588598214,
+      "y": 2.52558752514108,
+      "heading": 3.476367044923788,
+      "angularVelocity": 0.8359954650705317,
+      "velocityX": 2.4971535730624357,
+      "velocityY": 2.393799837167353,
+      "timestamp": 1.709737624787362
+    },
+    {
+      "x": 7.251211218612922,
+      "y": 2.6873391007207674,
+      "heading": 3.5255323995870227,
+      "angularVelocity": 0.7826833000126306,
+      "velocityX": 2.2912743854108286,
+      "velocityY": 2.5749891935920948,
+      "timestamp": 1.7725540342628694
+    },
+    {
+      "x": 7.379106119935948,
+      "y": 2.855321266683036,
+      "heading": 3.570245943801856,
+      "angularVelocity": 0.7118131167982105,
+      "velocityX": 2.036011010353802,
+      "velocityY": 2.6741764988616117,
+      "timestamp": 1.8353704437383769
+    },
+    {
+      "x": 7.489828992967153,
+      "y": 3.0226403080656628,
+      "heading": 3.6098523077969857,
+      "angularVelocity": 0.6305098353412365,
+      "velocityX": 1.7626424998770196,
+      "velocityY": 2.6636199486674914,
+      "timestamp": 1.8981868532138844
+    },
+    {
+      "x": 7.5846664001825115,
+      "y": 3.1833964842133824,
+      "heading": 3.6444385665610812,
+      "angularVelocity": 0.5505927360840481,
+      "velocityX": 1.5097553013171952,
+      "velocityY": 2.5591430247282747,
+      "timestamp": 1.9610032626893918
+    },
+    {
+      "x": 7.6657049690486385,
+      "y": 3.333883053307194,
+      "heading": 3.6744875788552074,
+      "angularVelocity": 0.4783624620544796,
+      "velocityX": 1.2900859750305362,
+      "velocityY": 2.3956569684628017,
+      "timestamp": 2.0238196721648993
+    },
+    {
+      "x": 7.7348079326686,
+      "y": 3.471967025062567,
+      "heading": 3.7004866328547554,
+      "angularVelocity": 0.4138895269027619,
+      "velocityX": 1.1000782151820558,
+      "velocityY": 2.1982149713477863,
+      "timestamp": 2.086636081640407
+    },
+    {
+      "x": 7.793428112313008,
+      "y": 3.5963874907480546,
+      "heading": 3.7228267453311363,
+      "angularVelocity": 0.3556413469491874,
+      "velocityX": 0.9331985086996176,
+      "velocityY": 1.980700054720585,
+      "timestamp": 2.1494524911159143
+    },
+    {
+      "x": 7.8426730977585235,
+      "y": 3.7063547510103105,
+      "heading": 3.7418093512359456,
+      "angularVelocity": 0.30219183272820804,
+      "velocityX": 0.783950974859778,
+      "velocityY": 1.7506135925379998,
+      "timestamp": 2.212268900591422
+    },
+    {
+      "x": 7.883396045766907,
+      "y": 3.8013448757169503,
+      "heading": 3.757668265765805,
+      "angularVelocity": 0.25246451782703877,
+      "velocityX": 0.6482851908984306,
+      "velocityY": 1.5121864732443446,
+      "timestamp": 2.2750853100669293
+    },
+    {
+      "x": 7.916266704646568,
+      "y": 3.8809924971435787,
+      "heading": 3.7705880432506556,
+      "angularVelocity": 0.20567519845093782,
+      "velocityX": 0.5232814029664861,
+      "velocityY": 1.2679429163757567,
+      "timestamp": 2.3379017195424368
+    },
+    {
+      "x": 7.941821412998917,
+      "y": 3.9450320342824847,
+      "heading": 3.7807171527629357,
+      "angularVelocity": 0.16124941869257636,
+      "velocityX": 0.4068158076165283,
+      "velocityY": 1.0194714673062533,
+      "timestamp": 2.4007181290179442
+    },
+    {
+      "x": 7.960497682770524,
+      "y": 3.993263707972552,
+      "heading": 3.7881771819141687,
+      "angularVelocity": 0.11875924163003808,
+      "velocityX": 0.29731514308994755,
+      "velocityY": 0.7678196524249489,
+      "timestamp": 2.4635345384934517
+    },
+    {
+      "x": 7.972658330298564,
+      "y": 4.0255328988210515,
+      "heading": 3.7930693040909933,
+      "angularVelocity": 0.0778796849051358,
+      "velocityX": 0.19359029956625398,
+      "velocityY": 0.513706388472933,
+      "timestamp": 2.526350947968959
     },
     {
       "x": 7.97860860824585,
       "y": 4.041717052459717,
       "heading": 3.7954788959034658,
-      "angularVelocity": 0.04054806281539965,
-      "velocityX": 0.09474471019991201,
-      "velocityY": 0.2576215074567916,
-      "timestamp": 2.5893653870243902
+      "angularVelocity": 0.038359273199338115,
+      "velocityX": 0.09472489747453801,
+      "velocityY": 0.257642131630843,
+      "timestamp": 2.5891673574444667
     },
     {
       "x": 7.97860860824585,
       "y": 4.041717052459717,
       "heading": 3.7954788959034658,
-      "angularVelocity": 1.081663947501335e-26,
-      "velocityX": -9.481769134483666e-28,
-      "velocityY": -9.233714768009215e-27,
-      "timestamp": 2.6521860967466537
+      "angularVelocity": 2.7641446763079204e-28,
+      "velocityX": -4.8321001161270604e-27,
+      "velocityY": -6.381302523611655e-27,
+      "timestamp": 2.651983766919974
     }
   ],
   "eventMarkers": []
diff --git a/src/main/deploy/choreo/543.6.traj b/src/main/deploy/choreo/543.6.traj
index d712101..80e2f87 100644
--- a/src/main/deploy/choreo/543.6.traj
+++ b/src/main/deploy/choreo/543.6.traj
@@ -4,379 +4,370 @@
       "x": 7.97860860824585,
       "y": 4.041717052459717,
       "heading": 3.7954788959034658,
-      "angularVelocity": 1.081663947501335e-26,
-      "velocityX": -9.481769134483666e-28,
-      "velocityY": -9.233714768009215e-27,
+      "angularVelocity": 2.7641446763079204e-28,
+      "velocityX": -4.8321001161270604e-27,
+      "velocityY": -6.381302523611655e-27,
       "timestamp": 0
     },
     {
-      "x": 7.973189079938411,
-      "y": 4.026463842839712,
-      "heading": 3.793127862432137,
-      "angularVelocity": -0.03862699851561016,
-      "velocityX": -0.08904174034085098,
-      "velocityY": -0.25060711067509717,
-      "timestamp": 0.06086503123919407
-    },
-    {
-      "x": 7.96211997120059,
-      "y": 3.996042186549112,
-      "heading": 3.788358107501387,
-      "angularVelocity": -0.07836609681518215,
-      "velocityX": -0.1818631899541847,
-      "velocityY": -0.49982158344823596,
-      "timestamp": 0.12173006247838813
-    },
-    {
-      "x": 7.945132814358059,
-      "y": 3.9505560796650534,
-      "heading": 3.7810908608062244,
-      "angularVelocity": -0.11939937509606813,
-      "velocityX": -0.27909550848290027,
-      "velocityY": -0.7473274219691394,
-      "timestamp": 0.1825950937175822
-    },
-    {
-      "x": 7.921910586758543,
-      "y": 3.890135520000167,
-      "heading": 3.7712333978408124,
-      "angularVelocity": -0.16195609802076888,
-      "velocityX": -0.3815364442721711,
-      "velocityY": -0.9926974230480341,
-      "timestamp": 0.24346012495677627
-    },
-    {
-      "x": 7.892073849640702,
-      "y": 3.8149466158138026,
-      "heading": 3.7586751345824734,
-      "angularVelocity": -0.20632969379389762,
-      "velocityX": -0.4902114812129911,
-      "velocityY": -1.2353382994395923,
-      "timestamp": 0.30432515619597034
-    },
-    {
-      "x": 7.855161431332755,
-      "y": 3.7252072224578345,
-      "heading": 3.743282218448319,
-      "angularVelocity": -0.2529024600950483,
-      "velocityX": -0.606463474287625,
-      "velocityY": -1.4743998570098393,
-      "timestamp": 0.3651901874351644
-    },
-    {
-      "x": 7.810603011221402,
-      "y": 3.6212121261116588,
-      "heading": 3.7248899061541354,
-      "angularVelocity": -0.3021819248215532,
-      "velocityX": -0.7320857182549075,
-      "velocityY": -1.7086181380156253,
-      "timestamp": 0.42605521867435847
-    },
-    {
-      "x": 7.75767969326837,
-      "y": 3.503375512839711,
-      "heading": 3.703291696041228,
-      "angularVelocity": -0.35485416951530235,
-      "velocityX": -0.8695192769235301,
-      "velocityY": -1.9360314267951175,
-      "timestamp": 0.48692024991355254
-    },
-    {
-      "x": 7.695467478966328,
-      "y": 3.372306326826921,
-      "heading": 3.678223928018662,
-      "angularVelocity": -0.41185829551375247,
-      "velocityX": -1.0221339418615227,
-      "velocityY": -2.1534398873089917,
-      "timestamp": 0.5477852811527466
-    },
-    {
-      "x": 7.622760415809598,
-      "y": 3.2289490492757267,
-      "heading": 3.6493453622484107,
-      "angularVelocity": -0.4744689221757036,
-      "velocityX": -1.1945621595263345,
-      "velocityY": -2.3553307150671072,
-      "timestamp": 0.6086503123919407
-    },
-    {
-      "x": 7.537989170266957,
-      "y": 3.074856416210723,
-      "heading": 3.6162182235150375,
-      "angularVelocity": -0.5442721059845679,
-      "velocityX": -1.3927742057585912,
-      "velocityY": -2.5317104078930326,
-      "timestamp": 0.6695153436311347
-    },
-    {
-      "x": 7.439241543844895,
-      "y": 2.912701143314702,
-      "heading": 3.5783337834184628,
-      "angularVelocity": -0.6224335932350433,
-      "velocityX": -1.6224032816805989,
-      "velocityY": -2.664177929339482,
-      "timestamp": 0.7303803748703288
-    },
-    {
-      "x": 7.324766462909669,
-      "y": 2.746988913544774,
-      "heading": 3.5353421357377637,
-      "angularVelocity": -0.706343968045381,
-      "velocityX": -1.880802138839768,
-      "velocityY": -2.722618002423959,
-      "timestamp": 0.7912454061095229
-    },
-    {
-      "x": 7.194385716013789,
-      "y": 2.583976737212008,
-      "heading": 3.4875425161473705,
-      "angularVelocity": -0.7853379619989738,
-      "velocityX": -2.1421289735890285,
-      "velocityY": -2.6782566773381076,
-      "timestamp": 0.8521104373487169
-    },
-    {
-      "x": 7.050272925938226,
-      "y": 2.4294807954441997,
-      "heading": 3.4358824464756204,
-      "angularVelocity": -0.8487643663359049,
-      "velocityX": -2.3677436311370705,
-      "velocityY": -2.5383366872950677,
-      "timestamp": 0.912975468587911
-    },
-    {
-      "x": 6.895473593565761,
-      "y": 2.287134578977517,
-      "heading": 3.3814523385529762,
-      "angularVelocity": -0.8942755275806573,
-      "velocityX": -2.5433213328046476,
-      "velocityY": -2.3387191884823553,
-      "timestamp": 0.9738404998271051
-    },
-    {
-      "x": 6.732591084116293,
-      "y": 2.1588201874781916,
-      "heading": 3.3251409447097355,
-      "angularVelocity": -0.9251846700273916,
-      "velocityX": -2.6761262769972647,
-      "velocityY": -2.108179177548776,
-      "timestamp": 1.0347055310662991
-    },
-    {
-      "x": 6.563562240961557,
-      "y": 2.0454941987485715,
-      "heading": 3.26759140242196,
-      "angularVelocity": -0.9455271954369048,
-      "velocityX": -2.7771092811973754,
-      "velocityY": -1.8619227891998904,
-      "timestamp": 1.0955705623054932
-    },
-    {
-      "x": 6.389800863403908,
-      "y": 1.9476641851905458,
-      "heading": 3.209264282654608,
-      "angularVelocity": -0.9583026342027352,
-      "velocityX": -2.854863852361817,
-      "velocityY": -1.6073270902229824,
-      "timestamp": 1.1564355935446873
-    },
-    {
-      "x": 6.212356894659494,
-      "y": 1.8656139570355461,
-      "heading": 3.1504971848650327,
-      "angularVelocity": -0.9655313830140856,
-      "velocityX": -2.915368071480525,
-      "velocityY": -1.3480684472591271,
-      "timestamp": 1.2173006247838813
-    },
-    {
-      "x": 6.032030314899095,
-      "y": 1.7995095607928446,
-      "heading": 3.0915449896362426,
-      "angularVelocity": -0.9685724960382134,
-      "velocityX": -2.9627287802043525,
-      "velocityY": -1.086081694149083,
-      "timestamp": 1.2781656560230754
-    },
-    {
-      "x": 5.849446338451813,
-      "y": 1.7494515528487504,
-      "heading": 3.032605568444944,
-      "angularVelocity": -0.9683626212179334,
-      "velocityX": -2.9998173455254054,
-      "velocityY": -0.8224428202027946,
-      "timestamp": 1.3390306872622695
+      "x": 7.9731832513294965,
+      "y": 4.026487402904062,
+      "heading": 3.7932364227144895,
+      "angularVelocity": -0.0368681350379896,
+      "velocityX": -0.08919740597331677,
+      "velocityY": -0.25038817817727327,
+      "timestamp": 0.060824155782917444
+    },
+    {
+      "x": 7.962103008768326,
+      "y": 3.996112792343719,
+      "heading": 3.788687152758471,
+      "angularVelocity": -0.07479380350554962,
+      "velocityX": -0.18216845624155484,
+      "velocityY": -0.4993840057353227,
+      "timestamp": 0.12164831156583489
+    },
+    {
+      "x": 7.945100079421275,
+      "y": 3.950697091129024,
+      "heading": 3.7817562440819508,
+      "angularVelocity": -0.1139499362926918,
+      "velocityX": -0.27954238128244496,
+      "velocityY": -0.7466721178471404,
+      "timestamp": 0.18247246734875233
+    },
+    {
+      "x": 7.92185830417986,
+      "y": 3.890370089672628,
+      "heading": 3.772355616140964,
+      "angularVelocity": -0.1545541869012955,
+      "velocityX": -0.3821142265313985,
+      "velocityY": -0.9918263670062992,
+      "timestamp": 0.24329662313166978
+    },
+    {
+      "x": 7.891999384931547,
+      "y": 3.8152975554838595,
+      "heading": 3.760380253516664,
+      "angularVelocity": -0.19688497884031883,
+      "velocityX": -0.49090560919382475,
+      "velocityY": -1.2342552596488783,
+      "timestamp": 0.3041207789145872
+    },
+    {
+      "x": 7.85506368954834,
+      "y": 3.72569677838064,
+      "heading": 3.745703091329558,
+      "angularVelocity": -0.24130482368698247,
+      "velocityX": -0.6072537285191664,
+      "velocityY": -1.4731117259236042,
+      "timestamp": 0.36494493469750466
+    },
+    {
+      "x": 7.810483024689109,
+      "y": 3.6218615851815734,
+      "heading": 3.7281678174840622,
+      "angularVelocity": -0.2882945701388696,
+      "velocityX": -0.7329434216619469,
+      "velocityY": -1.7071374335166476,
+      "timestamp": 0.4257690904804221
+    },
+    {
+      "x": 7.75754150465543,
+      "y": 3.5042044804582817,
+      "heading": 3.707578629757375,
+      "angularVelocity": -0.338503468920643,
+      "velocityX": -0.8704028745195956,
+      "velocityY": -1.9343812208953974,
+      "timestamp": 0.48659324626333955
+    },
+    {
+      "x": 7.695319475194805,
+      "y": 3.373331333274469,
+      "heading": 3.6836857657148254,
+      "angularVelocity": -0.3928186710527244,
+      "velocityX": -1.0229822125718777,
+      "velocityY": -2.1516640140621313,
+      "timestamp": 0.547417402046257
+    },
+    {
+      "x": 7.6226172615317065,
+      "y": 3.2301807206906474,
+      "heading": 3.656166422928496,
+      "angularVelocity": -0.45244101512146395,
+      "velocityX": -1.195285207452349,
+      "velocityY": -2.3535158152417135,
+      "timestamp": 0.6082415578291744
+    },
+    {
+      "x": 7.537874056741358,
+      "y": 3.0762935692392714,
+      "heading": 3.624607309055113,
+      "angularVelocity": -0.5188582310294256,
+      "velocityX": -1.3932491737788937,
+      "velocityY": -2.5300334952547887,
+      "timestamp": 0.6690657136120919
+    },
+    {
+      "x": 7.439186116305785,
+      "y": 2.9143192742653987,
+      "heading": 3.5885289471098396,
+      "angularVelocity": -0.593158449646844,
+      "velocityX": -1.622512292448285,
+      "velocityY": -2.662992899596701,
+      "timestamp": 0.7298898693950093
+    },
+    {
+      "x": 7.324799462619061,
+      "y": 2.7487257316338787,
+      "heading": 3.5475979292802173,
+      "angularVelocity": -0.6729401715940964,
+      "velocityX": -1.880612270147605,
+      "velocityY": -2.7224963585606825,
+      "timestamp": 0.7907140251779268
+    },
+    {
+      "x": 7.194507340242676,
+      "y": 2.585740156358662,
+      "heading": 3.5020835972715822,
+      "angularVelocity": -0.7482936906033946,
+      "velocityX": -2.1421114802053443,
+      "velocityY": -2.6796191936788247,
+      "timestamp": 0.8515381809608442
+    },
+    {
+      "x": 7.0504536551705375,
+      "y": 2.431188888490648,
+      "heading": 3.452877836818068,
+      "angularVelocity": -0.8089838620881198,
+      "velocityX": -2.3683630823626802,
+      "velocityY": -2.540952124672488,
+      "timestamp": 0.9123623367437617
+    },
+    {
+      "x": 6.895679700680455,
+      "y": 2.28873114154361,
+      "heading": 3.4010206368377873,
+      "angularVelocity": -0.8525757458165169,
+      "velocityX": -2.5446132790148983,
+      "velocityY": -2.3421245245963243,
+      "timestamp": 0.9731864925266791
+    },
+    {
+      "x": 6.732796621571605,
+      "y": 2.160266132765056,
+      "heading": 3.3473624043780283,
+      "angularVelocity": -0.8821862263286692,
+      "velocityX": -2.6779340709665105,
+      "velocityY": -2.1120722042908184,
+      "timestamp": 1.0340106483095965
+    },
+    {
+      "x": 6.563749580215948,
+      "y": 2.0467591756877423,
+      "heading": 3.2925189413234834,
+      "angularVelocity": -0.9016724087430362,
+      "velocityX": -2.7792747664100683,
+      "velocityY": -1.8661493220295844,
+      "timestamp": 1.094834804092514
+    },
+    {
+      "x": 6.3899587104320545,
+      "y": 1.9487221444905019,
+      "heading": 3.236931228275579,
+      "angularVelocity": -0.9139085011931405,
+      "velocityX": -2.8572672739455114,
+      "velocityY": -1.6118108000896318,
+      "timestamp": 1.1556589598754314
+    },
+    {
+      "x": 6.212478467014217,
+      "y": 1.8664410195309742,
+      "heading": 3.1809224189873455,
+      "angularVelocity": -0.9208316756278593,
+      "velocityX": -2.9179236626196454,
+      "velocityY": -1.3527705218497519,
+      "timestamp": 1.2164831156583489
+    },
+    {
+      "x": 6.032112039259563,
+      "y": 1.8000829772107247,
+      "heading": 3.124736406673497,
+      "angularVelocity": -0.9237450415979039,
+      "velocityX": -2.96537494738743,
+      "velocityY": -1.090981723726388,
+      "timestamp": 1.2773072714412663
+    },
+    {
+      "x": 5.849486965098296,
+      "y": 1.749749174951984,
+      "heading": 3.0685624701789247,
+      "angularVelocity": -0.9235465050276829,
+      "velocityX": -3.0025089836521532,
+      "velocityY": -0.827529812964159,
+      "timestamp": 1.3381314272241838
     },
     {
       "x": 5.665104866027832,
       "y": 1.7155022621154783,
-      "heading": 2.9738363314411114,
-      "angularVelocity": -0.9655665298662963,
-      "velocityX": -3.028692644542217,
-      "velocityY": -0.5577798949918237,
-      "timestamp": 1.3998957185014635
-    },
-    {
-      "x": 5.449668901780852,
-      "y": 1.6978455407032218,
-      "heading": 2.906132119432981,
-      "angularVelocity": -0.959891751531484,
-      "velocityX": -3.0543920227455827,
-      "velocityY": -0.250332154234056,
-      "timestamp": 1.470428892580843
-    },
-    {
-      "x": 5.233414974096308,
-      "y": 1.7019335435723504,
-      "heading": 2.8391383653684743,
-      "angularVelocity": -0.9498190736335087,
-      "velocityX": -3.0659888840557348,
-      "velocityY": 0.057958583637934886,
-      "timestamp": 1.5409620666602226
-    },
-    {
-      "x": 5.01765545620336,
-      "y": 1.727774331810827,
-      "heading": 2.77326134838151,
-      "angularVelocity": -0.9339862815875167,
-      "velocityX": -3.0589792776109848,
-      "velocityY": 0.36636360940449214,
-      "timestamp": 1.6114952407396022
-    },
-    {
-      "x": 4.80417702272647,
-      "y": 1.7752501139947119,
-      "heading": 2.7090489373906985,
-      "angularVelocity": -0.910385954253894,
-      "velocityX": -3.0266386882949394,
-      "velocityY": 0.6730986206640174,
-      "timestamp": 1.6820284148189817
-    },
-    {
-      "x": 4.59548781041016,
-      "y": 1.843939818969414,
-      "heading": 2.6472607773678716,
-      "angularVelocity": -0.8760155888247669,
-      "velocityX": -2.958738424013771,
-      "velocityY": 0.9738638005628106,
-      "timestamp": 1.7525615888983612
-    },
-    {
-      "x": 4.395161877372632,
-      "y": 1.9326893621825305,
-      "heading": 2.58896223762384,
-      "angularVelocity": -0.82654070945995,
-      "velocityX": -2.8401661438357806,
-      "velocityY": 1.2582666861587242,
-      "timestamp": 1.8230947629777408
-    },
-    {
-      "x": 4.208052213977568,
-      "y": 2.0386582351477758,
-      "heading": 2.5355600028021983,
-      "angularVelocity": -0.7571222409690838,
-      "velocityX": -2.652789497102312,
-      "velocityY": 1.502397621380076,
-      "timestamp": 1.8936279370571203
-    },
-    {
-      "x": 4.039383008540803,
-      "y": 2.156012297087957,
-      "heading": 2.488408609997161,
-      "angularVelocity": -0.6684995170070284,
-      "velocityX": -2.3913457410401313,
-      "velocityY": 1.6638137085410236,
-      "timestamp": 1.9641611111364998
-    },
-    {
-      "x": 3.892137754898665,
-      "y": 2.2765348326064325,
-      "heading": 2.447990164035441,
-      "angularVelocity": -0.5730416430179723,
-      "velocityX": -2.087602827520932,
-      "velocityY": 1.708735458053227,
-      "timestamp": 2.0346942852158794
-    },
-    {
-      "x": 3.766164166080398,
-      "y": 2.3929352805610016,
-      "heading": 2.4139692777566655,
-      "angularVelocity": -0.48233879621649,
-      "velocityX": -1.786018996911929,
-      "velocityY": 1.6502936309596794,
-      "timestamp": 2.105227459295259
-    },
-    {
-      "x": 3.6599405750653324,
-      "y": 2.5003798939702526,
-      "heading": 2.3856988855870287,
-      "angularVelocity": -0.40080986767759647,
-      "velocityX": -1.5060089440398745,
-      "velocityY": 1.5233202647073794,
-      "timestamp": 2.1757606333746384
-    },
-    {
-      "x": 3.571849727372911,
-      "y": 2.5959017093772516,
-      "heading": 2.3625508713896815,
-      "angularVelocity": -0.328186197480587,
-      "velocityX": -1.2489278816983742,
-      "velocityY": 1.3542821041840187,
-      "timestamp": 2.246293807454018
-    },
-    {
-      "x": 3.5005309804136506,
-      "y": 2.677634460422761,
-      "heading": 2.3440149762008446,
-      "angularVelocity": -0.26279683894525624,
-      "velocityX": -1.0111376368657052,
-      "velocityY": 1.1587845309999307,
-      "timestamp": 2.3168269815333975
-    },
-    {
-      "x": 3.444898984368672,
-      "y": 2.7443434037076186,
-      "heading": 2.3296936875946765,
-      "angularVelocity": -0.20304330257491268,
-      "velocityX": -0.7887351841329246,
-      "velocityY": 0.9457811045024435,
-      "timestamp": 2.387360155612777
-    },
-    {
-      "x": 3.404091793996619,
-      "y": 2.7951695430879604,
-      "heading": 2.319276755671779,
-      "angularVelocity": -0.14768840419933443,
-      "velocityX": -0.5785531546634841,
-      "velocityY": 0.720599066237137,
-      "timestamp": 2.4578933296921566
-    },
-    {
-      "x": 3.377417673658437,
-      "y": 2.8294887518678977,
-      "heading": 2.3125184133536703,
-      "angularVelocity": -0.09581792406652051,
-      "velocityX": -0.3781783633919927,
-      "velocityY": 0.4865683308298885,
-      "timestamp": 2.528426503771536
+      "heading": 3.0125511385109696,
+      "angularVelocity": -0.9208731456604314,
+      "velocityX": -3.031395942896885,
+      "velocityY": -0.5630478943059016,
+      "timestamp": 1.3989555830071012
+    },
+    {
+      "x": 5.4364501501141,
+      "y": 1.6977707730417206,
+      "heading": 2.944139623228989,
+      "angularVelocity": -0.9151171979283065,
+      "velocityX": -3.058635115120499,
+      "velocityY": -0.23718800160164863,
+      "timestamp": 1.4737126910986706
+    },
+    {
+      "x": 5.206960377408042,
+      "y": 1.7044694351689678,
+      "heading": 2.876515284948492,
+      "angularVelocity": -0.9045874032160918,
+      "velocityX": -3.069805381248256,
+      "velocityY": 0.08960568831851862,
+      "timestamp": 1.54846979919024
+    },
+    {
+      "x": 4.978251239441715,
+      "y": 1.735598056307952,
+      "heading": 2.8101543423117734,
+      "angularVelocity": -0.88768739629994,
+      "velocityX": -3.059363100110605,
+      "velocityY": 0.41639680738927637,
+      "timestamp": 1.6232269072818095
+    },
+    {
+      "x": 4.752574161124427,
+      "y": 1.7909760209909795,
+      "heading": 2.745713503987336,
+      "angularVelocity": -0.8620028244739498,
+      "velocityX": -3.0188042860199698,
+      "velocityY": 0.7407718957666946,
+      "timestamp": 1.697984015373379
+    },
+    {
+      "x": 4.5331713643671705,
+      "y": 1.86996361407104,
+      "heading": 2.6841254526244476,
+      "angularVelocity": -0.8238420791699165,
+      "velocityX": -2.934875389889497,
+      "velocityY": 1.0565897356985674,
+      "timestamp": 1.7727411234649484
+    },
+    {
+      "x": 4.324741325186423,
+      "y": 1.9707561474332134,
+      "heading": 2.6267153184834644,
+      "angularVelocity": -0.767955524318328,
+      "velocityX": -2.7880966038098087,
+      "velocityY": 1.3482668863904335,
+      "timestamp": 1.8474982315565178
+    },
+    {
+      "x": 4.133456760500775,
+      "y": 2.0888763146698124,
+      "heading": 2.575139560935057,
+      "angularVelocity": -0.6899110849129252,
+      "velocityX": -2.558747516708982,
+      "velocityY": 1.5800526565569466,
+      "timestamp": 1.9222553396480873
+    },
+    {
+      "x": 3.9648313060513067,
+      "y": 2.215896432204998,
+      "heading": 2.5306079426062213,
+      "angularVelocity": -0.5956840689221082,
+      "velocityX": -2.2556444297299487,
+      "velocityY": 1.6991042160111327,
+      "timestamp": 1.9970124477396567
+    },
+    {
+      "x": 3.8205343209977376,
+      "y": 2.3421025100473667,
+      "heading": 2.493194959981666,
+      "angularVelocity": -0.5004605392002106,
+      "velocityX": -1.930210902176966,
+      "velocityY": 1.6882150883602955,
+      "timestamp": 2.071769555831226
+    },
+    {
+      "x": 3.699264664656396,
+      "y": 2.4603619153467347,
+      "heading": 2.4622728561260585,
+      "angularVelocity": -0.413634297058835,
+      "velocityX": -1.6221822838946542,
+      "velocityY": 1.5819151960040088,
+      "timestamp": 2.1465266639227956
+    },
+    {
+      "x": 3.5990570492993528,
+      "y": 2.5663446289225074,
+      "heading": 2.437087858484135,
+      "angularVelocity": -0.336891009896672,
+      "velocityX": -1.3404426403747447,
+      "velocityY": 1.417694133458925,
+      "timestamp": 2.221283772014365
+    },
+    {
+      "x": 3.5181735452870257,
+      "y": 2.6574416406371975,
+      "heading": 2.4170079069842205,
+      "angularVelocity": -0.2686025718827755,
+      "velocityX": -1.0819506810409738,
+      "velocityY": 1.2185732439396435,
+      "timestamp": 2.2960408801059344
+    },
+    {
+      "x": 3.4552317701509287,
+      "y": 2.7319987511114388,
+      "heading": 2.4015458699114443,
+      "angularVelocity": -0.20683032647326308,
+      "velocityX": -0.84195037425739,
+      "velocityY": 0.9973247009891939,
+      "timestamp": 2.370797988197504
+    },
+    {
+      "x": 3.409149587958946,
+      "y": 2.7889049301174764,
+      "heading": 2.3903286620169495,
+      "angularVelocity": -0.15004871350500593,
+      "velocityX": -0.616425425867687,
+      "velocityY": 0.7612142906375352,
+      "timestamp": 2.4455550962890733
+    },
+    {
+      "x": 3.379072144956023,
+      "y": 2.827375131876985,
+      "heading": 2.383066118245118,
+      "angularVelocity": -0.09714853820904662,
+      "velocityX": -0.4023355607346594,
+      "velocityY": 0.5146025942093229,
+      "timestamp": 2.5203122043806427
     },
     {
       "x": 3.3643133640289307,
       "y": 2.8468308448791504,
-      "heading": 2.309220505183218,
-      "angularVelocity": -0.046756837665363614,
-      "velocityX": -0.18578930837223656,
-      "velocityY": 0.24587143904421285,
-      "timestamp": 2.5989596778509156
+      "heading": 2.3795279978377377,
+      "angularVelocity": -0.0473282139679155,
+      "velocityX": -0.19742311204728097,
+      "velocityY": 0.26025234922589974,
+      "timestamp": 2.595069312472212
     },
     {
       "x": 3.3643133640289307,
       "y": 2.8468308448791504,
-      "heading": 2.309220505183218,
-      "angularVelocity": 1.5317015602458727e-25,
-      "velocityX": -2.505849102759169e-26,
-      "velocityY": 2.1276220109101717e-26,
-      "timestamp": 2.669492851930295
+      "heading": 2.3795279978377377,
+      "angularVelocity": 2.4866807892758145e-28,
+      "velocityX": 1.5094963977000519e-27,
+      "velocityY": 1.0159722407732268e-27,
+      "timestamp": 2.6698264205637816
     }
   ],
   "eventMarkers": []
diff --git a/src/main/deploy/choreo/543.traj b/src/main/deploy/choreo/543.traj
index 3adc0c2..a926318 100644
--- a/src/main/deploy/choreo/543.traj
+++ b/src/main/deploy/choreo/543.traj
@@ -4,1909 +4,1900 @@
       "x": 1.3906110525131226,
       "y": 3.773930549621582,
       "heading": 2.146011906845138,
-      "angularVelocity": -4.607415814404034e-24,
-      "velocityX": -1.7254345385809295e-24,
-      "velocityY": -1.05174879071868e-23,
+      "angularVelocity": 5.794330982484493e-26,
+      "velocityX": -7.992490165005739e-26,
+      "velocityY": -3.398096319318013e-26,
       "timestamp": 0
     },
     {
-      "x": 1.4188356238691378,
-      "y": 3.760942213943607,
-      "heading": 2.153530791915604,
-      "angularVelocity": 0.08908449280361179,
-      "velocityX": 0.33440750859809526,
-      "velocityY": -0.15388708370877877,
-      "timestamp": 0.08440172732465938
-    },
-    {
-      "x": 1.475288932367314,
-      "y": 3.734962941794519,
-      "heading": 2.168364325366795,
-      "angularVelocity": 0.17574916913882777,
-      "velocityX": 0.6688643738418175,
-      "velocityY": -0.30780498187147287,
-      "timestamp": 0.16880345464931876
-    },
-    {
-      "x": 1.5599758288607513,
-      "y": 3.695989670782734,
-      "heading": 2.1902666180765573,
-      "angularVelocity": 0.2595005268732581,
-      "velocityX": 1.0033787124720934,
-      "velocityY": -0.4617591635520705,
-      "timestamp": 0.2532051819739781
-    },
-    {
-      "x": 1.6729020410079392,
-      "y": 3.6440187494301686,
-      "heading": 2.218934937634643,
-      "angularVelocity": 0.3396650811162915,
-      "velocityX": 1.3379609129657555,
-      "velocityY": -0.6157566083055958,
-      "timestamp": 0.3376069092986375
-    },
-    {
-      "x": 1.8140744209466089,
-      "y": 3.5790457513290828,
-      "heading": 2.2539866117999128,
-      "angularVelocity": 0.41529569685748813,
-      "velocityX": 1.6726242982639008,
-      "velocityY": -0.7698064975751115,
-      "timestamp": 0.4220086366232969
-    },
-    {
-      "x": 1.9835012543622998,
-      "y": 3.5010652014864134,
-      "heading": 2.294922249726516,
-      "angularVelocity": 0.48500948054226534,
-      "velocityX": 2.0073858531825324,
-      "velocityY": -0.9239212551031034,
-      "timestamp": 0.5064103639479562
-    },
-    {
-      "x": 2.1811926014666385,
-      "y": 3.410070177872789,
-      "heading": 2.3410635990000292,
-      "angularVelocity": 0.5466872626436459,
-      "velocityX": 2.342266602481963,
-      "velocityY": -1.078118025518638,
-      "timestamp": 0.5908120912726156
-    },
-    {
-      "x": 2.4071604854884874,
-      "y": 3.306051768554538,
-      "heading": 2.391439626548247,
-      "angularVelocity": 0.5968601490161605,
-      "velocityX": 2.677289804184235,
-      "velocityY": -1.2324203854043734,
-      "timestamp": 0.6752138185972749
-    },
-    {
-      "x": 2.6614180186191594,
-      "y": 3.188998550481633,
-      "heading": 2.4445515358009664,
-      "angularVelocity": 0.6292751456189901,
-      "velocityX": 3.0124683604240237,
-      "velocityY": -1.3868580867148388,
-      "timestamp": 0.7596155459219343
-    },
-    {
-      "x": 2.9439724015872475,
-      "y": 3.0588976398796266,
-      "heading": 2.497791194825149,
-      "angularVelocity": 0.6307887375265607,
-      "velocityX": 3.3477322316072415,
-      "velocityY": -1.5414484362572416,
-      "timestamp": 0.8440172732465936
-    },
-    {
-      "x": 3.2547705207438518,
-      "y": 2.9157523875003513,
-      "heading": 2.5454529495785527,
-      "angularVelocity": 0.5647011769091861,
-      "velocityX": 3.6823668070333375,
-      "velocityY": -1.695999085761044,
-      "timestamp": 0.9284190005712529
-    },
-    {
-      "x": 3.5925128012400935,
-      "y": 2.7599542956015277,
-      "heading": 2.5628561343461667,
-      "angularVelocity": 0.20619465168847934,
-      "velocityX": 4.001603891317103,
-      "velocityY": -1.8459111778545862,
-      "timestamp": 1.0128207278959123
-    },
-    {
-      "x": 3.9351974184342486,
-      "y": 2.6023709673223303,
-      "heading": 2.562856153970607,
-      "angularVelocity": 2.3251230459987665e-7,
-      "velocityX": 4.060161184568953,
-      "velocityY": -1.867062834781069,
-      "timestamp": 1.0972224552205716
-    },
-    {
-      "x": 4.277882042528265,
-      "y": 2.444787654047679,
-      "heading": 2.562856173594968,
-      "angularVelocity": 2.325113720761536e-7,
-      "velocityX": 4.060161266319199,
-      "velocityY": -1.8670626570057298,
-      "timestamp": 1.181624182545231
-    },
-    {
-      "x": 4.6205666666222935,
+      "x": 1.4188356238691382,
+      "y": 3.7609422139436073,
+      "heading": 2.1535307919155904,
+      "angularVelocity": 0.08908449280344664,
+      "velocityX": 0.3344075085981018,
+      "velocityY": -0.15388708370877402,
+      "timestamp": 0.08440172732465939
+    },
+    {
+      "x": 1.4752889323673153,
+      "y": 3.73496294179452,
+      "heading": 2.1683643253667535,
+      "angularVelocity": 0.1757491691385009,
+      "velocityX": 0.6688643738418307,
+      "velocityY": -0.30780498187146277,
+      "timestamp": 0.16880345464931878
+    },
+    {
+      "x": 1.5599758288607544,
+      "y": 3.695989670782737,
+      "heading": 2.1902666180764747,
+      "angularVelocity": 0.2595005268727734,
+      "velocityX": 1.0033787124721134,
+      "velocityY": -0.4617591635520542,
+      "timestamp": 0.2532051819739782
+    },
+    {
+      "x": 1.6729020410079447,
+      "y": 3.644018749430173,
+      "heading": 2.2189349376345064,
+      "angularVelocity": 0.339665081115654,
+      "velocityX": 1.3379609129657823,
+      "velocityY": -0.6157566083055724,
+      "timestamp": 0.33760690929863757
+    },
+    {
+      "x": 1.814074420946617,
+      "y": 3.5790457513290903,
+      "heading": 2.2539866117997107,
+      "angularVelocity": 0.4152956968567039,
+      "velocityX": 1.6726242982639348,
+      "velocityY": -0.7698064975750799,
+      "timestamp": 0.42200863662329696
+    },
+    {
+      "x": 1.9835012543623114,
+      "y": 3.5010652014864245,
+      "heading": 2.294922249726236,
+      "angularVelocity": 0.4850094805413429,
+      "velocityX": 2.0073858531825732,
+      "velocityY": -0.923921255103062,
+      "timestamp": 0.5064103639479564
+    },
+    {
+      "x": 2.181192601466654,
+      "y": 3.4100701778728046,
+      "heading": 2.34106359899966,
+      "angularVelocity": 0.5466872626425968,
+      "velocityX": 2.342266602482012,
+      "velocityY": -1.0781180255185847,
+      "timestamp": 0.5908120912726158
+    },
+    {
+      "x": 2.407160485488508,
+      "y": 3.3060517685545587,
+      "heading": 2.39143962654778,
+      "angularVelocity": 0.5968601490150018,
+      "velocityX": 2.6772898041842925,
+      "velocityY": -1.2324203854043054,
+      "timestamp": 0.6752138185972751
+    },
+    {
+      "x": 2.6614180186191856,
+      "y": 3.1889985504816614,
+      "heading": 2.444551535800395,
+      "angularVelocity": 0.6292751456177489,
+      "velocityX": 3.0124683604240907,
+      "velocityY": -1.3868580867147517,
+      "timestamp": 0.7596155459219345
+    },
+    {
+      "x": 2.94397240158728,
+      "y": 3.058897639879665,
+      "heading": 2.4977911948244698,
+      "angularVelocity": 0.6307887375252847,
+      "velocityX": 3.3477322316073206,
+      "velocityY": -1.5414484362571284,
+      "timestamp": 0.8440172732465938
+    },
+    {
+      "x": 3.254770520743893,
+      "y": 2.9157523875004028,
+      "heading": 2.5454529495777716,
+      "angularVelocity": 0.5647011769079837,
+      "velocityX": 3.6823668070334374,
+      "velocityY": -1.6959990857608904,
+      "timestamp": 0.9284190005712532
+    },
+    {
+      "x": 3.592512801240152,
+      "y": 2.759954295601597,
+      "heading": 2.5628561343453486,
+      "angularVelocity": 0.2061946516880405,
+      "velocityX": 4.001603891317303,
+      "velocityY": -1.8459111778543746,
+      "timestamp": 1.0128207278959125
+    },
+    {
+      "x": 3.9351974184343876,
+      "y": 2.602370967322575,
+      "heading": 2.562856153969789,
+      "angularVelocity": 2.3251230463668793e-7,
+      "velocityX": 4.060161184569908,
+      "velocityY": -1.867062834778992,
+      "timestamp": 1.0972224552205718
+    },
+    {
+      "x": 4.2778820425282325,
+      "y": 2.4447876540475497,
+      "heading": 2.56285617359415,
+      "angularVelocity": 2.3251137262525053e-7,
+      "velocityX": 4.060161266317163,
+      "velocityY": -1.8670626570101556,
+      "timestamp": 1.1816241825452312
+    },
+    {
+      "x": 4.620566666622319,
       "y": 2.287204340773051,
-      "heading": 2.56285619321933,
-      "angularVelocity": 2.3251137344363183e-7,
-      "velocityX": 4.06016126631933,
-      "velocityY": -1.8670626570054454,
-      "timestamp": 1.2660259098698903
-    },
-    {
-      "x": 4.963251290716338,
-      "y": 2.12962102749846,
-      "heading": 2.562856212843691,
-      "angularVelocity": 2.325113733001605e-7,
-      "velocityX": 4.060161266319529,
-      "velocityY": -1.8670626570050126,
-      "timestamp": 1.3504276371945496
-    },
-    {
-      "x": 5.305935914810376,
-      "y": 1.9720377142238548,
-      "heading": 2.5628562324680524,
-      "angularVelocity": 2.3251137288700666e-7,
-      "velocityX": 4.060161266319452,
-      "velocityY": -1.8670626570051803,
-      "timestamp": 1.434829364519209
-    },
-    {
-      "x": 5.6486205335479065,
-      "y": 1.8144543893009162,
-      "heading": 2.562856252092488,
-      "angularVelocity": 2.3251224680194668e-7,
-      "velocityX": 4.060161202855022,
-      "velocityY": -1.8670627950157828,
-      "timestamp": 1.5192310918438683
-    },
-    {
-      "x": 5.98670407076577,
-      "y": 1.6586057446575901,
-      "heading": 2.579360195393005,
-      "angularVelocity": 0.19554034998636466,
-      "velocityX": 4.005647134653921,
-      "velocityY": -1.8465101317635249,
-      "timestamp": 1.6036328191685276
-    },
-    {
-      "x": 6.297588553428444,
-      "y": 1.515443031462974,
-      "heading": 2.623278535257842,
-      "angularVelocity": 0.5203488276478101,
-      "velocityX": 3.6833900503816404,
-      "velocityY": -1.6962059632254551,
-      "timestamp": 1.688034546493187
-    },
-    {
-      "x": 6.580221781390715,
-      "y": 1.3853244468495944,
-      "heading": 2.6723827473448787,
-      "angularVelocity": 0.5817915538405133,
-      "velocityX": 3.348666394884248,
-      "velocityY": -1.5416578396892986,
-      "timestamp": 1.7724362738178463
-    },
-    {
-      "x": 6.834557352214876,
-      "y": 1.2682518474424065,
-      "heading": 2.7214165995037427,
-      "angularVelocity": 0.5809579224634863,
-      "velocityX": 3.0133929587226977,
-      "velocityY": -1.3870877186773325,
-      "timestamp": 1.8568380011425056
-    },
-    {
-      "x": 7.060600794430822,
-      "y": 1.164213692766984,
-      "heading": 2.7679660552881162,
-      "angularVelocity": 0.5515225488847675,
-      "velocityX": 2.678185025129261,
-      "velocityY": -1.2326543303459838,
-      "timestamp": 1.941239728467165
-    },
-    {
-      "x": 7.258362981468531,
-      "y": 1.0731997707175525,
-      "heading": 2.810637820160032,
-      "angularVelocity": 0.5055792840326011,
-      "velocityX": 2.3431059210079694,
-      "velocityY": -1.0783419360523008,
+      "heading": 2.5628561932185114,
+      "angularVelocity": 2.3251137330597664e-7,
+      "velocityX": 4.060161266320031,
+      "velocityY": -1.867062657003921,
+      "timestamp": 1.2660259098698905
+    },
+    {
+      "x": 4.963251290716406,
+      "y": 2.129621027498552,
+      "heading": 2.562856212842873,
+      "angularVelocity": 2.325113741533684e-7,
+      "velocityX": 4.06016126632003,
+      "velocityY": -1.8670626570039215,
+      "timestamp": 1.3504276371945498
+    },
+    {
+      "x": 5.305935914810306,
+      "y": 1.9720377142236445,
+      "heading": 2.5628562324672344,
+      "angularVelocity": 2.325113718451583e-7,
+      "velocityX": 4.060161266317804,
+      "velocityY": -1.8670626570087616,
+      "timestamp": 1.4348293645192092
+    },
+    {
+      "x": 5.648620533547862,
+      "y": 1.8144543893007625,
+      "heading": 2.56285625209167,
+      "angularVelocity": 2.3251224808098197e-7,
+      "velocityX": 4.060161202855331,
+      "velocityY": -1.8670627950151129,
+      "timestamp": 1.5192310918438685
+    },
+    {
+      "x": 5.986704070765734,
+      "y": 1.6586057446574787,
+      "heading": 2.5793601953922063,
+      "angularVelocity": 0.19554034998659195,
+      "velocityX": 4.0056471346540325,
+      "velocityY": -1.8465101317630266,
+      "timestamp": 1.6036328191685278
+    },
+    {
+      "x": 6.297588553428419,
+      "y": 1.5154430314628888,
+      "heading": 2.623278535257151,
+      "angularVelocity": 0.5203488276490896,
+      "velocityX": 3.6833900503817576,
+      "velocityY": -1.6962059632251454,
+      "timestamp": 1.6880345464931872
+    },
+    {
+      "x": 6.580221781390697,
+      "y": 1.385324446849529,
+      "heading": 2.6723827473443014,
+      "angularVelocity": 0.5817915538418572,
+      "velocityX": 3.3486663948843316,
+      "velocityY": -1.5416578396890646,
+      "timestamp": 1.7724362738178465
+    },
+    {
+      "x": 6.834557352214864,
+      "y": 1.2682518474423568,
+      "heading": 2.7214165995032737,
+      "angularVelocity": 0.5809579224647721,
+      "velocityX": 3.013392958722759,
+      "velocityY": -1.3870877186771464,
+      "timestamp": 1.8568380011425059
+    },
+    {
+      "x": 7.060600794430814,
+      "y": 1.1642136927669469,
+      "heading": 2.7679660552877468,
+      "angularVelocity": 0.5515225488859516,
+      "velocityX": 2.6781850251293067,
+      "velocityY": -1.2326543303458337,
+      "timestamp": 1.9412397284671652
+    },
+    {
+      "x": 7.258362981468526,
+      "y": 1.0731997707175256,
+      "heading": 2.810637820159753,
+      "angularVelocity": 0.5055792840336621,
+      "velocityX": 2.3431059210080036,
+      "velocityY": -1.078341936052179,
       "timestamp": 2.0256414557918245
     },
     {
-      "x": 7.4278539951534555,
-      "y": 0.9952020001334562,
-      "heading": 2.848524374960913,
-      "angularVelocity": 0.44888364257222324,
-      "velocityX": 2.0081462673501975,
-      "velocityY": -0.9241252881480766,
+      "x": 7.427853995153451,
+      "y": 0.9952020001334377,
+      "heading": 2.8485243749607116,
+      "angularVelocity": 0.4488836425731485,
+      "velocityX": 2.0081462673502224,
+      "velocityY": -0.9241252881479789,
       "timestamp": 2.110043183116484
     },
     {
-      "x": 7.569082320847809,
-      "y": 0.930214000728212,
-      "heading": 2.8809880838803004,
-      "angularVelocity": 0.3846332290631053,
-      "velocityX": 1.6732871491018833,
-      "velocityY": -0.7699842345081582,
+      "x": 7.569082320847807,
+      "y": 0.9302140007282002,
+      "heading": 2.880988083880165,
+      "angularVelocity": 0.38463322906388664,
+      "velocityX": 1.673287149101901,
+      "velocityY": -0.7699842345080813,
       "timestamp": 2.194444910441143
     },
     {
-      "x": 7.682054982165758,
-      "y": 0.8782306591629105,
-      "heading": 2.9075567665885504,
-      "angularVelocity": 0.31478837638063123,
-      "velocityX": 1.3385112473277885,
-      "velocityY": -0.6159037642125805,
+      "x": 7.6820549821657576,
+      "y": 0.8782306591629035,
+      "heading": 2.9075567665884687,
+      "angularVelocity": 0.3147883763812628,
+      "velocityX": 1.338511247327801,
+      "velocityY": -0.615903764212522,
       "timestamp": 2.2788466377658025
     },
     {
       "x": 7.766777816162518,
-      "y": 0.8392478073722182,
-      "heading": 2.927866772500761,
-      "angularVelocity": 0.24063495565779372,
-      "velocityX": 1.0038045035602847,
-      "velocityY": -0.4618726775666696,
+      "y": 0.8392478073722147,
+      "heading": 2.92786677250072,
+      "angularVelocity": 0.24063495565827153,
+      "velocityX": 1.0038045035602927,
+      "velocityY": -0.46187267756662764,
       "timestamp": 2.363248365090462
     },
     {
       "x": 7.823255725612272,
-      "y": 0.8132619936429646,
-      "heading": 2.9416291988019947,
-      "angularVelocity": 0.16305858585447291,
-      "velocityX": 0.6691558483454472,
-      "velocityY": -0.3078824871592573,
+      "y": 0.8132619936429635,
+      "heading": 2.941629198801981,
+      "angularVelocity": 0.16305858585479388,
+      "velocityX": 0.6691558483454518,
+      "velocityY": -0.30788248715923044,
       "timestamp": 2.447650092415121
     },
     {
       "x": 7.851492881774902,
       "y": 0.8002703189849854,
       "heading": 2.948608540855105,
-      "angularVelocity": 0.08269193385419325,
-      "velocityX": 0.33455661462961894,
-      "velocityY": -0.15392664427358824,
+      "angularVelocity": 0.08269193385435476,
+      "velocityX": 0.334556614629621,
+      "velocityY": -0.15392664427357527,
       "timestamp": 2.5320518197397806
     },
     {
       "x": 7.851492881774902,
       "y": 0.8002703189849854,
       "heading": 2.948608540855105,
-      "angularVelocity": 5.402032347351411e-23,
-      "velocityX": -1.1123337120346699e-22,
-      "velocityY": 3.0651678544995594e-23,
+      "angularVelocity": -1.2062609516459865e-26,
+      "velocityX": 1.2103314188915662e-26,
+      "velocityY": -7.234631053601379e-26,
       "timestamp": 2.61645354706444
     },
     {
-      "x": 7.822568882035389,
-      "y": 0.8134565460364541,
-      "heading": 2.9419859459707647,
-      "angularVelocity": -0.07760298691601544,
-      "velocityX": -0.3389288960814876,
-      "velocityY": 0.15451505387509465,
-      "timestamp": 2.7017929798301834
-    },
-    {
-      "x": 7.7647170451374405,
-      "y": 0.8398310193474777,
-      "heading": 2.9289537678985185,
-      "angularVelocity": -0.15270992142659134,
-      "velocityX": -0.6779027587018491,
-      "velocityY": 0.3090537686537181,
-      "timestamp": 2.787132412595927
-    },
-    {
-      "x": 7.677932914287794,
-      "y": 0.8793960863330212,
-      "heading": 2.9097686653736,
-      "angularVelocity": -0.22480935135321586,
-      "velocityX": -1.0169288456353933,
-      "velocityY": 0.4636199902353415,
-      "timestamp": 2.8724718453616704
-    },
-    {
-      "x": 7.562211255465081,
-      "y": 0.9321545004865132,
-      "heading": 2.8847464233438402,
-      "angularVelocity": -0.29320844091436304,
-      "velocityX": -1.3560162643729914,
-      "velocityY": 0.6182184770118369,
-      "timestamp": 2.957811278127414
-    },
-    {
-      "x": 7.417545860204267,
-      "y": 0.9981095206504768,
-      "heading": 2.8542852498864897,
-      "angularVelocity": -0.35694136309724944,
-      "velocityX": -1.6951764333601793,
-      "velocityY": 0.7728551506196457,
-      "timestamp": 3.0431507108931575
-    },
-    {
-      "x": 7.243929314298609,
-      "y": 1.0772650341717676,
-      "heading": 2.81890263652658,
-      "angularVelocity": -0.414610364906394,
-      "velocityX": -2.034423481372746,
-      "velocityY": 0.9275373758174913,
-      "timestamp": 3.128490143658901
-    },
-    {
-      "x": 7.041352783402235,
-      "y": 1.1696256928089817,
-      "heading": 2.779297618081299,
-      "angularVelocity": -0.46408813794200654,
-      "velocityX": -2.373774049476592,
-      "velocityY": 1.0822741099152131,
-      "timestamp": 3.2138295764246445
-    },
-    {
-      "x": 6.809806051541585,
-      "y": 1.2751969821493576,
-      "heading": 2.736465537770621,
-      "angularVelocity": -0.5019025662878775,
-      "velocityX": -2.713244327464013,
-      "velocityY": 1.2370751236438273,
-      "timestamp": 3.299169009190388
-    },
-    {
-      "x": 6.549278874556655,
-      "y": 1.3939848079923727,
-      "heading": 2.6919369879711237,
-      "angularVelocity": -0.5217816471985232,
-      "velocityX": -3.05283464562131,
-      "velocityY": 1.3919453410135438,
-      "timestamp": 3.3845084419561315
-    },
-    {
-      "x": 6.259769303119967,
-      "y": 1.525992204929741,
-      "heading": 2.648375507048617,
-      "angularVelocity": -0.5104496187838855,
-      "velocityX": -3.3924478058272545,
-      "velocityY": 1.5468511174632342,
-      "timestamp": 3.469847874721875
-    },
-    {
-      "x": 5.941344077941224,
-      "y": 1.6711937644032617,
-      "heading": 2.6116438214579167,
-      "angularVelocity": -0.43041867516894305,
-      "velocityX": -3.7312789042413628,
-      "velocityY": 1.7014591586529397,
-      "timestamp": 3.5551873074876186
-    },
-    {
-      "x": 5.595435536591844,
-      "y": 1.8290722409965166,
-      "heading": 2.607733432493964,
-      "angularVelocity": -0.045821595447992164,
-      "velocityX": -4.053325996422999,
-      "velocityY": 1.8500061633480882,
-      "timestamp": 3.640526740253362
-    },
-    {
-      "x": 5.2496529439780035,
-      "y": 1.9869633522762045,
-      "heading": 2.6034613630785652,
-      "angularVelocity": -0.05005973530578218,
-      "velocityX": -4.05185014016924,
-      "velocityY": 1.8501542154972939,
-      "timestamp": 3.7258661730191056
-    },
-    {
-      "x": 4.931253772917131,
-      "y": 2.1321611295912564,
-      "heading": 2.5655322472298923,
-      "angularVelocity": -0.4444500580732541,
-      "velocityX": -3.7309736043697175,
-      "velocityY": 1.7014148396512054,
-      "timestamp": 3.811205605784849
-    },
-    {
-      "x": 4.641767327132308,
-      "y": 2.2641652661660645,
-      "heading": 2.520640978635251,
-      "angularVelocity": -0.5260319542768441,
-      "velocityX": -3.3921768214638104,
-      "velocityY": 1.5468129128202641,
-      "timestamp": 3.8965450385505926
-    },
-    {
-      "x": 4.3812632098082105,
-      "y": 2.3829495591894077,
-      "heading": 2.47480035700841,
-      "angularVelocity": -0.537156389973591,
-      "velocityX": -3.052564434534983,
-      "velocityY": 1.3919039437419969,
-      "timestamp": 3.981884471316336
-    },
-    {
-      "x": 4.149739035406864,
-      "y": 2.48851732367813,
-      "heading": 2.4307407651450164,
-      "angularVelocity": -0.5162864391697761,
-      "velocityX": -2.71298000113124,
-      "velocityY": 1.2370338197408188,
-      "timestamp": 4.06722390408208
-    },
-    {
-      "x": 3.9471838536286543,
-      "y": 2.580874783829144,
-      "heading": 2.3900276970993897,
-      "angularVelocity": -0.4770721661272781,
-      "velocityX": -2.373523882379488,
-      "velocityY": 1.0822366303340143,
-      "timestamp": 4.152563336847823
-    },
-    {
-      "x": 3.773586819419269,
-      "y": 2.6600276124979123,
-      "heading": 2.3536756719868617,
-      "angularVelocity": -0.4259698469324771,
-      "velocityX": -2.0341948450244476,
-      "velocityY": 0.9275059149507459,
-      "timestamp": 4.237902769613567
-    },
-    {
-      "x": 3.6289385773839675,
-      "y": 2.725980527941314,
-      "heading": 2.3223946646011053,
-      "angularVelocity": -0.3665481052776955,
-      "velocityX": -1.694975433365738,
-      "velocityY": 0.7728304876884101,
-      "timestamp": 4.32324220237931
-    },
-    {
-      "x": 3.5132312818952185,
-      "y": 2.7787374037595027,
-      "heading": 2.29670882734183,
-      "angularVelocity": -0.3009843917029925,
-      "velocityX": -1.3558479560833883,
-      "velocityY": 0.6182004509334662,
-      "timestamp": 4.408581635145054
-    },
-    {
-      "x": 3.4264583605812398,
-      "y": 2.8183014403250346,
-      "heading": 2.277020911631921,
-      "angularVelocity": -0.23070127222373424,
-      "velocityX": -1.0167974932780486,
-      "velocityY": 0.4636079158638751,
-      "timestamp": 4.493921067910797
-    },
-    {
-      "x": 3.3686142652512063,
-      "y": 2.8446753119826385,
-      "heading": 2.2636502919705843,
-      "angularVelocity": -0.15667575033031875,
-      "velocityX": -0.6778120436869518,
-      "velocityY": 0.3090467185316375,
-      "timestamp": 4.579260500676541
+      "x": 7.822569410321687,
+      "y": 0.8134570127208937,
+      "heading": 2.942250346546477,
+      "angularVelocity": -0.07451133821509169,
+      "velocityX": -0.3389526112595688,
+      "velocityY": 0.15453415690077843,
+      "timestamp": 2.701785450381938
+    },
+    {
+      "x": 7.764718890043133,
+      "y": 0.839832272440097,
+      "heading": 2.9297405462516477,
+      "angularVelocity": -0.14660167895568676,
+      "velocityX": -0.6779471455512713,
+      "velocityY": 0.30909025456830386,
+      "timestamp": 2.7871173536994363
+    },
+    {
+      "x": 7.677937167802769,
+      "y": 0.8793982739906296,
+      "heading": 2.911328060299494,
+      "angularVelocity": -0.2157749357077613,
+      "velocityX": -1.0169903502265918,
+      "velocityY": 0.4636718508822873,
+      "timestamp": 2.8724492570169344
+    },
+    {
+      "x": 7.562219369891921,
+      "y": 0.9321575688208921,
+      "heading": 2.887319090771594,
+      "angularVelocity": -0.28135982668250875,
+      "velocityX": -1.3560906696325765,
+      "velocityY": 0.6182833474832815,
+      "timestamp": 2.9577811603344326
+    },
+    {
+      "x": 7.417559721625072,
+      "y": 0.998113175702274,
+      "heading": 2.8580996423497167,
+      "angularVelocity": -0.3424211494868395,
+      "velocityX": -1.6952586622685288,
+      "velocityY": 0.7729302209043448,
+      "timestamp": 3.043113063651931
+    },
+    {
+      "x": 7.243951337087096,
+      "y": 1.0772686940136758,
+      "heading": 2.8241711861092553,
+      "angularVelocity": -0.3976057596444594,
+      "velocityX": -2.034507350574668,
+      "velocityY": 0.9276192752537634,
+      "timestamp": 3.128444966969429
+    },
+    {
+      "x": 7.041386028561067,
+      "y": 1.1696284268040618,
+      "heading": 2.786210932104745,
+      "angularVelocity": -0.4448541814808713,
+      "velocityX": -2.373851990296467,
+      "velocityY": 1.0823587568032942,
+      "timestamp": 3.213776870286927
+    },
+    {
+      "x": 6.809854361139004,
+      "y": 1.275197436064349,
+      "heading": 2.745182930692885,
+      "angularVelocity": -0.4808049488736419,
+      "velocityX": -2.7133071971990876,
+      "velocityY": 1.2371575595529873,
+      "timestamp": 3.2991087736044253
+    },
+    {
+      "x": 6.54934695925946,
+      "y": 1.3939811321605526,
+      "heading": 2.702569215300316,
+      "angularVelocity": -0.49938784599723113,
+      "velocityX": -3.0528722758036095,
+      "velocityY": 1.3920197660919402,
+      "timestamp": 3.3844406769219235
+    },
+    {
+      "x": 6.259862392041541,
+      "y": 1.5259821373575067,
+      "heading": 2.660947042906878,
+      "angularVelocity": -0.48776800675091764,
+      "velocityX": -3.39245412282464,
+      "velocityY": 1.546912702811892,
+      "timestamp": 3.4697725802394217
+    },
+    {
+      "x": 5.941463784169146,
+      "y": 1.6711762227772475,
+      "heading": 2.6259775148098465,
+      "angularVelocity": -0.4098060249156608,
+      "velocityX": -3.731296215059398,
+      "velocityY": 1.7015217026100005,
+      "timestamp": 3.55510448355692
+    },
+    {
+      "x": 5.595461000648761,
+      "y": 1.8290711503385564,
+      "heading": 2.6224591054778523,
+      "angularVelocity": -0.04123205032592272,
+      "velocityX": -4.0547880695101535,
+      "velocityY": 1.8503621907251089,
+      "timestamp": 3.640436386874418
+    },
+    {
+      "x": 5.24956334725571,
+      "y": 1.986975195185791,
+      "heading": 2.6186328254708116,
+      "angularVelocity": -0.04483997026064621,
+      "velocityX": -4.053556055184374,
+      "velocityY": 1.8504690357100606,
+      "timestamp": 3.7257682901919162
+    },
+    {
+      "x": 4.931186691253366,
+      "y": 2.1321663984246007,
+      "heading": 2.58261703355146,
+      "angularVelocity": -0.4220671345551227,
+      "velocityX": -3.731038962271196,
+      "velocityY": 1.7014879264861869,
+      "timestamp": 3.8111001935094144
+    },
+    {
+      "x": 4.641721554882089,
+      "y": 2.2641649180815384,
+      "heading": 2.5398323894162624,
+      "angularVelocity": -0.5013909507679347,
+      "velocityX": -3.392226413774599,
+      "velocityY": 1.546883574901704,
+      "timestamp": 3.8964320968269126
+    },
+    {
+      "x": 4.381233513115829,
+      "y": 2.3829458675377655,
+      "heading": 2.4960705108691763,
+      "angularVelocity": -0.512843108447488,
+      "velocityX": -3.0526453956740087,
+      "velocityY": 1.3919875783653128,
+      "timestamp": 3.981764000144411
+    },
+    {
+      "x": 4.149720790549715,
+      "y": 2.4885121054416337,
+      "heading": 2.4539667442415882,
+      "angularVelocity": -0.4934117837607673,
+      "velocityX": -2.7130851834479257,
+      "velocityY": 1.2371250821756956,
+      "timestamp": 4.067095903461909
+    },
+    {
+      "x": 3.9471734283435462,
+      "y": 2.5808693126971836,
+      "heading": 2.4150338091170536,
+      "angularVelocity": -0.4562529793771927,
+      "velocityX": -2.3736416783362024,
+      "velocityY": 1.0823291601959537,
+      "timestamp": 4.152427806779407
+    },
+    {
+      "x": 3.773581464458937,
+      "y": 2.6600227125745386,
+      "heading": 2.3802529914030197,
+      "angularVelocity": -0.4075945380548163,
+      "velocityX": -2.034314917818226,
+      "velocityY": 0.9275944494387498,
+      "timestamp": 4.237759710096905
+    },
+    {
+      "x": 3.6289362693248974,
+      "y": 2.7259766668551513,
+      "heading": 2.3503116341483112,
+      "angularVelocity": -0.35088116039442224,
+      "velocityX": -1.6950892867800245,
+      "velocityY": 0.772910854164535,
+      "timestamp": 4.3230916134144035
+    },
+    {
+      "x": 3.5132305875893466,
+      "y": 2.7787347643176643,
+      "heading": 2.3257175786127346,
+      "angularVelocity": -0.288216418237719,
+      "velocityX": -1.3559486808238648,
+      "velocityY": 0.6182693155948199,
+      "timestamp": 4.408423516731902
+    },
+    {
+      "x": 3.426458330792868,
+      "y": 2.8182999738021985,
+      "heading": 2.306861275231502,
+      "angularVelocity": -0.22097600836433876,
+      "velocityX": -1.0168794251971758,
+      "velocityY": 0.4636625687033173,
+      "timestamp": 4.4937554200494
+    },
+    {
+      "x": 3.3686143533074815,
+      "y": 2.844674778468884,
+      "heading": 2.2940524576726125,
+      "angularVelocity": -0.15010584624172035,
+      "velocityX": -0.6778704709089147,
+      "velocityY": 0.30908492183224257,
+      "timestamp": 4.579087323366898
     },
     {
       "x": 3.3396942615509033,
       "y": 2.857861280441284,
-      "heading": 2.256856869928089,
-      "angularVelocity": -0.07960472459599503,
-      "velocityX": -0.33888207084394817,
-      "velocityY": 0.15451202370703507,
-      "timestamp": 4.664599933442284
+      "heading": 2.287543209286567,
+      "angularVelocity": -0.0762815328497496,
+      "velocityX": -0.3389130047758784,
+      "velocityY": 0.15453190963450955,
+      "timestamp": 4.664419226684396
     },
     {
       "x": 3.3396942615509033,
       "y": 2.857861280441284,
-      "heading": 2.256856869928089,
-      "angularVelocity": -5.437621548215379e-23,
-      "velocityX": 1.126114853157674e-22,
-      "velocityY": -4.5016812727452064e-23,
-      "timestamp": 4.749939366208028
-    },
-    {
-      "x": 3.351644043460381,
-      "y": 2.8456827633555766,
-      "heading": 2.2599985645312386,
-      "angularVelocity": 0.050261094910594425,
-      "velocityX": 0.1911736176110555,
-      "velocityY": -0.19483294222852873,
-      "timestamp": 4.8124468505502955
-    },
-    {
-      "x": 3.375805096988204,
-      "y": 2.821589634193531,
-      "heading": 2.266346205797599,
-      "angularVelocity": 0.10155009969051512,
-      "velocityX": 0.38653056961188503,
-      "velocityY": -0.3854439098863877,
-      "timestamp": 4.874954334892563
-    },
-    {
-      "x": 3.4124780907077805,
-      "y": 2.7859000800493376,
-      "heading": 2.2759735457087524,
-      "angularVelocity": 0.1540189948844771,
-      "velocityX": 0.5866976427777654,
-      "velocityY": -0.5709644936080076,
-      "timestamp": 4.937461819234831
-    },
-    {
-      "x": 3.4620112120736506,
-      "y": 2.7390039778926036,
-      "heading": 2.2889657812850372,
-      "angularVelocity": 0.2078508791866281,
-      "velocityX": 0.7924350481719095,
-      "velocityY": -0.7502477927274819,
-      "timestamp": 4.999969303577099
-    },
-    {
-      "x": 3.524810340388698,
-      "y": 2.6813880030564383,
-      "heading": 2.3054218546593743,
-      "angularVelocity": 0.2632656480659119,
-      "velocityX": 1.0046657448439726,
-      "velocityY": -0.921745218871413,
-      "timestamp": 5.062476787919366
-    },
-    {
-      "x": 3.6013509003736557,
-      "y": 2.6136727622292386,
-      "heading": 2.3254569789759962,
-      "angularVelocity": 0.3205236065319362,
-      "velocityX": 1.224502326247042,
-      "velocityY": -1.0833141269358477,
-      "timestamp": 5.124984272261634
-    },
-    {
-      "x": 3.6921900643990977,
-      "y": 2.5366690761295727,
-      "heading": 2.349204872167281,
-      "angularVelocity": 0.37992079574423454,
-      "velocityX": 1.4532525981695328,
-      "velocityY": -1.2319114568428715,
-      "timestamp": 5.187491756603902
-    },
-    {
-      "x": 3.7979745951175046,
-      "y": 2.451465011623651,
-      "heading": 2.376818153439006,
-      "angularVelocity": 0.44175959986687446,
-      "velocityX": 1.6923498334882667,
-      "velocityY": -1.3631018013679077,
-      "timestamp": 5.2499992409461695
-    },
-    {
-      "x": 3.919430507100887,
-      "y": 2.3595611737368243,
-      "heading": 2.40846281175274,
-      "angularVelocity": 0.506253909379225,
-      "velocityX": 1.9430619110878742,
-      "velocityY": -1.4702853402897413,
-      "timestamp": 5.312506725288437
-    },
-    {
-      "x": 4.057297923271103,
-      "y": 2.2630736309568915,
-      "heading": 2.444297103991139,
-      "angularVelocity": 0.5732800258315275,
-      "velocityX": 2.2056145375377016,
-      "velocityY": -1.5436158372908153,
-      "timestamp": 5.375014209630705
-    },
-    {
-      "x": 4.212127945253694,
-      "y": 2.1649943582593476,
-      "heading": 2.4844167991527084,
-      "angularVelocity": 0.6418382627892845,
-      "velocityX": 2.476983734216506,
-      "velocityY": -1.569080466596581,
-      "timestamp": 5.437521693972973
-    },
-    {
-      "x": 4.383820693252035,
-      "y": 2.069358793134477,
-      "heading": 2.5287485383649866,
-      "angularVelocity": 0.7092228983258065,
-      "velocityX": 2.7467550454952905,
-      "velocityY": -1.5299858269964235,
-      "timestamp": 5.50002917831524
-    },
-    {
-      "x": 4.570979270017924,
-      "y": 1.9808954420903548,
-      "heading": 2.5769092562000195,
-      "angularVelocity": 0.7704792208773401,
-      "velocityX": 2.9941786769257464,
-      "velocityY": -1.415244141961144,
-      "timestamp": 5.562536662657508
-    },
-    {
-      "x": 4.770751425736408,
-      "y": 1.9039231820267064,
-      "heading": 2.6281541085992433,
-      "angularVelocity": 0.8198194654359416,
-      "velocityX": 3.195971775549396,
-      "velocityY": -1.2314087004713992,
-      "timestamp": 5.625044146999776
-    },
-    {
-      "x": 4.979639835251487,
-      "y": 1.8413910789934598,
-      "heading": 2.6815711170435192,
-      "angularVelocity": 0.854569800822325,
-      "velocityX": 3.3418143717204245,
-      "velocityY": -1.0003938518921032,
-      "timestamp": 5.687551631342044
-    },
-    {
-      "x": 5.1944404545831935,
-      "y": 1.7948889188778072,
-      "heading": 2.736334014493798,
-      "angularVelocity": 0.8761014465150618,
-      "velocityX": 3.436398402398313,
-      "velocityY": -0.7439454747694548,
-      "timestamp": 5.750059115684311
-    },
-    {
-      "x": 5.412600696471709,
-      "y": 1.7651426093363154,
-      "heading": 2.791791924356713,
-      "angularVelocity": 0.887220313638733,
-      "velocityX": 3.4901459270693214,
-      "velocityY": -0.4758839658081921,
-      "timestamp": 5.812566600026579
+      "heading": 2.287543209286567,
+      "angularVelocity": -5.746242802708337e-26,
+      "velocityX": 2.4125661857863508e-26,
+      "velocityY": -5.00362558177337e-27,
+      "timestamp": 4.749751130001894
+    },
+    {
+      "x": 3.3516435621879443,
+      "y": 2.845682470433759,
+      "heading": 2.2905998350495063,
+      "angularVelocity": 0.048902527346193034,
+      "velocityX": 0.19117518678796644,
+      "velocityY": -0.19484707505193644,
+      "timestamp": 4.812255583837183
+    },
+    {
+      "x": 3.375803728180644,
+      "y": 2.82158872757552,
+      "heading": 2.2967757258080246,
+      "angularVelocity": 0.09880721099960219,
+      "velocityX": 0.38653511086371894,
+      "velocityY": -0.38547241644140595,
+      "timestamp": 4.8747600376724725
+    },
+    {
+      "x": 3.412475519518133,
+      "y": 2.785898212552426,
+      "heading": 2.3061427774759617,
+      "angularVelocity": 0.14986214730586908,
+      "velocityX": 0.5867068518689256,
+      "velocityY": -0.5710075495923139,
+      "timestamp": 4.9372644915077615
+    },
+    {
+      "x": 3.4620072362728327,
+      "y": 2.739000780362959,
+      "heading": 2.3187840455780817,
+      "angularVelocity": 0.20224587731671442,
+      "velocityX": 0.7924509969357517,
+      "velocityY": -0.7503054472414145,
+      "timestamp": 4.9997689453430505
+    },
+    {
+      "x": 3.5248048977787745,
+      "y": 2.6813830942336088,
+      "heading": 2.334796000084425,
+      "angularVelocity": 0.25617301686272975,
+      "velocityX": 1.0046909884442055,
+      "velocityY": -0.9218172881117153,
+      "timestamp": 5.0622733991783395
+    },
+    {
+      "x": 3.6013441038202685,
+      "y": 2.613665768416081,
+      "heading": 2.354291010287888,
+      "angularVelocity": 0.3118979369827916,
+      "velocityX": 1.2245400342700232,
+      "velocityY": -1.083400008517403,
+      "timestamp": 5.1247778530136285
+    },
+    {
+      "x": 3.6921822448448554,
+      "y": 2.5366596684882037,
+      "heading": 2.3773995605243607,
+      "angularVelocity": 0.3697104577118356,
+      "velocityX": 1.4533066917753177,
+      "velocityY": -1.2320098041461673,
+      "timestamp": 5.187282306848918
+    },
+    {
+      "x": 3.7979663486343616,
+      "y": 2.4514529745156497,
+      "heading": 2.4042706940551257,
+      "angularVelocity": 0.4299075006970781,
+      "velocityX": 1.6924250561130743,
+      "velocityY": -1.3632099593588929,
+      "timestamp": 5.249786760684207
+    },
+    {
+      "x": 3.919422728848772,
+      "y": 2.359546524255324,
+      "heading": 2.4350666770591682,
+      "angularVelocity": 0.49270061754632183,
+      "velocityX": 1.9431636109399608,
+      "velocityY": -1.4703984215671488,
+      "timestamp": 5.312291214519496
+    },
+    {
+      "x": 4.057291778395416,
+      "y": 2.2630568077934385,
+      "heading": 2.46994235759142,
+      "angularVelocity": 0.5579711267321186,
+      "velocityX": 2.205747608161725,
+      "velocityY": -1.5437254554076125,
+      "timestamp": 5.374795668354785
+    },
+    {
+      "x": 4.212124670100329,
+      "y": 2.1649764518129966,
+      "heading": 2.5089912150282228,
+      "angularVelocity": 0.6247371993634814,
+      "velocityX": 2.4771497422076023,
+      "velocityY": -1.569173874215458,
+      "timestamp": 5.437300122190074
+    },
+    {
+      "x": 4.383821100314581,
+      "y": 2.069341640095549,
+      "heading": 2.552140235385777,
+      "angularVelocity": 0.6903351314973505,
+      "velocityX": 2.7469471322268335,
+      "velocityY": -1.5300479541740037,
+      "timestamp": 5.499804576025363
+    },
+    {
+      "x": 4.57098306636943,
+      "y": 1.9808811883739248,
+      "heading": 2.5990137961096176,
+      "angularVelocity": 0.7499235310072663,
+      "velocityX": 2.994378073409875,
+      "velocityY": -1.4152663737328883,
+      "timestamp": 5.562309029860652
+    },
+    {
+      "x": 4.770757132781262,
+      "y": 1.9039132129567853,
+      "heading": 2.6488865297070845,
+      "angularVelocity": 0.7979068776265251,
+      "velocityX": 3.1961573000585606,
+      "velocityY": -1.2313998554401338,
+      "timestamp": 5.624813483695941
+    },
+    {
+      "x": 4.979645659161256,
+      "y": 1.8413854433641312,
+      "heading": 2.700871838493138,
+      "angularVelocity": 0.8317056720956911,
+      "velocityX": 3.341978268147973,
+      "velocityY": -1.0003730255355316,
+      "timestamp": 5.68731793753123
+    },
+    {
+      "x": 5.194445000550818,
+      "y": 1.794886668519366,
+      "heading": 2.7541661254761425,
+      "angularVelocity": 0.852647830880101,
+      "velocityX": 3.436544569377394,
+      "velocityY": -0.74392738423566,
+      "timestamp": 5.749822391366519
+    },
+    {
+      "x": 5.41260313772344,
+      "y": 1.7651422981078766,
+      "heading": 2.80813619301323,
+      "angularVelocity": 0.8634595492876254,
+      "velocityX": 3.490281472541287,
+      "velocityY": -0.47587601500961113,
+      "timestamp": 5.812326845201808
     },
     {
       "x": 5.632181167602539,
       "y": 1.7524278163909912,
-      "heading": 2.8474537083946774,
-      "angularVelocity": 0.8904819098650865,
-      "velocityX": 3.5128668741248528,
-      "velocityY": -0.20341232860536554,
-      "timestamp": 5.875074084368847
-    },
-    {
-      "x": 5.8440548234983485,
-      "y": 1.7560753750562226,
-      "heading": 2.9010181770052657,
-      "angularVelocity": 0.8879122072577887,
-      "velocityX": 3.5121267949821284,
-      "velocityY": 0.060463810237589344,
-      "timestamp": 5.935400396106373
-    },
-    {
-      "x": 6.054389053331998,
-      "y": 1.7755662495775102,
-      "heading": 2.954051932515814,
-      "angularVelocity": 0.8791148336946817,
-      "velocityX": 3.486608476062547,
-      "velocityY": 0.3230907701782012,
-      "timestamp": 5.995726707843899
-    },
-    {
-      "x": 6.261238142657165,
-      "y": 1.8105864214888754,
-      "heading": 3.0060676791923955,
-      "angularVelocity": 0.8622397951808591,
-      "velocityX": 3.4288369928058486,
-      "velocityY": 0.580512398366648,
-      "timestamp": 6.056053019581426
-    },
-    {
-      "x": 6.462109517822259,
-      "y": 1.8603513524817452,
-      "heading": 3.056444759125243,
-      "angularVelocity": 0.8350764116333455,
-      "velocityX": 3.3297473254964793,
-      "velocityY": 0.8249291156633646,
-      "timestamp": 6.116379331318952
-    },
-    {
-      "x": 6.654010184213206,
-      "y": 1.9232453521028667,
-      "heading": 3.104446433482699,
-      "angularVelocity": 0.7957004659311325,
-      "velocityX": 3.1810442386381634,
-      "velocityY": 1.0425633162320176,
-      "timestamp": 6.176705643056478
-    },
-    {
-      "x": 6.833858375306977,
-      "y": 1.9964918469597606,
-      "heading": 3.14932595328394,
-      "angularVelocity": 0.7439460246883234,
-      "velocityX": 2.9812562033673333,
-      "velocityY": 1.2141716068368684,
-      "timestamp": 6.237031954794005
-    },
-    {
-      "x": 6.999254693304601,
-      "y": 2.076309931658828,
-      "heading": 3.1905011120826616,
-      "angularVelocity": 0.682540629665392,
-      "velocityX": 2.741694514944779,
-      "velocityY": 1.3231056631863822,
-      "timestamp": 6.297358266531531
-    },
-    {
-      "x": 7.148994960466567,
-      "y": 2.158718271752955,
-      "heading": 3.2276763371225257,
-      "angularVelocity": 0.6162356684693461,
-      "velocityX": 2.4821717563883468,
-      "velocityY": 1.366043070106414,
-      "timestamp": 6.357684578269057
-    },
-    {
-      "x": 7.282888276645903,
-      "y": 2.2403059232688856,
-      "heading": 3.2608205631276768,
-      "angularVelocity": 0.549415753267966,
-      "velocityX": 2.219484538718249,
-      "velocityY": 1.3524389137348638,
-      "timestamp": 6.418010890006584
-    },
-    {
-      "x": 7.401284262943972,
-      "y": 2.318469756879384,
-      "heading": 3.290049267440689,
-      "angularVelocity": 0.4845100499460918,
-      "velocityX": 1.9625928204130767,
-      "velocityY": 1.2956839455158753,
-      "timestamp": 6.47833720174411
-    },
-    {
-      "x": 7.504726503640908,
-      "y": 2.3913046004079064,
-      "heading": 3.3155261667453493,
-      "angularVelocity": 0.4223181986577886,
-      "velocityX": 1.7147118349784642,
-      "velocityY": 1.207347862495227,
-      "timestamp": 6.538663513481636
-    },
-    {
-      "x": 7.593783054881719,
-      "y": 2.4574176139035644,
-      "heading": 3.337415785304815,
-      "angularVelocity": 0.3628535862544627,
-      "velocityX": 1.4762472406449565,
-      "velocityY": 1.09592334739955,
-      "timestamp": 6.598989825219163
-    },
-    {
-      "x": 7.668980952466653,
-      "y": 2.515773590456062,
-      "heading": 3.3558669674797814,
-      "angularVelocity": 0.30585629460069885,
-      "velocityX": 1.2465190630601162,
-      "velocityY": 0.9673387096230766,
-      "timestamp": 6.659316136956689
-    },
-    {
-      "x": 7.730787601696288,
-      "y": 2.5655858755396013,
-      "heading": 3.3710094475828405,
-      "angularVelocity": 0.2510095457010997,
-      "velocityX": 1.0245388363629793,
-      "velocityY": 0.8257140814486926,
-      "timestamp": 6.7196424486942155
-    },
-    {
-      "x": 7.779610612054574,
-      "y": 2.606242990697603,
-      "heading": 3.3829549992996975,
-      "angularVelocity": 0.1980156149580433,
-      "velocityX": 0.8093153543135553,
-      "velocityY": 0.6739532715823396,
-      "timestamp": 6.779968760431742
-    },
-    {
-      "x": 7.815803885955238,
-      "y": 2.637259478202497,
-      "heading": 3.391799843863087,
-      "angularVelocity": 0.14661669690454437,
-      "velocityX": 0.5999583408668668,
-      "velocityY": 0.5141452645048762,
-      "timestamp": 6.840295072169268
-    },
-    {
-      "x": 7.839675112054325,
-      "y": 2.6582425491647967,
-      "heading": 3.3976271358840906,
-      "angularVelocity": 0.09659619249320384,
-      "velocityX": 0.3957017329842471,
-      "velocityY": 0.34782618658331665,
-      "timestamp": 6.9006213839067945
+      "heading": 2.8623042167051507,
+      "angularVelocity": 0.8666266220750221,
+      "velocityX": 3.512998137024418,
+      "velocityY": -0.20341721168207155,
+      "timestamp": 5.874831299037097
+    },
+    {
+      "x": 5.844052633999474,
+      "y": 1.7560741482181919,
+      "heading": 2.9144309181641597,
+      "angularVelocity": 0.8641203781884118,
+      "velocityX": 3.512258526740335,
+      "velocityY": 0.06044636528553216,
+      "timestamp": 5.935154724771241
+    },
+    {
+      "x": 6.054385084094644,
+      "y": 1.775562351216045,
+      "heading": 2.966040820049239,
+      "angularVelocity": 0.8555532325457329,
+      "velocityX": 3.48674577969332,
+      "velocityY": 0.32306194087420037,
+      "timestamp": 5.995478150505385
+    },
+    {
+      "x": 6.26123327956607,
+      "y": 1.810578663020331,
+      "heading": 3.0166596950957345,
+      "angularVelocity": 0.8391246755378504,
+      "velocityX": 3.4289862181077373,
+      "velocityY": 0.5804761811540523,
+      "timestamp": 6.05580157623953
+    },
+    {
+      "x": 6.462105137626569,
+      "y": 1.860339123757078,
+      "heading": 3.0656834710845464,
+      "angularVelocity": 0.8126822273799312,
+      "velocityX": 3.3299146329284577,
+      "velocityY": 0.8248944772475333,
+      "timestamp": 6.116125001973674
+    },
+    {
+      "x": 6.654007902194967,
+      "y": 1.923229033256814,
+      "heading": 3.1123949171108847,
+      "angularVelocity": 0.7743500217014212,
+      "velocityX": 3.181231208820061,
+      "velocityY": 1.0425453915184284,
+      "timestamp": 6.176448427707818
+    },
+    {
+      "x": 6.833859400320409,
+      "y": 1.9964729638714147,
+      "heading": 3.1560670771443236,
+      "angularVelocity": 0.7239668421006098,
+      "velocityX": 2.9814536548053483,
+      "velocityY": 1.2141871872031882,
+      "timestamp": 6.2367718534419625
+    },
+    {
+      "x": 6.9992591804507365,
+      "y": 2.0762906150910156,
+      "heading": 3.196134058178292,
+      "angularVelocity": 0.6642026799099766,
+      "velocityX": 2.7418830763901587,
+      "velocityY": 1.323161777505331,
+      "timestamp": 6.297095279176107
+    },
+    {
+      "x": 7.149002064381009,
+      "y": 2.158700328766707,
+      "heading": 3.2323093855933887,
+      "angularVelocity": 0.5996895397573637,
+      "velocityX": 2.4823338878368153,
+      "velocityY": 1.366131194850996,
+      "timestamp": 6.357418704910251
+    },
+    {
+      "x": 7.28289676997483,
+      "y": 2.240290393761693,
+      "heading": 3.264563171309931,
+      "angularVelocity": 0.53468093570631,
+      "velocityX": 2.2196137564189082,
+      "velocityY": 1.3525436263279895,
+      "timestamp": 6.417742130644395
+    },
+    {
+      "x": 7.401293019643784,
+      "y": 2.3184570273209686,
+      "heading": 3.293007501257009,
+      "angularVelocity": 0.471530414609361,
+      "velocityX": 1.9626910810859457,
+      "velocityY": 1.2957923494559103,
+      "timestamp": 6.47806555637854
+    },
+    {
+      "x": 7.504734676211669,
+      "y": 2.3912946510869886,
+      "heading": 3.317801309695562,
+      "angularVelocity": 0.411014595686653,
+      "velocityX": 1.7147841872205727,
+      "velocityY": 1.2074517134857092,
+      "timestamp": 6.538388982112684
+    },
+    {
+      "x": 7.593790089197515,
+      "y": 2.4574102058192864,
+      "heading": 3.3391044114920563,
+      "angularVelocity": 0.3531480770071126,
+      "velocityX": 1.4762989983083836,
+      "velocityY": 1.0960179056090211,
+      "timestamp": 6.598712407846828
+    },
+    {
+      "x": 7.668986549958961,
+      "y": 2.51576837810098,
+      "heading": 3.3570614630429048,
+      "angularVelocity": 0.297679571945867,
+      "velocityX": 1.246554880567463,
+      "velocityY": 0.9674213884816201,
+      "timestamp": 6.6590358335809725
+    },
+    {
+      "x": 7.73079167331363,
+      "y": 2.5655824702880596,
+      "heading": 3.37179859188409,
+      "angularVelocity": 0.24430192187914104,
+      "velocityX": 1.0245625576215516,
+      "velocityY": 0.8257835423110678,
+      "timestamp": 6.719359259315117
+    },
+    {
+      "x": 7.779613237498961,
+      "y": 2.6062409955381525,
+      "heading": 3.3834244875514194,
+      "angularVelocity": 0.1927260517094479,
+      "velocityX": 0.8093301000592581,
+      "velocityY": 0.6740088904977358,
+      "timestamp": 6.779682685049261
+    },
+    {
+      "x": 7.815805280749054,
+      "y": 2.6372585064369205,
+      "heading": 3.392032727236094,
+      "angularVelocity": 0.14270143944762578,
+      "velocityX": 0.5999666433003645,
+      "velocityY": 0.5141868274435829,
+      "timestamp": 6.840006110783405
+    },
+    {
+      "x": 7.839675601727849,
+      "y": 2.6582422341725844,
+      "heading": 3.397704184310039,
+      "angularVelocity": 0.09401748997048373,
+      "velocityX": 0.3957056597547123,
+      "velocityY": 0.3478537148759254,
+      "timestamp": 6.90032953651755
     },
     {
       "x": 7.851492881774902,
       "y": 2.6688690185546875,
       "heading": 3.4005091591002805,
-      "angularVelocity": 0.047773900528336063,
-      "velocityX": 0.19589743480415714,
-      "velocityY": 0.17614982722838615,
-      "timestamp": 6.960947695644321
+      "angularVelocity": 0.04649893065761563,
+      "velocityX": 0.1958986894931053,
+      "velocityY": 0.17616347634064075,
+      "timestamp": 6.960652962251694
     },
     {
       "x": 7.851492881774902,
       "y": 2.6688690185546875,
       "heading": 3.4005091591002805,
-      "angularVelocity": 9.276573292600319e-26,
-      "velocityX": -1.5083414418709853e-26,
-      "velocityY": 1.2473322363600933e-26,
-      "timestamp": 7.021274007381847
-    },
-    {
-      "x": 7.8398706908734885,
-      "y": 2.659045579836875,
-      "heading": 3.397670399128096,
-      "angularVelocity": -0.048087115146296475,
-      "velocityX": -0.1968738595741256,
-      "velocityY": -0.1664039345998305,
-      "timestamp": 7.080307699953096
-    },
-    {
-      "x": 7.816406714095507,
-      "y": 2.6396661861972013,
-      "heading": 3.391938122786304,
-      "angularVelocity": -0.09710177514092747,
-      "velocityX": -0.3974675436347192,
-      "velocityY": -0.3282768330353808,
-      "timestamp": 7.1393413925243445
-    },
-    {
-      "x": 7.780852662322508,
-      "y": 2.6110489157431105,
-      "heading": 3.3832503902407196,
-      "angularVelocity": -0.1471656636606117,
-      "velocityX": -0.6022671160217185,
-      "velocityY": -0.4847616540258291,
-      "timestamp": 7.198375085095593
-    },
-    {
-      "x": 7.732926709877436,
-      "y": 2.5735771170694988,
-      "heading": 3.371536801646899,
-      "angularVelocity": -0.1984220888721078,
-      "velocityX": -0.8118406685678751,
-      "velocityY": -0.6347527495148073,
-      "timestamp": 7.257408777666842
-    },
-    {
-      "x": 7.6723081853265365,
-      "y": 2.5277198244659425,
-      "heading": 3.356717057617367,
-      "angularVelocity": -0.25103874387742214,
-      "velocityX": -1.026846228155873,
-      "velocityY": -0.7767986484702889,
-      "timestamp": 7.316442470238091
-    },
-    {
-      "x": 7.5986324175748425,
-      "y": 2.474060659554904,
-      "heading": 3.338699486712251,
-      "angularVelocity": -0.3052082653201855,
-      "velocityX": -1.2480291261261385,
-      "velocityY": -0.9089583011646543,
-      "timestamp": 7.375476162809339
-    },
-    {
-      "x": 7.511487405741507,
-      "y": 2.4133393759459825,
-      "heading": 3.317379927830016,
-      "angularVelocity": -0.36114222156278913,
-      "velocityX": -1.476191104396181,
-      "velocityY": -1.0285869130689465,
-      "timestamp": 7.434509855380588
-    },
-    {
-      "x": 7.4104163777069365,
-      "y": 2.3465120960997368,
-      "heading": 3.292641982912585,
-      "angularVelocity": -0.4190479002744803,
-      "velocityX": -1.7120905644278663,
-      "velocityY": -1.1320193085599486,
-      "timestamp": 7.493543547951837
-    },
-    {
-      "x": 7.294935610990268,
-      "y": 2.274838006810846,
-      "heading": 3.2643611388836136,
-      "angularVelocity": -0.47906276563741024,
-      "velocityX": -1.9561840313020116,
-      "velocityY": -1.2141217356916356,
-      "timestamp": 7.552577240523085
-    },
-    {
-      "x": 7.164587802676699,
-      "y": 2.1999985571515315,
-      "heading": 3.232418514985885,
-      "angularVelocity": -0.5410914090995878,
-      "velocityX": -2.208023971332143,
-      "velocityY": -1.2677412914496198,
-      "timestamp": 7.611610933094334
-    },
-    {
-      "x": 7.019069460404565,
-      "y": 2.1242390065298777,
-      "heading": 3.1967356179090185,
-      "angularVelocity": -0.6044496883504356,
-      "velocityX": -2.4650049138719563,
-      "velocityY": -1.283327322447578,
-      "timestamp": 7.670644625665583
-    },
-    {
-      "x": 6.858482408304033,
-      "y": 2.0504663765671833,
-      "heading": 3.157343833838982,
-      "angularVelocity": -0.6672763019608559,
-      "velocityX": -2.7202610086895374,
-      "velocityY": -1.2496699215224816,
-      "timestamp": 7.729678318236831
-    },
-    {
-      "x": 6.683696731414882,
-      "y": 1.9821321374647565,
-      "heading": 3.1144766897750107,
-      "angularVelocity": -0.7261470898543997,
-      "velocityX": -2.960778316182739,
-      "velocityY": -1.1575464133461344,
-      "timestamp": 7.78871201080808
-    },
-    {
-      "x": 6.496590119927003,
-      "y": 1.9227240477896728,
-      "heading": 3.068611211883559,
-      "angularVelocity": -0.7769373029833073,
-      "velocityX": -3.1694885299959403,
-      "velocityY": -1.0063420919059627,
-      "timestamp": 7.847745703379329
-    },
-    {
-      "x": 6.299809989168005,
-      "y": 1.8750739339769262,
-      "heading": 3.0203961806049864,
-      "angularVelocity": -0.8167375134188262,
-      "velocityX": -3.333352907265656,
-      "velocityY": -0.8071681058276496,
-      "timestamp": 7.906779395950577
-    },
-    {
-      "x": 6.096166852667886,
-      "y": 1.841025283234324,
-      "heading": 2.970514787317599,
-      "angularVelocity": -0.8449648177976474,
-      "velocityX": -3.449608649405423,
-      "velocityY": -0.5767664067686196,
-      "timestamp": 7.965813088521826
-    },
-    {
-      "x": 5.888159130049816,
-      "y": 1.8215785590507176,
-      "heading": 2.919575403832584,
-      "angularVelocity": -0.862886620611375,
-      "velocityX": -3.5235424646192124,
-      "velocityY": -0.32941737737539917,
-      "timestamp": 8.024846781093075
+      "angularVelocity": -1.5889815326108731e-28,
+      "velocityX": -3.357307726516775e-27,
+      "velocityY": -2.0645613226978418e-27,
+      "timestamp": 7.020976387985838
+    },
+    {
+      "x": 7.839871736672402,
+      "y": 2.659044902527838,
+      "heading": 3.397879005222776,
+      "angularVelocity": -0.04455940593353878,
+      "velocityX": -0.19688251948443478,
+      "velocityY": -0.16643770454749696,
+      "timestamp": 7.080002172158714
+    },
+    {
+      "x": 7.816409675527677,
+      "y": 2.639664097331194,
+      "heading": 3.3925680599821177,
+      "angularVelocity": -0.08997669942179426,
+      "velocityX": -0.39748834299276414,
+      "velocityY": -0.3283447304974564,
+      "timestamp": 7.13902795633159
+    },
+    {
+      "x": 7.78085819927372,
+      "y": 2.6110446305437054,
+      "heading": 3.3845190322360748,
+      "angularVelocity": -0.13636460504224676,
+      "velocityX": -0.602304175236922,
+      "velocityY": -0.4848638131374468,
+      "timestamp": 7.1980537405044664
+    },
+    {
+      "x": 7.732935229810911,
+      "y": 2.5735698133578784,
+      "heading": 3.373666801655185,
+      "angularVelocity": -0.18385576291719186,
+      "velocityX": -0.811898903747731,
+      "velocityY": -0.6348889338948905,
+      "timestamp": 7.2570795246773425
+    },
+    {
+      "x": 7.672319790339265,
+      "y": 2.5277086671674183,
+      "heading": 3.359937097674719,
+      "angularVelocity": -0.23260519403273167,
+      "velocityX": -1.026931540530051,
+      "velocityY": -0.7769680120833478,
+      "timestamp": 7.316105308850219
+    },
+    {
+      "x": 7.598646839413137,
+      "y": 2.474044844547294,
+      "heading": 3.343245157116424,
+      "angularVelocity": -0.2827906616099751,
+      "velocityX": -1.2481486177354881,
+      "velocityY": -0.9091589950410944,
+      "timestamp": 7.375131093023095
+    },
+    {
+      "x": 7.511503929455819,
+      "y": 2.4133182068213186,
+      "heading": 3.3234947258008027,
+      "angularVelocity": -0.33460684330386586,
+      "velocityX": -1.4763532781214996,
+      "velocityY": -1.0288154334064903,
+      "timestamp": 7.434156877195971
+    },
+    {
+      "x": 7.410433762027863,
+      "y": 2.3464851163906575,
+      "heading": 3.3005783521017755,
+      "angularVelocity": -0.38824344344006334,
+      "velocityX": -1.7123053737319145,
+      "velocityY": -1.1322694203421133,
+      "timestamp": 7.493182661368847
+    },
+    {
+      "x": 7.2949520343132965,
+      "y": 2.274805221808202,
+      "heading": 3.2743812863631283,
+      "angularVelocity": -0.4438241034108166,
+      "velocityX": -1.9564624059265545,
+      "velocityY": -1.214382758092934,
+      "timestamp": 7.552208445541723
+    },
+    {
+      "x": 7.164600915240746,
+      "y": 2.19996078160869,
+      "heading": 3.244794267206559,
+      "angularVelocity": -0.501255842191178,
+      "velocityX": -2.208375897061781,
+      "velocityY": -1.2679956945647022,
+      "timestamp": 7.611234229714599
+    },
+    {
+      "x": 7.019076723662156,
+      "y": 2.124198312448077,
+      "heading": 3.2117455235213295,
+      "angularVelocity": -0.5599035090907978,
+      "velocityX": -2.4654342778805964,
+      "velocityY": -1.2835487104875807,
+      "timestamp": 7.670260013887475
+    },
+    {
+      "x": 6.858481968394699,
+      "y": 2.050426351752548,
+      "heading": 3.175264297565607,
+      "angularVelocity": -0.6180557610022694,
+      "velocityX": -2.7207559800832732,
+      "velocityY": -1.2498260163636987,
+      "timestamp": 7.729285798060351
+    },
+    {
+      "x": 6.683688673153273,
+      "y": 1.9820972458441994,
+      "heading": 3.135565218611889,
+      "angularVelocity": -0.6725718177236996,
+      "velocityX": -2.9613040756813716,
+      "velocityY": -1.157614538558684,
+      "timestamp": 7.788311582233227
+    },
+    {
+      "x": 6.4965769519072785,
+      "y": 1.922697862826189,
+      "heading": 3.0930877819878293,
+      "angularVelocity": -0.7196420550661587,
+      "velocityX": -3.169999752955046,
+      "velocityY": -1.0063294177344664,
+      "timestamp": 7.847337366406103
+    },
+    {
+      "x": 6.299795589898969,
+      "y": 1.8750576451758807,
+      "heading": 3.0484322857695423,
+      "angularVelocity": -0.7565421932811351,
+      "velocityX": -3.3338203763963823,
+      "velocityY": -0.8071085936068,
+      "timestamp": 7.906363150578979
+    },
+    {
+      "x": 6.0961549426702675,
+      "y": 1.8410176211789118,
+      "heading": 3.0022319656530985,
+      "angularVelocity": -0.7827142114898721,
+      "velocityX": -3.450028662597266,
+      "velocityY": -0.5766975309853047,
+      "timestamp": 7.965388934751855
+    },
+    {
+      "x": 5.8881524104280425,
+      "y": 1.8215766031247145,
+      "heading": 2.955050627350933,
+      "angularVelocity": -0.7993343750246449,
+      "velocityX": -3.5239266221863828,
+      "velocityY": -0.3293648415963126,
+      "timestamp": 8.024414718924731
     },
     {
       "x": 5.677816390991211,
       "y": 1.8171948194503784,
-      "heading": 2.868072689693009,
-      "angularVelocity": -0.8724291484462967,
-      "velocityX": -3.563096426752226,
-      "velocityY": -0.07425826522791971,
-      "timestamp": 8.083880473664323
-    },
-    {
-      "x": 5.442365912429816,
-      "y": 1.831235505391545,
-      "heading": 2.810430444000349,
-      "angularVelocity": -0.8757353156168458,
-      "velocityX": -3.5771038528666774,
-      "velocityY": 0.21331446036513985,
-      "timestamp": 8.149702012050104
-    },
-    {
-      "x": 5.207967241132597,
-      "y": 1.8641978412146734,
-      "heading": 2.753052044025448,
-      "angularVelocity": -0.8717268143841358,
-      "velocityX": -3.5611241706840544,
-      "velocityY": 0.5007834309483129,
-      "timestamp": 8.215523550435886
-    },
-    {
-      "x": 4.977322209976329,
-      "y": 1.915733472956131,
-      "heading": 2.6965967084381495,
-      "angularVelocity": -0.8577030706333759,
-      "velocityX": -3.504096634819568,
-      "velocityY": 0.7829600007129153,
-      "timestamp": 8.281345088821668
-    },
-    {
-      "x": 4.754056144303332,
-      "y": 1.9847152153370575,
-      "heading": 2.6419511097713526,
-      "angularVelocity": -0.8302084698555116,
-      "velocityX": -3.3919909979074836,
-      "velocityY": 1.048011700617232,
-      "timestamp": 8.34716662720745
-    },
-    {
-      "x": 4.542560603740239,
-      "y": 2.0685214884350387,
-      "heading": 2.5901946725019775,
-      "angularVelocity": -0.7863146097562858,
-      "velocityX": -3.2131661724997835,
-      "velocityY": 1.2732347975033529,
-      "timestamp": 8.412988165593232
-    },
-    {
-      "x": 4.346947756601267,
-      "y": 2.162593065499909,
-      "heading": 2.5423282505574454,
-      "angularVelocity": -0.7272151809030252,
-      "velocityX": -2.971866837758739,
-      "velocityY": 1.4291914071274503,
-      "timestamp": 8.478809703979014
-    },
-    {
-      "x": 4.169641642267927,
-      "y": 2.26135754407989,
-      "heading": 2.4989196149597426,
-      "angularVelocity": -0.6594898366440953,
-      "velocityX": -2.6937400535086446,
-      "velocityY": 1.5004887610058348,
-      "timestamp": 8.544631242364796
-    },
-    {
-      "x": 4.011229101161916,
-      "y": 2.3598659918928777,
-      "heading": 2.4601095427398985,
-      "angularVelocity": -0.5896257239139054,
-      "velocityX": -2.4066976401789413,
-      "velocityY": 1.4965989891580096,
-      "timestamp": 8.610452780750578
-    },
-    {
-      "x": 3.8713053457808018,
-      "y": 2.454465693871717,
-      "heading": 2.42581281294347,
-      "angularVelocity": -0.5210563386624898,
-      "velocityX": -2.125804999588662,
-      "velocityY": 1.437214995255607,
-      "timestamp": 8.67627431913636
-    },
-    {
-      "x": 3.7491504704503686,
-      "y": 2.542621118074636,
-      "heading": 2.3958642561820227,
-      "angularVelocity": -0.45499630509875777,
-      "velocityX": -1.8558495946186861,
-      "velocityY": 1.3393096904881925,
-      "timestamp": 8.742095857522141
-    },
-    {
-      "x": 3.6440254618022103,
-      "y": 2.6225670711356144,
-      "heading": 2.370088465420997,
-      "angularVelocity": -0.39160115963794145,
-      "velocityX": -1.5971217207354962,
-      "velocityY": 1.2145865171429433,
-      "timestamp": 8.807917395907923
-    },
-    {
-      "x": 3.555266392414835,
-      "y": 2.6930420764383802,
-      "heading": 2.3483250557484934,
-      "angularVelocity": -0.33064267724869734,
-      "velocityX": -1.3484806275288594,
-      "velocityY": 1.0706982399850524,
-      "timestamp": 8.873738934293705
-    },
-    {
-      "x": 3.482301944919266,
-      "y": 2.753116019704283,
-      "heading": 2.330434726775575,
-      "angularVelocity": -0.2718005293048944,
-      "velocityX": -1.1085193279427956,
-      "velocityY": 0.9126791129342325,
-      "timestamp": 8.939560472679487
-    },
-    {
-      "x": 3.4246464401914216,
-      "y": 2.8020823678924462,
-      "heading": 2.316298479297474,
-      "angularVelocity": -0.21476628812970447,
-      "velocityX": -0.8759367547735366,
-      "velocityY": 0.743925915270608,
-      "timestamp": 9.005382011065269
-    },
-    {
-      "x": 3.381886982990636,
-      "y": 2.8393900377748,
-      "heading": 2.3058148947987087,
-      "angularVelocity": -0.1592728574242708,
-      "velocityX": -0.6496271319301332,
-      "velocityY": 0.5668003331020922,
-      "timestamp": 9.07120354945105
-    },
-    {
-      "x": 3.3536707768732223,
-      "y": 2.864599234964658,
-      "heading": 2.298897214798888,
-      "angularVelocity": -0.10509751320723953,
-      "velocityX": -0.4286774027072638,
-      "velocityY": 0.38299313276614483,
-      "timestamp": 9.137025087836832
+      "heading": 2.907346545445461,
+      "angularVelocity": -0.8081905657662355,
+      "velocityX": -3.563459975742036,
+      "velocityY": -0.0742350776993099,
+      "timestamp": 8.083440503097608
+    },
+    {
+      "x": 5.442371655977857,
+      "y": 1.8312329857861205,
+      "heading": 2.8539540674037878,
+      "angularVelocity": -0.8112707617342358,
+      "velocityX": -3.5774595322493767,
+      "velocityY": 0.21330259081926167,
+      "timestamp": 8.149253891869979
+    },
+    {
+      "x": 5.207978052246513,
+      "y": 1.8641881677109164,
+      "heading": 2.8008045056785926,
+      "angularVelocity": -0.8075797754317682,
+      "velocityX": -3.5614881425121783,
+      "velocityY": 0.500736742773998,
+      "timestamp": 8.21506728064235
+    },
+    {
+      "x": 4.977335594971118,
+      "y": 1.9157126949064627,
+      "heading": 2.748508031198271,
+      "angularVelocity": -0.7946175611956366,
+      "velocityX": -3.5044914352172007,
+      "velocityY": 0.782888226189873,
+      "timestamp": 8.28088066941472
+    },
+    {
+      "x": 4.754067600876142,
+      "y": 1.9846814915867437,
+      "heading": 2.6978851936191504,
+      "angularVelocity": -0.7691875243532816,
+      "velocityX": -3.392440326499412,
+      "velocityY": 1.0479447718278632,
+      "timestamp": 8.346694058187092
+    },
+    {
+      "x": 4.542564948081897,
+      "y": 2.068476988403223,
+      "heading": 2.649933573452933,
+      "angularVelocity": -0.7285997737036102,
+      "velocityX": -3.2136721226401024,
+      "velocityY": 1.2732287210783588,
+      "timestamp": 8.412507446959463
+    },
+    {
+      "x": 4.346942427891662,
+      "y": 2.1625437031056833,
+      "heading": 2.6055779926025404,
+      "angularVelocity": -0.6739598382299568,
+      "velocityX": -2.9723818183384134,
+      "velocityY": 1.4292945015764016,
+      "timestamp": 8.478320835731834
+    },
+    {
+      "x": 4.1696279422067075,
+      "y": 2.2613093610310995,
+      "heading": 2.565350469760314,
+      "angularVelocity": -0.6112361571497512,
+      "velocityX": -2.6942008152510084,
+      "velocityY": 1.5006924847315846,
+      "timestamp": 8.544134224504205
+    },
+    {
+      "x": 4.011210200789988,
+      "y": 2.3598229084456155,
+      "heading": 2.5293884262899673,
+      "angularVelocity": -0.546424430365192,
+      "velocityX": -2.4070746754074355,
+      "velocityY": 1.496861797456512,
+      "timestamp": 8.609947613276576
+    },
+    {
+      "x": 3.871284494174842,
+      "y": 2.4544295481535148,
+      "heading": 2.497613892197236,
+      "angularVelocity": -0.48279741683914584,
+      "velocityX": -2.1260978841115015,
+      "velocityY": 1.4374983794728338,
+      "timestamp": 8.675761002048947
+    },
+    {
+      "x": 3.749130246258036,
+      "y": 2.5425923526977727,
+      "heading": 2.469872126114301,
+      "angularVelocity": -0.4215216174156515,
+      "velocityX": -1.8560698696020823,
+      "velocityY": 1.3395876764405317,
+      "timestamp": 8.741574390821318
+    },
+    {
+      "x": 3.6440076258991128,
+      "y": 2.622545326222263,
+      "heading": 2.4459987512831027,
+      "angularVelocity": -0.362743436806896,
+      "velocityX": -1.5972832020929764,
+      "velocityY": 1.2148435905803896,
+      "timestamp": 8.80738777959369
+    },
+    {
+      "x": 3.5552519630245114,
+      "y": 2.6930265682484116,
+      "heading": 2.4258437576324656,
+      "angularVelocity": -0.3062445807242533,
+      "velocityX": -1.3485958485070668,
+      "velocityY": 1.070925587343959,
+      "timestamp": 8.87320116836606
+    },
+    {
+      "x": 3.4822913234359776,
+      "y": 2.753105759149151,
+      "heading": 2.409277081736245,
+      "angularVelocity": -0.2517219703352401,
+      "velocityX": -1.1085987357509106,
+      "velocityY": 0.9128718642423238,
+      "timestamp": 8.939014557138432
+    },
+    {
+      "x": 3.4246395297726133,
+      "y": 2.8020762823137697,
+      "heading": 2.3961877488562684,
+      "angularVelocity": -0.19888556301588897,
+      "velocityX": -0.8759888335603617,
+      "velocityY": 0.7440814715375484,
+      "timestamp": 9.004827945910803
+    },
+    {
+      "x": 3.3818832860452783,
+      "y": 2.8393870378309063,
+      "heading": 2.386481246318591,
+      "angularVelocity": -0.14748522631541322,
+      "velocityX": -0.6496587476328872,
+      "velocityY": 0.5669174040890574,
+      "timestamp": 9.070641334683174
+    },
+    {
+      "x": 3.3536694716552815,
+      "y": 2.864598250774754,
+      "heading": 2.380076747643575,
+      "angularVelocity": -0.09731300567377486,
+      "velocityX": -0.4286941444024425,
+      "velocityY": 0.3830711867921795,
+      "timestamp": 9.136454723455545
     },
     {
       "x": 3.3396942615509033,
       "y": 2.877351999282837,
-      "heading": 2.2954707540735027,
-      "angularVelocity": -0.05205683138706078,
-      "velocityX": -0.21233954211768968,
-      "velocityY": 0.19374758826563127,
-      "timestamp": 9.202846626222614
+      "heading": 2.3769046726239993,
+      "angularVelocity": -0.048198019867158104,
+      "velocityX": -0.2123460038308339,
+      "velocityY": 0.19378653410774088,
+      "timestamp": 9.202268112227916
     },
     {
       "x": 3.3396942615509033,
       "y": 2.877351999282837,
-      "heading": 2.2954707540735027,
-      "angularVelocity": -2.2138058328679337e-25,
-      "velocityX": 3.908937921937773e-26,
-      "velocityY": -5.142843079725612e-27,
-      "timestamp": 9.268668164608396
-    },
-    {
-      "x": 3.3516645476191473,
-      "y": 2.8617630229365867,
-      "heading": 2.298537948781302,
-      "angularVelocity": 0.04572936123680092,
-      "velocityX": 0.1784671623000002,
-      "velocityY": -0.23241887084535387,
-      "timestamp": 9.33574092978254
-    },
-    {
-      "x": 3.376003702841053,
-      "y": 2.8309022396479997,
-      "heading": 2.3048120923274715,
-      "angularVelocity": 0.09354234210979048,
-      "velocityX": 0.3628768719868968,
-      "velocityY": -0.4601090056219035,
-      "timestamp": 9.402813694956684
-    },
-    {
-      "x": 3.413188351414955,
-      "y": 2.7851720067926857,
-      "heading": 2.3144615113821967,
-      "angularVelocity": 0.14386493578536452,
-      "velocityX": 0.5543926581431038,
-      "velocityY": -0.6818003214357108,
-      "timestamp": 9.469886460130828
-    },
-    {
-      "x": 3.463795860207917,
-      "y": 2.725096311990658,
-      "heading": 2.3276920106910532,
-      "angularVelocity": 0.1972559096751932,
-      "velocityX": 0.7545165114568831,
-      "velocityY": -0.8956794109509365,
-      "timestamp": 9.536959225304972
-    },
-    {
-      "x": 3.5285345689846737,
-      "y": 2.6513792453542453,
-      "heading": 2.344759157342521,
-      "angularVelocity": 0.254457179559477,
-      "velocityX": 0.9652011305732239,
-      "velocityY": -1.099061093500722,
-      "timestamp": 9.604031990479116
-    },
-    {
-      "x": 3.608282029663586,
-      "y": 2.5650027653656142,
-      "heading": 2.365984707549641,
-      "angularVelocity": 0.31645557108032524,
-      "velocityX": 1.1889693301276525,
-      "velocityY": -1.2878025792490757,
-      "timestamp": 9.67110475565326
-    },
-    {
-      "x": 3.7041249846999373,
-      "y": 2.467396548832097,
-      "heading": 2.391775895173838,
-      "angularVelocity": 0.3845254859738355,
-      "velocityX": 1.4289399697106506,
-      "velocityY": -1.4552287546233942,
-      "timestamp": 9.738177520827405
-    },
-    {
-      "x": 3.817367854577491,
-      "y": 2.360738630218002,
-      "heading": 2.4226367432261977,
-      "angularVelocity": 0.46010997119671315,
-      "velocityX": 1.6883584504610083,
-      "velocityY": -1.590182219820124,
-      "timestamp": 9.805250286001549
-    },
-    {
-      "x": 3.949385432841112,
-      "y": 2.2484593214367075,
-      "heading": 2.459128147951867,
-      "angularVelocity": 0.5440569600928907,
-      "velocityX": 1.968273977088275,
-      "velocityY": -1.6739925436170393,
-      "timestamp": 9.872323051175693
-    },
-    {
-      "x": 4.100985215141024,
-      "y": 2.135844091585944,
-      "heading": 2.5016794738291117,
-      "angularVelocity": 0.6344054217351344,
-      "velocityX": 2.2602286025677487,
-      "velocityY": -1.679000851662739,
-      "timestamp": 9.939395816349837
-    },
-    {
-      "x": 4.271035246020557,
-      "y": 2.029803920822179,
-      "heading": 2.55023405409309,
-      "angularVelocity": 0.7239090283204185,
-      "velocityX": 2.535306699194872,
-      "velocityY": -1.5809721052717514,
-      "timestamp": 10.00646858152398
-    },
-    {
-      "x": 4.455854041914051,
-      "y": 1.9366653659853252,
-      "heading": 2.60397591092134,
-      "angularVelocity": 0.801247073811809,
-      "velocityX": 2.7554968907818176,
-      "velocityY": -1.3886195774847423,
-      "timestamp": 10.073541346698125
-    },
-    {
-      "x": 4.650909282787146,
-      "y": 1.8602874196738752,
-      "heading": 2.6616516476615515,
-      "angularVelocity": 0.8598980016772068,
-      "velocityX": 2.908113902366535,
-      "velocityY": -1.1387326303477394,
-      "timestamp": 10.140614111872269
-    },
-    {
-      "x": 4.852413526913252,
-      "y": 1.8024799152254807,
-      "heading": 2.722142252767918,
-      "angularVelocity": 0.9018653838008867,
-      "velocityX": 3.0042632595052488,
-      "velocityY": -0.8618625502960255,
-      "timestamp": 10.207686877046413
-    },
-    {
-      "x": 5.057594824272398,
-      "y": 1.763994130666435,
-      "heading": 2.7846105473763534,
-      "angularVelocity": 0.9313511146624962,
-      "velocityX": 3.059085111914244,
-      "velocityY": -0.5737915301258724,
-      "timestamp": 10.274759642220557
-    },
-    {
-      "x": 5.264464307067692,
-      "y": 1.7451094274340988,
-      "heading": 2.848447740477815,
-      "angularVelocity": 0.9517602701441944,
-      "velocityX": 3.0842545742402043,
-      "velocityY": -0.28155545970566304,
-      "timestamp": 10.341832407394701
-    },
-    {
-      "x": 5.471568697214922,
-      "y": 1.745899571938889,
-      "heading": 2.913204372628034,
-      "angularVelocity": 0.9654683533933353,
-      "velocityX": 3.087756850481914,
-      "velocityY": 0.01178040748340537,
-      "timestamp": 10.408905172568845
+      "heading": 2.3769046726239993,
+      "angularVelocity": 8.699347294583009e-29,
+      "velocityX": 8.966370263182221e-27,
+      "velocityY": 9.299144171685505e-27,
+      "timestamp": 9.268081501000287
+    },
+    {
+      "x": 3.3516625830764935,
+      "y": 2.861762565335628,
+      "heading": 2.3798027568533566,
+      "angularVelocity": 0.04321176422934021,
+      "velocityX": 0.1784531597618389,
+      "velocityY": -0.23244560574593578,
+      "timestamp": 9.335148520388248
+    },
+    {
+      "x": 3.3759979879487325,
+      "y": 2.8309006486888566,
+      "heading": 2.3857310557967786,
+      "angularVelocity": 0.08839365454917242,
+      "velocityX": 0.3628520410526427,
+      "velocityY": -0.4601653231112726,
+      "timestamp": 9.40221553977621
+    },
+    {
+      "x": 3.4131773512442836,
+      "y": 2.7851683566473224,
+      "heading": 2.3948487463537145,
+      "angularVelocity": 0.13594894540031874,
+      "velocityX": 0.5543613483175733,
+      "velocityY": -0.6818894362516296,
+      "timestamp": 9.46928255916417
+    },
+    {
+      "x": 3.463778400038,
+      "y": 2.7250893961159655,
+      "heading": 2.407350522660198,
+      "angularVelocity": 0.18640721505998045,
+      "velocityX": 0.7544848310762926,
+      "velocityY": -0.895804839392364,
+      "timestamp": 9.536349578552132
+    },
+    {
+      "x": 3.5285100034686807,
+      "y": 2.6513675596934068,
+      "heading": 2.423478332665211,
+      "angularVelocity": 0.2404730395385411,
+      "velocityX": 0.9651778776126764,
+      "velocityY": -1.0992263722963704,
+      "timestamp": 9.603416597940093
+    },
+    {
+      "x": 3.608250506819797,
+      "y": 2.5649845398562943,
+      "heading": 2.443537205147885,
+      "angularVelocity": 0.29908698292732966,
+      "velocityX": 1.1889674549251013,
+      "velocityY": -1.2880104204037197,
+      "timestamp": 9.670483617328054
+    },
+    {
+      "x": 3.704087845598115,
+      "y": 2.4673699165153473,
+      "heading": 2.467914194177291,
+      "angularVelocity": 0.36347207989657143,
+      "velocityX": 1.4289786493109158,
+      "velocityY": -1.4554787767781576,
+      "timestamp": 9.737550636716016
+    },
+    {
+      "x": 3.8173281503467877,
+      "y": 2.3607021391611296,
+      "heading": 2.4970905528957617,
+      "angularVelocity": 0.43503288180580346,
+      "velocityX": 1.6884648487748337,
+      "velocityY": -1.5904654527313735,
+      "timestamp": 9.804617656103977
+    },
+    {
+      "x": 3.949348217986618,
+      "y": 2.248413089529829,
+      "heading": 2.531605230749573,
+      "angularVelocity": 0.5146296669925818,
+      "velocityX": 1.9684797213983332,
+      "velocityY": -1.674281198956299,
+      "timestamp": 9.871684675491938
+    },
+    {
+      "x": 4.100956630482294,
+      "y": 2.1357913846970256,
+      "heading": 2.5718681396894523,
+      "angularVelocity": 0.6003384272524676,
+      "velocityX": 2.2605509217380098,
+      "velocityY": -1.6792412404869688,
+      "timestamp": 9.9387516948799
+    },
+    {
+      "x": 4.271019524465303,
+      "y": 2.02975174701908,
+      "heading": 2.617805882913228,
+      "angularVelocity": 0.6849528075497259,
+      "velocityX": 2.5357156995340735,
+      "velocityY": -1.5810996022432426,
+      "timestamp": 10.00581871426786
+    },
+    {
+      "x": 4.455850074444798,
+      "y": 1.936621120126799,
+      "heading": 2.6686369840979474,
+      "angularVelocity": 0.7579150176732569,
+      "velocityX": 2.755908219363514,
+      "velocityY": -1.3886203344381607,
+      "timestamp": 10.072885733655822
+    },
+    {
+      "x": 4.650912904466248,
+      "y": 1.8602546060912546,
+      "heading": 2.7231836593037944,
+      "angularVelocity": 0.8133159294035703,
+      "velocityX": 2.908476204870152,
+      "velocityY": -1.138659727723825,
+      "timestamp": 10.139952753043783
+    },
+    {
+      "x": 4.852420678438731,
+      "y": 1.8024586285174926,
+      "heading": 2.7803910249763573,
+      "angularVelocity": 0.8529880438198227,
+      "velocityX": 3.004573273292882,
+      "velocityY": -0.8617645170636102,
+      "timestamp": 10.207019772431744
+    },
+    {
+      "x": 5.05760246636137,
+      "y": 1.7639825860583975,
+      "heading": 2.839468056705675,
+      "angularVelocity": 0.8808656217085786,
+      "velocityX": 3.059354505315471,
+      "velocityY": -0.5736954289935475,
+      "timestamp": 10.274086791819705
+    },
+    {
+      "x": 5.264470410929027,
+      "y": 1.7451049209511764,
+      "heading": 2.8998392064876755,
+      "angularVelocity": 0.9001615150477019,
+      "velocityX": 3.0844958737616186,
+      "velocityY": -0.2814746395395884,
+      "timestamp": 10.341153811207667
+    },
+    {
+      "x": 5.4715720463226285,
+      "y": 1.745898973757099,
+      "heading": 2.9610795307026567,
+      "angularVelocity": 0.9131213042393547,
+      "velocityX": 3.0879803110912887,
+      "velocityY": 0.011839691299369801,
+      "timestamp": 10.408220830595628
     },
     {
       "x": 5.677816390991211,
       "y": 1.7663486003875732,
-      "heading": 2.9785400944393525,
-      "angularVelocity": 0.9741021059991204,
-      "velocityX": 3.0749842091763746,
-      "velocityY": 0.3048782675888085,
-      "timestamp": 10.47597793774299
-    },
-    {
-      "x": 5.869498283497575,
-      "y": 1.8026990212845277,
-      "heading": 3.040009892901514,
-      "angularVelocity": 0.978495765710481,
-      "velocityX": 3.051253214963835,
-      "velocityY": 0.5786375393984518,
-      "timestamp": 10.538798647465253
-    },
-    {
-      "x": 6.059212183017009,
-      "y": 1.856199315511381,
-      "heading": 3.101605164447669,
-      "angularVelocity": 0.9804930860933324,
-      "velocityX": 3.019926077852052,
-      "velocityY": 0.8516346673475012,
-      "timestamp": 10.601619357187516
-    },
-    {
-      "x": 6.246366657416464,
-      "y": 1.9267712723501649,
-      "heading": 3.1631385311618336,
-      "angularVelocity": 0.9795076653258243,
-      "velocityX": 2.9791843362942707,
-      "velocityY": 1.12338681225969,
-      "timestamp": 10.66444006690978
-    },
-    {
-      "x": 6.430212631499626,
-      "y": 2.014285410480658,
-      "heading": 3.2243713465018264,
-      "angularVelocity": 0.9747233931407323,
-      "velocityX": 2.92651857796523,
-      "velocityY": 1.3930778324123159,
-      "timestamp": 10.727260776632043
-    },
-    {
-      "x": 6.609777595601999,
-      "y": 2.118521635924677,
-      "heading": 3.284991437728681,
-      "angularVelocity": 0.9649698561965084,
-      "velocityX": 2.858372102070309,
-      "velocityY": 1.6592653267506663,
-      "timestamp": 10.790081486354307
-    },
-    {
-      "x": 6.783764646274751,
-      "y": 2.239091051762057,
-      "heading": 3.3445780348502288,
-      "angularVelocity": 0.9485183689421323,
-      "velocityX": 2.7695811053706194,
-      "velocityY": 1.9192622364572296,
-      "timestamp": 10.85290219607657
-    },
-    {
-      "x": 6.950401684609891,
-      "y": 2.3752716608654083,
-      "heading": 3.402547014524198,
-      "angularVelocity": 0.9227686208935938,
-      "velocityX": 2.6525812756949354,
-      "velocityY": 2.167766166689632,
-      "timestamp": 10.915722905798834
-    },
-    {
-      "x": 7.107252334800024,
-      "y": 2.525651797665975,
-      "heading": 3.4580758800306346,
-      "angularVelocity": 0.8839261089525424,
-      "velocityX": 2.496798442481599,
-      "velocityY": 2.3937987562606944,
-      "timestamp": 10.978543615521097
-    },
-    {
-      "x": 7.25116745034712,
-      "y": 2.6874080724763414,
-      "heading": 3.510064675427793,
-      "angularVelocity": 0.8275741491461444,
-      "velocityX": 2.290886495605672,
-      "velocityY": 2.5748877324931376,
-      "timestamp": 11.04136432524336
-    },
-    {
-      "x": 7.379049043556767,
-      "y": 2.855386112012741,
-      "heading": 3.557350238869835,
-      "angularVelocity": 0.7527066098281388,
-      "velocityX": 2.0356597971437416,
-      "velocityY": 2.673927758521817,
-      "timestamp": 11.104185034965624
-    },
-    {
-      "x": 7.48976542528158,
-      "y": 3.0226940652081797,
-      "heading": 3.5992337594928014,
-      "angularVelocity": 0.666715177337827,
-      "velocityX": 1.7624185115752826,
-      "velocityY": 2.6632611114252915,
-      "timestamp": 11.167005744687888
-    },
-    {
-      "x": 7.584603731721159,
-      "y": 3.183437719649434,
-      "heading": 3.6358032566417093,
-      "angularVelocity": 0.5821248647235219,
-      "velocityX": 1.5096662686376792,
-      "velocityY": 2.558768519997944,
-      "timestamp": 11.229826454410151
-    },
-    {
-      "x": 7.665647899394972,
-      "y": 3.3339132583126054,
-      "heading": 3.66757214697857,
-      "angularVelocity": 0.5057072815209269,
-      "velocityX": 1.2900867887694702,
-      "velocityY": 2.3953173933952745,
-      "timestamp": 11.292647164132415
-    },
-    {
-      "x": 7.734758840021845,
-      "y": 3.4719883665738904,
-      "heading": 3.695057946928366,
-      "angularVelocity": 0.4375276890584947,
-      "velocityX": 1.1001298923940959,
-      "velocityY": 2.1979234057006147,
-      "timestamp": 11.355467873854678
-    },
-    {
-      "x": 7.793387895501397,
-      "y": 3.596402025341782,
-      "heading": 3.7186750616098347,
-      "angularVelocity": 0.37594472883039054,
-      "velocityX": 0.9332759171100913,
-      "velocityY": 1.9804561157926779,
-      "timestamp": 11.418288583576942
-    },
-    {
-      "x": 7.842641745167335,
-      "y": 3.706364225843829,
-      "heading": 3.7387425543728092,
-      "angularVelocity": 0.3194407202926423,
-      "velocityX": 0.7840384147790729,
-      "velocityY": 1.7504132154539842,
-      "timestamp": 11.481109293299205
-    },
-    {
-      "x": 7.883372973162177,
-      "y": 3.801350711025084,
-      "heading": 3.755507752795704,
-      "angularVelocity": 0.26687375066304414,
-      "velocityX": 0.6483726174842498,
-      "velocityY": 1.5120250248875047,
-      "timestamp": 11.543930003021469
-    },
-    {
-      "x": 7.916250955707456,
-      "y": 3.8809958185462916,
-      "heading": 3.7691658139622635,
-      "angularVelocity": 0.21741335344575932,
-      "velocityX": 0.5233621633795045,
-      "velocityY": 1.2678161051240537,
-      "timestamp": 11.606750712743732
-    },
-    {
-      "x": 7.941811781791086,
-      "y": 3.9450337141673115,
-      "heading": 3.7798737136826723,
-      "angularVelocity": 0.1704517470074654,
-      "velocityX": 0.4068853439675645,
-      "velocityY": 1.0193755515360785,
-      "timestamp": 11.669571422465996
-    },
-    {
-      "x": 7.960492791122214,
-      "y": 3.993264403965962,
-      "heading": 3.7877599997554308,
-      "angularVelocity": 0.12553640523363524,
-      "velocityX": 0.2973702368807853,
-      "velocityY": 0.7677514312061038,
-      "timestamp": 11.73239213218826
-    },
-    {
-      "x": 7.972656678308661,
-      "y": 4.025533086521562,
-      "heading": 3.7929316378195392,
-      "angularVelocity": 0.08232377645800033,
-      "velocityX": 0.19362861769987666,
-      "velocityY": 0.5136631327195069,
-      "timestamp": 11.795212841910523
+      "heading": 3.022867248231808,
+      "angularVelocity": 0.9212831894575391,
+      "velocityX": 3.0751977134323645,
+      "velocityY": 0.30491330637760916,
+      "timestamp": 10.475287849983589
+    },
+    {
+      "x": 5.869498315560729,
+      "y": 1.8026975491019477,
+      "heading": 3.0809998241533054,
+      "angularVelocity": 0.9254361464923138,
+      "velocityX": 3.051462606188219,
+      "velocityY": 0.5786537151338974,
+      "timestamp": 10.538104259459097
+    },
+    {
+      "x": 6.0592123423789275,
+      "y": 1.8561940082480726,
+      "heading": 3.1392509157059085,
+      "angularVelocity": 0.9273228450810435,
+      "velocityX": 3.0201348405971915,
+      "velocityY": 0.8516319158130763,
+      "timestamp": 10.600920668934604
+    },
+    {
+      "x": 6.246367362862811,
+      "y": 1.9267598042730498,
+      "heading": 3.197443332957825,
+      "angularVelocity": 0.9263887849974373,
+      "velocityX": 2.9793969767860897,
+      "velocityY": 1.1233656398729925,
+      "timestamp": 10.663737078410112
+    },
+    {
+      "x": 6.430214724431651,
+      "y": 2.014265565864972,
+      "heading": 3.25535141192564,
+      "angularVelocity": 0.9218622880760795,
+      "velocityX": 2.9267410077063314,
+      "velocityY": 1.393039849341311,
+      "timestamp": 10.726553487885619
+    },
+    {
+      "x": 6.609782474245099,
+      "y": 2.11849145104989,
+      "heading": 3.312679976603456,
+      "angularVelocity": 0.9126367641271997,
+      "velocityX": 2.8586121256017254,
+      "velocityY": 1.6592143049111507,
+      "timestamp": 10.789369897361127
+    },
+    {
+      "x": 6.783774433001653,
+      "y": 2.2390490978953044,
+      "heading": 3.3690311941233704,
+      "angularVelocity": 0.8970779767647533,
+      "velocityX": 2.7698488374187553,
+      "velocityY": 1.9192062687444857,
+      "timestamp": 10.852186306836634
+    },
+    {
+      "x": 6.9504193672294985,
+      "y": 2.3752176143671733,
+      "heading": 3.4238528114702502,
+      "angularVelocity": 0.8727276487882547,
+      "velocityX": 2.652888562387848,
+      "velocityY": 2.1677220587553996,
+      "timestamp": 10.915002716312141
+    },
+    {
+      "x": 7.107281588598214,
+      "y": 2.52558752514108,
+      "heading": 3.476367044923788,
+      "angularVelocity": 0.8359954650705317,
+      "velocityX": 2.4971535730624357,
+      "velocityY": 2.393799837167353,
+      "timestamp": 10.977819125787649
+    },
+    {
+      "x": 7.251211218612922,
+      "y": 2.6873391007207674,
+      "heading": 3.5255323995870227,
+      "angularVelocity": 0.7826833000126306,
+      "velocityX": 2.2912743854108286,
+      "velocityY": 2.5749891935920948,
+      "timestamp": 11.040635535263156
+    },
+    {
+      "x": 7.379106119935948,
+      "y": 2.855321266683036,
+      "heading": 3.570245943801856,
+      "angularVelocity": 0.7118131167982105,
+      "velocityX": 2.036011010353802,
+      "velocityY": 2.6741764988616117,
+      "timestamp": 11.103451944738664
+    },
+    {
+      "x": 7.489828992967153,
+      "y": 3.0226403080656628,
+      "heading": 3.6098523077969857,
+      "angularVelocity": 0.6305098353412365,
+      "velocityX": 1.7626424998770196,
+      "velocityY": 2.6636199486674914,
+      "timestamp": 11.166268354214171
+    },
+    {
+      "x": 7.5846664001825115,
+      "y": 3.1833964842133824,
+      "heading": 3.6444385665610812,
+      "angularVelocity": 0.5505927360840481,
+      "velocityX": 1.5097553013171952,
+      "velocityY": 2.5591430247282747,
+      "timestamp": 11.229084763689679
+    },
+    {
+      "x": 7.6657049690486385,
+      "y": 3.333883053307194,
+      "heading": 3.6744875788552074,
+      "angularVelocity": 0.4783624620544796,
+      "velocityX": 1.2900859750305362,
+      "velocityY": 2.3956569684628017,
+      "timestamp": 11.291901173165186
+    },
+    {
+      "x": 7.7348079326686,
+      "y": 3.471967025062567,
+      "heading": 3.7004866328547554,
+      "angularVelocity": 0.4138895269027619,
+      "velocityX": 1.1000782151820558,
+      "velocityY": 2.1982149713477863,
+      "timestamp": 11.354717582640694
+    },
+    {
+      "x": 7.793428112313008,
+      "y": 3.5963874907480546,
+      "heading": 3.7228267453311363,
+      "angularVelocity": 0.3556413469491874,
+      "velocityX": 0.9331985086996176,
+      "velocityY": 1.980700054720585,
+      "timestamp": 11.417533992116201
+    },
+    {
+      "x": 7.8426730977585235,
+      "y": 3.7063547510103105,
+      "heading": 3.7418093512359456,
+      "angularVelocity": 0.30219183272820804,
+      "velocityX": 0.783950974859778,
+      "velocityY": 1.7506135925379998,
+      "timestamp": 11.480350401591709
+    },
+    {
+      "x": 7.883396045766907,
+      "y": 3.8013448757169503,
+      "heading": 3.757668265765805,
+      "angularVelocity": 0.25246451782703877,
+      "velocityX": 0.6482851908984306,
+      "velocityY": 1.5121864732443446,
+      "timestamp": 11.543166811067216
+    },
+    {
+      "x": 7.916266704646568,
+      "y": 3.8809924971435787,
+      "heading": 3.7705880432506556,
+      "angularVelocity": 0.20567519845093782,
+      "velocityX": 0.5232814029664861,
+      "velocityY": 1.2679429163757567,
+      "timestamp": 11.605983220542724
+    },
+    {
+      "x": 7.941821412998917,
+      "y": 3.9450320342824847,
+      "heading": 3.7807171527629357,
+      "angularVelocity": 0.16124941869257636,
+      "velocityX": 0.4068158076165283,
+      "velocityY": 1.0194714673062533,
+      "timestamp": 11.668799630018231
+    },
+    {
+      "x": 7.960497682770524,
+      "y": 3.993263707972552,
+      "heading": 3.7881771819141687,
+      "angularVelocity": 0.11875924163003808,
+      "velocityX": 0.29731514308994755,
+      "velocityY": 0.7678196524249489,
+      "timestamp": 11.731616039493739
+    },
+    {
+      "x": 7.972658330298564,
+      "y": 4.0255328988210515,
+      "heading": 3.7930693040909933,
+      "angularVelocity": 0.0778796849051358,
+      "velocityX": 0.19359029956625398,
+      "velocityY": 0.513706388472933,
+      "timestamp": 11.794432448969246
     },
     {
       "x": 7.97860860824585,
       "y": 4.041717052459717,
       "heading": 3.7954788959034658,
-      "angularVelocity": 0.04054806281539965,
-      "velocityX": 0.09474471019991201,
-      "velocityY": 0.2576215074567916,
-      "timestamp": 11.858033551632786
+      "angularVelocity": 0.038359273199338115,
+      "velocityX": 0.09472489747453801,
+      "velocityY": 0.257642131630843,
+      "timestamp": 11.857248858444754
     },
     {
       "x": 7.97860860824585,
       "y": 4.041717052459717,
       "heading": 3.7954788959034658,
-      "angularVelocity": 1.081663947501335e-26,
-      "velocityX": -9.481769134483666e-28,
-      "velocityY": -9.233714768009215e-27,
-      "timestamp": 11.92085426135505
-    },
-    {
-      "x": 7.973189079938411,
-      "y": 4.026463842839712,
-      "heading": 3.793127862432137,
-      "angularVelocity": -0.03862699851561016,
-      "velocityX": -0.08904174034085098,
-      "velocityY": -0.25060711067509717,
-      "timestamp": 11.981719292594244
-    },
-    {
-      "x": 7.96211997120059,
-      "y": 3.996042186549112,
-      "heading": 3.788358107501387,
-      "angularVelocity": -0.07836609681518215,
-      "velocityX": -0.1818631899541847,
-      "velocityY": -0.49982158344823596,
-      "timestamp": 12.042584323833438
-    },
-    {
-      "x": 7.945132814358059,
-      "y": 3.9505560796650534,
-      "heading": 3.7810908608062244,
-      "angularVelocity": -0.11939937509606813,
-      "velocityX": -0.27909550848290027,
-      "velocityY": -0.7473274219691394,
-      "timestamp": 12.103449355072632
-    },
-    {
-      "x": 7.921910586758543,
-      "y": 3.890135520000167,
-      "heading": 3.7712333978408124,
-      "angularVelocity": -0.16195609802076888,
-      "velocityX": -0.3815364442721711,
-      "velocityY": -0.9926974230480341,
-      "timestamp": 12.164314386311826
-    },
-    {
-      "x": 7.892073849640702,
-      "y": 3.8149466158138026,
-      "heading": 3.7586751345824734,
-      "angularVelocity": -0.20632969379389762,
-      "velocityX": -0.4902114812129911,
-      "velocityY": -1.2353382994395923,
-      "timestamp": 12.22517941755102
-    },
-    {
-      "x": 7.855161431332755,
-      "y": 3.7252072224578345,
-      "heading": 3.743282218448319,
-      "angularVelocity": -0.2529024600950483,
-      "velocityX": -0.606463474287625,
-      "velocityY": -1.4743998570098393,
-      "timestamp": 12.286044448790214
-    },
-    {
-      "x": 7.810603011221402,
-      "y": 3.6212121261116588,
-      "heading": 3.7248899061541354,
-      "angularVelocity": -0.3021819248215532,
-      "velocityX": -0.7320857182549075,
-      "velocityY": -1.7086181380156253,
-      "timestamp": 12.346909480029408
-    },
-    {
-      "x": 7.75767969326837,
-      "y": 3.503375512839711,
-      "heading": 3.703291696041228,
-      "angularVelocity": -0.35485416951530235,
-      "velocityX": -0.8695192769235301,
-      "velocityY": -1.9360314267951175,
-      "timestamp": 12.407774511268602
-    },
-    {
-      "x": 7.695467478966328,
-      "y": 3.372306326826921,
-      "heading": 3.678223928018662,
-      "angularVelocity": -0.41185829551375247,
-      "velocityX": -1.0221339418615227,
-      "velocityY": -2.1534398873089917,
-      "timestamp": 12.468639542507796
-    },
-    {
-      "x": 7.622760415809598,
-      "y": 3.2289490492757267,
-      "heading": 3.6493453622484107,
-      "angularVelocity": -0.4744689221757036,
-      "velocityX": -1.1945621595263345,
-      "velocityY": -2.3553307150671072,
-      "timestamp": 12.52950457374699
-    },
-    {
-      "x": 7.537989170266957,
-      "y": 3.074856416210723,
-      "heading": 3.6162182235150375,
-      "angularVelocity": -0.5442721059845679,
-      "velocityX": -1.3927742057585912,
-      "velocityY": -2.5317104078930326,
-      "timestamp": 12.590369604986185
-    },
-    {
-      "x": 7.439241543844895,
-      "y": 2.912701143314702,
-      "heading": 3.5783337834184628,
-      "angularVelocity": -0.6224335932350433,
-      "velocityX": -1.6224032816805989,
-      "velocityY": -2.664177929339482,
-      "timestamp": 12.651234636225379
-    },
-    {
-      "x": 7.324766462909669,
-      "y": 2.746988913544774,
-      "heading": 3.5353421357377637,
-      "angularVelocity": -0.706343968045381,
-      "velocityX": -1.880802138839768,
-      "velocityY": -2.722618002423959,
-      "timestamp": 12.712099667464573
-    },
-    {
-      "x": 7.194385716013789,
-      "y": 2.583976737212008,
-      "heading": 3.4875425161473705,
-      "angularVelocity": -0.7853379619989738,
-      "velocityX": -2.1421289735890285,
-      "velocityY": -2.6782566773381076,
-      "timestamp": 12.772964698703767
-    },
-    {
-      "x": 7.050272925938226,
-      "y": 2.4294807954441997,
-      "heading": 3.4358824464756204,
-      "angularVelocity": -0.8487643663359049,
-      "velocityX": -2.3677436311370705,
-      "velocityY": -2.5383366872950677,
-      "timestamp": 12.833829729942961
-    },
-    {
-      "x": 6.895473593565761,
-      "y": 2.287134578977517,
-      "heading": 3.3814523385529762,
-      "angularVelocity": -0.8942755275806573,
-      "velocityX": -2.5433213328046476,
-      "velocityY": -2.3387191884823553,
-      "timestamp": 12.894694761182155
-    },
-    {
-      "x": 6.732591084116293,
-      "y": 2.1588201874781916,
-      "heading": 3.3251409447097355,
-      "angularVelocity": -0.9251846700273916,
-      "velocityX": -2.6761262769972647,
-      "velocityY": -2.108179177548776,
-      "timestamp": 12.955559792421349
-    },
-    {
-      "x": 6.563562240961557,
-      "y": 2.0454941987485715,
-      "heading": 3.26759140242196,
-      "angularVelocity": -0.9455271954369048,
-      "velocityX": -2.7771092811973754,
-      "velocityY": -1.8619227891998904,
-      "timestamp": 13.016424823660543
-    },
-    {
-      "x": 6.389800863403908,
-      "y": 1.9476641851905458,
-      "heading": 3.209264282654608,
-      "angularVelocity": -0.9583026342027352,
-      "velocityX": -2.854863852361817,
-      "velocityY": -1.6073270902229824,
-      "timestamp": 13.077289854899737
-    },
-    {
-      "x": 6.212356894659494,
-      "y": 1.8656139570355461,
-      "heading": 3.1504971848650327,
-      "angularVelocity": -0.9655313830140856,
-      "velocityX": -2.915368071480525,
-      "velocityY": -1.3480684472591271,
-      "timestamp": 13.138154886138931
-    },
-    {
-      "x": 6.032030314899095,
-      "y": 1.7995095607928446,
-      "heading": 3.0915449896362426,
-      "angularVelocity": -0.9685724960382134,
-      "velocityX": -2.9627287802043525,
-      "velocityY": -1.086081694149083,
-      "timestamp": 13.199019917378125
-    },
-    {
-      "x": 5.849446338451813,
-      "y": 1.7494515528487504,
-      "heading": 3.032605568444944,
-      "angularVelocity": -0.9683626212179334,
-      "velocityX": -2.9998173455254054,
-      "velocityY": -0.8224428202027946,
-      "timestamp": 13.25988494861732
+      "angularVelocity": 2.7641446763079204e-28,
+      "velocityX": -4.8321001161270604e-27,
+      "velocityY": -6.381302523611655e-27,
+      "timestamp": 11.920065267920261
+    },
+    {
+      "x": 7.9731832513294965,
+      "y": 4.026487402904062,
+      "heading": 3.7932364227144895,
+      "angularVelocity": -0.0368681350379896,
+      "velocityX": -0.08919740597331677,
+      "velocityY": -0.25038817817727327,
+      "timestamp": 11.980889423703179
+    },
+    {
+      "x": 7.962103008768326,
+      "y": 3.996112792343719,
+      "heading": 3.788687152758471,
+      "angularVelocity": -0.07479380350554962,
+      "velocityX": -0.18216845624155484,
+      "velocityY": -0.4993840057353227,
+      "timestamp": 12.041713579486096
+    },
+    {
+      "x": 7.945100079421275,
+      "y": 3.950697091129024,
+      "heading": 3.7817562440819508,
+      "angularVelocity": -0.1139499362926918,
+      "velocityX": -0.27954238128244496,
+      "velocityY": -0.7466721178471404,
+      "timestamp": 12.102537735269014
+    },
+    {
+      "x": 7.92185830417986,
+      "y": 3.890370089672628,
+      "heading": 3.772355616140964,
+      "angularVelocity": -0.1545541869012955,
+      "velocityX": -0.3821142265313985,
+      "velocityY": -0.9918263670062992,
+      "timestamp": 12.163361891051931
+    },
+    {
+      "x": 7.891999384931547,
+      "y": 3.8152975554838595,
+      "heading": 3.760380253516664,
+      "angularVelocity": -0.19688497884031883,
+      "velocityX": -0.49090560919382475,
+      "velocityY": -1.2342552596488783,
+      "timestamp": 12.224186046834848
+    },
+    {
+      "x": 7.85506368954834,
+      "y": 3.72569677838064,
+      "heading": 3.745703091329558,
+      "angularVelocity": -0.24130482368698247,
+      "velocityX": -0.6072537285191664,
+      "velocityY": -1.4731117259236042,
+      "timestamp": 12.285010202617766
+    },
+    {
+      "x": 7.810483024689109,
+      "y": 3.6218615851815734,
+      "heading": 3.7281678174840622,
+      "angularVelocity": -0.2882945701388696,
+      "velocityX": -0.7329434216619469,
+      "velocityY": -1.7071374335166476,
+      "timestamp": 12.345834358400683
+    },
+    {
+      "x": 7.75754150465543,
+      "y": 3.5042044804582817,
+      "heading": 3.707578629757375,
+      "angularVelocity": -0.338503468920643,
+      "velocityX": -0.8704028745195956,
+      "velocityY": -1.9343812208953974,
+      "timestamp": 12.4066585141836
+    },
+    {
+      "x": 7.695319475194805,
+      "y": 3.373331333274469,
+      "heading": 3.6836857657148254,
+      "angularVelocity": -0.3928186710527244,
+      "velocityX": -1.0229822125718777,
+      "velocityY": -2.1516640140621313,
+      "timestamp": 12.467482669966518
+    },
+    {
+      "x": 7.6226172615317065,
+      "y": 3.2301807206906474,
+      "heading": 3.656166422928496,
+      "angularVelocity": -0.45244101512146395,
+      "velocityX": -1.195285207452349,
+      "velocityY": -2.3535158152417135,
+      "timestamp": 12.528306825749436
+    },
+    {
+      "x": 7.537874056741358,
+      "y": 3.0762935692392714,
+      "heading": 3.624607309055113,
+      "angularVelocity": -0.5188582310294256,
+      "velocityX": -1.3932491737788937,
+      "velocityY": -2.5300334952547887,
+      "timestamp": 12.589130981532353
+    },
+    {
+      "x": 7.439186116305785,
+      "y": 2.9143192742653987,
+      "heading": 3.5885289471098396,
+      "angularVelocity": -0.593158449646844,
+      "velocityX": -1.622512292448285,
+      "velocityY": -2.662992899596701,
+      "timestamp": 12.64995513731527
+    },
+    {
+      "x": 7.324799462619061,
+      "y": 2.7487257316338787,
+      "heading": 3.5475979292802173,
+      "angularVelocity": -0.6729401715940964,
+      "velocityX": -1.880612270147605,
+      "velocityY": -2.7224963585606825,
+      "timestamp": 12.710779293098188
+    },
+    {
+      "x": 7.194507340242676,
+      "y": 2.585740156358662,
+      "heading": 3.5020835972715822,
+      "angularVelocity": -0.7482936906033946,
+      "velocityX": -2.1421114802053443,
+      "velocityY": -2.6796191936788247,
+      "timestamp": 12.771603448881105
+    },
+    {
+      "x": 7.0504536551705375,
+      "y": 2.431188888490648,
+      "heading": 3.452877836818068,
+      "angularVelocity": -0.8089838620881198,
+      "velocityX": -2.3683630823626802,
+      "velocityY": -2.540952124672488,
+      "timestamp": 12.832427604664023
+    },
+    {
+      "x": 6.895679700680455,
+      "y": 2.28873114154361,
+      "heading": 3.4010206368377873,
+      "angularVelocity": -0.8525757458165169,
+      "velocityX": -2.5446132790148983,
+      "velocityY": -2.3421245245963243,
+      "timestamp": 12.89325176044694
+    },
+    {
+      "x": 6.732796621571605,
+      "y": 2.160266132765056,
+      "heading": 3.3473624043780283,
+      "angularVelocity": -0.8821862263286692,
+      "velocityX": -2.6779340709665105,
+      "velocityY": -2.1120722042908184,
+      "timestamp": 12.954075916229858
+    },
+    {
+      "x": 6.563749580215948,
+      "y": 2.0467591756877423,
+      "heading": 3.2925189413234834,
+      "angularVelocity": -0.9016724087430362,
+      "velocityX": -2.7792747664100683,
+      "velocityY": -1.8661493220295844,
+      "timestamp": 13.014900072012775
+    },
+    {
+      "x": 6.3899587104320545,
+      "y": 1.9487221444905019,
+      "heading": 3.236931228275579,
+      "angularVelocity": -0.9139085011931405,
+      "velocityX": -2.8572672739455114,
+      "velocityY": -1.6118108000896318,
+      "timestamp": 13.075724227795693
+    },
+    {
+      "x": 6.212478467014217,
+      "y": 1.8664410195309742,
+      "heading": 3.1809224189873455,
+      "angularVelocity": -0.9208316756278593,
+      "velocityX": -2.9179236626196454,
+      "velocityY": -1.3527705218497519,
+      "timestamp": 13.13654838357861
+    },
+    {
+      "x": 6.032112039259563,
+      "y": 1.8000829772107247,
+      "heading": 3.124736406673497,
+      "angularVelocity": -0.9237450415979039,
+      "velocityX": -2.96537494738743,
+      "velocityY": -1.090981723726388,
+      "timestamp": 13.197372539361528
+    },
+    {
+      "x": 5.849486965098296,
+      "y": 1.749749174951984,
+      "heading": 3.0685624701789247,
+      "angularVelocity": -0.9235465050276829,
+      "velocityX": -3.0025089836521532,
+      "velocityY": -0.827529812964159,
+      "timestamp": 13.258196695144445
     },
     {
       "x": 5.665104866027832,
       "y": 1.7155022621154783,
-      "heading": 2.9738363314411114,
-      "angularVelocity": -0.9655665298662963,
-      "velocityX": -3.028692644542217,
-      "velocityY": -0.5577798949918237,
-      "timestamp": 13.320749979856513
-    },
-    {
-      "x": 5.449668901780852,
-      "y": 1.6978455407032218,
-      "heading": 2.906132119432981,
-      "angularVelocity": -0.959891751531484,
-      "velocityX": -3.0543920227455827,
-      "velocityY": -0.250332154234056,
-      "timestamp": 13.391283153935893
-    },
-    {
-      "x": 5.233414974096308,
-      "y": 1.7019335435723504,
-      "heading": 2.8391383653684743,
-      "angularVelocity": -0.9498190736335087,
-      "velocityX": -3.0659888840557348,
-      "velocityY": 0.057958583637934886,
-      "timestamp": 13.461816328015273
-    },
-    {
-      "x": 5.01765545620336,
-      "y": 1.727774331810827,
-      "heading": 2.77326134838151,
-      "angularVelocity": -0.9339862815875167,
-      "velocityX": -3.0589792776109848,
-      "velocityY": 0.36636360940449214,
-      "timestamp": 13.532349502094652
-    },
-    {
-      "x": 4.80417702272647,
-      "y": 1.7752501139947119,
-      "heading": 2.7090489373906985,
-      "angularVelocity": -0.910385954253894,
-      "velocityX": -3.0266386882949394,
-      "velocityY": 0.6730986206640174,
-      "timestamp": 13.602882676174032
-    },
-    {
-      "x": 4.59548781041016,
-      "y": 1.843939818969414,
-      "heading": 2.6472607773678716,
-      "angularVelocity": -0.8760155888247669,
-      "velocityX": -2.958738424013771,
-      "velocityY": 0.9738638005628106,
-      "timestamp": 13.673415850253411
-    },
-    {
-      "x": 4.395161877372632,
-      "y": 1.9326893621825305,
-      "heading": 2.58896223762384,
-      "angularVelocity": -0.82654070945995,
-      "velocityX": -2.8401661438357806,
-      "velocityY": 1.2582666861587242,
-      "timestamp": 13.74394902433279
-    },
-    {
-      "x": 4.208052213977568,
-      "y": 2.0386582351477758,
-      "heading": 2.5355600028021983,
-      "angularVelocity": -0.7571222409690838,
-      "velocityX": -2.652789497102312,
-      "velocityY": 1.502397621380076,
-      "timestamp": 13.81448219841217
-    },
-    {
-      "x": 4.039383008540803,
-      "y": 2.156012297087957,
-      "heading": 2.488408609997161,
-      "angularVelocity": -0.6684995170070284,
-      "velocityX": -2.3913457410401313,
-      "velocityY": 1.6638137085410236,
-      "timestamp": 13.88501537249155
-    },
-    {
-      "x": 3.892137754898665,
-      "y": 2.2765348326064325,
-      "heading": 2.447990164035441,
-      "angularVelocity": -0.5730416430179723,
-      "velocityX": -2.087602827520932,
-      "velocityY": 1.708735458053227,
-      "timestamp": 13.95554854657093
-    },
-    {
-      "x": 3.766164166080398,
-      "y": 2.3929352805610016,
-      "heading": 2.4139692777566655,
-      "angularVelocity": -0.48233879621649,
-      "velocityX": -1.786018996911929,
-      "velocityY": 1.6502936309596794,
-      "timestamp": 14.026081720650309
-    },
-    {
-      "x": 3.6599405750653324,
-      "y": 2.5003798939702526,
-      "heading": 2.3856988855870287,
-      "angularVelocity": -0.40080986767759647,
-      "velocityX": -1.5060089440398745,
-      "velocityY": 1.5233202647073794,
-      "timestamp": 14.096614894729688
-    },
-    {
-      "x": 3.571849727372911,
-      "y": 2.5959017093772516,
-      "heading": 2.3625508713896815,
-      "angularVelocity": -0.328186197480587,
-      "velocityX": -1.2489278816983742,
-      "velocityY": 1.3542821041840187,
-      "timestamp": 14.167148068809068
-    },
-    {
-      "x": 3.5005309804136506,
-      "y": 2.677634460422761,
-      "heading": 2.3440149762008446,
-      "angularVelocity": -0.26279683894525624,
-      "velocityX": -1.0111376368657052,
-      "velocityY": 1.1587845309999307,
-      "timestamp": 14.237681242888447
-    },
-    {
-      "x": 3.444898984368672,
-      "y": 2.7443434037076186,
-      "heading": 2.3296936875946765,
-      "angularVelocity": -0.20304330257491268,
-      "velocityX": -0.7887351841329246,
-      "velocityY": 0.9457811045024435,
-      "timestamp": 14.308214416967827
-    },
-    {
-      "x": 3.404091793996619,
-      "y": 2.7951695430879604,
-      "heading": 2.319276755671779,
-      "angularVelocity": -0.14768840419933443,
-      "velocityX": -0.5785531546634841,
-      "velocityY": 0.720599066237137,
-      "timestamp": 14.378747591047206
-    },
-    {
-      "x": 3.377417673658437,
-      "y": 2.8294887518678977,
-      "heading": 2.3125184133536703,
-      "angularVelocity": -0.09581792406652051,
-      "velocityX": -0.3781783633919927,
-      "velocityY": 0.4865683308298885,
-      "timestamp": 14.449280765126586
+      "heading": 3.0125511385109696,
+      "angularVelocity": -0.9208731456604314,
+      "velocityX": -3.031395942896885,
+      "velocityY": -0.5630478943059016,
+      "timestamp": 13.319020850927362
+    },
+    {
+      "x": 5.4364501501141,
+      "y": 1.6977707730417206,
+      "heading": 2.944139623228989,
+      "angularVelocity": -0.9151171979283065,
+      "velocityX": -3.058635115120499,
+      "velocityY": -0.23718800160164863,
+      "timestamp": 13.393777959018932
+    },
+    {
+      "x": 5.206960377408042,
+      "y": 1.7044694351689678,
+      "heading": 2.876515284948492,
+      "angularVelocity": -0.9045874032160918,
+      "velocityX": -3.069805381248256,
+      "velocityY": 0.08960568831851862,
+      "timestamp": 13.468535067110501
+    },
+    {
+      "x": 4.978251239441715,
+      "y": 1.735598056307952,
+      "heading": 2.8101543423117734,
+      "angularVelocity": -0.88768739629994,
+      "velocityX": -3.059363100110605,
+      "velocityY": 0.41639680738927637,
+      "timestamp": 13.54329217520207
+    },
+    {
+      "x": 4.752574161124427,
+      "y": 1.7909760209909795,
+      "heading": 2.745713503987336,
+      "angularVelocity": -0.8620028244739498,
+      "velocityX": -3.0188042860199698,
+      "velocityY": 0.7407718957666946,
+      "timestamp": 13.61804928329364
+    },
+    {
+      "x": 4.5331713643671705,
+      "y": 1.86996361407104,
+      "heading": 2.6841254526244476,
+      "angularVelocity": -0.8238420791699165,
+      "velocityX": -2.934875389889497,
+      "velocityY": 1.0565897356985674,
+      "timestamp": 13.69280639138521
+    },
+    {
+      "x": 4.324741325186423,
+      "y": 1.9707561474332134,
+      "heading": 2.6267153184834644,
+      "angularVelocity": -0.767955524318328,
+      "velocityX": -2.7880966038098087,
+      "velocityY": 1.3482668863904335,
+      "timestamp": 13.767563499476779
+    },
+    {
+      "x": 4.133456760500775,
+      "y": 2.0888763146698124,
+      "heading": 2.575139560935057,
+      "angularVelocity": -0.6899110849129252,
+      "velocityX": -2.558747516708982,
+      "velocityY": 1.5800526565569466,
+      "timestamp": 13.842320607568348
+    },
+    {
+      "x": 3.9648313060513067,
+      "y": 2.215896432204998,
+      "heading": 2.5306079426062213,
+      "angularVelocity": -0.5956840689221082,
+      "velocityX": -2.2556444297299487,
+      "velocityY": 1.6991042160111327,
+      "timestamp": 13.917077715659918
+    },
+    {
+      "x": 3.8205343209977376,
+      "y": 2.3421025100473667,
+      "heading": 2.493194959981666,
+      "angularVelocity": -0.5004605392002106,
+      "velocityX": -1.930210902176966,
+      "velocityY": 1.6882150883602955,
+      "timestamp": 13.991834823751487
+    },
+    {
+      "x": 3.699264664656396,
+      "y": 2.4603619153467347,
+      "heading": 2.4622728561260585,
+      "angularVelocity": -0.413634297058835,
+      "velocityX": -1.6221822838946542,
+      "velocityY": 1.5819151960040088,
+      "timestamp": 14.066591931843057
+    },
+    {
+      "x": 3.5990570492993528,
+      "y": 2.5663446289225074,
+      "heading": 2.437087858484135,
+      "angularVelocity": -0.336891009896672,
+      "velocityX": -1.3404426403747447,
+      "velocityY": 1.417694133458925,
+      "timestamp": 14.141349039934626
+    },
+    {
+      "x": 3.5181735452870257,
+      "y": 2.6574416406371975,
+      "heading": 2.4170079069842205,
+      "angularVelocity": -0.2686025718827755,
+      "velocityX": -1.0819506810409738,
+      "velocityY": 1.2185732439396435,
+      "timestamp": 14.216106148026196
+    },
+    {
+      "x": 3.4552317701509287,
+      "y": 2.7319987511114388,
+      "heading": 2.4015458699114443,
+      "angularVelocity": -0.20683032647326308,
+      "velocityX": -0.84195037425739,
+      "velocityY": 0.9973247009891939,
+      "timestamp": 14.290863256117765
+    },
+    {
+      "x": 3.409149587958946,
+      "y": 2.7889049301174764,
+      "heading": 2.3903286620169495,
+      "angularVelocity": -0.15004871350500593,
+      "velocityX": -0.616425425867687,
+      "velocityY": 0.7612142906375352,
+      "timestamp": 14.365620364209335
+    },
+    {
+      "x": 3.379072144956023,
+      "y": 2.827375131876985,
+      "heading": 2.383066118245118,
+      "angularVelocity": -0.09714853820904662,
+      "velocityX": -0.4023355607346594,
+      "velocityY": 0.5146025942093229,
+      "timestamp": 14.440377472300904
     },
     {
       "x": 3.3643133640289307,
       "y": 2.8468308448791504,
-      "heading": 2.309220505183218,
-      "angularVelocity": -0.046756837665363614,
-      "velocityX": -0.18578930837223656,
-      "velocityY": 0.24587143904421285,
-      "timestamp": 14.519813939205966
+      "heading": 2.3795279978377377,
+      "angularVelocity": -0.0473282139679155,
+      "velocityX": -0.19742311204728097,
+      "velocityY": 0.26025234922589974,
+      "timestamp": 14.515134580392473
     },
     {
       "x": 3.3643133640289307,
       "y": 2.8468308448791504,
-      "heading": 2.309220505183218,
-      "angularVelocity": 1.5317015602458727e-25,
-      "velocityX": -2.505849102759169e-26,
-      "velocityY": 2.1276220109101717e-26,
-      "timestamp": 14.590347113285345
+      "heading": 2.3795279978377377,
+      "angularVelocity": 2.4866807892758145e-28,
+      "velocityX": 1.5094963977000519e-27,
+      "velocityY": 1.0159722407732268e-27,
+      "timestamp": 14.589891688484043
     }
   ],
   "eventMarkers": []
diff --git a/trajectories.chor b/trajectories.chor
index 2ab390e..9cf3ac0 100644
--- a/trajectories.chor
+++ b/trajectories.chor
@@ -4253,7 +4253,7 @@
             "usesDefaultFieldObstacles": true,
             "circleObstacles": [],
             "eventMarkers": [],
-            "isTrajectoryStale": false
+            "isTrajectoryStale": true
         },
         "345": {
             "waypoints": [
@@ -8779,7 +8779,7 @@
                 {
                     "x": 3.3396942615509033,
                     "y": 2.857861280441284,
-                    "heading": 2.256856869928089,
+                    "heading": 2.287543209286567,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,
@@ -8815,7 +8815,7 @@
                 {
                     "x": 3.3396942615509033,
                     "y": 2.877351999282837,
-                    "heading": 2.2954707540735027,
+                    "heading": 2.3769046726239993,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,
@@ -8846,12 +8846,12 @@
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": false,
-                    "controlIntervalCount": 18
+                    "controlIntervalCount": 17
                 },
                 {
                     "x": 3.3643133640289307,
                     "y": 2.8468308448791504,
-                    "heading": 2.3092205051832186,
+                    "heading": 2.3795279978377377,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,
@@ -8863,1909 +8863,1900 @@
                     "x": 1.3906110525131226,
                     "y": 3.773930549621582,
                     "heading": 2.146011906845138,
-                    "angularVelocity": -4.607415814404034e-24,
-                    "velocityX": -1.7254345385809295e-24,
-                    "velocityY": -1.05174879071868e-23,
+                    "angularVelocity": 5.794330982484493e-26,
+                    "velocityX": -7.992490165005739e-26,
+                    "velocityY": -3.398096319318013e-26,
                     "timestamp": 0
                 },
                 {
-                    "x": 1.4188356238691378,
-                    "y": 3.760942213943607,
-                    "heading": 2.153530791915604,
-                    "angularVelocity": 0.08908449280361179,
-                    "velocityX": 0.33440750859809526,
-                    "velocityY": -0.15388708370877877,
-                    "timestamp": 0.08440172732465938
-                },
-                {
-                    "x": 1.475288932367314,
-                    "y": 3.734962941794519,
-                    "heading": 2.168364325366795,
-                    "angularVelocity": 0.17574916913882777,
-                    "velocityX": 0.6688643738418175,
-                    "velocityY": -0.30780498187147287,
-                    "timestamp": 0.16880345464931876
-                },
-                {
-                    "x": 1.5599758288607513,
-                    "y": 3.695989670782734,
-                    "heading": 2.1902666180765573,
-                    "angularVelocity": 0.2595005268732581,
-                    "velocityX": 1.0033787124720934,
-                    "velocityY": -0.4617591635520705,
-                    "timestamp": 0.2532051819739781
-                },
-                {
-                    "x": 1.6729020410079392,
-                    "y": 3.6440187494301686,
-                    "heading": 2.218934937634643,
-                    "angularVelocity": 0.3396650811162915,
-                    "velocityX": 1.3379609129657555,
-                    "velocityY": -0.6157566083055958,
-                    "timestamp": 0.3376069092986375
-                },
-                {
-                    "x": 1.8140744209466089,
-                    "y": 3.5790457513290828,
-                    "heading": 2.2539866117999128,
-                    "angularVelocity": 0.41529569685748813,
-                    "velocityX": 1.6726242982639008,
-                    "velocityY": -0.7698064975751115,
-                    "timestamp": 0.4220086366232969
-                },
-                {
-                    "x": 1.9835012543622998,
-                    "y": 3.5010652014864134,
-                    "heading": 2.294922249726516,
-                    "angularVelocity": 0.48500948054226534,
-                    "velocityX": 2.0073858531825324,
-                    "velocityY": -0.9239212551031034,
-                    "timestamp": 0.5064103639479562
-                },
-                {
-                    "x": 2.1811926014666385,
-                    "y": 3.410070177872789,
-                    "heading": 2.3410635990000292,
-                    "angularVelocity": 0.5466872626436459,
-                    "velocityX": 2.342266602481963,
-                    "velocityY": -1.078118025518638,
-                    "timestamp": 0.5908120912726156
-                },
-                {
-                    "x": 2.4071604854884874,
-                    "y": 3.306051768554538,
-                    "heading": 2.391439626548247,
-                    "angularVelocity": 0.5968601490161605,
-                    "velocityX": 2.677289804184235,
-                    "velocityY": -1.2324203854043734,
-                    "timestamp": 0.6752138185972749
-                },
-                {
-                    "x": 2.6614180186191594,
-                    "y": 3.188998550481633,
-                    "heading": 2.4445515358009664,
-                    "angularVelocity": 0.6292751456189901,
-                    "velocityX": 3.0124683604240237,
-                    "velocityY": -1.3868580867148388,
-                    "timestamp": 0.7596155459219343
-                },
-                {
-                    "x": 2.9439724015872475,
-                    "y": 3.0588976398796266,
-                    "heading": 2.497791194825149,
-                    "angularVelocity": 0.6307887375265607,
-                    "velocityX": 3.3477322316072415,
-                    "velocityY": -1.5414484362572416,
-                    "timestamp": 0.8440172732465936
-                },
-                {
-                    "x": 3.2547705207438518,
-                    "y": 2.9157523875003513,
-                    "heading": 2.5454529495785527,
-                    "angularVelocity": 0.5647011769091861,
-                    "velocityX": 3.6823668070333375,
-                    "velocityY": -1.695999085761044,
-                    "timestamp": 0.9284190005712529
-                },
-                {
-                    "x": 3.5925128012400935,
-                    "y": 2.7599542956015277,
-                    "heading": 2.5628561343461667,
-                    "angularVelocity": 0.20619465168847934,
-                    "velocityX": 4.001603891317103,
-                    "velocityY": -1.8459111778545862,
-                    "timestamp": 1.0128207278959123
-                },
-                {
-                    "x": 3.9351974184342486,
-                    "y": 2.6023709673223303,
-                    "heading": 2.562856153970607,
-                    "angularVelocity": 2.3251230459987665e-7,
-                    "velocityX": 4.060161184568953,
-                    "velocityY": -1.867062834781069,
-                    "timestamp": 1.0972224552205716
-                },
-                {
-                    "x": 4.277882042528265,
-                    "y": 2.444787654047679,
-                    "heading": 2.562856173594968,
-                    "angularVelocity": 2.325113720761536e-7,
-                    "velocityX": 4.060161266319199,
-                    "velocityY": -1.8670626570057298,
-                    "timestamp": 1.181624182545231
-                },
-                {
-                    "x": 4.6205666666222935,
+                    "x": 1.4188356238691382,
+                    "y": 3.7609422139436073,
+                    "heading": 2.1535307919155904,
+                    "angularVelocity": 0.08908449280344664,
+                    "velocityX": 0.3344075085981018,
+                    "velocityY": -0.15388708370877402,
+                    "timestamp": 0.08440172732465939
+                },
+                {
+                    "x": 1.4752889323673153,
+                    "y": 3.73496294179452,
+                    "heading": 2.1683643253667535,
+                    "angularVelocity": 0.1757491691385009,
+                    "velocityX": 0.6688643738418307,
+                    "velocityY": -0.30780498187146277,
+                    "timestamp": 0.16880345464931878
+                },
+                {
+                    "x": 1.5599758288607544,
+                    "y": 3.695989670782737,
+                    "heading": 2.1902666180764747,
+                    "angularVelocity": 0.2595005268727734,
+                    "velocityX": 1.0033787124721134,
+                    "velocityY": -0.4617591635520542,
+                    "timestamp": 0.2532051819739782
+                },
+                {
+                    "x": 1.6729020410079447,
+                    "y": 3.644018749430173,
+                    "heading": 2.2189349376345064,
+                    "angularVelocity": 0.339665081115654,
+                    "velocityX": 1.3379609129657823,
+                    "velocityY": -0.6157566083055724,
+                    "timestamp": 0.33760690929863757
+                },
+                {
+                    "x": 1.814074420946617,
+                    "y": 3.5790457513290903,
+                    "heading": 2.2539866117997107,
+                    "angularVelocity": 0.4152956968567039,
+                    "velocityX": 1.6726242982639348,
+                    "velocityY": -0.7698064975750799,
+                    "timestamp": 0.42200863662329696
+                },
+                {
+                    "x": 1.9835012543623114,
+                    "y": 3.5010652014864245,
+                    "heading": 2.294922249726236,
+                    "angularVelocity": 0.4850094805413429,
+                    "velocityX": 2.0073858531825732,
+                    "velocityY": -0.923921255103062,
+                    "timestamp": 0.5064103639479564
+                },
+                {
+                    "x": 2.181192601466654,
+                    "y": 3.4100701778728046,
+                    "heading": 2.34106359899966,
+                    "angularVelocity": 0.5466872626425968,
+                    "velocityX": 2.342266602482012,
+                    "velocityY": -1.0781180255185847,
+                    "timestamp": 0.5908120912726158
+                },
+                {
+                    "x": 2.407160485488508,
+                    "y": 3.3060517685545587,
+                    "heading": 2.39143962654778,
+                    "angularVelocity": 0.5968601490150018,
+                    "velocityX": 2.6772898041842925,
+                    "velocityY": -1.2324203854043054,
+                    "timestamp": 0.6752138185972751
+                },
+                {
+                    "x": 2.6614180186191856,
+                    "y": 3.1889985504816614,
+                    "heading": 2.444551535800395,
+                    "angularVelocity": 0.6292751456177489,
+                    "velocityX": 3.0124683604240907,
+                    "velocityY": -1.3868580867147517,
+                    "timestamp": 0.7596155459219345
+                },
+                {
+                    "x": 2.94397240158728,
+                    "y": 3.058897639879665,
+                    "heading": 2.4977911948244698,
+                    "angularVelocity": 0.6307887375252847,
+                    "velocityX": 3.3477322316073206,
+                    "velocityY": -1.5414484362571284,
+                    "timestamp": 0.8440172732465938
+                },
+                {
+                    "x": 3.254770520743893,
+                    "y": 2.9157523875004028,
+                    "heading": 2.5454529495777716,
+                    "angularVelocity": 0.5647011769079837,
+                    "velocityX": 3.6823668070334374,
+                    "velocityY": -1.6959990857608904,
+                    "timestamp": 0.9284190005712532
+                },
+                {
+                    "x": 3.592512801240152,
+                    "y": 2.759954295601597,
+                    "heading": 2.5628561343453486,
+                    "angularVelocity": 0.2061946516880405,
+                    "velocityX": 4.001603891317303,
+                    "velocityY": -1.8459111778543746,
+                    "timestamp": 1.0128207278959125
+                },
+                {
+                    "x": 3.9351974184343876,
+                    "y": 2.602370967322575,
+                    "heading": 2.562856153969789,
+                    "angularVelocity": 2.3251230463668793e-7,
+                    "velocityX": 4.060161184569908,
+                    "velocityY": -1.867062834778992,
+                    "timestamp": 1.0972224552205718
+                },
+                {
+                    "x": 4.2778820425282325,
+                    "y": 2.4447876540475497,
+                    "heading": 2.56285617359415,
+                    "angularVelocity": 2.3251137262525053e-7,
+                    "velocityX": 4.060161266317163,
+                    "velocityY": -1.8670626570101556,
+                    "timestamp": 1.1816241825452312
+                },
+                {
+                    "x": 4.620566666622319,
                     "y": 2.287204340773051,
-                    "heading": 2.56285619321933,
-                    "angularVelocity": 2.3251137344363183e-7,
-                    "velocityX": 4.06016126631933,
-                    "velocityY": -1.8670626570054454,
-                    "timestamp": 1.2660259098698903
-                },
-                {
-                    "x": 4.963251290716338,
-                    "y": 2.12962102749846,
-                    "heading": 2.562856212843691,
-                    "angularVelocity": 2.325113733001605e-7,
-                    "velocityX": 4.060161266319529,
-                    "velocityY": -1.8670626570050126,
-                    "timestamp": 1.3504276371945496
-                },
-                {
-                    "x": 5.305935914810376,
-                    "y": 1.9720377142238548,
-                    "heading": 2.5628562324680524,
-                    "angularVelocity": 2.3251137288700666e-7,
-                    "velocityX": 4.060161266319452,
-                    "velocityY": -1.8670626570051803,
-                    "timestamp": 1.434829364519209
-                },
-                {
-                    "x": 5.6486205335479065,
-                    "y": 1.8144543893009162,
-                    "heading": 2.562856252092488,
-                    "angularVelocity": 2.3251224680194668e-7,
-                    "velocityX": 4.060161202855022,
-                    "velocityY": -1.8670627950157828,
-                    "timestamp": 1.5192310918438683
-                },
-                {
-                    "x": 5.98670407076577,
-                    "y": 1.6586057446575901,
-                    "heading": 2.579360195393005,
-                    "angularVelocity": 0.19554034998636466,
-                    "velocityX": 4.005647134653921,
-                    "velocityY": -1.8465101317635249,
-                    "timestamp": 1.6036328191685276
-                },
-                {
-                    "x": 6.297588553428444,
-                    "y": 1.515443031462974,
-                    "heading": 2.623278535257842,
-                    "angularVelocity": 0.5203488276478101,
-                    "velocityX": 3.6833900503816404,
-                    "velocityY": -1.6962059632254551,
-                    "timestamp": 1.688034546493187
-                },
-                {
-                    "x": 6.580221781390715,
-                    "y": 1.3853244468495944,
-                    "heading": 2.6723827473448787,
-                    "angularVelocity": 0.5817915538405133,
-                    "velocityX": 3.348666394884248,
-                    "velocityY": -1.5416578396892986,
-                    "timestamp": 1.7724362738178463
-                },
-                {
-                    "x": 6.834557352214876,
-                    "y": 1.2682518474424065,
-                    "heading": 2.7214165995037427,
-                    "angularVelocity": 0.5809579224634863,
-                    "velocityX": 3.0133929587226977,
-                    "velocityY": -1.3870877186773325,
-                    "timestamp": 1.8568380011425056
-                },
-                {
-                    "x": 7.060600794430822,
-                    "y": 1.164213692766984,
-                    "heading": 2.7679660552881162,
-                    "angularVelocity": 0.5515225488847675,
-                    "velocityX": 2.678185025129261,
-                    "velocityY": -1.2326543303459838,
-                    "timestamp": 1.941239728467165
-                },
-                {
-                    "x": 7.258362981468531,
-                    "y": 1.0731997707175525,
-                    "heading": 2.810637820160032,
-                    "angularVelocity": 0.5055792840326011,
-                    "velocityX": 2.3431059210079694,
-                    "velocityY": -1.0783419360523008,
+                    "heading": 2.5628561932185114,
+                    "angularVelocity": 2.3251137330597664e-7,
+                    "velocityX": 4.060161266320031,
+                    "velocityY": -1.867062657003921,
+                    "timestamp": 1.2660259098698905
+                },
+                {
+                    "x": 4.963251290716406,
+                    "y": 2.129621027498552,
+                    "heading": 2.562856212842873,
+                    "angularVelocity": 2.325113741533684e-7,
+                    "velocityX": 4.06016126632003,
+                    "velocityY": -1.8670626570039215,
+                    "timestamp": 1.3504276371945498
+                },
+                {
+                    "x": 5.305935914810306,
+                    "y": 1.9720377142236445,
+                    "heading": 2.5628562324672344,
+                    "angularVelocity": 2.325113718451583e-7,
+                    "velocityX": 4.060161266317804,
+                    "velocityY": -1.8670626570087616,
+                    "timestamp": 1.4348293645192092
+                },
+                {
+                    "x": 5.648620533547862,
+                    "y": 1.8144543893007625,
+                    "heading": 2.56285625209167,
+                    "angularVelocity": 2.3251224808098197e-7,
+                    "velocityX": 4.060161202855331,
+                    "velocityY": -1.8670627950151129,
+                    "timestamp": 1.5192310918438685
+                },
+                {
+                    "x": 5.986704070765734,
+                    "y": 1.6586057446574787,
+                    "heading": 2.5793601953922063,
+                    "angularVelocity": 0.19554034998659195,
+                    "velocityX": 4.0056471346540325,
+                    "velocityY": -1.8465101317630266,
+                    "timestamp": 1.6036328191685278
+                },
+                {
+                    "x": 6.297588553428419,
+                    "y": 1.5154430314628888,
+                    "heading": 2.623278535257151,
+                    "angularVelocity": 0.5203488276490896,
+                    "velocityX": 3.6833900503817576,
+                    "velocityY": -1.6962059632251454,
+                    "timestamp": 1.6880345464931872
+                },
+                {
+                    "x": 6.580221781390697,
+                    "y": 1.385324446849529,
+                    "heading": 2.6723827473443014,
+                    "angularVelocity": 0.5817915538418572,
+                    "velocityX": 3.3486663948843316,
+                    "velocityY": -1.5416578396890646,
+                    "timestamp": 1.7724362738178465
+                },
+                {
+                    "x": 6.834557352214864,
+                    "y": 1.2682518474423568,
+                    "heading": 2.7214165995032737,
+                    "angularVelocity": 0.5809579224647721,
+                    "velocityX": 3.013392958722759,
+                    "velocityY": -1.3870877186771464,
+                    "timestamp": 1.8568380011425059
+                },
+                {
+                    "x": 7.060600794430814,
+                    "y": 1.1642136927669469,
+                    "heading": 2.7679660552877468,
+                    "angularVelocity": 0.5515225488859516,
+                    "velocityX": 2.6781850251293067,
+                    "velocityY": -1.2326543303458337,
+                    "timestamp": 1.9412397284671652
+                },
+                {
+                    "x": 7.258362981468526,
+                    "y": 1.0731997707175256,
+                    "heading": 2.810637820159753,
+                    "angularVelocity": 0.5055792840336621,
+                    "velocityX": 2.3431059210080036,
+                    "velocityY": -1.078341936052179,
                     "timestamp": 2.0256414557918245
                 },
                 {
-                    "x": 7.4278539951534555,
-                    "y": 0.9952020001334562,
-                    "heading": 2.848524374960913,
-                    "angularVelocity": 0.44888364257222324,
-                    "velocityX": 2.0081462673501975,
-                    "velocityY": -0.9241252881480766,
+                    "x": 7.427853995153451,
+                    "y": 0.9952020001334377,
+                    "heading": 2.8485243749607116,
+                    "angularVelocity": 0.4488836425731485,
+                    "velocityX": 2.0081462673502224,
+                    "velocityY": -0.9241252881479789,
                     "timestamp": 2.110043183116484
                 },
                 {
-                    "x": 7.569082320847809,
-                    "y": 0.930214000728212,
-                    "heading": 2.8809880838803004,
-                    "angularVelocity": 0.3846332290631053,
-                    "velocityX": 1.6732871491018833,
-                    "velocityY": -0.7699842345081582,
+                    "x": 7.569082320847807,
+                    "y": 0.9302140007282002,
+                    "heading": 2.880988083880165,
+                    "angularVelocity": 0.38463322906388664,
+                    "velocityX": 1.673287149101901,
+                    "velocityY": -0.7699842345080813,
                     "timestamp": 2.194444910441143
                 },
                 {
-                    "x": 7.682054982165758,
-                    "y": 0.8782306591629105,
-                    "heading": 2.9075567665885504,
-                    "angularVelocity": 0.31478837638063123,
-                    "velocityX": 1.3385112473277885,
-                    "velocityY": -0.6159037642125805,
+                    "x": 7.6820549821657576,
+                    "y": 0.8782306591629035,
+                    "heading": 2.9075567665884687,
+                    "angularVelocity": 0.3147883763812628,
+                    "velocityX": 1.338511247327801,
+                    "velocityY": -0.615903764212522,
                     "timestamp": 2.2788466377658025
                 },
                 {
                     "x": 7.766777816162518,
-                    "y": 0.8392478073722182,
-                    "heading": 2.927866772500761,
-                    "angularVelocity": 0.24063495565779372,
-                    "velocityX": 1.0038045035602847,
-                    "velocityY": -0.4618726775666696,
+                    "y": 0.8392478073722147,
+                    "heading": 2.92786677250072,
+                    "angularVelocity": 0.24063495565827153,
+                    "velocityX": 1.0038045035602927,
+                    "velocityY": -0.46187267756662764,
                     "timestamp": 2.363248365090462
                 },
                 {
                     "x": 7.823255725612272,
-                    "y": 0.8132619936429646,
-                    "heading": 2.9416291988019947,
-                    "angularVelocity": 0.16305858585447291,
-                    "velocityX": 0.6691558483454472,
-                    "velocityY": -0.3078824871592573,
+                    "y": 0.8132619936429635,
+                    "heading": 2.941629198801981,
+                    "angularVelocity": 0.16305858585479388,
+                    "velocityX": 0.6691558483454518,
+                    "velocityY": -0.30788248715923044,
                     "timestamp": 2.447650092415121
                 },
                 {
                     "x": 7.851492881774902,
                     "y": 0.8002703189849854,
                     "heading": 2.948608540855105,
-                    "angularVelocity": 0.08269193385419325,
-                    "velocityX": 0.33455661462961894,
-                    "velocityY": -0.15392664427358824,
+                    "angularVelocity": 0.08269193385435476,
+                    "velocityX": 0.334556614629621,
+                    "velocityY": -0.15392664427357527,
                     "timestamp": 2.5320518197397806
                 },
                 {
                     "x": 7.851492881774902,
                     "y": 0.8002703189849854,
                     "heading": 2.948608540855105,
-                    "angularVelocity": 5.402032347351411e-23,
-                    "velocityX": -1.1123337120346699e-22,
-                    "velocityY": 3.0651678544995594e-23,
+                    "angularVelocity": -1.2062609516459865e-26,
+                    "velocityX": 1.2103314188915662e-26,
+                    "velocityY": -7.234631053601379e-26,
                     "timestamp": 2.61645354706444
                 },
                 {
-                    "x": 7.822568882035389,
-                    "y": 0.8134565460364541,
-                    "heading": 2.9419859459707647,
-                    "angularVelocity": -0.07760298691601544,
-                    "velocityX": -0.3389288960814876,
-                    "velocityY": 0.15451505387509465,
-                    "timestamp": 2.7017929798301834
-                },
-                {
-                    "x": 7.7647170451374405,
-                    "y": 0.8398310193474777,
-                    "heading": 2.9289537678985185,
-                    "angularVelocity": -0.15270992142659134,
-                    "velocityX": -0.6779027587018491,
-                    "velocityY": 0.3090537686537181,
-                    "timestamp": 2.787132412595927
-                },
-                {
-                    "x": 7.677932914287794,
-                    "y": 0.8793960863330212,
-                    "heading": 2.9097686653736,
-                    "angularVelocity": -0.22480935135321586,
-                    "velocityX": -1.0169288456353933,
-                    "velocityY": 0.4636199902353415,
-                    "timestamp": 2.8724718453616704
-                },
-                {
-                    "x": 7.562211255465081,
-                    "y": 0.9321545004865132,
-                    "heading": 2.8847464233438402,
-                    "angularVelocity": -0.29320844091436304,
-                    "velocityX": -1.3560162643729914,
-                    "velocityY": 0.6182184770118369,
-                    "timestamp": 2.957811278127414
-                },
-                {
-                    "x": 7.417545860204267,
-                    "y": 0.9981095206504768,
-                    "heading": 2.8542852498864897,
-                    "angularVelocity": -0.35694136309724944,
-                    "velocityX": -1.6951764333601793,
-                    "velocityY": 0.7728551506196457,
-                    "timestamp": 3.0431507108931575
-                },
-                {
-                    "x": 7.243929314298609,
-                    "y": 1.0772650341717676,
-                    "heading": 2.81890263652658,
-                    "angularVelocity": -0.414610364906394,
-                    "velocityX": -2.034423481372746,
-                    "velocityY": 0.9275373758174913,
-                    "timestamp": 3.128490143658901
-                },
-                {
-                    "x": 7.041352783402235,
-                    "y": 1.1696256928089817,
-                    "heading": 2.779297618081299,
-                    "angularVelocity": -0.46408813794200654,
-                    "velocityX": -2.373774049476592,
-                    "velocityY": 1.0822741099152131,
-                    "timestamp": 3.2138295764246445
-                },
-                {
-                    "x": 6.809806051541585,
-                    "y": 1.2751969821493576,
-                    "heading": 2.736465537770621,
-                    "angularVelocity": -0.5019025662878775,
-                    "velocityX": -2.713244327464013,
-                    "velocityY": 1.2370751236438273,
-                    "timestamp": 3.299169009190388
-                },
-                {
-                    "x": 6.549278874556655,
-                    "y": 1.3939848079923727,
-                    "heading": 2.6919369879711237,
-                    "angularVelocity": -0.5217816471985232,
-                    "velocityX": -3.05283464562131,
-                    "velocityY": 1.3919453410135438,
-                    "timestamp": 3.3845084419561315
-                },
-                {
-                    "x": 6.259769303119967,
-                    "y": 1.525992204929741,
-                    "heading": 2.648375507048617,
-                    "angularVelocity": -0.5104496187838855,
-                    "velocityX": -3.3924478058272545,
-                    "velocityY": 1.5468511174632342,
-                    "timestamp": 3.469847874721875
-                },
-                {
-                    "x": 5.941344077941224,
-                    "y": 1.6711937644032617,
-                    "heading": 2.6116438214579167,
-                    "angularVelocity": -0.43041867516894305,
-                    "velocityX": -3.7312789042413628,
-                    "velocityY": 1.7014591586529397,
-                    "timestamp": 3.5551873074876186
-                },
-                {
-                    "x": 5.595435536591844,
-                    "y": 1.8290722409965166,
-                    "heading": 2.607733432493964,
-                    "angularVelocity": -0.045821595447992164,
-                    "velocityX": -4.053325996422999,
-                    "velocityY": 1.8500061633480882,
-                    "timestamp": 3.640526740253362
-                },
-                {
-                    "x": 5.2496529439780035,
-                    "y": 1.9869633522762045,
-                    "heading": 2.6034613630785652,
-                    "angularVelocity": -0.05005973530578218,
-                    "velocityX": -4.05185014016924,
-                    "velocityY": 1.8501542154972939,
-                    "timestamp": 3.7258661730191056
-                },
-                {
-                    "x": 4.931253772917131,
-                    "y": 2.1321611295912564,
-                    "heading": 2.5655322472298923,
-                    "angularVelocity": -0.4444500580732541,
-                    "velocityX": -3.7309736043697175,
-                    "velocityY": 1.7014148396512054,
-                    "timestamp": 3.811205605784849
-                },
-                {
-                    "x": 4.641767327132308,
-                    "y": 2.2641652661660645,
-                    "heading": 2.520640978635251,
-                    "angularVelocity": -0.5260319542768441,
-                    "velocityX": -3.3921768214638104,
-                    "velocityY": 1.5468129128202641,
-                    "timestamp": 3.8965450385505926
-                },
-                {
-                    "x": 4.3812632098082105,
-                    "y": 2.3829495591894077,
-                    "heading": 2.47480035700841,
-                    "angularVelocity": -0.537156389973591,
-                    "velocityX": -3.052564434534983,
-                    "velocityY": 1.3919039437419969,
-                    "timestamp": 3.981884471316336
-                },
-                {
-                    "x": 4.149739035406864,
-                    "y": 2.48851732367813,
-                    "heading": 2.4307407651450164,
-                    "angularVelocity": -0.5162864391697761,
-                    "velocityX": -2.71298000113124,
-                    "velocityY": 1.2370338197408188,
-                    "timestamp": 4.06722390408208
-                },
-                {
-                    "x": 3.9471838536286543,
-                    "y": 2.580874783829144,
-                    "heading": 2.3900276970993897,
-                    "angularVelocity": -0.4770721661272781,
-                    "velocityX": -2.373523882379488,
-                    "velocityY": 1.0822366303340143,
-                    "timestamp": 4.152563336847823
-                },
-                {
-                    "x": 3.773586819419269,
-                    "y": 2.6600276124979123,
-                    "heading": 2.3536756719868617,
-                    "angularVelocity": -0.4259698469324771,
-                    "velocityX": -2.0341948450244476,
-                    "velocityY": 0.9275059149507459,
-                    "timestamp": 4.237902769613567
-                },
-                {
-                    "x": 3.6289385773839675,
-                    "y": 2.725980527941314,
-                    "heading": 2.3223946646011053,
-                    "angularVelocity": -0.3665481052776955,
-                    "velocityX": -1.694975433365738,
-                    "velocityY": 0.7728304876884101,
-                    "timestamp": 4.32324220237931
-                },
-                {
-                    "x": 3.5132312818952185,
-                    "y": 2.7787374037595027,
-                    "heading": 2.29670882734183,
-                    "angularVelocity": -0.3009843917029925,
-                    "velocityX": -1.3558479560833883,
-                    "velocityY": 0.6182004509334662,
-                    "timestamp": 4.408581635145054
-                },
-                {
-                    "x": 3.4264583605812398,
-                    "y": 2.8183014403250346,
-                    "heading": 2.277020911631921,
-                    "angularVelocity": -0.23070127222373424,
-                    "velocityX": -1.0167974932780486,
-                    "velocityY": 0.4636079158638751,
-                    "timestamp": 4.493921067910797
-                },
-                {
-                    "x": 3.3686142652512063,
-                    "y": 2.8446753119826385,
-                    "heading": 2.2636502919705843,
-                    "angularVelocity": -0.15667575033031875,
-                    "velocityX": -0.6778120436869518,
-                    "velocityY": 0.3090467185316375,
-                    "timestamp": 4.579260500676541
+                    "x": 7.822569410321687,
+                    "y": 0.8134570127208937,
+                    "heading": 2.942250346546477,
+                    "angularVelocity": -0.07451133821509169,
+                    "velocityX": -0.3389526112595688,
+                    "velocityY": 0.15453415690077843,
+                    "timestamp": 2.701785450381938
+                },
+                {
+                    "x": 7.764718890043133,
+                    "y": 0.839832272440097,
+                    "heading": 2.9297405462516477,
+                    "angularVelocity": -0.14660167895568676,
+                    "velocityX": -0.6779471455512713,
+                    "velocityY": 0.30909025456830386,
+                    "timestamp": 2.7871173536994363
+                },
+                {
+                    "x": 7.677937167802769,
+                    "y": 0.8793982739906296,
+                    "heading": 2.911328060299494,
+                    "angularVelocity": -0.2157749357077613,
+                    "velocityX": -1.0169903502265918,
+                    "velocityY": 0.4636718508822873,
+                    "timestamp": 2.8724492570169344
+                },
+                {
+                    "x": 7.562219369891921,
+                    "y": 0.9321575688208921,
+                    "heading": 2.887319090771594,
+                    "angularVelocity": -0.28135982668250875,
+                    "velocityX": -1.3560906696325765,
+                    "velocityY": 0.6182833474832815,
+                    "timestamp": 2.9577811603344326
+                },
+                {
+                    "x": 7.417559721625072,
+                    "y": 0.998113175702274,
+                    "heading": 2.8580996423497167,
+                    "angularVelocity": -0.3424211494868395,
+                    "velocityX": -1.6952586622685288,
+                    "velocityY": 0.7729302209043448,
+                    "timestamp": 3.043113063651931
+                },
+                {
+                    "x": 7.243951337087096,
+                    "y": 1.0772686940136758,
+                    "heading": 2.8241711861092553,
+                    "angularVelocity": -0.3976057596444594,
+                    "velocityX": -2.034507350574668,
+                    "velocityY": 0.9276192752537634,
+                    "timestamp": 3.128444966969429
+                },
+                {
+                    "x": 7.041386028561067,
+                    "y": 1.1696284268040618,
+                    "heading": 2.786210932104745,
+                    "angularVelocity": -0.4448541814808713,
+                    "velocityX": -2.373851990296467,
+                    "velocityY": 1.0823587568032942,
+                    "timestamp": 3.213776870286927
+                },
+                {
+                    "x": 6.809854361139004,
+                    "y": 1.275197436064349,
+                    "heading": 2.745182930692885,
+                    "angularVelocity": -0.4808049488736419,
+                    "velocityX": -2.7133071971990876,
+                    "velocityY": 1.2371575595529873,
+                    "timestamp": 3.2991087736044253
+                },
+                {
+                    "x": 6.54934695925946,
+                    "y": 1.3939811321605526,
+                    "heading": 2.702569215300316,
+                    "angularVelocity": -0.49938784599723113,
+                    "velocityX": -3.0528722758036095,
+                    "velocityY": 1.3920197660919402,
+                    "timestamp": 3.3844406769219235
+                },
+                {
+                    "x": 6.259862392041541,
+                    "y": 1.5259821373575067,
+                    "heading": 2.660947042906878,
+                    "angularVelocity": -0.48776800675091764,
+                    "velocityX": -3.39245412282464,
+                    "velocityY": 1.546912702811892,
+                    "timestamp": 3.4697725802394217
+                },
+                {
+                    "x": 5.941463784169146,
+                    "y": 1.6711762227772475,
+                    "heading": 2.6259775148098465,
+                    "angularVelocity": -0.4098060249156608,
+                    "velocityX": -3.731296215059398,
+                    "velocityY": 1.7015217026100005,
+                    "timestamp": 3.55510448355692
+                },
+                {
+                    "x": 5.595461000648761,
+                    "y": 1.8290711503385564,
+                    "heading": 2.6224591054778523,
+                    "angularVelocity": -0.04123205032592272,
+                    "velocityX": -4.0547880695101535,
+                    "velocityY": 1.8503621907251089,
+                    "timestamp": 3.640436386874418
+                },
+                {
+                    "x": 5.24956334725571,
+                    "y": 1.986975195185791,
+                    "heading": 2.6186328254708116,
+                    "angularVelocity": -0.04483997026064621,
+                    "velocityX": -4.053556055184374,
+                    "velocityY": 1.8504690357100606,
+                    "timestamp": 3.7257682901919162
+                },
+                {
+                    "x": 4.931186691253366,
+                    "y": 2.1321663984246007,
+                    "heading": 2.58261703355146,
+                    "angularVelocity": -0.4220671345551227,
+                    "velocityX": -3.731038962271196,
+                    "velocityY": 1.7014879264861869,
+                    "timestamp": 3.8111001935094144
+                },
+                {
+                    "x": 4.641721554882089,
+                    "y": 2.2641649180815384,
+                    "heading": 2.5398323894162624,
+                    "angularVelocity": -0.5013909507679347,
+                    "velocityX": -3.392226413774599,
+                    "velocityY": 1.546883574901704,
+                    "timestamp": 3.8964320968269126
+                },
+                {
+                    "x": 4.381233513115829,
+                    "y": 2.3829458675377655,
+                    "heading": 2.4960705108691763,
+                    "angularVelocity": -0.512843108447488,
+                    "velocityX": -3.0526453956740087,
+                    "velocityY": 1.3919875783653128,
+                    "timestamp": 3.981764000144411
+                },
+                {
+                    "x": 4.149720790549715,
+                    "y": 2.4885121054416337,
+                    "heading": 2.4539667442415882,
+                    "angularVelocity": -0.4934117837607673,
+                    "velocityX": -2.7130851834479257,
+                    "velocityY": 1.2371250821756956,
+                    "timestamp": 4.067095903461909
+                },
+                {
+                    "x": 3.9471734283435462,
+                    "y": 2.5808693126971836,
+                    "heading": 2.4150338091170536,
+                    "angularVelocity": -0.4562529793771927,
+                    "velocityX": -2.3736416783362024,
+                    "velocityY": 1.0823291601959537,
+                    "timestamp": 4.152427806779407
+                },
+                {
+                    "x": 3.773581464458937,
+                    "y": 2.6600227125745386,
+                    "heading": 2.3802529914030197,
+                    "angularVelocity": -0.4075945380548163,
+                    "velocityX": -2.034314917818226,
+                    "velocityY": 0.9275944494387498,
+                    "timestamp": 4.237759710096905
+                },
+                {
+                    "x": 3.6289362693248974,
+                    "y": 2.7259766668551513,
+                    "heading": 2.3503116341483112,
+                    "angularVelocity": -0.35088116039442224,
+                    "velocityX": -1.6950892867800245,
+                    "velocityY": 0.772910854164535,
+                    "timestamp": 4.3230916134144035
+                },
+                {
+                    "x": 3.5132305875893466,
+                    "y": 2.7787347643176643,
+                    "heading": 2.3257175786127346,
+                    "angularVelocity": -0.288216418237719,
+                    "velocityX": -1.3559486808238648,
+                    "velocityY": 0.6182693155948199,
+                    "timestamp": 4.408423516731902
+                },
+                {
+                    "x": 3.426458330792868,
+                    "y": 2.8182999738021985,
+                    "heading": 2.306861275231502,
+                    "angularVelocity": -0.22097600836433876,
+                    "velocityX": -1.0168794251971758,
+                    "velocityY": 0.4636625687033173,
+                    "timestamp": 4.4937554200494
+                },
+                {
+                    "x": 3.3686143533074815,
+                    "y": 2.844674778468884,
+                    "heading": 2.2940524576726125,
+                    "angularVelocity": -0.15010584624172035,
+                    "velocityX": -0.6778704709089147,
+                    "velocityY": 0.30908492183224257,
+                    "timestamp": 4.579087323366898
                 },
                 {
                     "x": 3.3396942615509033,
                     "y": 2.857861280441284,
-                    "heading": 2.256856869928089,
-                    "angularVelocity": -0.07960472459599503,
-                    "velocityX": -0.33888207084394817,
-                    "velocityY": 0.15451202370703507,
-                    "timestamp": 4.664599933442284
+                    "heading": 2.287543209286567,
+                    "angularVelocity": -0.0762815328497496,
+                    "velocityX": -0.3389130047758784,
+                    "velocityY": 0.15453190963450955,
+                    "timestamp": 4.664419226684396
                 },
                 {
                     "x": 3.3396942615509033,
                     "y": 2.857861280441284,
-                    "heading": 2.256856869928089,
-                    "angularVelocity": -5.437621548215379e-23,
-                    "velocityX": 1.126114853157674e-22,
-                    "velocityY": -4.5016812727452064e-23,
-                    "timestamp": 4.749939366208028
-                },
-                {
-                    "x": 3.351644043460381,
-                    "y": 2.8456827633555766,
-                    "heading": 2.2599985645312386,
-                    "angularVelocity": 0.050261094910594425,
-                    "velocityX": 0.1911736176110555,
-                    "velocityY": -0.19483294222852873,
-                    "timestamp": 4.8124468505502955
-                },
-                {
-                    "x": 3.375805096988204,
-                    "y": 2.821589634193531,
-                    "heading": 2.266346205797599,
-                    "angularVelocity": 0.10155009969051512,
-                    "velocityX": 0.38653056961188503,
-                    "velocityY": -0.3854439098863877,
-                    "timestamp": 4.874954334892563
-                },
-                {
-                    "x": 3.4124780907077805,
-                    "y": 2.7859000800493376,
-                    "heading": 2.2759735457087524,
-                    "angularVelocity": 0.1540189948844771,
-                    "velocityX": 0.5866976427777654,
-                    "velocityY": -0.5709644936080076,
-                    "timestamp": 4.937461819234831
-                },
-                {
-                    "x": 3.4620112120736506,
-                    "y": 2.7390039778926036,
-                    "heading": 2.2889657812850372,
-                    "angularVelocity": 0.2078508791866281,
-                    "velocityX": 0.7924350481719095,
-                    "velocityY": -0.7502477927274819,
-                    "timestamp": 4.999969303577099
-                },
-                {
-                    "x": 3.524810340388698,
-                    "y": 2.6813880030564383,
-                    "heading": 2.3054218546593743,
-                    "angularVelocity": 0.2632656480659119,
-                    "velocityX": 1.0046657448439726,
-                    "velocityY": -0.921745218871413,
-                    "timestamp": 5.062476787919366
-                },
-                {
-                    "x": 3.6013509003736557,
-                    "y": 2.6136727622292386,
-                    "heading": 2.3254569789759962,
-                    "angularVelocity": 0.3205236065319362,
-                    "velocityX": 1.224502326247042,
-                    "velocityY": -1.0833141269358477,
-                    "timestamp": 5.124984272261634
-                },
-                {
-                    "x": 3.6921900643990977,
-                    "y": 2.5366690761295727,
-                    "heading": 2.349204872167281,
-                    "angularVelocity": 0.37992079574423454,
-                    "velocityX": 1.4532525981695328,
-                    "velocityY": -1.2319114568428715,
-                    "timestamp": 5.187491756603902
-                },
-                {
-                    "x": 3.7979745951175046,
-                    "y": 2.451465011623651,
-                    "heading": 2.376818153439006,
-                    "angularVelocity": 0.44175959986687446,
-                    "velocityX": 1.6923498334882667,
-                    "velocityY": -1.3631018013679077,
-                    "timestamp": 5.2499992409461695
-                },
-                {
-                    "x": 3.919430507100887,
-                    "y": 2.3595611737368243,
-                    "heading": 2.40846281175274,
-                    "angularVelocity": 0.506253909379225,
-                    "velocityX": 1.9430619110878742,
-                    "velocityY": -1.4702853402897413,
-                    "timestamp": 5.312506725288437
-                },
-                {
-                    "x": 4.057297923271103,
-                    "y": 2.2630736309568915,
-                    "heading": 2.444297103991139,
-                    "angularVelocity": 0.5732800258315275,
-                    "velocityX": 2.2056145375377016,
-                    "velocityY": -1.5436158372908153,
-                    "timestamp": 5.375014209630705
-                },
-                {
-                    "x": 4.212127945253694,
-                    "y": 2.1649943582593476,
-                    "heading": 2.4844167991527084,
-                    "angularVelocity": 0.6418382627892845,
-                    "velocityX": 2.476983734216506,
-                    "velocityY": -1.569080466596581,
-                    "timestamp": 5.437521693972973
-                },
-                {
-                    "x": 4.383820693252035,
-                    "y": 2.069358793134477,
-                    "heading": 2.5287485383649866,
-                    "angularVelocity": 0.7092228983258065,
-                    "velocityX": 2.7467550454952905,
-                    "velocityY": -1.5299858269964235,
-                    "timestamp": 5.50002917831524
-                },
-                {
-                    "x": 4.570979270017924,
-                    "y": 1.9808954420903548,
-                    "heading": 2.5769092562000195,
-                    "angularVelocity": 0.7704792208773401,
-                    "velocityX": 2.9941786769257464,
-                    "velocityY": -1.415244141961144,
-                    "timestamp": 5.562536662657508
-                },
-                {
-                    "x": 4.770751425736408,
-                    "y": 1.9039231820267064,
-                    "heading": 2.6281541085992433,
-                    "angularVelocity": 0.8198194654359416,
-                    "velocityX": 3.195971775549396,
-                    "velocityY": -1.2314087004713992,
-                    "timestamp": 5.625044146999776
-                },
-                {
-                    "x": 4.979639835251487,
-                    "y": 1.8413910789934598,
-                    "heading": 2.6815711170435192,
-                    "angularVelocity": 0.854569800822325,
-                    "velocityX": 3.3418143717204245,
-                    "velocityY": -1.0003938518921032,
-                    "timestamp": 5.687551631342044
-                },
-                {
-                    "x": 5.1944404545831935,
-                    "y": 1.7948889188778072,
-                    "heading": 2.736334014493798,
-                    "angularVelocity": 0.8761014465150618,
-                    "velocityX": 3.436398402398313,
-                    "velocityY": -0.7439454747694548,
-                    "timestamp": 5.750059115684311
-                },
-                {
-                    "x": 5.412600696471709,
-                    "y": 1.7651426093363154,
-                    "heading": 2.791791924356713,
-                    "angularVelocity": 0.887220313638733,
-                    "velocityX": 3.4901459270693214,
-                    "velocityY": -0.4758839658081921,
-                    "timestamp": 5.812566600026579
+                    "heading": 2.287543209286567,
+                    "angularVelocity": -5.746242802708337e-26,
+                    "velocityX": 2.4125661857863508e-26,
+                    "velocityY": -5.00362558177337e-27,
+                    "timestamp": 4.749751130001894
+                },
+                {
+                    "x": 3.3516435621879443,
+                    "y": 2.845682470433759,
+                    "heading": 2.2905998350495063,
+                    "angularVelocity": 0.048902527346193034,
+                    "velocityX": 0.19117518678796644,
+                    "velocityY": -0.19484707505193644,
+                    "timestamp": 4.812255583837183
+                },
+                {
+                    "x": 3.375803728180644,
+                    "y": 2.82158872757552,
+                    "heading": 2.2967757258080246,
+                    "angularVelocity": 0.09880721099960219,
+                    "velocityX": 0.38653511086371894,
+                    "velocityY": -0.38547241644140595,
+                    "timestamp": 4.8747600376724725
+                },
+                {
+                    "x": 3.412475519518133,
+                    "y": 2.785898212552426,
+                    "heading": 2.3061427774759617,
+                    "angularVelocity": 0.14986214730586908,
+                    "velocityX": 0.5867068518689256,
+                    "velocityY": -0.5710075495923139,
+                    "timestamp": 4.9372644915077615
+                },
+                {
+                    "x": 3.4620072362728327,
+                    "y": 2.739000780362959,
+                    "heading": 2.3187840455780817,
+                    "angularVelocity": 0.20224587731671442,
+                    "velocityX": 0.7924509969357517,
+                    "velocityY": -0.7503054472414145,
+                    "timestamp": 4.9997689453430505
+                },
+                {
+                    "x": 3.5248048977787745,
+                    "y": 2.6813830942336088,
+                    "heading": 2.334796000084425,
+                    "angularVelocity": 0.25617301686272975,
+                    "velocityX": 1.0046909884442055,
+                    "velocityY": -0.9218172881117153,
+                    "timestamp": 5.0622733991783395
+                },
+                {
+                    "x": 3.6013441038202685,
+                    "y": 2.613665768416081,
+                    "heading": 2.354291010287888,
+                    "angularVelocity": 0.3118979369827916,
+                    "velocityX": 1.2245400342700232,
+                    "velocityY": -1.083400008517403,
+                    "timestamp": 5.1247778530136285
+                },
+                {
+                    "x": 3.6921822448448554,
+                    "y": 2.5366596684882037,
+                    "heading": 2.3773995605243607,
+                    "angularVelocity": 0.3697104577118356,
+                    "velocityX": 1.4533066917753177,
+                    "velocityY": -1.2320098041461673,
+                    "timestamp": 5.187282306848918
+                },
+                {
+                    "x": 3.7979663486343616,
+                    "y": 2.4514529745156497,
+                    "heading": 2.4042706940551257,
+                    "angularVelocity": 0.4299075006970781,
+                    "velocityX": 1.6924250561130743,
+                    "velocityY": -1.3632099593588929,
+                    "timestamp": 5.249786760684207
+                },
+                {
+                    "x": 3.919422728848772,
+                    "y": 2.359546524255324,
+                    "heading": 2.4350666770591682,
+                    "angularVelocity": 0.49270061754632183,
+                    "velocityX": 1.9431636109399608,
+                    "velocityY": -1.4703984215671488,
+                    "timestamp": 5.312291214519496
+                },
+                {
+                    "x": 4.057291778395416,
+                    "y": 2.2630568077934385,
+                    "heading": 2.46994235759142,
+                    "angularVelocity": 0.5579711267321186,
+                    "velocityX": 2.205747608161725,
+                    "velocityY": -1.5437254554076125,
+                    "timestamp": 5.374795668354785
+                },
+                {
+                    "x": 4.212124670100329,
+                    "y": 2.1649764518129966,
+                    "heading": 2.5089912150282228,
+                    "angularVelocity": 0.6247371993634814,
+                    "velocityX": 2.4771497422076023,
+                    "velocityY": -1.569173874215458,
+                    "timestamp": 5.437300122190074
+                },
+                {
+                    "x": 4.383821100314581,
+                    "y": 2.069341640095549,
+                    "heading": 2.552140235385777,
+                    "angularVelocity": 0.6903351314973505,
+                    "velocityX": 2.7469471322268335,
+                    "velocityY": -1.5300479541740037,
+                    "timestamp": 5.499804576025363
+                },
+                {
+                    "x": 4.57098306636943,
+                    "y": 1.9808811883739248,
+                    "heading": 2.5990137961096176,
+                    "angularVelocity": 0.7499235310072663,
+                    "velocityX": 2.994378073409875,
+                    "velocityY": -1.4152663737328883,
+                    "timestamp": 5.562309029860652
+                },
+                {
+                    "x": 4.770757132781262,
+                    "y": 1.9039132129567853,
+                    "heading": 2.6488865297070845,
+                    "angularVelocity": 0.7979068776265251,
+                    "velocityX": 3.1961573000585606,
+                    "velocityY": -1.2313998554401338,
+                    "timestamp": 5.624813483695941
+                },
+                {
+                    "x": 4.979645659161256,
+                    "y": 1.8413854433641312,
+                    "heading": 2.700871838493138,
+                    "angularVelocity": 0.8317056720956911,
+                    "velocityX": 3.341978268147973,
+                    "velocityY": -1.0003730255355316,
+                    "timestamp": 5.68731793753123
+                },
+                {
+                    "x": 5.194445000550818,
+                    "y": 1.794886668519366,
+                    "heading": 2.7541661254761425,
+                    "angularVelocity": 0.852647830880101,
+                    "velocityX": 3.436544569377394,
+                    "velocityY": -0.74392738423566,
+                    "timestamp": 5.749822391366519
+                },
+                {
+                    "x": 5.41260313772344,
+                    "y": 1.7651422981078766,
+                    "heading": 2.80813619301323,
+                    "angularVelocity": 0.8634595492876254,
+                    "velocityX": 3.490281472541287,
+                    "velocityY": -0.47587601500961113,
+                    "timestamp": 5.812326845201808
                 },
                 {
                     "x": 5.632181167602539,
                     "y": 1.7524278163909912,
-                    "heading": 2.8474537083946774,
-                    "angularVelocity": 0.8904819098650865,
-                    "velocityX": 3.5128668741248528,
-                    "velocityY": -0.20341232860536554,
-                    "timestamp": 5.875074084368847
-                },
-                {
-                    "x": 5.8440548234983485,
-                    "y": 1.7560753750562226,
-                    "heading": 2.9010181770052657,
-                    "angularVelocity": 0.8879122072577887,
-                    "velocityX": 3.5121267949821284,
-                    "velocityY": 0.060463810237589344,
-                    "timestamp": 5.935400396106373
-                },
-                {
-                    "x": 6.054389053331998,
-                    "y": 1.7755662495775102,
-                    "heading": 2.954051932515814,
-                    "angularVelocity": 0.8791148336946817,
-                    "velocityX": 3.486608476062547,
-                    "velocityY": 0.3230907701782012,
-                    "timestamp": 5.995726707843899
-                },
-                {
-                    "x": 6.261238142657165,
-                    "y": 1.8105864214888754,
-                    "heading": 3.0060676791923955,
-                    "angularVelocity": 0.8622397951808591,
-                    "velocityX": 3.4288369928058486,
-                    "velocityY": 0.580512398366648,
-                    "timestamp": 6.056053019581426
-                },
-                {
-                    "x": 6.462109517822259,
-                    "y": 1.8603513524817452,
-                    "heading": 3.056444759125243,
-                    "angularVelocity": 0.8350764116333455,
-                    "velocityX": 3.3297473254964793,
-                    "velocityY": 0.8249291156633646,
-                    "timestamp": 6.116379331318952
-                },
-                {
-                    "x": 6.654010184213206,
-                    "y": 1.9232453521028667,
-                    "heading": 3.104446433482699,
-                    "angularVelocity": 0.7957004659311325,
-                    "velocityX": 3.1810442386381634,
-                    "velocityY": 1.0425633162320176,
-                    "timestamp": 6.176705643056478
-                },
-                {
-                    "x": 6.833858375306977,
-                    "y": 1.9964918469597606,
-                    "heading": 3.14932595328394,
-                    "angularVelocity": 0.7439460246883234,
-                    "velocityX": 2.9812562033673333,
-                    "velocityY": 1.2141716068368684,
-                    "timestamp": 6.237031954794005
-                },
-                {
-                    "x": 6.999254693304601,
-                    "y": 2.076309931658828,
-                    "heading": 3.1905011120826616,
-                    "angularVelocity": 0.682540629665392,
-                    "velocityX": 2.741694514944779,
-                    "velocityY": 1.3231056631863822,
-                    "timestamp": 6.297358266531531
-                },
-                {
-                    "x": 7.148994960466567,
-                    "y": 2.158718271752955,
-                    "heading": 3.2276763371225257,
-                    "angularVelocity": 0.6162356684693461,
-                    "velocityX": 2.4821717563883468,
-                    "velocityY": 1.366043070106414,
-                    "timestamp": 6.357684578269057
-                },
-                {
-                    "x": 7.282888276645903,
-                    "y": 2.2403059232688856,
-                    "heading": 3.2608205631276768,
-                    "angularVelocity": 0.549415753267966,
-                    "velocityX": 2.219484538718249,
-                    "velocityY": 1.3524389137348638,
-                    "timestamp": 6.418010890006584
-                },
-                {
-                    "x": 7.401284262943972,
-                    "y": 2.318469756879384,
-                    "heading": 3.290049267440689,
-                    "angularVelocity": 0.4845100499460918,
-                    "velocityX": 1.9625928204130767,
-                    "velocityY": 1.2956839455158753,
-                    "timestamp": 6.47833720174411
-                },
-                {
-                    "x": 7.504726503640908,
-                    "y": 2.3913046004079064,
-                    "heading": 3.3155261667453493,
-                    "angularVelocity": 0.4223181986577886,
-                    "velocityX": 1.7147118349784642,
-                    "velocityY": 1.207347862495227,
-                    "timestamp": 6.538663513481636
-                },
-                {
-                    "x": 7.593783054881719,
-                    "y": 2.4574176139035644,
-                    "heading": 3.337415785304815,
-                    "angularVelocity": 0.3628535862544627,
-                    "velocityX": 1.4762472406449565,
-                    "velocityY": 1.09592334739955,
-                    "timestamp": 6.598989825219163
-                },
-                {
-                    "x": 7.668980952466653,
-                    "y": 2.515773590456062,
-                    "heading": 3.3558669674797814,
-                    "angularVelocity": 0.30585629460069885,
-                    "velocityX": 1.2465190630601162,
-                    "velocityY": 0.9673387096230766,
-                    "timestamp": 6.659316136956689
-                },
-                {
-                    "x": 7.730787601696288,
-                    "y": 2.5655858755396013,
-                    "heading": 3.3710094475828405,
-                    "angularVelocity": 0.2510095457010997,
-                    "velocityX": 1.0245388363629793,
-                    "velocityY": 0.8257140814486926,
-                    "timestamp": 6.7196424486942155
-                },
-                {
-                    "x": 7.779610612054574,
-                    "y": 2.606242990697603,
-                    "heading": 3.3829549992996975,
-                    "angularVelocity": 0.1980156149580433,
-                    "velocityX": 0.8093153543135553,
-                    "velocityY": 0.6739532715823396,
-                    "timestamp": 6.779968760431742
-                },
-                {
-                    "x": 7.815803885955238,
-                    "y": 2.637259478202497,
-                    "heading": 3.391799843863087,
-                    "angularVelocity": 0.14661669690454437,
-                    "velocityX": 0.5999583408668668,
-                    "velocityY": 0.5141452645048762,
-                    "timestamp": 6.840295072169268
-                },
-                {
-                    "x": 7.839675112054325,
-                    "y": 2.6582425491647967,
-                    "heading": 3.3976271358840906,
-                    "angularVelocity": 0.09659619249320384,
-                    "velocityX": 0.3957017329842471,
-                    "velocityY": 0.34782618658331665,
-                    "timestamp": 6.9006213839067945
+                    "heading": 2.8623042167051507,
+                    "angularVelocity": 0.8666266220750221,
+                    "velocityX": 3.512998137024418,
+                    "velocityY": -0.20341721168207155,
+                    "timestamp": 5.874831299037097
+                },
+                {
+                    "x": 5.844052633999474,
+                    "y": 1.7560741482181919,
+                    "heading": 2.9144309181641597,
+                    "angularVelocity": 0.8641203781884118,
+                    "velocityX": 3.512258526740335,
+                    "velocityY": 0.06044636528553216,
+                    "timestamp": 5.935154724771241
+                },
+                {
+                    "x": 6.054385084094644,
+                    "y": 1.775562351216045,
+                    "heading": 2.966040820049239,
+                    "angularVelocity": 0.8555532325457329,
+                    "velocityX": 3.48674577969332,
+                    "velocityY": 0.32306194087420037,
+                    "timestamp": 5.995478150505385
+                },
+                {
+                    "x": 6.26123327956607,
+                    "y": 1.810578663020331,
+                    "heading": 3.0166596950957345,
+                    "angularVelocity": 0.8391246755378504,
+                    "velocityX": 3.4289862181077373,
+                    "velocityY": 0.5804761811540523,
+                    "timestamp": 6.05580157623953
+                },
+                {
+                    "x": 6.462105137626569,
+                    "y": 1.860339123757078,
+                    "heading": 3.0656834710845464,
+                    "angularVelocity": 0.8126822273799312,
+                    "velocityX": 3.3299146329284577,
+                    "velocityY": 0.8248944772475333,
+                    "timestamp": 6.116125001973674
+                },
+                {
+                    "x": 6.654007902194967,
+                    "y": 1.923229033256814,
+                    "heading": 3.1123949171108847,
+                    "angularVelocity": 0.7743500217014212,
+                    "velocityX": 3.181231208820061,
+                    "velocityY": 1.0425453915184284,
+                    "timestamp": 6.176448427707818
+                },
+                {
+                    "x": 6.833859400320409,
+                    "y": 1.9964729638714147,
+                    "heading": 3.1560670771443236,
+                    "angularVelocity": 0.7239668421006098,
+                    "velocityX": 2.9814536548053483,
+                    "velocityY": 1.2141871872031882,
+                    "timestamp": 6.2367718534419625
+                },
+                {
+                    "x": 6.9992591804507365,
+                    "y": 2.0762906150910156,
+                    "heading": 3.196134058178292,
+                    "angularVelocity": 0.6642026799099766,
+                    "velocityX": 2.7418830763901587,
+                    "velocityY": 1.323161777505331,
+                    "timestamp": 6.297095279176107
+                },
+                {
+                    "x": 7.149002064381009,
+                    "y": 2.158700328766707,
+                    "heading": 3.2323093855933887,
+                    "angularVelocity": 0.5996895397573637,
+                    "velocityX": 2.4823338878368153,
+                    "velocityY": 1.366131194850996,
+                    "timestamp": 6.357418704910251
+                },
+                {
+                    "x": 7.28289676997483,
+                    "y": 2.240290393761693,
+                    "heading": 3.264563171309931,
+                    "angularVelocity": 0.53468093570631,
+                    "velocityX": 2.2196137564189082,
+                    "velocityY": 1.3525436263279895,
+                    "timestamp": 6.417742130644395
+                },
+                {
+                    "x": 7.401293019643784,
+                    "y": 2.3184570273209686,
+                    "heading": 3.293007501257009,
+                    "angularVelocity": 0.471530414609361,
+                    "velocityX": 1.9626910810859457,
+                    "velocityY": 1.2957923494559103,
+                    "timestamp": 6.47806555637854
+                },
+                {
+                    "x": 7.504734676211669,
+                    "y": 2.3912946510869886,
+                    "heading": 3.317801309695562,
+                    "angularVelocity": 0.411014595686653,
+                    "velocityX": 1.7147841872205727,
+                    "velocityY": 1.2074517134857092,
+                    "timestamp": 6.538388982112684
+                },
+                {
+                    "x": 7.593790089197515,
+                    "y": 2.4574102058192864,
+                    "heading": 3.3391044114920563,
+                    "angularVelocity": 0.3531480770071126,
+                    "velocityX": 1.4762989983083836,
+                    "velocityY": 1.0960179056090211,
+                    "timestamp": 6.598712407846828
+                },
+                {
+                    "x": 7.668986549958961,
+                    "y": 2.51576837810098,
+                    "heading": 3.3570614630429048,
+                    "angularVelocity": 0.297679571945867,
+                    "velocityX": 1.246554880567463,
+                    "velocityY": 0.9674213884816201,
+                    "timestamp": 6.6590358335809725
+                },
+                {
+                    "x": 7.73079167331363,
+                    "y": 2.5655824702880596,
+                    "heading": 3.37179859188409,
+                    "angularVelocity": 0.24430192187914104,
+                    "velocityX": 1.0245625576215516,
+                    "velocityY": 0.8257835423110678,
+                    "timestamp": 6.719359259315117
+                },
+                {
+                    "x": 7.779613237498961,
+                    "y": 2.6062409955381525,
+                    "heading": 3.3834244875514194,
+                    "angularVelocity": 0.1927260517094479,
+                    "velocityX": 0.8093301000592581,
+                    "velocityY": 0.6740088904977358,
+                    "timestamp": 6.779682685049261
+                },
+                {
+                    "x": 7.815805280749054,
+                    "y": 2.6372585064369205,
+                    "heading": 3.392032727236094,
+                    "angularVelocity": 0.14270143944762578,
+                    "velocityX": 0.5999666433003645,
+                    "velocityY": 0.5141868274435829,
+                    "timestamp": 6.840006110783405
+                },
+                {
+                    "x": 7.839675601727849,
+                    "y": 2.6582422341725844,
+                    "heading": 3.397704184310039,
+                    "angularVelocity": 0.09401748997048373,
+                    "velocityX": 0.3957056597547123,
+                    "velocityY": 0.3478537148759254,
+                    "timestamp": 6.90032953651755
                 },
                 {
                     "x": 7.851492881774902,
                     "y": 2.6688690185546875,
                     "heading": 3.4005091591002805,
-                    "angularVelocity": 0.047773900528336063,
-                    "velocityX": 0.19589743480415714,
-                    "velocityY": 0.17614982722838615,
-                    "timestamp": 6.960947695644321
+                    "angularVelocity": 0.04649893065761563,
+                    "velocityX": 0.1958986894931053,
+                    "velocityY": 0.17616347634064075,
+                    "timestamp": 6.960652962251694
                 },
                 {
                     "x": 7.851492881774902,
                     "y": 2.6688690185546875,
                     "heading": 3.4005091591002805,
-                    "angularVelocity": 9.276573292600319e-26,
-                    "velocityX": -1.5083414418709853e-26,
-                    "velocityY": 1.2473322363600933e-26,
-                    "timestamp": 7.021274007381847
-                },
-                {
-                    "x": 7.8398706908734885,
-                    "y": 2.659045579836875,
-                    "heading": 3.397670399128096,
-                    "angularVelocity": -0.048087115146296475,
-                    "velocityX": -0.1968738595741256,
-                    "velocityY": -0.1664039345998305,
-                    "timestamp": 7.080307699953096
-                },
-                {
-                    "x": 7.816406714095507,
-                    "y": 2.6396661861972013,
-                    "heading": 3.391938122786304,
-                    "angularVelocity": -0.09710177514092747,
-                    "velocityX": -0.3974675436347192,
-                    "velocityY": -0.3282768330353808,
-                    "timestamp": 7.1393413925243445
-                },
-                {
-                    "x": 7.780852662322508,
-                    "y": 2.6110489157431105,
-                    "heading": 3.3832503902407196,
-                    "angularVelocity": -0.1471656636606117,
-                    "velocityX": -0.6022671160217185,
-                    "velocityY": -0.4847616540258291,
-                    "timestamp": 7.198375085095593
-                },
-                {
-                    "x": 7.732926709877436,
-                    "y": 2.5735771170694988,
-                    "heading": 3.371536801646899,
-                    "angularVelocity": -0.1984220888721078,
-                    "velocityX": -0.8118406685678751,
-                    "velocityY": -0.6347527495148073,
-                    "timestamp": 7.257408777666842
-                },
-                {
-                    "x": 7.6723081853265365,
-                    "y": 2.5277198244659425,
-                    "heading": 3.356717057617367,
-                    "angularVelocity": -0.25103874387742214,
-                    "velocityX": -1.026846228155873,
-                    "velocityY": -0.7767986484702889,
-                    "timestamp": 7.316442470238091
-                },
-                {
-                    "x": 7.5986324175748425,
-                    "y": 2.474060659554904,
-                    "heading": 3.338699486712251,
-                    "angularVelocity": -0.3052082653201855,
-                    "velocityX": -1.2480291261261385,
-                    "velocityY": -0.9089583011646543,
-                    "timestamp": 7.375476162809339
-                },
-                {
-                    "x": 7.511487405741507,
-                    "y": 2.4133393759459825,
-                    "heading": 3.317379927830016,
-                    "angularVelocity": -0.36114222156278913,
-                    "velocityX": -1.476191104396181,
-                    "velocityY": -1.0285869130689465,
-                    "timestamp": 7.434509855380588
-                },
-                {
-                    "x": 7.4104163777069365,
-                    "y": 2.3465120960997368,
-                    "heading": 3.292641982912585,
-                    "angularVelocity": -0.4190479002744803,
-                    "velocityX": -1.7120905644278663,
-                    "velocityY": -1.1320193085599486,
-                    "timestamp": 7.493543547951837
-                },
-                {
-                    "x": 7.294935610990268,
-                    "y": 2.274838006810846,
-                    "heading": 3.2643611388836136,
-                    "angularVelocity": -0.47906276563741024,
-                    "velocityX": -1.9561840313020116,
-                    "velocityY": -1.2141217356916356,
-                    "timestamp": 7.552577240523085
-                },
-                {
-                    "x": 7.164587802676699,
-                    "y": 2.1999985571515315,
-                    "heading": 3.232418514985885,
-                    "angularVelocity": -0.5410914090995878,
-                    "velocityX": -2.208023971332143,
-                    "velocityY": -1.2677412914496198,
-                    "timestamp": 7.611610933094334
-                },
-                {
-                    "x": 7.019069460404565,
-                    "y": 2.1242390065298777,
-                    "heading": 3.1967356179090185,
-                    "angularVelocity": -0.6044496883504356,
-                    "velocityX": -2.4650049138719563,
-                    "velocityY": -1.283327322447578,
-                    "timestamp": 7.670644625665583
-                },
-                {
-                    "x": 6.858482408304033,
-                    "y": 2.0504663765671833,
-                    "heading": 3.157343833838982,
-                    "angularVelocity": -0.6672763019608559,
-                    "velocityX": -2.7202610086895374,
-                    "velocityY": -1.2496699215224816,
-                    "timestamp": 7.729678318236831
-                },
-                {
-                    "x": 6.683696731414882,
-                    "y": 1.9821321374647565,
-                    "heading": 3.1144766897750107,
-                    "angularVelocity": -0.7261470898543997,
-                    "velocityX": -2.960778316182739,
-                    "velocityY": -1.1575464133461344,
-                    "timestamp": 7.78871201080808
-                },
-                {
-                    "x": 6.496590119927003,
-                    "y": 1.9227240477896728,
-                    "heading": 3.068611211883559,
-                    "angularVelocity": -0.7769373029833073,
-                    "velocityX": -3.1694885299959403,
-                    "velocityY": -1.0063420919059627,
-                    "timestamp": 7.847745703379329
-                },
-                {
-                    "x": 6.299809989168005,
-                    "y": 1.8750739339769262,
-                    "heading": 3.0203961806049864,
-                    "angularVelocity": -0.8167375134188262,
-                    "velocityX": -3.333352907265656,
-                    "velocityY": -0.8071681058276496,
-                    "timestamp": 7.906779395950577
-                },
-                {
-                    "x": 6.096166852667886,
-                    "y": 1.841025283234324,
-                    "heading": 2.970514787317599,
-                    "angularVelocity": -0.8449648177976474,
-                    "velocityX": -3.449608649405423,
-                    "velocityY": -0.5767664067686196,
-                    "timestamp": 7.965813088521826
-                },
-                {
-                    "x": 5.888159130049816,
-                    "y": 1.8215785590507176,
-                    "heading": 2.919575403832584,
-                    "angularVelocity": -0.862886620611375,
-                    "velocityX": -3.5235424646192124,
-                    "velocityY": -0.32941737737539917,
-                    "timestamp": 8.024846781093075
+                    "angularVelocity": -1.5889815326108731e-28,
+                    "velocityX": -3.357307726516775e-27,
+                    "velocityY": -2.0645613226978418e-27,
+                    "timestamp": 7.020976387985838
+                },
+                {
+                    "x": 7.839871736672402,
+                    "y": 2.659044902527838,
+                    "heading": 3.397879005222776,
+                    "angularVelocity": -0.04455940593353878,
+                    "velocityX": -0.19688251948443478,
+                    "velocityY": -0.16643770454749696,
+                    "timestamp": 7.080002172158714
+                },
+                {
+                    "x": 7.816409675527677,
+                    "y": 2.639664097331194,
+                    "heading": 3.3925680599821177,
+                    "angularVelocity": -0.08997669942179426,
+                    "velocityX": -0.39748834299276414,
+                    "velocityY": -0.3283447304974564,
+                    "timestamp": 7.13902795633159
+                },
+                {
+                    "x": 7.78085819927372,
+                    "y": 2.6110446305437054,
+                    "heading": 3.3845190322360748,
+                    "angularVelocity": -0.13636460504224676,
+                    "velocityX": -0.602304175236922,
+                    "velocityY": -0.4848638131374468,
+                    "timestamp": 7.1980537405044664
+                },
+                {
+                    "x": 7.732935229810911,
+                    "y": 2.5735698133578784,
+                    "heading": 3.373666801655185,
+                    "angularVelocity": -0.18385576291719186,
+                    "velocityX": -0.811898903747731,
+                    "velocityY": -0.6348889338948905,
+                    "timestamp": 7.2570795246773425
+                },
+                {
+                    "x": 7.672319790339265,
+                    "y": 2.5277086671674183,
+                    "heading": 3.359937097674719,
+                    "angularVelocity": -0.23260519403273167,
+                    "velocityX": -1.026931540530051,
+                    "velocityY": -0.7769680120833478,
+                    "timestamp": 7.316105308850219
+                },
+                {
+                    "x": 7.598646839413137,
+                    "y": 2.474044844547294,
+                    "heading": 3.343245157116424,
+                    "angularVelocity": -0.2827906616099751,
+                    "velocityX": -1.2481486177354881,
+                    "velocityY": -0.9091589950410944,
+                    "timestamp": 7.375131093023095
+                },
+                {
+                    "x": 7.511503929455819,
+                    "y": 2.4133182068213186,
+                    "heading": 3.3234947258008027,
+                    "angularVelocity": -0.33460684330386586,
+                    "velocityX": -1.4763532781214996,
+                    "velocityY": -1.0288154334064903,
+                    "timestamp": 7.434156877195971
+                },
+                {
+                    "x": 7.410433762027863,
+                    "y": 2.3464851163906575,
+                    "heading": 3.3005783521017755,
+                    "angularVelocity": -0.38824344344006334,
+                    "velocityX": -1.7123053737319145,
+                    "velocityY": -1.1322694203421133,
+                    "timestamp": 7.493182661368847
+                },
+                {
+                    "x": 7.2949520343132965,
+                    "y": 2.274805221808202,
+                    "heading": 3.2743812863631283,
+                    "angularVelocity": -0.4438241034108166,
+                    "velocityX": -1.9564624059265545,
+                    "velocityY": -1.214382758092934,
+                    "timestamp": 7.552208445541723
+                },
+                {
+                    "x": 7.164600915240746,
+                    "y": 2.19996078160869,
+                    "heading": 3.244794267206559,
+                    "angularVelocity": -0.501255842191178,
+                    "velocityX": -2.208375897061781,
+                    "velocityY": -1.2679956945647022,
+                    "timestamp": 7.611234229714599
+                },
+                {
+                    "x": 7.019076723662156,
+                    "y": 2.124198312448077,
+                    "heading": 3.2117455235213295,
+                    "angularVelocity": -0.5599035090907978,
+                    "velocityX": -2.4654342778805964,
+                    "velocityY": -1.2835487104875807,
+                    "timestamp": 7.670260013887475
+                },
+                {
+                    "x": 6.858481968394699,
+                    "y": 2.050426351752548,
+                    "heading": 3.175264297565607,
+                    "angularVelocity": -0.6180557610022694,
+                    "velocityX": -2.7207559800832732,
+                    "velocityY": -1.2498260163636987,
+                    "timestamp": 7.729285798060351
+                },
+                {
+                    "x": 6.683688673153273,
+                    "y": 1.9820972458441994,
+                    "heading": 3.135565218611889,
+                    "angularVelocity": -0.6725718177236996,
+                    "velocityX": -2.9613040756813716,
+                    "velocityY": -1.157614538558684,
+                    "timestamp": 7.788311582233227
+                },
+                {
+                    "x": 6.4965769519072785,
+                    "y": 1.922697862826189,
+                    "heading": 3.0930877819878293,
+                    "angularVelocity": -0.7196420550661587,
+                    "velocityX": -3.169999752955046,
+                    "velocityY": -1.0063294177344664,
+                    "timestamp": 7.847337366406103
+                },
+                {
+                    "x": 6.299795589898969,
+                    "y": 1.8750576451758807,
+                    "heading": 3.0484322857695423,
+                    "angularVelocity": -0.7565421932811351,
+                    "velocityX": -3.3338203763963823,
+                    "velocityY": -0.8071085936068,
+                    "timestamp": 7.906363150578979
+                },
+                {
+                    "x": 6.0961549426702675,
+                    "y": 1.8410176211789118,
+                    "heading": 3.0022319656530985,
+                    "angularVelocity": -0.7827142114898721,
+                    "velocityX": -3.450028662597266,
+                    "velocityY": -0.5766975309853047,
+                    "timestamp": 7.965388934751855
+                },
+                {
+                    "x": 5.8881524104280425,
+                    "y": 1.8215766031247145,
+                    "heading": 2.955050627350933,
+                    "angularVelocity": -0.7993343750246449,
+                    "velocityX": -3.5239266221863828,
+                    "velocityY": -0.3293648415963126,
+                    "timestamp": 8.024414718924731
                 },
                 {
                     "x": 5.677816390991211,
                     "y": 1.8171948194503784,
-                    "heading": 2.868072689693009,
-                    "angularVelocity": -0.8724291484462967,
-                    "velocityX": -3.563096426752226,
-                    "velocityY": -0.07425826522791971,
-                    "timestamp": 8.083880473664323
-                },
-                {
-                    "x": 5.442365912429816,
-                    "y": 1.831235505391545,
-                    "heading": 2.810430444000349,
-                    "angularVelocity": -0.8757353156168458,
-                    "velocityX": -3.5771038528666774,
-                    "velocityY": 0.21331446036513985,
-                    "timestamp": 8.149702012050104
-                },
-                {
-                    "x": 5.207967241132597,
-                    "y": 1.8641978412146734,
-                    "heading": 2.753052044025448,
-                    "angularVelocity": -0.8717268143841358,
-                    "velocityX": -3.5611241706840544,
-                    "velocityY": 0.5007834309483129,
-                    "timestamp": 8.215523550435886
-                },
-                {
-                    "x": 4.977322209976329,
-                    "y": 1.915733472956131,
-                    "heading": 2.6965967084381495,
-                    "angularVelocity": -0.8577030706333759,
-                    "velocityX": -3.504096634819568,
-                    "velocityY": 0.7829600007129153,
-                    "timestamp": 8.281345088821668
-                },
-                {
-                    "x": 4.754056144303332,
-                    "y": 1.9847152153370575,
-                    "heading": 2.6419511097713526,
-                    "angularVelocity": -0.8302084698555116,
-                    "velocityX": -3.3919909979074836,
-                    "velocityY": 1.048011700617232,
-                    "timestamp": 8.34716662720745
-                },
-                {
-                    "x": 4.542560603740239,
-                    "y": 2.0685214884350387,
-                    "heading": 2.5901946725019775,
-                    "angularVelocity": -0.7863146097562858,
-                    "velocityX": -3.2131661724997835,
-                    "velocityY": 1.2732347975033529,
-                    "timestamp": 8.412988165593232
-                },
-                {
-                    "x": 4.346947756601267,
-                    "y": 2.162593065499909,
-                    "heading": 2.5423282505574454,
-                    "angularVelocity": -0.7272151809030252,
-                    "velocityX": -2.971866837758739,
-                    "velocityY": 1.4291914071274503,
-                    "timestamp": 8.478809703979014
-                },
-                {
-                    "x": 4.169641642267927,
-                    "y": 2.26135754407989,
-                    "heading": 2.4989196149597426,
-                    "angularVelocity": -0.6594898366440953,
-                    "velocityX": -2.6937400535086446,
-                    "velocityY": 1.5004887610058348,
-                    "timestamp": 8.544631242364796
-                },
-                {
-                    "x": 4.011229101161916,
-                    "y": 2.3598659918928777,
-                    "heading": 2.4601095427398985,
-                    "angularVelocity": -0.5896257239139054,
-                    "velocityX": -2.4066976401789413,
-                    "velocityY": 1.4965989891580096,
-                    "timestamp": 8.610452780750578
-                },
-                {
-                    "x": 3.8713053457808018,
-                    "y": 2.454465693871717,
-                    "heading": 2.42581281294347,
-                    "angularVelocity": -0.5210563386624898,
-                    "velocityX": -2.125804999588662,
-                    "velocityY": 1.437214995255607,
-                    "timestamp": 8.67627431913636
-                },
-                {
-                    "x": 3.7491504704503686,
-                    "y": 2.542621118074636,
-                    "heading": 2.3958642561820227,
-                    "angularVelocity": -0.45499630509875777,
-                    "velocityX": -1.8558495946186861,
-                    "velocityY": 1.3393096904881925,
-                    "timestamp": 8.742095857522141
-                },
-                {
-                    "x": 3.6440254618022103,
-                    "y": 2.6225670711356144,
-                    "heading": 2.370088465420997,
-                    "angularVelocity": -0.39160115963794145,
-                    "velocityX": -1.5971217207354962,
-                    "velocityY": 1.2145865171429433,
-                    "timestamp": 8.807917395907923
-                },
-                {
-                    "x": 3.555266392414835,
-                    "y": 2.6930420764383802,
-                    "heading": 2.3483250557484934,
-                    "angularVelocity": -0.33064267724869734,
-                    "velocityX": -1.3484806275288594,
-                    "velocityY": 1.0706982399850524,
-                    "timestamp": 8.873738934293705
-                },
-                {
-                    "x": 3.482301944919266,
-                    "y": 2.753116019704283,
-                    "heading": 2.330434726775575,
-                    "angularVelocity": -0.2718005293048944,
-                    "velocityX": -1.1085193279427956,
-                    "velocityY": 0.9126791129342325,
-                    "timestamp": 8.939560472679487
-                },
-                {
-                    "x": 3.4246464401914216,
-                    "y": 2.8020823678924462,
-                    "heading": 2.316298479297474,
-                    "angularVelocity": -0.21476628812970447,
-                    "velocityX": -0.8759367547735366,
-                    "velocityY": 0.743925915270608,
-                    "timestamp": 9.005382011065269
-                },
-                {
-                    "x": 3.381886982990636,
-                    "y": 2.8393900377748,
-                    "heading": 2.3058148947987087,
-                    "angularVelocity": -0.1592728574242708,
-                    "velocityX": -0.6496271319301332,
-                    "velocityY": 0.5668003331020922,
-                    "timestamp": 9.07120354945105
-                },
-                {
-                    "x": 3.3536707768732223,
-                    "y": 2.864599234964658,
-                    "heading": 2.298897214798888,
-                    "angularVelocity": -0.10509751320723953,
-                    "velocityX": -0.4286774027072638,
-                    "velocityY": 0.38299313276614483,
-                    "timestamp": 9.137025087836832
+                    "heading": 2.907346545445461,
+                    "angularVelocity": -0.8081905657662355,
+                    "velocityX": -3.563459975742036,
+                    "velocityY": -0.0742350776993099,
+                    "timestamp": 8.083440503097608
+                },
+                {
+                    "x": 5.442371655977857,
+                    "y": 1.8312329857861205,
+                    "heading": 2.8539540674037878,
+                    "angularVelocity": -0.8112707617342358,
+                    "velocityX": -3.5774595322493767,
+                    "velocityY": 0.21330259081926167,
+                    "timestamp": 8.149253891869979
+                },
+                {
+                    "x": 5.207978052246513,
+                    "y": 1.8641881677109164,
+                    "heading": 2.8008045056785926,
+                    "angularVelocity": -0.8075797754317682,
+                    "velocityX": -3.5614881425121783,
+                    "velocityY": 0.500736742773998,
+                    "timestamp": 8.21506728064235
+                },
+                {
+                    "x": 4.977335594971118,
+                    "y": 1.9157126949064627,
+                    "heading": 2.748508031198271,
+                    "angularVelocity": -0.7946175611956366,
+                    "velocityX": -3.5044914352172007,
+                    "velocityY": 0.782888226189873,
+                    "timestamp": 8.28088066941472
+                },
+                {
+                    "x": 4.754067600876142,
+                    "y": 1.9846814915867437,
+                    "heading": 2.6978851936191504,
+                    "angularVelocity": -0.7691875243532816,
+                    "velocityX": -3.392440326499412,
+                    "velocityY": 1.0479447718278632,
+                    "timestamp": 8.346694058187092
+                },
+                {
+                    "x": 4.542564948081897,
+                    "y": 2.068476988403223,
+                    "heading": 2.649933573452933,
+                    "angularVelocity": -0.7285997737036102,
+                    "velocityX": -3.2136721226401024,
+                    "velocityY": 1.2732287210783588,
+                    "timestamp": 8.412507446959463
+                },
+                {
+                    "x": 4.346942427891662,
+                    "y": 2.1625437031056833,
+                    "heading": 2.6055779926025404,
+                    "angularVelocity": -0.6739598382299568,
+                    "velocityX": -2.9723818183384134,
+                    "velocityY": 1.4292945015764016,
+                    "timestamp": 8.478320835731834
+                },
+                {
+                    "x": 4.1696279422067075,
+                    "y": 2.2613093610310995,
+                    "heading": 2.565350469760314,
+                    "angularVelocity": -0.6112361571497512,
+                    "velocityX": -2.6942008152510084,
+                    "velocityY": 1.5006924847315846,
+                    "timestamp": 8.544134224504205
+                },
+                {
+                    "x": 4.011210200789988,
+                    "y": 2.3598229084456155,
+                    "heading": 2.5293884262899673,
+                    "angularVelocity": -0.546424430365192,
+                    "velocityX": -2.4070746754074355,
+                    "velocityY": 1.496861797456512,
+                    "timestamp": 8.609947613276576
+                },
+                {
+                    "x": 3.871284494174842,
+                    "y": 2.4544295481535148,
+                    "heading": 2.497613892197236,
+                    "angularVelocity": -0.48279741683914584,
+                    "velocityX": -2.1260978841115015,
+                    "velocityY": 1.4374983794728338,
+                    "timestamp": 8.675761002048947
+                },
+                {
+                    "x": 3.749130246258036,
+                    "y": 2.5425923526977727,
+                    "heading": 2.469872126114301,
+                    "angularVelocity": -0.4215216174156515,
+                    "velocityX": -1.8560698696020823,
+                    "velocityY": 1.3395876764405317,
+                    "timestamp": 8.741574390821318
+                },
+                {
+                    "x": 3.6440076258991128,
+                    "y": 2.622545326222263,
+                    "heading": 2.4459987512831027,
+                    "angularVelocity": -0.362743436806896,
+                    "velocityX": -1.5972832020929764,
+                    "velocityY": 1.2148435905803896,
+                    "timestamp": 8.80738777959369
+                },
+                {
+                    "x": 3.5552519630245114,
+                    "y": 2.6930265682484116,
+                    "heading": 2.4258437576324656,
+                    "angularVelocity": -0.3062445807242533,
+                    "velocityX": -1.3485958485070668,
+                    "velocityY": 1.070925587343959,
+                    "timestamp": 8.87320116836606
+                },
+                {
+                    "x": 3.4822913234359776,
+                    "y": 2.753105759149151,
+                    "heading": 2.409277081736245,
+                    "angularVelocity": -0.2517219703352401,
+                    "velocityX": -1.1085987357509106,
+                    "velocityY": 0.9128718642423238,
+                    "timestamp": 8.939014557138432
+                },
+                {
+                    "x": 3.4246395297726133,
+                    "y": 2.8020762823137697,
+                    "heading": 2.3961877488562684,
+                    "angularVelocity": -0.19888556301588897,
+                    "velocityX": -0.8759888335603617,
+                    "velocityY": 0.7440814715375484,
+                    "timestamp": 9.004827945910803
+                },
+                {
+                    "x": 3.3818832860452783,
+                    "y": 2.8393870378309063,
+                    "heading": 2.386481246318591,
+                    "angularVelocity": -0.14748522631541322,
+                    "velocityX": -0.6496587476328872,
+                    "velocityY": 0.5669174040890574,
+                    "timestamp": 9.070641334683174
+                },
+                {
+                    "x": 3.3536694716552815,
+                    "y": 2.864598250774754,
+                    "heading": 2.380076747643575,
+                    "angularVelocity": -0.09731300567377486,
+                    "velocityX": -0.4286941444024425,
+                    "velocityY": 0.3830711867921795,
+                    "timestamp": 9.136454723455545
                 },
                 {
                     "x": 3.3396942615509033,
                     "y": 2.877351999282837,
-                    "heading": 2.2954707540735027,
-                    "angularVelocity": -0.05205683138706078,
-                    "velocityX": -0.21233954211768968,
-                    "velocityY": 0.19374758826563127,
-                    "timestamp": 9.202846626222614
+                    "heading": 2.3769046726239993,
+                    "angularVelocity": -0.048198019867158104,
+                    "velocityX": -0.2123460038308339,
+                    "velocityY": 0.19378653410774088,
+                    "timestamp": 9.202268112227916
                 },
                 {
                     "x": 3.3396942615509033,
                     "y": 2.877351999282837,
-                    "heading": 2.2954707540735027,
-                    "angularVelocity": -2.2138058328679337e-25,
-                    "velocityX": 3.908937921937773e-26,
-                    "velocityY": -5.142843079725612e-27,
-                    "timestamp": 9.268668164608396
-                },
-                {
-                    "x": 3.3516645476191473,
-                    "y": 2.8617630229365867,
-                    "heading": 2.298537948781302,
-                    "angularVelocity": 0.04572936123680092,
-                    "velocityX": 0.1784671623000002,
-                    "velocityY": -0.23241887084535387,
-                    "timestamp": 9.33574092978254
-                },
-                {
-                    "x": 3.376003702841053,
-                    "y": 2.8309022396479997,
-                    "heading": 2.3048120923274715,
-                    "angularVelocity": 0.09354234210979048,
-                    "velocityX": 0.3628768719868968,
-                    "velocityY": -0.4601090056219035,
-                    "timestamp": 9.402813694956684
-                },
-                {
-                    "x": 3.413188351414955,
-                    "y": 2.7851720067926857,
-                    "heading": 2.3144615113821967,
-                    "angularVelocity": 0.14386493578536452,
-                    "velocityX": 0.5543926581431038,
-                    "velocityY": -0.6818003214357108,
-                    "timestamp": 9.469886460130828
-                },
-                {
-                    "x": 3.463795860207917,
-                    "y": 2.725096311990658,
-                    "heading": 2.3276920106910532,
-                    "angularVelocity": 0.1972559096751932,
-                    "velocityX": 0.7545165114568831,
-                    "velocityY": -0.8956794109509365,
-                    "timestamp": 9.536959225304972
-                },
-                {
-                    "x": 3.5285345689846737,
-                    "y": 2.6513792453542453,
-                    "heading": 2.344759157342521,
-                    "angularVelocity": 0.254457179559477,
-                    "velocityX": 0.9652011305732239,
-                    "velocityY": -1.099061093500722,
-                    "timestamp": 9.604031990479116
-                },
-                {
-                    "x": 3.608282029663586,
-                    "y": 2.5650027653656142,
-                    "heading": 2.365984707549641,
-                    "angularVelocity": 0.31645557108032524,
-                    "velocityX": 1.1889693301276525,
-                    "velocityY": -1.2878025792490757,
-                    "timestamp": 9.67110475565326
-                },
-                {
-                    "x": 3.7041249846999373,
-                    "y": 2.467396548832097,
-                    "heading": 2.391775895173838,
-                    "angularVelocity": 0.3845254859738355,
-                    "velocityX": 1.4289399697106506,
-                    "velocityY": -1.4552287546233942,
-                    "timestamp": 9.738177520827405
-                },
-                {
-                    "x": 3.817367854577491,
-                    "y": 2.360738630218002,
-                    "heading": 2.4226367432261977,
-                    "angularVelocity": 0.46010997119671315,
-                    "velocityX": 1.6883584504610083,
-                    "velocityY": -1.590182219820124,
-                    "timestamp": 9.805250286001549
-                },
-                {
-                    "x": 3.949385432841112,
-                    "y": 2.2484593214367075,
-                    "heading": 2.459128147951867,
-                    "angularVelocity": 0.5440569600928907,
-                    "velocityX": 1.968273977088275,
-                    "velocityY": -1.6739925436170393,
-                    "timestamp": 9.872323051175693
-                },
-                {
-                    "x": 4.100985215141024,
-                    "y": 2.135844091585944,
-                    "heading": 2.5016794738291117,
-                    "angularVelocity": 0.6344054217351344,
-                    "velocityX": 2.2602286025677487,
-                    "velocityY": -1.679000851662739,
-                    "timestamp": 9.939395816349837
-                },
-                {
-                    "x": 4.271035246020557,
-                    "y": 2.029803920822179,
-                    "heading": 2.55023405409309,
-                    "angularVelocity": 0.7239090283204185,
-                    "velocityX": 2.535306699194872,
-                    "velocityY": -1.5809721052717514,
-                    "timestamp": 10.00646858152398
-                },
-                {
-                    "x": 4.455854041914051,
-                    "y": 1.9366653659853252,
-                    "heading": 2.60397591092134,
-                    "angularVelocity": 0.801247073811809,
-                    "velocityX": 2.7554968907818176,
-                    "velocityY": -1.3886195774847423,
-                    "timestamp": 10.073541346698125
-                },
-                {
-                    "x": 4.650909282787146,
-                    "y": 1.8602874196738752,
-                    "heading": 2.6616516476615515,
-                    "angularVelocity": 0.8598980016772068,
-                    "velocityX": 2.908113902366535,
-                    "velocityY": -1.1387326303477394,
-                    "timestamp": 10.140614111872269
-                },
-                {
-                    "x": 4.852413526913252,
-                    "y": 1.8024799152254807,
-                    "heading": 2.722142252767918,
-                    "angularVelocity": 0.9018653838008867,
-                    "velocityX": 3.0042632595052488,
-                    "velocityY": -0.8618625502960255,
-                    "timestamp": 10.207686877046413
-                },
-                {
-                    "x": 5.057594824272398,
-                    "y": 1.763994130666435,
-                    "heading": 2.7846105473763534,
-                    "angularVelocity": 0.9313511146624962,
-                    "velocityX": 3.059085111914244,
-                    "velocityY": -0.5737915301258724,
-                    "timestamp": 10.274759642220557
-                },
-                {
-                    "x": 5.264464307067692,
-                    "y": 1.7451094274340988,
-                    "heading": 2.848447740477815,
-                    "angularVelocity": 0.9517602701441944,
-                    "velocityX": 3.0842545742402043,
-                    "velocityY": -0.28155545970566304,
-                    "timestamp": 10.341832407394701
-                },
-                {
-                    "x": 5.471568697214922,
-                    "y": 1.745899571938889,
-                    "heading": 2.913204372628034,
-                    "angularVelocity": 0.9654683533933353,
-                    "velocityX": 3.087756850481914,
-                    "velocityY": 0.01178040748340537,
-                    "timestamp": 10.408905172568845
+                    "heading": 2.3769046726239993,
+                    "angularVelocity": 8.699347294583009e-29,
+                    "velocityX": 8.966370263182221e-27,
+                    "velocityY": 9.299144171685505e-27,
+                    "timestamp": 9.268081501000287
+                },
+                {
+                    "x": 3.3516625830764935,
+                    "y": 2.861762565335628,
+                    "heading": 2.3798027568533566,
+                    "angularVelocity": 0.04321176422934021,
+                    "velocityX": 0.1784531597618389,
+                    "velocityY": -0.23244560574593578,
+                    "timestamp": 9.335148520388248
+                },
+                {
+                    "x": 3.3759979879487325,
+                    "y": 2.8309006486888566,
+                    "heading": 2.3857310557967786,
+                    "angularVelocity": 0.08839365454917242,
+                    "velocityX": 0.3628520410526427,
+                    "velocityY": -0.4601653231112726,
+                    "timestamp": 9.40221553977621
+                },
+                {
+                    "x": 3.4131773512442836,
+                    "y": 2.7851683566473224,
+                    "heading": 2.3948487463537145,
+                    "angularVelocity": 0.13594894540031874,
+                    "velocityX": 0.5543613483175733,
+                    "velocityY": -0.6818894362516296,
+                    "timestamp": 9.46928255916417
+                },
+                {
+                    "x": 3.463778400038,
+                    "y": 2.7250893961159655,
+                    "heading": 2.407350522660198,
+                    "angularVelocity": 0.18640721505998045,
+                    "velocityX": 0.7544848310762926,
+                    "velocityY": -0.895804839392364,
+                    "timestamp": 9.536349578552132
+                },
+                {
+                    "x": 3.5285100034686807,
+                    "y": 2.6513675596934068,
+                    "heading": 2.423478332665211,
+                    "angularVelocity": 0.2404730395385411,
+                    "velocityX": 0.9651778776126764,
+                    "velocityY": -1.0992263722963704,
+                    "timestamp": 9.603416597940093
+                },
+                {
+                    "x": 3.608250506819797,
+                    "y": 2.5649845398562943,
+                    "heading": 2.443537205147885,
+                    "angularVelocity": 0.29908698292732966,
+                    "velocityX": 1.1889674549251013,
+                    "velocityY": -1.2880104204037197,
+                    "timestamp": 9.670483617328054
+                },
+                {
+                    "x": 3.704087845598115,
+                    "y": 2.4673699165153473,
+                    "heading": 2.467914194177291,
+                    "angularVelocity": 0.36347207989657143,
+                    "velocityX": 1.4289786493109158,
+                    "velocityY": -1.4554787767781576,
+                    "timestamp": 9.737550636716016
+                },
+                {
+                    "x": 3.8173281503467877,
+                    "y": 2.3607021391611296,
+                    "heading": 2.4970905528957617,
+                    "angularVelocity": 0.43503288180580346,
+                    "velocityX": 1.6884648487748337,
+                    "velocityY": -1.5904654527313735,
+                    "timestamp": 9.804617656103977
+                },
+                {
+                    "x": 3.949348217986618,
+                    "y": 2.248413089529829,
+                    "heading": 2.531605230749573,
+                    "angularVelocity": 0.5146296669925818,
+                    "velocityX": 1.9684797213983332,
+                    "velocityY": -1.674281198956299,
+                    "timestamp": 9.871684675491938
+                },
+                {
+                    "x": 4.100956630482294,
+                    "y": 2.1357913846970256,
+                    "heading": 2.5718681396894523,
+                    "angularVelocity": 0.6003384272524676,
+                    "velocityX": 2.2605509217380098,
+                    "velocityY": -1.6792412404869688,
+                    "timestamp": 9.9387516948799
+                },
+                {
+                    "x": 4.271019524465303,
+                    "y": 2.02975174701908,
+                    "heading": 2.617805882913228,
+                    "angularVelocity": 0.6849528075497259,
+                    "velocityX": 2.5357156995340735,
+                    "velocityY": -1.5810996022432426,
+                    "timestamp": 10.00581871426786
+                },
+                {
+                    "x": 4.455850074444798,
+                    "y": 1.936621120126799,
+                    "heading": 2.6686369840979474,
+                    "angularVelocity": 0.7579150176732569,
+                    "velocityX": 2.755908219363514,
+                    "velocityY": -1.3886203344381607,
+                    "timestamp": 10.072885733655822
+                },
+                {
+                    "x": 4.650912904466248,
+                    "y": 1.8602546060912546,
+                    "heading": 2.7231836593037944,
+                    "angularVelocity": 0.8133159294035703,
+                    "velocityX": 2.908476204870152,
+                    "velocityY": -1.138659727723825,
+                    "timestamp": 10.139952753043783
+                },
+                {
+                    "x": 4.852420678438731,
+                    "y": 1.8024586285174926,
+                    "heading": 2.7803910249763573,
+                    "angularVelocity": 0.8529880438198227,
+                    "velocityX": 3.004573273292882,
+                    "velocityY": -0.8617645170636102,
+                    "timestamp": 10.207019772431744
+                },
+                {
+                    "x": 5.05760246636137,
+                    "y": 1.7639825860583975,
+                    "heading": 2.839468056705675,
+                    "angularVelocity": 0.8808656217085786,
+                    "velocityX": 3.059354505315471,
+                    "velocityY": -0.5736954289935475,
+                    "timestamp": 10.274086791819705
+                },
+                {
+                    "x": 5.264470410929027,
+                    "y": 1.7451049209511764,
+                    "heading": 2.8998392064876755,
+                    "angularVelocity": 0.9001615150477019,
+                    "velocityX": 3.0844958737616186,
+                    "velocityY": -0.2814746395395884,
+                    "timestamp": 10.341153811207667
+                },
+                {
+                    "x": 5.4715720463226285,
+                    "y": 1.745898973757099,
+                    "heading": 2.9610795307026567,
+                    "angularVelocity": 0.9131213042393547,
+                    "velocityX": 3.0879803110912887,
+                    "velocityY": 0.011839691299369801,
+                    "timestamp": 10.408220830595628
                 },
                 {
                     "x": 5.677816390991211,
                     "y": 1.7663486003875732,
-                    "heading": 2.9785400944393525,
-                    "angularVelocity": 0.9741021059991204,
-                    "velocityX": 3.0749842091763746,
-                    "velocityY": 0.3048782675888085,
-                    "timestamp": 10.47597793774299
-                },
-                {
-                    "x": 5.869498283497575,
-                    "y": 1.8026990212845277,
-                    "heading": 3.040009892901514,
-                    "angularVelocity": 0.978495765710481,
-                    "velocityX": 3.051253214963835,
-                    "velocityY": 0.5786375393984518,
-                    "timestamp": 10.538798647465253
-                },
-                {
-                    "x": 6.059212183017009,
-                    "y": 1.856199315511381,
-                    "heading": 3.101605164447669,
-                    "angularVelocity": 0.9804930860933324,
-                    "velocityX": 3.019926077852052,
-                    "velocityY": 0.8516346673475012,
-                    "timestamp": 10.601619357187516
-                },
-                {
-                    "x": 6.246366657416464,
-                    "y": 1.9267712723501649,
-                    "heading": 3.1631385311618336,
-                    "angularVelocity": 0.9795076653258243,
-                    "velocityX": 2.9791843362942707,
-                    "velocityY": 1.12338681225969,
-                    "timestamp": 10.66444006690978
-                },
-                {
-                    "x": 6.430212631499626,
-                    "y": 2.014285410480658,
-                    "heading": 3.2243713465018264,
-                    "angularVelocity": 0.9747233931407323,
-                    "velocityX": 2.92651857796523,
-                    "velocityY": 1.3930778324123159,
-                    "timestamp": 10.727260776632043
-                },
-                {
-                    "x": 6.609777595601999,
-                    "y": 2.118521635924677,
-                    "heading": 3.284991437728681,
-                    "angularVelocity": 0.9649698561965084,
-                    "velocityX": 2.858372102070309,
-                    "velocityY": 1.6592653267506663,
-                    "timestamp": 10.790081486354307
-                },
-                {
-                    "x": 6.783764646274751,
-                    "y": 2.239091051762057,
-                    "heading": 3.3445780348502288,
-                    "angularVelocity": 0.9485183689421323,
-                    "velocityX": 2.7695811053706194,
-                    "velocityY": 1.9192622364572296,
-                    "timestamp": 10.85290219607657
-                },
-                {
-                    "x": 6.950401684609891,
-                    "y": 2.3752716608654083,
-                    "heading": 3.402547014524198,
-                    "angularVelocity": 0.9227686208935938,
-                    "velocityX": 2.6525812756949354,
-                    "velocityY": 2.167766166689632,
-                    "timestamp": 10.915722905798834
-                },
-                {
-                    "x": 7.107252334800024,
-                    "y": 2.525651797665975,
-                    "heading": 3.4580758800306346,
-                    "angularVelocity": 0.8839261089525424,
-                    "velocityX": 2.496798442481599,
-                    "velocityY": 2.3937987562606944,
-                    "timestamp": 10.978543615521097
-                },
-                {
-                    "x": 7.25116745034712,
-                    "y": 2.6874080724763414,
-                    "heading": 3.510064675427793,
-                    "angularVelocity": 0.8275741491461444,
-                    "velocityX": 2.290886495605672,
-                    "velocityY": 2.5748877324931376,
-                    "timestamp": 11.04136432524336
-                },
-                {
-                    "x": 7.379049043556767,
-                    "y": 2.855386112012741,
-                    "heading": 3.557350238869835,
-                    "angularVelocity": 0.7527066098281388,
-                    "velocityX": 2.0356597971437416,
-                    "velocityY": 2.673927758521817,
-                    "timestamp": 11.104185034965624
-                },
-                {
-                    "x": 7.48976542528158,
-                    "y": 3.0226940652081797,
-                    "heading": 3.5992337594928014,
-                    "angularVelocity": 0.666715177337827,
-                    "velocityX": 1.7624185115752826,
-                    "velocityY": 2.6632611114252915,
-                    "timestamp": 11.167005744687888
-                },
-                {
-                    "x": 7.584603731721159,
-                    "y": 3.183437719649434,
-                    "heading": 3.6358032566417093,
-                    "angularVelocity": 0.5821248647235219,
-                    "velocityX": 1.5096662686376792,
-                    "velocityY": 2.558768519997944,
-                    "timestamp": 11.229826454410151
-                },
-                {
-                    "x": 7.665647899394972,
-                    "y": 3.3339132583126054,
-                    "heading": 3.66757214697857,
-                    "angularVelocity": 0.5057072815209269,
-                    "velocityX": 1.2900867887694702,
-                    "velocityY": 2.3953173933952745,
-                    "timestamp": 11.292647164132415
-                },
-                {
-                    "x": 7.734758840021845,
-                    "y": 3.4719883665738904,
-                    "heading": 3.695057946928366,
-                    "angularVelocity": 0.4375276890584947,
-                    "velocityX": 1.1001298923940959,
-                    "velocityY": 2.1979234057006147,
-                    "timestamp": 11.355467873854678
-                },
-                {
-                    "x": 7.793387895501397,
-                    "y": 3.596402025341782,
-                    "heading": 3.7186750616098347,
-                    "angularVelocity": 0.37594472883039054,
-                    "velocityX": 0.9332759171100913,
-                    "velocityY": 1.9804561157926779,
-                    "timestamp": 11.418288583576942
-                },
-                {
-                    "x": 7.842641745167335,
-                    "y": 3.706364225843829,
-                    "heading": 3.7387425543728092,
-                    "angularVelocity": 0.3194407202926423,
-                    "velocityX": 0.7840384147790729,
-                    "velocityY": 1.7504132154539842,
-                    "timestamp": 11.481109293299205
-                },
-                {
-                    "x": 7.883372973162177,
-                    "y": 3.801350711025084,
-                    "heading": 3.755507752795704,
-                    "angularVelocity": 0.26687375066304414,
-                    "velocityX": 0.6483726174842498,
-                    "velocityY": 1.5120250248875047,
-                    "timestamp": 11.543930003021469
-                },
-                {
-                    "x": 7.916250955707456,
-                    "y": 3.8809958185462916,
-                    "heading": 3.7691658139622635,
-                    "angularVelocity": 0.21741335344575932,
-                    "velocityX": 0.5233621633795045,
-                    "velocityY": 1.2678161051240537,
-                    "timestamp": 11.606750712743732
-                },
-                {
-                    "x": 7.941811781791086,
-                    "y": 3.9450337141673115,
-                    "heading": 3.7798737136826723,
-                    "angularVelocity": 0.1704517470074654,
-                    "velocityX": 0.4068853439675645,
-                    "velocityY": 1.0193755515360785,
-                    "timestamp": 11.669571422465996
-                },
-                {
-                    "x": 7.960492791122214,
-                    "y": 3.993264403965962,
-                    "heading": 3.7877599997554308,
-                    "angularVelocity": 0.12553640523363524,
-                    "velocityX": 0.2973702368807853,
-                    "velocityY": 0.7677514312061038,
-                    "timestamp": 11.73239213218826
-                },
-                {
-                    "x": 7.972656678308661,
-                    "y": 4.025533086521562,
-                    "heading": 3.7929316378195392,
-                    "angularVelocity": 0.08232377645800033,
-                    "velocityX": 0.19362861769987666,
-                    "velocityY": 0.5136631327195069,
-                    "timestamp": 11.795212841910523
+                    "heading": 3.022867248231808,
+                    "angularVelocity": 0.9212831894575391,
+                    "velocityX": 3.0751977134323645,
+                    "velocityY": 0.30491330637760916,
+                    "timestamp": 10.475287849983589
+                },
+                {
+                    "x": 5.869498315560729,
+                    "y": 1.8026975491019477,
+                    "heading": 3.0809998241533054,
+                    "angularVelocity": 0.9254361464923138,
+                    "velocityX": 3.051462606188219,
+                    "velocityY": 0.5786537151338974,
+                    "timestamp": 10.538104259459097
+                },
+                {
+                    "x": 6.0592123423789275,
+                    "y": 1.8561940082480726,
+                    "heading": 3.1392509157059085,
+                    "angularVelocity": 0.9273228450810435,
+                    "velocityX": 3.0201348405971915,
+                    "velocityY": 0.8516319158130763,
+                    "timestamp": 10.600920668934604
+                },
+                {
+                    "x": 6.246367362862811,
+                    "y": 1.9267598042730498,
+                    "heading": 3.197443332957825,
+                    "angularVelocity": 0.9263887849974373,
+                    "velocityX": 2.9793969767860897,
+                    "velocityY": 1.1233656398729925,
+                    "timestamp": 10.663737078410112
+                },
+                {
+                    "x": 6.430214724431651,
+                    "y": 2.014265565864972,
+                    "heading": 3.25535141192564,
+                    "angularVelocity": 0.9218622880760795,
+                    "velocityX": 2.9267410077063314,
+                    "velocityY": 1.393039849341311,
+                    "timestamp": 10.726553487885619
+                },
+                {
+                    "x": 6.609782474245099,
+                    "y": 2.11849145104989,
+                    "heading": 3.312679976603456,
+                    "angularVelocity": 0.9126367641271997,
+                    "velocityX": 2.8586121256017254,
+                    "velocityY": 1.6592143049111507,
+                    "timestamp": 10.789369897361127
+                },
+                {
+                    "x": 6.783774433001653,
+                    "y": 2.2390490978953044,
+                    "heading": 3.3690311941233704,
+                    "angularVelocity": 0.8970779767647533,
+                    "velocityX": 2.7698488374187553,
+                    "velocityY": 1.9192062687444857,
+                    "timestamp": 10.852186306836634
+                },
+                {
+                    "x": 6.9504193672294985,
+                    "y": 2.3752176143671733,
+                    "heading": 3.4238528114702502,
+                    "angularVelocity": 0.8727276487882547,
+                    "velocityX": 2.652888562387848,
+                    "velocityY": 2.1677220587553996,
+                    "timestamp": 10.915002716312141
+                },
+                {
+                    "x": 7.107281588598214,
+                    "y": 2.52558752514108,
+                    "heading": 3.476367044923788,
+                    "angularVelocity": 0.8359954650705317,
+                    "velocityX": 2.4971535730624357,
+                    "velocityY": 2.393799837167353,
+                    "timestamp": 10.977819125787649
+                },
+                {
+                    "x": 7.251211218612922,
+                    "y": 2.6873391007207674,
+                    "heading": 3.5255323995870227,
+                    "angularVelocity": 0.7826833000126306,
+                    "velocityX": 2.2912743854108286,
+                    "velocityY": 2.5749891935920948,
+                    "timestamp": 11.040635535263156
+                },
+                {
+                    "x": 7.379106119935948,
+                    "y": 2.855321266683036,
+                    "heading": 3.570245943801856,
+                    "angularVelocity": 0.7118131167982105,
+                    "velocityX": 2.036011010353802,
+                    "velocityY": 2.6741764988616117,
+                    "timestamp": 11.103451944738664
+                },
+                {
+                    "x": 7.489828992967153,
+                    "y": 3.0226403080656628,
+                    "heading": 3.6098523077969857,
+                    "angularVelocity": 0.6305098353412365,
+                    "velocityX": 1.7626424998770196,
+                    "velocityY": 2.6636199486674914,
+                    "timestamp": 11.166268354214171
+                },
+                {
+                    "x": 7.5846664001825115,
+                    "y": 3.1833964842133824,
+                    "heading": 3.6444385665610812,
+                    "angularVelocity": 0.5505927360840481,
+                    "velocityX": 1.5097553013171952,
+                    "velocityY": 2.5591430247282747,
+                    "timestamp": 11.229084763689679
+                },
+                {
+                    "x": 7.6657049690486385,
+                    "y": 3.333883053307194,
+                    "heading": 3.6744875788552074,
+                    "angularVelocity": 0.4783624620544796,
+                    "velocityX": 1.2900859750305362,
+                    "velocityY": 2.3956569684628017,
+                    "timestamp": 11.291901173165186
+                },
+                {
+                    "x": 7.7348079326686,
+                    "y": 3.471967025062567,
+                    "heading": 3.7004866328547554,
+                    "angularVelocity": 0.4138895269027619,
+                    "velocityX": 1.1000782151820558,
+                    "velocityY": 2.1982149713477863,
+                    "timestamp": 11.354717582640694
+                },
+                {
+                    "x": 7.793428112313008,
+                    "y": 3.5963874907480546,
+                    "heading": 3.7228267453311363,
+                    "angularVelocity": 0.3556413469491874,
+                    "velocityX": 0.9331985086996176,
+                    "velocityY": 1.980700054720585,
+                    "timestamp": 11.417533992116201
+                },
+                {
+                    "x": 7.8426730977585235,
+                    "y": 3.7063547510103105,
+                    "heading": 3.7418093512359456,
+                    "angularVelocity": 0.30219183272820804,
+                    "velocityX": 0.783950974859778,
+                    "velocityY": 1.7506135925379998,
+                    "timestamp": 11.480350401591709
+                },
+                {
+                    "x": 7.883396045766907,
+                    "y": 3.8013448757169503,
+                    "heading": 3.757668265765805,
+                    "angularVelocity": 0.25246451782703877,
+                    "velocityX": 0.6482851908984306,
+                    "velocityY": 1.5121864732443446,
+                    "timestamp": 11.543166811067216
+                },
+                {
+                    "x": 7.916266704646568,
+                    "y": 3.8809924971435787,
+                    "heading": 3.7705880432506556,
+                    "angularVelocity": 0.20567519845093782,
+                    "velocityX": 0.5232814029664861,
+                    "velocityY": 1.2679429163757567,
+                    "timestamp": 11.605983220542724
+                },
+                {
+                    "x": 7.941821412998917,
+                    "y": 3.9450320342824847,
+                    "heading": 3.7807171527629357,
+                    "angularVelocity": 0.16124941869257636,
+                    "velocityX": 0.4068158076165283,
+                    "velocityY": 1.0194714673062533,
+                    "timestamp": 11.668799630018231
+                },
+                {
+                    "x": 7.960497682770524,
+                    "y": 3.993263707972552,
+                    "heading": 3.7881771819141687,
+                    "angularVelocity": 0.11875924163003808,
+                    "velocityX": 0.29731514308994755,
+                    "velocityY": 0.7678196524249489,
+                    "timestamp": 11.731616039493739
+                },
+                {
+                    "x": 7.972658330298564,
+                    "y": 4.0255328988210515,
+                    "heading": 3.7930693040909933,
+                    "angularVelocity": 0.0778796849051358,
+                    "velocityX": 0.19359029956625398,
+                    "velocityY": 0.513706388472933,
+                    "timestamp": 11.794432448969246
                 },
                 {
                     "x": 7.97860860824585,
                     "y": 4.041717052459717,
                     "heading": 3.7954788959034658,
-                    "angularVelocity": 0.04054806281539965,
-                    "velocityX": 0.09474471019991201,
-                    "velocityY": 0.2576215074567916,
-                    "timestamp": 11.858033551632786
+                    "angularVelocity": 0.038359273199338115,
+                    "velocityX": 0.09472489747453801,
+                    "velocityY": 0.257642131630843,
+                    "timestamp": 11.857248858444754
                 },
                 {
                     "x": 7.97860860824585,
                     "y": 4.041717052459717,
                     "heading": 3.7954788959034658,
-                    "angularVelocity": 1.081663947501335e-26,
-                    "velocityX": -9.481769134483666e-28,
-                    "velocityY": -9.233714768009215e-27,
-                    "timestamp": 11.92085426135505
-                },
-                {
-                    "x": 7.973189079938411,
-                    "y": 4.026463842839712,
-                    "heading": 3.793127862432137,
-                    "angularVelocity": -0.03862699851561016,
-                    "velocityX": -0.08904174034085098,
-                    "velocityY": -0.25060711067509717,
-                    "timestamp": 11.981719292594244
-                },
-                {
-                    "x": 7.96211997120059,
-                    "y": 3.996042186549112,
-                    "heading": 3.788358107501387,
-                    "angularVelocity": -0.07836609681518215,
-                    "velocityX": -0.1818631899541847,
-                    "velocityY": -0.49982158344823596,
-                    "timestamp": 12.042584323833438
-                },
-                {
-                    "x": 7.945132814358059,
-                    "y": 3.9505560796650534,
-                    "heading": 3.7810908608062244,
-                    "angularVelocity": -0.11939937509606813,
-                    "velocityX": -0.27909550848290027,
-                    "velocityY": -0.7473274219691394,
-                    "timestamp": 12.103449355072632
-                },
-                {
-                    "x": 7.921910586758543,
-                    "y": 3.890135520000167,
-                    "heading": 3.7712333978408124,
-                    "angularVelocity": -0.16195609802076888,
-                    "velocityX": -0.3815364442721711,
-                    "velocityY": -0.9926974230480341,
-                    "timestamp": 12.164314386311826
-                },
-                {
-                    "x": 7.892073849640702,
-                    "y": 3.8149466158138026,
-                    "heading": 3.7586751345824734,
-                    "angularVelocity": -0.20632969379389762,
-                    "velocityX": -0.4902114812129911,
-                    "velocityY": -1.2353382994395923,
-                    "timestamp": 12.22517941755102
-                },
-                {
-                    "x": 7.855161431332755,
-                    "y": 3.7252072224578345,
-                    "heading": 3.743282218448319,
-                    "angularVelocity": -0.2529024600950483,
-                    "velocityX": -0.606463474287625,
-                    "velocityY": -1.4743998570098393,
-                    "timestamp": 12.286044448790214
-                },
-                {
-                    "x": 7.810603011221402,
-                    "y": 3.6212121261116588,
-                    "heading": 3.7248899061541354,
-                    "angularVelocity": -0.3021819248215532,
-                    "velocityX": -0.7320857182549075,
-                    "velocityY": -1.7086181380156253,
-                    "timestamp": 12.346909480029408
-                },
-                {
-                    "x": 7.75767969326837,
-                    "y": 3.503375512839711,
-                    "heading": 3.703291696041228,
-                    "angularVelocity": -0.35485416951530235,
-                    "velocityX": -0.8695192769235301,
-                    "velocityY": -1.9360314267951175,
-                    "timestamp": 12.407774511268602
-                },
-                {
-                    "x": 7.695467478966328,
-                    "y": 3.372306326826921,
-                    "heading": 3.678223928018662,
-                    "angularVelocity": -0.41185829551375247,
-                    "velocityX": -1.0221339418615227,
-                    "velocityY": -2.1534398873089917,
-                    "timestamp": 12.468639542507796
-                },
-                {
-                    "x": 7.622760415809598,
-                    "y": 3.2289490492757267,
-                    "heading": 3.6493453622484107,
-                    "angularVelocity": -0.4744689221757036,
-                    "velocityX": -1.1945621595263345,
-                    "velocityY": -2.3553307150671072,
-                    "timestamp": 12.52950457374699
-                },
-                {
-                    "x": 7.537989170266957,
-                    "y": 3.074856416210723,
-                    "heading": 3.6162182235150375,
-                    "angularVelocity": -0.5442721059845679,
-                    "velocityX": -1.3927742057585912,
-                    "velocityY": -2.5317104078930326,
-                    "timestamp": 12.590369604986185
-                },
-                {
-                    "x": 7.439241543844895,
-                    "y": 2.912701143314702,
-                    "heading": 3.5783337834184628,
-                    "angularVelocity": -0.6224335932350433,
-                    "velocityX": -1.6224032816805989,
-                    "velocityY": -2.664177929339482,
-                    "timestamp": 12.651234636225379
-                },
-                {
-                    "x": 7.324766462909669,
-                    "y": 2.746988913544774,
-                    "heading": 3.5353421357377637,
-                    "angularVelocity": -0.706343968045381,
-                    "velocityX": -1.880802138839768,
-                    "velocityY": -2.722618002423959,
-                    "timestamp": 12.712099667464573
-                },
-                {
-                    "x": 7.194385716013789,
-                    "y": 2.583976737212008,
-                    "heading": 3.4875425161473705,
-                    "angularVelocity": -0.7853379619989738,
-                    "velocityX": -2.1421289735890285,
-                    "velocityY": -2.6782566773381076,
-                    "timestamp": 12.772964698703767
-                },
-                {
-                    "x": 7.050272925938226,
-                    "y": 2.4294807954441997,
-                    "heading": 3.4358824464756204,
-                    "angularVelocity": -0.8487643663359049,
-                    "velocityX": -2.3677436311370705,
-                    "velocityY": -2.5383366872950677,
-                    "timestamp": 12.833829729942961
-                },
-                {
-                    "x": 6.895473593565761,
-                    "y": 2.287134578977517,
-                    "heading": 3.3814523385529762,
-                    "angularVelocity": -0.8942755275806573,
-                    "velocityX": -2.5433213328046476,
-                    "velocityY": -2.3387191884823553,
-                    "timestamp": 12.894694761182155
-                },
-                {
-                    "x": 6.732591084116293,
-                    "y": 2.1588201874781916,
-                    "heading": 3.3251409447097355,
-                    "angularVelocity": -0.9251846700273916,
-                    "velocityX": -2.6761262769972647,
-                    "velocityY": -2.108179177548776,
-                    "timestamp": 12.955559792421349
-                },
-                {
-                    "x": 6.563562240961557,
-                    "y": 2.0454941987485715,
-                    "heading": 3.26759140242196,
-                    "angularVelocity": -0.9455271954369048,
-                    "velocityX": -2.7771092811973754,
-                    "velocityY": -1.8619227891998904,
-                    "timestamp": 13.016424823660543
-                },
-                {
-                    "x": 6.389800863403908,
-                    "y": 1.9476641851905458,
-                    "heading": 3.209264282654608,
-                    "angularVelocity": -0.9583026342027352,
-                    "velocityX": -2.854863852361817,
-                    "velocityY": -1.6073270902229824,
-                    "timestamp": 13.077289854899737
-                },
-                {
-                    "x": 6.212356894659494,
-                    "y": 1.8656139570355461,
-                    "heading": 3.1504971848650327,
-                    "angularVelocity": -0.9655313830140856,
-                    "velocityX": -2.915368071480525,
-                    "velocityY": -1.3480684472591271,
-                    "timestamp": 13.138154886138931
-                },
-                {
-                    "x": 6.032030314899095,
-                    "y": 1.7995095607928446,
-                    "heading": 3.0915449896362426,
-                    "angularVelocity": -0.9685724960382134,
-                    "velocityX": -2.9627287802043525,
-                    "velocityY": -1.086081694149083,
-                    "timestamp": 13.199019917378125
-                },
-                {
-                    "x": 5.849446338451813,
-                    "y": 1.7494515528487504,
-                    "heading": 3.032605568444944,
-                    "angularVelocity": -0.9683626212179334,
-                    "velocityX": -2.9998173455254054,
-                    "velocityY": -0.8224428202027946,
-                    "timestamp": 13.25988494861732
+                    "angularVelocity": 2.7641446763079204e-28,
+                    "velocityX": -4.8321001161270604e-27,
+                    "velocityY": -6.381302523611655e-27,
+                    "timestamp": 11.920065267920261
+                },
+                {
+                    "x": 7.9731832513294965,
+                    "y": 4.026487402904062,
+                    "heading": 3.7932364227144895,
+                    "angularVelocity": -0.0368681350379896,
+                    "velocityX": -0.08919740597331677,
+                    "velocityY": -0.25038817817727327,
+                    "timestamp": 11.980889423703179
+                },
+                {
+                    "x": 7.962103008768326,
+                    "y": 3.996112792343719,
+                    "heading": 3.788687152758471,
+                    "angularVelocity": -0.07479380350554962,
+                    "velocityX": -0.18216845624155484,
+                    "velocityY": -0.4993840057353227,
+                    "timestamp": 12.041713579486096
+                },
+                {
+                    "x": 7.945100079421275,
+                    "y": 3.950697091129024,
+                    "heading": 3.7817562440819508,
+                    "angularVelocity": -0.1139499362926918,
+                    "velocityX": -0.27954238128244496,
+                    "velocityY": -0.7466721178471404,
+                    "timestamp": 12.102537735269014
+                },
+                {
+                    "x": 7.92185830417986,
+                    "y": 3.890370089672628,
+                    "heading": 3.772355616140964,
+                    "angularVelocity": -0.1545541869012955,
+                    "velocityX": -0.3821142265313985,
+                    "velocityY": -0.9918263670062992,
+                    "timestamp": 12.163361891051931
+                },
+                {
+                    "x": 7.891999384931547,
+                    "y": 3.8152975554838595,
+                    "heading": 3.760380253516664,
+                    "angularVelocity": -0.19688497884031883,
+                    "velocityX": -0.49090560919382475,
+                    "velocityY": -1.2342552596488783,
+                    "timestamp": 12.224186046834848
+                },
+                {
+                    "x": 7.85506368954834,
+                    "y": 3.72569677838064,
+                    "heading": 3.745703091329558,
+                    "angularVelocity": -0.24130482368698247,
+                    "velocityX": -0.6072537285191664,
+                    "velocityY": -1.4731117259236042,
+                    "timestamp": 12.285010202617766
+                },
+                {
+                    "x": 7.810483024689109,
+                    "y": 3.6218615851815734,
+                    "heading": 3.7281678174840622,
+                    "angularVelocity": -0.2882945701388696,
+                    "velocityX": -0.7329434216619469,
+                    "velocityY": -1.7071374335166476,
+                    "timestamp": 12.345834358400683
+                },
+                {
+                    "x": 7.75754150465543,
+                    "y": 3.5042044804582817,
+                    "heading": 3.707578629757375,
+                    "angularVelocity": -0.338503468920643,
+                    "velocityX": -0.8704028745195956,
+                    "velocityY": -1.9343812208953974,
+                    "timestamp": 12.4066585141836
+                },
+                {
+                    "x": 7.695319475194805,
+                    "y": 3.373331333274469,
+                    "heading": 3.6836857657148254,
+                    "angularVelocity": -0.3928186710527244,
+                    "velocityX": -1.0229822125718777,
+                    "velocityY": -2.1516640140621313,
+                    "timestamp": 12.467482669966518
+                },
+                {
+                    "x": 7.6226172615317065,
+                    "y": 3.2301807206906474,
+                    "heading": 3.656166422928496,
+                    "angularVelocity": -0.45244101512146395,
+                    "velocityX": -1.195285207452349,
+                    "velocityY": -2.3535158152417135,
+                    "timestamp": 12.528306825749436
+                },
+                {
+                    "x": 7.537874056741358,
+                    "y": 3.0762935692392714,
+                    "heading": 3.624607309055113,
+                    "angularVelocity": -0.5188582310294256,
+                    "velocityX": -1.3932491737788937,
+                    "velocityY": -2.5300334952547887,
+                    "timestamp": 12.589130981532353
+                },
+                {
+                    "x": 7.439186116305785,
+                    "y": 2.9143192742653987,
+                    "heading": 3.5885289471098396,
+                    "angularVelocity": -0.593158449646844,
+                    "velocityX": -1.622512292448285,
+                    "velocityY": -2.662992899596701,
+                    "timestamp": 12.64995513731527
+                },
+                {
+                    "x": 7.324799462619061,
+                    "y": 2.7487257316338787,
+                    "heading": 3.5475979292802173,
+                    "angularVelocity": -0.6729401715940964,
+                    "velocityX": -1.880612270147605,
+                    "velocityY": -2.7224963585606825,
+                    "timestamp": 12.710779293098188
+                },
+                {
+                    "x": 7.194507340242676,
+                    "y": 2.585740156358662,
+                    "heading": 3.5020835972715822,
+                    "angularVelocity": -0.7482936906033946,
+                    "velocityX": -2.1421114802053443,
+                    "velocityY": -2.6796191936788247,
+                    "timestamp": 12.771603448881105
+                },
+                {
+                    "x": 7.0504536551705375,
+                    "y": 2.431188888490648,
+                    "heading": 3.452877836818068,
+                    "angularVelocity": -0.8089838620881198,
+                    "velocityX": -2.3683630823626802,
+                    "velocityY": -2.540952124672488,
+                    "timestamp": 12.832427604664023
+                },
+                {
+                    "x": 6.895679700680455,
+                    "y": 2.28873114154361,
+                    "heading": 3.4010206368377873,
+                    "angularVelocity": -0.8525757458165169,
+                    "velocityX": -2.5446132790148983,
+                    "velocityY": -2.3421245245963243,
+                    "timestamp": 12.89325176044694
+                },
+                {
+                    "x": 6.732796621571605,
+                    "y": 2.160266132765056,
+                    "heading": 3.3473624043780283,
+                    "angularVelocity": -0.8821862263286692,
+                    "velocityX": -2.6779340709665105,
+                    "velocityY": -2.1120722042908184,
+                    "timestamp": 12.954075916229858
+                },
+                {
+                    "x": 6.563749580215948,
+                    "y": 2.0467591756877423,
+                    "heading": 3.2925189413234834,
+                    "angularVelocity": -0.9016724087430362,
+                    "velocityX": -2.7792747664100683,
+                    "velocityY": -1.8661493220295844,
+                    "timestamp": 13.014900072012775
+                },
+                {
+                    "x": 6.3899587104320545,
+                    "y": 1.9487221444905019,
+                    "heading": 3.236931228275579,
+                    "angularVelocity": -0.9139085011931405,
+                    "velocityX": -2.8572672739455114,
+                    "velocityY": -1.6118108000896318,
+                    "timestamp": 13.075724227795693
+                },
+                {
+                    "x": 6.212478467014217,
+                    "y": 1.8664410195309742,
+                    "heading": 3.1809224189873455,
+                    "angularVelocity": -0.9208316756278593,
+                    "velocityX": -2.9179236626196454,
+                    "velocityY": -1.3527705218497519,
+                    "timestamp": 13.13654838357861
+                },
+                {
+                    "x": 6.032112039259563,
+                    "y": 1.8000829772107247,
+                    "heading": 3.124736406673497,
+                    "angularVelocity": -0.9237450415979039,
+                    "velocityX": -2.96537494738743,
+                    "velocityY": -1.090981723726388,
+                    "timestamp": 13.197372539361528
+                },
+                {
+                    "x": 5.849486965098296,
+                    "y": 1.749749174951984,
+                    "heading": 3.0685624701789247,
+                    "angularVelocity": -0.9235465050276829,
+                    "velocityX": -3.0025089836521532,
+                    "velocityY": -0.827529812964159,
+                    "timestamp": 13.258196695144445
                 },
                 {
                     "x": 5.665104866027832,
                     "y": 1.7155022621154783,
-                    "heading": 2.9738363314411114,
-                    "angularVelocity": -0.9655665298662963,
-                    "velocityX": -3.028692644542217,
-                    "velocityY": -0.5577798949918237,
-                    "timestamp": 13.320749979856513
-                },
-                {
-                    "x": 5.449668901780852,
-                    "y": 1.6978455407032218,
-                    "heading": 2.906132119432981,
-                    "angularVelocity": -0.959891751531484,
-                    "velocityX": -3.0543920227455827,
-                    "velocityY": -0.250332154234056,
-                    "timestamp": 13.391283153935893
-                },
-                {
-                    "x": 5.233414974096308,
-                    "y": 1.7019335435723504,
-                    "heading": 2.8391383653684743,
-                    "angularVelocity": -0.9498190736335087,
-                    "velocityX": -3.0659888840557348,
-                    "velocityY": 0.057958583637934886,
-                    "timestamp": 13.461816328015273
-                },
-                {
-                    "x": 5.01765545620336,
-                    "y": 1.727774331810827,
-                    "heading": 2.77326134838151,
-                    "angularVelocity": -0.9339862815875167,
-                    "velocityX": -3.0589792776109848,
-                    "velocityY": 0.36636360940449214,
-                    "timestamp": 13.532349502094652
-                },
-                {
-                    "x": 4.80417702272647,
-                    "y": 1.7752501139947119,
-                    "heading": 2.7090489373906985,
-                    "angularVelocity": -0.910385954253894,
-                    "velocityX": -3.0266386882949394,
-                    "velocityY": 0.6730986206640174,
-                    "timestamp": 13.602882676174032
-                },
-                {
-                    "x": 4.59548781041016,
-                    "y": 1.843939818969414,
-                    "heading": 2.6472607773678716,
-                    "angularVelocity": -0.8760155888247669,
-                    "velocityX": -2.958738424013771,
-                    "velocityY": 0.9738638005628106,
-                    "timestamp": 13.673415850253411
-                },
-                {
-                    "x": 4.395161877372632,
-                    "y": 1.9326893621825305,
-                    "heading": 2.58896223762384,
-                    "angularVelocity": -0.82654070945995,
-                    "velocityX": -2.8401661438357806,
-                    "velocityY": 1.2582666861587242,
-                    "timestamp": 13.74394902433279
-                },
-                {
-                    "x": 4.208052213977568,
-                    "y": 2.0386582351477758,
-                    "heading": 2.5355600028021983,
-                    "angularVelocity": -0.7571222409690838,
-                    "velocityX": -2.652789497102312,
-                    "velocityY": 1.502397621380076,
-                    "timestamp": 13.81448219841217
-                },
-                {
-                    "x": 4.039383008540803,
-                    "y": 2.156012297087957,
-                    "heading": 2.488408609997161,
-                    "angularVelocity": -0.6684995170070284,
-                    "velocityX": -2.3913457410401313,
-                    "velocityY": 1.6638137085410236,
-                    "timestamp": 13.88501537249155
-                },
-                {
-                    "x": 3.892137754898665,
-                    "y": 2.2765348326064325,
-                    "heading": 2.447990164035441,
-                    "angularVelocity": -0.5730416430179723,
-                    "velocityX": -2.087602827520932,
-                    "velocityY": 1.708735458053227,
-                    "timestamp": 13.95554854657093
-                },
-                {
-                    "x": 3.766164166080398,
-                    "y": 2.3929352805610016,
-                    "heading": 2.4139692777566655,
-                    "angularVelocity": -0.48233879621649,
-                    "velocityX": -1.786018996911929,
-                    "velocityY": 1.6502936309596794,
-                    "timestamp": 14.026081720650309
-                },
-                {
-                    "x": 3.6599405750653324,
-                    "y": 2.5003798939702526,
-                    "heading": 2.3856988855870287,
-                    "angularVelocity": -0.40080986767759647,
-                    "velocityX": -1.5060089440398745,
-                    "velocityY": 1.5233202647073794,
-                    "timestamp": 14.096614894729688
-                },
-                {
-                    "x": 3.571849727372911,
-                    "y": 2.5959017093772516,
-                    "heading": 2.3625508713896815,
-                    "angularVelocity": -0.328186197480587,
-                    "velocityX": -1.2489278816983742,
-                    "velocityY": 1.3542821041840187,
-                    "timestamp": 14.167148068809068
-                },
-                {
-                    "x": 3.5005309804136506,
-                    "y": 2.677634460422761,
-                    "heading": 2.3440149762008446,
-                    "angularVelocity": -0.26279683894525624,
-                    "velocityX": -1.0111376368657052,
-                    "velocityY": 1.1587845309999307,
-                    "timestamp": 14.237681242888447
-                },
-                {
-                    "x": 3.444898984368672,
-                    "y": 2.7443434037076186,
-                    "heading": 2.3296936875946765,
-                    "angularVelocity": -0.20304330257491268,
-                    "velocityX": -0.7887351841329246,
-                    "velocityY": 0.9457811045024435,
-                    "timestamp": 14.308214416967827
-                },
-                {
-                    "x": 3.404091793996619,
-                    "y": 2.7951695430879604,
-                    "heading": 2.319276755671779,
-                    "angularVelocity": -0.14768840419933443,
-                    "velocityX": -0.5785531546634841,
-                    "velocityY": 0.720599066237137,
-                    "timestamp": 14.378747591047206
-                },
-                {
-                    "x": 3.377417673658437,
-                    "y": 2.8294887518678977,
-                    "heading": 2.3125184133536703,
-                    "angularVelocity": -0.09581792406652051,
-                    "velocityX": -0.3781783633919927,
-                    "velocityY": 0.4865683308298885,
-                    "timestamp": 14.449280765126586
+                    "heading": 3.0125511385109696,
+                    "angularVelocity": -0.9208731456604314,
+                    "velocityX": -3.031395942896885,
+                    "velocityY": -0.5630478943059016,
+                    "timestamp": 13.319020850927362
+                },
+                {
+                    "x": 5.4364501501141,
+                    "y": 1.6977707730417206,
+                    "heading": 2.944139623228989,
+                    "angularVelocity": -0.9151171979283065,
+                    "velocityX": -3.058635115120499,
+                    "velocityY": -0.23718800160164863,
+                    "timestamp": 13.393777959018932
+                },
+                {
+                    "x": 5.206960377408042,
+                    "y": 1.7044694351689678,
+                    "heading": 2.876515284948492,
+                    "angularVelocity": -0.9045874032160918,
+                    "velocityX": -3.069805381248256,
+                    "velocityY": 0.08960568831851862,
+                    "timestamp": 13.468535067110501
+                },
+                {
+                    "x": 4.978251239441715,
+                    "y": 1.735598056307952,
+                    "heading": 2.8101543423117734,
+                    "angularVelocity": -0.88768739629994,
+                    "velocityX": -3.059363100110605,
+                    "velocityY": 0.41639680738927637,
+                    "timestamp": 13.54329217520207
+                },
+                {
+                    "x": 4.752574161124427,
+                    "y": 1.7909760209909795,
+                    "heading": 2.745713503987336,
+                    "angularVelocity": -0.8620028244739498,
+                    "velocityX": -3.0188042860199698,
+                    "velocityY": 0.7407718957666946,
+                    "timestamp": 13.61804928329364
+                },
+                {
+                    "x": 4.5331713643671705,
+                    "y": 1.86996361407104,
+                    "heading": 2.6841254526244476,
+                    "angularVelocity": -0.8238420791699165,
+                    "velocityX": -2.934875389889497,
+                    "velocityY": 1.0565897356985674,
+                    "timestamp": 13.69280639138521
+                },
+                {
+                    "x": 4.324741325186423,
+                    "y": 1.9707561474332134,
+                    "heading": 2.6267153184834644,
+                    "angularVelocity": -0.767955524318328,
+                    "velocityX": -2.7880966038098087,
+                    "velocityY": 1.3482668863904335,
+                    "timestamp": 13.767563499476779
+                },
+                {
+                    "x": 4.133456760500775,
+                    "y": 2.0888763146698124,
+                    "heading": 2.575139560935057,
+                    "angularVelocity": -0.6899110849129252,
+                    "velocityX": -2.558747516708982,
+                    "velocityY": 1.5800526565569466,
+                    "timestamp": 13.842320607568348
+                },
+                {
+                    "x": 3.9648313060513067,
+                    "y": 2.215896432204998,
+                    "heading": 2.5306079426062213,
+                    "angularVelocity": -0.5956840689221082,
+                    "velocityX": -2.2556444297299487,
+                    "velocityY": 1.6991042160111327,
+                    "timestamp": 13.917077715659918
+                },
+                {
+                    "x": 3.8205343209977376,
+                    "y": 2.3421025100473667,
+                    "heading": 2.493194959981666,
+                    "angularVelocity": -0.5004605392002106,
+                    "velocityX": -1.930210902176966,
+                    "velocityY": 1.6882150883602955,
+                    "timestamp": 13.991834823751487
+                },
+                {
+                    "x": 3.699264664656396,
+                    "y": 2.4603619153467347,
+                    "heading": 2.4622728561260585,
+                    "angularVelocity": -0.413634297058835,
+                    "velocityX": -1.6221822838946542,
+                    "velocityY": 1.5819151960040088,
+                    "timestamp": 14.066591931843057
+                },
+                {
+                    "x": 3.5990570492993528,
+                    "y": 2.5663446289225074,
+                    "heading": 2.437087858484135,
+                    "angularVelocity": -0.336891009896672,
+                    "velocityX": -1.3404426403747447,
+                    "velocityY": 1.417694133458925,
+                    "timestamp": 14.141349039934626
+                },
+                {
+                    "x": 3.5181735452870257,
+                    "y": 2.6574416406371975,
+                    "heading": 2.4170079069842205,
+                    "angularVelocity": -0.2686025718827755,
+                    "velocityX": -1.0819506810409738,
+                    "velocityY": 1.2185732439396435,
+                    "timestamp": 14.216106148026196
+                },
+                {
+                    "x": 3.4552317701509287,
+                    "y": 2.7319987511114388,
+                    "heading": 2.4015458699114443,
+                    "angularVelocity": -0.20683032647326308,
+                    "velocityX": -0.84195037425739,
+                    "velocityY": 0.9973247009891939,
+                    "timestamp": 14.290863256117765
+                },
+                {
+                    "x": 3.409149587958946,
+                    "y": 2.7889049301174764,
+                    "heading": 2.3903286620169495,
+                    "angularVelocity": -0.15004871350500593,
+                    "velocityX": -0.616425425867687,
+                    "velocityY": 0.7612142906375352,
+                    "timestamp": 14.365620364209335
+                },
+                {
+                    "x": 3.379072144956023,
+                    "y": 2.827375131876985,
+                    "heading": 2.383066118245118,
+                    "angularVelocity": -0.09714853820904662,
+                    "velocityX": -0.4023355607346594,
+                    "velocityY": 0.5146025942093229,
+                    "timestamp": 14.440377472300904
                 },
                 {
                     "x": 3.3643133640289307,
                     "y": 2.8468308448791504,
-                    "heading": 2.309220505183218,
-                    "angularVelocity": -0.046756837665363614,
-                    "velocityX": -0.18578930837223656,
-                    "velocityY": 0.24587143904421285,
-                    "timestamp": 14.519813939205966
+                    "heading": 2.3795279978377377,
+                    "angularVelocity": -0.0473282139679155,
+                    "velocityX": -0.19742311204728097,
+                    "velocityY": 0.26025234922589974,
+                    "timestamp": 14.515134580392473
                 },
                 {
                     "x": 3.3643133640289307,
                     "y": 2.8468308448791504,
-                    "heading": 2.309220505183218,
-                    "angularVelocity": 1.5317015602458727e-25,
-                    "velocityX": -2.505849102759169e-26,
-                    "velocityY": 2.1276220109101717e-26,
-                    "timestamp": 14.590347113285345
+                    "heading": 2.3795279978377377,
+                    "angularVelocity": 2.4866807892758145e-28,
+                    "velocityX": 1.5094963977000519e-27,
+                    "velocityY": 1.0159722407732268e-27,
+                    "timestamp": 14.589891688484043
                 }
             ],
             "trajectoryWaypoints": [
@@ -10792,18 +10783,18 @@
                     "controlIntervalCount": 25
                 },
                 {
-                    "timestamp": 4.749939366208028,
+                    "timestamp": 4.749751130001894,
                     "isStopPoint": true,
                     "x": 3.3396942615509033,
                     "y": 2.857861280441284,
-                    "heading": 2.256856869928089,
+                    "heading": 2.287543209286567,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,
                     "controlIntervalCount": 18
                 },
                 {
-                    "timestamp": 5.875074084368847,
+                    "timestamp": 5.874831299037097,
                     "isStopPoint": false,
                     "x": 5.632181167602539,
                     "y": 1.7524278163909912,
@@ -10814,7 +10805,7 @@
                     "controlIntervalCount": 19
                 },
                 {
-                    "timestamp": 7.021274007381847,
+                    "timestamp": 7.020976387985838,
                     "isStopPoint": true,
                     "x": 7.851492881774902,
                     "y": 2.6688690185546875,
@@ -10825,7 +10816,7 @@
                     "controlIntervalCount": 18
                 },
                 {
-                    "timestamp": 8.083880473664323,
+                    "timestamp": 8.083440503097608,
                     "isStopPoint": false,
                     "x": 5.677816390991211,
                     "y": 1.8171948194503784,
@@ -10836,18 +10827,18 @@
                     "controlIntervalCount": 18
                 },
                 {
-                    "timestamp": 9.268668164608396,
+                    "timestamp": 9.268081501000287,
                     "isStopPoint": true,
                     "x": 3.3396942615509033,
                     "y": 2.877351999282837,
-                    "heading": 2.2954707540735027,
+                    "heading": 2.3769046726239993,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,
                     "controlIntervalCount": 18
                 },
                 {
-                    "timestamp": 10.47597793774299,
+                    "timestamp": 10.475287849983589,
                     "isStopPoint": false,
                     "x": 5.677816390991211,
                     "y": 1.7663486003875732,
@@ -10858,7 +10849,7 @@
                     "controlIntervalCount": 23
                 },
                 {
-                    "timestamp": 11.92085426135505,
+                    "timestamp": 11.920065267920261,
                     "isStopPoint": true,
                     "x": 7.97860860824585,
                     "y": 4.041717052459717,
@@ -10869,7 +10860,7 @@
                     "controlIntervalCount": 23
                 },
                 {
-                    "timestamp": 13.320749979856513,
+                    "timestamp": 13.319020850927362,
                     "isStopPoint": false,
                     "x": 5.665104866027832,
                     "y": 1.7155022621154785,
@@ -10877,14 +10868,14 @@
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": false,
-                    "controlIntervalCount": 18
+                    "controlIntervalCount": 17
                 },
                 {
-                    "timestamp": 14.590347113285345,
+                    "timestamp": 14.589891688484043,
                     "isStopPoint": true,
                     "x": 3.3643133640289307,
                     "y": 2.8468308448791504,
-                    "heading": 2.3092205051832186,
+                    "heading": 2.3795279978377377,
                     "isInitialGuess": false,
                     "translationConstrained": true,
                     "headingConstrained": true,