result_stop_dest_0.pb.txt 47.1 KB
Newer Older
1 2 3 4 5 6 7 8 9 10
header {
  module_name: "planning"
}
is_replan: true
gear: GEAR_DRIVE
trajectory_point {
  path_point {
    x: 586361.375698
    y: 4140761.72259
    theta: 1.2866508336700004
11 12
    kappa: 0.0057515850184131972
    s: 6.9388939039072284e-18
13 14 15
    dkappa: 0
    ddkappa: 0
  }
16 17
  v: 4.4250001907348633
  a: -0.0767818497207001
18 19 20 21
  relative_time: 0
}
trajectory_point {
  path_point {
22 23 24 25 26
    x: 586361.43751383328
    y: 4140761.9349217108
    theta: 1.2882248928094353
    kappa: 0.0080167643456748768
    s: 0.22114690287933558
27 28 29
    dkappa: 0
    ddkappa: 0
  }
30 31
  v: 4.4207338635860829
  a: -0.093829152017882569
32 33 34 35
  relative_time: 0.05
}
trajectory_point {
  path_point {
36 37 38 39 40
    x: 586361.49888394726
    y: 4140762.1471384941
    theta: 1.2902125078575937
    kappa: 0.0097026280395425841
    s: 0.44205928548389228
41 42 43
    dkappa: 0
    ddkappa: 0
  }
44 45
  v: 4.4156214839543368
  a: -0.11062394903937239
46 47 48 49
  relative_time: 0.1
}
trajectory_point {
  path_point {
50 51 52 53 54
    x: 586361.55972844153
    y: 4140762.3592188349
    theta: 1.2924965184026695
    kappa: 0.010853068878461464
    s: 0.66269516082111624
55 56 57
    dkappa: 0
    ddkappa: 0
  }
58 59
  v: 4.409675677103408
  a: -0.12716624078516955
60 61 62 63
  relative_time: 0.15000000000000002
}
trajectory_point {
  path_point {
64 65 66 67 68
    x: 586361.61998996162
    y: 4140762.5711350413
    theta: 1.294968651525463
    kappa: 0.011512027473091697
    s: 0.883013173161643
69 70 71
    dkappa: 0
    ddkappa: 0
  }
72 73
  v: 4.4029090682970811
  a: -0.14345602725527407
74 75 76 77
  relative_time: 0.2
}
trajectory_point {
  path_point {
78 79 80 81 82
    x: 586361.67963176186
    y: 4140762.7828539629
    theta: 1.2975300000973851
    kappa: 0.011723368940540022
    s: 1.1029725980392975
83 84 85
    dkappa: 0
    ddkappa: 0
  }
86 87
  v: 4.3953342827991415
  a: -0.1594933084496859
88 89 90 91
  relative_time: 0.25
}
trajectory_point {
  path_point {
92 93 94 95 96
    x: 586361.7386356002
    y: 4140762.9943377404
    theta: 1.3000911050690056
    kappa: 0.011530463001302695
    s: 1.3225333422510934
97 98 99
    dkappa: 0
    ddkappa: 0
  }
100 101
  v: 4.386963945873374
  a: -0.17527808436840511
102 103 104 105
  relative_time: 0.3
}
trajectory_point {
  path_point {
106 107 108 109 110
    x: 586361.79699981515
    y: 4140763.2055445109
    theta: 1.3025719062205343
    kappa: 0.010976850806491479
    s: 1.5416559438572339
111 112 113
    dkappa: 0
    ddkappa: 0
  }
114 115
  v: 4.3778106827835632
  a: -0.19081035501143165
116 117 118 119
  relative_time: 0.35
}
trajectory_point {
  path_point {
120 121 122 123 124
    x: 586361.85470627318
    y: 4140763.4164375537
    theta: 1.3048860270251088
    kappa: 0.010093564913800297
    s: 1.7603015721811117
125 126 127
    dkappa: 0
    ddkappa: 0
  }
128 129
  v: 4.3678871187934929
  a: -0.20609012037876553
130 131 132 133
  relative_time: 0.39999999999999997
}
trajectory_point {
  path_point {
134 135 136 137 138
    x: 586361.91177469282
    y: 4140763.6269703866
    theta: 1.3069495743318977
    kappa: 0.0089477563794648426
    s: 1.9784320278093086
139 140 141
    dkappa: 0
    ddkappa: 0
  }
142 143
  v: 4.3572058791669477
  a: -0.2211173804704068
144 145 146 147
  relative_time: 0.44999999999999996
}
trajectory_point {
  path_point {
148 149 150 151 152
    x: 586361.968307682
    y: 4140763.837075226
    theta: 1.3087423864786687
    kappa: 0.0076279480537567966
    s: 2.196009742591595
153 154 155
    dkappa: 0
    ddkappa: 0
  }
156 157
  v: 4.3457795891677131
  a: -0.23589213528635536
158 159 160 161
  relative_time: 0.49999999999999994
}
trajectory_point {
  path_point {
162 163 164 165 166
    x: 586362.024354734
    y: 4140764.0466998909
    theta: 1.3102365968856091
    kappa: 0.0061848777502448282
    s: 2.4129977796409312
167 168 169
    dkappa: 0
    ddkappa: 0
  }
170 171
  v: 4.3336208740595739
  a: -0.25041438482661127
172 173 174 175
  relative_time: 0.54999999999999993
}
trajectory_point {
  path_point {
176 177 178 179 180
    x: 586362.0799690159
    y: 4140764.25579214
    theta: 1.3114146106415427
    kappa: 0.0046677702471116479
    s: 2.6293598333334676
181 182 183
    dkappa: 0
    ddkappa: 0
  }
184 185
  v: 4.3207423591063137
  a: -0.26468412909117456
186 187 188 189
  relative_time: 0.6
}
trajectory_point {
  path_point {
190 191 192 193 194
    x: 586362.13520543324
    y: 4140764.4643001538
    theta: 1.3122685390022877
    kappa: 0.0031242547634302976
    s: 2.8450602293085412
195 196 197
    dkappa: 0
    ddkappa: 0
  }
198 199
  v: 4.3071566695717181
  a: -0.2787013680800452
200 201 202 203
  relative_time: 0.65
}
trajectory_point {
  path_point {
204 205 206 207 208
    x: 586362.19011886581
    y: 4140764.672172959
    theta: 1.3127994832139651
    kappa: 0.0016002431420147822
    s: 3.0600639244686807
209 210 211
    dkappa: 0
    ddkappa: 0
  }
212 213
  v: 4.2928764307195708
  a: -0.29246610179322319
214 215 216 217
  relative_time: 0.70000000000000007
}
trajectory_point {
  path_point {
218 219 220 221 222
    x: 586362.24476264929
    y: 4140764.8793607885
    theta: 1.3129854414893747
    kappa: 0.00015319934257204256
    s: 3.2743365069796022
223 224 225
    dkappa: 0
    ddkappa: 0
  }
226 227
  v: 4.2779142678136575
  a: -0.30597833023070853
228 229 230 231
  relative_time: 0.75000000000000011
}
trajectory_point {
  path_point {
232 233 234 235 236
    x: 586362.29920936842
    y: 4140765.0858095428
    theta: 1.3128540295995201
    kappa: -0.0011550134795974868
    s: 3.4878441962702134
237 238 239
    dkappa: 0
    ddkappa: 0
  }
240 241
  v: 4.2622828061177618
  a: -0.31923805339250116
242 243 244 245
  relative_time: 0.80000000000000016
}
trajectory_point {
  path_point {
246 247 248 249 250
    x: 586362.35350874043
    y: 4140765.2914718161
    theta: 1.3124741697505753
    kappa: -0.00229047899795153
    s: 3.7005538430326088
251 252 253
    dkappa: 0
    ddkappa: 0
  }
254 255
  v: 4.2459946708956684
  a: -0.33224527127860115
256 257 258 259
  relative_time: 0.8500000000000002
}
trajectory_point {
  path_point {
260 261 262 263 264
    x: 586362.40769359027
    y: 4140765.4963052692
    theta: 1.3118867334016588
    kappa: -0.0032144276882176822
    s: 3.9124329292220734
265 266 267
    dkappa: 0
    ddkappa: 0
  }
268 269
  v: 4.2290624874111629
  a: -0.34499998388900854
270 271 272 273
  relative_time: 0.90000000000000024
}
trajectory_point {
  path_point {
274 275 276 277 278
    x: 586362.46178855607
    y: 4140765.7002703352
    theta: 1.3111381994183879
    kappa: -0.0038898822108662853
    s: 4.1234495680570822
279 280 281
    dkappa: 0
    ddkappa: 0
  }
282 283
  v: 4.2114988809280289
  a: -0.35750219122372329
284 285 286 287
  relative_time: 0.95000000000000029
}
trajectory_point {
  path_point {
288 289 290 291 292
    x: 586362.515809764
    y: 4140765.9033303056
    theta: 1.3102798400204179
    kappa: -0.0042817744829844679
    s: 4.3335725040192958
293 294 295
    dkappa: 0
    ddkappa: 0
  }
296 297
  v: 4.1933164767100521
  a: -0.36975189328274527
298 299 300 301
  relative_time: 1.0000000000000002
}
trajectory_point {
  path_point {
302 303 304 305 306
    x: 586362.56978253124
    y: 4140766.1054466041
    theta: 1.3093711936059327
    kappa: -0.0043187107940818236
    s: 4.5427711128535693
307 308 309
    dkappa: 0
    ddkappa: 0
  }
310 311
  v: 4.1745279000210163
  a: -0.3817490900660746
312 313 314 315
  relative_time: 1.0500000000000003
}
trajectory_point {
  path_point {
316 317 318 319 320
    x: 586362.62370872637
    y: 4140766.3065874637
    theta: 1.3085110466489471
    kappa: -0.0039280393518643037
    s: 4.7510154015679431
321 322 323
    dkappa: 0
    ddkappa: 0
  }
324 325
  v: 4.1551457761247059
  a: -0.3934937815737114
326 327 328 329
  relative_time: 1.1000000000000003
}
trajectory_point {
  path_point {
330 331 332 333 334
    x: 586362.67753110162
    y: 4140766.5067376643
    theta: 1.3077803824397614
    kappa: -0.0031345717895512938
    s: 4.958276008433649
335 336 337
    dkappa: 0
    ddkappa: 0
  }
338 339
  v: 4.1351827302849067
  a: -0.40498596780565543
340 341 342 343
  relative_time: 1.1500000000000004
}
trajectory_point {
  path_point {
344 345 346 347 348
    x: 586362.73121033725
    y: 4140766.7058779495
    theta: 1.3072332003838836
    kappa: -0.0021350349136650465
    s: 5.1645242029851062
349 350 351
    dkappa: 0
    ddkappa: 0
  }
352 353
  v: 4.1146513877654023
  a: -0.41622564876190693
354 355 356 357
  relative_time: 1.2000000000000004
}
trajectory_point {
  path_point {
358 359 360 361 362
    x: 586362.78470461629
    y: 4140766.903990428
    theta: 1.3068881517558635
    kappa: -0.0011314778668996813
    s: 5.3697318860199239
363 364 365
    dkappa: 0
    ddkappa: 0
  }
366 367
  v: 4.0935643738299774
  a: -0.42721282444246567
368 369 370 371
  relative_time: 1.2500000000000004
}
trajectory_point {
  path_point {
372 373 374 375 376
    x: 586362.83797205181
    y: 4140767.1010579267
    theta: 1.30672686587383
    kappa: -0.00028774454082471367
    s: 5.5738715895989008
377 378 379
    dkappa: 0
    ddkappa: 0
  }
380 381
  v: 4.0719343137424167
  a: -0.43794749484733175
382 383 384 385
  relative_time: 1.3000000000000005
}
trajectory_point {
  path_point {
386 387 388 389 390
    x: 586362.89096900029
    y: 4140767.297064431
    theta: 1.3067546159881223
    kappa: 0.00036598091003388355
    s: 5.7769164770460266
391 392 393
    dkappa: 0
    ddkappa: 0
  }
394 395
  v: 4.0497738327665056
  a: -0.44842965997650519
396 397 398 399
  relative_time: 1.3500000000000005
}
trajectory_point {
  path_point {
400 401 402 403 404
    x: 586362.94365444686
    y: 4140767.4919938827
    theta: 1.306889944646709
    kappa: 0.000888679377269726
    s: 5.9788403429484758
405 406 407
    dkappa: 0
    ddkappa: 0
  }
408 409
  v: 4.027095556166028
  a: -0.458659319829986
410 411 412 413
  relative_time: 1.4000000000000006
}
trajectory_point {
  path_point {
414 415 416 417 418
    x: 586362.99600743642
    y: 4140767.6858254485
    theta: 1.3071099196104039
    kappa: 0.0012908825242618637
    s: 6.1796176131566165
419 420 421
    dkappa: 0
    ddkappa: 0
  }
422 423
  v: 4.0039121092047685
  a: -0.46863647440777423
424 425 426 427
  relative_time: 1.4500000000000006
}
trajectory_point {
  path_point {
428 429 430 431 432
    x: 586363.04801045381
    y: 4140767.8785380148
    theta: 1.307394129826507
    kappa: 0.0015820801200401324
    s: 6.3792233447840045
433 434 435
    dkappa: 0
    ddkappa: 0
  }
436 437
  v: 3.9802361171465122
  a: -0.47836112370986972
438 439 440 441
  relative_time: 1.5000000000000007
}
trajectory_point {
  path_point {
442 443 444 445 446
    x: 586363.09964502789
    y: 4140768.0701113734
    theta: 1.3077254102657054
    kappa: 0.0017655574725103185
    s: 6.5776332262073813
447 448 449
    dkappa: 0
    ddkappa: 0
  }
450 451
  v: 3.9560802052550432
  a: -0.48783326773627256
452 453 454 455
  relative_time: 1.5500000000000007
}
trajectory_point {
  path_point {
456 457 458 459 460
    x: 586363.15088096738
    y: 4140768.2605291056
    theta: 1.3080838582756638
    kappa: 0.0018295858318487586
    s: 6.7748235770666838
461 462 463
    dkappa: 0
    ddkappa: 0
  }
464 465
  v: 3.9314569987941463
  a: -0.49705290648698275
466 467 468 469
  relative_time: 1.6000000000000008
}
trajectory_point {
  path_point {
470 471 472 473 474
    x: 586363.20173153421
    y: 4140768.4497637404
    theta: 1.3084415747924121
    kappa: 0.0018138538375126823
    s: 6.9707713482650355
475 476 477
    dkappa: 0
    ddkappa: 0
  }
478 479
  v: 3.9063791230276061
  a: -0.50602003996200018
480 481 482 483
  relative_time: 1.6500000000000008
}
trajectory_point {
  path_point {
484 485 486 487 488
    x: 586363.25219350308
    y: 4140768.6377929142
    theta: 1.3087874835518492
    kappa: 0.0017253063325051554
    s: 7.1654541219687475
489 490 491
    dkappa: 0
    ddkappa: 0
  }
492 493
  v: 3.8808592032192077
  a: -0.51473466816132507
494 495 496 497
  relative_time: 1.7000000000000008
}
trajectory_point {
  path_point {
498 499 500 501 502
    x: 586363.30226443044
    y: 4140768.8245947096
    theta: 1.3091118700932238
    kappa: 0.0015704558630259637
    s: 7.3588501116073228
503 504 505
    dkappa: 0
    ddkappa: 0
  }
506 507
  v: 3.8549098646327353
  a: -0.52319679108495731
508 509 510 511
  relative_time: 1.7500000000000009
}
trajectory_point {
  path_point {
512 513 514 515 516
    x: 586363.35192733211
    y: 4140769.0101517504
    theta: 1.3093884264858082
    kappa: 0.0013367078519725397
    s: 7.550938161873451
517 518 519
    dkappa: 0
    ddkappa: 0
  }
520 521
  v: 3.8285437325319736
  a: -0.53140640873289691
522 523 524 525
  relative_time: 1.8000000000000009
}
trajectory_point {
  path_point {
526 527 528 529 530
    x: 586363.40120282909
    y: 4140769.1944372477
    theta: 1.3096128866134502
    kappa: 0.0010561662796014946
    s: 7.7416977487230119
531 532 533
    dkappa: 0
    ddkappa: 0
  }
534 535
  v: 3.8017734321807071
  a: -0.53936352110514374
536 537 538 539
  relative_time: 1.850000000000001
}
trajectory_point {
  path_point {
540 541 542 543 544
    x: 586363.45009812654
    y: 4140769.3774286788
    theta: 1.3097855158013991
    kappa: 0.00074519625924900144
    s: 7.9311089793750771
545 546 547
    dkappa: 0
    ddkappa: 0
  }
548 549
  v: 3.7746115888427205
  a: -0.547068128201698
550 551 552 553
  relative_time: 1.900000000000001
}
trajectory_point {
  path_point {
554 555 556 557 558
    x: 586363.49861513288
    y: 4140769.5591055909
    theta: 1.3099041961019247
    kappa: 0.00041322512008698905
    s: 8.1191525923119023
559 560 561
    dkappa: 0
    ddkappa: 0
  }
562 563
  v: 3.7470708277817986
  a: -0.55452023002255968
564 565 566 567
  relative_time: 1.9500000000000011
}
trajectory_point {
  path_point {
568 569 570 571 572
    x: 586363.54675613972
    y: 4140769.7394480854
    theta: 1.3099426013005222
    kappa: 7.2878457267950585e-05
    s: 8.3058099572789388
573 574 575
    dkappa: 0
    ddkappa: 0
  }
576 577
  v: 3.7191637742617272
  a: -0.56171982656772668
578 579 580 581
  relative_time: 2.0000000000000009
}
trajectory_point {
  path_point {
582 583 584 585 586
    x: 586363.59453562845
    y: 4140769.9184336849
    theta: 1.3099207455347919
    kappa: -0.0002558014307362294
    s: 8.4910630935589424
587 588 589
    dkappa: 0
    ddkappa: 0
  }
590 591
  v: 3.6909041005246706
  a: -0.568628996221489
592 593 594 595
  relative_time: 2.0500000000000007
}
trajectory_point {
  path_point {
596 597 598 599 600
    x: 586363.64195580827
    y: 4140770.0960438983
    theta: 1.3098485724993856
    kappa: -0.0005659208499033412
    s: 8.6748947050067589
601 602 603
    dkappa: 0
    ddkappa: 0
  }
604 605
  v: 3.6623046873088838
  a: -0.57530940571693412
606 607 608 609
  relative_time: 2.1000000000000005
}
trajectory_point {
  path_point {
610 611 612 613 614
    x: 586363.689018898
    y: 4140770.2722608461
    theta: 1.3097259690233976
    kappa: -0.00084937247402828747
    s: 8.8572880905986491
615 616 617
    dkappa: 0
    ddkappa: 0
  }
618 619
  v: 3.6333769726222824
  a: -0.58176105505406217
620 621 622 623
  relative_time: 2.1500000000000004
}
trajectory_point {
  path_point {
624 625 626 627 628
    x: 586363.735742684
    y: 4140770.4470630791
    theta: 1.3095432867072321
    kappa: -0.0010748712929242218
    s: 9.0382271212112713
629 630 631
    dkappa: 0
    ddkappa: 0
  }
632 633
  v: 3.6041323944727828
  a: -0.587983944232873
634 635 636 637
  relative_time: 2.2
}
trajectory_point {
  path_point {
638 639 640 641 642
    x: 586363.78211673163
    y: 4140770.6204372738
    theta: 1.3093336441218324
    kappa: -0.0012519255294316724
    s: 9.2176962396216773
643 644 645
    dkappa: 0
    ddkappa: 0
  }
646 647
  v: 3.5745823908683008
  a: -0.59397807325336682
648 649 650 651
  relative_time: 2.25
}
trajectory_point {
  path_point {
652 653 654 655 656
    x: 586363.82813767879
    y: 4140770.7923688153
    theta: 1.3091019891332967
    kappa: -0.0013787227941279309
    s: 9.3956804605073145
657 658 659
    dkappa: 0
    ddkappa: 0
  }
660 661
  v: 3.5447383998167519
  a: -0.59974344211554342
662 663 664 665
  relative_time: 2.3
}
trajectory_point {
  path_point {
666 667 668 669 670
    x: 586363.87382233678
    y: 4140770.9628382712
    theta: 1.3088523655709143
    kappa: -0.0014174239207088077
    s: 9.5721653704460312
671 672 673
    dkappa: 0
    ddkappa: 0
  }
674 675
  v: 3.514611859326052
  a: -0.605280050819403
676 677 678 679
  relative_time: 2.3499999999999996
}
trajectory_point {
  path_point {
680 681 682 683 684
    x: 586363.919157091
    y: 4140771.1318349428
    theta: 1.3086081940379302
    kappa: -0.0013738880588894148
    s: 9.7471371279160657
685 686 687
    dkappa: 0
    ddkappa: 0
  }
688 689
  v: 3.4842142074041171
  a: -0.6105878993649454
690 691 692 693
  relative_time: 2.3999999999999995
}
trajectory_point {
  path_point {
694 695 696 697 698
    x: 586363.96412790962
    y: 4140771.2993488503
    theta: 1.308376369344878
    kappa: -0.0012625570880983193
    s: 9.9205824632960535
699 700 701
    dkappa: 0
    ddkappa: 0
  }
702 703
  v: 3.4535568820588631
  a: -0.61566698775217066
704 705 706 707
  relative_time: 2.4499999999999993
}
trajectory_point {
  path_point {
708 709 710 711 712
    x: 586364.00874124747
    y: 4140771.4653651062
    theta: 1.308174905678444
    kappa: -0.001050216907036608
    s: 10.092488678865028
713 714 715
    dkappa: 0
    ddkappa: 0
  }
716 717
  v: 3.4226513212982055
  a: -0.62051731598107884
718 719 720 721
  relative_time: 2.4999999999999991
}
trajectory_point {
  path_point {
722 723 724 725 726
    x: 586364.05298392032
    y: 4140771.6298746848
    theta: 1.3080204795870782
    kappa: -0.0008245619295909651
    s: 10.262843648802415
727 728 729
    dkappa: 0
    ddkappa: 0
  }
730 731
  v: 3.3915089631300606
  a: -0.62513888405166984
732 733 734 735
  relative_time: 2.5499999999999989
}
trajectory_point {
  path_point {
736 737 738 739 740
    x: 586364.09683791571
    y: 4140771.7928704624
    theta: 1.3078955078707666
    kappa: -0.00060790642068188274
    s: 10.431635819188038
741 742 743
    dkappa: 0
    ddkappa: 0
  }
744 745
  v: 3.3601412455623438
  a: -0.62953169196394376
746 747 748 749
  relative_time: 2.5999999999999988
}
trajectory_point {
  path_point {
750 751 752 753 754
    x: 586364.14030273189
    y: 4140771.9543412011
    theta: 1.3078096297942174
    kappa: -0.00042508288231435723
    s: 10.59885420800212
755 756 757
    dkappa: 0
    ddkappa: 0
  }
758 759
  v: 3.3285596066029717
  a: -0.6336957397179005
760 761 762 763
  relative_time: 2.6499999999999986
}
trajectory_point {
  path_point {
764 765 766 767 768
    x: 586364.18336758669
    y: 4140772.1142790182
    theta: 1.3077554933142406
    kappa: -0.00027142803963083864
    s: 10.764488405125272
769 770 771
    dkappa: 0
    ddkappa: 0
  }
772 773
  v: 3.2967754842598596
  a: -0.63763102731354016
774 775 776 777
  relative_time: 2.6999999999999984
}
trajectory_point {
  path_point {
778 779 780 781 782
    x: 586364.22602325166
    y: 4140772.2726762113
    theta: 1.3077189190815335
    kappa: -0.00013483698647107697
    s: 10.928528572338507
783 784 785
    dkappa: 0
    ddkappa: 0
  }
786 787
  v: 3.264800316540923
  a: -0.64133755475086274
788 789 790 791
  relative_time: 2.7499999999999982
}
trajectory_point {
  path_point {
792 793 794 795 796
    x: 586364.26826706389
    y: 4140772.4295238997
    theta: 1.3077077870384741
    kappa: -2.3523965333587631e-05
    s: 11.090965443323231
797 798 799
    dkappa: 0
    ddkappa: 0
  }
800 801
  v: 3.2326455414540787
  a: -0.64481532202986813
802 803 804 805
  relative_time: 2.799999999999998
}
trajectory_point {
  path_point {
806 807 808 809 810
    x: 586364.31009132427
    y: 4140772.5848151529
    theta: 1.3077128147096768
    kappa: 6.9985033627657315e-05
    s: 11.251790323661247
811 812 813
    dkappa: 0
    ddkappa: 0
  }
814 815
  v: 3.2003225970072418
  a: -0.64806432915055645
816 817 818 819
  relative_time: 2.8499999999999979
}
trajectory_point {
  path_point {
820 821 822 823 824
    x: 586364.35149369691
    y: 4140772.7385421889
    theta: 1.307727487493177
    kappa: 0.00015234579115338152
    s: 11.410995090834753
825 826 827
    dkappa: 0
    ddkappa: 0
  }
828 829
  v: 3.1678429212083286
  a: -0.65108457611292758
830 831 832 833
  relative_time: 2.8999999999999977
}
trajectory_point {
  path_point {
834 835 836 837 838
    x: 586364.39246768609
    y: 4140772.8906989358
    theta: 1.3077591627334773
    kappa: 0.00021446140053450234
    s: 11.568572194226343
839 840 841
    dkappa: 0
    ddkappa: 0
  }
842 843
  v: 3.1352179520652546
  a: -0.65387606291698164
844 845 846 847
  relative_time: 2.9499999999999975
}
trajectory_point {
  path_point {
848 849 850 851 852
    x: 586364.43301230134
    y: 4140773.041278434
    theta: 1.3077964865131118
    kappa: 0.00026784897593073857
    s: 11.724514655119007
853 854 855
    dkappa: 0
    ddkappa: 0
  }
856 857
  v: 3.1024591275859361
  a: -0.65643878956271851
858 859 860 861
  relative_time: 2.9999999999999973
}
trajectory_point {
  path_point {
862 863 864 865 866
    x: 586364.4731251651
    y: 4140773.1902746879
    theta: 1.30784044062924
    kappa: 0.000311176433737767
    s: 11.87881606669613
867 868 869
    dkappa: 0
    ddkappa: 0
  }
870 871
  v: 3.0695778857782883
  a: -0.6587727560501383
872 873 874 875
  relative_time: 3.0499999999999972
}
trajectory_point {
  path_point {
876 877 878 879 880
    x: 586364.51280026045
    y: 4140773.3376832753
    theta: 1.3078914389522838
    kappa: 0.00034209790757459938
    s: 12.031470594041494
881 882 883
    dkappa: 0
    ddkappa: 0
  }
884 885
  v: 3.0365856646502274
  a: -0.6608779623792409
886 887 888 889
  relative_time: 3.099999999999997
}
trajectory_point {
  path_point {
890 891 892 893 894
    x: 586364.55204182828
    y: 4140773.4834976029
    theta: 1.3079443291146586
    kappa: 0.00036815004734104659
    s: 12.182472974139277
895 896 897
    dkappa: 0
    ddkappa: 0
  }
898 899
  v: 3.0034939022096694
  a: -0.66275440855002654
900 901 902 903
  relative_time: 3.1499999999999968
}
trajectory_point {
  path_point {
904 905 906 907 908
    x: 586364.59084149613
    y: 4140773.6277150656
    theta: 1.3080010998931597
    kappa: 0.00038317176587834395
    s: 12.331818515874051
909 910 911
    dkappa: 0
    ddkappa: 0
  }
912 913
  v: 2.9703140364645306
  a: -0.66440209456249488
914 915 916 917
  relative_time: 3.1999999999999966
}
trajectory_point {
  path_point {
918 919 920 921 922
    x: 586364.62920334
    y: 4140773.7703303006
    theta: 1.3080582752011356
    kappa: 0.0003929758226836173
    s: 12.479503100030785
923 924 925
    dkappa: 0
    ddkappa: 0
  }
926 927
  v: 2.9370575054227257
  a: -0.66582102041664615
928 929 930 931
  relative_time: 3.2499999999999964
}
trajectory_point {
  path_point {
932 933 934 935 936
    x: 586364.66712516022
    y: 4140773.9113402264
    theta: 1.308116063524182
    kappa: 0.00039653881207247946
    s: 12.625523179294843
937 938 939
    dkappa: 0
    ddkappa: 0
  }
940 941
  v: 2.9037357470921714
  a: -0.66701118611248034
942 943 944 945
  relative_time: 3.2999999999999963
}
trajectory_point {
  path_point {
946 947 948 949 950
    x: 586364.7046038711
    y: 4140774.05074259
    theta: 1.308172952848043
    kappa: 0.00039258480293066485
    s: 12.769875778251986
951 952 953
    dkappa: 0
    ddkappa: 0
  }
954 955
  v: 2.8703601994807832
  a: -0.66797259164999734
956 957 958 959
  relative_time: 3.3499999999999961
}
trajectory_point {
  path_point {
960 961 962 963 964
    x: 586364.74164507829
    y: 4140774.1885333955
    theta: 1.3082290902797715
    kappa: 0.00038574361515462691
    s: 12.912558493388371
965 966 967
    dkappa: 0
    ddkappa: 0
  }
968 969
  v: 2.8369423005964771
  a: -0.66870523702919726
970 971 972 973
  relative_time: 3.3999999999999959
}
trajectory_point {
  path_point {
974 975 976 977 978
    x: 586364.77823991445
    y: 4140774.3247131296
    theta: 1.3082815798086951
    kappa: 0.00036963177878818383
    s: 13.053569493090549
979 980 981
    dkappa: 0
    ddkappa: 0
  }
982 983
  v: 2.8034934884471694
  a: -0.66920912225008011
984 985 986 987
  relative_time: 3.4499999999999957
}
trajectory_point {
  path_point {
988 989 990 991 992
    x: 586364.81439816917
    y: 4140774.4592778566
    theta: 1.3083325391872813
    kappa: 0.00035164887721110495
    s: 13.19290751764547
993 994 995
    dkappa: 0
    ddkappa: 0
  }
996 997
  v: 2.7700252010407747
  a: -0.66948424731264577
998 999 1000 1001
  relative_time: 3.4999999999999956
}
trajectory_point {
  path_point {
1002 1003 1004 1005 1006
    x: 586364.85011163889
    y: 4140774.5922290678
    theta: 1.3083784133999454
    kappa: 0.00032454399654910815
    s: 13.330571879240473
1007 1008 1009
    dkappa: 0
    ddkappa: 0
  }
1010 1011
  v: 2.7365488763852097
  a: -0.66953061221689425
1012 1013 1014 1015
  relative_time: 3.5499999999999954
}
trajectory_point {
  path_point {
1016 1017 1018 1019 1020
    x: 586364.8853879876
    y: 4140774.7235645843
    theta: 1.3084210894453685
    kappa: 0.00029271013370355252
    s: 13.466562461963303
1021 1022 1023
    dkappa: 0
    ddkappa: 0
  }
1024 1025
  v: 2.7030759524883905
  a: -0.66934821696282576
1026 1027 1028 1029
  relative_time: 3.5999999999999952
}
trajectory_point {
  path_point {
1030 1031 1032 1033 1034
    x: 586364.92022340058
    y: 4140774.8532859012
    theta: 1.3084569889560485
    kappa: 0.00024929142146133817
    s: 13.600879721802091
1035 1036 1037
    dkappa: 0
    ddkappa: 0
  }
1038 1039
  v: 2.6696178673582329
  a: -0.66893706155044
1040 1041 1042 1043
  relative_time: 3.649999999999995
}
trajectory_point {
  path_point {
1044 1045 1046 1047 1048
    x: 586364.95462214493
    y: 4140774.9813929391
    theta: 1.3084873586061088
    kappa: 0.00020163775277591366
    s: 13.733524686645367
1049 1050 1051
    dkappa: 0
    ddkappa: 0
  }
1052 1053
  v: 2.636186059002652
  a: -0.66829714597973722
1054 1055 1056 1057
  relative_time: 3.6999999999999948
}
trajectory_point {
  path_point {
1058 1059 1060 1061 1062
    x: 586364.98858333286
    y: 4140775.1078875912
    theta: 1.3085099585272459
    kappa: 0.00014764378648614087
    s: 13.864498956282063
1063 1064 1065
    dkappa: 0
    ddkappa: 0
  }
1066 1067
  v: 2.6027919654295646
  a: -0.66742847025071728
1068 1069 1070 1071
  relative_time: 3.7499999999999947
}
trajectory_point {
  path_point {
1072 1073 1074 1075 1076
    x: 586365.02211012528
    y: 4140775.2327712579
    theta: 1.3085257506780859
    kappa: 9.3597331198162732e-05
    s: 13.993804702401498
1077 1078 1079
    dkappa: 0
    ddkappa: 0
  }
1080 1081
  v: 2.5694470246468861
  a: -0.66633103436338015
1082 1083 1084 1085
  relative_time: 3.7999999999999945
}
trajectory_point {
  path_point {
1086 1087 1088 1089 1090
    x: 586365.05520304793
    y: 4140775.3560466385
    theta: 1.3085340448026772
    kappa: 3.9418823002833073e-05
    s: 14.121444668593389
1091 1092 1093
    dkappa: 0
    ddkappa: 0
  }
1094 1095
  v: 2.5361626746625321
  a: -0.66500483831772594
1096 1097 1098 1099
  relative_time: 3.8499999999999943
}
trajectory_point {
  path_point {
1100 1101 1102 1103 1104
    x: 586365.08786477987
    y: 4140775.4777164469
    theta: 1.3085360796060865
    kappa: -1.0440790843809109e-05
    s: 14.247422170347853
1105 1106 1107
    dkappa: 0
    ddkappa: 0
  }
1108 1109
  v: 2.5029503534844189
  a: -0.66344988211375466
1110 1111 1112 1113
  relative_time: 3.8999999999999941
}
trajectory_point {
  path_point {
1114 1115 1116 1117 1118
    x: 586365.12009632192
    y: 4140775.5977844386
    theta: 1.3085315999765337
    kappa: -5.5833160634789228e-05
    s: 14.371741095055398
1119 1120 1121
    dkappa: 0
    ddkappa: 0
  }
1122 1123
  v: 2.4698214991204623
  a: -0.6616661657514662
1124 1125 1126 1127
  relative_time: 3.949999999999994
}
trajectory_point {
  path_point {
1128 1129 1130 1131 1132
    x: 586365.15190000914
    y: 4140775.716254605
    theta: 1.308522875138868
    kappa: -9.3734110706872835e-05
    s: 14.494405902006932
1133 1134 1135
    dkappa: 0
    ddkappa: 0
  }
1136 1137
  v: 2.436787549578578
  a: -0.65965368923086054
1138 1139 1140 1141
  relative_time: 3.9999999999999938
}
trajectory_point {
  path_point {
1142 1143 1144 1145 1146
    x: 586365.18327737483
    y: 4140775.8331317855
    theta: 1.308508964328821
    kappa: -0.00012264061579029447
    s: 14.615421662890043
1147 1148 1149
    dkappa: 0
    ddkappa: 0
  }
1150 1151
  v: 2.4038622608978963
  a: -0.65732867099245429
1152 1153 1154 1155
  relative_time: 4.0499999999999936
}
trajectory_point {
  path_point {
1156 1157 1158 1159 1160
    x: 586365.21423009166
    y: 4140775.9484214955
    theta: 1.3084937567695818
    kappa: -0.00014316092391241392
    s: 14.734794138579428
1161 1162 1163
    dkappa: 0
    ddkappa: 0
  }
1164 1165
  v: 2.3710576011797397
  a: -0.65482853072976888
1166 1167 1168 1169
  relative_time: 4.0999999999999934
}
trajectory_point {
  path_point {
1170 1171 1172 1173 1174
    x: 586365.24476096546
    y: 4140776.0621294538
    theta: 1.3084760191161358
    kappa: -0.00014866425068478772
    s: 14.852529579425745
1175 1176 1177
    dkappa: 0
    ddkappa: 0
  }
1178 1179
  v: 2.3383823265253243
  a: -0.65215326844280541
1180 1181 1182 1183
  relative_time: 4.1499999999999932
}
trajectory_point {
  path_point {
1184 1185 1186 1187 1188
    x: 586365.27486984816
    y: 4140776.1742626252
    theta: 1.3084588853343717
    kappa: -0.00014883389781624362
    s: 14.96863467358471
1189 1190 1191
    dkappa: 0
    ddkappa: 0
  }
1192 1193
  v: 2.3058451930358639
  a: -0.6493028841315639
1194 1195 1196 1197
  relative_time: 4.1999999999999931
}
trajectory_point {
  path_point {
1198 1199 1200 1201 1202
    x: 586365.30456108646
    y: 4140776.2848272203
    theta: 1.3084434920432602
    kappa: -0.00012697401480359275
    s: 15.0831165470171
1203 1204 1205
    dkappa: 0
    ddkappa: 0
  }
1206 1207
  v: 2.2734549568125728
  a: -0.64627737779604433
1208 1209 1210 1211
  relative_time: 4.2499999999999929
}
trajectory_point {
  path_point {
1212 1213 1214 1215 1216
    x: 586365.33383329876
    y: 4140776.3938314421
    theta: 1.3084283159942085
    kappa: -0.00010542263540895017
    s: 15.195982763488756
1217 1218 1219
    dkappa: 0
    ddkappa: 0
  }
1220 1221
  v: 2.2412203739566645
  a: -0.6430767494362466
1222 1223 1224 1225
  relative_time: 4.2999999999999927
}
trajectory_point {
  path_point {
1226 1227 1228 1229 1230
    x: 586365.36269140325
    y: 4140776.5012822552
    theta: 1.3084186993418125
    kappa: -9.1983127491818416e-05
    s: 15.307241324570576
1231 1232 1233
    dkappa: 0
    ddkappa: 0
  }
1234 1235
  v: 2.2091502005693533
  a: -0.63970099905217082
1236 1237 1238 1239
  relative_time: 4.3499999999999925
}
trajectory_point {
  path_point {
1240 1241 1242 1243 1244
    x: 586365.39113480574
    y: 4140776.6071885577
    theta: 1.3084094102193551
    kappa: -7.9013311289759713e-05
    s: 15.416900669638521
1245 1246 1247
    dkappa: 0
    ddkappa: 0
  }
1248 1249
  v: 2.1772531927518521
  a: -0.63615012664381687
1250 1251 1252 1253
  relative_time: 4.3999999999999924
}
trajectory_point {
  path_point {
1254 1255 1256 1257 1258
    x: 586365.41916710185
    y: 4140776.7115585748
    theta: 1.3084006059196867
    kappa: -7.923759154271752e-05
    s: 15.52496967587361
1259 1260 1261
    dkappa: 0
    ddkappa: 0
  }
1262 1263
  v: 2.1455381066053762
  a: -0.632424132211185
1264 1265 1266 1267
  relative_time: 4.4499999999999922
}
trajectory_point {
  path_point {
1268 1269 1270 1271 1272
    x: 586365.44678998669
    y: 4140776.8144014967
    theta: 1.3083921046915998
    kappa: -8.5932366560351168e-05
    s: 15.631457658261928
1273 1274 1275
    dkappa: 0
    ddkappa: 0
  }
1276 1277
  v: 2.1140136982311386
  a: -0.62852301575427494
1278 1279 1280 1281
  relative_time: 4.499999999999992
}
trajectory_point {
  path_point {
1282 1283 1284 1285 1286
    x: 586365.47400596365
    y: 4140776.9157267497
    theta: 1.3083827284312783
    kappa: -9.6586701340997674e-05
    s: 15.736374369594614
1287 1288 1289
    dkappa: 0
    ddkappa: 0
  }
1290 1291
  v: 2.0826887237303535
  a: -0.62444677727308673
1292 1293 1294 1295
  relative_time: 4.5499999999999918
}
trajectory_point {
  path_point {
1296 1297 1298 1299 1300
    x: 586365.50081866654
    y: 4140777.0155439097
    theta: 1.3083710164608273
    kappa: -0.00011712307800827877
    s: 15.839730000467874
1301 1302 1303
    dkappa: 0
    ddkappa: 0
  }
1304 1305
  v: 2.0515719392042349
  a: -0.62019541676762058
1306 1307 1308 1309
  relative_time: 4.5999999999999917
}
trajectory_point {
  path_point {
1310 1311 1312 1313 1314
    x: 586365.52722914843
    y: 4140777.1138636982
    theta: 1.3083594801832585
    kappa: -0.00013735138565985157
    s: 15.941535179282969
1315 1316 1317
    dkappa: 0
    ddkappa: 0
  }
1318 1319
  v: 2.0206721007539965
  a: -0.61576893423787626
1320 1321 1322 1323
  relative_time: 4.6499999999999915
}
trajectory_point {
  path_point {
1324 1325 1326 1327 1328
    x: 586365.553243132
    y: 4140777.2106960379
    theta: 1.3083429664370598
    kappa: -0.00016481461274646844
    s: 16.041800972246225
1329 1330 1331
    dkappa: 0
    ddkappa: 0
  }
1332 1333
  v: 1.9899979644808521
  a: -0.6111673296838539
1334 1335 1336 1337
  relative_time: 4.6999999999999913
}
trajectory_point {
  path_point {
1338 1339 1340 1341 1342
    x: 586365.57886133261
    y: 4140777.3060526466
    theta: 1.3083255727107173
    kappa: -0.00019351568875362627
    s: 16.140538883369025
1343 1344 1345
    dkappa: 0
    ddkappa: 0
  }
1346 1347
  v: 1.9595582864860159
  a: -0.60639060310555337
1348 1349 1350 1351
  relative_time: 4.7499999999999911
}
trajectory_point {
  path_point {
1352 1353 1354 1355 1356
    x: 586365.60408752749
    y: 4140777.3999448759
    theta: 1.3083064485151885
    kappa: -0.00022298867360861125
    s: 16.237760854467815
1357 1358 1359
    dkappa: 0
    ddkappa: 0
  }
1360 1361
  v: 1.9293618228707015
  a: -0.60143875450297479
1362 1363 1364 1365
  relative_time: 4.7999999999999909
}
trajectory_point {
  path_point {
1366 1367 1368 1369 1370
    x: 586365.62892741151
    y: 4140777.4923840147
    theta: 1.3082818192409247
    kappa: -0.00025552715832237547
    s: 16.333479265164108
1371 1372 1373
    dkappa: 0
    ddkappa: 0
  }
1374 1375
  v: 1.8994173297361232
  a: -0.59631178387611816
1376 1377 1378 1379
  relative_time: 4.8499999999999908
}
trajectory_point {
  path_point {
1380 1381 1382 1383 1384
    x: 586365.65338043275
    y: 4140777.5833834819
    theta: 1.3082575735492668
    kappa: -0.00028755888036444577
    s: 16.427706932884462
1385 1386 1387
    dkappa: 0
    ddkappa: 0
  }
1388 1389
  v: 1.8697335631834946
  a: -0.59100969122498348
1390 1391 1392 1393
  relative_time: 4.8999999999999906
}
trajectory_point {
  path_point {
1394 1395 1396 1397 1398
    x: 586365.67745392257
    y: 4140777.6729550338
    theta: 1.3082289748996849
    kappa: -0.00031966091537967954
    s: 16.520457112860509
1399 1400 1401
    dkappa: 0
    ddkappa: 0
  }
1402 1403
  v: 1.8403192793140297
  a: -0.58553247654957064
1404 1405 1406 1407
  relative_time: 4.94999999999999
}
trajectory_point {
  path_point {
1408 1409 1410 1411 1412
    x: 586365.70115023141
    y: 4140777.7611122178
    theta: 1.3081974828625069
    kappa: -0.00035166092681497243
    s: 16.611743498128938
1413 1414 1415
    dkappa: 0
    ddkappa: 0
  }
1416 1417
  v: 1.8111832342289422
  a: -0.57988013984987985
1418 1419 1420 1421
  relative_time: 4.99999999999999
}
trajectory_point {
  path_point {
1422 1423 1424 1425 1426
    x: 586365.72447023366
    y: 4140777.8478694311
    theta: 1.3081664909313342
    kappa: -0.00038315276542527204
    s: 16.701580219531493
1427 1428 1429
    dkappa: 0
    ddkappa: 0
  }
1430 1431
  v: 1.7823341840294464
  a: -0.57405268112591079
1432 1433 1434 1435
  relative_time: 5.04999999999999
}
trajectory_point {
  path_point {
1436 1437 1438 1439 1440
    x: 586365.7474245464
    y: 4140777.9332389049
    theta: 1.3081299436849041
    kappa: -0.00041196864929830265
    s: 16.789981845714994
1441 1442 1443
    dkappa: 0
    ddkappa: 0
  }
1444 1445
  v: 1.7537808848167562
  a: -0.56805010037766379
1446 1447 1448 1449
  relative_time: 5.09999999999999
}
trajectory_point {
  path_point {
1450 1451 1452 1453 1454
    x: 586365.77001186507
    y: 4140778.0172365289
    theta: 1.3080924387062842
    kappa: -0.00043976683601050894
    s: 16.876963383131304
1455 1456 1457
    dkappa: 0
    ddkappa: 0
  }
1458 1459
  v: 1.725532092692085
  a: -0.56187239760513863
1460 1461 1462 1463
  relative_time: 5.14999999999999
}
trajectory_point {
  path_point {
1464 1465 1466 1467 1468
    x: 586365.79223442648
    y: 4140778.0998776956
    theta: 1.3080555393868305
    kappa: -0.00046711611630509718
    s: 16.962540276037355
1469 1470 1471
    dkappa: 0
    ddkappa: 0
  }
1472 1473
  v: 1.697596563756647
  a: -0.55551957280833542
1474 1475 1476 1477
  relative_time: 5.1999999999999895
}
trajectory_point {
  path_point {
1478 1479 1480 1481 1482
    x: 586365.81410466135
    y: 4140778.1811755067
    theta: 1.3080138290923238
    kappa: -0.0004893095327715793
    s: 17.046728406495141
1483 1484 1485
    dkappa: 0
    ddkappa: 0
  }
1486 1487
  v: 1.6699830541116563
  a: -0.54899162598725415
1488 1489 1490 1491
  relative_time: 5.2499999999999893
}
trajectory_point {
  path_point {
1492 1493 1494 1495 1496
    x: 586365.83561954
    y: 4140778.2611476779
    theta: 1.3079720340792909
    kappa: -0.00051047509537889492
    s: 17.129544094371717
1497 1498 1499
    dkappa: 0
    ddkappa: 0
  }
1500 1501
  v: 1.6427003198583265
  a: -0.54228855714189472
1502 1503 1504 1505
  relative_time: 5.2999999999999892
}
trajectory_point {
  path_point {
1506 1507 1508 1509 1510
    x: 586365.85678222182
    y: 4140778.3398107123
    theta: 1.307930923246684
    kappa: -0.00053129417974573281
    s: 17.211004097339188
1511 1512 1513
    dkappa: 0
    ddkappa: 0
  }
1514 1515
  v: 1.6157571170978717
  a: -0.53541036627225724
1516 1517 1518 1519
  relative_time: 5.349999999999989
}
trajectory_point {
  path_point {
1520 1521 1522 1523 1524
    x: 586365.87760568981
    y: 4140778.4171789233
    theta: 1.3078870946096381
    kappa: -0.00054524104752019147
    s: 17.291125610874737
1525 1526 1527
    dkappa: 0
    ddkappa: 0
  }
1528 1529
  v: 1.5891622019315057
  a: -0.52835705337834171
1530 1531 1532 1533
  relative_time: 5.3999999999999888
}
trajectory_point {
  path_point {
1534 1535 1536 1537 1538
    x: 586365.898087868
    y: 4140778.4932711311
    theta: 1.3078431920040261
    kappa: -0.000557425170683397
    s: 17.369926268260592
1539 1540 1541
    dkappa: 0
    ddkappa: 0
  }
1542 1543
  v: 1.5629243304604423
  a: -0.521128618460148
1544 1545 1546 1547
  relative_time: 5.4499999999999886
}
trajectory_point {
  path_point {
1548 1549 1550 1551 1552
    x: 586365.91823142115
    y: 4140778.56810533
    theta: 1.3078000152256266
    kappa: -0.00056940785779033146
    s: 17.447424140584054
1553 1554 1555
    dkappa: 0
    ddkappa: 0
  }
1556 1557
  v: 1.5370522587858957
  a: -0.51372506151767627
1558 1559 1560 1561
  relative_time: 5.4999999999999885
}
trajectory_point {
  path_point {
1562 1563 1564 1565 1566
    x: 586365.93804727262
    y: 4140778.64169775
    theta: 1.3077565308067329
    kappa: -0.00057544684793075813
    s: 17.523637736737477
1567 1568 1569
    dkappa: 0
    ddkappa: 0
  }
1570 1571
  v: 1.5115547430090794
  a: -0.50614638255092648
1572 1573 1574 1575
  relative_time: 5.5499999999999883
}
trajectory_point {
  path_point {
1576 1577 1578 1579 1580
    x: 586365.95753856469
    y: 4140778.7140671653
    theta: 1.307713026584389
    kappa: -0.00057722057816611137
    s: 17.59858600341828
1581 1582 1583
    dkappa: 0
    ddkappa: 0
  }
1584 1585
  v: 1.4864405392312079
  a: -0.49839258155989863
1586 1587 1588 1589
  relative_time: 5.5999999999999881
}
trajectory_point {
  path_point {
1590 1591 1592 1593 1594
    x: 586365.976705832
    y: 4140778.785233506
    theta: 1.3076702455791132
    kappa: -0.00057896482179206057
    s: 17.672288325128935
1595 1596 1597
    dkappa: 0
    ddkappa: 0
  }
1598 1599
  v: 1.4617184035534945
  a: -0.49046365854459262
1600 1601 1602 1603
  relative_time: 5.6499999999999879
}
trajectory_point {
  path_point {
1604 1605 1606 1607 1608
    x: 586365.99555587338
    y: 4140778.8552154703
    theta: 1.3076283287166648
    kappa: -0.00057882017733478246
    s: 17.744764524176983
1609 1610 1611
    dkappa: 0
    ddkappa: 0
  }
1612 1613
  v: 1.4373970920771533
  a: -0.48235961350500861
1614 1615 1616 1617
  relative_time: 5.6999999999999877
}
trajectory_point {
  path_point {
1618 1619 1620 1621 1622
    x: 586366.01410070469
    y: 4140778.9240308041
    theta: 1.3075878900226703
    kappa: -0.00056915169433799091
    s: 17.816034860675025
1623 1624 1625
    dkappa: 0
    ddkappa: 0
  }
1626 1627
  v: 1.4134853609033984
  a: -0.47408044644114644
1628 1629 1630 1631
  relative_time: 5.7499999999999876
}
trajectory_point {
  path_point {
1632 1633 1634 1635 1636
    x: 586366.03233715135
    y: 4140778.9917017967
    theta: 1.30754812378943
    kappa: -0.00055964398992958933
    s: 17.88612003254072
1637 1638 1639
    dkappa: 0
    ddkappa: 0
  }
1640 1641
  v: 1.3899919661334434
  a: -0.46562615735300628
1642 1643 1644 1645
  relative_time: 5.7999999999999874
}
trajectory_point {
  path_point {
1646 1647 1648 1649 1650
    x: 586366.05027071282
    y: 4140779.058248858
    theta: 1.3075090180246889
    kappa: -0.00055029419685251508
    s: 17.955041175496785
1651 1652 1653
    dkappa: 0
    ddkappa: 0
  }
1654 1655
  v: 1.3669256638685026
  a: -0.45699674624058795
1656 1657 1658 1659
  relative_time: 5.8499999999999872
}
trajectory_point {
  path_point {
1660 1661 1662 1663 1664
    x: 586366.06791185623
    y: 4140779.1236915085
    theta: 1.3074727052076756
    kappa: -0.00053430664871937424
    s: 18.022819863071007
1665 1666 1667
    dkappa: 0
    ddkappa: 0
  }
1668 1669
  v: 1.3442952102097896
  a: -0.44819221310389151
1670 1671 1672 1673
  relative_time: 5.899999999999987
}
trajectory_point {
  path_point {
1674 1675 1676 1677 1678
    x: 586366.08526548918
    y: 4140779.1880512238
    theta: 1.30743881060915
    kappa: -0.00051282564265235251
    s: 18.089478106596221
1679 1680 1681
    dkappa: 0
    ddkappa: 0
  }
1682 1683
  v: 1.3221093612585182
  a: -0.439212557942917
1684 1685 1686 1687
  relative_time: 5.9499999999999869
}
trajectory_point {
  path_point {
1688 1689 1690 1691 1692
    x: 586366.10233327292
    y: 4140779.2513508042
    theta: 1.3074054743225885
    kappa: -0.00049169847182159757
    s: 18.155038355210337
1693 1694 1695
    dkappa: 0
    ddkappa: 0
  }
1696 1697
  v: 1.3003768731159027
  a: -0.43005778075766454
1698 1699 1700 1701
  relative_time: 5.9999999999999867
}
trajectory_point {
  path_point {
1702 1703 1704 1705 1706
    x: 586366.119121183
    y: 4140779.3136124127
    theta: 1.307372684677325
    kappa: -0.00047091773979097366
    s: 18.219523560978057
1707 1708 1709
    dkappa: 0
    ddkappa: 0
  }
1710 1711
  v: 1.2791101824341249
  a: -0.42059879981618753
1712 1713 1714 1715
  relative_time: 6.0499999999999865
}
trajectory_point {
  path_point {
1716 1717 1718 1719 1720
    x: 586366.13564019417
    y: 4140779.374857489
    theta: 1.3073449700114912
    kappa: -0.00044161264386505939
    s: 18.282957283554609
1721 1722 1723
    dkappa: 0
    ddkappa: 0
  }
1724 1725
  v: 1.2583180978040081
  a: -0.41107353869124696
1726 1727 1728 1729
  relative_time: 6.0999999999999863
}
trajectory_point {
  path_point {
1730 1731 1732 1733 1734
    x: 586366.15189381433
    y: 4140779.4351097522
    theta: 1.3073197942198937
    kappa: -0.00040870263486835737
    s: 18.345363336092806
1735 1736 1737
    dkappa: 0
    ddkappa: 0
  }
1738 1739
  v: 1.2380039332347248
  a: -0.4014819973828469
1740 1741 1742 1743
  relative_time: 6.1499999999999861
}
trajectory_point {
  path_point {
1744 1745 1746 1747 1748
    x: 586366.16788602388
    y: 4140779.4943929641
    theta: 1.3072950233364486
    kappa: -0.00037632192526791019
    s: 18.406765697445916
1749 1750 1751
    dkappa: 0
    ddkappa: 0
  }
1752 1753
  v: 1.218171002735448
  a: -0.39182417589098734
1754 1755 1756 1757
  relative_time: 6.199999999999986
}
trajectory_point {
  path_point {
1758 1759 1760 1761 1762
    x: 586366.183623111
    y: 4140779.552730436
    theta: 1.3072706476208129
    kappa: -0.000344457782364754
    s: 18.46718851216767
1763 1764 1765
    dkappa: 0
    ddkappa: 0
  }
1766 1767
  v: 1.1988226203153505
  a: -0.38210007421566822
1768 1769 1770 1771
  relative_time: 6.2499999999999858
}
trajectory_point {
  path_point {
1772 1773 1774 1775 1776
    x: 586366.1991140875
    y: 4140779.610144916
    theta: 1.3072521774934802
    kappa: -0.00030550344887828485
    s: 18.526656090512255
1777 1778 1779
    dkappa: 0
    ddkappa: 0
  }
1780 1781
  v: 1.1799620999836056
  a: -0.37230969235688954
1782 1783 1784 1785
  relative_time: 6.2999999999999856
}
trajectory_point {
  path_point {
1786 1787 1788 1789 1790
    x: 586366.21436463878
    y: 4140779.6666602218
    theta: 1.3072381835838016
    kappa: -0.00026139875701327035
    s: 18.585192908434323
1791 1792 1793
    dkappa: 0
    ddkappa: 0
  }
1794 1795
  v: 1.1615927557493859
  a: -0.36245303031465137
1796 1797 1798 1799
  relative_time: 6.3499999999999854
}
trajectory_point {
  path_point {
1800 1801 1802 1803 1804
    x: 586366.22937911982
    y: 4140779.7223007
    theta: 1.307224406292389
    kappa: -0.00021797678229019664
    s: 18.642823607588973
1805 1806 1807
    dkappa: 0
    ddkappa: 0
  }
1808 1809
  v: 1.1437179016218648
  a: -0.35253008808895364
1810 1811 1812 1813
  relative_time: 6.3999999999999853
}
trajectory_point {
  path_point {
1814 1815 1816 1817 1818
    x: 586366.24416399328
    y: 4140779.7770903022
    theta: 1.3072108396887598
    kappa: -0.00017521883355344262
    s: 18.699572995331774
1819 1820 1821
    dkappa: 0
    ddkappa: 0
  }
1822 1823
  v: 1.1263408516102151
  a: -0.34254086567979641
1824 1825 1826 1827
  relative_time: 6.4499999999999851
}
trajectory_point {
  path_point {
1828 1829 1830 1831 1832
    x: 586366.2587260654
    y: 4140779.8310530582
    theta: 1.3071994662898134
    kappa: -0.00013095237925167777
    s: 18.755466044718744
1833 1834 1835
    dkappa: 0
    ddkappa: 0
  }
1836 1837
  v: 1.1094649197236097
  a: -0.33248536308717963
1838 1839 1840 1841
  relative_time: 6.4999999999999849
}
trajectory_point {
  path_point {
1842 1843 1844 1845 1846
    x: 586366.27307310549
    y: 4140779.8842129088
    theta: 1.3071983759824641
    kappa: -7.6389872809683878e-05
    s: 18.810527894506372
1847 1848 1849
    dkappa: 0
    ddkappa: 0
  }
1850 1851
  v: 1.0930934199712214
  a: -0.32236358031110335
1852 1853 1854 1855
  relative_time: 6.5499999999999847
}
trajectory_point {
  path_point {
1856 1857 1858 1859 1860
    x: 586366.2872101597
    y: 4140779.9365947023
    theta: 1.3071973016330491
    kappa: -2.2625953031031243e-05
    s: 18.864783849151589
1861 1862 1863
    dkappa: 0
    ddkappa: 0
  }
1864 1865
  v: 1.0772296663622238
  a: -0.31217551735156751
1866 1867 1868 1869
  relative_time: 6.5999999999999845
}
trajectory_point {
  path_point {
1870 1871 1872 1873 1874
    x: 586366.30114386464
    y: 4140779.9882230293
    theta: 1.3071962427372215
    kappa: 3.0364619258640808e-05
    s: 18.9182593788118
1875 1876 1877
    dkappa: 0
    ddkappa: 0
  }
1878 1879
  v: 1.0618769729057893
  a: -0.30192117420857212
1880 1881 1882 1883
  relative_time: 6.6499999999999844
}
trajectory_point {
  path_point {
1884 1885 1886 1887 1888
    x: 586366.3148809
    y: 4140780.03912264
    theta: 1.3071951987873522
    kappa: 8.26072474314494e-05
    s: 18.970980119344865
1889 1890 1891
    dkappa: 0
    ddkappa: 0
  }
1892 1893
  v: 1.0470386536110909
  a: -0.29160055088211728
1894 1895 1896 1897
  relative_time: 6.6999999999999842
}
trajectory_point {
  path_point {
1898 1899 1900 1901 1902
    x: 586366.32842733862
    y: 4140780.08931862
    theta: 1.3072007201052498
    kappa: 0.0001398927791812812
    s: 19.022971872309093
1903 1904 1905
    dkappa: 0
    ddkappa: 0
  }
1906 1907
  v: 1.0327180224873018
  a: -0.28121364737220289
1908 1909 1910 1911
  relative_time: 6.749999999999984
}
trajectory_point {
  path_point {
1912 1913 1914 1915 1916
    x: 586366.34178981266
    y: 4140780.1388360756
    theta: 1.3072141576383025
    kappa: 0.00020343634537708764
    s: 19.074260604963261
1917 1918 1919
    dkappa: 0
    ddkappa: 0
  }
1920 1921
  v: 1.0189183935435953
  a: -0.27076046367882889
1922 1923 1924 1925
  relative_time: 6.7999999999999838
}
trajectory_point {
  path_point {
1926 1927 1928 1929 1930
    x: 586366.35497593426
    y: 4140780.1877000197
    theta: 1.3072274178283909
    kappa: 0.00026614129002858281
    s: 19.124872450266604
1931 1932 1933
    dkappa: 0
    ddkappa: 0
  }
1934 1935
  v: 1.0056430807891434
  a: -0.26024099980199544
1936 1937 1938 1939
  relative_time: 6.8499999999999837
}
trajectory_point {
  path_point {
1940 1941 1942 1943 1944
    x: 586366.36799255526
    y: 4140780.235935844
    theta: 1.3072405075656996
    kappa: 0.000328040195547857
    s: 19.174833706878815
1945 1946 1947
    dkappa: 0
    ddkappa: 0
  }
1948 1949
  v: 0.99289539823312
  a: -0.24965525574170247
1950 1951 1952 1953
  relative_time: 6.8999999999999835
}
trajectory_point {
  path_point {
1954 1955 1956 1957 1958
    x: 586366.38084657036
    y: 4140780.283569098
    theta: 1.3072534337838275
    kappa: 0.00038916584963962126
    s: 19.224170839160045
1959 1960 1961
    dkappa: 0
    ddkappa: 0
  }
1962 1963
  v: 0.98067865988469771
  a: -0.23900323149794994
1964 1965 1966 1967
  relative_time: 6.9499999999999833
}
trajectory_point {
  path_point {
1968 1969 1970 1971 1972
    x: 586366.39354280988
    y: 4140780.3306260617
    theta: 1.3072729269914578
    kappa: 0.00045248838757094595
    s: 19.2729104771709
1973 1974 1975
    dkappa: 0
    ddkappa: 0
  }
1976 1977
  v: 0.96899617975304941
  a: -0.22828492707073789
1978 1979 1980 1981
  relative_time: 6.9999999999999831
}
trajectory_point {
  path_point {
1982 1983 1984 1985 1986
    x: 586366.40608735709
    y: 4140780.377132847
    theta: 1.3073018580669944
    kappa: 0.00051929207009493732
    s: 19.321079416672447
1987 1988 1989
    dkappa: 0
    ddkappa: 0
  }
1990 1991
  v: 0.9578512718473482
  a: -0.2175003424600663
1992 1993 1994 1995
  relative_time: 7.0499999999999829
}
trajectory_point {
  path_point {
1996 1997 1998 1999 2000
    x: 586366.41849029972
    y: 4140780.4231146574
    theta: 1.3073304625649693
    kappa: 0.00058534166424804217
    s: 19.36870461912622
2001 2002 2003
    dkappa: 0
    ddkappa: 0
  }
2004 2005
  v: 0.94724725017676725
  a: -0.20664947766593519
2006 2007 2008 2009
  relative_time: 7.0999999999999828
}
trajectory_point {
  path_point {
2010 2011 2012 2013 2014
    x: 586366.43075870269
    y: 4140780.468597685
    theta: 1.3073587567783649
    kappa: 0.00065067479166642931
    s: 19.415813211694196
2015 2016 2017
    dkappa: 0
    ddkappa: 0
  }
2018 2019
  v: 0.93718742875047911
  a: -0.19573233268834456
2020 2021 2022 2023
  relative_time: 7.1499999999999826
}
trajectory_point {
  path_point {
2024 2025 2026 2027 2028
    x: 586366.44289967371
    y: 4140780.51360828
    theta: 1.3073867570996887
    kappa: 0.00071532930378998992
    s: 19.462432487238825
2029 2030 2031
    dkappa: 0
    ddkappa: 0
  }
2032 2033
  v: 0.92767512157765708
  a: -0.18474890752729439
2034 2035 2036 2037
  relative_time: 7.1999999999999824
}
trajectory_point {
  path_point {
2038 2039 2040 2041 2042
    x: 586366.45491995208
    y: 4140780.5581730651
    theta: 1.3074152665991767
    kappa: 0.00077950469275329926
    s: 19.508589904323006
2043 2044 2045
    dkappa: 0
    ddkappa: 0
  }
2046 2047
  v: 0.91871364266747413
  a: -0.17369920218278473
2048 2049 2050 2051
  relative_time: 7.2499999999999822
}
trajectory_point {
  path_point {
2052 2053 2054 2055 2056
    x: 586366.46681901719
    y: 4140780.6023207912
    theta: 1.3074590392355818
    kappa: 0.00084626347179084162
    s: 19.5543130872101
2057 2058 2059
    dkappa: 0
    ddkappa: 0
  }
2060 2061
  v: 0.910306306029103
  a: -0.16258321665481545
2062 2063 2064 2065
  relative_time: 7.2999999999999821
}
trajectory_point {
  path_point {
2066 2067 2068 2069 2070
    x: 586366.47861230862
    y: 4140780.6460760776
    theta: 1.3075024227669099
    kappa: 0.0009124288161843759
    s: 19.599629825863932
2071 2072 2073
    dkappa: 0
    ddkappa: 0
  }
2074 2075
  v: 0.90245642567171691
  a: -0.15140095094338674
2076 2077 2078 2079
  relative_time: 7.3499999999999819
}
trajectory_point {
  path_point {
2080 2081 2082 2083 2084
    x: 586366.49030710175
    y: 4140780.6894659162
    theta: 1.3075454439560714
    kappa: 0.0009780415429964163
    s: 19.644568075948776
2085 2086 2087
    dkappa: 0
    ddkappa: 0
  }
2088 2089
  v: 0.89516731560448881
  a: -0.14015240504849841
2090 2091 2092 2093
  relative_time: 7.3999999999999817
}
trajectory_point {
  path_point {
2094 2095 2096 2097 2098
    x: 586366.50191071478
    y: 4140780.7325174608
    theta: 1.3075881297246159
    kappa: 0.0010431427112227733
    s: 19.689155958829367
2099 2100 2101
    dkappa: 0
    ddkappa: 0
  }
2102 2103
  v: 0.88844228983659157
  a: -0.12883757897015063
2104 2105 2106 2107
  relative_time: 7.4499999999999815
}
trajectory_point {
  path_point {
2108 2109 2110 2111 2112
    x: 586366.51343050925
    y: 4140780.7752580224
    theta: 1.3076305071527325
    kappa: 0.001107773621792565
    s: 19.733421761570909
2113 2114 2115
    dkappa: 0
    ddkappa: 0
  }
2116 2117
  v: 0.882284662377198
  a: -0.11745647270834331
2118 2119 2120 2121
  relative_time: 7.4999999999999813
}
trajectory_point {
  path_point {
2122 2123 2124 2125 2126
    x: 586366.524868832
    y: 4140780.8177164369
    theta: 1.3076794289230105
    kappa: 0.0011738222512511479
    s: 19.777393936939049
2127 2128 2129
    dkappa: 0
    ddkappa: 0
  }
2130 2131
  v: 0.87669774723548155
  a: -0.10600908626307642
2132 2133 2134 2135
  relative_time: 7.5499999999999812
}
trajectory_point {
  path_point {
2136 2137 2138 2139 2140
    x: 586366.53623074142
    y: 4140780.859920979
    theta: 1.3077381465793392
    kappa: 0.0012422025871250643
    s: 19.821101103399904
2141 2142 2143
    dkappa: 0
    ddkappa: 0
  }
2144 2145
  v: 0.87168485842061472
  a: -0.094495419634350042
2146 2147 2148 2149
  relative_time: 7.599999999999981
}
trajectory_point {
  path_point {
2150 2151 2152 2153 2154
    x: 586366.54753124318
    y: 4140780.9018974183
    theta: 1.3077965468841208
    kappa: 0.0013102133468305909
    s: 19.864572045120045
2155 2156 2157
    dkappa: 0
    ddkappa: 0
  }
2158 2159
  v: 0.86724930994177085
  a: -0.0829154728221641
2160 2161 2162 2163
  relative_time: 7.6499999999999808
}
trajectory_point {
  path_point {
2164 2165 2166 2167 2168
    x: 586366.55877786269
    y: 4140780.9436737085
    theta: 1.3078546687291621
    kappa: 0.0013778998227486194
    s: 19.907835711966502
2169 2170 2171
    dkappa: 0
    ddkappa: 0
  }
2172 2173
  v: 0.86339441580812282
  a: -0.071269245826518668
2174 2175 2176 2177
  relative_time: 7.6999999999999806
}
trajectory_point {
  path_point {
2178 2179 2180 2181 2182
    x: 586366.5699781687
    y: 4140780.9852779643
    theta: 1.3079125512288892
    kappa: 0.0014453075665002057
    s: 19.950921219506764
2183 2184 2185
    dkappa: 0
    ddkappa: 0
  }
2186 2187
  v: 0.86012349002884336
  a: -0.059556738647413676
2188 2189 2190 2191
  relative_time: 7.7499999999999805
}
trajectory_point {
  path_point {
2192 2193 2194 2195 2196
    x: 586366.58113977313
    y: 4140781.02673846
    theta: 1.3079702337203447
    kappa: 0.0015124823889465671
    s: 19.993857849008776
2197 2198 2199
    dkappa: 0
    ddkappa: 0
  }
2200 2201
  v: 0.85743984661310568
  a: -0.047777951284849185
2202 2203 2204 2205
  relative_time: 7.79999999999998
}
trajectory_point {
  path_point {
2206 2207 2208 2209 2210
    x: 586366.59226149938
    y: 4140781.0680860071
    theta: 1.3080374513289197
    kappa: 0.0015819519131733454
    s: 20.036675047440951
2211 2212 2213
    dkappa: 0
    ddkappa: 0
  }
2214 2215
  v: 0.85534679957008275
  a: -0.035932883738825139
2216 2217 2218 2219
  relative_time: 7.84999999999998
}
trajectory_point {
  path_point {
2220 2221 2222 2223 2224
    x: 586366.60335273843
    y: 4140781.1093487437
    theta: 1.3081123855345642
    kappa: 0.001653286840577301
    s: 20.07940242747215
2225 2226 2227
    dkappa: 0
    ddkappa: 0
  }
2228 2229
  v: 0.85384766290894754
  a: -0.024021536009341593
2230 2231 2232 2233
  relative_time: 7.89999999999998
}
trajectory_point {
  path_point {
2234 2235 2236 2237 2238
    x: 586366.614428392
    y: 4140781.150553498
    theta: 1.3081872144446953
    kappa: 0.0017245215289472668
    s: 20.122069767471697
2239 2240 2241
    dkappa: 0
    ddkappa: 0
  }
2242 2243
  v: 0.8529457506388729
  a: -0.012043908096398492
2244 2245 2246 2247
  relative_time: 7.94999999999998
}
trajectory_point {
  path_point {
2248 2249 2250 2251 2252
    x: 586366.62549623335
    y: 4140781.1917291884
    theta: 1.3082619905736301
    kappa: 0.0017957059710055358
    s: 20.164707011509375
2253 2254 2255
    dkappa: 0
    ddkappa: 0
  }
2256 2257
  v: 0.85264437676903193
  a: 4.1078251911130792e-15
2258 2259 2260 2261 2262 2263 2264 2265
  relative_time: 7.99999999999998
}
decision {
  main_decision {
    stop {
      reason_code: STOP_REASON_DESTINATION
      reason: "stop by DEST"
      stop_point {
2266 2267
        x: 586367.75164318818
        y: 4140785.4550120709
2268
      }
2269
      stop_heading: 1.3145051415984907
2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288
    }
  }
  object_decision {
    decision {
      id: "3_0"
      perception_id: 3
      object_decision {
        ignore {
        }
      }
    }
    decision {
      id: "DEST"
      perception_id: -1
      object_decision {
        stop {
          reason_code: STOP_REASON_DESTINATION
          distance_s: 0
          stop_point {
2289 2290
            x: 586367.75164318818
            y: 4140785.4550120709
2291
          }
2292
          stop_heading: 1.3145051415984907
2293 2294 2295 2296 2297
        }
      }
    }
  }
}