diff --git a/modules/planning/common/planning_gflags.cc b/modules/planning/common/planning_gflags.cc
index 10ffcda263f1c8700f7909e62667b36ca7e99778..afd74d30d743c5381b0f4281ca8eff6e16e065f8 100644
--- a/modules/planning/common/planning_gflags.cc
+++ b/modules/planning/common/planning_gflags.cc
@@ -187,7 +187,7 @@ DEFINE_double(destination_check_distance, 5.0,
               " it is considered to reach destination");
 DEFINE_double(nudge_distance_obstacle, 0.3,
               "minimum distance to nudge a obstacle (meters)");
-DEFINE_double(follow_min_distance, 10,
+DEFINE_double(follow_min_distance, 5.0,
               "min follow distance for vehicles/bicycles/moving objects");
 DEFINE_double(
     follow_time_buffer, 2.0,
diff --git a/modules/planning/testdata/sunnyvale_loop_test/result_follow_03_0.pb.txt b/modules/planning/testdata/sunnyvale_loop_test/result_follow_03_0.pb.txt
index 35a1232caa86336aab72419086572827b4342433..e5659537e6e4efc35a84c5a2339a824419a5cf2f 100644
--- a/modules/planning/testdata/sunnyvale_loop_test/result_follow_03_0.pb.txt
+++ b/modules/planning/testdata/sunnyvale_loop_test/result_follow_03_0.pb.txt
@@ -1,7 +1,7 @@
 header {
   module_name: "planning"
 }
-total_path_length: 16.222394716530406
+total_path_length: 16.933040991001789
 total_path_time: 7.9999999999999885
 is_replan: true
 gear: GEAR_DRIVE
@@ -16,1687 +16,1687 @@ trajectory_point {
     ddkappa: 0
   }
   v: 4.5999999046325684
-  a: -1.3228767898402884
+  a: -1.2939013007199713
   relative_time: 0
 }
 trajectory_point {
   path_point {
-    x: 587260.57982531958
-    y: 4140955.1546906461
-    theta: -1.8273458280819155
-    kappa: 0.0014027650784570423
-    s: 0.091736235726282478
+    x: 587260.579823854
+    y: 4140955.1546850037
+    theta: -1.8273458090728043
+    kappa: 0.0014027747731399324
+    s: 0.09174206572194582
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.5736641823577253
-  a: -1.3107224548113654
+  v: 4.5742489142812968
+  a: -1.2812272559792004
   relative_time: 0.02
 }
 trajectory_point {
   path_point {
-    x: 587260.55689584964
-    y: 4140955.0664078183
-    theta: -1.8270484248738743
-    kappa: 0.0015544411513738064
-    s: 0.18294817709362218
+    x: 587260.55688995274
+    y: 4140955.0663851141
+    theta: -1.82704834838868
+    kappa: 0.0015544801589031552
+    s: 0.18297163466614128
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.5475699310364632
-  a: -1.2987294303300736
+  v: 4.5487496393216658
+  a: -1.2687294719986635
   relative_time: 0.04
 }
 trajectory_point {
   path_point {
-    x: 587260.53409697441
-    y: 4140954.9786278056
-    theta: -1.826752715056567
-    kappa: 0.0017052533540748917
-    s: 0.273640621364642
+    x: 587260.53408362961
+    y: 4140954.9785764255
+    theta: -1.8267525419698161
+    kappa: 0.0017053416283679609
+    s: 0.27369370600409004
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.5217139403069586
-  a: -1.2868961314833032
+  v: 4.5234985719119027
+  a: -1.2564062114351675
   relative_time: 0.06
 }
 trajectory_point {
   path_point {
-    x: 587260.51142750378
-    y: 4140954.8913460253
-    theta: -1.8264586832557139
-    kappa: 0.001855209557671491
-    s: 0.36381830191171111
+    x: 587260.51140364539
+    y: 4140954.8912541657
+    theta: -1.82645837380277
+    kappa: 0.0018553673785563589
+    s: 0.36391320909792896
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.4960930315056551
-  a: -1.2752209733579449
+  v: 4.4984922389571
+  a: -1.2442557369455192
   relative_time: 0.08
 }
 trajectory_point {
   path_point {
-    x: 587260.488886264
-    y: 4140954.8045579577
-    theta: -1.8261663143014117
-    kappa: 0.002004317528086099
-    s: 0.45348588885091018
+    x: 587260.48884877842
+    y: 4140954.8044136306
+    theta: -1.8261658280976136
+    kappa: 0.0020045654915601743
+    s: 0.45363500419536529
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.4707040576672528
-  a: -1.2637023710408892
+  v: 4.4737272021092114
+  a: -1.2322763111865258
   relative_time: 0.1
 }
 trajectory_point {
   path_point {
-    x: 587260.46647209674
-    y: 4140954.7182591432
-    theta: -1.8258755932261181
-    kappa: 0.0021525849271067281
-    s: 0.54264798967599626
+    x: 587260.466417824
+    y: 4140954.7180501833
+    theta: -1.8258748892857217
+    kappa: 0.0021529439356966556
+    s: 0.54286388312461409
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.445543903524718
-  a: -1.2523387396190262
+  v: 4.4492000577670554
+  a: -1.2204661968149941
   relative_time: 0.12000000000000001
 }
 trajectory_point {
   path_point {
-    x: 587260.44418385928
-    y: 4140954.6324451831
-    theta: -1.8255865052626374
-    kappa: 0.0023000193134411328
-    s: 0.63130914989236886
+    x: 587260.44410959468
+    y: 4140954.63215925
+    theta: -1.8255855420175571
+    kappa: 0.0023005105666640867
+    s: 0.63160456998933545
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.4206094855092779
-  a: -1.2411284941792466
+  v: 4.4249074370763157
+  a: -1.208823656487731
   relative_time: 0.14
 }
 trajectory_point {
   path_point {
-    x: 587260.42202042439
-    y: 4140954.5471117361
-    theta: -1.8252990358421037
-    kappa: 0.0024466281437710226
-    s: 0.71947385365103389
+    x: 587260.42192291946
+    y: 4140954.5467363233
+    theta: -1.8252977711604554
+    kappa: 0.0024472731286973937
+    s: 0.71986172186357167
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.3958977517504216
-  a: -1.2300700498084405
+  v: 4.4008460059295391
+  a: -1.1973469528615435
   relative_time: 0.16
 }
 trajectory_point {
   path_point {
-    x: 587260.39998068009
-    y: 4140954.4622545214
-    theta: -1.8250131705919619
-    kappa: 0.0025924187738062864
-    s: 0.80714652438257051
+    x: 587260.39985664457
+    y: 4140954.4617769616
+    theta: -1.8250115617964078
+    kappa: 0.0025932392557237549
+    s: 0.8076399294866845
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.3714056820759009
-  a: -1.2191618215934985
+  v: 4.3770124649661355
+  a: -1.1860343485932385
   relative_time: 0.18
 }
 trajectory_point {
   path_point {
-    x: 587260.37806352938
-    y: 4140954.3778693164
-    theta: -1.8247288953339487
-    kappa: 0.0027373984593392071
-    s: 0.89433152543109484
+    x: 587260.37790963228
+    y: 4140954.3772767829
+    theta: -1.8247268992198415
+    kappa: 0.0027384164725182104
+    s: 0.89494371795829308
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.34713028801173
-  a: -1.2084022246213111
+  v: 4.3534035495723789
+  a: -1.1748841063396227
   relative_time: 0.19999999999999998
 }
 trajectory_point {
   path_point {
-    x: 587260.35626789043
-    y: 4140954.2939519538
-    theta: -1.8244461960820704
-    kappa: 0.0028815743572986833
-    s: 0.98103316068822621
+    x: 587260.35608076141
+    y: 4140954.2932314714
+    theta: -1.8244437689354003
+    kappa: 0.00288281219585927
+    s: 0.98177754743321
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.3230686127821842
-  a: -1.1977896739787686
+  v: 4.3300160298814072
+  a: -1.1638944887575033
   relative_time: 0.21999999999999997
 }
 trajectory_point {
   path_point {
-    x: 587260.334592696
-    y: 4140954.2104983265
-    theta: -1.8241650590405811
-    kappa: 0.003024953526804449
-    s: 1.0672556752270523
+    x: 587260.33436892717
+    y: 4140954.209636773
+    theta: -1.8241621566557231
+    kappa: 0.0030264337356845235
+    s: 1.0681458138163795
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.2992177313098026
-  a: -1.1873225847527615
+  v: 4.3068467107732227
+  a: -1.1530637585036869
   relative_time: 0.23999999999999996
 }
 trajectory_point {
   path_point {
-    x: 587260.31303689373
-    y: 4140954.1275043809
-    theta: -1.8238854706019585
-    kappa: 0.0031675429302212882
-    s: 1.1530032559360939
+    x: 587260.31277303991
+    y: 4140954.1264884933
+    theta: -1.8238820482992204
+    kappa: 0.0031692882962462512
+    s: 1.1540528494578148
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.2755747502153838
-  a: -1.1769993720301801
+  v: 4.2838924318746923
+  a: -1.1423901782349808
   relative_time: 0.25999999999999995
 }
 trajectory_point {
   path_point {
-    x: 587260.29159944551
-    y: 4140954.0449661207
-    theta: -1.8236074173448782
-    kappa: 0.0033093494342132583
-    s: 1.2382800321532705
+    x: 587260.29129202676
+    y: 4140954.0437825
+    theta: -1.8236034299878496
+    kappa: 0.00331138297726703
+    s: 1.239502923847535
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.2521368078179931
-  a: -1.1668184508979147
+  v: 4.2611500675595444
+  a: -1.1318720106081916
   relative_time: 0.27999999999999997
 }
 trajectory_point {
   path_point {
-    x: 587260.27027932741
-    y: 4140953.9628796047
-    theta: -1.8233308860321882
-    kappa: 0.0034503798107979079
-    s: 1.3230900762998654
+    x: 587260.26992483
+    y: 4140953.9615147216
+    theta: -1.8233262880448908
+    kappa: 0.0034527247750953433
+    s: 1.3245002443105018
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.2289010741349529
-  a: -1.156778236442856
+  v: 4.2386165269483733
+  a: -1.1215075182801266
   relative_time: 0.3
 }
 trajectory_point {
   path_point {
-    x: 587260.24907553
-    y: 4140953.8812409448
-    theta: -1.8230558636088803
-    kappa: 0.0035906407384004944
-    s: 1.4074374045144911
+    x: 587260.24867040722
+    y: 4140953.8796811448
+    theta: -1.8230506089927181
+    kappa: 0.003593320583861193
+    s: 1.4090489567015581
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.205864750881851
-  a: -1.1468771437518945
+  v: 4.2162887539086356
+  a: -1.1112949639075922
   relative_time: 0.32
 }
 trajectory_point {
   path_point {
-    x: 587260.22798705753
-    y: 4140953.8000463084
-    theta: -1.8227823372000616
-    kappa: 0.0037301388029082039
-    s: 1.4913259772870544
+    x: 587260.22752773168
+    y: 4140953.7982778158
+    theta: -1.8227763795505731
+    kappa: 0.0037331771966317047
+    s: 1.4931531461003644
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.183025071472537
-  a: -1.13711358791192
+  v: 4.1941637270546535
+  a: -1.1012326101473957
   relative_time: 0.34
 }
 trajectory_point {
   path_point {
-    x: 587260.20701292844
-    y: 4140953.7192919152
-    theta: -1.8225102941089246
-    kappa: 0.00386888049872437
-    s: 1.5747597000927214
+    x: 587260.20649579144
+    y: 4140953.7173008393
+    theta: -1.8225035866323347
+    kappa: 0.0038723013065667397
+    s: 1.5768168375063358
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.1603793010191223
-  a: -1.1274859840098237
+  v: 4.1722384597476125
+  a: -1.0913187196563441
   relative_time: 0.36000000000000004
 }
 trajectory_point {
   path_point {
-    x: 587260.18615217437
-    y: 4140953.638974038
-    theta: -1.8222397218147155
-    kappa: 0.0040068722298226937
-    s: 1.6577424240258838
+    x: 587260.18557358964
+    y: 4140953.6367463763
+    theta: -1.8222322173442886
+    kappa: 0.0040106995080745047
+    s: 1.6600439965335807
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.1379247363319793
-  a: -1.1179927471324955
+  v: 4.1505100000955606
+  a: -1.0815515550912438
   relative_time: 0.38000000000000006
 }
 trajectory_point {
   path_point {
-    x: 587260.16540384083
-    y: 4140953.5590890013
-    theta: -1.821970607970703
-    kappa: 0.0041441203108014612
-    s: 1.7402779464341225
+    x: 587260.16476014419
+    y: 4140953.5566106462
+    theta: -1.8219622589828968
+    kappa: 0.0041483782979671565
+    s: 1.7428385301058362
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.1156587059197447
-  a: -1.1086322923668259
+  v: 4.12897543095341
+  a: -1.0719293791089022
   relative_time: 0.40000000000000008
 }
 trajectory_point {
   path_point {
-    x: 587260.1447669866
-    y: 4140953.4796331809
-    theta: -1.8217029404021439
-    kappa: 0.0042806309679377635
-    s: 1.8223700115521748
+    x: 587260.14405448735
+    y: 4140953.4768899232
+    theta: -1.8216936990325641
+    kappa: 0.004285344076616418
+    s: 1.8252042871514069
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.0935785699893152
-  a: -1.0994030347997055
+  v: 4.10763186992294
+  a: -1.062450454366126
   relative_time: 0.4200000000000001
 }
 trajectory_point {
   path_point {
-    x: 587260.12424068351
-    y: 4140953.4006030033
-    theta: -1.8214367071042494
-    kappa: 0.0044164103402417158
-    s: 1.9040223111358978
+    x: 587260.12345566624
+    y: 4140953.397580537
+    theta: -1.8214265251634045
+    kappa: 0.00442160314910918
+    s: 1.9071450592981012
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.0716817204458531
-  a: -1.0903033895180245
+  v: 4.08647646935279
+  a: -1.0531130435197222
   relative_time: 0.44000000000000011
 }
 trajectory_point {
   path_point {
-    x: 587260.10382401675
-    y: 4140953.3219949463
-    theta: -1.8211718962401504
-    kappa: 0.0045514644805106719
-    s: 1.9852384850962341
+    x: 587260.10296274151
+    y: 4140953.3186788731
+    theta: -1.8211607252290072
+    kappa: 0.0045571617264031179
+    s: 1.9886645815681692
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.0499655808927795
-  a: -1.0813317716086734
+  v: 4.0655064163384633
+  a: -1.0439154092264977
   relative_time: 0.46000000000000013
 }
 trajectory_point {
   path_point {
-    x: 587260.08406389679
-    y: 4140953.2436657832
-    theta: -1.8207846354262838
-    kappa: 0.004587439356800037
-    s: 2.0660221221331789
+    x: 587260.083154014
+    y: 4140953.2400336033
+    theta: -1.8207653241246742
+    kappa: 0.0045880257974020419
+    s: 2.0697665330732398
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.0284276066317783
-  a: -1.0724865961585426
+  v: 4.04471893272233
+  a: -1.0348558141432596
   relative_time: 0.48000000000000015
 }
 trajectory_point {
   path_point {
-    x: 587260.06453791761
-    y: 4140953.1657196218
-    theta: -1.8203702162969559
-    kappa: 0.0046000243062555637
-    s: 2.1463767603697415
+    x: 587260.06354702776
+    y: 4140953.1617640681
+    theta: -1.8203491856220555
+    kappa: 0.0046006629578982687
+    s: 2.150454537709257
     dkappa: 0
     ddkappa: 0
   }
-  v: 4.0070652846627963
-  a: -1.0637662782545227
+  v: 4.0241112750936212
+  a: -1.0259325209268144
   relative_time: 0.50000000000000011
 }
 trajectory_point {
   path_point {
-    x: 587260.04511533654
-    y: 4140953.0881862175
-    theta: -1.8199579901844281
-    kappa: 0.004612542613264956
-    s: 2.226305887985915
+    x: 587260.04403976211
+    y: 4140953.0838926095
+    theta: -1.8199351620836703
+    kappa: 0.0046132358460621034
+    s: 2.23073216485142
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.9858761336840436
-  a: -1.0551692329835038
+  v: 4.0036807347884329
+  a: -1.0171437922339694
   relative_time: 0.52000000000000013
 }
 trajectory_point {
   path_point {
-    x: 587260.02579531784
-    y: 4140953.0110622337
-    theta: -1.8195479395158933
-    kappa: 0.0046249948164158771
-    s: 2.3058129438526374
+    x: 587260.024631363
+    y: 4140953.0064158184
+    theta: -1.8195232355422555
+    kappa: 0.0046257450124904068
+    s: 2.3106029300491167
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.9648577040919903
-  a: -1.0466938754323765
+  v: 3.9834246378897262
+  a: -1.0084878907215313
   relative_time: 0.54000000000000015
 }
 trajectory_point {
   path_point {
-    x: 587260.00657703774
-    y: 4140952.934344383
-    theta: -1.8191400469648233
-    kappa: 0.0046373814466726185
-    s: 2.38490131816576
+    x: 587260.005320989
+    y: 4140952.9293303359
+    theta: -1.8191133882999317
+    kappa: 0.0046381909994588078
+    s: 2.3900702957208626
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.9440075779813704
-  a: -1.0383386206880312
+  v: 3.9633403452273237
+  a: -0.9999630790463071
   relative_time: 0.56000000000000016
 }
 trajectory_point {
   path_point {
-    x: 587259.98745968414
-    y: 4140952.8580294224
-    theta: -1.8187342954478229
-    kappa: 0.004649703027475382
-    s: 2.4635743530800109
+    x: 587259.98610781145
+    y: 4140952.8526328532
+    theta: -1.8187056029247419
+    kappa: 0.0046505743410305452
+    s: 2.469137671849241
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.9233233691451783
-  a: -1.0301018838373581
+  v: 3.9434252523779136
+  a: -0.99156761986510378
   relative_time: 0.58000000000000018
 }
 trajectory_point {
   path_point {
-    x: 587259.96844245633
-    y: 4140952.7821141565
-    theta: -1.8183306681214788
-    kappa: 0.004661960074839583
-    s: 2.541835343342961
+    x: 587259.96699101431
+    y: 4140952.7763201147
+    theta: -1.8182998622471835
+    kappa: 0.0046628955631653106
+    s: 2.547808416675835
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.902802723074672
-  a: -1.0219820799672479
+  v: 3.9236767896650475
+  a: -0.98329977583472816
   relative_time: 0.6000000000000002
 }
 trajectory_point {
   path_point {
-    x: 587259.94952456513
-    y: 4140952.7065954339
-    theta: -1.8179291483792073
-    kappa: 0.0046741530974551242
-    s: 2.6196875369289887
+    x: 587259.94796979392
+    y: 4140952.7003889102
+    theta: -1.8178961493567398
+    kappa: 0.0046751551838280806
+    s: 2.6260858373961682
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.8824433169593719
-  a: -1.013977624164591
+  v: 3.9040924221591404
+  a: -0.97515780961198706
   relative_time: 0.62000000000000022
 }
 trajectory_point {
   path_point {
-    x: 587259.93070523243
-    y: 4140952.6314701494
-    theta: -1.817529719848096
-    kappa: 0.0046862825967856981
-    s: 2.6971341356732452
+    x: 587259.92904335889
+    y: 4140952.6248360816
+    theta: -1.8174944475984056
+    kappa: 0.0046873537130979644
+    s: 2.7039731908546409
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.8622428596870595
-  a: -1.0060869315162777
+  v: 3.8846696496774715
+  a: -0.9671399838536876
   relative_time: 0.64000000000000024
 }
 trajectory_point {
   path_point {
-    x: 587259.91198369139
-    y: 4140952.5567352409
-    theta: -1.817132366385745
-    kappa: 0.0046983490671680742
-    s: 2.7741782959056205
+    x: 587259.91021093
+    y: 4140952.5496585183
+    theta: -1.8170947405692104
+    kappa: 0.0046994916532770385
+    s: 2.7814736842394678
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.8421990918437792
-  a: -0.99830841710919849
+  v: 3.8654060067841849
+  a: -0.9592445612166367
   relative_time: 0.66000000000000025
 }
 trajectory_point {
   path_point {
-    x: 587259.89335918578
-    y: 4140952.4823876908
-    theta: -1.8167370720771034
-    kappa: 0.0047103529959113839
-    s: 2.8508231290847079
+    x: 587259.89147173963
+    y: 4140952.4748531552
+    theta: -1.8166970121147403
+    kappa: 0.0047115694989991828
+    s: 2.8585904757776159
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.8223097857138373
-  a: -0.99064049603024373
+  v: 3.846299062790286
+  a: -0.95146980435764106
   relative_time: 0.68000000000000027
 }
 trajectory_point {
   path_point {
-    x: 587259.87483097031
-    y: 4140952.4084245227
-    theta: -1.8163438212313026
-    kappa: 0.004722294863396417
-    s: 2.92707170243177
+    x: 587259.87282503233
+    y: 4140952.4004169772
+    theta: -1.8163012463256532
+    kappa: 0.0047235877373389308
+    s: 2.9353266754297396
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.8025727452798024
-  a: -0.98308158336630391
+  v: 3.8273464217536466
+  a: -0.94381397593350791
   relative_time: 0.70000000000000029
 }
 trajectory_point {
   path_point {
-    x: 587259.85639831028
-    y: 4140952.3348428048
-    theta: -1.8159525983784877
-    kappa: 0.0047341751431749087
-    s: 3.0029270395647014
+    x: 587259.85427006357
+    y: 4140952.3263470121
+    theta: -1.8159074275341947
+    kappa: 0.0047355468479202967
+    s: 3.01168534558512
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.7829858062225057
-  a: -0.97563009420426927
+  v: 3.8085457224790011
+  a: -0.93627533860104384
   relative_time: 0.72000000000000031
 }
 trajectory_point {
   path_point {
-    x: 587259.83806048147
-    y: 4140952.2616396453
-    theta: -1.8155633882666462
-    kappa: 0.0047459943020688317
-    s: 3.0783921211319982
+    x: 587259.83580610086
+    y: 4140952.2526403368
+    theta: -1.8155155403107082
+    kappa: 0.0047474473030256238
+    s: 3.0876695017566025
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.76354683592104
-  a: -0.96828444363103039
+  v: 3.7898946385179482
+  a: -0.92885215501705609
   relative_time: 0.74000000000000032
 }
 trajectory_point {
   path_point {
-    x: 587259.8198167698
-    y: 4140952.1888121939
-    theta: -1.8151761758584324
-    kappa: 0.0047577528002696844
-    s: 3.15346988544672
+    x: 587259.81743242254
+    y: 4140952.1792940693
+    theta: -1.815125569460144
+    kappa: 0.0047592895677044172
+    s: 3.1632821132755309
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.74425373345276
-  a: -0.96104304673347773
+  v: 3.7713908781689502
+  a: -0.92154268783835125
   relative_time: 0.76000000000000034
 }
 trajectory_point {
   path_point {
-    x: 587259.80166647129
-    y: 4140952.1163576413
-    theta: -1.8147909463279903
-    kappa: 0.00476945109143778
-    s: 3.2281632291204567
+    x: 587259.79914831824
+    y: 4140952.1063053738
+    theta: -1.8147375000185653
+    kappa: 0.0047710740998821895
+    s: 3.2385261039866879
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.7251044295932836
-  a: -0.95390431859850144
+  v: 3.7530321844773336
+  a: -0.91434519972173645
   relative_time: 0.78000000000000036
 }
 trajectory_point {
   path_point {
-    x: 587259.78360889223
-    y: 4140952.0442732163
-    theta: -1.8144076850577739
-    kappa: 0.0047810896228015392
-    s: 3.3024750076972924
+    x: 587259.78095308819
+    y: 4140952.0336714573
+    theta: -1.8143513172496508
+    kappa: 0.0047828013504692974
+    s: 3.3134043529432335
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.70609688681649
-  a: -0.94686667431299232
+  v: 3.7348163352352883
+  a: -0.9072579533240186
   relative_time: 0.80000000000000038
 }
 trajectory_point {
   path_point {
-    x: 587259.76564334845
-    y: 4140951.9725561896
-    theta: -1.8140263776353651
-    kappa: 0.00479266883525678
-    s: 3.3764080362877711
+    x: 587259.76284604368
+    y: 4140951.961389571
+    theta: -1.8139670066411964
+    kappa: 0.0047944717634697759
+    s: 3.3879196951016359
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.6872290992945214
-  a: -0.93992852896384038
+  v: 3.716741142981868
+  a: -0.90027921130200461
   relative_time: 0.8200000000000004
 }
 trajectory_point {
   path_point {
-    x: 587259.74776916555
-    y: 4140951.901203868
-    theta: -1.8136470098502884
-    kappa: 0.0048041891634660076
-    s: 3.449965090202864
+    x: 587259.74482650636
+    y: 4140951.8894570051
+    theta: -1.8135845539016122
+    kappa: 0.0048060857760901894
+    s: 3.4620749220166172
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.6684990928977812
-  a: -0.93308829763793633
+  v: 3.6988044550029913
+  a: -0.89340723631250119
   relative_time: 0.84000000000000041
 }
 trajectory_point {
   path_point {
-    x: 587259.7299856788
-    y: 4140951.830213598
-    theta: -1.8132695676908237
-    kappa: 0.0048156510359577019
-    s: 3.5231489055879313
+    x: 587259.726893808
+    y: 4140951.8178710947
+    theta: -1.813203944956419
+    kappa: 0.0048176438188484594
+    s: 3.5358727825360829
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.649904925194936
-  a: -0.9263443954221704
+  v: 3.6810041533314393
+  a: -0.88664029101231567
   relative_time: 0.86000000000000043
 }
 trajectory_point {
   path_point {
-    x: 587259.71229223255
-    y: 4140951.7595827626
-    theta: -1.8128940373408173
-    kappa: 0.0048270548752256115
-    s: 3.59596218005669
+    x: 587259.7090472912
+    y: 4140951.7466292139
+    theta: -1.8128251659447423
+    kappa: 0.0048291463156827112
+    s: 3.609315983496066
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.6314446854529145
-  a: -0.91969523740343317
+  v: 3.6633381547468575
+  a: -0.87997663805825455
   relative_time: 0.88000000000000045
 }
 trajectory_point {
   path_point {
-    x: 587259.69468818046
-    y: 4140951.6893087821
-    theta: -1.81252040517649
-    kappa: 0.00483840109782804
-    s: 3.6684075733251773
+    x: 587259.691286308
+    y: 4140951.6757287765
+    theta: -1.8124482032158022
+    kappa: 0.00484059368406011
+    s: 3.6824071904156592
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.6131164946369063
-  a: -0.913139238668615
+  v: 3.6458044107757561
+  a: -0.87341454010712494
   relative_time: 0.90000000000000047
 }
 trajectory_point {
   path_point {
-    x: 587259.67717288528
-    y: 4140951.6193891121
-    theta: -1.8121486577632431
-    kappa: 0.0048496901144871405
-    s: 3.7404877078457179
+    x: 587259.67361022066
+    y: 4140951.6051672371
+    theta: -1.812073043325404
+    kappa: 0.0048519863350857013
+    s: 3.7551490281919535
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.5949185054103641
-  a: -0.90667481430460617
+  v: 3.6284009076915078
+  a: -0.866952259815734
   relative_time: 0.92000000000000048
 }
 trajectory_point {
   path_point {
-    x: 587259.65974571893
-    y: 4140951.549821245
-    theta: -1.8117787818524627
-    kappa: 0.0048609223301882033
-    s: 3.8122051694408889
+    x: 587259.656018401
+    y: 4140951.5349420873
+    theta: -1.8116996730324246
+    kappa: 0.0048633246736112506
+    s: 3.827544081794978
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.5768489021350041
-  a: -0.90030037939829732
+  v: 3.61112566651435
+  a: -0.86058805984088815
   relative_time: 0.9400000000000005
 }
 trajectory_point {
   path_point {
-    x: 587259.64240606152
-    y: 4140951.4806027068
-    theta: -1.8114107643783217
-    kappa: 0.0048720981442789439
-    s: 3.8835625079374827
+    x: 587259.63851023046
+    y: 4140951.465050858
+    theta: -1.8113280792952975
+    kappa: 0.004874609098344084
+    s: 3.8995948969626344
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.5589059008708022
-  a: -0.89401434903657861
+  v: 3.5939767430113836
+  a: -0.85432020283939458
   relative_time: 0.96000000000000052
 }
 trajectory_point {
   path_point {
-    x: 587259.6251533021
-    y: 4140951.4117310583
-    theta: -1.8110445924545804
-    kappa: 0.0048832179505687969
-    s: 3.9545622378004732
+    x: 587259.62108509964
+    y: 4140951.3954911171
+    theta: -1.8109582492684955
+    kappa: 0.0048858400019559213
+    s: 3.9713039808956339
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.5410877493759974
-  a: -0.88781513830634073
+  v: 3.5769522276965731
+  a: -0.84814695146806018
   relative_time: 0.98000000000000054
 }
 trajectory_point {
   path_point {
-    x: 587259.60821006529
-    y: 4140951.3431490851
-    theta: -1.8107072288527211
-    kappa: 0.0048651463464462769
-    s: 4.0252068387669837
+    x: 587259.60412457492
+    y: 4140951.3261666349
+    theta: -1.8106363522983135
+    kappa: 0.0048471371609220843
+    s: 4.0426738029524358
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.5233927271070922
-  a: -0.88170116229447393
+  v: 3.5600502458307477
+  a: -0.842066568383692
   relative_time: 1.0000000000000004
 }
 trajectory_point {
   path_point {
-    x: 587259.52681807079
-    y: 4140951.0048211687
-    theta: -1.8092952047667905
-    kappa: 0.0045063635884965416
-    s: 4.37318734988157
+    x: 587259.52182890614
+    y: 4140950.984082351
+    theta: -1.809208650159565
+    kappa: 0.0044843709312561474
+    s: 4.3945178512440464
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.4367065540069603
-  a: -0.85235433105187086
+  v: 3.4773151546458738
+  a: -0.81299687025458423
   relative_time: 1.1000000000000005
 }
 trajectory_point {
   path_point {
-    x: 587259.44742008613
-    y: 4140950.6747818952
-    theta: -1.8079177638218538
-    kappa: 0.0041563705940471261
-    s: 4.7126427400764763
+    x: 587259.44143522379
+    y: 4140950.64990419
+    theta: -1.8078139348142426
+    kappa: 0.0041299888171971106
+    s: 4.7382302132450329
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.3528587565302903
-  a: -0.824900630802108
+  v: 3.3973821682566578
+  a: -0.78598827782066649
   relative_time: 1.2000000000000006
 }
 trajectory_point {
   path_point {
-    x: 587259.36995185912
-    y: 4140950.3527641827
-    theta: -1.8065737970909646
-    kappa: 0.0038148841335117513
-    s: 5.0438477114493168
+    x: 587259.3628803126
+    y: 4140950.323369381
+    theta: -1.8064511154869909
+    kappa: 0.0037837121620392013
+    s: 5.0740811558529826
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.2716699272847336
-  a: -0.79914194740648681
+  v: 3.3200560344885384
+  a: -0.76082362318280361
   relative_time: 1.3000000000000007
 }
 trajectory_point {
   path_point {
-    x: 587259.2943531021
-    y: 4140950.0385174304
-    theta: -1.8052622636608762
-    kappa: 0.0034816384536512975
-    s: 5.3670600159291624
+    x: 587259.28610527108
+    y: 4140950.0042330818
+    theta: -1.8051191754778848
+    kappa: 0.0034452813208622796
+    s: 5.4023225065875229
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.1929804702918112
-  a: -0.77488016672630944
+  v: 3.2451632179568661
+  a: -0.73728573844186029
   relative_time: 1.4000000000000008
 }
 trajectory_point {
   path_point {
-    x: 587259.22056702839
-    y: 4140949.7318055881
-    theta: -1.8039821826754376
-    kappa: 0.0031563832349324828
-    s: 5.6825224364179316
+    x: 587259.21105500183
+    y: 4140949.6922662677
+    theta: -1.8038171634291686
+    kappa: 0.0031144534214381046
+    s: 5.723189825269313
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.1166506009869135
-  a: -0.75191717462287755
+  v: 3.1725519000669067
+  a: -0.71515745569870126
   relative_time: 1.5000000000000009
 }
 trajectory_point {
   path_point {
-    x: 587259.1485398896
-    y: 4140949.4324052357
-    theta: -1.8027326253695395
-    kappa: 0.0028388815488865466
-    s: 5.9904647679317735
+    x: 587259.13787313015
+    y: 4140949.38720716
+    theta: -1.8026619174225356
+    kappa: 0.0027583822855485889
+    s: 6.036904575699034
     dkappa: 0
     ddkappa: 0
   }
-  v: 3.0425603462193003
-  a: -0.73005485695749328
+  v: 3.1020919790138377
+  a: -0.69422160705419156
   relative_time: 1.600000000000001
 }
 trajectory_point {
   path_point {
-    x: 587259.079748491
-    y: 4140949.1397404186
-    theta: -1.8024332244310042
-    kappa: 0.0022738772948507307
-    s: 6.291105798742457
+    x: 587259.06772793015
+    y: 4140949.0885626553
+    theta: -1.8023859291947391
+    kappa: 0.0021736784499070154
+    s: 6.3436762973363807
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.970609544252103
-  a: -0.70909509959145844
+  v: 3.0336750697827508
+  a: -0.67426102460919579
   relative_time: 1.7000000000000011
 }
 trajectory_point {
   path_point {
-    x: 587259.01262663328
-    y: 4140948.8539678496
-    theta: -1.8021691315539825
-    kappa: 0.0017143748952786865
-    s: 6.58465529151876
+    x: 587258.99912461312
+    y: 4140948.7964827456
+    theta: -1.8021160074605116
+    kappa: 0.0016018271661170347
+    s: 6.6437047769790514
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.9007178447623208
-  a: -0.68883978838607485
+  v: 2.967214504148652
+  a: -0.65505854046457879
   relative_time: 1.8000000000000012
 }
 trajectory_point {
   path_point {
-    x: 587258.94707994559
-    y: 4140948.5749015976
-    theta: -1.8019112361785383
-    kappa: 0.0011680025174521831
-    s: 6.87131596446785
+    x: 587258.93201922986
+    y: 4140948.5107803177
+    theta: -1.801851979344969
+    kappa: 0.0010424620918166928
+    s: 6.9371822204417422
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.8328247088408229
-  a: -0.66909080920264441
+  v: 2.90264533067646
+  a: -0.63639698672120515
   relative_time: 1.9000000000000012
 }
 trajectory_point {
   path_point {
-    x: 587258.883063233
-    y: 4140948.3023492433
-    theta: -1.8016593605203559
-    kappa: 0.000634383433132005
-    s: 7.151285472476677
+    x: 587258.86636906827
+    y: 4140948.2312735235
+    theta: -1.8015936768344973
+    kappa: 0.00049522719472342737
+    s: 7.2242954242351347
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.766889408992351
-  a: -0.64965004790246927
+  v: 2.8399243147210078
+  a: -0.61805919547993993
   relative_time: 2.0000000000000013
 }
 trajectory_point {
   path_point {
-    x: 587258.82053203846
-    y: 4140948.036121509
-    theta: -1.8014133296935237
-    kappa: 0.00011314706467927297
-    s: 7.4247582434476254
+    x: 587258.80213218508
+    y: 4140947.9577837884
+    theta: -1.8013409349357108
+    kappa: -4.0227148841633889e-05
+    s: 7.5052278225208591
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.7028850676583689
-  a: -0.6305066970493326
+  v: 2.7790247580575267
+  a: -0.59999298033533133
   relative_time: 2.1000000000000014
 }
 trajectory_point {
   path_point {
-    x: 587258.7594426159
-    y: 4140947.7760321465
-    theta: -1.8011729716053291
-    kappa: -0.00039607123886385264
-    s: 7.6919255957803943
+    x: 587258.7392672929
+    y: 4140947.6901353304
+    theta: -1.8010935912319728
+    kappa: -0.00056424509448645761
+    s: 7.7801599805730444
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.6407740028750828
-  a: -0.61178534741824164
+  v: 2.719913301446482
+  a: -0.58229928141451093
   relative_time: 2.2000000000000015
 }
 trajectory_point {
   path_point {
-    x: 587258.69975215872
-    y: 4140947.5218989053
-    theta: -1.8009381178559567
-    kappa: -0.00089362829663547339
-    s: 7.9529747388186482
+    x: 587258.67762547359
+    y: 4140947.4281815113
+    theta: -1.8010288396270027
+    kappa: -0.0011063573286637053
+    s: 8.0492688249459814
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.5805137653613812
-  a: -0.59349098218733254
+  v: 2.6625520671705072
+  a: -0.56499062061721739
   relative_time: 2.3000000000000016
 }
 trajectory_point {
   path_point {
-    x: 587258.640975373
-    y: 4140947.27364836
-    theta: -1.8014337341032562
-    kappa: -0.0014992338635611687
-    s: 8.2080886120620455
+    x: 587258.61682836118
+    y: 4140947.1718338
+    theta: -1.8017005002249589
+    kappa: -0.0017580815655125941
+    s: 8.3127274318127267
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.522061407518339
-  a: -0.57562858453474153
+  v: 2.6069019253222629
+  a: -0.54807951984318981
   relative_time: 2.4000000000000017
 }
 trajectory_point {
   path_point {
-    x: 587258.583432371
-    y: 4140947.0310214283
-    theta: -1.8020694456059627
-    kappa: -0.0021160751502160148
-    s: 8.4574458353344664
+    x: 587258.55729610508
+    y: 4140946.9208192881
+    theta: -1.8023581887576732
+    kappa: -0.0023962469749333436
+    s: 8.5707049017461028
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.4653734834292176
-  a: -0.55820313763860463
+  v: 2.5529224938044357
+  a: -0.531578500992167
   relative_time: 2.5000000000000018
 }
 trajectory_point {
   path_point {
-    x: 587258.52717759332
-    y: 4140946.7938262243
-    theta: -1.8026909264128952
-    kappa: -0.0027191071132811311
-    s: 8.7012206589522219
+    x: 587258.49899062922
+    y: 4140946.6749774264
+    theta: -1.8030023252293796
+    kappa: -0.0030212617210006528
+    s: 8.8233662344997068
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.410406048859465
-  a: -0.54121962467705809
+  v: 2.5005721383297379
+  a: -0.51550008596388786
   relative_time: 2.6000000000000019
 }
 trajectory_point {
   path_point {
-    x: 587258.47217184876
-    y: 4140946.5618975013
-    theta: -1.8032986089555725
-    kappa: -0.0033087498679509868
-    s: 8.93958291389228
+    x: 587258.4418748325
+    y: 4140946.4341517836
+    theta: -1.8036333189429683
+    kappa: -0.0036335235137312728
+    s: 9.0708722037889018
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.3571146612567149
-  a: -0.52468302882823825
+  v: 2.4498079724209085
+  a: -0.49985679665809146
   relative_time: 2.700000000000002
 }
 trajectory_point {
   path_point {
-    x: 587258.41837697779
-    y: 4140946.3350743605
-    theta: -1.8038929143368541
-    kappa: -0.0038854124739180892
-    s: 9.17269796196048
+    x: 587258.3859126179
+    y: 4140946.1981901564
+    theta: -1.8042515681737639
+    kappa: -0.004233419299326629
+    s: 9.3133792320718314
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.3054543797507883
-  a: -0.508598333270281
+  v: 2.4005858574107122
+  a: -0.48466115497451656
   relative_time: 2.800000000000002
 }
 trajectory_point {
   path_point {
-    x: 587258.36575586314
-    y: 4140946.1132002985
-    theta: -1.8044742521973278
-    kappa: -0.0044494928121028574
-    s: 9.400726645959752
+    x: 587258.33106892183
+    y: 4140945.966944702
+    theta: -1.804857459843918
+    kappa: -0.0048213249504153906
+    s: 9.5510392653304148
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.255379765153692
-  a: -0.49297052118132278
+  v: 2.3528604024419395
+  a: -0.4699256828129022
   relative_time: 2.9000000000000021
 }
 trajectory_point {
   path_point {
-    x: 587258.31427244248
-    y: 4140945.8961232617
-    theta: -1.8050430205823014
-    kappa: -0.0050013774613834831
-    s: 9.6238252398583377
+    x: 587258.27730974229
+    y: 4140945.7402720517
+    theta: -1.805451369197371
+    kappa: -0.0053976049562960643
+    s: 9.7839996478513509
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.2068448799596192
-  a: -0.47780457573949975
+  v: 2.3065849644674081
+  a: -0.45566290207298721
   relative_time: 3.0000000000000022
 }
 trajectory_point {
   path_point {
-    x: 587258.26389171882
-    y: 4140945.6836956874
-    theta: -1.8055996058093418
-    kappa: -0.0055414415753257847
-    s: 9.84214539895801
+    x: 587258.22441242414
+    y: 4140945.5180796362
+    theta: -1.8061340011609281
+    kappa: -0.0059669484264166153
+    s: 10.012402997007122
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.15980328834495
-  a: -0.463105480122948
+  v: 2.2617116482499608
+  a: -0.44188533465451052
   relative_time: 3.1000000000000023
 }
 trajectory_point {
   path_point {
-    x: 587258.21388651058
-    y: 4140945.4759433488
-    theta: -1.8065109999741134
-    kappa: -0.0060858922395583019
-    s: 10.055834110062282
+    x: 587258.17012790521
+    y: 4140945.3007732634
+    theta: -1.8080782930098871
+    kappa: -0.006580368594739117
+    s: 10.236387078036998
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.1142080561682493
-  a: -0.44887821750980372
+  v: 2.218191306362467
+  a: -0.42860550245721107
   relative_time: 3.2000000000000024
 }
 trajectory_point {
   path_point {
-    x: 587258.1631851577
-    y: 4140945.2729807487
-    theta: -1.8083269631528267
-    kappa: -0.0066588222946148464
-    s: 10.265033641644637
+    x: 587258.11688225262
+    y: 4140945.0876255771
+    theta: -1.8099854245613365
+    kappa: -0.0071820494759768788
+    s: 10.456084678828033
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.0700117509702709
-  a: -0.43512777107820311
+  v: 2.1759735391878214
+  a: -0.41583592738082775
   relative_time: 3.3000000000000025
 }
 trajectory_point {
   path_point {
-    x: 587258.11353847268
-    y: 4140945.0742400908
-    theta: -1.8101051920176248
-    kappa: -0.0072198345036291146
-    s: 10.469881494016745
+    x: 587258.06464452064
+    y: 4140944.8785126978
+    theta: -1.8118564879642514
+    kappa: -0.0077723407590344976
+    s: 10.671623484696077
     dkappa: 0
     ddkappa: 0
   }
-  v: 2.0271664419739528
-  a: -0.42185912400628245
+  v: 2.1350066949189461
+  a: -0.40358913132509955
   relative_time: 3.4000000000000026
 }
 trajectory_point {
   path_point {
-    x: 587258.06491429871
-    y: 4140944.8795926464
-    theta: -1.8118468249254476
-    kappa: -0.0077692922406833523
-    s: 10.670510349496674
+    x: 587258.01338503067
+    y: 4140944.6733158194
+    theta: -1.8136925316461137
+    kappa: -0.0083515778155850047
+    s: 10.883125953166768
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.9856237000844204
-  a: -0.40907725947217777
+  v: 2.0952378695587885
+  a: -0.39187763618976529
   relative_time: 3.5000000000000027
 }
 trajectory_point {
   path_point {
-    x: 587258.01728165906
-    y: 4140944.6889144136
-    theta: -1.8135529594478903
-    kappa: -0.0083075455484558757
-    s: 10.867048022577119
+    x: 587257.96307540149
+    y: 4140944.4719213285
+    theta: -1.8154945590749958
+    kappa: -0.0089200813571354738
+    s: 11.090709188756547
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.9453345978889853
-  a: -0.39678716065402531
+  v: 2.0566129069203218
+  a: -0.38071396387456391
   relative_time: 3.6000000000000028
 }
 trajectory_point {
   path_point {
-    x: 587257.97061076842
-    y: 4140944.5020861588
-    theta: -1.8152246517980253
-    kappa: -0.0088349310017478526
-    s: 11.059617410093612
+    x: 587257.91368857922
+    y: 4140944.2742209272
+    theta: -1.8172635275358033
+    kappa: -0.0094781570920925047
+    s: 11.294484817753645
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.9062497096571458
-  a: -0.38499381072996131
+  v: 2.0190763986265461
+  a: -0.37011063627923441
   relative_time: 3.7000000000000028
 }
 trajectory_point {
   path_point {
-    x: 587257.92487304553
-    y: 4140944.3189934674
-    theta: -1.8168629162704275
-    kappa: -0.0093517715710101489
-    s: 11.248336441392745
+    x: 587257.86519886844
+    y: 4140944.0801117532
+    theta: -1.8190003469197116
+    kappa: -0.010026095382827829
+    s: 11.494558862999103
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.8683191113405857
-  a: -0.3737021928781219
+  v: 1.9825716841104879
+  a: -0.36008017530351555
   relative_time: 3.8000000000000029
 }
 trajectory_point {
   path_point {
-    x: 587257.88004112523
-    y: 4140944.1395267951
-    theta: -1.8184687246933844
-    kappa: -0.0098583764858701413
-    s: 11.433318028500388
+    x: 587257.8175819621
+    y: 4140943.8894965015
+    theta: -1.82070587852589
+    kappa: -0.010564170902743803
+    s: 11.691031618667758
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.8314923805731758
-  a: -0.36291729027664332
+  v: 1.9470408506151982
+  a: -0.35063510284714644
   relative_time: 3.900000000000003
 }
 trajectory_point {
   path_point {
-    x: 587257.83608887042
-    y: 4140943.9635815113
-    theta: -1.8200430058923549
-    kappa: -0.010355041098658532
-    s: 11.614670016289907
+    x: 587257.77081497153
+    y: 4140943.7022835491
+    theta: -1.8223809338746715
+    kappa: -0.011092642293338995
+    s: 11.88399752504926
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.7957185966709737
-  a: -0.35264408610366088
+  v: 1.9124247331937558
+  a: -0.3417879408098653
   relative_time: 4.0000000000000027
 }
 trajectory_point {
   path_point {
-    x: 587257.79299127508
-    y: 4140943.7910575159
-    theta: -1.8215866490622161
-    kappa: -0.010842047977866379
-    s: 11.792495581746778
+    x: 587257.723122264
+    y: 4140943.5188458655
+    theta: -1.8244630312555414
+    kappa: -0.011608963278611771
+    s: 12.073545682116679
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.76096416642972
-  a: -0.34235969252848136
+  v: 1.8786883004456483
+  a: -0.33279792741331782
   relative_time: 4.1000000000000023
 }
 trajectory_point {
   path_point {
-    x: 587257.7507233331
-    y: 4140943.6218547062
-    theta: -1.8231005442143382
-    kappa: -0.011319679695948616
-    s: 11.966897903303844
+    x: 587257.6738945815
+    y: 4140943.3392495881
+    theta: -1.8270993581606896
+    kappa: -0.012112447078367068
+    s: 12.259766485742068
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.7272607791844579
-  a: -0.33165166837789911
+  v: 1.8458901809951882
+  a: -0.3230569154938992
   relative_time: 4.200000000000002
 }
 trajectory_point {
   path_point {
-    x: 587257.70608794235
-    y: 4140943.4566999222
-    theta: -1.8253752644166448
-    kappa: -0.011783184459702813
-    s: 12.137983918991642
+    x: 587257.62552078464
+    y: 4140943.1627685237
+    theta: -1.8296900970188263
+    kappa: -0.012607197628018379
+    s: 12.442757169841434
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.6946422653345081
-  a: -0.32069066681628589
+  v: 1.8140949025035691
+  a: -0.31277634887347483
   relative_time: 4.3000000000000016
 }
 trajectory_point {
   path_point {
-    x: 587257.66170888965
-    y: 4140943.2947927946
-    theta: -1.8277519713243757
-    kappa: -0.012237078141847707
-    s: 12.305863096614814
+    x: 587257.57797374343
+    y: 4140942.9893036922
+    theta: -1.8322366596732285
+    kappa: -0.013093492406080477
+    s: 12.6226203638778
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.6631253899627561
-  a: -0.30964734100801328
+  v: 1.7833458482497981
+  a: -0.30216767137391043
   relative_time: 4.4000000000000012
 }
 trajectory_point {
   path_point {
-    x: 587257.61814841256
-    y: 4140943.1358720595
-    theta: -1.8300849466655158
-    kappa: -0.012682599712885007
-    s: 12.470645727220475
+    x: 587257.53122546023
+    y: 4140942.8187529533
+    theta: -1.8347405082480004
+    kappa: -0.013571617762177513
+    s: 12.799461978422974
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.6327098528356487
-  a: -0.29869234411745288
+  v: 1.7536652571306961
+  a: -0.29144232681707155
   relative_time: 4.5000000000000009
 }
 trajectory_point {
   path_point {
-    x: 587257.57537758932
-    y: 4140942.9798322003
-    theta: -1.83237570884214
-    kappa: -0.013120044977754958
-    s: 12.632441218566562
+    x: 587257.485247629
+    y: 4140942.6510130372
+    theta: -1.8372031248734788
+    kappa: -0.014041863200252195
+    s: 12.973389090719339
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.6033782884031962
-  a: -0.28799632930897623
+  v: 1.7250542236608977
+  a: -0.28081175902482369
   relative_time: 4.6000000000000005
 }
 trajectory_point {
   path_point {
-    x: 587257.53336818225
-    y: 4140942.8265701989
-    theta: -1.8346257425883508
-    kappa: -0.01354970273931852
-    s: 12.791356388590184
+    x: 587257.44001219433
+    y: 4140942.485981591
+    theta: -1.8396259814248102
+    kappa: -0.014504515661774898
+    s: 13.144507830241634
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.5750962657989718
-  a: -0.27772994974695508
+  v: 1.69749269797285
+  a: -0.27048741181903246
   relative_time: 4.7
 }
 trajectory_point {
   path_point {
-    x: 587257.49209308962
-    y: 4140942.6759871813
-    theta: -1.8368364745191768
-    kappa: -0.013971850184420521
-    s: 12.947493758875995
+    x: 587257.3954919104
+    y: 4140942.3235592125
+    theta: -1.8420105092806309
+    kappa: -0.01495985380895281
+    s: 13.312921264258732
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.5478122888401111
-  a: -0.26806385859576093
+  v: 1.6709394858168138
+  a: -0.26068072902156347
   relative_time: 4.8
 }
 trajectory_point {
   path_point {
-    x: 587257.45152679679
-    y: 4140942.5279900627
-    theta: -1.8390092487040626
-    kappa: -0.014386748269952735
-    s: 13.100949848124538
+    x: 587257.35166089935
+    y: 4140942.1636514934
+    theta: -1.8443580691078028
+    kappa: -0.015408142307939071
+    s: 13.478727283395424
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.521457796027313
-  a: -0.25916870901976546
+  v: 1.6453322485608646
+  a: -0.25160315445428216
   relative_time: 4.8999999999999995
 }
 trajectory_point {
   path_point {
-    x: 587257.41164582688
-    y: 4140942.3824931923
-    theta: -1.8411453022677962
-    kappa: -0.014794637108916963
-    s: 13.251813465620597
+    x: 587257.30849521141
+    y: 4140942.0061710579
+    theta: -1.8466699206773209
+    kappa: -0.0158496261120419
+    s: 13.642016487194194
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.4959471605448393
-  a: -0.25121515418334028
+  v: 1.6205875031908894
+  a: -0.24346613193905425
   relative_time: 4.9999999999999991
 }
 trajectory_point {
   path_point {
-    x: 587257.37242919207
-    y: 4140942.2394200014
-    theta: -1.8432457410212264
-    kappa: -0.015195731356488197
-    s: 13.400164004701571
+    x: 587257.26597338286
+    y: 4140941.8510396006
+    theta: -1.8489471927158048
+    kappa: -0.016284524744933745
+    s: 13.802870069677015
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.471177690260514
-  a: -0.24437384725085695
+  v: 1.5966006223105897
+  a: -0.23648110529774519
   relative_time: 5.0999999999999988
 }
 trajectory_point {
   path_point {
-    x: 587257.33385884482
-    y: 4140942.0987046473
-    theta: -1.8453115151237112
-    kappa: -0.015590215596077664
-    s: 13.546069736225812
+    x: 587257.224076995
+    y: 4140941.6981899259
+    theta: -1.8511908527963705
+    kappa: -0.016713026583860403
+    s: 13.96135770490711
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.4470296277257242
-  a: -0.23881544138668714
+  v: 1.573245834141481
+  a: -0.23085951835222063
   relative_time: 5.1999999999999984
 }
 trajectory_point {
   path_point {
-    x: 587257.29592012928
-    y: 4140941.9602936609
-    theta: -1.847343394778872
-    kappa: -0.015978239725395981
-    s: 13.689586102040993
+    x: 587257.178749859
+    y: 4140941.5487487353
+    theta: -1.8540249876710126
+    kappa: -0.017093358324359306
+    s: 14.117535432550751
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.4233661501754207
-  a: -0.23471058975520243
+  v: 1.5503762225228908
+  a: -0.22681281492434605
   relative_time: 5.299999999999998
 }
 trajectory_point {
   path_point {
-    x: 587257.25860223162
-    y: 4140941.8241475914
-    theta: -1.8493419459649076
-    kappa: -0.016359914342516227
-    s: 13.830754008452459
+    x: 587257.13312348363
+    y: 4140941.4017591416
+    theta: -1.8569659281515423
+    kappa: -0.017458225353082002
+    s: 14.271443543439032
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.4000333695281153
-  a: -0.23222994552077444
+  v: 1.5278237269119614
+  a: -0.22455243883598708
   relative_time: 5.3999999999999977
 }
 trajectory_point {
   path_point {
-    x: 587257.22189863189
-    y: 4140941.6902426514
-    theta: -1.8513075062004063
-    kappa: -0.016735306131937064
-    s: 13.969598119691582
+    x: 587257.08816329215
+    y: 4140941.2569157216
+    theta: -1.859864161269243
+    kappa: -0.017817765013150803
+    s: 14.423104465129656
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.3768603323858848
-  a: -0.23154416184777477
+  v: 1.5053991423836475
+  a: -0.22428983390900928
   relative_time: 5.4999999999999973
 }
 trajectory_point {
   path_point {
-    x: 587257.18213246006
-    y: 4140941.5596460979
-    theta: -1.8538069661200043
-    kappa: -0.017066308188001124
-    s: 14.106125151384122
+    x: 587257.04386855825
+    y: 4140941.1142161349
+    theta: -1.8627196759796487
+    kappa: -0.018171983112369162
+    s: 14.5725206474687
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.3536590200343672
-  a: -0.23282389190057506
+  v: 1.4828921196307181
+  a: -0.2262364439652782
   relative_time: 5.599999999999997
 }
 trajectory_point {
   path_point {
-    x: 587257.14234948042
-    y: 4140941.4314815449
-    theta: -1.8563712270069319
-    kappa: -0.017384446491309512
-    s: 14.240322164018581
+    x: 587257.000245105
+    y: 4140940.97367914
+    theta: -1.8655320433784981
+    kappa: -0.01852083308510151
+    s: 14.719672448152421
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.3302243484427643
-  a: -0.23623978884354691
+  v: 1.460071164963755
+  a: -0.23060371282665942
   relative_time: 5.6999999999999966
 }
 trajectory_point {
   path_point {
-    x: 587257.10326740821
-    y: 4140941.30557503
-    theta: -1.858890493884263
-    kappa: -0.0176969797456352
-    s: 14.372154856414557
+    x: 587256.95730593137
+    y: 4140940.8353466168
+    theta: -1.8683003760860206
+    kappa: -0.01886421097961475
+    s: 14.86451601828902
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.3063341682638399
-  a: -0.24196250584106191
+  v: 1.4366836403111538
+  a: -0.23760308431501853
   relative_time: 5.7999999999999963
 }
 trajectory_point {
   path_point {
-    x: 587257.0649032509
-    y: 4140941.1819813447
-    theta: -1.8613636294446465
-    kappa: -0.018003771946478855
-    s: 14.501565859191111
+    x: 587256.91507183947
+    y: 4140940.6992855789
+    theta: -1.871023287728705
+    kappa: -0.019201950445419856
+    s: 15.006981187960427
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.2817492648339215
-  a: -0.25016269605749164
+  v: 1.4124557632191233
+  a: -0.24744600225222108
   relative_time: 5.8999999999999959
 }
 trajectory_point {
   path_point {
-    x: 587257.02728136012
-    y: 4140941.0607789406
-    theta: -1.8637890262269281
-    kappa: -0.018304628356355147
-    s: 14.628473028235101
+    x: 587256.87357206107
+    y: 4140940.5655901995
+    theta: -1.8736988525202813
+    kappa: -0.019533817720613435
+    s: 15.146969351784088
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.2562133581728989
-  a: -0.26101101265720783
+  v: 1.3870926068516862
+  a: -0.26034391046013255
   relative_time: 5.9999999999999956
 }
 trajectory_point {
   path_point {
-    x: 587256.99043393834
-    y: 4140940.9420715584
-    theta: -1.8661645739219412
-    kappa: -0.018599291459150655
-    s: 14.752767738169563
+    x: 587256.83284488437
+    y: 4140940.4343838282
+    theta: -1.8763245649416114
+    kappa: -0.019859506619219279
+    s: 15.284351354474737
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.2294531029842251
-  a: -0.27467810880458204
+  v: 1.3602780999906778
+  a: -0.27650825276061852
   relative_time: 6.0999999999999952
 }
 trajectory_point {
   path_point {
-    x: 587256.95440154383
-    y: 4140940.8259898629
-    theta: -1.8684876267445145
-    kappa: -0.018887436914481824
-    s: 14.874313175822053
+    x: 587256.79293828132
+    y: 4140940.3058210118
+    theta: -1.8788972995166788
+    kappa: -0.020178633518529939
+    s: 15.418965376406183
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.201178088654915
-  a: -0.29133463766398582
+  v: 1.3316750270357478
+  a: -0.29615047297554481
   relative_time: 6.1999999999999948
 }
 trajectory_point {
   path_point {
-    x: 587256.9192335977
-    y: 4140940.7126930682
-    theta: -1.8707549708674742
-    kappa: -0.01916866951205284
-    s: 14.992942633693007
+    x: 587256.75391053385
+    y: 4140940.1800895091
+    theta: -1.8814132706788331
+    kappa: -0.0204907323464483
+    s: 15.550614819173095
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.1710808392555476
-  a: -0.31115125239979086
+  v: 1.3009250280043589
+  a: -0.31948201492677669
   relative_time: 6.2999999999999945
 }
 trajectory_point {
   path_point {
-    x: 587256.88498888863
-    y: 4140940.6023705667
-    theta: -1.8729627919112886
-    kappa: -0.019442519126013559
-    s: 15.108457803424093
+    x: 587256.71583086113
+    y: 4140940.0574123166
+    theta: -1.8838679927177888
+    kappa: -0.020795249568829118
+    s: 15.679066191152771
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.1388368135402647
-  a: -0.33429860617636881
+  v: 1.2676485985317874
+  a: -0.34671432243617983
   relative_time: 6.3999999999999941
 }
 trajectory_point {
   path_point {
-    x: 587256.85173607955
-    y: 4140940.4952435629
-    theta: -1.8751066424805265
-    kappa: -0.019708436669317455
-    s: 15.220627069266582
+    x: 587256.678780046
+    y: 4140939.9380496847
+    theta: -1.8862562397935465
+    kappa: -0.021091539176820624
+    s: 15.804046993066938
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.1041044049467694
-  a: -0.36094735215809109
+  v: 1.231445089871122
+  a: -0.37805883932561984
   relative_time: 6.4999999999999938
 }
 trajectory_point {
   path_point {
-    x: 587256.81955421343
-    y: 4140940.3915667012
-    theta: -1.8771814097354376
-    kappa: -0.019965790048079475
-    s: 15.329183801549679
+    x: 587256.64285106189
+    y: 4140939.8223011363
+    theta: -1.8885720059983906
+    kappa: -0.02137885767420605
+    s: 15.925243603543514
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.0665249415963296
-  a: -0.39126814350932942
+  v: 1.1918927088932665
+  a: -0.41372700941696222
   relative_time: 6.5999999999999934
 }
 trajectory_point {
   path_point {
-    x: 587256.78853321914
-    y: 4140940.2916296958
-    theta: -1.8791812829837542
-    kappa: -0.020213860115934019
-    s: 15.433824650148905
+    x: 587256.6060134517
+    y: 4140939.7112210784
+    theta: -1.8910062256986642
+    kappa: -0.021622836354963371
+    s: 16.042299164678397
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.0257226862937743
-  a: -0.42543163339445561
+  v: 1.1485485180869375
+  a: -0.45393027653207263
   relative_time: 6.6999999999999931
 }
 trajectory_point {
   path_point {
-    x: 587256.7587744171
-    y: 4140940.1957589593
-    theta: -1.8810997212742939
-    kappa: -0.020451836628392832
-    s: 15.534207837954437
+    x: 587256.568089684
+    y: 4140939.6052927715
+    theta: -1.8935790306234594
+    kappa: -0.02181786475069843
+    s: 16.154811467597259
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.98130483652749667
-  a: -0.46360847497784091
+  v: 1.1009484355586645
+  a: -0.49888008449281646
   relative_time: 6.7999999999999927
 }
 trajectory_point {
   path_point {
-    x: 587256.73039102554
-    y: 4140940.1043192353
-    theta: -1.8829294209702034
-    kappa: -0.02067881419720291
-    s: 15.629951454339475
+    x: 587256.53184885054
+    y: 4140939.5040652212
+    theta: -1.8960378992841318
+    kappa: -0.022004238416328453
+    s: 16.262330838017302
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.93286152446945214
-  a: -0.50596932142385731
+  v: 1.0486072350327913
+  a: -0.54878787712105948
   relative_time: 6.8999999999999924
 }
 trajectory_point {
   path_point {
-    x: 587256.70350866625
-    y: 4140940.017715225
-    theta: -1.8846622832758664
-    kappa: -0.02089378824470443
-    s: 15.720631748628582
+    x: 587256.49745923164
+    y: 4140939.4080084651
+    theta: -1.8983713530177344
+    kappa: -0.022181091946654127
+    s: 16.364358021809061
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.87996581697515874
-  a: -0.55268482589687606
+  v: 0.9910185458514742
+  a: -0.60386509823866719
   relative_time: 6.999999999999992
 }
 trajectory_point {
   path_point {
-    x: 587256.67826587043
-    y: 4140939.9363932209
-    theta: -1.8862893816877981
-    kappa: -0.021095650958188671
-    s: 15.805781423566062
+    x: 587256.46510653186
+    y: 4140939.3176412121
+    theta: -1.9005667372849828
+    kappa: -0.022347470329800317
+    s: 16.46034207055817
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.82217371558369812
-  a: -0.60392564156126893
+  v: 0.92765485297468386
+  a: -0.664323191667505
   relative_time: 7.0999999999999917
 }
 trajectory_point {
   path_point {
-    x: 587256.65481458453
-    y: 4140939.8608427322
-    theta: -1.8878009293365343
-    kappa: -0.021283187244255916
-    s: 15.884887928784298
+    x: 587256.43499459233
+    y: 4140939.23353283
+    theta: -1.9026101735437246
+    kappa: -0.022502325282056975
+    s: 16.549678227127167
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.75902415651771371
-  a: -0.65986242158140762
+  v: 0.85796749698020391
+  a: -0.73037360122943873
   relative_time: 7.1999999999999913
 }
 trajectory_point {
   path_point {
-    x: 587256.63332067674
-    y: 4140939.7915981179
-    theta: -1.889186246183983
-    kappa: -0.021455070683173406
-    s: 15.957391754272123
+    x: 587256.4073461045
+    y: 4140939.1563053373
+    theta: -1.9044865109974309
+    kappa: -0.022644511582719982
+    s: 16.631705811217234
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.69003901068341311
-  a: -0.72066581912166372
+  v: 0.78138667406363127
+  a: -0.80222777074633389
   relative_time: 7.2999999999999909
 }
 trajectory_point {
   path_point {
-    x: 587256.61262475979
-    y: 4140939.729687721
-    theta: -1.8905577330851107
-    kappa: -0.021588836758207317
-    s: 16.02268472384316
+    x: 587256.38240332156
+    y: 4140939.0866353936
+    theta: -1.9061792781682803
+    kappa: -0.022772783408932056
+    s: 16.705706104930027
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.6147230836705655
-  a: -0.7865064873464086
+  v: 0.69732143603837693
+  a: -0.88009714404005579
   relative_time: 7.3999999999999906
 }
 trajectory_point {
   path_point {
-    x: 587256.59326938377
-    y: 4140939.6756244688
-    theta: -1.8918707719770316
-    kappa: -0.021688374545828708
-    s: 16.08010828860419
+    x: 587256.360428772
+    y: 4140939.025256291
+    theta: -1.9076706342504701
+    kappa: -0.022885790670523615
+    s: 16.770900238329418
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.5325641157525034
-  a: -0.8575550794200143
+  v: 0.6051596903356643
+  a: -0.96419316493247031
   relative_time: 7.49999999999999
 }
 trajectory_point {
   path_point {
-    x: 587256.576806022
-    y: 4140939.6296391636
-    theta: -1.8929876776762358
-    kappa: -0.021773039737151178
-    s: 16.128951820423513
+    x: 587256.34170597221
+    y: 4140938.972959945
+    theta: -1.9089413202129266
+    kappa: -0.022982075344853657
+    s: 16.826447075003305
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.44303278188612211
-  a: -0.93398224850685174
+  v: 0.50426820000453143
+  a: -1.0547272772454428
   relative_time: 7.59999999999999
 }
 trajectory_point {
   path_point {
-    x: 587256.56349233014
-    y: 4140939.5924514863
-    theta: -1.8938909398063821
-    kappa: -0.021841507300039677
-    s: 16.168450905399283
+    x: 587256.32654013857
+    y: 4140938.930598883
+    theta: -1.9099706096442108
+    kappa: -0.023060067811650597
+    s: 16.871441097625365
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.34558269171188
-  a: -1.0159586477712936
+  v: 0.39399258371182877
+  a: -1.1519109248008392
   relative_time: 7.6999999999999895
 }
 trajectory_point {
   path_point {
-    x: 587256.5536046687
-    y: 4140939.5648333649
-    theta: -1.8945617841678009
-    kappa: -0.021892356012215446
-    s: 16.19778563732789
+    x: 587256.3152589011
+    y: 4140938.8990882374
+    theta: -1.9107362593694721
+    kappa: -0.023118083187853224
+    s: 16.904910293516863
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.23965038955379797
-  a: -1.1036549303777103
+  v: 0.2736573157422213
+  a: -1.2559555514205243
   relative_time: 7.7999999999999892
 }
 trajectory_point {
   path_point {
-    x: 587256.54743867752
-    y: 4140939.5476105767
-    theta: -1.8949801340830053
-    kappa: -0.02192406550316053
-    s: 16.216078911172296
+    x: 587256.30821301532
+    y: 4140938.8794077369
+    theta: -1.9112144599237526
+    kappa: -0.02315431766245149
+    s: 16.925814040208419
     dkappa: 0
     ddkappa: 0
   }
-  v: 0.1246553544194605
-  a: -1.1972417494904743
+  v: 0.14256572599818604
+  a: -1.367072600926365
   relative_time: 7.8999999999999888
 }
 trajectory_point {
   path_point {
-    x: 587256.5453098513
-    y: 4140939.54166436
-    theta: -1.8951245720376648
-    kappa: -0.021935013296022397
-    s: 16.222394716530406
+    x: 587256.30577707547
+    y: 4140938.872603693
+    theta: -1.9113797860426984
+    kappa: -0.023166844831327447
+    s: 16.933040991001789
     dkappa: 0
     ddkappa: 0
   }
-  v: 1.0613732115378789e-13
-  a: -1.2968897582739574
+  v: 1.2168044349848486e-13
+  a: -1.4854735171402254
   relative_time: 7.9999999999999885
 }
 decision {
@@ -1711,13 +1711,13 @@ decision {
       perception_id: 867
       object_decision {
         follow {
-          distance_s: -10
+          distance_s: -9.1999998092651367
           fence_point {
-            x: 587257.05795772409
-            y: 4140940.9044501609
+            x: 587256.80786406528
+            y: 4140940.1445523128
             z: 0
           }
-          fence_heading: -1.8819017153205233
+          fence_heading: -1.8909777299337525
         }
       }
     }
@@ -1726,13 +1726,13 @@ decision {
       perception_id: 867
       object_decision {
         follow {
-          distance_s: -10
+          distance_s: -9.1999998092651367
           fence_point {
-            x: 587257.07047114323
-            y: 4140940.9431678308
+            x: 587256.820761905
+            y: 4140940.1831436818
             z: 0
           }
-          fence_heading: -1.8775749912662505
+          fence_heading: -1.8909777299337525
         }
       }
     }