result_stop_dest_0.pb.txt 47.1 KB
Newer Older
1 2 3 4 5 6 7 8 9
header {
  module_name: "planning"
}
is_replan: true
gear: GEAR_DRIVE
trajectory_point {
  path_point {
    x: 586361.375698
    y: 4140761.72259
10
    z: 0
11
    theta: 1.2866508336700004
12
    kappa: 0.0057515850184131946
13 14 15
    dkappa: 0
    ddkappa: 0
  }
16
  v: 4.4250001907348633
17
  a: -0.076781849720699985
18 19 20 21
  relative_time: 0
}
trajectory_point {
  path_point {
22 23 24 25 26
    x: 586361.43751743168
    y: 4140761.934907442
    theta: 1.2881431153576008
    kappa: 0.0074017923968599363
    s: 0.22113420881112056
27 28 29
    dkappa: 0
    ddkappa: 0
  }
30 31
  v: 4.4199748968520591
  a: -0.12397363266889826
32 33 34 35
  relative_time: 0.05
}
trajectory_point {
  path_point {
36 37 38 39 40
    x: 586361.4989021708
    y: 4140762.147028619
    theta: 1.2899301043609315
    kappa: 0.00858001152110176
    s: 0.4419588038817221
41 42 43
    dkappa: 0
    ddkappa: 0
  }
44 45
  v: 4.412628454760231
  a: -0.16962777808164545
46 47 48 49
  relative_time: 0.1
}
trajectory_point {
  path_point {
50 51 52 53 54
    x: 586361.55977372348
    y: 4140762.3588567032
    theta: 1.2919157407077571
    kappa: 0.00933025618880853
    s: 0.66235964984827289
55 56 57
    dkappa: 0
    ddkappa: 0
  }
58 59
  v: 4.4030377463361523
  a: -0.21374428595894154
60 61 62 63
  relative_time: 0.15000000000000002
}
trajectory_point {
  path_point {
64 65 66 67 68
    x: 586361.6200735257
    y: 4140762.5702929273
    theta: 1.2940136847378871
    kappa: 0.0096965974618179428
    s: 0.88222645544107925
69 70 71
    dkappa: 0
    ddkappa: 0
  }
72 73
  v: 4.3912796534565945
  a: -0.2563231563007865
74 75 76 77
  relative_time: 0.2
}
trajectory_point {
  path_point {
78 79 80 81 82
    x: 586361.67976070067
    y: 4140762.7812373484
    theta: 1.2961471492808958
    kappa: 0.0097228502002747672
    s: 1.1014527734842872
83 84 85
    dkappa: 0
    ddkappa: 0
  }
86 87
  v: 4.3774310579983311
  a: -0.29736438910718038
88 89 90 91
  relative_time: 0.25
}
trajectory_point {
  path_point {
92 93 94 95 96
    x: 586361.73881000455
    y: 4140762.9915895453
    theta: 1.2982488995380068
    kappa: 0.00945232423854282
    s: 1.31993600089588
97 98 99
    dkappa: 0
    ddkappa: 0
  }
100 101
  v: 4.3615688418381335
  a: -0.33686798437812315
102 103 104 105
  relative_time: 0.3
}
trajectory_point {
  path_point {
106 107 108 109 110
    x: 586361.79720980418
    y: 4140763.2012492949
    theta: 1.3002612905048812
    kappa: 0.00892754181739973
    s: 1.537577378687681
111 112 113
    dkappa: 0
    ddkappa: 0
  }
114 115
  v: 4.3437698868527761
  a: -0.37483394211361487
116 117 118 119
  relative_time: 0.35
}
trajectory_point {
  path_point {
120 121 122 123 124
    x: 586361.85493258445
    y: 4140763.4101247839
    theta: 1.3021225434149117
    kappa: 0.0081770678125865481
    s: 1.7542819919653512
125 126 127
    dkappa: 0
    ddkappa: 0
  }
128 129
  v: 4.3241110749190295
  a: -0.41126226231365548
130 131 132 133
  relative_time: 0.39999999999999997
}
trajectory_point {
  path_point {
134 135 136 137 138
    x: 586361.91198304668
    y: 4140763.6181192687
    theta: 1.3037738864548907
    kappa: 0.0072456817102639383
    s: 1.9699587699283905
139 140 141
    dkappa: 0
    ddkappa: 0
  }
142 143
  v: 4.3026692879136679
  a: -0.446152944978245
144 145 146 147
  relative_time: 0.44999999999999996
}
trajectory_point {
  path_point {
148 149 150 151 152
    x: 586361.96843149932
    y: 4140763.8251223508
    theta: 1.3052073367509496
    kappa: 0.0061977515142901552
    s: 2.184520485870137
153 154 155
    dkappa: 0
    ddkappa: 0
  }
156 157
  v: 4.2795214077134629
  a: -0.47950599010738337
158 159 160 161
  relative_time: 0.49999999999999994
}
trajectory_point {
  path_point {
162 163 164 165 166
    x: 586362.02430411358
    y: 4140764.0310400855
    theta: 1.3064066889182717
    kappa: 0.0050706863790577622
    s: 2.3978837571777687
167 168 169
    dkappa: 0
    ddkappa: 0
  }
170 171
  v: 4.254744316195187
  a: -0.51132139770107077
172 173 174 175
  relative_time: 0.54999999999999993
}
trajectory_point {
  path_point {
176 177 178 179 180
    x: 586362.07962899283
    y: 4140764.2357821525
    theta: 1.3073633455712927
    kappa: 0.0038997767177632995
    s: 2.6099690453323015
181 182 183
    dkappa: 0
    ddkappa: 0
  }
184 185
  v: 4.2284148952356135
  a: -0.54159916775930694
186 187 188 189
  relative_time: 0.6
}
trajectory_point {
  path_point {
190 191 192 193 194
    x: 586362.13443479687
    y: 4140764.4392622043
    theta: 1.3080755339955159
    kappa: 0.00271815529545725
    s: 2.8207006559085888
195 196 197
    dkappa: 0
    ddkappa: 0
  }
198 199
  v: 4.2006100267115141
  a: -0.57033930028209223
200 201 202 203
  relative_time: 0.65
}
trajectory_point {
  path_point {
204 205 206 207 208
    x: 586362.18874932756
    y: 4140764.641398218
    theta: 1.3085460943943852
    kappa: 0.0015571544345605922
    s: 3.0300067385753233
209 210 211
    dkappa: 0
    ddkappa: 0
  }
212 213
  v: 4.1714065924996619
  a: -0.5975417952694263
214 215 216 217
  relative_time: 0.70000000000000007
}
trajectory_point {
  path_point {
218 219 220 221 222
    x: 586362.24259766866
    y: 4140764.8421129691
    theta: 1.3087307276913567
    kappa: 0.00046973675977931054
    s: 3.2378192870950389
223 224 225
    dkappa: 0
    ddkappa: 0
  }
226 227
  v: 4.1408814744768287
  a: -0.62320665272130926
228 229 230 231
  relative_time: 0.75000000000000011
}
trajectory_point {
  path_point {
232 233 234 235 236
    x: 586362.2960325022
    y: 4140765.041325877
    theta: 1.3087109069453122
    kappa: -0.00052053631579712114
    s: 3.4440741393241034
237 238 239
    dkappa: 0
    ddkappa: 0
  }
240 241
  v: 4.1091115545197878
  a: -0.64733387263774111
242 243 244 245
  relative_time: 0.80000000000000016
}
trajectory_point {
  path_point {
246 247 248 249 250
    x: 586362.34907115856
    y: 4140765.2389698392
    theta: 1.3085118820799704
    kappa: -0.0013893446033544205
    s: 3.6487109772127271
251 252 253
    dkappa: 0
    ddkappa: 0
  }
254 255
  v: 4.0761737145053125
  a: -0.66992345501872186
256 257 258 259
  relative_time: 0.8500000000000002
}
trajectory_point {
  path_point {
260 261 262 263 264
    x: 586362.401726026
    y: 4140765.4349830486
    theta: 1.3081611380958884
    kappa: -0.0021150436286312014
    s: 3.8516733268049572
265 266 267
    dkappa: 0
    ddkappa: 0
  }
268 269
  v: 4.0421448363101735
  a: -0.6909753998642516
270 271 272 273
  relative_time: 0.90000000000000024
}
trajectory_point {
  path_point {
274 275 276 277 278
    x: 586362.45400504465
    y: 4140765.6293088617
    theta: 1.3076873786890422
    kappa: -0.0026787172989801151
    s: 4.05290855823868
279 280 281
    dkappa: 0
    ddkappa: 0
  }
282 283
  v: 4.0071018018111442
  a: -0.71048970717433013
284 285 286 287
  relative_time: 0.95000000000000029
}
trajectory_point {
  path_point {
288 289 290 291 292
    x: 586362.50594336819
    y: 4140765.8218872454
    theta: 1.3071102358198687
    kappa: -0.0030031942753629554
    s: 4.2523678857456195
293 294 295
    dkappa: 0
    ddkappa: 0
  }
296 297
  v: 3.9711214928849978
  a: -0.72846637694895755
298 299 300 301
  relative_time: 1.0000000000000002
}
trajectory_point {
  path_point {
302 303 304 305 306
    x: 586362.55752332706
    y: 4140766.0126763266
    theta: 1.3065024411861761
    kappa: -0.0030946879635670552
    s: 4.4500063676513406
307 308 309
    dkappa: 0
    ddkappa: 0
  }
310 311
  v: 3.9342807914085061
  a: -0.744905409188134
312 313 314 315
  relative_time: 1.0500000000000003
}
trajectory_point {
  path_point {
316 317 318 319 320
    x: 586362.60872226441
    y: 4140766.2016395931
    theta: 1.3059078863550844
    kappa: -0.0029563701253345377
    s: 4.6457829063752447
321 322 323
    dkappa: 0
    ddkappa: 0
  }
324 325
  v: 3.8966565792584422
  a: -0.75980680389185928
326 327 328 329
  relative_time: 1.1000000000000003
}
trajectory_point {
  path_point {
330 331 332 333 334
    x: 586362.65952263132
    y: 4140766.3887431575
    theta: 1.3053608949915978
    kappa: -0.002579227859466144
    s: 4.8396602484305715
335 336 337
    dkappa: 0
    ddkappa: 0
  }
338 339
  v: 3.8583257383115779
  a: -0.77317056106013349
340 341 342 343
  relative_time: 1.1500000000000004
}
trajectory_point {
  path_point {
344 345 346 347 348
    x: 586362.70991566509
    y: 4140766.5739547219
    theta: 1.3049144172889615
    kappa: -0.00191380912916914
    s: 5.0316049844244022
349 350 351
    dkappa: 0
    ddkappa: 0
  }
352 353
  v: 3.8193651504446859
  a: -0.78499668069295647
354 355 356 357
  relative_time: 1.2000000000000004
}
trajectory_point {
  path_point {
358 359 360 361 362
    x: 586362.75986949413
    y: 4140766.7572522652
    theta: 1.304644823196391
    kappa: -0.001155343752081986
    s: 5.2215875490576531
363 364 365
    dkappa: 0
    ddkappa: 0
  }
366 367
  v: 3.7798516975345393
  a: -0.79528516279032857
368 369 370 371
  relative_time: 1.2500000000000004
}
trajectory_point {
  path_point {
372 373 374 375 376
    x: 586362.80933099834
    y: 4140766.9386235857
    theta: 1.3044937853235319
    kappa: -0.0004884744729848978
    s: 5.4095822211250821
377 378 379
    dkappa: 0
    ddkappa: 0
  }
380 381
  v: 3.7398622614579109
  a: -0.80403600735224945
382 383 384 385
  relative_time: 1.3000000000000005
}
trajectory_point {
  path_point {
386 387 388 389 390
    x: 586362.85828082717
    y: 4140767.1180512817
    theta: 1.3044453549917077
    kappa: 6.5818585129369964e-05
    s: 5.5955671235152824
391 392 393
    dkappa: 0
    ddkappa: 0
  }
394 395
  v: 3.6994737240915718
  a: -0.81124921437871933
396 397 398 399
  relative_time: 1.3500000000000005
}
trajectory_point {
  path_point {
400 401 402 403 404
    x: 586362.90669847745
    y: 4140767.295522253
    theta: 1.304498025614016
    kappa: 0.0004953456040165616
    s: 5.77952422321069
405 406 407
    dkappa: 0
    ddkappa: 0
  }
408 409
  v: 3.6587629673122963
  a: -0.816924783869738
410 411 412 413
  relative_time: 1.4000000000000006
}
trajectory_point {
  path_point {
414 415 416 417 418
    x: 586362.95455827564
    y: 4140767.471028795
    theta: 1.3046255125746846
    kappa: 0.00080904482878373075
    s: 5.9614393312875764
419 420 421
    dkappa: 0
    ddkappa: 0
  }
422 423
  v: 3.6178068729968555
  a: -0.82106271582530554
424 425 426 427
  relative_time: 1.4500000000000006
}
trajectory_point {
  path_point {
428 429 430 431 432
    x: 586363.00185566628
    y: 4140767.644561423
    theta: 1.3047917554481081
    kappa: 0.0010465549777487913
    s: 6.1413021029160531
433 434 435
    dkappa: 0
    ddkappa: 0
  }
436 437
  v: 3.5766823230220228
  a: -0.8236630102454221
438 439 440 441
  relative_time: 1.5000000000000007
}
trajectory_point {
  path_point {
442 443 444 445 446
    x: 586363.04858715262
    y: 4140767.8161143512
    theta: 1.3049889013406966
    kappa: 0.0012147838024090067
    s: 6.3191060373600694
447 448 449
    dkappa: 0
    ddkappa: 0
  }
450 451
  v: 3.5354661992645711
  a: -0.82472566713008755
452 453 454 455
  relative_time: 1.5500000000000007
}
trajectory_point {
  path_point {
456 457 458 459 460
    x: 586363.0947267462
    y: 4140767.9856918948
    theta: 1.3052128822448505
    kappa: 0.0012854223482340666
    s: 6.4948484779774134
461 462 463
    dkappa: 0
    ddkappa: 0
  }
464 465
  v: 3.4942353836012714
  a: -0.82425068647930178
466 467 468 469
  relative_time: 1.6000000000000008
}
trajectory_point {
  path_point {
470 471 472 473 474
    x: 586363.14029313368
    y: 4140768.1532901865
    theta: 1.3054382839735144
    kappa: 0.0013070175378518682
    s: 6.6685306122197119
475 476 477
    dkappa: 0
    ddkappa: 0
  }
478 479
  v: 3.4530667579088981
  a: -0.82223806829306512
480 481 482 483
  relative_time: 1.6500000000000008
}
trajectory_point {
  path_point {
484 485 486 487 488
    x: 586363.18529118027
    y: 4140768.3189131143
    theta: 1.3056624240243586
    kappa: 0.0012864701804431605
    s: 6.8401574716324314
489 490 491
    dkappa: 0
    ddkappa: 0
  }
492 493
  v: 3.4120372040642226
  a: -0.81868781257137724
494 495 496 497
  relative_time: 1.7000000000000008
}
trajectory_point {
  path_point {
498 499 500 501 502
    x: 586363.22970585432
    y: 4140768.4825739507
    theta: 1.3058735284786094
    kappa: 0.0012078510882870849
    s: 7.0097379318548754
503 504 505
    dkappa: 0
    ddkappa: 0
  }
506 507
  v: 3.371223603944018
  a: -0.81359991931423825
508 509 510 511
  relative_time: 1.7500000000000009
}
trajectory_point {
  path_point {
512 513 514 515 516
    x: 586363.2735578334
    y: 4140768.6442802493
    theta: 1.3060655118393281
    kappa: 0.0010978372900260725
    s: 7.1772847126201871
517 518 519
    dkappa: 0
    ddkappa: 0
  }
520 521
  v: 3.3307028394250562
  a: -0.80697438852164816
522 523 524 525
  relative_time: 1.8000000000000009
}
trajectory_point {
  path_point {
526 527 528 529 530
    x: 586363.31685993436
    y: 4140768.8040456958
    theta: 1.3062413865203897
    kappa: 0.00096612244981494867
    s: 7.3428143777553485
531 532 533
    dkappa: 0
    ddkappa: 0
  }
534 535
  v: 3.2905517923841106
  a: -0.798811220193607
536 537 538 539
  relative_time: 1.850000000000001
}
trajectory_point {
  path_point {
540 541 542 543 544
    x: 586363.35960491537
    y: 4140768.9618933909
    theta: 1.3063823959813168
    kappa: 0.00080321470466721218
    s: 7.5063473351811787
545 546 547
    dkappa: 0
    ddkappa: 0
  }
548 549
  v: 3.2508473446979531
  a: -0.78911041433011486
550 551 552 553
  relative_time: 1.900000000000001
}
trajectory_point {
  path_point {
554 555 556 557 558
    x: 586363.4018182155
    y: 4140769.1178415641
    theta: 1.3064971061853865
    kappa: 0.00062934739548512288
    s: 7.6679078369123372
559 560 561
    dkappa: 0
    ddkappa: 0
  }
562 563
  v: 3.2116663782433568
  a: -0.77787197093117144
564 565 566 567
  relative_time: 1.9500000000000011
}
trajectory_point {
  path_point {
568 569 570 571 572
    x: 586363.44351103937
    y: 4140769.2719162903
    theta: 1.306591435596963
    kappa: 0.0004475894721108113
    s: 7.827523979057319
573 574 575
    dkappa: 0
    ddkappa: 0
  }
576 577
  v: 3.1730857748970949
  a: -0.765095889996779
578 579 580 581
  relative_time: 2.0000000000000009
}
trajectory_point {
  path_point {
582 583 584 585 586
    x: 586363.48468630889
    y: 4140769.4241451696
    theta: 1.3066384460084759
    kappa: 0.0002584336594677672
    s: 7.9852231689082984
587 588 589
    dkappa: 0
    ddkappa: 0
  }
590 591
  v: 3.1349074703585176
  a: -0.762017744025199
592 593 594 595
  relative_time: 2.0500000000000007
}
trajectory_point {
  path_point {
596 597 598 599 600
    x: 586363.52536190348
    y: 4140769.5745357242
    theta: 1.3066664907081089
    kappa: 7.257206759469229e-05
    s: 8.1410173375836159
601 602 603
    dkappa: 0
    ddkappa: 0
  }
604 605
  v: 3.0968858552466885
  a: -0.7588283129268385
606 607 608 609
  relative_time: 2.1000000000000005
}
trajectory_point {
  path_point {
610 611 612 613 614
    x: 586363.56553888554
    y: 4140769.7230959274
    theta: 1.3066651806140293
    kappa: -0.00010914713282384877
    s: 8.2949144586610171
615 616 617
    dkappa: 0
    ddkappa: 0
  }
618 619
  v: 3.0590264938179468
  a: -0.75552759670169767
620 621 622 623
  relative_time: 2.1500000000000004
}
trajectory_point {
  path_point {
624 625 626 627 628
    x: 586363.60522698029
    y: 4140769.8698316971
    theta: 1.3066317059658168
    kappa: -0.00027748315955165745
    s: 8.4469227839310665
629 630 631
    dkappa: 0
    ddkappa: 0
  }
632 633
  v: 3.0213349503286322
  a: -0.75211559534977646
634 635 636 637
  relative_time: 2.2
}
trajectory_point {
  path_point {
638 639 640 641 642
    x: 586363.64442662941
    y: 4140770.01475175
    theta: 1.3065848790780192
    kappa: -0.00043808964885163666
    s: 8.5970508433971418
643 644 645
    dkappa: 0
    ddkappa: 0
  }
646 647
  v: 2.9838167890350826
  a: -0.74859230887107486
648 649 650 651
  relative_time: 2.25
}
trajectory_point {
  path_point {
652 653 654 655 656
    x: 586363.68315203884
    y: 4140770.1578613678
    theta: 1.3065036301965056
    kappa: -0.00057179838905571179
    s: 8.7453074452754418
657 658 659
    dkappa: 0
    ddkappa: 0
  }
660 661
  v: 2.9464775741936378
  a: -0.74495773726559289
662 663 664 665
  relative_time: 2.3
}
trajectory_point {
  path_point {
666 667 668 669 670
    x: 586363.72139918734
    y: 4140770.29917105
    theta: 1.3064132494046683
    kappa: -0.0006904924428344267
    s: 8.8917016759949785
671 672 673
    dkappa: 0
    ddkappa: 0
  }
674 675
  v: 2.9093228700606364
  a: -0.74121188053333043
676 677 678 679
  relative_time: 2.3499999999999996
}
trajectory_point {
  path_point {
680 681 682 683 684
    x: 586363.75917708536
    y: 4140770.4386880593
    theta: 1.3063056043665358
    kappa: -0.00078350541692719143
    s: 9.0362429001975837
685 686 687
    dkappa: 0
    ddkappa: 0
  }
688 689
  v: 2.8723582408924182
  a: -0.73735473867428769
690 691 692 693
  relative_time: 2.3999999999999995
}
trajectory_point {
  path_point {
694 695 696 697 698
    x: 586363.7964902994
    y: 4140770.5764211463
    theta: 1.3061888156352979
    kappa: -0.00084627853709071284
    s: 9.1789407607379054
699 700 701
    dkappa: 0
    ddkappa: 0
  }
702 703
  v: 2.8355892509453211
  a: -0.73338631168846447
704 705 706 707
  relative_time: 2.4499999999999993
}
trajectory_point {
  path_point {
708 709 710 711 712
    x: 586363.83333513862
    y: 4140770.7123815892
    theta: 1.3060667393294423
    kappa: -0.00088949178026048368
    s: 9.3198051786834064
713 714 715
    dkappa: 0
    ddkappa: 0
  }
716 717
  v: 2.7990214644756848
  a: -0.72930659957586086
718 719 720 721
  relative_time: 2.4999999999999991
}
trajectory_point {
  path_point {
722 723 724 725 726
    x: 586363.86972767068
    y: 4140770.8465755973
    theta: 1.3059432410502936
    kappa: -0.00088504250980733085
    s: 9.45884635331437
727 728 729
    dkappa: 0
    ddkappa: 0
  }
730 731
  v: 2.762660445739848
  a: -0.72511560233647687
732 733 734 735
  relative_time: 2.5499999999999989
}
trajectory_point {
  path_point {
736 737 738 739 740
    x: 586363.90565116075
    y: 4140770.9790185625
    theta: 1.3058206898508784
    kappa: -0.00087024782496173151
    s: 9.5960747621238927
741 742 743
    dkappa: 0
    ddkappa: 0
  }
744 745
  v: 2.7265117589941505
  a: -0.7208133199703125
746 747 748 749
  relative_time: 2.5999999999999988
}
trajectory_point {
  path_point {
750 751 752 753 754
    x: 586363.94113097619
    y: 4140771.1097147455
    theta: 1.3057114363297464
    kappa: -0.0007898839694939709
    s: 9.7315011608178921
755 756 757
    dkappa: 0
    ddkappa: 0
  }
758 759
  v: 2.6905809684949302
  a: -0.71639975247736776
760 761 762 763
  relative_time: 2.6499999999999986
}
trajectory_point {
  path_point {
764 765 766 767 768
    x: 586363.97614447773
    y: 4140771.238681721
    theta: 1.3056070461658946
    kappa: -0.000701500450007949
    s: 9.865136583315099
769 770 771
    dkappa: 0
    ddkappa: 0
  }
772 773
  v: 2.6548736384985268
  a: -0.71187489985764263
774 775 776 777
  relative_time: 2.6999999999999984
}
trajectory_point {
  path_point {
778 779 780 781 782
    x: 586364.01071186387
    y: 4140771.3659257255
    theta: 1.3055300185373897
    kappa: -0.00054880216979950837
    s: 9.9969923417470632
783 784 785
    dkappa: 0
    ddkappa: 0
  }
786 787
  v: 2.6193953332612794
  a: -0.707238762111137
788 789 790 791
  relative_time: 2.7499999999999982
}
trajectory_point {
  path_point {
792 793 794 795 796
    x: 586364.04481823347
    y: 4140771.4914628169
    theta: 1.305461805489071
    kappa: -0.00039627458589898586
    s: 10.127080026458151
797 798 799
    dkappa: 0
    ddkappa: 0
  }
800 801
  v: 2.5841516170395264
  a: -0.70249133923785112
802 803 804 805
  relative_time: 2.799999999999998
}
trajectory_point {
  path_point {
806 807 808 809 810
    x: 586364.07847499871
    y: 4140771.615302192
    theta: 1.3054282089073328
    kappa: -0.00023767916259789573
    s: 10.255411506005544
811 812 813
    dkappa: 0
    ddkappa: 0
  }
814 815
  v: 2.5491480540896072
  a: -0.69763263123778474
816 817 818 819
  relative_time: 2.8499999999999979
}
trajectory_point {
  path_point {
820 821 822 823 824
    x: 586364.11167514324
    y: 4140771.7374583445
    theta: 1.3054020889251861
    kappa: -9.0872160799771725e-05
    s: 10.381998927159247
825 826 827
    dkappa: 0
    ddkappa: 0
  }
828 829
  v: 2.5143902086678613
  a: -0.692662638110938
830 831 832 833
  relative_time: 2.8999999999999977
}
trajectory_point {
  path_point {
834 835 836 837 838
    x: 586364.144424052
    y: 4140771.8579426864
    theta: 1.3054024945688796
    kappa: 1.8017678153333247e-05
    s: 10.506854714902072
839 840 841
    dkappa: 0
    ddkappa: 0
  }
842 843
  v: 2.4798836450306267
  a: -0.68758135985731084
844 845 846 847
  relative_time: 2.9499999999999975
}
trajectory_point {
  path_point {
848 849 850 851 852
    x: 586364.17672156286
    y: 4140771.9767684261
    theta: 1.3054068376578329
    kappa: 0.00011862988479453647
    s: 10.629991572429656
853 854 855
    dkappa: 0
    ddkappa: 0
  }
856 857
  v: 2.4456339274342431
  a: -0.68238879647690331
858 859 860 861
  relative_time: 2.9999999999999973
}
trajectory_point {
  path_point {
862 863 864 865 866
    x: 586364.20856919151
    y: 4140772.0939486045
    theta: 1.3054290871336971
    kappa: 0.00018696167603883703
    s: 10.751422481150449
867 868 869
    dkappa: 0
    ddkappa: 0
  }
870 871
  v: 2.4116466201350497
  a: -0.67708494796971541
872 873 874 875
  relative_time: 3.0499999999999972
}
trajectory_point {
  path_point {
876 877 878 879 880
    x: 586364.2399722574
    y: 4140772.209495516
    theta: 1.3054521702764745
    kappa: 0.00025162882155149312
    s: 10.871160700685719
881 882 883
    dkappa: 0
    ddkappa: 0
  }
884 885
  v: 2.3779272873893849
  a: -0.67166981433574713
886 887 888 889
  relative_time: 3.099999999999997
}
trajectory_point {
  path_point {
890 891 892 893 894
    x: 586364.27092856541
    y: 4140772.3234237852
    theta: 1.3054866540179597
    kappa: 0.00028758924063908395
    s: 10.989219768869551
895 896 897
    dkappa: 0
    ddkappa: 0
  }
898 899
  v: 2.3444814934535883
  a: -0.66614339557499835
900 901 902 903
  relative_time: 3.1499999999999968
}
trajectory_point {
  path_point {
904 905 906 907 908
    x: 586364.30144820525
    y: 4140772.4357449878
    theta: 1.3055206513335129
    kappa: 0.00032304240385557756
    s: 11.105613501748847
909 910 911
    dkappa: 0
    ddkappa: 0
  }
912 913
  v: 2.3113148025839987
  a: -0.6605056916874692
914 915 916 917
  relative_time: 3.1999999999999966
}
trajectory_point {
  path_point {
918 919 920 921 922
    x: 586364.33152649691
    y: 4140772.5464750016
    theta: 1.3055593968940173
    kappa: 0.00033549162540689266
    s: 11.220355993583325
923 924 925
    dkappa: 0
    ddkappa: 0
  }
926 927
  v: 2.2784327790369545
  a: -0.65475670267315977
928 929 930 931
  relative_time: 3.2499999999999964
}
trajectory_point {
  path_point {
932 933 934 935 936
    x: 586364.36117511766
    y: 4140772.6556255454
    theta: 1.3055979559915649
    kappa: 0.00034618763989546981
    s: 11.333461616845522
937 938 939
    dkappa: 0
    ddkappa: 0
  }
940 941
  v: 2.2458409870687959
  a: -0.64889642853206986
942 943 944 945
  relative_time: 3.2999999999999963
}
trajectory_point {
  path_point {
946 947 948 949 950
    x: 586364.39039181557
    y: 4140772.7632124135
    theta: 1.3056361848039755
    kappa: 0.00034367867374531576
    s: 11.444945022220791
951 952 953
    dkappa: 0
    ddkappa: 0
  }
954 955
  v: 2.2135449909358611
  a: -0.64292486926419956
956 957 958 959
  relative_time: 3.3499999999999961
}
trajectory_point {
  path_point {
960 961 962 963 964
    x: 586364.41918459546
    y: 4140772.8692489015
    theta: 1.3056739521393359
    kappa: 0.00033595130429922115
    s: 11.5548211386073
965 966 967
    dkappa: 0
    ddkappa: 0
  }
968 969
  v: 2.181550354894489
  a: -0.63684202486954888
970 971 972 973
  relative_time: 3.3999999999999959
}
trajectory_point {
  path_point {
974 975 976 977 978
    x: 586364.44755660277
    y: 4140772.9737499123
    theta: 1.3057096226962783
    kappa: 0.00032288937649241714
    s: 11.663105173116037
979 980 981
    dkappa: 0
    ddkappa: 0
  }
982 983
  v: 2.1498626432010193
  a: -0.63064789534811783
984 985 986 987
  relative_time: 3.4499999999999957
}
trajectory_point {
  path_point {
988 989 990 991 992
    x: 586364.47551052063
    y: 4140773.0767307645
    theta: 1.30574260523157
    kappa: 0.00030239490961122553
    s: 11.769812611070806
993 994 995
    dkappa: 0
    ddkappa: 0
  }
996 997
  v: 2.1184874201117907
  a: -0.62434248069990628
998 999 1000 1001
  relative_time: 3.4999999999999956
}
trajectory_point {
  path_point {
1002 1003 1004 1005 1006
    x: 586364.50305527309
    y: 4140773.1782053676
    theta: 1.305774866163091
    kappa: 0.0002818662428750022
    s: 11.874959216008225
1007 1008 1009
    dkappa: 0
    ddkappa: 0
  }
1010 1011
  v: 2.0874302498831421
  a: -0.61792578092491446
1012 1013 1014 1015
  relative_time: 3.5499999999999954
}
trajectory_point {
  path_point {
1016 1017 1018 1019 1020
    x: 586364.53018848214
    y: 4140773.2781909904
    theta: 1.3058007332756691
    kappa: 0.00025337239387999223
    s: 11.978561029677735
1021 1022 1023
    dkappa: 0
    ddkappa: 0
  }
1024 1025
  v: 2.0566966967714126
  a: -0.61139779602314215
1026 1027 1028 1029
  relative_time: 3.5999999999999952
}
trajectory_point {
  path_point {
1030 1031 1032 1033 1034
    x: 586364.55692138628
    y: 4140773.3767014928
    theta: 1.3058262187623151
    kappa: 0.00022529892392115971
    s: 12.080634372041587
1035 1036 1037
    dkappa: 0
    ddkappa: 0
  }
1038 1039
  v: 2.0262923250329408
  a: -0.60475852599458957
1040 1041 1042 1043
  relative_time: 3.649999999999995
}
trajectory_point {
  path_point {
1044 1045 1046 1047 1048
    x: 586364.583255354
    y: 4140773.4737537014
    theta: 1.3058469372274395
    kappa: 0.00019501547847605464
    s: 12.181195841274853
1049 1050 1051
    dkappa: 0
    ddkappa: 0
  }
1052 1053
  v: 1.9962226989240666
  a: -0.5980079708392565
1054 1055 1056 1057
  relative_time: 3.6999999999999948
}
trajectory_point {
  path_point {
1058 1059 1060 1061 1062
    x: 586364.60919564776
    y: 4140773.5693636751
    theta: 1.3058641344211472
    kappa: 0.00016326009368749562
    s: 12.280262313765427
1063 1064 1065
    dkappa: 0
    ddkappa: 0
  }
1066 1067
  v: 1.9664933827011284
  a: -0.591146130557143
1068 1069 1070 1071
  relative_time: 3.7499999999999947
}
trajectory_point {
  path_point {
1072 1073 1074 1075 1076
    x: 586364.634748915
    y: 4140773.6635473859
    theta: 1.3058809273810372
    kappa: 0.00013195733924349529
    s: 12.377850944114005
1077 1078 1079
    dkappa: 0
    ddkappa: 0
  }
1080 1081
  v: 1.9371099406204653
  a: -0.58417300514824921
1082 1083 1084 1085
  relative_time: 3.7999999999999945
}
trajectory_point {
  path_point {
1086 1087 1088 1089 1090
    x: 586364.65991673246
    y: 4140773.7563224682
    theta: 1.3058896263934312
    kappa: 0.00010000331026451545
    s: 12.473979165134114
1091 1092 1093
    dkappa: 0
    ddkappa: 0
  }
1094 1095
  v: 1.9080779369384167
  a: -0.577088594612575
1096 1097 1098 1099
  relative_time: 3.8499999999999943
}
trajectory_point {
  path_point {
1100 1101 1102 1103 1104
    x: 586364.6847068296
    y: 4140773.8477051761
    theta: 1.3058981948505084
    kappa: 6.8528849333970482e-05
    s: 12.568664687852095
1105 1106 1107
    dkappa: 0
    ddkappa: 0
  }
1108 1109
  v: 1.8794029359113211
  a: -0.5698928989501203
1110 1111 1112 1113
  relative_time: 3.8999999999999941
}
trajectory_point {
  path_point {
1114 1115 1116 1117 1118
    x: 586364.709123513
    y: 4140773.9377129804
    theta: 1.3059038953552016
    kappa: 3.8156752746602476e-05
    s: 12.6619255015071
1119 1120 1121
    dkappa: 0
    ddkappa: 0
  }
1122 1123
  v: 1.8510905017955177
  a: -0.56258591816088532
1124 1125 1126 1127
  relative_time: 3.949999999999994
}
trajectory_point {
  path_point {
1128 1129 1130 1131 1132
    x: 586364.73317125812
    y: 4140774.0263635954
    theta: 1.3059046482273982
    kappa: 9.3587432639294473e-06
    s: 12.753779873551107
1133 1134 1135
    dkappa: 0
    ddkappa: 0
  }
1136 1137
  v: 1.8231461988473459
  a: -0.55516765224486986
1138 1139 1140 1141
  relative_time: 3.9999999999999938
}
trajectory_point {
  path_point {
1142 1143 1144 1145 1146
    x: 586364.75685556722
    y: 4140774.1136744241
    theta: 1.3059053897213497
    kappa: -1.9004038542251818e-05
    s: 12.844246039755943
1147 1148 1149
    dkappa: 0
    ddkappa: 0
  }
1150 1151
  v: 1.7955567910774797
  a: -0.548406644485107
1152 1153 1154 1155
  relative_time: 4.0499999999999936
}
trajectory_point {
  path_point {
1156 1157 1158 1159 1160
    x: 586364.780181333
    y: 4140774.199661951
    theta: 1.3059022941075469
    kappa: -4.4434912369978438e-05
    s: 12.933341191867148
1161 1162 1163
    dkappa: 0
    ddkappa: 0
  }
1164 1165
  v: 1.7683057358053325
  a: -0.54163355233586752
1166 1167 1168 1169
  relative_time: 4.0999999999999934
}
trajectory_point {
  path_point {
1170 1171 1172 1173 1174
    x: 586364.8031528641
    y: 4140774.2843425525
    theta: 1.305896573589743
    kappa: -6.7731861892229061e-05
    s: 13.021082262615096
1175 1176 1177
    dkappa: 0
    ddkappa: 0
  }
1178 1179
  v: 1.7413936372503844
  a: -0.53484837579715017
1180 1181 1182 1183
  relative_time: 4.1499999999999932
}
trajectory_point {
  path_point {
1184 1185 1186 1187 1188
    x: 586364.82577432378
    y: 4140774.3677326753
    theta: 1.3058909402490122
    kappa: -9.0673780639097e-05
    s: 13.107486214941131
1189 1190 1191
    dkappa: 0
    ddkappa: 0
  }
1192 1193
  v: 1.7148210996321089
  a: -0.52805111486895484
1194 1195 1196 1197
  relative_time: 4.1999999999999931
}
trajectory_point {
  path_point {
1198 1199 1200 1201 1202
    x: 586364.84805151878
    y: 4140774.4498483511
    theta: 1.305881913268538
    kappa: -0.00010904971826985411
    s: 13.192570041997575
1203 1204 1205
    dkappa: 0
    ddkappa: 0
  }
1206 1207
  v: 1.6885887271699804
  a: -0.52124176955128165
1208 1209 1210 1211
  relative_time: 4.2499999999999929
}
trajectory_point {
  path_point {
1212 1213 1214 1215 1216
    x: 586364.86998812552
    y: 4140774.5307062212
    theta: 1.3058714917902767
    kappa: -0.00012528738209185609
    s: 13.276350767147722
1217 1218 1219
    dkappa: 0
    ddkappa: 0
  }
1220 1221
  v: 1.6626971240834723
  a: -0.51442033984413049
1222 1223 1224 1225
  relative_time: 4.2999999999999927
}
trajectory_point {
  path_point {
1226 1227 1228 1229 1230
    x: 586364.89158800174
    y: 4140774.6103229094
    theta: 1.3058612302834738
    kappa: -0.00014127579502187904
    s: 13.358845443965841
1231 1232 1233
    dkappa: 0
    ddkappa: 0
  }
1234 1235
  v: 1.6371468945920589
  a: -0.50758682574750136
1236 1237 1238 1239
  relative_time: 4.3499999999999925
}
trajectory_point {
  path_point {
1240 1241 1242 1243 1244
    x: 586364.9128575268
    y: 4140774.6887143864
    theta: 1.3058491835043122
    kappa: -0.00015186247613603216
    s: 13.44007115623717
1245 1246 1247
    dkappa: 0
    ddkappa: 0
  }
1248 1249
  v: 1.6119386429152136
  a: -0.50074122726139436
1250 1251 1252 1253
  relative_time: 4.3999999999999924
}
trajectory_point {
  path_point {
1254 1255 1256 1257 1258
    x: 586364.93380020733
    y: 4140774.7658974328
    theta: 1.305836342677603
    kappa: -0.00015968646624900016
    s: 13.520045017957928
1259 1260 1261
    dkappa: 0
    ddkappa: 0
  }
1262 1263
  v: 1.5870729732724107
  a: -0.49388354438580939
1264 1265 1266 1267
  relative_time: 4.4499999999999922
}
trajectory_point {
  path_point {
1268 1269 1270 1271 1272
    x: 586364.95441955654
    y: 4140774.8418888608
    theta: 1.3058237000987947
    kappa: -0.00016738966276747138
    s: 13.598784173335304
1273 1274 1275
    dkappa: 0
    ddkappa: 0
  }
1276 1277
  v: 1.5625504898831242
  a: -0.48701377712074656
1278 1279 1280 1281
  relative_time: 4.499999999999992
}
trajectory_point {
  path_point {
1282 1283 1284 1285 1286
    x: 586364.97472160892
    y: 4140774.9167048265
    theta: 1.3058108142519862
    kappa: -0.00017073172117795636
    s: 13.676305796787457
1287 1288 1289
    dkappa: 0
    ddkappa: 0
  }
1290 1291
  v: 1.5383717969668276
  a: -0.48013192546620576
1292 1293 1294 1295
  relative_time: 4.5499999999999918
}
trajectory_point {
  path_point {
1296 1297 1298 1299 1300
    x: 586364.99471093423
    y: 4140774.9903619182
    theta: 1.3057976640945841
    kappa: -0.00016953758746756503
    s: 13.752627092943527
1301 1302 1303
    dkappa: 0
    ddkappa: 0
  }
1304 1305
  v: 1.5145374987429951
  a: -0.47323798942218703
1306 1307 1308 1309
  relative_time: 4.5999999999999917
}
trajectory_point {
  path_point {
1310 1311 1312 1313 1314
    x: 586365.01439039549
    y: 4140775.0628772159
    theta: 1.3057847177839816
    kappa: -0.00016836196458777208
    s: 13.827765296643621
1315 1316 1317
    dkappa: 0
    ddkappa: 0
  }
1318 1319
  v: 1.4910481994311005
  a: -0.46633196898869034
1320 1321 1322 1323
  relative_time: 4.6499999999999915
}
trajectory_point {
  path_point {
1324 1325 1326 1327 1328
    x: 586365.03376492427
    y: 4140775.1342672715
    theta: 1.3057721856904845
    kappa: -0.00016586338285778132
    s: 13.901737672938825
1329 1330 1331
    dkappa: 0
    ddkappa: 0
  }
1332 1333
  v: 1.4679045032506175
  a: -0.45941386416571584
1334 1335 1336 1337
  relative_time: 4.6999999999999913
}
trajectory_point {
  path_point {
1338 1339 1340 1341 1342
    x: 586365.0528411445
    y: 4140775.204548209
    theta: 1.3057611548975485
    kappa: -0.00015518885843686652
    s: 13.974561517091198
1343 1344 1345
    dkappa: 0
    ddkappa: 0
  }
1346 1347
  v: 1.4451070144210203
  a: -0.4524836749532633
1348 1349 1350 1351
  relative_time: 4.7499999999999911
}
trajectory_point {
  path_point {
1352 1353 1354 1355 1356
    x: 586365.07162104477
    y: 4140775.273737439
    theta: 1.3057502954510523
    kappa: -0.00014468014637263887
    s: 14.046254154573766
1357 1358 1359
    dkappa: 0
    ddkappa: 0
  }
1360 1361
  v: 1.4226563371617826
  a: -0.44554140135133291
1362 1363 1364 1365
  relative_time: 4.7999999999999909
}
trajectory_point {
  path_point {
1366 1367 1368 1369 1370
    x: 586365.09010917158
    y: 4140775.3418517131
    theta: 1.3057396047220935
    kappa: -0.00013433470266766259
    s: 14.116832941070539
1371 1372 1373
    dkappa: 0
    ddkappa: 0
  }
1374 1375
  v: 1.4005530756923785
  a: -0.43858704335992454
1376 1377 1378 1379
  relative_time: 4.8499999999999908
}
trajectory_point {
  path_point {
1380 1381 1382 1383 1384
    x: 586365.10831139237
    y: 4140775.4089074521
    theta: 1.3057313886688438
    kappa: -0.00011807227757512723
    s: 14.186315262476493
1385 1386 1387
    dkappa: 0
    ddkappa: 0
  }
1388 1389
  v: 1.3787978342322817
  a: -0.43162060097903832
1390 1391 1392 1393
  relative_time: 4.8999999999999906
}
trajectory_point {
  path_point {
1394 1395 1396 1397 1398
    x: 586365.12623176887
    y: 4140775.4749216
    theta: 1.3057247650841828
    kappa: -9.8205910968867017e-05
    s: 14.254718534897579
1399 1400 1401
    dkappa: 0
    ddkappa: 0
  }
1402 1403
  v: 1.3573912170009661
  a: -0.42464207420867411
1404 1405 1406 1407
  relative_time: 4.94999999999999
}
trajectory_point {
  path_point {
1408 1409 1410 1411 1412
    x: 586365.14387402532
    y: 4140775.5399112245
    theta: 1.3057182442959947
    kappa: -7.8647865690593247e-05
    s: 14.322060204650725
1413 1414 1415
    dkappa: 0
    ddkappa: 0
  }
1416 1417
  v: 1.3363338282179056
  a: -0.41765146304883194
1418 1419 1420 1421
  relative_time: 4.99999999999999
}
trajectory_point {
  path_point {
1422 1423 1424 1425 1426
    x: 586365.16124274035
    y: 4140775.6038931911
    theta: 1.3057118246120034
    kappa: -5.9393066031235254e-05
    s: 14.388357748263832
1427 1428 1429
    dkappa: 0
    ddkappa: 0
  }
1430 1431
  v: 1.3156262721025742
  a: -0.41064876749951196
1432 1433 1434 1435
  relative_time: 5.04999999999999
}
trajectory_point {
  path_point {
1436 1437 1438 1439 1440
    x: 586365.17834326217
    y: 4140775.6668841885
    theta: 1.3057107717151069
    kappa: -3.1627444670421057e-05
    s: 14.453628672475769
1441 1442 1443
    dkappa: 0
    ddkappa: 0
  }
1444 1445
  v: 1.295269152874446
  a: -0.403633987560714
1446 1447 1448 1449
  relative_time: 5.09999999999999
}
trajectory_point {
  path_point {
1450 1451 1452 1453 1454
    x: 586365.19517952041
    y: 4140775.7289013211
    theta: 1.3057104883417052
    kappa: -3.0313747440803531e-06
    s: 14.517890514236388
1455 1456 1457
    dkappa: 0
    ddkappa: 0
  }
1458 1459
  v: 1.2752630747529943
  a: -0.39660712323243807
1460 1461 1462 1463
  relative_time: 5.14999999999999
}
trajectory_point {
  path_point {
1464 1465 1466 1467 1468
    x: 586365.211756007
    y: 4140775.7899615718
    theta: 1.305710209340557
    kappa: 2.5123477815881872e-05
    s: 14.581160840706504
1469 1470 1471
    dkappa: 0
    ddkappa: 0
  }
1472 1473
  v: 1.2556086419576937
  a: -0.38956817451468428
1474 1475 1476 1477
  relative_time: 5.1999999999999895
}
trajectory_point {
  path_point {
1478 1479 1480 1481 1482
    x: 586365.22807733237
    y: 4140775.8500819253
    theta: 1.3057099346340639
    kappa: 5.2844943716783035e-05
    s: 14.643457249257917
1483 1484 1485
    dkappa: 0
    ddkappa: 0
  }
1486 1487
  v: 1.2363064587080173
  a: -0.38251714140745252
1488 1489 1490 1491
  relative_time: 5.2499999999999893
}
trajectory_point {
  path_point {
1492 1493 1494 1495 1496
    x: 586365.2441472786
    y: 4140775.9092796184
    theta: 1.3057170811156837
    kappa: 8.9149178463394571e-05
    s: 14.704797367473391
1497 1498 1499
    dkappa: 0
    ddkappa: 0
  }
1500 1501
  v: 1.2173571292234397
  a: -0.3754540239107429
1502 1503 1504 1505
  relative_time: 5.2999999999999892
}
trajectory_point {
  path_point {
1506 1507 1508 1509 1510
    x: 586365.25997123565
    y: 4140775.9675714867
    theta: 1.3057248736210096
    kappa: 0.00012581533180350057
    s: 14.76519885314667
1511 1512 1513
    dkappa: 0
    ddkappa: 0
  }
1514 1515
  v: 1.1987612577234346
  a: -0.3683788220245553
1516 1517 1518 1519
  relative_time: 5.349999999999989
}
trajectory_point {
  path_point {
1520 1521 1522 1523 1524
    x: 586365.275553924
    y: 4140776.0249745753
    theta: 1.3057325473136088
    kappa: 0.00016192243443065508
    s: 14.824679394282468
1525 1526 1527
    dkappa: 0
    ddkappa: 0
  }
1528 1529
  v: 1.1805194484274755
  a: -0.36129153574888978
1530 1531 1532 1533
  relative_time: 5.3999999999999888
}
trajectory_point {
  path_point {
1534 1535 1536 1537 1538
    x: 586365.29089998559
    y: 4140776.0815059841
    theta: 1.3057401044793395
    kappa: 0.00019748124202091693
    s: 14.883256709096475
1539 1540 1541
    dkappa: 0
    ddkappa: 0
  }
1542 1543
  v: 1.1626323055550369
  a: -0.35419216508374629
1544 1545 1546 1547
  relative_time: 5.4499999999999886
}
trajectory_point {
  path_point {
1548 1549 1550 1551 1552
    x: 586365.30601210683
    y: 4140776.1371833752
    theta: 1.3057542648238087
    kappa: 0.00023726094744678882
    s: 14.940948546015354
1553 1554 1555
    dkappa: 0
    ddkappa: 0
  }
1556 1557
  v: 1.1451004333255925
  a: -0.347080710029125
1558 1559 1560 1561
  relative_time: 5.4999999999999885
}
trajectory_point {
  path_point {
1562 1563 1564 1565 1566
    x: 586365.32089602377
    y: 4140776.1920236126
    theta: 1.3057713406732927
    kappa: 0.000278658479219143
    s: 14.997772683676743
1567 1568 1569
    dkappa: 0
    ddkappa: 0
  }
1570 1571
  v: 1.127924435958616
  a: -0.33995717058502567
1572 1573 1574 1575
  relative_time: 5.5499999999999883
}
trajectory_point {
  path_point {
1576 1577 1578 1579 1580
    x: 586365.33555732935
    y: 4140776.2460436318
    theta: 1.3057881611277808
    kappa: 0.000319436848666247
    s: 15.053746930929249
1581 1582 1583
    dkappa: 0
    ddkappa: 0
  }
1584 1585
  v: 1.1111049176735812
  a: -0.33282154675144848
1586 1587 1588 1589
  relative_time: 5.5999999999999881
}
trajectory_point {
  path_point {
1590 1591 1592 1593 1594
    x: 586365.35000069614
    y: 4140776.2992606489
    theta: 1.3058047315479626
    kappa: 0.00035960905190324477
    s: 15.108889126832457
1595 1596 1597
    dkappa: 0
    ddkappa: 0
  }
1598 1599
  v: 1.0946424826899626
  a: -0.32567383852839338
1600 1601 1602 1603
  relative_time: 5.6499999999999879
}
trajectory_point {
  path_point {
1604 1605 1606 1607 1608
    x: 586365.36422995641
    y: 4140776.3516921396
    theta: 1.3058223791039094
    kappa: 0.00039591201937996909
    s: 15.163217140656926
1609 1610 1611
    dkappa: 0
    ddkappa: 0
  }
1612 1613
  v: 1.0785377352272334
  a: -0.31851404591586024
1614 1615 1616 1617
  relative_time: 5.6999999999999877
}
trajectory_point {
  path_point {
1618 1619 1620 1621 1622
    x: 586365.37824637466
    y: 4140776.4033563081
    theta: 1.3058464448424973
    kappa: 0.00041513431543040434
    s: 15.216748871884185
1623 1624 1625
    dkappa: 0
    ddkappa: 0
  }
1626 1627
  v: 1.062791279504868
  a: -0.3113421689138493
1628 1629 1630 1631
  relative_time: 5.7499999999999876
}
trajectory_point {
  path_point {
1632 1633 1634 1635 1636
    x: 586365.39205899369
    y: 4140776.4542692774
    theta: 1.30587016066459
    kappa: 0.00043407711874591571
    s: 15.269502250206742
1637 1638 1639
    dkappa: 0
    ddkappa: 0
  }
1640 1641
  v: 1.0474037197423398
  a: -0.30415820752236034
1642 1643 1644 1645
  relative_time: 5.7999999999999874
}
trajectory_point {
  path_point {
1646 1647 1648 1649 1650
    x: 586365.40567251609
    y: 4140776.5044483822
    theta: 1.3058935346442182
    kappa: 0.00045274687840957638
    s: 15.321495235528076
1651 1652 1653
    dkappa: 0
    ddkappa: 0
  }
1654 1655
  v: 1.0323756601591234
  a: -0.29696216174139356
1656 1657 1658 1659
  relative_time: 5.8499999999999872
}
trajectory_point {
  path_point {
1660 1661 1662 1663 1664
    x: 586365.41909165238
    y: 4140776.5539109842
    theta: 1.3059165748689976
    kappa: 0.0004711500543526825
    s: 15.372745817962635
1665 1666 1667
    dkappa: 0
    ddkappa: 0
  }
1668 1669
  v: 1.0177077049746921
  a: -0.28975403157094876
1670 1671 1672 1673
  relative_time: 5.899999999999987
}
trajectory_point {
  path_point {
1674 1675 1676 1677 1678
    x: 586365.43231926416
    y: 4140776.6026749783
    theta: 1.3059397420769507
    kappa: 0.00048137198683082048
    s: 15.423272017835849
1679 1680 1681
    dkappa: 0
    ddkappa: 0
  }
1682 1683
  v: 1.0034004584085197
  a: -0.28253381701102609
1684 1685 1686 1687
  relative_time: 5.9499999999999869
}
trajectory_point {
  path_point {
1688 1689 1690 1691 1692
    x: 586365.44535813457
    y: 4140776.650758313
    theta: 1.3059635182263674
    kappa: 0.00047512691207154571
    s: 15.473091885684115
1693 1694 1695
    dkappa: 0
    ddkappa: 0
  }
1696 1697
  v: 0.98945452468008077
  a: -0.27530151806162551
1698 1699 1700 1701
  relative_time: 5.9999999999999867
}
trajectory_point {
  path_point {
1702 1703 1704 1705 1706
    x: 586365.45821689826
    y: 4140776.69817747
    theta: 1.3059869659545524
    kappa: 0.00046896810087445847
    s: 15.522223588949256
1707 1708 1709
    dkappa: 0
    ddkappa: 0
  }
1710 1711
  v: 0.97587562470128453
  a: -0.26785926498030488
1712 1713 1714 1715
  relative_time: 6.0499999999999865
}
trajectory_point {
  path_point {
1716 1717 1718 1719 1720
    x: 586365.47090039984
    y: 4140776.744950315
    theta: 1.3060100940954449
    kappa: 0.00046289323289846383
    s: 15.570685638072085
1721 1722 1723
    dkappa: 0
    ddkappa: 0
  }
1724 1725
  v: 0.96266811979305256
  a: -0.26044571523897303
1726 1727 1728 1729
  relative_time: 6.0999999999999863
}
trajectory_point {
  path_point {
1730 1731 1732 1733 1734
    x: 586365.48341349012
    y: 4140776.7910947348
    theta: 1.3060329114941696
    kappa: 0.00045689998486500056
    s: 15.618496566926954
1735 1736 1737
    dkappa: 0
    ddkappa: 0
  }
1738 1739
  v: 0.9498305747883875
  a: -0.2530608688376299
1740 1741 1742 1743
  relative_time: 6.1499999999999861
}
trajectory_point {
  path_point {
1744 1745 1746 1747 1748
    x: 586365.49576032453
    y: 4140776.8366287323
    theta: 1.3060549208056509
    kappa: 0.000448739164670687
    s: 15.665674837629865
1749 1750 1751
    dkappa: 0
    ddkappa: 0
  }
1752 1753
  v: 0.9373615545202898
  a: -0.24570472577627553
1754 1755 1756 1757
  relative_time: 6.199999999999986
}
trajectory_point {
  path_point {
1758 1759 1760 1761 1762
    x: 586365.507941976
    y: 4140776.8815710703
    theta: 1.3060733312027748
    kappa: 0.00042598074071003271
    s: 15.712238840538475
1763 1764 1765
    dkappa: 0
    ddkappa: 0
  }
1766 1767
  v: 0.92525962382176019
  a: -0.23837728605490985
1768 1769 1770 1771
  relative_time: 6.2499999999999858
}
trajectory_point {
  path_point {
1772 1773 1774 1775 1776
    x: 586365.51996772038
    y: 4140776.9259382137
    theta: 1.3060915059745282
    kappa: 0.0004035135903425326
    s: 15.758206894252085
1777 1778 1779
    dkappa: 0
    ddkappa: 0
  }
1780 1781
  v: 0.91352334752579911
  a: -0.23107854967353286
1782 1783 1784 1785
  relative_time: 6.2999999999999856
}
trajectory_point {
  path_point {
1786 1787 1788 1789 1790
    x: 586365.53184233163
    y: 4140776.9697477743
    theta: 1.3061094523353036
    kappa: 0.00038132879531983105
    s: 15.803597245611648
1791 1792 1793
    dkappa: 0
    ddkappa: 0
  }
1794 1795
  v: 0.90215129046540721
  a: -0.22380851663214463
1796 1797 1798 1799
  relative_time: 6.3499999999999854
}
trajectory_point {
  path_point {
1800 1801 1802 1803 1804
    x: 586365.54357056459
    y: 4140777.013017294
    theta: 1.3061271774711232
    kappa: 0.0003594174724658786
    s: 15.848428069699768
1805 1806 1807
    dkappa: 0
    ddkappa: 0
  }
1808 1809
  v: 0.8911420174735849
  a: -0.21656718693074509
1810 1811 1812 1813
  relative_time: 6.3999999999999853
}
trajectory_point {
  path_point {
1814 1815 1816 1817 1818
    x: 586365.555157155
    y: 4140777.0557642458
    theta: 1.3061446885396379
    kappa: 0.000337770773676931
    s: 15.892717469840699
1819 1820 1821
    dkappa: 0
    ddkappa: 0
  }
1822 1823
  v: 0.880494093383333
  a: -0.20935456056933427
1824 1825 1826 1827
  relative_time: 6.4499999999999851
}
trajectory_point {
  path_point {
1828 1829 1830 1831 1832
    x: 586365.56660490972
    y: 4140777.0980065512
    theta: 1.3061582136651357
    kappa: 0.00031052513825540135
    s: 15.936483477600344
1833 1834 1835
    dkappa: 0
    ddkappa: 0
  }
1836 1837
  v: 0.87020608302765179
  a: -0.20217063754791215
1838 1839 1840 1841
  relative_time: 6.4999999999999849
}
trajectory_point {
  path_point {
1842 1843 1844 1845 1846
    x: 586365.57791896374
    y: 4140777.1397614256
    theta: 1.3061686235471908
    kappa: 0.00027900974680275363
    s: 15.979744052786256
1847 1848 1849
    dkappa: 0
    ddkappa: 0
  }
1850 1851
  v: 0.860276551239542
  a: -0.19501541786647877
1852 1853 1854 1855
  relative_time: 6.5499999999999847
}
trajectory_point {
  path_point {
1856 1857 1858 1859 1860
    x: 586365.58910550911
    y: 4140777.181045725
    theta: 1.3061789161103976
    kappa: 0.00024784953223980455
    s: 16.022517083447639
1861 1862 1863
    dkappa: 0
    ddkappa: 0
  }
1864 1865
  v: 0.85070406285200417
  a: -0.18788890152503412
1866 1867 1868 1869
  relative_time: 6.5999999999999845
}
trajectory_point {
  path_point {
1870 1871 1872 1873 1874
    x: 586365.60016920511
    y: 4140777.2218766445
    theta: 1.3061890956419246
    kappa: 0.00021703151537295394
    s: 16.06482038587535
1875 1876 1877
    dkappa: 0
    ddkappa: 0
  }
1878 1879
  v: 0.84148718269803879
  a: -0.18079108852357817
1880 1881 1882 1883
  relative_time: 6.6499999999999844
}
trajectory_point {
  path_point {
1884 1885 1886 1887 1888
    x: 586365.61111469253
    y: 4140777.2622713121
    theta: 1.3061991664116734
    kappa: 0.00018654276928467138
    s: 16.106671704601887
1889 1890 1891
    dkappa: 0
    ddkappa: 0
  }
1892 1893
  v: 0.83262447561064656
  a: -0.17372197886211094
1894 1895 1896 1897
  relative_time: 6.6999999999999842
}
trajectory_point {
  path_point {
1898 1899 1900 1901 1902
    x: 586365.62194659351
    y: 4140777.3022467857
    theta: 1.3062091326722787
    kappa: 0.00015637041933347779
    s: 16.148088712401407
1903 1904 1905
    dkappa: 0
    ddkappa: 0
  }
1906 1907
  v: 0.824114506422828
  a: -0.16668157254063243
1908 1909 1910 1911
  relative_time: 6.749999999999984
}
trajectory_point {
  path_point {
1912 1913 1914 1915 1916
    x: 586365.63266866293
    y: 4140777.3418202829
    theta: 1.3062140254870924
    kappa: 0.00012324594000215466
    s: 16.189089010289713
1917 1918 1919
    dkappa: 0
    ddkappa: 0
  }
1920 1921
  v: 0.81595583996758358
  a: -0.15966986955914259
1922 1923 1924 1925
  relative_time: 6.7999999999999838
}
trajectory_point {
  path_point {
1926 1927 1928 1929 1930
    x: 586365.64328577323
    y: 4140777.3810086437
    theta: 1.3062155390125227
    kappa: 8.8262884779405357e-05
    s: 16.229690127524258
1931 1932 1933
    dkappa: 0
    ddkappa: 0
  }
1934 1935
  v: 0.808147041077914
  a: -0.15268686991764152
1936 1937 1938 1939
  relative_time: 6.8499999999999837
}
trajectory_point {
  path_point {
1940 1941 1942 1943 1944
    x: 586365.65380306391
    y: 4140777.4198285649
    theta: 1.3062170383081058
    kappa: 5.360873287530186e-05
    s: 16.269909521604145
1945 1946 1947
    dkappa: 0
    ddkappa: 0
  }
1948 1949
  v: 0.80068667458681975
  a: -0.14573257361612915
1950 1951 1952 1953
  relative_time: 6.8999999999999835
}
trajectory_point {
  path_point {
1954 1955 1956 1957 1958
    x: 586365.6642250811
    y: 4140777.4582968256
    theta: 1.3062185240219457
    kappa: 1.9268504250612273e-05
    s: 16.309764578270133
1959 1960 1961
    dkappa: 0
    ddkappa: 0
  }
1962 1963
  v: 0.7935733053273013
  a: -0.13880698065460548
1964 1965 1966 1967
  relative_time: 6.9499999999999833
}
trajectory_point {
  path_point {
1968 1969 1970 1971 1972
    x: 586365.67455635231
    y: 4140777.4964301386
    theta: 1.3062199967994719
    kappa: -1.4772719304889577e-05
    s: 16.34927261150462
1973 1974 1975
    dkappa: 0
    ddkappa: 0
  }
1976 1977
  v: 0.78680549813235934
  a: -0.13191009103307055
1978 1979 1980 1981
  relative_time: 6.9999999999999831
}
trajectory_point {
  path_point {
1982 1983 1984 1985 1986
    x: 586365.68480138632
    y: 4140777.5342451446
    theta: 1.3062214572834387
    kappa: -4.8529794172439653e-05
    s: 16.388450863531659
1987 1988 1989
    dkappa: 0
    ddkappa: 0
  }
1990 1991
  v: 0.7803818178349945
  a: -0.12504190475152435
1992 1993 1994 1995
  relative_time: 7.0499999999999829
}
trajectory_point {
  path_point {
1996 1997 1998 1999 2000
    x: 586365.694964859
    y: 4140777.5717583676
    theta: 1.3062206365024069
    kappa: -8.2359633808726465e-05
    s: 16.427316504816961
2001 2002 2003
    dkappa: 0
    ddkappa: 0
  }
2004 2005
  v: 0.7743008292682072
  a: -0.11820242180996685
2006 2007 2008 2009
  relative_time: 7.0999999999999828
}
trajectory_point {
  path_point {
2010 2011 2012 2013 2014
    x: 586365.7050515787
    y: 4140777.6089862194
    theta: 1.3062134183506171
    kappa: -0.00011689752456425804
    s: 16.465886634067875
2015 2016 2017
    dkappa: 0
    ddkappa: 0
  }
2018 2019
  v: 0.76856109726499811
  a: -0.11139164220839806
2020 2021 2022 2023
  relative_time: 7.1499999999999826
}
trajectory_point {
  path_point {
2024 2025 2026 2027 2028
    x: 586365.71506546985
    y: 4140777.645945278
    theta: 1.3062062523155196
    kappa: -0.00015118604391132218
    s: 16.504178278233404
2029 2030 2031
    dkappa: 0
    ddkappa: 0
  }
2032 2033
  v: 0.76316118665836763
  a: -0.10460956594681797
2034 2035 2036 2037
  relative_time: 7.1999999999999824
}
trajectory_point {
  path_point {
2038 2039 2040 2041 2042
    x: 586365.72501096665
    y: 4140777.6826519081
    theta: 1.3061991352240603
    kappa: -0.00018524037449343052
    s: 16.542208392504204
2043 2044 2045
    dkappa: 0
    ddkappa: 0
  }
2046 2047
  v: 0.75809966228131642
  a: -0.0978561930252266
2048 2049 2050 2051
  relative_time: 7.2499999999999822
}
trajectory_point {
  path_point {
2052 2053 2054 2055 2056
    x: 586365.7348924845
    y: 4140777.7191224052
    theta: 1.306192063916614
    kappa: -0.00021907563469757705
    s: 16.579993860312577
2057 2058 2059
    dkappa: 0
    ddkappa: 0
  }
2060 2061
  v: 0.75337508896684513
  a: -0.091131523443623991
2062 2063 2064 2065
  relative_time: 7.2999999999999821
}
trajectory_point {
  path_point {
2066 2067 2068 2069 2070
    x: 586365.74471441971
    y: 4140777.7553729969
    theta: 1.3061850352469848
    kappa: -0.00025270687865424778
    s: 16.617551493332481
2071 2072 2073
    dkappa: 0
    ddkappa: 0
  }
2074 2075
  v: 0.74898603154795429
  a: -0.08443555720201007
2076 2077 2078 2079
  relative_time: 7.3499999999999819
}
trajectory_point {
  path_point {
2080 2081 2082 2083 2084
    x: 586365.75448115019
    y: 4140777.79141984
    theta: 1.3061780460824055
    kappa: -0.00028614909623740468
    s: 16.654898031479515
2085 2086 2087
    dkappa: 0
    ddkappa: 0
  }
2088 2089
  v: 0.74493105485764444
  a: -0.077768294300384871
2090 2091 2092 2093
  relative_time: 7.3999999999999817
}
trajectory_point {
  path_point {
2094 2095 2096 2097 2098
    x: 586365.76419863082
    y: 4140777.82727859
    theta: 1.3061662021317564
    kappa: -0.00031822121797684121
    s: 16.692050142910936
2099 2100 2101
    dkappa: 0
    ddkappa: 0
  }
2102 2103
  v: 0.741208723728916
  a: -0.0711297347387484
2104 2105 2106 2107
  relative_time: 7.4499999999999815
}
trajectory_point {
  path_point {
2108 2109 2110 2111 2112
    x: 586365.77387065871
    y: 4140777.8629654129
    theta: 1.3061511645584383
    kappa: -0.00034934505433031264
    s: 16.729024424025649
2113 2114 2115
    dkappa: 0
    ddkappa: 0
  }
2116 2117
  v: 0.73781760299476984
  a: -0.064519878517100615
2118 2119 2120 2121
  relative_time: 7.4999999999999813
}
trajectory_point {
  path_point {
2122 2123 2124 2125 2126
    x: 586365.78350049106
    y: 4140777.8984965472
    theta: 1.3061361925887074
    kappa: -0.00038033310842335412
    s: 16.765837399464207
2127 2128 2129
    dkappa: 0
    ddkappa: 0
  }
2130 2131
  v: 0.73475625748820617
  a: -0.057938725635441585
2132 2133 2134 2135
  relative_time: 7.5499999999999812
}
trajectory_point {
  path_point {
2136 2137 2138 2139 2140
    x: 586365.79309243162
    y: 4140777.9338878719
    theta: 1.3061212795311241
    kappa: -0.00041119922979672191
    s: 16.802505522108813
2141 2142 2143
    dkappa: 0
    ddkappa: 0
  }
2144 2145
  v: 0.73202325204222585
  a: -0.051386276093771249
2146 2147 2148 2149
  relative_time: 7.599999999999981
}
trajectory_point {
  path_point {
2150 2151 2152 2153 2154
    x: 586365.80265076552
    y: 4140777.9691551989
    theta: 1.3061064187234332
    kappa: -0.0004419572075871573
    s: 16.839045173083324
2155 2156 2157
    dkappa: 0
    ddkappa: 0
  }
2158 2159
  v: 0.7296171514898292
  a: -0.044862529892089581
2160 2161 2162 2163
  relative_time: 7.6499999999999808
}
trajectory_point {
  path_point {
2164 2165 2166 2167 2168
    x: 586365.81217975926
    y: 4140778.0043142694
    theta: 1.3060916035325634
    kappa: -0.00047262077052737697
    s: 16.875472661753239
2169 2170 2171
    dkappa: 0
    ddkappa: 0
  }
2172 2173
  v: 0.727536520664017
  a: -0.038367487030396691
2174 2175 2176 2177
  relative_time: 7.6999999999999806
}
trajectory_point {
  path_point {
2178 2179 2180 2181 2182
    x: 586365.82168366
    y: 4140778.0393807548
    theta: 1.3060768273546275
    kappa: -0.00050320358694608855
    s: 16.911804225725717
2183 2184 2185
    dkappa: 0
    ddkappa: 0
  }
2186 2187
  v: 0.72577992439778982
  a: -0.031901147508692523
2188 2189 2190 2191
  relative_time: 7.7499999999999805
}
trajectory_point {
  path_point {
2192 2193 2194 2195 2196
    x: 586365.83116993867
    y: 4140778.07436938
    theta: 1.3060569682288126
    kappa: -0.00053018949466413943
    s: 16.94805603084956
2197 2198 2199
    dkappa: 0
    ddkappa: 0
  }
2200 2201
  v: 0.724345927524148
  a: -0.025463511326977051
2202 2203 2204 2205
  relative_time: 7.79999999999998
}
trajectory_point {
  path_point {
2206 2207 2208 2209 2210
    x: 586365.84064088389
    y: 4140778.1092961989
    theta: 1.3060350512556869
    kappa: -0.00055568396813450091
    s: 16.984244171215224
2211 2212 2213
    dkappa: 0
    ddkappa: 0
  }
2214 2215
  v: 0.72323309487609233
  a: -0.019054578485250329
2216 2217 2218 2219
  relative_time: 7.84999999999998
}
trajectory_point {
  path_point {
2220 2221 2222 2223 2224
    x: 586365.85009936045
    y: 4140778.1441770368
    theta: 1.3060131631366665
    kappa: -0.0005811448776097169
    s: 17.020384669154815
2225 2226 2227
    dkappa: 0
    ddkappa: 0
  }
2228 2229
  v: 0.72243999128662317
  a: -0.012674348983512274
2230 2231 2232 2233
  relative_time: 7.89999999999998
}
trajectory_point {
  path_point {
2234 2235 2236 2237 2238
    x: 586365.85954954266
    y: 4140778.1790272864
    theta: 1.3059912942114724
    kappa: -0.00060658346023751406
    s: 17.056493475242082
2239 2240 2241
    dkappa: 0
    ddkappa: 0
  }
2242 2243
  v: 0.72196518158874123
  a: -0.0063228228217629412
2244 2245 2246 2247
  relative_time: 7.94999999999998
}
trajectory_point {
  path_point {
2248 2249 2250 2251 2252
    x: 586365.86899558664
    y: 4140778.2138622748
    theta: 1.3059694348632853
    kappa: -0.00063201090261201011
    s: 17.092586468292431
2253 2254 2255
    dkappa: 0
    ddkappa: 0
  }
2256 2257
  v: 0.721807230615447
  a: -2.3869795029440866e-15
2258 2259 2260 2261
  relative_time: 7.99999999999998
}
decision {
  main_decision {
2262
    stop {
2263
      reason_code: STOP_REASON_DESTINATION
2264 2265
      reason: "stop by DEST"
      stop_point {
2266 2267
        x: 586366.98236622673
        y: 4140782.340687993
2268
      }
2269
      stop_heading: 1.312334775534727
2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282
    }
  }
  object_decision {
    decision {
      id: "3_0"
      perception_id: 3
      object_decision {
        ignore {
        }
      }
    }
    decision {
      id: "DEST"
D
Dong Li 已提交
2283
      perception_id: -1109540454
2284
      object_decision {
2285
        stop {
2286 2287
          reason_code: STOP_REASON_DESTINATION
          distance_s: -3
2288
          stop_point {
2289 2290
            x: 586366.98236622673
            y: 4140782.340687993
2291
          }
2292
          stop_heading: 1.312334775534727
2293 2294 2295 2296 2297
        }
      }
    }
  }
}