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 17
  v: 4.425000190734858
  a: -0.5767818497207
18 19 20 21
  relative_time: 0
}
trajectory_point {
  path_point {
22 23 24 25 26
    x: 586361.4373470156
    y: 4140761.9343221514
    theta: 1.2881390016213083
    kappa: 0.0073972433097370715
    s: 0.22052461343852292
27 28 29
    dkappa: 0
    ddkappa: 0
  }
30 31
  v: 4.3958968029057006
  a: -0.58728711776645759
32 33 34 35
  relative_time: 0.05
}
trajectory_point {
  path_point {
36 37 38 39 40
    x: 586361.49824183853
    y: 4140762.14474444
    theta: 1.2899103318944416
    kappa: 0.0085681657579296314
    s: 0.43958109226472925
41 42 43
    dkappa: 0
    ddkappa: 0
  }
44 45
  v: 4.3662781335261256
  a: -0.59739311173741994
46 47 48 49
  relative_time: 0.1
}
trajectory_point {
  path_point {
50 51 52 53 54
    x: 586361.55833649891
    y: 4140762.3538431614
    theta: 1.2918672977180676
    kappa: 0.0093158151570009781
    s: 0.65714417149369075
55 56 57
    dkappa: 0
    ddkappa: 0
  }
58 59
  v: 4.3361641462998719
  a: -0.60709983163358694
60 61 62 63
  relative_time: 0.15000000000000002
}
trajectory_point {
  path_point {
64 65 66 67 68
    x: 586361.617604211
    y: 4140762.5615999694
    theta: 1.2939256980911411
    kappa: 0.0096891840423137358
    s: 0.8731895843256674
69 70 71
    dkappa: 0
    ddkappa: 0
  }
72 73
  v: 4.30557480493068
  a: -0.61640727745495849
74 75 76 77
  relative_time: 0.2
}
trajectory_point {
  path_point {
78 79 80 81 82
    x: 586361.67603380838
    y: 4140762.7679930134
    theta: 1.2960133416057238
    kappa: 0.0097347687336904049
    s: 1.0876940621461055
83 84 85
    dkappa: 0
    ddkappa: 0
  }
86 87
  v: 4.2745300731222891
  a: -0.62531544920153481
88 89 90 91
  relative_time: 0.25
}
trajectory_point {
  path_point {
92 93 94 95 96
    x: 586361.73362677824
    y: 4140762.9729978838
    theta: 1.2980690091144289
    kappa: 0.0094965754186221614
    s: 1.3006353345256387
97 98 99
    dkappa: 0
    ddkappa: 0
  }
100 101
  v: 4.24304991457844
  a: -0.63382434687331579
102 103 104 105
  relative_time: 0.3
}
trajectory_point {
  path_point {
106 107 108 109 110
    x: 586361.79038700042
    y: 4140763.1765905446
    theta: 1.3000389447652241
    kappa: 0.0090119917569182837
    s: 1.5119921292200873
111 112 113
    dkappa: 0
    ddkappa: 0
  }
114 115
  v: 4.2111542930028714
  a: -0.64193397047030132
116 117 118 119
  relative_time: 0.35
}
trajectory_point {
  path_point {
120 121 122 123 124
    x: 586361.84626560973
    y: 4140763.3787624938
    theta: 1.3018430796476403
    kappa: 0.00828975017573529
    s: 1.7217441721704592
125 126 127
    dkappa: 0
    ddkappa: 0
  }
128 129
  v: 4.178863172099323
  a: -0.64964431999249161
130 131 132 133
  relative_time: 0.39999999999999997
}
trajectory_point {
  path_point {
134 135 136 137 138
    x: 586361.90138448658
    y: 4140763.5794591517
    theta: 1.3034695219951715
    kappa: 0.00742114250180464
    s: 1.929872187502949
139 140 141
    dkappa: 0
    ddkappa: 0
  }
142 143
  v: 4.1461965155715355
  a: -0.65695539543988657
144 145 146 147
  relative_time: 0.44999999999999996
}
trajectory_point {
  path_point {
148 149 150 151 152
    x: 586361.95577998715
    y: 4140763.7786511322
    theta: 1.3048991673692052
    kappa: 0.0064405400839702958
    s: 2.1363578975289377
153 154 155
    dkappa: 0
    ddkappa: 0
  }
156 157
  v: 4.1131742871232477
  a: -0.66386719681248618
158 159 160 161
  relative_time: 0.49999999999999994
}
trajectory_point {
  path_point {
162 163 164 165 166
    x: 586362.00948936422
    y: 4140763.9763099924
    theta: 1.3061193493559609
    kappa: 0.0053799387051453526
    s: 2.3411840227449945
167 168 169
    dkappa: 0
    ddkappa: 0
  }
170 171
  v: 4.0798164504582
  a: -0.67037972411029045
172 173 174 175
  relative_time: 0.54999999999999993
}
trajectory_point {
  path_point {
176 177 178 179 180
    x: 586362.06254960538
    y: 4140764.1724085249
    theta: 1.3071228718995369
    kappa: 0.0042688008870616929
    s: 2.5443342818328745
181 182 183
    dkappa: 0
    ddkappa: 0
  }
184 185
  v: 4.0461429692801314
  a: -0.67649297733329938
186 187 188 189
  relative_time: 0.6
}
trajectory_point {
  path_point {
190 191 192 193 194
    x: 586362.11497301632
    y: 4140764.3669273127
    theta: 1.3078609809582293
    kappa: 0.0031361194132871928
    s: 2.74579339165952
195 196 197
    dkappa: 0
    ddkappa: 0
  }
198 199
  v: 4.0121738072927826
  a: -0.682206956481513
200 201 202 203
  relative_time: 0.65
}
trajectory_point {
  path_point {
204 205 206 207 208
    x: 586362.16683220339
    y: 4140764.5598318297
    theta: 1.30835621278454
    kappa: 0.002025644169015484
    s: 2.9455470672770603
209 210 211
    dkappa: 0
    ddkappa: 0
  }
212 213
  v: 3.9779289281998937
  a: -0.68752166155493133
214 215 216 217
  relative_time: 0.70000000000000007
}
trajectory_point {
  path_point {
218 219 220 221 222
    x: 586362.21817909437
    y: 4140764.7510943152
    theta: 1.3086475937498583
    kappa: 0.00096271387065292272
    s: 3.1435820219228132
223 224 225
    dkappa: 0
    ddkappa: 0
  }
226 227
  v: 3.9434282957052034
  a: -0.69243709255355423
228 229 230 231
  relative_time: 0.75000000000000011
}
trajectory_point {
  path_point {
232 233 234 235 236
    x: 586362.26904164487
    y: 4140764.9406945258
    theta: 1.3087499430564697
    kappa: -3.3064954971130135e-05
    s: 3.33988596701928
237 238 239
    dkappa: 0
    ddkappa: 0
  }
240 241
  v: 3.9086918735124514
  a: -0.6969532494773818
242 243 244 245
  relative_time: 0.80000000000000016
}
trajectory_point {
  path_point {
246 247 248 249 250
    x: 586362.31944454077
    y: 4140765.1286141411
    theta: 1.3086770467781648
    kappa: -0.00094337202563080829
    s: 3.5344476121741533
251 252 253
    dkappa: 0
    ddkappa: 0
  }
254 255
  v: 3.8737396253253782
  a: -0.701070132326414
256 257 258 259
  relative_time: 0.8500000000000002
}
trajectory_point {
  path_point {
260 261 262 263 264
    x: 586362.36943702807
    y: 4140765.3148292908
    theta: 1.308397107631857
    kappa: -0.0016950128778855024
    s: 3.7272566651803087
265 266 267
    dkappa: 0
    ddkappa: 0
  }
268 269
  v: 3.8385915148477232
  a: -0.704787741100651
270 271 272 273
  relative_time: 0.90000000000000024
}
trajectory_point {
  path_point {
274 275 276 277 278
    x: 586362.41903352493
    y: 4140765.499326461
    theta: 1.3080064826253586
    kappa: -0.0023064922057937981
    s: 3.9183038320158117
279 280 281
    dkappa: 0
    ddkappa: 0
  }
282 283
  v: 3.8032675057832264
  a: -0.70810607580009255
284 285 286 287
  relative_time: 0.95000000000000029
}
trajectory_point {
  path_point {
288 289 290 291 292
    x: 586362.46824145806
    y: 4140765.6820950378
    theta: 1.3075291825121791
    kappa: -0.0027676571815415324
    s: 4.1075808168439121
293 294 295
    dkappa: 0
    ddkappa: 0
  }
296 297
  v: 3.7677875618356271
  a: -0.71102513642473886
298 299 300 301
  relative_time: 1.0000000000000002
}
trajectory_point {
  path_point {
302 303 304 305 306
    x: 586362.51706643042
    y: 4140765.8631259366
    theta: 1.3069863561984532
    kappa: -0.0030708234377076634
    s: 4.2950803220130505
307 308 309
    dkappa: 0
    ddkappa: 0
  }
310 311
  v: 3.7321716467086654
  a: -0.71354492297458971
312 313 314 315
  relative_time: 1.0500000000000003
}
trajectory_point {
  path_point {
316 317 318 319 320
    x: 586362.56556364661
    y: 4140766.0423976607
    theta: 1.3064062689201124
    kappa: -0.003099430749850746
    s: 4.4807960480568525
321 322 323
    dkappa: 0
    ddkappa: 0
  }
324 325
  v: 3.6964397241060816
  a: -0.71566543544964523
326 327 328 329
  relative_time: 1.1000000000000003
}
trajectory_point {
  path_point {
330 331 332 333 334
    x: 586362.61368233187
    y: 4140766.2199183595
    theta: 1.3058519589174313
    kappa: -0.00292718322545183
    s: 4.6647226936941282
335 336 337
    dkappa: 0
    ddkappa: 0
  }
338 339
  v: 3.6606117577316146
  a: -0.71738667384990551
340 341 342 343
  relative_time: 1.1500000000000004
}
trajectory_point {
  path_point {
344 345 346 347 348
    x: 586362.66141178727
    y: 4140766.395686449
    theta: 1.3053441572424238
    kappa: -0.0025542823538976856
    s: 4.8468559558288788
349 350 351
    dkappa: 0
    ddkappa: 0
  }
352 353
  v: 3.624707711289004
  a: -0.71870863817537045
354 355 356 357
  relative_time: 1.2000000000000004
}
trajectory_point {
  path_point {
358 359 360 361 362
    x: 586362.7087572224
    y: 4140766.5696970504
    theta: 1.3049246809860784
    kappa: -0.0019291058764574812
    s: 5.0271925295502893
363 364 365
    dkappa: 0
    ddkappa: 0
  }
366 367
  v: 3.58874754848199
  a: -0.71963132842603994
368 369 370 371
  relative_time: 1.2500000000000004
}
trajectory_point {
  path_point {
372 373 374 375 376
    x: 586362.75569921127
    y: 4140766.7419530107
    theta: 1.3046656400846266
    kappa: -0.0012196279265992926
    s: 5.205730108132733
377 378 379
    dkappa: 0
    ddkappa: 0
  }
380 381
  v: 3.5527512330143134
  a: -0.7201547446019142
382 383 384 385
  relative_time: 1.3000000000000005
}
trajectory_point {
  path_point {
386 387 388 389 390
    x: 586362.80219463608
    y: 4140766.91246471
    theta: 1.3045047656511823
    kappa: -0.00057391214588754867
    s: 5.3824673830357721
391 392 393
    dkappa: 0
    ddkappa: 0
  }
394 395
  v: 3.5167387285897123
  a: -0.72027888670299312
396 397 398 399
  relative_time: 1.3500000000000005
}
trajectory_point {
  path_point {
400 401 402 403 404
    x: 586362.84823627514
    y: 4140767.0812337906
    theta: 1.3044344281334661
    kappa: -2.3289548473873866e-05
    s: 5.5574040439041514
405 406 407
    dkappa: 0
    ddkappa: 0
  }
408 409
  v: 3.4807299989119271
  a: -0.72000375472927658
410 411 412 413
  relative_time: 1.4000000000000006
}
trajectory_point {
  path_point {
414 415 416 417 418
    x: 586362.8938059971
    y: 4140767.2482659118
    theta: 1.3044840006673524
    kappa: 0.00038097267148435443
    s: 5.7305407785678071
419 420 421
    dkappa: 0
    ddkappa: 0
  }
422 423
  v: 3.4447450076846975
  a: -0.71932934868076481
424 425 426 427
  relative_time: 1.4500000000000006
}
trajectory_point {
  path_point {
428 429 430 431 432
    x: 586362.93889000523
    y: 4140767.4135665828
    theta: 1.3045789517278026
    kappa: 0.00071343867287942822
    s: 5.90187927304186
433 434 435
    dkappa: 0
    ddkappa: 0
  }
436 437
  v: 3.4088037186117637
  a: -0.7182556685574577
438 439 440 441
  relative_time: 1.5000000000000007
}
trajectory_point {
  path_point {
442 443 444 445 446
    x: 586362.983488875
    y: 4140767.5771384286
    theta: 1.304714589644234
    kappa: 0.00097940110671568769
    s: 6.0714222115266177
447 448 449
    dkappa: 0
    ddkappa: 0
  }
450 451
  v: 3.3729260953968652
  a: -0.71678271435935526
452 453 454 455
  relative_time: 1.5500000000000007
}
trajectory_point {
  path_point {
456 457 458 459 460
    x: 586363.02757951012
    y: 4140767.7389915586
    theta: 1.30489983100012
    kappa: 0.0011406081886486288
    s: 6.2391732764075769
461 462 463
    dkappa: 0
    ddkappa: 0
  }
464 465
  v: 3.3371321017437414
  a: -0.71491048608645746
466 467 468 469
  relative_time: 1.6000000000000008
}
trajectory_point {
  path_point {
470 471 472 473 474
    x: 586363.07117384532
    y: 4140767.8991275635
    theta: 1.3050985466024767
    kappa: 0.0012493634551554596
    s: 6.4051371482554176
475 476 477
    dkappa: 0
    ddkappa: 0
  }
478 479
  v: 3.3014417013561328
  a: -0.71263898373876433
480 481 482 483
  relative_time: 1.6500000000000008
}
trajectory_point {
  path_point {
484 485 486 487 488
    x: 586363.11427769181
    y: 4140768.057550746
    theta: 1.3053078885386971
    kappa: 0.0013142334604290898
    s: 6.5693195058260114
489 490 491
    dkappa: 0
    ddkappa: 0
  }
492 493
  v: 3.2658748579377779
  a: -0.70996820731627586
494 495 496 497
  relative_time: 1.7000000000000008
}
trajectory_point {
  path_point {
498 499 500 501 502
    x: 586363.15686469187
    y: 4140768.214275186
    theta: 1.3055213444719411
    kappa: 0.0013024210723349646
    s: 6.7317270260604118
503 504 505
    dkappa: 0
    ddkappa: 0
  }
506 507
  v: 3.2304515351924179
  a: -0.706898156818992
508 509 510 511
  relative_time: 1.7500000000000009
}
trajectory_point {
  path_point {
512 513 514 515 516
    x: 586363.198965434
    y: 4140768.3693005117
    theta: 1.3057274182164766
    kappa: 0.0012622651752605216
    s: 6.8923673840848654
517 518 519
    dkappa: 0
    ddkappa: 0
  }
520 521
  v: 3.1951916968237923
  a: -0.70342883224691288
522 523 524 525
  relative_time: 1.8000000000000009
}
trajectory_point {
  path_point {
526 527 528 529 530
    x: 586363.2405780491
    y: 4140768.5226362166
    theta: 1.3059252043896648
    kappa: 0.0011886060502979145
    s: 7.0512492532108
531 532 533
    dkappa: 0
    ddkappa: 0
  }
534 535
  v: 3.1601153065356398
  a: -0.69956023360003838
536 537 538 539
  relative_time: 1.850000000000001
}
trajectory_point {
  path_point {
540 541 542 543 544
    x: 586363.28169369185
    y: 4140768.6742947134
    theta: 1.3060993196453274
    kappa: 0.0010738600078355851
    s: 7.2083823049348332
545 546 547
    dkappa: 0
    ddkappa: 0
  }
548 549
  v: 3.1252423280317014
  a: -0.69529236087836865
550 551 552 553
  relative_time: 1.900000000000001
}
trajectory_point {
  path_point {
554 555 556 557 558
    x: 586363.32233929355
    y: 4140768.8242797498
    theta: 1.3062594621276349
    kappa: 0.000945239762840045
    s: 7.36377720893877
559 560 561
    dkappa: 0
    ddkappa: 0
  }
562 563
  v: 3.0905927250157168
  a: -0.69062521408190347
564 565 566 567
  relative_time: 1.9500000000000011
}
trajectory_point {
  path_point {
568 569 570 571 572
    x: 586363.36250583851
    y: 4140768.9726058538
    theta: 1.3063919657037077
    kappa: 0.00079215883730140166
    s: 7.5174456330896
573 574 575
    dkappa: 0
    ddkappa: 0
  }
576 577
  v: 3.0561864611914227
  a: -0.68555879321063951
578 579 580 581
  relative_time: 2.0000000000000009
}
trajectory_point {
  path_point {
582 583 584 585 586
    x: 586363.40220783628
    y: 4140769.1192813977
    theta: 1.3064979876967502
    kappa: 0.00062764886188807672
    s: 7.6693994548568591
587 588 589
    dkappa: 0
    ddkappa: 0
  }
590 591
  v: 3.021995484203071
  a: -0.68206982871952948
592 593 594 595
  relative_time: 2.0500000000000007
}
trajectory_point {
  path_point {
596 597 598 599 600
    x: 586363.44145381
    y: 4140769.2643138543
    theta: 1.3065867811453655
    kappa: 0.00045655786749991518
    s: 7.8196481151243251
601 602 603
    dkappa: 0
    ddkappa: 0
  }
604 605
  v: 2.98798052407986
  a: -0.67851811860503219
606 607 608 609
  relative_time: 2.1000000000000005
}
trajectory_point {
  path_point {
610 611 612 613 614
    x: 586363.4802417137
    y: 4140769.4077129737
    theta: 1.3066334447518531
    kappa: 0.00027886707920806445
    s: 7.9682004931672825
615 616 617
    dkappa: 0
    ddkappa: 0
  }
618 619
  v: 2.9541447181029579
  a: -0.67490366286714776
620 621 622 623
  relative_time: 2.1500000000000004
}
trajectory_point {
  path_point {
624 625 626 627 628
    x: 586363.5185868484
    y: 4140769.5494839777
    theta: 1.3066667116296222
    kappa: 0.00010321542469222696
    s: 8.1150656251250783
629 630 631
    dkappa: 0
    ddkappa: 0
  }
632 633
  v: 2.9204912035535351
  a: -0.67122646150587617
634 635 636 637
  relative_time: 2.2
}
trajectory_point {
  path_point {
638 639 640 641 642
    x: 586363.55648995284
    y: 4140769.68963619
    theta: 1.3066654756823142
    kappa: -6.8219100526652329e-05
    s: 8.2602527040011129
643 644 645
    dkappa: 0
    ddkappa: 0
  }
646 647
  v: 2.88702311771276
  a: -0.66748651452121732
648 649 650 651
  relative_time: 2.25
}
trajectory_point {
  path_point {
652 653 654 655 656
    x: 586363.59396000614
    y: 4140769.8281768672
    theta: 1.3066444747509645
    kappa: -0.00023082833007545436
    s: 8.40377107966285
657 658 659
    dkappa: 0
    ddkappa: 0
  }
660 661
  v: 2.8537435978618033
  a: -0.66368382191317143
662 663 664 665
  relative_time: 2.3
}
trajectory_point {
  path_point {
666 667 668 669 670
    x: 586363.63099964883
    y: 4140769.9651151439
    theta: 1.3066024979759843
    kappa: -0.00038420386706677456
    s: 8.5456302588418076
671 672 673
    dkappa: 0
    ddkappa: 0
  }
674 675
  v: 2.8206557812818329
  a: -0.65981838368173829
676 677 678 679
  relative_time: 2.3499999999999996
}
trajectory_point {
  path_point {
680 681 682 683 684
    x: 586363.66761880252
    y: 4140770.1004583463
    theta: 1.3065362201187523
    kappa: -0.00051816617453934047
    s: 8.6858399051335677
685 686 687
    dkappa: 0
    ddkappa: 0
  }
688 689
  v: 2.7877628052540193
  a: -0.655890199826918
690 691 692 693
  relative_time: 2.3999999999999995
}
trajectory_point {
  path_point {
694 695 696 697 698
    x: 586363.703814003
    y: 4140770.2342175851
    theta: 1.3064602798098794
    kappa: -0.0006431387629597399
    s: 8.8244098389977648
699 700 701
    dkappa: 0
    ddkappa: 0
  }
702 703
  v: 2.7550678070595311
  a: -0.65189927034871054
704 705 706 707
  relative_time: 2.4499999999999993
}
trajectory_point {
  path_point {
708 709 710 711 712
    x: 586363.739602774
    y: 4140770.3663984528
    theta: 1.3063613797695646
    kappa: -0.00073531149915565756
    s: 8.9613500377580948
713 714 715
    dkappa: 0
    ddkappa: 0
  }
716 717
  v: 2.7225739239795383
  a: -0.64784559524711594
718 719 720 721
  relative_time: 2.4999999999999991
}
trajectory_point {
  path_point {
722 723 724 725 726
    x: 586363.77497152577
    y: 4140770.4970151274
    theta: 1.3062601127951545
    kappa: -0.00082104037563770973
    s: 9.0966706356023117
727 728 729
    dkappa: 0
    ddkappa: 0
  }
730 731
  v: 2.6902842932952096
  a: -0.64372917452213418
732 733 734 735
  relative_time: 2.5499999999999989
}
trajectory_point {
  path_point {
736 737 738 739 740
    x: 586363.809945375
    y: 4140770.6260714657
    theta: 1.3061442355544606
    kappa: -0.00086205923963681341
    s: 9.2303819235822289
741 742 743
    dkappa: 0
    ddkappa: 0
  }
744 745
  v: 2.6582020522877148
  a: -0.63955000817376517
746 747 748 749
  relative_time: 2.5999999999999988
}
trajectory_point {
  path_point {
750 751 752 753 754
    x: 586363.84450475755
    y: 4140770.753583591
    theta: 1.3060292877641198
    kappa: -0.00089543028258236746
    s: 9.3624943496137156
755 756 757
    dkappa: 0
    ddkappa: 0
  }
758 759
  v: 2.626330338238223
  a: -0.635308096202009
760 761 762 763
  relative_time: 2.6499999999999986
}
trajectory_point {
  path_point {
764 765 766 767 768
    x: 586363.87867321959
    y: 4140770.8795561073
    theta: 1.3059127237552313
    kappa: -0.000881358386246806
    s: 9.4930185184767026
769 770 771
    dkappa: 0
    ddkappa: 0
  }
772 773
  v: 2.5946722884279039
  a: -0.6310034386068657
774 775 776 777
  relative_time: 2.6999999999999984
}
trajectory_point {
  path_point {
778 779 780 781 782
    x: 586363.9124337968
    y: 4140771.0040047625
    theta: 1.3057996810174928
    kappa: -0.00085557084676168469
    s: 9.6219651918151783
783 784 785
    dkappa: 0
    ddkappa: 0
  }
786 787
  v: 2.5632310401379268
  a: -0.62663603538833534
788 789 790 791
  relative_time: 2.7499999999999982
}
trajectory_point {
  path_point {
792 793 794 795 796
    x: 586363.94580593484
    y: 4140771.1269355938
    theta: 1.3056970606916727
    kappa: -0.00077918314663328182
    s: 9.7493452881371869
797 798 799
    dkappa: 0
    ddkappa: 0
  }
800 801
  v: 2.5320097306494604
  a: -0.62220588654641762
802 803 804 805
  relative_time: 2.799999999999998
}
trajectory_point {
  path_point {
806 807 808 809 810
    x: 586363.97877481359
    y: 4140771.2483640979
    theta: 1.3056011849029989
    kappa: -0.000689881180613535
    s: 9.8751698828148342
811 812 813
    dkappa: 0
    ddkappa: 0
  }
814 815
  v: 2.5010114972436748
  a: -0.61771299208111285
816 817 818 819
  relative_time: 2.8499999999999979
}
trajectory_point {
  path_point {
820 821 822 823 824
    x: 586364.01135621965
    y: 4140771.3682976263
    theta: 1.3055285826985794
    kappa: -0.00054595578700107009
    s: 9.9994502080842835
825 826 827
    dkappa: 0
    ddkappa: 0
  }
828 829
  v: 2.4702394772017393
  a: -0.61315735199242094
830 831 832 833
  relative_time: 2.8999999999999977
}
trajectory_point {
  path_point {
834 835 836 837 838
    x: 586364.04353776132
    y: 4140771.4867513455
    theta: 1.3054630836716175
    kappa: -0.00040230835158752432
    s: 10.122197653045758
839 840 841
    dkappa: 0
    ddkappa: 0
  }
842 843
  v: 2.4396968078048227
  a: -0.60853896628034176
844 845 846 847
  relative_time: 2.9499999999999975
}
trajectory_point {
  path_point {
848 849 850 851 852
    x: 586364.07533104194
    y: 4140771.6037340676
    theta: 1.3054313472422678
    kappa: -0.00025249393039968845
    s: 10.243423763663536
853 854 855
    dkappa: 0
    ddkappa: 0
  }
856 857
  v: 2.4093866263340953
  a: -0.60385783494487544
858 859 860 861
  relative_time: 2.9999999999999973
}
trajectory_point {
  path_point {
862 863 864 865 866
    x: 586364.10672862583
    y: 4140771.7192599396
    theta: 1.3054020276552478
    kappa: -0.00010731928867087038
    s: 10.363140242765954
867 868 869
    dkappa: 0
    ddkappa: 0
  }
870 871
  v: 2.3793120700707253
  a: -0.599113957986022
872 873 874 875
  relative_time: 3.0499999999999972
}
trajectory_point {
  path_point {
876 877 878 879 880
    x: 586364.137736669
    y: 4140771.8333395785
    theta: 1.3054024117357454
    kappa: -4.2178127231173515e-06
    s: 10.481358950045415
881 882 883
    dkappa: 0
    ddkappa: 0
  }
884 885
  v: 2.3494762762958827
  a: -0.59430733540378133
886 887 888 889
  relative_time: 3.099999999999997
}
trajectory_point {
  path_point {
890 891 892 893 894
    x: 586364.16835500777
    y: 4140771.9459854811
    theta: 1.3054027909891759
    kappa: 9.7587899090524375e-05
    s: 10.598091902058371
895 896 897
    dkappa: 0
    ddkappa: 0
  }
898 899
  v: 2.3198823822907371
  a: -0.58943796719815356
900 901 902 903
  relative_time: 3.1499999999999968
}
trajectory_point {
  path_point {
904 905 906 907 908
    x: 586364.198584273
    y: 4140772.0572100915
    theta: 1.3054221114431328
    kappa: 0.00016553818569281224
    s: 10.713351272225337
909 910 911
    dkappa: 0
    ddkappa: 0
  }
912 913
  v: 2.2905335253364574
  a: -0.58450585336913852
914 915 916 917
  relative_time: 3.1999999999999966
}
trajectory_point {
  path_point {
918 919 920 921 922
    x: 586364.22843005345
    y: 4140772.1670246683
    theta: 1.3054429623823214
    kappa: 0.00022957484132245758
    s: 10.827149390830883
923 924 925
    dkappa: 0
    ddkappa: 0
  }
926 927
  v: 2.2614328427142132
  a: -0.57951099391673644
928 929 930 931
  relative_time: 3.2499999999999964
}
trajectory_point {
  path_point {
932 933 934 935 936
    x: 586364.257891199
    y: 4140772.2754424629
    theta: 1.3054721310595829
    kappa: 0.000272444373900183
    s: 10.939498745023643
937 938 939
    dkappa: 0
    ddkappa: 0
  }
940 941
  v: 2.2325834717051736
  a: -0.5744533888409471
942 943 944 945
  relative_time: 3.2999999999999963
}
trajectory_point {
  path_point {
946 947 948 949 950
    x: 586364.28697379539
    y: 4140772.3824749254
    theta: 1.3055045275822839
    kappa: 0.00030622819441394108
    s: 11.050411978816307
951 952 953
    dkappa: 0
    ddkappa: 0
  }
954 955
  v: 2.2039885495905085
  a: -0.56933303814177061
956 957 958 959
  relative_time: 3.3499999999999961
}
trajectory_point {
  path_point {
960 961 962 963 964
    x: 586364.31567953329
    y: 4140772.488134861
    theta: 1.305538787347905
    kappa: 0.00032977468653004832
    s: 11.159901893085619
965 966 967
    dkappa: 0
    ddkappa: 0
  }
968 969
  v: 2.1756512136513866
  a: -0.564149941819207
970 971 972 973
  relative_time: 3.3999999999999959
}
trajectory_point {
  path_point {
974 975 976 977 978
    x: 586364.34401065926
    y: 4140772.5924350857
    theta: 1.3055756329961359
    kappa: 0.0003399954025826674
    s: 11.267981445572389
979 980 981
    dkappa: 0
    ddkappa: 0
  }
982 983
  v: 2.1475746011689778
  a: -0.55890409987325618
984 985 986 987
  relative_time: 3.4499999999999957
}
trajectory_point {
  path_point {
988 989 990 991 992
    x: 586364.37197477242
    y: 4140772.6953871264
    theta: 1.3056120272670184
    kappa: 0.000348621416232406
    s: 11.374663750881481
993 994 995
    dkappa: 0
    ddkappa: 0
  }
996 997
  v: 2.1197618494244512
  a: -0.55359551230391812
998 999 1000 1001
  relative_time: 3.4999999999999956
}
trajectory_point {
  path_point {
1002 1003 1004 1005 1006
    x: 586364.399567954
    y: 4140772.7970057987
    theta: 1.30564822109563
    kappa: 0.00034121599345593846
    s: 11.479962080481819
1007 1008 1009
    dkappa: 0
    ddkappa: 0
  }
1010 1011
  v: 2.0922160956989759
  a: -0.548224179111193
1012 1013 1014 1015
  relative_time: 3.5499999999999954
}
trajectory_point {
  path_point {
1016 1017 1018 1019 1020
    x: 586364.42680198676
    y: 4140772.8973018173
    theta: 1.30568394383077
    kappa: 0.00033390695855942413
    s: 11.583889862706382
1021 1022 1023
    dkappa: 0
    ddkappa: 0
  }
1024 1025
  v: 2.0649404772737219
  a: -0.54279010029508068
1026 1027 1028 1029
  relative_time: 3.5999999999999952
}
trajectory_point {
  path_point {
1030 1031 1032 1033 1034
    x: 586364.45367499534
    y: 4140772.9962897687
    theta: 1.3057168417236991
    kappa: 0.00031840366558129172
    s: 11.686460682752212
1035 1036 1037
    dkappa: 0
    ddkappa: 0
  }
1038 1039
  v: 2.0379381314298577
  a: -0.53729327585558118
1040 1041 1042 1043
  relative_time: 3.649999999999995
}
trajectory_point {
  path_point {
1044 1045 1046 1047 1048
    x: 586364.48019337177
    y: 4140773.0939821564
    theta: 1.3057481304787417
    kappa: 0.00029896166852884322
    s: 11.78768828268041
1049 1050 1051
    dkappa: 0
    ddkappa: 0
  }
1052 1053
  v: 2.0112121954485538
  a: -0.53173370579269452
1054 1055 1056 1057
  relative_time: 3.6999999999999948
}
trajectory_point {
  path_point {
1058 1059 1060 1061 1062
    x: 586364.506362362
    y: 4140773.1903919596
    theta: 1.3057780189357455
    kappa: 0.0002783933145495542
    s: 11.887586561416128
1063 1064 1065
    dkappa: 0
    ddkappa: 0
  }
1066 1067
  v: 1.9847658066109783
  a: -0.52611139010642072
1068 1069 1070 1071
  relative_time: 3.7499999999999947
}
trajectory_point {
  path_point {
1072 1073 1074 1075 1076
    x: 586364.53218115238
    y: 4140773.2855339618
    theta: 1.3058026329633774
    kappa: 0.0002512797979432825
    s: 11.986169574748587
1077 1078 1079
    dkappa: 0
    ddkappa: 0
  }
1080 1081
  v: 1.9586021021983016
  a: -0.52042632879675965
1082 1083 1084 1085
  relative_time: 3.7999999999999945
}
trajectory_point {
  path_point {
1086 1087 1088 1089 1090
    x: 586364.55765919841
    y: 4140773.3794203238
    theta: 1.305826922146526
    kappa: 0.00022452411291620382
    s: 12.08345153533106
1091 1092 1093
    dkappa: 0
    ddkappa: 0
  }
1094 1095
  v: 1.9327242194916925
  a: -0.51467852186371155
1096 1097 1098 1099
  relative_time: 3.8499999999999943
}
trajectory_point {
  path_point {
1100 1101 1102 1103 1104
    x: 586364.58279737551
    y: 4140773.4720656974
    theta: 1.3058466336092449
    kappa: 0.00019557612300706104
    s: 12.179446812680876
1105 1106 1107
    dkappa: 0
    ddkappa: 0
  }
1108 1109
  v: 1.9071352957723204
  a: -0.50886796930727618
1110 1111 1112 1113
  relative_time: 3.8999999999999941
}
trajectory_point {
  path_point {
1114 1115 1116 1117 1118
    x: 586364.607600374
    y: 4140773.5634838622
    theta: 1.30586307682975
    kappa: 0.00016521298334756687
    s: 12.274169933179433
1119 1120 1121
    dkappa: 0
    ddkappa: 0
  }
1122 1123
  v: 1.8818384683213547
  a: -0.50299467112745366
1124 1125 1126 1127
  relative_time: 3.949999999999994
}
trajectory_point {
  path_point {
1128 1129 1130 1131 1132
    x: 586364.63207410625
    y: 4140773.6536884275
    theta: 1.3058793017623027
    kappa: 0.00013525292211824511
    s: 12.367635580072172
1133 1134 1135
    dkappa: 0
    ddkappa: 0
  }
1136 1137
  v: 1.856836874419965
  a: -0.497058627324244
1138 1139 1140 1141
  relative_time: 3.9999999999999938
}
trajectory_point {
  path_point {
1142 1143 1144 1145 1146
    x: 586364.65621972736
    y: 4140773.7426943518
    theta: 1.3058883485594153
    kappa: 0.00010469717013317555
    s: 12.459858491988678
1147 1148 1149
    dkappa: 0
    ddkappa: 0
  }
1150 1151
  v: 1.8321274689107034
  a: -0.4913146268787017
1152 1153 1154 1155
  relative_time: 4.0499999999999936
}
trajectory_point {
  path_point {
1156 1157 1158 1159 1160
    x: 586364.68004349293
    y: 4140773.8305149106
    theta: 1.3058965830133311
    kappa: 7.444960097020015e-05
    s: 12.550853121045698
1161 1162 1163
    dkappa: 0
    ddkappa: 0
  }
1164 1165
  v: 1.8077057083488586
  a: -0.48555282942748057
1166 1167 1168 1169
  relative_time: 4.0999999999999934
}
trajectory_point {
  path_point {
1170 1171 1172 1173 1174
    x: 586364.70354930148
    y: 4140773.9171639746
    theta: 1.3059037208411777
    kappa: 4.4832064355409314e-05
    s: 12.640633871736858
1175 1176 1177
    dkappa: 0
    ddkappa: 0
  }
1178 1179
  v: 1.7835724825847168
  a: -0.47977323497057955
1180 1181 1182 1183
  relative_time: 4.1499999999999932
}
trajectory_point {
  path_point {
1184 1185 1186 1187 1188
    x: 586364.72674015246
    y: 4140774.0026556985
    theta: 1.3059044468862475
    kappa: 1.7060215565321126e-05
    s: 12.7292151930483
1189 1190 1191
    dkappa: 0
    ddkappa: 0
  }
1192 1193
  v: 1.7597286814685622
  a: -0.47397584350799865
1194 1195 1196 1197
  relative_time: 4.1999999999999931
}
trajectory_point {
  path_point {
1198 1199 1200 1201 1202
    x: 586364.74962078384
    y: 4140774.0870038159
    theta: 1.3059051632191472
    kappa: -1.0340134355897887e-05
    s: 12.816611578458685
1203 1204 1205
    dkappa: 0
    ddkappa: 0
  }
1206 1207
  v: 1.7361751948506785
  a: -0.46816065503973781
1208 1209 1210 1211
  relative_time: 4.2499999999999929
}
trajectory_point {
  path_point {
1212 1213 1214 1215 1216
    x: 586364.77219516423
    y: 4140774.1702223131
    theta: 1.3059042828744234
    kappa: -3.6335610327825466e-05
    s: 12.902837565939178
1217 1218 1219
    dkappa: 0
    ddkappa: 0
  }
1220 1221
  v: 1.7129129125813498
  a: -0.46232766956579707
1222 1223 1224 1225
  relative_time: 4.2999999999999927
}
trajectory_point {
  path_point {
1226 1227 1228 1229 1230
    x: 586364.79446742614
    y: 4140774.2523251791
    theta: 1.3058987364931285
    kappa: -5.8923384632054971e-05
    s: 12.987907737953467
1231 1232 1233
    dkappa: 0
    ddkappa: 0
  }
1234 1235
  v: 1.6899427245108603
  a: -0.4564768870861764
1236 1237 1238 1239
  relative_time: 4.3499999999999925
}
trajectory_point {
  path_point {
1240 1241 1242 1243 1244
    x: 586364.816440913
    y: 4140774.333326661
    theta: 1.305893264514723
    kappa: -8.12081513380594e-05
    s: 13.071836721457748
1245 1246 1247
    dkappa: 0
    ddkappa: 0
  }
1248 1249
  v: 1.6672655204894937
  a: -0.45060830760087583
1250 1251 1252 1253
  relative_time: 4.3999999999999924
}
trajectory_point {
  path_point {
1254 1255 1256 1257 1258
    x: 586364.83811994758
    y: 4140774.4132407894
    theta: 1.3058866314846986
    kappa: -0.00010169828443824127
    s: 13.154639187900738
1259 1260 1261
    dkappa: 0
    ddkappa: 0
  }
1262 1263
  v: 1.6448821903675341
  a: -0.44472193110989533
1264 1265 1266 1267
  relative_time: 4.4499999999999922
}
trajectory_point {
  path_point {
1268 1269 1270 1271 1272
    x: 586364.85950930661
    y: 4140774.492081515
    theta: 1.3058764699888268
    kappa: -0.00011753087073457766
    s: 13.236329853223664
1273 1274 1275
    dkappa: 0
    ddkappa: 0
  }
1276 1277
  v: 1.6227936239952656
  a: -0.43881775761323494
1278 1279 1280 1281
  relative_time: 4.499999999999992
}
trajectory_point {
  path_point {
1282 1283 1284 1285 1286
    x: 586364.8806114234
    y: 4140774.5698634735
    theta: 1.3058664449537649
    kappa: -0.00013315083798480669
    s: 13.316923477860264
1287 1288 1289
    dkappa: 0
    ddkappa: 0
  }
1290 1291
  v: 1.6010007112229721
  a: -0.43289578711089466
1292 1293 1294 1295
  relative_time: 4.5499999999999918
}
trajectory_point {
  path_point {
1296 1297 1298 1299 1300
    x: 586364.90143053245
    y: 4140774.646600855
    theta: 1.3058561898688861
    kappa: -0.00014759345760583263
    s: 13.396434866736797
1301 1302 1303
    dkappa: 0
    ddkappa: 0
  }
1304 1305
  v: 1.5795043419009376
  a: -0.42695601960287444
1306 1307 1308 1309
  relative_time: 4.5999999999999917
}
trajectory_point {
  path_point {
1310 1311 1312 1313 1314
    x: 586364.92197259015
    y: 4140774.7223074287
    theta: 1.3058435946806441
    kappa: -0.00015526777877842164
    s: 13.474878869272032
1315 1316 1317
    dkappa: 0
    ddkappa: 0
  }
1318 1319
  v: 1.5583054058794463
  a: -0.42099845508917433
1320 1321 1322 1323
  relative_time: 4.6499999999999915
}
trajectory_point {
  path_point {
1324 1325 1326 1327 1328
    x: 586364.94223903259
    y: 4140774.7969982391
    theta: 1.3058311684835258
    kappa: -0.00016283913267908944
    s: 13.552270379377255
1329 1330 1331
    dkappa: 0
    ddkappa: 0
  }
1332 1333
  v: 1.5374047930087817
  a: -0.41502309356979428
1334 1335 1336 1337
  relative_time: 4.6999999999999913
}
trajectory_point {
  path_point {
1338 1339 1340 1341 1342
    x: 586364.96223377192
    y: 4140774.8706877027
    theta: 1.3058189088789831
    kappa: -0.00017030898075937902
    s: 13.628624335456262
1343 1344 1345
    dkappa: 0
    ddkappa: 0
  }
1346 1347
  v: 1.5168033931392282
  a: -0.40902993504473434
1348 1349 1350 1351
  relative_time: 4.7499999999999911
}
trajectory_point {
  path_point {
1352 1353 1354 1355 1356
    x: 586364.98196340573
    y: 4140774.9433895536
    theta: 1.3058060501708448
    kappa: -0.00017029910659271171
    s: 13.703955720405368
1357 1358 1359
    dkappa: 0
    ddkappa: 0
  }
1360 1361
  v: 1.4965020961210698
  a: -0.40301897951399446
1362 1363 1364 1365
  relative_time: 4.7999999999999909
}
trajectory_point {
  path_point {
1366 1367 1368 1369 1370
    x: 586365.00142957713
    y: 4140775.0151189165
    theta: 1.3057932441748792
    kappa: -0.0001691362253427551
    s: 13.778279561613397
1371 1372 1373
    dkappa: 0
    ddkappa: 0
  }
1374 1375
  v: 1.4765017918045902
  a: -0.39699022697757469
1376 1377 1378 1379
  relative_time: 4.8499999999999908
}
trajectory_point {
  path_point {
1380 1381 1382 1383 1384
    x: 586365.0206358101
    y: 4140775.0858904524
    theta: 1.3057806091817905
    kappa: -0.00016798887244679685
    s: 13.851610930961693
1385 1386 1387
    dkappa: 0
    ddkappa: 0
  }
1388 1389
  v: 1.4568033700400738
  a: -0.390943677435475
1390 1391 1392 1393
  relative_time: 4.8999999999999906
}
trajectory_point {
  path_point {
1394 1395 1396 1397 1398
    x: 586365.03958736255
    y: 4140775.1557183983
    theta: 1.3057688188751713
    kappa: -0.00016260530771341889
    s: 13.923964944824109
1399 1400 1401
    dkappa: 0
    ddkappa: 0
  }
1402 1403
  v: 1.4374077206778042
  a: -0.38487933088769544
1404 1405 1406 1407
  relative_time: 4.94999999999999
}
trajectory_point {
  path_point {
1408 1409 1410 1411 1412
    x: 586365.05828846339
    y: 4140775.2246173145
    theta: 1.3057580049942972
    kappa: -0.00015214068960884035
    s: 13.995356764067013
1413 1414 1415
    dkappa: 0
    ddkappa: 0
  }
1416 1417
  v: 1.4183157335680656
  a: -0.3787971873342359
1418 1419 1420 1421
  relative_time: 4.99999999999999
}
trajectory_point {
  path_point {
1422 1423 1424 1425 1426
    x: 586365.07674150029
    y: 4140775.292602309
    theta: 1.3057473345560349
    kappa: -0.0001418148812595904
    s: 14.065801594049294
1427 1428 1429
    dkappa: 0
    ddkappa: 0
  }
1430 1431
  v: 1.3995282985611421
  a: -0.37269724677509652
1432 1433 1434 1435
  relative_time: 5.04999999999999
}
trajectory_point {
  path_point {
1436 1437 1438 1439 1440
    x: 586365.09495046781
    y: 4140775.3596881
    theta: 1.3057368052504568
    kappa: -0.00013162564734133216
    s: 14.135314684622346
1441 1442 1443
    dkappa: 0
    ddkappa: 0
  }
1444 1445
  v: 1.3810463055073174
  a: -0.36657950921027715
1446 1447 1448 1449
  relative_time: 5.09999999999999
}
trajectory_point {
  path_point {
1450 1451 1452 1453 1454
    x: 586365.11292123247
    y: 4140775.4258889407
    theta: 1.3057296848169713
    kappa: -0.00011296185056685702
    s: 14.203911330130083
1455 1456 1457
    dkappa: 0
    ddkappa: 0
  }
1458 1459
  v: 1.3628706442568759
  a: -0.36044397463977795
1460 1461 1462 1463
  relative_time: 5.14999999999999
}
trajectory_point {
  path_point {
1464 1465 1466 1467 1468
    x: 586365.13065619627
    y: 4140775.4912200756
    theta: 1.3057231297631016
    kappa: -9.3301030940522449e-05
    s: 14.271606869408927
1469 1470 1471
    dkappa: 0
    ddkappa: 0
  }
1472 1473
  v: 1.3450022046601011
  a: -0.35429064306359881
1474 1475 1476 1477
  relative_time: 5.1999999999999895
}
trajectory_point {
  path_point {
1478 1479 1480 1481 1482
    x: 586365.14815911709
    y: 4140775.5556964222
    theta: 1.3057166604750206
    kappa: -7.3897451870364925e-05
    s: 14.338416685787823
1483 1484 1485
    dkappa: 0
    ddkappa: 0
  }
1486 1487
  v: 1.3274418765672773
  a: -0.34811951448173972
1488 1489 1490 1491
  relative_time: 5.2499999999999893
}
trajectory_point {
  path_point {
1492 1493 1494 1495 1496
    x: 586365.16543414013
    y: 4140775.619332843
    theta: 1.3057109889903318
    kappa: -5.3553346995381749e-05
    s: 14.404356207088226
1497 1498 1499
    dkappa: 0
    ddkappa: 0
  }
1500 1501
  v: 1.3101905498286888
  a: -0.34193058889420075
1502 1503 1504 1505
  relative_time: 5.2999999999999892
}
trajectory_point {
  path_point {
1506 1507 1508 1509 1510
    x: 586365.18248598243
    y: 4140775.6821440891
    theta: 1.3057107019884049
    kappa: -2.4591111561798837e-05
    s: 14.4694409056241
1511 1512 1513
    dkappa: 0
    ddkappa: 0
  }
1514 1515
  v: 1.2932491142946188
  a: -0.33572386630098183
1516 1517 1518 1519
  relative_time: 5.349999999999989
}
trajectory_point {
  path_point {
1520 1521 1522 1523 1524
    x: 586365.1993179312
    y: 4140775.7441453468
    theta: 1.3057104186875386
    kappa: 3.9976385933015388e-06
    s: 14.533686298201934
1525 1526 1527
    dkappa: 0
    ddkappa: 0
  }
1528 1529
  v: 1.276618459815352
  a: -0.32949934670208303
1530 1531 1532 1533
  relative_time: 5.3999999999999888
}
trajectory_point {
  path_point {
1534 1535 1536 1537 1538
    x: 586365.21593406319
    y: 4140775.805351634
    theta: 1.305710139019113
    kappa: 3.2219828139086092e-05
    s: 14.597107946120721
1539 1540 1541
    dkappa: 0
    ddkappa: 0
  }
1542 1543
  v: 1.2602994762411719
  a: -0.32325703009750439
1544 1545 1546 1547
  relative_time: 5.4499999999999886
}
trajectory_point {
  path_point {
1548 1549 1550 1551 1552
    x: 586365.232338309
    y: 4140775.8657780541
    theta: 1.3057112657904031
    kappa: 6.1786270184464816e-05
    s: 14.659721455171972
1553 1554 1555
    dkappa: 0
    ddkappa: 0
  }
1556 1557
  v: 1.2442930534223628
  a: -0.31699691648724571
1558 1559 1560 1561
  relative_time: 5.4999999999999885
}
trajectory_point {
  path_point {
1562 1563 1564 1565 1566
    x: 586365.24853415531
    y: 4140775.9254398774
    theta: 1.305719241432489
    kappa: 9.9314138759972064e-05
    s: 14.721542475639717
1567 1568 1569
    dkappa: 0
    ddkappa: 0
  }
1570 1571
  v: 1.2286000812092088
  a: -0.31071900587130719
1572 1573 1574 1575
  relative_time: 5.5499999999999883
}
trajectory_point {
  path_point {
1576 1577 1578 1579 1580
    x: 586365.26452649746
    y: 4140775.9843520373
    theta: 1.3057271168589966
    kappa: 0.00013637046196664479
    s: 14.782586702300494
1581 1582 1583
    dkappa: 0
    ddkappa: 0
  }
1584 1585
  v: 1.2132214494519937
  a: -0.30442329824968878
1586 1587 1588 1589
  relative_time: 5.5999999999999881
}
trajectory_point {
  path_point {
1590 1591 1592 1593 1594
    x: 586365.28031945881
    y: 4140776.0425297241
    theta: 1.3057348941004765
    kappa: 0.00017296479417961311
    s: 14.842869874423354
1595 1596 1597
    dkappa: 0
    ddkappa: 0
  }
1598 1599
  v: 1.1981580480010015
  a: -0.29810979362239043
1600 1601 1602 1603
  relative_time: 5.6499999999999879
}
trajectory_point {
  path_point {
1604 1605 1606 1607 1608
    x: 586365.29591714288
    y: 4140776.0999881784
    theta: 1.3057426831893424
    kappa: 0.00020918321804461193
    s: 14.902407775769868
1609 1610 1611
    dkappa: 0
    ddkappa: 0
  }
1612 1613
  v: 1.1834107667065161
  a: -0.29177849198941219
1614 1615 1616 1617
  relative_time: 5.6999999999999877
}
trajectory_point {
  path_point {
1618 1619 1620 1621 1622
    x: 586365.311320812
    y: 4140776.156743458
    theta: 1.305760355334175
    kappa: 0.00025202636785477304
    s: 14.961216234594119
1623 1624 1625
    dkappa: 0
    ddkappa: 0
  }
1626 1627
  v: 1.1689804954188214
  a: -0.285429393350754
1628 1629 1630 1631
  relative_time: 5.7499999999999876
}
trajectory_point {
  path_point {
1632 1633 1634 1635 1636
    x: 586365.32653757627
    y: 4140776.2128100814
    theta: 1.3057778130488398
    kappa: 0.00029434966767379089
    s: 15.019311123642701
1637 1638 1639
    dkappa: 0
    ddkappa: 0
  }
1640 1641
  v: 1.1548681239882022
  a: -0.27906249770641589
1642 1643 1644 1645
  relative_time: 5.7999999999999874
}
trajectory_point {
  path_point {
1646 1647 1648 1649 1650
    x: 586365.3415716046
    y: 4140776.2682034085
    theta: 1.3057950611165112
    kappa: 0.00033616471353178462
    s: 15.076708360154727
1651 1652 1653
    dkappa: 0
    ddkappa: 0
  }
1654 1655
  v: 1.1410745422649415
  a: -0.27267780505639794
1656 1657 1658 1659
  relative_time: 5.8499999999999872
}
trajectory_point {
  path_point {
1660 1661 1662 1663 1664
    x: 586365.35642707814
    y: 4140776.3229388455
    theta: 1.3058121043337343
    kappa: 0.00037748313387256876
    s: 15.133423905861822
1665 1666 1667
    dkappa: 0
    ddkappa: 0
  }
1668 1669
  v: 1.1276006400993237
  a: -0.26627531540070004
1670 1671 1672 1673
  relative_time: 5.899999999999987
}
trajectory_point {
  path_point {
1674 1675 1676 1677 1678
    x: 586365.37110482948
    y: 4140776.3770327503
    theta: 1.3058341830394573
    kappa: 0.00040534030860307085
    s: 15.189473766988124
1679 1680 1681
    dkappa: 0
    ddkappa: 0
  }
1682 1683
  v: 1.1144473073416328
  a: -0.2598550287393222
1684 1685 1686 1687
  relative_time: 5.9499999999999869
}
trajectory_point {
  path_point {
1688 1689 1690 1691 1692
    x: 586365.38561048312
    y: 4140776.430500228
    theta: 1.3058590887796149
    kappa: 0.00042523354846811035
    s: 15.244873994250288
1693 1694 1695
    dkappa: 0
    ddkappa: 0
  }
1696 1697
  v: 1.1016154338421529
  a: -0.25341694507226442
1698 1699 1700 1701
  relative_time: 5.9999999999999867
}
trajectory_point {
  path_point {
1702 1703 1704 1705 1706
    x: 586365.39995026716
    y: 4140776.4833563147
    theta: 1.3058837097270477
    kappa: 0.00044489931264530625
    s: 15.299640729688663
1707 1708 1709
    dkappa: 0
    ddkappa: 0
  }
1710 1711
  v: 1.08910865815193
  a: -0.24685600998533544
1712 1713 1714 1715
  relative_time: 6.0499999999999865
}
trajectory_point {
  path_point {
1716 1717 1718 1719 1720
    x: 586365.41412846243
    y: 4140776.5356167895
    theta: 1.3059080532317617
    kappa: 0.00046434347191070619
    s: 15.353790322692765
1721 1722 1723
    dkappa: 0
    ddkappa: 0
  }
1724 1725
  v: 1.0769296400987893
  a: -0.24030663958867141
1726 1727 1728 1729
  relative_time: 6.0999999999999863
}
trajectory_point {
  path_point {
1730 1731 1732 1733 1734
    x: 586365.42814930854
    y: 4140776.587297467
    theta: 1.3059321382365385
    kappa: 0.00048336922158358241
    s: 15.407339146688583
1735 1736 1737
    dkappa: 0
    ddkappa: 0
  }
1738 1739
  v: 1.0650778014482252
  a: -0.23376883388226993
1740 1741 1742 1743
  relative_time: 6.1499999999999861
}
trajectory_point {
  path_point {
1744 1745 1746 1747 1748
    x: 586365.44201116671
    y: 4140776.6384157273
    theta: 1.3059574150895279
    kappa: 0.00047672997004087934
    s: 15.460303546190389
1749 1750 1751
    dkappa: 0
    ddkappa: 0
  }
1752 1753
  v: 1.0535525639657246
  a: -0.22724259286613105
1754 1755 1756 1757
  relative_time: 6.199999999999986
}
trajectory_point {
  path_point {
1758 1759 1760 1761 1762
    x: 586365.45572433912
    y: 4140776.68898568
    theta: 1.3059824208169548
    kappa: 0.00047016193270752523
    s: 15.512699836800715
1763 1764 1765
    dkappa: 0
    ddkappa: 0
  }
1766 1767
  v: 1.0423533494167745
  a: -0.2207279165402547
1768 1769 1770 1771
  relative_time: 6.2499999999999858
}
trajectory_point {
  path_point {
1772 1773 1774 1775 1776
    x: 586365.46929308842
    y: 4140776.7390230456
    theta: 1.3060071631914851
    kappa: 0.00046366306799637557
    s: 15.564544305210383
1777 1778 1779
    dkappa: 0
    ddkappa: 0
  }
1780 1781
  v: 1.0314795795668616
  a: -0.21422480490464096
1782 1783 1784 1785
  relative_time: 6.2999999999999856
}
trajectory_point {
  path_point {
1786 1787 1788 1789 1790
    x: 586365.48272166972
    y: 4140776.7885435149
    theta: 1.3060316499719891
    kappa: 0.00045723133794446115
    s: 15.615853209198477
1791 1792 1793
    dkappa: 0
    ddkappa: 0
  }
1794 1795
  v: 1.0209306761814727
  a: -0.20773325795928979
1796 1797 1798 1799
  relative_time: 6.3499999999999854
}
trajectory_point {
  path_point {
1800 1801 1802 1803 1804
    x: 586365.49601354823
    y: 4140776.837562962
    theta: 1.3060553035081404
    kappa: 0.00044826607843305048
    s: 15.666642777632363
1805 1806 1807
    dkappa: 0
    ddkappa: 0
  }
1808 1809
  v: 1.0107060610260949
  a: -0.20125327570420118
1810 1811 1812 1813
  relative_time: 6.3999999999999853
}
trajectory_point {
  path_point {
1814 1815 1816 1817 1818
    x: 586365.50916902779
    y: 4140776.88609809
    theta: 1.306075185673347
    kappa: 0.0004236882954580515
    s: 15.716929210467677
1819 1820 1821
    dkappa: 0
    ddkappa: 0
  }
1822 1823
  v: 1.000805155866215
  a: -0.19478485813937516
1824 1825 1826 1827
  relative_time: 6.4499999999999851
}
trajectory_point {
  path_point {
1828 1829 1830 1831 1832
    x: 586365.52219711221
    y: 4140776.9341632128
    theta: 1.3060948753033488
    kappa: 0.00039934851920705533
    s: 15.766728678748333
1833 1834 1835
    dkappa: 0
    ddkappa: 0
  }
1836 1837
  v: 0.99122738246731978
  a: -0.18832800526481169
1838 1839 1840 1841
  relative_time: 6.4999999999999849
}
trajectory_point {
  path_point {
1842 1843 1844 1845 1846
    x: 586365.53510202433
    y: 4140776.981773911
    theta: 1.3061143787803788
    kappa: 0.00037523886012020885
    s: 15.816057324606517
1847 1848 1849
    dkappa: 0
    ddkappa: 0
  }
1850 1851
  v: 0.98197216259489617
  a: -0.18188271708051079
1852 1853 1854 1855
  relative_time: 6.5499999999999847
}
trajectory_point {
  path_point {
1856 1857 1858 1859 1860
    x: 586365.54788797954
    y: 4140777.0289457357
    theta: 1.3061337024752404
    kappa: 0.00035135144276843218
    s: 15.864931261262688
1861 1862 1863
    dkappa: 0
    ddkappa: 0
  }
1864 1865
  v: 0.9730389180144311
  a: -0.17544899358647251
1866 1867 1868 1869
  relative_time: 6.5999999999999845
}
trajectory_point {
  path_point {
1870 1871 1872 1873 1874
    x: 586365.56055908371
    y: 4140777.0756942388
    theta: 1.3061526509963781
    kappa: 0.00032736583659831935
    s: 15.913366573025584
1875 1876 1877
    dkappa: 0
    ddkappa: 0
  }
1878 1879
  v: 0.9644270704914113
  a: -0.16902683478269676
1880 1881 1882 1883
  relative_time: 6.6499999999999844
}
trajectory_point {
  path_point {
1884 1885 1886 1887 1888
    x: 586365.57311598479
    y: 4140777.1220358796
    theta: 1.3061642044022652
    kappa: 0.000292388484569477
    s: 15.961379315292211
1889 1890 1891
    dkappa: 0
    ddkappa: 0
  }
1892 1893
  v: 0.95613604179132383
  a: -0.16261624066918362
1894 1895 1896 1897
  relative_time: 6.6999999999999842
}
trajectory_point {
  path_point {
1898 1899 1900 1901 1902
    x: 586365.58556656155
    y: 4140777.1679851264
    theta: 1.3061756599808683
    kappa: 0.0002577072997108207
    s: 16.008985514547856
1903 1904 1905
    dkappa: 0
    ddkappa: 0
  }
1906 1907
  v: 0.94816525367965532
  a: -0.15621721124593302
1908 1909 1910 1911
  relative_time: 6.749999999999984
}
trajectory_point {
  path_point {
1912 1913 1914 1915 1916
    x: 586365.597914998
    y: 4140777.2135574222
    theta: 1.3061870215817133
    kappa: 0.00022331062776692764
    s: 16.056201168366076
1917 1918 1919
    dkappa: 0
    ddkappa: 0
  }
1920 1921
  v: 0.94051412792189282
  a: -0.149829746512945
1922 1923 1924 1925
  relative_time: 6.7999999999999838
}
trajectory_point {
  path_point {
1926 1927 1928 1929 1930
    x: 586365.61016547028
    y: 4140777.2587681776
    theta: 1.3061982930473697
    kappa: 0.00018918683554461065
    s: 16.1030422454087
1931 1932 1933
    dkappa: 0
    ddkappa: 0
  }
1934 1935
  v: 0.93318208628352317
  a: -0.14345384647021955
1936 1937 1938 1939
  relative_time: 6.8499999999999837
}
trajectory_point {
  path_point {
1940 1941 1942 1943 1944
    x: 586365.62232214736
    y: 4140777.303632779
    theta: 1.3062094782134497
    kappa: 0.00015532431091291171
    s: 16.149524685425842
1945 1946 1947
    dkappa: 0
    ddkappa: 0
  }
1948 1949
  v: 0.92616855053003322
  a: -0.13708951111775669
1950 1951 1952 1953
  relative_time: 6.8999999999999835
}
trajectory_point {
  path_point {
1954 1955 1956 1957 1958
    x: 586365.63438811386
    y: 4140777.3481668741
    theta: 1.3062142706039535
    kappa: 0.00011758040144109458
    s: 16.195664399255879
1959 1960 1961
    dkappa: 0
    ddkappa: 0
  }
1962 1963
  v: 0.9194729424269098
  a: -0.13073674045555639
1964 1965 1966 1967
  relative_time: 6.9499999999999833
}
trajectory_point {
  path_point {
1968 1969 1970 1971 1972
    x: 586365.646368087
    y: 4140777.39238564
    theta: 1.3062159784127
    kappa: 7.8106755018828722e-05
    s: 16.241477268825463
1973 1974 1975
    dkappa: 0
    ddkappa: 0
  }
1976 1977
  v: 0.91309468373963987
  a: -0.12439553448361867
1978 1979 1980 1981
  relative_time: 6.9999999999999831
}
trajectory_point {
  path_point {
1982 1983 1984 1985 1986
    x: 586365.65826673666
    y: 4140777.4363042368
    theta: 1.306217674628338
    kappa: 3.890106732914777e-05
    s: 16.28697914714953
1987 1988 1989
    dkappa: 0
    ddkappa: 0
  }
1990 1991
  v: 0.90703319623371026
  a: -0.11806589320194352
1992 1993 1994 1995
  relative_time: 7.0499999999999829
}
trajectory_point {
  path_point {
1996 1997 1998 1999 2000
    x: 586365.67008820071
    y: 4140777.4799379352
    theta: 1.3062193598407572
    kappa: -5.0296116697441065e-08
    s: 16.332185858331282
2001 2002 2003
    dkappa: 0
    ddkappa: 0
  }
2004 2005
  v: 0.90128790167460782
  a: -0.11174781661053096
2006 2007 2008 2009
  relative_time: 7.0999999999999828
}
trajectory_point {
  path_point {
2010 2011 2012 2013 2014
    x: 586365.6818366095
    y: 4140777.5233019837
    theta: 1.3062210346387695
    kappa: -3.8760944896307534e-05
    s: 16.377113197562196
2015 2016 2017
    dkappa: 0
    ddkappa: 0
  }
2018 2019
  v: 0.89585822182781949
  a: -0.10544130470938096
2020 2021 2022 2023
  relative_time: 7.1499999999999826
}
trajectory_point {
  path_point {
2024 2025 2026 2027 2028
    x: 586365.69351617
    y: 4140777.5664115767
    theta: 1.3062216731980196
    kappa: -7.7399183978152641e-05
    s: 16.421776931122025
2029 2030 2031
    dkappa: 0
    ddkappa: 0
  }
2032 2033
  v: 0.89074357845883212
  a: -0.099146357498493543
2034 2035 2036 2037
  relative_time: 7.1999999999999824
}
trajectory_point {
  path_point {
2038 2039 2040 2041 2042
    x: 586365.70513164508
    y: 4140777.6092817271
    theta: 1.3062133610543083
    kappa: -0.00011717167973701785
    s: 16.4661927963788
2043 2044 2045
    dkappa: 0
    ddkappa: 0
  }
2046 2047
  v: 0.88594339333313243
  a: -0.092862974977868662
2048 2049 2050 2051
  relative_time: 7.2499999999999822
}
trajectory_point {
  path_point {
2052 2053 2054 2055 2056
    x: 586365.71668640664
    y: 4140777.6519277981
    theta: 1.3062050923578183
    kappa: -0.00015673628634485585
    s: 16.510376501788819
2057 2058 2059
    dkappa: 0
    ddkappa: 0
  }
2060 2061
  v: 0.88145708821620761
  a: -0.0865911571475064
2062 2063 2064 2065
  relative_time: 7.2999999999999821
}
trajectory_point {
  path_point {
2066 2067 2068 2069 2070
    x: 586365.72818455508
    y: 4140777.6943649212
    theta: 1.3061968641742248
    kappa: -0.00019610704415901084
    s: 16.554343726896658
2071 2072 2073
    dkappa: 0
    ddkappa: 0
  }
2074 2075
  v: 0.87728408487354415
  a: -0.080330904007406667
2076 2077 2078 2079
  relative_time: 7.3499999999999819
}
trajectory_point {
  path_point {
2080 2081 2082 2083 2084
    x: 586365.73963018321
    y: 4140777.7366082044
    theta: 1.3061886735746133
    kappa: -0.0002352979676476284
    s: 16.598110122335168
2085 2086 2087
    dkappa: 0
    ddkappa: 0
  }
2088 2089
  v: 0.87342380507062922
  a: -0.074082215557569553
2090 2091 2092 2093
  relative_time: 7.3999999999999817
}
trajectory_point {
  path_point {
2094 2095 2096 2097 2098
    x: 586365.75102737639
    y: 4140777.778672725
    theta: 1.3061805176354802
    kappa: -0.00027432304538964575
    s: 16.641691309825475
2099 2100 2101
    dkappa: 0
    ddkappa: 0
  }
2102 2103
  v: 0.86987567057294946
  a: -0.067845091797994972
2104 2105 2106 2107
  relative_time: 7.4499999999999815
}
trajectory_point {
  path_point {
2108 2109 2110 2111 2112
    x: 586365.76238131081
    y: 4140777.8205732354
    theta: 1.3061690276077205
    kappa: -0.00031237322310933007
    s: 16.685102882176974
2113 2114 2115
    dkappa: 0
    ddkappa: 0
  }
2116 2117
  v: 0.866639103145992
  a: -0.061619532728683007
2118 2119 2120 2121
  relative_time: 7.4999999999999813
}
trajectory_point {
  path_point {
2122 2123 2124 2125 2126
    x: 586365.7736969589
    y: 4140777.8623245135
    theta: 1.3061514346180645
    kappa: -0.00034878610166994256
    s: 16.728360403287343
2127 2128 2129
    dkappa: 0
    ddkappa: 0
  }
2130 2131
  v: 0.86371352455524353
  a: -0.055405538349633576
2132 2133 2134 2135
  relative_time: 7.5499999999999812
}
trajectory_point {
  path_point {
2136 2137 2138 2139 2140
    x: 586365.78497637273
    y: 4140777.9039420988
    theta: 1.3061338979634518
    kappa: -0.00038508238141838963
    s: 16.771479408142529
2141 2142 2143
    dkappa: 0
    ddkappa: 0
  }
2144 2145
  v: 0.86109835656619094
  a: -0.049203108660846762
2146 2147 2148 2149
  relative_time: 7.599999999999981
}
trajectory_point {
  path_point {
2150 2151 2152 2153 2154
    x: 586365.79622360866
    y: 4140777.9454409573
    theta: 1.3061164113375165
    kappa: -0.00042127511490098091
    s: 16.81447540281675
2155 2156 2157
    dkappa: 0
    ddkappa: 0
  }
2158 2159
  v: 0.85879302094432119
  a: -0.04301224366232248
2160 2161 2162 2163
  relative_time: 7.6499999999999808
}
trajectory_point {
  path_point {
2164 2165 2166 2167 2168
    x: 586365.80744271528
    y: 4140777.9868360269
    theta: 1.3060989684456519
    kappa: -0.00045737733032700682
    s: 16.857363864472504
2169 2170 2171
    dkappa: 0
    ddkappa: 0
  }
2172 2173
  v: 0.856796939455121
  a: -0.036832943354060815
2174 2175 2176 2177
  relative_time: 7.6999999999999806
}
trajectory_point {
  path_point {
2178 2179 2180 2181 2182
    x: 586365.81863773358
    y: 4140778.0281422185
    theta: 1.3060815630050091
    kappa: -0.00049340203156874186
    s: 16.900160241360563
2183 2184 2185
    dkappa: 0
    ddkappa: 0
  }
2186 2187
  v: 0.8551095338640774
  a: -0.030665207736061656
2188 2189 2190 2191
  relative_time: 7.7499999999999805
}
trajectory_point {
  path_point {
2192 2193 2194 2195 2196
    x: 586365.82981528621
    y: 4140778.0693737115
    theta: 1.3060601030669605
    kappa: -0.00052654295790727755
    s: 16.942879952819972
2197 2198 2199
    dkappa: 0
    ddkappa: 0
  }
2200 2201
  v: 0.85373022593667713
  a: -0.024509036808325141
2202 2203 2204 2205
  relative_time: 7.79999999999998
}
trajectory_point {
  path_point {
2206 2207 2208 2209 2210
    x: 586365.84097959893
    y: 4140778.1105453079
    theta: 1.3060342674258949
    kappa: -0.00055659574220562292
    s: 16.985538389278048
2211 2212 2213
    dkappa: 0
    ddkappa: 0
  }
2214 2215
  v: 0.85265843743840719
  a: -0.018364430570851159
2216 2217 2218 2219
  relative_time: 7.84999999999998
}
trajectory_point {
  path_point {
2220 2221 2222 2223 2224
    x: 586365.85213189549
    y: 4140778.151672591
    theta: 1.3060084595918064
    kappa: -0.00058661618054387812
    s: 17.028150912250389
2225 2226 2227
    dkappa: 0
    ddkappa: 0
  }
2228 2229
  v: 0.8518935901347543
  a: -0.01223138902363971
2230 2231 2232 2233
  relative_time: 7.89999999999998
}
trajectory_point {
  path_point {
2234 2235 2236 2237 2238
    x: 586365.86327618849
    y: 4140778.1927703586
    theta: 1.3059826702786963
    kappa: -0.00061661507471120753
    s: 17.070732854340861
2239 2240 2241
    dkappa: 0
    ddkappa: 0
  }
2242 2243
  v: 0.85143510579120552
  a: -0.006109912166690934
2244 2245 2246 2247
  relative_time: 7.94999999999998
}
trajectory_point {
  path_point {
2248 2249 2250 2251 2252
    x: 586365.87441648333
    y: 4140778.2338533816
    theta: 1.3059568902180763
    kappa: -0.00064660320612852293
    s: 17.113299519241604
2253 2254 2255
    dkappa: 0
    ddkappa: 0
  }
2256 2257
  v: 0.85128240617324757
  a: -4.6629367034256575e-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
        }
      }
    }
  }
}