result_stop_over_line_0.pb.txt 47.4 KB
Newer Older
1 2 3 4 5 6 7
header {
  module_name: "planning"
}
is_replan: true
gear: GEAR_DRIVE
trajectory_point {
  path_point {
8 9 10 11 12
    x: 586344.82300500013
    y: 4140700.15992
    theta: 1.3255010179499997
    kappa: -0.026050217221752481
    s: 8.1401899110211673e-16
13 14 15
    dkappa: 0
    ddkappa: 0
  }
16 17
  v: 5.59999990463256
  a: -0.071950214089804676
18 19 20 21
  relative_time: 0
}
trajectory_point {
  path_point {
22 23 24 25 26
    x: 586344.89359809551
    y: 4140700.4307795353
    theta: 1.3200281512114724
    kappa: -0.022124866614589504
    s: 0.27990761472707293
27 28 29
    dkappa: 0
    ddkappa: 0
  }
30 31
  v: 5.5962468341301133
  a: -0.078887067556498686
32 33 34 35
  relative_time: 0.05
}
trajectory_point {
  path_point {
36 37 38 39 40
    x: 586344.96414123522
    y: 4140700.7014473942
    theta: 1.314558961397323
    kappa: -0.018202293805852272
    s: 0.55961715111430821
41 42 43
    dkappa: 0
    ddkappa: 0
  }
44 45
  v: 5.59204234420127
  a: -0.089955141561606541
46 47 48 49
  relative_time: 0.1
}
trajectory_point {
  path_point {
50 51 52 53 54
    x: 586345.03462745738
    y: 4140700.9718968654
    theta: 1.3090943154935779
    kappa: -0.014282885926015612
    s: 0.839101003788674
55 56 57
    dkappa: 0
    ddkappa: 0
  }
58 59
  v: 5.5871876512567145
  a: -0.10484333860099054
60 61 62 63
  relative_time: 0.15000000000000002
}
trajectory_point {
  path_point {
64 65 66 67 68
    x: 586345.10769487952
    y: 4140701.24138464
    theta: 1.3061211768365237
    kappa: -0.011077903531517415
    s: 1.118322017069552
69 70 71
    dkappa: 0
    ddkappa: 0
  }
72 73
  v: 5.5814995265823359
  a: -0.12324056117051298
74 75 76 77
  relative_time: 0.2
}
trajectory_point {
  path_point {
78 79 80 81 82
    x: 586345.18133851385
    y: 4140701.5103988694
    theta: 1.303768280801646
    kappa: -0.00805284522728414
    s: 1.3972342627124983
83 84 85
    dkappa: 0
    ddkappa: 0
  }
86 87
  v: 5.57481029633923
  a: -0.14483571176603616
88 89 90 91
  relative_time: 0.25
}
trajectory_point {
  path_point {
92 93 94 95 96
    x: 586345.25488638377
    y: 4140701.7790632797
    theta: 1.30141844968303
    kappa: -0.005031720635314943
    s: 1.6757838176530038
97 98 99
    dkappa: 0
    ddkappa: 0
  }
100 101
  v: 5.5669678415637005
  a: -0.16931769288342235
102 103 104 105
  relative_time: 0.3
}
trajectory_point {
  path_point {
106 107 108 109 110
    x: 586345.32891686482
    y: 4140702.04715497
    theta: 1.3004563402580804
    kappa: -0.0025346903739443139
    s: 1.9539095417502557
111 112 113
    dkappa: 0
    ddkappa: 0
  }
114 115
  v: 5.5578355981672587
  a: -0.19637540701853395
116 117 118 119
  relative_time: 0.35
}
trajectory_point {
  path_point {
120 121 122 123 124
    x: 586345.40320934367
    y: 4140702.3146646703
    theta: 1.3004104267601
    kappa: -0.00038530498254104391
    s: 2.2315438555308957
125 126 127
    dkappa: 0
    ddkappa: 0
  }
128 129
  v: 5.5472925569366209
  a: -0.22569775666723316
130 131 132 133
  relative_time: 0.39999999999999997
}
trajectory_point {
  path_point {
134 135 136 137 138
    x: 586345.477350727
    y: 4140702.581630311
    theta: 1.3003646066407781
    kappa: 0.0017597089988293608
    s: 2.5086135179327824
139 140 141
    dkappa: 0
    ddkappa: 0
  }
142 143
  v: 5.5352332635337111
  a: -0.25697364432538233
144 145 146 147
  relative_time: 0.44999999999999996
}
trajectory_point {
  path_point {
148 149 150 151 152
    x: 586345.55105675524
    y: 4140702.8480493943
    theta: 1.3009286055286906
    kappa: 0.0036090402382023936
    s: 2.7850404040487504
153 154 155
    dkappa: 0
    ddkappa: 0
  }
156 157
  v: 5.5215678184956607
  a: -0.2898919724888438
158 159 160 161
  relative_time: 0.49999999999999994
}
trajectory_point {
  path_point {
162 163 164 165 166
    x: 586345.62415809743
    y: 4140703.1138834022
    theta: 1.3024435308773246
    kappa: 0.0049994234494187585
    s: 3.060742282870371
167 168 169
    dkappa: 0
    ddkappa: 0
  }
170 171
  v: 5.5062218772348075
  a: -0.32414164365347975
172 173 174 175
  relative_time: 0.54999999999999993
}
trajectory_point {
  path_point {
176 177 178 179 180
    x: 586345.6970445211
    y: 4140703.3789358549
    theta: 1.3039540038854394
    kappa: 0.0063857189181763486
    s: 3.3356335950317129
181 182 183
    dkappa: 0
    ddkappa: 0
  }
184 185
  v: 5.489136650038696
  a: -0.3594115603151527
186 187 188 189
  relative_time: 0.6
}
trajectory_point {
  path_point {
190 191 192 193 194
    x: 586345.76942611253
    y: 4140703.643194152
    theta: 1.3056054592707438
    kappa: 0.0076753745365622152
    s: 3.6096262305531015
195 196 197
    dkappa: 0
    ddkappa: 0
  }
198 199
  v: 5.4702689020700772
  a: -0.39539062496972471
200 201 202 203
  relative_time: 0.65
}
trajectory_point {
  path_point {
204 205 206 207 208
    x: 586345.84007824759
    y: 4140703.9068975868
    theta: 1.3080548086877113
    kappa: 0.0084529987833462245
    s: 3.8826303065848817
209 210 211
    dkappa: 0
    ddkappa: 0
  }
212 213
  v: 5.4495909533669105
  a: -0.43176774011305818
214 215 216 217
  relative_time: 0.70000000000000007
}
trajectory_point {
  path_point {
218 219 220 221 222
    x: 586345.91045102943
    y: 4140704.1695583579
    theta: 1.3104944875195423
    kappa: 0.0092275483626811181
    s: 4.1545549451511734
223 224 225
    dkappa: 0
    ddkappa: 0
  }
226 227
  v: 5.4270906788423607
  a: -0.46823180824101557
228 229 230 231
  relative_time: 0.75000000000000011
}
trajectory_point {
  path_point {
232 233 234 235 236
    x: 586345.980520883
    y: 4140704.4310884736
    theta: 1.3129236494441341
    kappa: 0.00999876379873619
    s: 4.4253090508936372
237 238 239
    dkappa: 0
    ddkappa: 0
  }
240 241
  v: 5.4027715082848005
  a: -0.50447173184945893
242 243 244 245
  relative_time: 0.80000000000000016
}
trajectory_point {
  path_point {
246 247 248 249 250
    x: 586346.0482308924
    y: 4140704.6919356463
    theta: 1.3157531103933249
    kappa: 0.010356962231219437
    s: 4.6948020888152326
251 252 253
    dkappa: 0
    ddkappa: 0
  }
254 255
  v: 5.3766524263578095
  a: -0.5401764134342506
256 257 258 259
  relative_time: 0.8500000000000002
}
trajectory_point {
  path_point {
260 261 262 263 264
    x: 586346.11532491946
    y: 4140704.9515487012
    theta: 1.3186244449368612
    kappa: 0.010657648954105346
    s: 4.9629448620239769
265 266 267
    dkappa: 0
    ddkappa: 0
  }
268 269
  v: 5.3487679726001724
  a: -0.57503475549125294
270 271 272 273
  relative_time: 0.90000000000000024
}
trajectory_point {
  path_point {
274 275 276 277 278
    x: 586346.18205929745
    y: 4140705.2097701328
    theta: 1.3214803775693171
    kappa: 0.010956723883468508
    s: 5.2296502894767087
279 280 281
    dkappa: 0
    ddkappa: 0
  }
282 283
  v: 5.3191682414258823
  a: -0.60873566051632833
284 285 286 287
  relative_time: 0.95000000000000029
}
trajectory_point {
  path_point {
288 289 290 291 292
    x: 586346.2470159966
    y: 4140705.4668721817
    theta: 1.3243755025765573
    kappa: 0.011056015439023289
    s: 5.4948341837228432
293 294 295
    dkappa: 0
    ddkappa: 0
  }
296 297
  v: 5.28791888212414
  a: -0.640968031005339
298 299 300 301
  relative_time: 1.0000000000000002
}
trajectory_point {
  path_point {
302 303 304 305 306
    x: 586346.31046946358
    y: 4140705.7227022946
    theta: 1.3272973227710065
    kappa: 0.010997204037996235
    s: 5.7584160286481412
307 308 309
    dkappa: 0
    ddkappa: 0
  }
310 311
  v: 5.2551010988593525
  a: -0.67142076945414719
312 313 314 315
  relative_time: 1.0500000000000003
}
trajectory_point {
  path_point {
316 317 318 319 320
    x: 586346.37351894856
    y: 4140705.9769036425
    theta: 1.33020054738836
    kappa: 0.010938767064782867
    s: 6.0203197572184584
321 322 323
    dkappa: 0
    ddkappa: 0
  }
324 325
  v: 5.2208116506711315
  a: -0.69978277835861524
326 327 328 329
  relative_time: 1.1000000000000003
}
trajectory_point {
  path_point {
330 331 332 333 334
    x: 586346.43573968869
    y: 4140706.2295065126
    theta: 1.3330543500421494
    kappa: 0.010835330853953993
    s: 6.2804745292235138
335 336 337
    dkappa: 0
    ddkappa: 0
  }
338 339
  v: 5.1851628514742982
  a: -0.72574296021460571
340 341 342 343
  relative_time: 1.1500000000000004
}
trajectory_point {
  path_point {
344 345 346 347 348
    x: 586346.49551310949
    y: 4140706.4808373693
    theta: 1.335740133933278
    kappa: 0.010508454878326729
    s: 6.5388155090206475
349 350 351
    dkappa: 0
    ddkappa: 0
  }
352 353
  v: 5.148282570058881
  a: -0.74899021751798034
354 355 356 357
  relative_time: 1.2000000000000004
}
trajectory_point {
  path_point {
358 359 360 361 362
    x: 586346.55485343363
    y: 4140706.7303471747
    theta: 1.3384064788559611
    kappa: 0.010183947328093412
    s: 6.7952846432785829
363 364 365
    dkappa: 0
    ddkappa: 0
  }
366 367
  v: 5.110314230090113
  a: -0.76921345276460174
368 369 370 371
  relative_time: 1.2500000000000004
}
trajectory_point {
  path_point {
372 373 374 375 376
    x: 586346.61374897836
    y: 4140706.9779868037
    theta: 1.3410528219099376
    kappa: 0.00986187209183616
    s: 7.0498314387211805
377 378 379
    dkappa: 0
    ddkappa: 0
  }
380 381
  v: 5.0714168101084356
  a: -0.7861015684503323
382 383 384 385
  relative_time: 1.3000000000000005
}
trajectory_point {
  path_point {
386 387 388 389 390
    x: 586346.67070720287
    y: 4140707.2240611408
    theta: 1.3434130961672746
    kappa: 0.0094011298374711422
    s: 7.3024137398712083
391 392 393
    dkappa: 0
    ddkappa: 0
  }
394 395
  v: 5.0317648435294968
  a: -0.79934346707103443
396 397 398 399
  relative_time: 1.3500000000000005
}
trajectory_point {
  path_point {
400 401 402 403 404
    x: 586346.72658030561
    y: 4140707.4683374632
    theta: 1.3456410320351397
    kappa: 0.0088836143960309318
    s: 7.5529985067940935
405 406 407
    dkappa: 0
    ddkappa: 0
  }
408 409
  v: 4.9915484186441512
  a: -0.80862805112257008
410 411 412 413
  relative_time: 1.4000000000000006
}
trajectory_point {
  path_point {
414 415 416 417 418
    x: 586346.78200285533
    y: 4140707.7106439751
    theta: 1.3478510037059268
    kappa: 0.00837027212747759
    s: 7.8015625928416874
419 420 421
    dkappa: 0
    ddkappa: 0
  }
422 423
  v: 4.9509731786184616
  a: -0.81364422310080164
424 425 426 427
  relative_time: 1.4500000000000006
}
trajectory_point {
  path_point {
428 429 430 431 432
    x: 586346.83674403909
    y: 4140707.9510198343
    theta: 1.3499723822428109
    kappa: 0.00784121452674081
    s: 8.0480935223960248
433 434 435
    dkappa: 0
    ddkappa: 0
  }
436 437
  v: 4.9102603214936948
  a: -0.81408088550159174
438 439 440 441
  relative_time: 1.5000000000000007
}
trajectory_point {
  path_point {
442 443 444 445 446
    x: 586346.889590871
    y: 4140708.1897369707
    theta: 1.351630243893065
    kappa: 0.0071905321458882211
    s: 8.2925902686130826
447 448 449
    dkappa: 0
    ddkappa: 0
  }
450 451
  v: 4.8696466001863286
  a: -0.80962694082080233
452 453 454 455
  relative_time: 1.5500000000000007
}
trajectory_point {
  path_point {
456 457 458 459 460
    x: 586346.94200044463
    y: 4140708.4264789447
    theta: 1.3532743944254788
    kappa: 0.0065452335578550531
    s: 8.5350640311665433
461 462 463
    dkappa: 0
    ddkappa: 0
  }
464 465
  v: 4.8293843224880435
  a: -0.7999712915542958
466 467 468 469
  relative_time: 1.6000000000000008
}
trajectory_point {
  path_point {
470 471 472 473 474
    x: 586346.99397799128
    y: 4140708.6612693872
    theta: 1.3549049890285094
    kappa: 0.0059052543483928844
    s: 8.7755390139915566
475 476 477
    dkappa: 0
    ddkappa: 0
  }
478 479
  v: 4.78974135106573
  a: -0.78480284019793456
480 481 482 483
  relative_time: 1.6500000000000008
}
trajectory_point {
  path_point {
484 485 486 487 488
    x: 586347.04499897221
    y: 4140708.8942619525
    theta: 1.3562392256812867
    kappa: 0.0052255781364317676
    s: 9.0140532030284888
489 490 491
    dkappa: 0
    ddkappa: 0
  }
492 493
  v: 4.7510011034614834
  a: -0.76381048924758077
494 495 496 497
  relative_time: 1.7000000000000008
}
trajectory_point {
  path_point {
498 499 500 501 502
    x: 586347.09500312712
    y: 4140709.1255236128
    theta: 1.3572394189490606
    kappa: 0.0045000270880651908
    s: 9.250659143966697
503 504 505
    dkappa: 0
    ddkappa: 0
  }
506 507
  v: 4.7134625520926079
  a: -0.73668314119909639
508 509 510 511
  relative_time: 1.7500000000000009
}
trajectory_point {
  path_point {
512 513 514 515 516
    x: 586347.14461834054
    y: 4140709.3549864781
    theta: 1.3582318333419012
    kappa: 0.0037801195103965052
    s: 9.4854247199882842
517 518 519
    dkappa: 0
    ddkappa: 0
  }
520 521
  v: 4.6774402242516118
  a: -0.70310969854834426
522 523 524 525
  relative_time: 1.8000000000000009
}
trajectory_point {
  path_point {
526 527 528 529 530
    x: 586347.19386236451
    y: 4140709.5827326477
    theta: 1.35921682199089
    kappa: 0.0030655978226547514
    s: 9.7184339295118551
531 532 533
    dkappa: 0
    ddkappa: 0
  }
534 535
  v: 4.6432642021062129
  a: -0.66277906379118678
536 537 538 539
  relative_time: 1.850000000000001
}
trajectory_point {
  path_point {
540 541 542 543 544
    x: 586347.24236552615
    y: 4140709.8089447594
    theta: 1.359747060603701
    kappa: 0.0023215553637100008
    s: 9.9497876639362826
545 546 547
    dkappa: 0
    ddkappa: 0
  }
548 549
  v: 4.611280122699335
  a: -0.61538013942348591
550 551 552 553
  relative_time: 1.900000000000001
}
trajectory_point {
  path_point {
554 555 556 557 558
    x: 586347.29036675452
    y: 4140710.0336927371
    theta: 1.36006796895751
    kappa: 0.0015665530764059853
    s: 10.179604485384468
559 560 561
    dkappa: 0
    ddkappa: 0
  }
562 563
  v: 4.5818491779491088
  a: -0.56060182794110425
564 565 566 567
  relative_time: 1.9500000000000011
}
trajectory_point {
  path_point {
568 569 570 571 572
    x: 586347.33807558916
    y: 4140710.2570716888
    theta: 1.360386922551635
    kappa: 0.0008161497975489434
    s: 10.408021404447098
573 574 575
    dkappa: 0
    ddkappa: 0
  }
576 577
  v: 4.5553481146488721
  a: -0.49813303183990293
578 579 580 581
  relative_time: 2.0000000000000009
}
trajectory_point {
  path_point {
582 583 584 585 586
    x: 586347.38552438386
    y: 4140710.479233101
    theta: 1.3607041376223994
    kappa: 6.9836635031418048e-05
    s: 10.635193323921902
587 588 589
    dkappa: 0
    ddkappa: 0
  }
590 591
  v: 4.5320624493442985
  a: -0.43407623727673894
592 593 594 595
  relative_time: 2.0500000000000007
}
trajectory_point {
  path_point {
596 597 598 599 600
    x: 586347.43276459316
    y: 4140710.700328412
    theta: 1.3604846075693098
    kappa: -0.00067774873226833759
    s: 10.861279090697614
601 602 603
    dkappa: 0
    ddkappa: 0
  }
604 605
  v: 4.5118635224492643
  a: -0.3746375510295909
606 607 608 609
  relative_time: 2.1000000000000005
}
trajectory_point {
  path_point {
610 611 612 613 614
    x: 586347.47981341206
    y: 4140710.9205059311
    theta: 1.3601341111818186
    kappa: -0.00142342670087262
    s: 11.086427333920389
J
Jiangtao Hu 已提交
615 616 617
    dkappa: 0
    ddkappa: 0
  }
618 619
  v: 4.49452432021228
  a: -0.31966130652600888
J
Jiangtao Hu 已提交
620
  relative_time: 2.1500000000000004
621 622 623
}
trajectory_point {
  path_point {
624 625 626 627 628
    x: 586347.52669504564
    y: 4140711.1399010634
    theta: 1.3597848602473048
    kappa: -0.0021664549484247267
    s: 11.310775526632023
629 630 631
    dkappa: 0
    ddkappa: 0
  }
632 633
  v: 4.4798256122104787
  a: -0.26899183719354286
634 635 636 637
  relative_time: 2.2
}
trajectory_point {
  path_point {
638 639 640 641 642
    x: 586347.57343597186
    y: 4140711.3586377166
    theta: 1.3594366576027761
    kappa: -0.0029072531182173884
    s: 11.53445037493638
643 644 645
    dkappa: 0
    ddkappa: 0
  }
646 647
  v: 4.467555951349615
  a: -0.22247347645974286
648 649 650 651
  relative_time: 2.25
}
trajectory_point {
  path_point {
652 653 654 655 656
    x: 586347.62055361213
    y: 4140711.5767235924
    theta: 1.3585441428330465
    kappa: -0.0036158754337125686
    s: 11.757568207165832
657 658 659
    dkappa: 0
    ddkappa: 0
  }
660 661
  v: 4.457511673864067
  a: -0.1799505577521589
662 663 664 665
  relative_time: 2.3
}
trajectory_point {
  path_point {
666 667 668 669 670
    x: 586347.667664701
    y: 4140711.7943498953
    theta: 1.3575554500368372
    kappa: -0.0043176153474858217
    s: 11.980235363047685
671 672 673
    dkappa: 0
    ddkappa: 0
  }
674 675
  v: 4.449496899316836
  a: -0.14126741449834102
676 677 678 679
  relative_time: 2.3499999999999996
}
trajectory_point {
  path_point {
680 681 682 683 684
    x: 586347.71470090537
    y: 4140712.0116302748
    theta: 1.3565683285144947
    kappa: -0.005018239824819918
    s: 12.202548582870609
685 686 687
    dkappa: 0
    ddkappa: 0
  }
688 689
  v: 4.4433235305995442
  a: -0.10626838012583922
690 691 692 693
  relative_time: 2.3999999999999995
}
trajectory_point {
  path_point {
694 695 696 697 698
    x: 586347.76168074459
    y: 4140712.2286502789
    theta: 1.3555823915344292
    kappa: -0.0057180247182803774
    s: 12.424595396651069
699 700 701
    dkappa: 0
    ddkappa: 0
  }
702 703
  v: 4.438811253932438
  a: -0.074797788062203552
704 705 706 707
  relative_time: 2.4499999999999993
}
trajectory_point {
  path_point {
708 709 710 711 712
    x: 586347.8095661
    y: 4140712.4452796862
    theta: 1.3540945847602877
    kappa: -0.0063495533575096408
    s: 12.646454513299764
713 714 715
    dkappa: 0
    ddkappa: 0
  }
716 717
  v: 4.4357875388643837
  a: -0.046699971734983969
718 719 720 721
  relative_time: 2.4999999999999991
}
trajectory_point {
  path_point {
722 723 724 725 726
    x: 586347.85758784646
    y: 4140712.6617589965
    theta: 1.3525215414725191
    kappa: -0.0069691698939991012
    s: 12.868196209788044
727 728 729
    dkappa: 0
    ddkappa: 0
  }
730 731
  v: 4.4340876382728736
  a: -0.021819264571730612
732 733 734 735
  relative_time: 2.5499999999999989
}
trajectory_point {
  path_point {
736 737 738 739 740
    x: 586347.9055976416
    y: 4140712.8781844303
    theta: 1.3509488885129672
    kappa: -0.0075886322234307111
    s: 13.089882720314355
741 742 743
    dkappa: 0
    ddkappa: 0
  }
744 745
  v: 4.4335545883640188
  a: 6.6058269965196814e-15
746 747 748 749
  relative_time: 2.5999999999999988
}
trajectory_point {
  path_point {
750 751 752 753 754
    x: 586347.95360730542
    y: 4140713.0946092736
    theta: 1.3493762464648349
    kappa: -0.008208092861266782
    s: 13.311568625470663
755 756 757
    dkappa: 0
    ddkappa: 0
  }
758 759
  v: 4.434039208672556
  a: 0.018913488552677604
760 761 762 763
  relative_time: 2.6499999999999986
}
trajectory_point {
  path_point {
764 765 766 767 768
    x: 586348.00298143167
    y: 4140713.3107740232
    theta: 1.3473810446567234
    kappa: -0.0087214760830463273
    s: 13.533301241408884
769 770 771
    dkappa: 0
    ddkappa: 0
  }
772 773
  v: 4.435400102061843
  a: 0.035076867658732414
774 775 776 777
  relative_time: 2.6999999999999984
}
trajectory_point {
  path_point {
778 779 780 781 782
    x: 586348.05262063839
    y: 4140713.526968284
    theta: 1.3453084483112643
    kappa: -0.00921579530895714
    s: 13.75512100900732
783 784 785
    dkappa: 0
    ddkappa: 0
  }
786 787
  v: 4.43750365472386
  a: 0.0486458038906209
788 789 790 791
  relative_time: 2.7499999999999982
}
trajectory_point {
  path_point {
792 793 794 795 796
    x: 586348.10228694649
    y: 4140713.7432805803
    theta: 1.3432347176039776
    kappa: -0.0097103844172054758
    s: 13.977061883037086
797 798 799
    dkappa: 0
    ddkappa: 0
  }
800 801
  v: 4.44022403617921
  a: 0.0597759638207932
802 803 804 805
  relative_time: 2.799999999999998
}
trajectory_point {
  path_point {
806 807 808 809 810
    x: 586348.15198659012
    y: 4140713.9597380627
    theta: 1.3411596100910042
    kappa: -0.010205305488196918
    s: 14.199151721328544
811 812 813
    dkappa: 0
    ddkappa: 0
  }
814 815
  v: 4.4434431992771177
  a: 0.068623014021699236
816 817 818 819
  relative_time: 2.8499999999999979
}
trajectory_point {
  path_point {
820 821 822 823 824
    x: 586348.20337573159
    y: 4140714.1759753139
    theta: 1.3387738475244213
    kappa: -0.010555416231317968
    s: 14.421412673937731
825 826 827
    dkappa: 0
    ddkappa: 0
  }
828 829
  v: 4.4470508801954329
  a: 0.075342621065788928
830 831 832 833
  relative_time: 2.8999999999999977
}
trajectory_point {
  path_point {
834 835 836 837 838
    x: 586348.25511774584
    y: 4140714.392322896
    theta: 1.336328121095524
    kappa: -0.010878615732717176
    s: 14.643861572312796
839 840 841
    dkappa: 0
    ddkappa: 0
  }
842 843
  v: 4.450944598440624
  a: 0.080090451525512307
844 845
  relative_time: 2.9499999999999975
}
846 847
trajectory_point {
  path_point {
848 849 850 851 852
    x: 586348.30690624483
    y: 4140714.6088648448
    theta: 1.3338801928757875
    kappa: -0.011202105596086791
    s: 14.866510318460421
853 854 855
    dkappa: 0
    ddkappa: 0
  }
856 857
  v: 4.4550296568477856
  a: 0.083022171973319292
858 859 860 861
  relative_time: 2.9999999999999973
}
trajectory_point {
  path_point {
862 863 864 865 866
    x: 586348.35874294117
    y: 4140714.8256083191
    theta: 1.3314300112923176
    kappa: -0.011525896517402469
    s: 15.089366274112262
867 868 869
    dkappa: 0
    ddkappa: 0
  }
870 871
  v: 4.4592191415806317
  a: 0.084293448981659913
872 873 874 875
  relative_time: 3.0499999999999972
}
trajectory_point {
  path_point {
876 877 878 879 880
    x: 586348.41250785918
    y: 4140715.0420968449
    theta: 1.3288134313898206
    kappa: -0.011661009443861725
    s: 15.312432649891377
881 882 883
    dkappa: 0
    ddkappa: 0
  }
884 885
  v: 4.4634339221315011
  a: 0.0840599491229842
886 887 888 889
  relative_time: 3.099999999999997
}
trajectory_point {
  path_point {
890 891 892 893 894
    x: 586348.46665503038
    y: 4140715.2587079369
    theta: 1.3261653886530853
    kappa: -0.011762896188636565
    s: 15.535708894478656
895 896 897
    dkappa: 0
    ddkappa: 0
  }
898 899
  v: 4.4676026513213536
  a: 0.082477338969742076
900 901 902 903
  relative_time: 3.1499999999999968
}
trajectory_point {
  path_point {
904 905 906 907 908
    x: 586348.52085214551
    y: 4140715.4755188264
    theta: 1.3235148982083098
    kappa: -0.011864876911328679
    s: 15.75919108377925
909 910 911
    dkappa: 0
    ddkappa: 0
  }
912 913
  v: 4.471661765299773
  a: 0.079701285094383456
914 915 916 917
  relative_time: 3.1999999999999966
}
trajectory_point {
  path_point {
918 919 920 921 922
    x: 586348.57509752968
    y: 4140715.6925228108
    theta: 1.3208620792552925
    kappa: -0.011966948459773398
    s: 15.982872310089006
923 924 925
    dkappa: 0
    ddkappa: 0
  }
926 927
  v: 4.4755554835449649
  a: 0.075887454069358484
928 929 930 931
  relative_time: 3.2499999999999964
}
trajectory_point {
  path_point {
932 933 934 935 936
    x: 586348.6313967302
    y: 4140715.90919743
    theta: 1.3182310503251367
    kappa: -0.011829966029733376
    s: 16.2067430712609
937 938 939
    dkappa: 0
    ddkappa: 0
  }
940 941
  v: 4.4792358088637556
  a: 0.071191512467116969
942 943 944 945
  relative_time: 3.2999999999999963
}
trajectory_point {
  path_point {
946 947 948 949 950
    x: 586348.68803397147
    y: 4140716.1259691836
    theta: 1.31560140191214
    kappa: -0.011657939517895203
    s: 16.43079165987146
951 952 953
    dkappa: 0
    ddkappa: 0
  }
954 955
  v: 4.4826625273915965
  a: 0.06576912686010894
956 957 958 959
  relative_time: 3.3499999999999961
}
trajectory_point {
  path_point {
960 961 962 963 964
    x: 586348.74471274728
    y: 4140716.3428999037
    theta: 1.3129698210366241
    kappa: -0.011485786852047913
    s: 16.655004552387204
965 966 967
    dkappa: 0
    ddkappa: 0
  }
968 969
  v: 4.4858032085925608
  a: 0.059775963820784428
970 971 972 973
  relative_time: 3.3999999999999959
}
trajectory_point {
  path_point {
974 975 976 977 978
    x: 586348.8014292781
    y: 4140716.5599751272
    theta: 1.3103365196472059
    kappa: -0.011313519511301615
    s: 16.879366798331073
979 980 981
    dkappa: 0
    ddkappa: 0
  }
982 983
  v: 4.4886332052593438
  a: 0.053367689921593242
984 985 986 987
  relative_time: 3.4499999999999957
}
trajectory_point {
  path_point {
988 989 990 991 992
    x: 586348.86012757686
    y: 4140716.7766601024
    theta: 1.3079683084248819
    kappa: -0.010844869901120392
    s: 17.103862409448851
993 994 995
    dkappa: 0
    ddkappa: 0
  }
996 997
  v: 4.4911356535132638
  a: 0.046699971734985524
998 999 1000 1001
  relative_time: 3.4999999999999956
}
trajectory_point {
  path_point {
1002 1003 1004 1005 1006
    x: 586348.91905327584
    y: 4140716.9934052639
    theta: 1.3056257866089336
    kappa: -0.010346033163037713
    s: 17.32847474887561
1007 1008 1009
    dkappa: 0
    ddkappa: 0
  }
1010 1011
  v: 4.49330147280426
  a: 0.039928475833411192
1012 1013 1014 1015
  relative_time: 3.5499999999999954
}
trajectory_point {
  path_point {
1016 1017 1018 1019 1020
    x: 586348.97800516535
    y: 4140717.2102467604
    theta: 1.3032822218244795
    kappa: -0.0098469747102031
    s: 17.553186920302132
1021 1022 1023
    dkappa: 0
    ddkappa: 0
  }
1024 1025
  v: 4.4951293659108957
  a: 0.033208868789320389
1026 1027 1028 1029
  relative_time: 3.5999999999999952
}
trajectory_point {
  path_point {
1030 1031 1032 1033 1034
    x: 586349.03697884653
    y: 4140717.4271684135
    theta: 1.3009378146876369
    kappa: -0.00934773177917099
    s: 17.777982157141341
1035 1036 1037
    dkappa: 0
    ddkappa: 0
  }
1038 1039
  v: 4.4966258189403572
  a: 0.026696817175162924
1040 1041 1042 1043
  relative_time: 3.649999999999995
}
trajectory_point {
  path_point {
1044 1045 1046 1047 1048
    x: 586349.09768494009
    y: 4140717.6436806722
    theta: 1.2991029262793754
    kappa: -0.0087264036074656583
    s: 18.00284421169474
1049 1050 1051
    dkappa: 0
    ddkappa: 0
  }
1052 1053
  v: 4.4978051013284519
  a: 0.020547987563388603
1054 1055 1056 1057
  relative_time: 3.6999999999999948
}
trajectory_point {
  path_point {
1058 1059 1060 1061 1062
    x: 586349.15848939749
    y: 4140717.8602191559
    theta: 1.2972927356364254
    kappa: -0.0080989272197250911
    s: 18.227757744318829
1063 1064 1065
    dkappa: 0
    ddkappa: 0
  }
1066 1067
  v: 4.4986892658396105
  a: 0.014918046526448347
1068 1069 1070 1071
  relative_time: 3.7499999999999947
}
trajectory_point {
  path_point {
1072 1073 1074 1075 1076
    x: 586349.21930397535
    y: 4140718.0767936818
    theta: 1.2954822434304492
    kappa: -0.0074713463919123362
    s: 18.452708712591562
1077 1078 1079
    dkappa: 0
    ddkappa: 0
  }
1080 1081
  v: 4.4993081485668851
  a: 0.0099626606367908543
1082 1083 1084 1085
  relative_time: 3.7999999999999945
}
trajectory_point {
  path_point {
1086 1087 1088 1089 1090
    x: 586349.28012870578
    y: 4140718.2933913954
    theta: 1.2936728721054096
    kappa: -0.0068439535526178532
    s: 18.677684760478744
1091 1092 1093
    dkappa: 0
    ddkappa: 0
  }
1094 1095
  v: 4.4996993689319513
  a: 0.0058374964668665985
1096 1097 1098 1099
  relative_time: 3.8499999999999943
}
trajectory_point {
  path_point {
1100 1101 1102 1103 1104
    x: 586349.34227057407
    y: 4140718.5096303131
    theta: 1.2923739090065554
    kappa: -0.0063169616613439278
    s: 18.902675607500484
1105 1106 1107
    dkappa: 0
    ddkappa: 0
  }
1108 1109
  v: 4.4999083296851081
  a: 0.0026982205891253885
1110 1111 1112 1113
  relative_time: 3.8999999999999941
}
trajectory_point {
  path_point {
1114 1115 1116 1117 1118
    x: 586349.40441437112
    y: 4140718.725875942
    theta: 1.2910749013284306
    kappa: -0.0057899534130392092
    s: 19.127673437897631
1119 1120 1121
    dkappa: 0
    ddkappa: 0
  }
1122 1123
  v: 4.4999882169052743
  a: 0.0007004995760183097
1124 1125 1126 1127
  relative_time: 3.949999999999994
}
trajectory_point {
  path_point {
1128 1129 1130 1131 1132
    x: 586349.4665587265
    y: 4140718.9421235146
    theta: 1.2897758821017249
    kappa: -0.005262940429804526
    s: 19.352673289798183
1133 1134 1135
    dkappa: 0
    ddkappa: 0
  }
1136 1137
  v: 4.4999999999999947
  a: -6.3282712403633923e-15
1138 1139 1140 1141
  relative_time: 3.9999999999999938
}
trajectory_point {
  path_point {
1142 1143 1144 1145 1146
    x: 586349.52875212324
    y: 4140719.1583570344
    theta: 1.2884996205262074
    kappa: -0.0047407999474843388
    s: 19.577673289798177
1147 1148 1149
    dkappa: 0
    ddkappa: 0
  }
1150 1151
  v: 4.4999999999999964
  a: -6.4105240437130673e-15
1152 1153 1154 1155
  relative_time: 4.0499999999999936
}
trajectory_point {
  path_point {
1156 1157 1158 1159 1160
    x: 586349.59181538643
    y: 4140719.3743385728
    theta: 1.2876272952489816
    kappa: -0.0043051633167532658
    s: 19.802673289798179
1161 1162 1163
    dkappa: 0
    ddkappa: 0
  }
1164 1165
  v: 4.4999999999999956
  a: -5.7367122329564153e-15
1166 1167 1168 1169
  relative_time: 4.0999999999999934
}
trajectory_point {
  path_point {
1170 1171 1172 1173 1174
    x: 586349.65487864986
    y: 4140719.5903201103
    theta: 1.2867549687487287
    kappa: -0.0038695266860222
    s: 20.027673289798177
1175 1176 1177
    dkappa: 0
    ddkappa: 0
  }
1178 1179
  v: 4.4999999999999956
  a: -5.1009734838493792e-15
1180 1181 1182 1183
  relative_time: 4.1499999999999932
}
trajectory_point {
  path_point {
1184 1185 1186 1187 1188
    x: 586349.717941913
    y: 4140719.8063016487
    theta: 1.2858826423530469
    kappa: -0.0034338900552911339
    s: 20.252673289798174
1189 1190 1191
    dkappa: 0
    ddkappa: 0
  }
1192 1193
  v: 4.4999999999999956
  a: -4.5023864665370332e-15
1194 1195 1196 1197
  relative_time: 4.1999999999999931
}
trajectory_point {
  path_point {
1198 1199 1200 1201 1202
    x: 586349.78106721467
    y: 4140720.02226498
    theta: 1.2850468974281826
    kappa: -0.0030067701975387282
    s: 20.477673289798176
1203 1204 1205
    dkappa: 0
    ddkappa: 0
  }
1206 1207
  v: 4.4999999999999947
  a: -3.9400298511644544e-15
1208 1209 1210 1211
  relative_time: 4.2499999999999929
}
trajectory_point {
  path_point {
1212 1213 1214 1215 1216
    x: 586349.84472581407
    y: 4140720.2380717974
    theta: 1.2845256053249463
    kappa: -0.0026528628574214838
    s: 20.702673289798174
1217 1218 1219
    dkappa: 0
    ddkappa: 0
  }
1220 1221
  v: 4.4999999999999947
  a: -3.4129823078767178e-15
1222 1223 1224 1225
  relative_time: 4.2999999999999927
}
trajectory_point {
  path_point {
1226 1227 1228 1229 1230
    x: 586349.90838441346
    y: 4140720.453878616
    theta: 1.2840043129751342
    kappa: -0.002298955517304239
    s: 20.927673289798172
1231 1232 1233
    dkappa: 0
    ddkappa: 0
  }
1234 1235
  v: 4.4999999999999947
  a: -2.9203225068188991e-15
1236 1237 1238 1239
  relative_time: 4.3499999999999925
}
trajectory_point {
  path_point {
1240 1241 1242 1243 1244
    x: 586349.97204301285
    y: 4140720.6696854341
    theta: 1.283483020662064
    kappa: -0.0019450481771869886
    s: 21.152673289798173
1245 1246 1247
    dkappa: 0
    ddkappa: 0
  }
1248 1249
  v: 4.4999999999999947
  a: -2.4611291181360731e-15
1250 1251 1252 1253
  relative_time: 4.3999999999999924
}
trajectory_point {
  path_point {
1254 1255 1256 1257 1258
    x: 586350.035750427
    y: 4140720.8854778139
    theta: 1.2830052698808307
    kappa: -0.0016023755152602933
    s: 21.377673289798171
1259 1260 1261
    dkappa: 0
    ddkappa: 0
  }
1262 1263
  v: 4.4999999999999947
  a: -2.0344808119733164e-15
1264 1265 1266 1267
  relative_time: 4.4499999999999922
}
trajectory_point {
  path_point {
1268 1269 1270 1271 1272
    x: 586350.09972363082
    y: 4140721.1011915803
    theta: 1.2827645957698737
    kappa: -0.0013208742796852542
    s: 21.602673289798169
1273 1274 1275
    dkappa: 0
    ddkappa: 0
  }
1276 1277
  v: 4.4999999999999947
  a: -1.6394562584757037e-15
1278 1279 1280 1281
  relative_time: 4.499999999999992
}
trajectory_point {
  path_point {
1282 1283 1284 1285 1286
    x: 586350.16369683482
    y: 4140721.3169053476
    theta: 1.2825239216360722
    kappa: -0.0010393730441102104
    s: 21.82767328979817
1287 1288 1289
    dkappa: 0
    ddkappa: 0
  }
1290 1291
  v: 4.4999999999999947
  a: -1.2751341277883108e-15
1292 1293 1294 1295
  relative_time: 4.5499999999999918
}
trajectory_point {
  path_point {
1296 1297 1298 1299 1300
    x: 586350.22767003858
    y: 4140721.5326191145
    theta: 1.2822832475073083
    kappa: -0.00075787180853517113
    s: 22.052673289798168
1301 1302 1303
    dkappa: 0
    ddkappa: 0
  }
1304 1305
  v: 4.4999999999999947
  a: -9.4059309005621344e-16
1306 1307 1308 1309
  relative_time: 4.5999999999999917
}
trajectory_point {
  path_point {
1310 1311 1312 1313 1314
    x: 586350.29166538944
    y: 4140721.7483263072
    theta: 1.2820882466680064
    kappa: -0.00048934690596353
    s: 22.277673289798166
1315 1316 1317
    dkappa: 0
    ddkappa: 0
  }
1318 1319
  v: 4.4999999999999947
  a: -6.349118154244872e-16
1320 1321 1322 1323
  relative_time: 4.6499999999999915
}
trajectory_point {
  path_point {
1324 1325 1326 1327 1328
    x: 586350.35574600939
    y: 4140721.9640081888
    theta: 1.2820690949573084
    kappa: -0.00027078289448198431
    s: 22.502673289798164
1329 1330 1331
    dkappa: 0
    ddkappa: 0
  }
1332 1333
  v: 4.4999999999999938
  a: -3.57168974038207e-16
1334 1335 1336 1337
  relative_time: 4.6999999999999913
}
trajectory_point {
  path_point {
1338 1339 1340 1341 1342
    x: 586350.41982662934
    y: 4140722.1796900705
    theta: 1.2820499432465993
    kappa: -5.2218883000435147e-05
    s: 22.727673289798165
1343 1344 1345
    dkappa: 0
    ddkappa: 0
  }
1346 1347
  v: 4.4999999999999938
  a: -1.0644323604244933e-16
1348 1349 1350 1351
  relative_time: 4.7499999999999911
}
trajectory_point {
  path_point {
1352 1353 1354 1355 1356
    x: 586350.48390724929
    y: 4140722.3953719526
    theta: 1.2820307915358937
    kappa: 0.00016634512848111044
    s: 22.952673289798163
1357 1358 1359
    dkappa: 0
    ddkappa: 0
  }
1360 1361
  v: 4.4999999999999938
  a: 1.1818672841771251e-16
1362 1363 1364 1365
  relative_time: 4.7999999999999909
}
trajectory_point {
  path_point {
1366 1367 1368 1369 1370
    x: 586350.54797322163
    y: 4140722.6110581839
    theta: 1.2820555129712896
    kappa: 0.00037101322384978876
    s: 23.177673289798161
1371 1372 1373
    dkappa: 0
    ddkappa: 0
  }
1374 1375
  v: 4.4999999999999938
  a: 3.176422491971989e-16
1376 1377 1378 1379
  relative_time: 4.8499999999999908
}
trajectory_point {
  path_point {
1380 1381 1382 1383 1384
    x: 586350.611996896
    y: 4140722.826756977
    theta: 1.2822069277375869
    kappa: 0.00053555381603878779
    s: 23.402673289798159
1385 1386 1387
    dkappa: 0
    ddkappa: 0
  }
1388 1389
  v: 4.4999999999999947
  a: 4.9284465615093809e-16
1390 1391 1392 1393
  relative_time: 4.8999999999999906
}
trajectory_point {
  path_point {
1394 1395 1396 1397 1398
    x: 586350.67602057022
    y: 4140723.0424557691
    theta: 1.2823583425088643
    kappa: 0.00070009440822778942
    s: 23.62767328979816
1399 1400 1401
    dkappa: 0
    ddkappa: 0
  }
1402 1403
  v: 4.4999999999999947
  a: 6.44715279133852e-16
1404 1405 1406 1407
  relative_time: 4.94999999999999
}
trajectory_point {
  path_point {
1408 1409 1410 1411 1412
    x: 586350.74004424445
    y: 4140723.2581545622
    theta: 1.2825097572781785
    kappa: 0.00086463500041678845
    s: 23.852673289798158
1413 1414 1415
    dkappa: 0
    ddkappa: 0
  }
1416 1417
  v: 4.4999999999999947
  a: 7.7417544800086743e-16
1418 1419 1420 1421
  relative_time: 4.99999999999999
}
trajectory_point {
  path_point {
1422 1423 1424 1425 1426
    x: 586350.80401038134
    y: 4140723.4738704059
    theta: 1.2826995388022415
    kappa: 0.0010149555943031016
    s: 24.077673289798156
1427 1428 1429
    dkappa: 0
    ddkappa: 0
  }
1430 1431
  v: 4.4999999999999947
  a: 8.821464926069078e-16
1432 1433 1434 1435
  relative_time: 5.04999999999999
}
trajectory_point {
  path_point {
1436 1437 1438 1439 1440
    x: 586350.86784739117
    y: 4140723.6896245158
    theta: 1.2829754243661913
    kappa: 0.001133363181028024
    s: 24.302673289798157
1441 1442 1443
    dkappa: 0
    ddkappa: 0
  }
1444 1445
  v: 4.4999999999999947
  a: 9.6954974280689667e-16
1446 1447 1448 1449
  relative_time: 5.09999999999999
}
trajectory_point {
  path_point {
1450 1451 1452 1453 1454
    x: 586350.93168440089
    y: 4140723.9053786267
    theta: 1.2832513099581229
    kappa: 0.0012517707677529447
    s: 24.527673289798155
1455 1456 1457
    dkappa: 0
    ddkappa: 0
  }
1458 1459
  v: 4.4999999999999947
  a: 1.0373065284557591e-15
1460 1461 1462 1463
  relative_time: 5.14999999999999
}
trajectory_point {
  path_point {
1464 1465 1466 1467 1468
    x: 586350.99552141072
    y: 4140724.121132737
    theta: 1.2835271955360394
    kappa: 0.0013701783544778656
    s: 24.752673289798153
1469 1470 1471
    dkappa: 0
    ddkappa: 0
  }
1472 1473
  v: 4.4999999999999947
  a: 1.0863381794084203e-15
1474 1475 1476 1477
  relative_time: 5.1999999999999895
}
trajectory_point {
  path_point {
1478 1479 1480 1481 1482
    x: 586351.05925969
    y: 4140724.3369159913
    theta: 1.2838342641107188
    kappa: 0.0014744544345517991
    s: 24.977673289798155
1483 1484 1485
    dkappa: 0
    ddkappa: 0
  }
1486 1487
  v: 4.4999999999999947
  a: 1.1175660255198069e-15
1488 1489 1490 1491
  relative_time: 5.2499999999999893
}
trajectory_point {
  path_point {
1492 1493 1494 1495 1496
    x: 586351.122821833
    y: 4140724.5527512389
    theta: 1.2841969636087915
    kappa: 0.0015535197745946288
    s: 25.202673289798152
1497 1498 1499
    dkappa: 0
    ddkappa: 0
  }
1500 1501
  v: 4.4999999999999947
  a: 1.1319113966448362e-15
1502 1503 1504 1505
  relative_time: 5.2999999999999892
}
trajectory_point {
  path_point {
1506 1507 1508 1509 1510
    x: 586351.186383976
    y: 4140724.7685864856
    theta: 1.2845596631655873
    kappa: 0.0016325851146374586
    s: 25.42767328979815
1511 1512 1513
    dkappa: 0
    ddkappa: 0
  }
1514 1515
  v: 4.4999999999999947
  a: 1.1302956226384394e-15
1516 1517 1518 1519
  relative_time: 5.349999999999989
}
trajectory_point {
  path_point {
1520 1521 1522 1523 1524
    x: 586351.24994611915
    y: 4140724.9844217333
    theta: 1.2849223626856796
    kappa: 0.0017116504546802896
    s: 25.652673289798152
1525 1526 1527
    dkappa: 0
    ddkappa: 0
  }
1528 1529
  v: 4.4999999999999947
  a: 1.1136400333555355e-15
1530 1531 1532 1533
  relative_time: 5.3999999999999888
}
trajectory_point {
  path_point {
1534 1535 1536 1537 1538
    x: 586351.31337122142
    y: 4140725.2002972229
    theta: 1.2853074735218961
    kappa: 0.0017766833044821344
    s: 25.87767328979815
1539 1540 1541
    dkappa: 0
    ddkappa: 0
  }
1542 1543
  v: 4.4999999999999947
  a: 1.0828659586510559e-15
1544 1545 1546 1547
  relative_time: 5.4499999999999886
}
trajectory_point {
  path_point {
1548 1549 1550 1551 1552
    x: 586351.37659916468
    y: 4140725.4162306087
    theta: 1.2857248275281963
    kappa: 0.001821527777655397
    s: 26.102673289798147
1553 1554 1555
    dkappa: 0
    ddkappa: 0
  }
1556 1557
  v: 4.4999999999999947
  a: 1.0388947283799208e-15
1558 1559 1560 1561
  relative_time: 5.4999999999999885
}
trajectory_point {
  path_point {
1562 1563 1564 1565 1566
    x: 586351.439827108
    y: 4140725.6321639949
    theta: 1.2861421816165801
    kappa: 0.0018663722508286606
    s: 26.327673289798149
1567 1568 1569
    dkappa: 0
    ddkappa: 0
  }
1570 1571
  v: 4.4999999999999947
  a: 9.82647672397054e-16
1572 1573 1574 1575
  relative_time: 5.5499999999999883
}
trajectory_point {
  path_point {
1576 1577 1578 1579 1580
    x: 586351.50305505132
    y: 4140725.8480973812
    theta: 1.2865595356416544
    kappa: 0.0019112167240019232
    s: 26.552673289798147
1581 1582 1583
    dkappa: 0
    ddkappa: 0
  }
1584 1585
  v: 4.4999999999999947
  a: 9.1504612055738353e-16
1586 1587 1588 1589
  relative_time: 5.5999999999999881
}
trajectory_point {
  path_point {
1590 1591 1592 1593 1594
    x: 586351.56611240737
    y: 4140726.0640805587
    theta: 1.2869893278418851
    kappa: 0.0019416905902012093
    s: 26.777673289798145
1595 1596 1597
    dkappa: 0
    ddkappa: 0
  }
1598 1599
  v: 4.4999999999999947
  a: 8.3701140271582989e-16
1600 1601 1602 1603
  relative_time: 5.6499999999999879
}
trajectory_point {
  path_point {
1604 1605 1606 1607 1608
    x: 586351.62897016713
    y: 4140726.2801219942
    theta: 1.2874336737159111
    kappa: 0.0019553500720780772
    s: 27.002673289798143
1609 1610 1611
    dkappa: 0
    ddkappa: 0
  }
1612 1613
  v: 4.4999999999999947
  a: 7.4946484872731657e-16
1614 1615 1616 1617
  relative_time: 5.6999999999999877
}
trajectory_point {
  path_point {
1618 1619 1620 1621 1622
    x: 586351.691827927
    y: 4140726.4961634306
    theta: 1.2878780196800996
    kappa: 0.0019690095539549451
    s: 27.227673289798144
1623 1624 1625
    dkappa: 0
    ddkappa: 0
  }
1626 1627
  v: 4.4999999999999947
  a: 6.5332778844677184e-16
1628 1629 1630 1631
  relative_time: 5.7499999999999876
}
trajectory_point {
  path_point {
1632 1633 1634 1635 1636
    x: 586351.75468568678
    y: 4140726.7122048661
    theta: 1.2883223655589844
    kappa: 0.001982669035831813
    s: 27.452673289798142
1637 1638 1639
    dkappa: 0
    ddkappa: 0
  }
1640 1641
  v: 4.4999999999999947
  a: 5.495215517291208e-16
1642 1643 1644 1645
  relative_time: 5.7999999999999874
}
trajectory_point {
  path_point {
1646 1647 1648 1649 1650
    x: 586351.81734882074
    y: 4140726.928302743
    theta: 1.2887659749722158
    kappa: 0.0019810972068921837
    s: 27.67767328979814
1651 1652 1653
    dkappa: 0
    ddkappa: 0
  }
1654 1655
  v: 4.4999999999999947
  a: 4.38967468429287e-16
1656 1657 1658 1659
  relative_time: 5.8499999999999872
}
trajectory_point {
  path_point {
1660 1661 1662 1663 1664
    x: 586351.87982607458
    y: 4140727.1444545249
    theta: 1.2892088813480531
    kappa: 0.0019649784925962182
    s: 27.902673289798138
1665 1666 1667
    dkappa: 0
    ddkappa: 0
  }
1668 1669
  v: 4.4999999999999947
  a: 3.2258686840219236e-16
1670 1671 1672 1673
  relative_time: 5.899999999999987
}
trajectory_point {
  path_point {
1674 1675 1676 1677 1678
    x: 586351.94230332831
    y: 4140727.3606063067
    theta: 1.2896517878043789
    kappa: 0.0019488597783002518
    s: 28.127673289798139
1679 1680 1681
    dkappa: 0
    ddkappa: 0
  }
1682 1683
  v: 4.4999999999999956
  a: 2.0130108150276517e-16
1684 1685 1686 1687
  relative_time: 5.9499999999999869
}
trajectory_point {
  path_point {
1688 1689 1690 1691 1692
    x: 586352.00478058215
    y: 4140727.5767580885
    theta: 1.2900946941674267
    kappa: 0.001932741064004286
    s: 28.352673289798137
1693 1694 1695
    dkappa: 0
    ddkappa: 0
  }
1696 1697
  v: 4.4999999999999956
  a: 7.6031437585927377e-17
1698 1699
  relative_time: 5.9999999999999867
}
1700 1701
trajectory_point {
  path_point {
1702 1703 1704 1705 1706
    x: 586352.06705097691
    y: 4140727.7929694704
    theta: 1.2905220677593847
    kappa: 0.0019000344607789431
    s: 28.577673289798135
1707 1708 1709
    dkappa: 0
    ddkappa: 0
  }
1710 1711
  v: 4.4999999999999956
  a: -5.2300733493403809e-17
1712 1713 1714 1715
  relative_time: 6.0499999999999865
}
trajectory_point {
  path_point {
1716 1717 1718 1719 1720
    x: 586352.129160227
    y: 4140728.0092272824
    theta: 1.2909373414775809
    kappa: 0.0018544057659473467
    s: 28.802673289798136
1721 1722 1723
    dkappa: 0
    ddkappa: 0
  }
1724 1725
  v: 4.4999999999999956
  a: -1.8277410188029223e-16
1726 1727 1728 1729
  relative_time: 6.0999999999999863
}
trajectory_point {
  path_point {
1730 1731 1732 1733 1734
    x: 586352.1912694769
    y: 4140728.2254850939
    theta: 1.2913526152548715
    kappa: 0.001808777071115751
    s: 29.027673289798134
1735 1736 1737
    dkappa: 0
    ddkappa: 0
  }
1738 1739
  v: 4.4999999999999947
  a: -3.1446733771981436e-16
1740 1741 1742 1743
  relative_time: 6.1499999999999861
}
trajectory_point {
  path_point {
1744 1745 1746 1747 1748
    x: 586352.253378727
    y: 4140728.4417429054
    theta: 1.2917678889480273
    kappa: 0.0017631483762841551
    s: 29.252673289798132
1749 1750 1751
    dkappa: 0
    ddkappa: 0
  }
1752 1753
  v: 4.4999999999999947
  a: -4.46459111157049e-16
1754 1755 1756 1757
  relative_time: 6.199999999999986
}
trajectory_point {
  path_point {
1758 1759 1760 1761 1762
    x: 586352.31528653041
    y: 4140728.6580584068
    theta: 1.2921387047329411
    kappa: 0.0016679490359985975
    s: 29.477673289798133
1763 1764 1765
    dkappa: 0
    ddkappa: 0
  }
1766 1767
  v: 4.4999999999999947
  a: -5.778280923370743e-16
1768 1769 1770 1771
  relative_time: 6.2499999999999858
}
trajectory_point {
  path_point {
1772 1773 1774 1775 1776
    x: 586352.3770670041
    y: 4140728.8744103722
    theta: 1.2924814198361181
    kappa: 0.0015414172003367474
    s: 29.702673289798131
1777 1778 1779
    dkappa: 0
    ddkappa: 0
  }
1780 1781
  v: 4.4999999999999947
  a: -7.0765295140496032e-16
1782 1783 1784 1785
  relative_time: 6.2999999999999856
}
trajectory_point {
  path_point {
1786 1787 1788 1789 1790
    x: 586352.43884747755
    y: 4140729.0907623386
    theta: 1.2928241349684355
    kappa: 0.0014148853646748973
    s: 29.927673289798129
1791 1792 1793
    dkappa: 0
    ddkappa: 0
  }
1794 1795
  v: 4.4999999999999947
  a: -8.3501235850578435e-16
1796 1797 1798 1799
  relative_time: 6.3499999999999854
}
trajectory_point {
  path_point {
1800 1801 1802 1803 1804
    x: 586352.50062795111
    y: 4140729.3071143036
    theta: 1.2931668500493874
    kappa: 0.0012883535290130449
    s: 30.15267328979813
1805 1806 1807
    dkappa: 0
    ddkappa: 0
  }
1808 1809
  v: 4.4999999999999947
  a: -9.5898498378463074e-16
1810 1811 1812 1813
  relative_time: 6.3999999999999853
}
trajectory_point {
  path_point {
1814 1815 1816 1817 1818
    x: 586352.562249588
    y: 4140729.5235115308
    theta: 1.2934275894690563
    kappa: 0.0011566339172740224
    s: 30.377673289798128
1819 1820 1821
    dkappa: 0
    ddkappa: 0
  }
1822 1823
  v: 4.4999999999999947
  a: -1.0786494973865602e-15
1824 1825 1826 1827
  relative_time: 6.4499999999999851
}
trajectory_point {
  path_point {
1828 1829 1830 1831 1832
    x: 586352.62379061466
    y: 4140729.7399317292
    theta: 1.2936467260721991
    kappa: 0.0010222814947404477
    s: 30.602673289798126
1833 1834 1835
    dkappa: 0
    ddkappa: 0
  }
1836 1837
  v: 4.4999999999999947
  a: -1.1930845694566618e-15
1838 1839 1840 1841
  relative_time: 6.4999999999999849
}
trajectory_point {
  path_point {
1842 1843 1844 1845 1846
    x: 586352.68533164146
    y: 4140729.9563519275
    theta: 1.2938658626818937
    kappa: 0.00088792907220687045
    s: 30.827673289798128
1847 1848 1849
    dkappa: 0
    ddkappa: 0
  }
1850 1851
  v: 4.4999999999999947
  a: -1.3013688701399979e-15
1852 1853 1854 1855
  relative_time: 6.5499999999999847
}
trajectory_point {
  path_point {
1856 1857 1858 1859 1860
    x: 586352.74687266815
    y: 4140730.1727721249
    theta: 1.2940849992770942
    kappa: 0.00075357664967329752
    s: 31.052673289798122
1861 1862 1863
    dkappa: 0
    ddkappa: 0
  }
1864 1865
  v: 4.4999999999999947
  a: -1.4025810695816535e-15
1866 1867 1868 1869
  relative_time: 6.5999999999999845
}
trajectory_point {
  path_point {
1870 1871 1872 1873 1874
    x: 586352.80831491284
    y: 4140730.3892203779
    theta: 1.2942264669780106
    kappa: 0.00063747784874315964
    s: 31.277673289798123
1875 1876 1877
    dkappa: 0
    ddkappa: 0
  }
1878 1879
  v: 4.4999999999999947
  a: -1.4957998379266972e-15
1880 1881 1882 1883
  relative_time: 6.6499999999999844
}
trajectory_point {
  path_point {
1884 1885 1886 1887 1888
    x: 586352.86971759645
    y: 4140730.6056798669
    theta: 1.2943368291077351
    kappa: 0.000528689432801185
    s: 31.502673289798125
1889 1890 1891
    dkappa: 0
    ddkappa: 0
  }
1892 1893
  v: 4.4999999999999947
  a: -1.5801038453202135e-15
1894 1895 1896 1897
  relative_time: 6.6999999999999842
}
trajectory_point {
  path_point {
1898 1899 1900 1901 1902
    x: 586352.93112028
    y: 4140730.8221393568
    theta: 1.2944471912381599
    kappa: 0.000419901016859214
    s: 31.727673289798119
1903 1904 1905
    dkappa: 0
    ddkappa: 0
  }
1906 1907
  v: 4.4999999999999947
  a: -1.6545717619072764e-15
1908 1909 1910 1911
  relative_time: 6.749999999999984
}
trajectory_point {
  path_point {
1912 1913 1914 1915 1916
    x: 586352.99252296356
    y: 4140731.0385988457
    theta: 1.2945575533665972
    kappa: 0.00031111260091723947
    s: 31.95267328979812
1917 1918 1919
    dkappa: 0
    ddkappa: 0
  }
1920 1921
  v: 4.4999999999999947
  a: -1.7182822578329498e-15
1922 1923 1924 1925
  relative_time: 6.7999999999999838
}
trajectory_point {
  path_point {
1926 1927 1928 1929 1930
    x: 586353.05387935659
    y: 4140731.2550714589
    theta: 1.2946055761417516
    kappa: 0.00023003400312390405
    s: 32.177673289798122
1931 1932 1933
    dkappa: 0
    ddkappa: 0
  }
1934 1935
  v: 4.4999999999999947
  a: -1.7703140032423266e-15
1936 1937 1938 1939
  relative_time: 6.8499999999999837
}
trajectory_point {
  path_point {
1940 1941 1942 1943 1944
    x: 586353.115221512
    y: 4140731.4715481084
    theta: 1.2946344252055297
    kappa: 0.00015747811289550207
    s: 32.402673289798116
1945 1946 1947
    dkappa: 0
    ddkappa: 0
  }
1948 1949
  v: 4.4999999999999938
  a: -1.8097456682804685e-15
1950 1951 1952 1953
  relative_time: 6.8999999999999835
}
trajectory_point {
  path_point {
1954 1955 1956 1957 1958
    x: 586353.1765636676
    y: 4140731.6880247588
    theta: 1.294663274269318
    kappa: 8.49222226670978e-05
    s: 32.627673289798118
1959 1960 1961
    dkappa: 0
    ddkappa: 0
  }
1962 1963
  v: 4.4999999999999938
  a: -1.835655923092451e-15
1964 1965 1966 1967
  relative_time: 6.9499999999999833
}
trajectory_point {
  path_point {
1968 1969 1970 1971 1972
    x: 586353.23790582316
    y: 4140731.9045014088
    theta: 1.2946921233330682
    kappa: 1.2366332438693513e-05
    s: 32.852673289798119
1973 1974 1975
    dkappa: 0
    ddkappa: 0
  }
1976 1977
  v: 4.4999999999999938
  a: -1.8471234378233593e-15
1978 1979 1980 1981
  relative_time: 6.9999999999999831
}
trajectory_point {
  path_point {
1982 1983 1984 1985 1986
    x: 586353.29924617161
    y: 4140732.120978571
    theta: 1.2946847633666672
    kappa: -2.1923150755299059e-05
    s: 33.077673289798113
1987 1988 1989
    dkappa: 0
    ddkappa: 0
  }
1990 1991
  v: 4.4999999999999938
  a: -1.8432268826182683e-15
1992 1993 1994 1995
  relative_time: 7.0499999999999829
}
trajectory_point {
  path_point {
1996 1997 1998 1999 2000
    x: 586353.36058611167
    y: 4140732.3374558482
    theta: 1.2946692148176704
    kappa: -4.7558780658687583e-05
    s: 33.302673289798115
2001 2002 2003
    dkappa: 0
    ddkappa: 0
  }
2004 2005
  v: 4.4999999999999938
  a: -1.8230449276222443e-15
2006 2007 2008 2009
  relative_time: 7.0999999999999828
}
trajectory_point {
  path_point {
2010 2011 2012 2013 2014
    x: 586353.42192605149
    y: 4140732.5539331259
    theta: 1.2946536662686725
    kappa: -7.3194410562076108e-05
    s: 33.527673289798116
2015 2016 2017
    dkappa: 0
    ddkappa: 0
  }
2018 2019
  v: 4.4999999999999938
  a: -1.7856562429803684e-15
2020 2021 2022 2023
  relative_time: 7.1499999999999826
}
trajectory_point {
  path_point {
2024 2025 2026 2027 2028
    x: 586353.48326599156
    y: 4140732.7704104036
    theta: 1.2946381177196808
    kappa: -9.8830040465463826e-05
    s: 33.752673289798111
2029 2030 2031
    dkappa: 0
    ddkappa: 0
  }
2032 2033
  v: 4.4999999999999938
  a: -1.73013949883771e-15
2034 2035 2036 2037
  relative_time: 7.1999999999999824
}
trajectory_point {
  path_point {
2038 2039 2040 2041 2042
    x: 586353.54462073918
    y: 4140732.9868834848
    theta: 1.2946243530377921
    kappa: -7.462025196980994e-05
    s: 33.977673289798112
2043 2044 2045
    dkappa: 0
    ddkappa: 0
  }
2046 2047
  v: 4.4999999999999938
  a: -1.6555733653393652e-15
2048 2049 2050 2051
  relative_time: 7.2499999999999822
}
trajectory_point {
  path_point {
2052 2053 2054 2055 2056
    x: 586353.60597777064
    y: 4140733.2033559196
    theta: 1.2946108634909232
    kappa: -4.2722547456042334e-05
    s: 34.202673289798113
2057 2058 2059
    dkappa: 0
    ddkappa: 0
  }
2060 2061
  v: 4.4999999999999938
  a: -1.5610365126303798e-15
2062 2063 2064 2065
  relative_time: 7.2999999999999821
}
trajectory_point {
  path_point {
2066 2067 2068 2069 2070
    x: 586353.66733480222
    y: 4140733.419828353
    theta: 1.2945973739440539
    kappa: -1.0824842942275737e-05
    s: 34.427673289798108
2071 2072 2073
    dkappa: 0
    ddkappa: 0
  }
2074 2075
  v: 4.4999999999999938
  a: -1.4456076108558485e-15
2076 2077 2078 2079
  relative_time: 7.3499999999999819
}
trajectory_point {
  path_point {
2080 2081 2082 2083 2084
    x: 586353.72869183368
    y: 4140733.6363007869
    theta: 1.2945838843971889
    kappa: 2.1072861571491869e-05
    s: 34.652673289798109
2085 2086 2087
    dkappa: 0
    ddkappa: 0
  }
2088 2089
  v: 4.4999999999999938
  a: -1.3083653301608421e-15
2090 2091 2092 2093
  relative_time: 7.3999999999999817
}
trajectory_point {
  path_point {
2094 2095 2096 2097 2098
    x: 586353.7900416872
    y: 4140733.8527752552
    theta: 1.2946235030299782
    kappa: 0.00011543354438639175
    s: 34.877673289798111
2099 2100 2101
    dkappa: 0
    ddkappa: 0
  }
2102 2103
  v: 4.4999999999999929
  a: -1.1483883406904418e-15
2104 2105 2106 2107
  relative_time: 7.4499999999999815
}
trajectory_point {
  path_point {
2108 2109 2110 2111 2112
    x: 586353.85139089276
    y: 4140734.0692499075
    theta: 1.294667916389489
    kappa: 0.00021543352612527736
    s: 35.102673289798105
2113 2114 2115
    dkappa: 0
    ddkappa: 0
  }
2116 2117
  v: 4.4999999999999929
  a: -9.6475531258971318e-16
2118 2119 2120 2121
  relative_time: 7.4999999999999813
}
trajectory_point {
  path_point {
2122 2123 2124 2125 2126
    x: 586353.91274009831
    y: 4140734.28572456
    theta: 1.2947123297490097
    kappa: 0.00031543350786416614
    s: 35.327673289798106
2127 2128 2129
    dkappa: 0
    ddkappa: 0
  }
2130 2131
  v: 4.4999999999999929
  a: -7.5654491600373495e-16
2132 2133 2134 2135
  relative_time: 7.5499999999999812
}
trajectory_point {
  path_point {
2136 2137 2138 2139 2140
    x: 586353.97408930375
    y: 4140734.5021992116
    theta: 1.2947567431083653
    kappa: 0.00041543348960305492
    s: 35.552673289798108
2141 2142 2143
    dkappa: 0
    ddkappa: 0
  }
2144 2145
  v: 4.4999999999999929
  a: -5.2283582107759622e-16
2146 2147 2148 2149
  relative_time: 7.599999999999981
}
trajectory_point {
  path_point {
2150 2151 2152 2153 2154
    x: 586354.03535876237
    y: 4140734.7186964476
    theta: 1.2949035303710472
    kappa: 0.00053496095603129006
    s: 35.7776732897981
2155 2156 2157
    dkappa: 0
    ddkappa: 0
  }
2158 2159
  v: 4.4999999999999929
  a: -2.6270669795634823e-16
2160 2161 2162 2163
  relative_time: 7.6499999999999808
}
trajectory_point {
  path_point {
2164 2165 2166 2167 2168
    x: 586354.09662558488
    y: 4140734.9351944304
    theta: 1.2950537015700649
    kappa: 0.00065513389589685932
    s: 36.002673289798096
2169 2170 2171
    dkappa: 0
    ddkappa: 0
  }
2172 2173
  v: 4.4999999999999929
  a: 2.4763783214920718e-17
2174 2175 2176 2177
  relative_time: 7.6999999999999806
}
trajectory_point {
  path_point {
2178 2179 2180 2181 2182
    x: 586354.1578924075
    y: 4140735.1516924128
    theta: 1.2952038727691273
    kappa: 0.00077530683576243606
    s: 36.227673289798105
2183 2184 2185
    dkappa: 0
    ddkappa: 0
  }
2186 2187
  v: 4.4999999999999929
  a: 3.4049695229114283e-16
2188 2189 2190 2191
  relative_time: 7.7499999999999805
}
trajectory_point {
  path_point {
2192 2193 2194 2195 2196
    x: 586354.21915600379
    y: 4140735.3681913069
    theta: 1.2953557702519414
    kappa: 0.00089486569908085137
    s: 36.4526732897981
2197 2198 2199
    dkappa: 0
    ddkappa: 0
  }
2200 2201
  v: 4.4999999999999929
  a: 6.8541413912721719e-16
2202 2203 2204 2205
  relative_time: 7.79999999999998
}
trajectory_point {
  path_point {
2206 2207 2208 2209 2210
    x: 586354.28025117121
    y: 4140735.5847377931
    theta: 1.2955977920531176
    kappa: 0.000982365520310151
    s: 36.677673289798093
2211 2212 2213
    dkappa: 0
    ddkappa: 0
  }
2214 2215
  v: 4.4999999999999929
  a: 1.0604366735780989e-15
2216 2217 2218 2219
  relative_time: 7.84999999999998
}
trajectory_point {
  path_point {
2220 2221 2222 2223 2224
    x: 586354.34134633862
    y: 4140735.8012842787
    theta: 1.295839813881394
    kappa: 0.0010698653415394561
    s: 36.9026732897981
2225 2226 2227
    dkappa: 0
    ddkappa: 0
  }
2228 2229
  v: 4.4999999999999929
  a: 1.4664858854987004e-15
2230 2231 2232 2233
  relative_time: 7.89999999999998
}
trajectory_point {
  path_point {
2234 2235 2236 2237 2238
    x: 586354.402441506
    y: 4140736.0178307644
    theta: 1.2960818357084176
    kappa: 0.0011573651627687558
    s: 37.127673289798096
2239 2240 2241
    dkappa: 0
    ddkappa: 0
  }
2242 2243
  v: 4.4999999999999938
  a: 1.9044831047439326e-15
2244 2245 2246 2247
  relative_time: 7.94999999999998
}
trajectory_point {
  path_point {
2248 2249 2250 2251 2252
    x: 586354.46352030267
    y: 4140736.2343818592
    theta: 1.2963283456983308
    kappa: 0.0012428116287377027
    s: 37.352673289798091
2253 2254 2255
    dkappa: 0
    ddkappa: 0
  }
2256 2257
  v: 4.4999999999999938
  a: 2.3753496611687458e-15
2258 2259
  relative_time: 7.99999999999998
}
2260 2261 2262
decision {
  main_decision {
    stop {
2263
      reason_code: STOP_REASON_DESTINATION
2264 2265
      reason: "stop by DEST"
      stop_point {
2266 2267
        x: 586366.15991747775
        y: 4140779.3877364951
2268
      }
2269
      stop_heading: 1.3127190859245008
2270 2271 2272
    }
  }
  object_decision {
2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287
    decision {
      id: "3_0"
      perception_id: 3
      object_decision {
        follow {
          distance_s: -22.399999618530273
          fence_point {
            x: 586356.17265400058
            y: 4140742.4606863293
            z: 0
          }
          fence_heading: 1.3046923765517029
        }
      }
    }
2288 2289 2290 2291 2292
    decision {
      id: "DEST"
      perception_id: -1109540454
      object_decision {
        stop {
2293 2294
          reason_code: STOP_REASON_DESTINATION
          distance_s: -3
2295
          stop_point {
2296 2297
            x: 586366.15991747775
            y: 4140779.3877364951
2298
          }
2299
          stop_heading: 1.3127190859245008
2300 2301 2302 2303 2304
        }
      }
    }
  }
}