result_qp_path_failure_0.pb.txt 37.5 KB
Newer Older
1 2 3
header {
  module_name: "planning"
}
4 5
total_path_length: 38.25392342267164
total_path_time: 7.9999999999999885
6 7 8 9
is_replan: true
gear: GEAR_DRIVE
trajectory_point {
  path_point {
10 11
    x: 586916.59764750663
    y: 4141003.4867316117
12
    theta: 2.6133262586660049
13
    kappa: -0.0224215037902896
14 15
    s: 1.3877787807814457e-17
    dkappa: -1.9030169564307339e-19
16 17 18
    ddkappa: 0
  }
  v: 4.8822846412658691
19
  a: -0.6387171057141463
20 21
  relative_time: 0
}
22 23
trajectory_point {
  path_point {
24 25 26 27 28 29
    x: 586916.51473062881
    y: 4141003.538053818
    theta: 2.6092594541551062
    kappa: -0.023775841086302187
    s: 0.097515011571290791
    dkappa: -0.0013371923760227208
30 31
    ddkappa: 0
  }
32 33
  v: 4.8690713635482741
  a: -0.682263315657554
34 35 36 37
  relative_time: 0.02
}
trajectory_point {
  path_point {
38 39 40 41 42 43
    x: 586916.43204574345
    y: 4141003.5892324303
    theta: 2.6052040281198821
    kappa: -0.025126389094205392
    s: 0.19475718677093257
    dkappa: -0.0026706434335531186
44 45
    ddkappa: 0
  }
46 47
  v: 4.8550078995623771
  a: -0.72374088717950524
48 49 50 51
  relative_time: 0.04
}
trajectory_point {
  path_point {
52 53 54 55 56 57
    x: 586916.34960695868
    y: 4141003.6402587164
    theta: 2.601160672522127
    kappa: -0.026472917375170522
    s: 0.29170993353938957
    dkappa: -0.00400012565094959
58 59
    ddkappa: 0
  }
60 61
  v: 4.840135312798501
  a: -0.7631807480904651
62 63 64 65
  relative_time: 0.06
}
trajectory_point {
  path_point {
66 67 68 69 70 71
    x: 586916.26742768963
    y: 4141003.6911243726
    theta: 2.597130045331042
    kappa: -0.027815206810666897
    s: 0.38835747490137046
    dkappa: -0.0053254226835618449
72 73
    ddkappa: 0
  }
74 75
  v: 4.8244940481907612
  a: -0.80061382620089883
76 77
  relative_time: 0.08
}
78 79
trajectory_point {
  path_point {
80 81 82 83 84 85
    x: 586916.18552066875
    y: 4141003.7418215177
    theta: 2.5931127710391664
    kappa: -0.029153049430645457
    s: 0.48468483659470396
    dkappa: -0.0066463291940896127
86 87
    ddkappa: 0
  }
88 89
  v: 4.8081239321170655
  a: -0.8360710493212713
90 91
  relative_time: 0.1
}
92 93
trajectory_point {
  path_point {
94 95 96 97 98 99
    x: 586916.1038979569
    y: 4141003.792342688
    theta: 2.5891094411782998
    kappa: -0.030486248241722455
    s: 0.580677834699215
    dkappa: -0.0079626506829413475
100 101
    ddkappa: 0
  }
102 103
  v: 4.7910641723991079
  a: -0.86958334526204784
104 105 106 107
  relative_time: 0.12000000000000001
}
trajectory_point {
  path_point {
108 109 110 111 112 113
    x: 586916.022570953
    y: 4141003.8426808263
    theta: 2.585120614835442
    kappa: -0.031814617055363044
    s: 0.6763230632656001
    dkappa: -0.009274203318592928
114 115
    ddkappa: 0
  }
116 117
  v: 4.7733533583023773
  a: -0.90118164183369354
118 119 120 121
  relative_time: 0.14
}
trajectory_point {
  path_point {
122 123 124 125 126 127
    x: 586915.94155040523
    y: 4141003.8928292808
    theta: 2.5811468191687164
    kappa: -0.033137980316064922
    s: 0.77160788194430374
    dkappa: -0.010580813767946364
128 129
    ddkappa: 0
  }
130 131
  v: 4.7550294605361518
  a: -0.9308968668466735
132 133 134 135
  relative_time: 0.16
}
trajectory_point {
  path_point {
136 137 138 139 140 141
    x: 586915.86084642087
    y: 4141003.9427817953
    theta: 2.5771885499233047
    kappa: -0.034456172929541978
    s: 0.86652040361439342
    dkappa: -0.0118823190266885
142 143
    ddkappa: 0
  }
144 145
  v: 4.736129831253499
  a: -0.95875994811145282
146 147
  relative_time: 0.18
}
148 149
trajectory_point {
  path_point {
150 151 152 153 154 155
    x: 586915.78046847787
    y: 4141003.9925325033
    theta: 2.5732462719473723
    kappa: -0.035769040090907922
    s: 0.96104948201243667
    dkappa: -0.013178566249649725
156 157
    ddkappa: 0
  }
158 159
  v: 4.7166912040512781
  a: -0.98480181343849638
160 161 162 163
  relative_time: 0.19999999999999998
}
trajectory_point {
  path_point {
164 165 166 167 168 169
    x: 586915.70128299226
    y: 4141004.0434052818
    theta: 2.5693814868553408
    kappa: -0.037024378601648492
    s: 1.0551846993613752
    dkappa: -0.01383700853651521
170 171
    ddkappa: 0
  }
172 173
  v: 4.6967496939701405
  a: -1.0090533906382697
174 175 176 177
  relative_time: 0.21999999999999997
}
trajectory_point {
  path_point {
178 179 180 181 182 183
    x: 586915.62348051043
    y: 4141004.0956776151
    theta: 2.5656075807095791
    kappa: -0.038210987287075553
    s: 1.1489163539994025
    dkappa: -0.013723078406034012
184 185
    ddkappa: 0
  }
186 187
  v: 4.6763407974945261
  a: -1.0315456075212377
188 189 190 191
  relative_time: 0.23999999999999996
}
trajectory_point {
  path_point {
192 193 194 195 196 197
    x: 586915.54602047685
    y: 4141004.1477198722
    theta: 2.5618502854419436
    kappa: -0.039392373104870093
    s: 1.2422354480088382
    dkappa: -0.0136096497399346
198 199
    ddkappa: 0
  }
200 201
  v: 4.6554993925526666
  a: -1.0523093918978657
202 203 204 205
  relative_time: 0.25999999999999995
}
trajectory_point {
  path_point {
206 207 208 209 210 211
    x: 586915.46890978643
    y: 4141004.19952742
    theta: 2.5581099354978249
    kappa: -0.040568430897195105
    s: 1.3351336748450047
    dkappa: -0.013496732634760374
212 213
    ddkappa: 0
  }
214 215
  v: 4.634259738516584
  a: -1.0713756715786185
216
  relative_time: 0.27999999999999997
217 218 219
}
trajectory_point {
  path_point {
220 221 222 223 224 225
    x: 586915.39215477044
    y: 4141004.2510960037
    theta: 2.5543868379840493
    kappa: -0.041739064102130616
    s: 1.4276034069651027
    dkappa: -0.013384336361732989
226 227
    ddkappa: 0
  }
228 229
  v: 4.6126554762020913
  a: -1.0887753743739612
230 231 232 233
  relative_time: 0.3
}
trajectory_point {
  path_point {
234 235 236 237 238 239
    x: 586915.31576120667
    y: 4141004.3024217431
    theta: 2.5506812731669637
    kappa: -0.042904184597059747
    s: 1.5196376834570868
    dkappa: -0.013272469381789369
240 241
    ddkappa: 0
  }
242 243
  v: 4.5907196278687916
  a: -1.1045394280943592
244 245 246 247
  relative_time: 0.32
}
trajectory_point {
  path_point {
248 249 250 251 252 253
    x: 586915.23973433021
    y: 4141004.3535011197
    theta: 2.5469934949705451
    kappa: -0.04406371254205476
    s: 1.6112301976685419
    dkappa: -0.013161139360618714
254 255
    ddkappa: 0
  }
256 257
  v: 4.56848459722008
  a: -1.1186987605502776
258 259 260 261
  relative_time: 0.34
}
trajectory_point {
  path_point {
262 263 264 265 266 267
    x: 586915.16407884308
    y: 4141004.4043309749
    theta: 2.5433237314744881
    kappa: -0.045217576223263167
    s: 1.7023752848355589
    dkappa: -0.013050353183699511
268 269
    ddkappa: 0
  }
270 271
  v: 4.5459821694031408
  a: -1.1312842995521812
272 273 274 275
  relative_time: 0.36000000000000004
}
trajectory_point {
  path_point {
276 277 278 279 280 281
    x: 586915.08879892481
    y: 4141004.4549085004
    theta: 2.539672185412309
    kappa: -0.046365711896293745
    s: 1.7930679097116098
    dkappa: -0.012940116971336532
282 283
    ddkappa: 0
  }
284 285
  v: 4.52324351100895
  a: -1.1423269729105356
286
  relative_time: 0.38000000000000006
287 288 289
}
trajectory_point {
  path_point {
290 291 292 293 294 295
    x: 586915.01389824273
    y: 4141004.5052312328
    theta: 2.5360390346694377
    kappa: -0.0475080636296026
    s: 1.8833036541964241
    dkappa: -0.012830436093697868
296 297
    ddkappa: 0
  }
298 299
  v: 4.5002991700722728
  a: -1.1518577084358053
300 301 302 303
  relative_time: 0.40000000000000008
}
trajectory_point {
  path_point {
304 305 306 307 308 309
    x: 586914.93937996193
    y: 4141004.555297045
    theta: 2.532424432781319
    kappa: -0.04864458314787929
    s: 1.973078704964865
    dkappa: -0.012721315185851918
310 311
    ddkappa: 0
  }
312 313
  v: 4.4771790760716685
  a: -1.1599074339384561
314 315 316 317
  relative_time: 0.4200000000000001
}
trajectory_point {
  path_point {
318 319 320 321 322 323
    x: 586914.866355145
    y: 4141004.6066684308
    theta: 2.5284355915883143
    kappa: -0.049730188550027789
    s: 2.0623898410958041
    dkappa: -0.012615159002751871
324 325
    ddkappa: 0
  }
326 327
  v: 4.4539125399294823
  a: -1.1665070772289527
328 329 330 331
  relative_time: 0.44000000000000011
}
trajectory_point {
  path_point {
332 333 334 335 336 337
    x: 586914.7951625085
    y: 4141004.6598188584
    theta: 2.5239533211474026
    kappa: -0.050751171182255195
    s: 2.1512344217009987
    dkappa: -0.012512699688586907
338 339
    ddkappa: 0
  }
340 341
  v: 4.4305282540118549
  a: -1.17168756611776
342 343 344 345
  relative_time: 0.46000000000000013
}
trajectory_point {
  path_point {
346 347 348 349 350 351
    x: 586914.7243453922
    y: 4141004.7126889341
    theta: 2.519494693350639
    kappa: -0.051766768434600943
    s: 2.2396103735539654
    dkappa: -0.012410780816846502
352 353
    ddkappa: 0
  }
354 355
  v: 4.4070542921287137
  a: -1.1754798284153436
356
  relative_time: 0.48000000000000015
357 358 359
}
trajectory_point {
  path_point {
360 361 362 363 364 365
    x: 586914.6539050123
    y: 4141004.76527775
    theta: 2.5150597847789378
    kappa: -0.052776962863275809
    s: 2.3275161787188585
    dkappa: -0.012309404138078239
366 367
    ddkappa: 0
  }
368 369
  v: 4.38351810953378
  a: -1.1779147919321684
370 371 372 373
  relative_time: 0.50000000000000011
}
trajectory_point {
  path_point {
374 375 376 377 378 379
    x: 586914.58384214994
    y: 4141004.8175847195
    theta: 2.5106486446225453
    kappa: -0.053781743263603771
    s: 2.4149508621793445
    dkappa: -0.012208570776712037
380 381
    ddkappa: 0
  }
382 383
  v: 4.3599465429245621
  a: -1.1790233844786995
384 385 386 387
  relative_time: 0.52000000000000013
}
trajectory_point {
  path_point {
388 389 390 391 392 393
    x: 586914.51415716135
    y: 4141004.8696095808
    theta: 2.5062612953051762
    kappa: -0.054781104527855715
    s: 2.5019139794674783
    dkappa: -0.012108281245327066
394 395
    ddkappa: 0
  }
396 397
  v: 4.3363658104423637
  a: -1.1788365338654021
398 399 400 401
  relative_time: 0.54000000000000015
}
trajectory_point {
  path_point {
402 403 404 405 406 407
    x: 586914.44484998751
    y: 4141004.9213523758
    theta: 2.5018977331081427
    kappa: -0.055775047503083083
    s: 2.5884056042925767
    dkappa: -0.012008535458918626
408 409
    ddkappa: 0
  }
410 411
  v: 4.3128015116722755
  a: -1.1773851679027412
412 413 414 415
  relative_time: 0.56000000000000016
}
trajectory_point {
  path_point {
416 417 418 419 420 421
    x: 586914.37592016417
    y: 4141004.9728134512
    theta: 2.4975579287944933
    kappa: -0.056763578848951737
    s: 2.6744263161701
    dkappa: -0.011909332749165077
422 423
    ddkappa: 0
  }
424 425
  v: 4.28927862764318
  a: -1.174700214401182
426
  relative_time: 0.58000000000000018
427 428 429
}
trajectory_point {
  path_point {
430 431 432 433 434 435
    x: 586914.30736683123
    y: 4141005.0239934498
    theta: 2.493241828233133
    kappa: -0.057746710895575579
    s: 2.7599771880505193
    dkappa: -0.011810671878694718
436 437
    ddkappa: 0
  }
438 439
  v: 4.2658215208277506
  a: -1.17081260117119
440 441 442 443
  relative_time: 0.6000000000000002
}
trajectory_point {
  path_point {
444 445 446 447 448 449
    x: 586914.23918874376
    y: 4141005.0748933004
    theta: 2.4889493530229654
    kappa: -0.058724461501350293
    s: 2.8450597739482011
    dkappa: -0.011712551055352698
450 451
    ddkappa: 0
  }
452 453
  v: 4.2424539351424517
  a: -1.1657532560232293
454 455 456 457
  relative_time: 0.62000000000000022
}
trajectory_point {
  path_point {
458 459 460 461 462 463
    x: 586914.17138428066
    y: 4141005.1255142135
    theta: 2.4846804011170178
    kappa: -0.059696853910787141
    s: 2.9296760965702768
    dkappa: -0.01161496794646792
464 465
    ddkappa: 0
  }
466 467
  v: 4.2191989959475382
  a: -1.159553106767766
468 469 470 471
  relative_time: 0.64000000000000024
}
trajectory_point {
  path_point {
472 473 474 475 476 477
    x: 586914.10395145568
    y: 4141005.175857672
    theta: 2.4804348474465776
    kappa: -0.0606639166123466
    s: 3.0138286349455221
    dkappa: -0.011517919693119934
478 479
    ddkappa: 0
  }
480 481
  v: 4.1960792100470545
  a: -1.1522430812152646
482 483 484 485
  relative_time: 0.66000000000000025
}
trajectory_point {
  path_point {
486 487 488 489 490 491
    x: 586914.03921281057
    y: 4141005.2288484671
    theta: 2.4756873617471564
    kappa: -0.06155678413022278
    s: 3.0975203120532315
    dkappa: -0.011423868009905814
492 493
    ddkappa: 0
  }
494 495
  v: 4.173116465688838
  a: -1.1438541071761907
496
  relative_time: 0.68000000000000027
497 498 499
}
trajectory_point {
  path_point {
500 501 502 503 504 505
    x: 586913.9756867293
    y: 4141005.2826291714
    theta: 2.4707718592056729
    kappa: -0.06241932376316707
    s: 3.1807544824520924
    dkappa: -0.011331240913868737
506 507
    ddkappa: 0
  }
508 509
  v: 4.1503320325645143
  a: -1.134417112461009
510 511 512 513
  relative_time: 0.70000000000000029
}
trajectory_point {
  path_point {
514 515 516 517 518 519
    x: 586913.91250694683
    y: 4141005.3361167014
    theta: 2.4658831524551292
    kappa: -0.063277161449263375
    s: 3.2635349199090644
    dkappa: -0.011239118754260802
520 521
    ddkappa: 0
  }
522 523
  v: 4.1277465618095022
  a: -1.1239630248801851
524 525 526 527
  relative_time: 0.72000000000000031
}
trajectory_point {
  path_point {
528 529 530 531 532 533
    x: 586913.849670272
    y: 4141005.3893137593
    theta: 2.4610209946044934
    kappa: -0.064130340511304618
    s: 3.3458658050282528
    dkappa: -0.011147496878699261
534 535
    ddkappa: 0
  }
536 537
  v: 4.1053800860030085
  a: -1.1125227722441835
538 539 540 541
  relative_time: 0.74000000000000032
}
trajectory_point {
  path_point {
542 543 544 545 546 547
    x: 586913.78717321332
    y: 4141005.4422233
    theta: 2.4561851154670302
    kappa: -0.064978908359859
    s: 3.4277517128797852
    dkappa: -0.011056370195820099
548 549
    ddkappa: 0
  }
550 551
  v: 4.0832520191680324
  a: -1.1001272823634698
552 553 554 555
  relative_time: 0.76000000000000034
}
trajectory_point {
  path_point {
556 557 558 559 560 561
    x: 586913.72501198738
    y: 4141005.4948485289
    theta: 2.4513752222908911
    kappa: -0.065822916365070289
    s: 3.5091976006286867
    dkappa: -0.010965733189045229
562 563
    ddkappa: 0
  }
564 565
  v: 4.0613811567713647
  a: -1.086807483048509
566
  relative_time: 0.78000000000000036
567 568 569
}
trajectory_point {
  path_point {
570 571 572 573 574 575
    x: 586913.66318252822
    y: 4141005.5471928846
    theta: 2.4465910004897058
    kappa: -0.066662419728458322
    s: 3.5902087951637562
    dkappa: -0.010875579930349677
576 577
    ddkappa: 0
  }
578 579
  v: 4.0397856757235839
  a: -1.0725943021097659
580 581 582 583
  relative_time: 0.80000000000000038
}
trajectory_point {
  path_point {
584 585 586 587 588 589
    x: 586913.6016804981
    y: 4141005.5992600424
    theta: 2.4418321143731809
    kappa: -0.067497477354719462
    s: 3.6707909807264425
    dkappa: -0.010785904094028798
590 591
    ddkappa: 0
  }
592 593
  v: 4.0184831343790623
  a: -1.0575186673577064
594 595 596 597
  relative_time: 0.8200000000000004
}
trajectory_point {
  path_point {
598 599 600 601 602 603
    x: 586913.54050129489
    y: 4141005.6510538971
    theta: 2.4370982078776837
    kappa: -0.06832815172352695
    s: 3.7509501865397188
    dkappa: -0.010696698970465462
604 605
    ddkappa: 0
  }
606 607
  v: 3.9974904725359615
  a: -1.0416115066027947
608 609 610 611
  relative_time: 0.84000000000000041
}
trajectory_point {
  path_point {
612 613 614 615 616 617
    x: 586913.47964006336
    y: 4141005.7025785591
    theta: 2.432388905296845
    kappa: -0.06915450876133139
    s: 3.8306927744369603
    dkappa: -0.01060795747989726
618 619
    ddkappa: 0
  }
620 621
  v: 3.9768240114362334
  a: -1.0249037476554963
622 623 624 625
  relative_time: 0.86000000000000043
}
trajectory_point {
  path_point {
626 627 628 629 630 631
    x: 586913.4190917036
    y: 4141005.7538383468
    theta: 2.4277038120121439
    kappa: -0.069976617713161215
    s: 3.9100254264908187
    dkappa: -0.010519672186183691
632 633
    ddkappa: 0
  }
634 635
  v: 3.9564994537656215
  a: -1.0074263183262762
636
  relative_time: 0.88000000000000045
637 638 639
}
trajectory_point {
  path_point {
640 641 642 643 644 645
    x: 586913.35885088064
    y: 4141005.8048377759
    theta: 2.4230425152235053
    kappa: -0.070794551014422988
    s: 3.9889551326420993
    dkappa: -0.010431835310573373
646 647
    ddkappa: 0
  }
648 649
  v: 3.9365318836536587
  a: -0.9892101464256
650 651 652 653
  relative_time: 0.90000000000000047
}
trajectory_point {
  path_point {
654 655 656 657 658 659
    x: 586913.29972078
    y: 4141005.856469241
    theta: 2.4179480422861435
    kappa: -0.071587355664330152
    s: 4.0674891783286355
    dkappa: -0.010342233030648804
660 661
    ddkappa: 0
  }
662 663
  v: 3.9169357666736704
  a: -0.97028615976393229
664 665 666 667
  relative_time: 0.92000000000000048
}
trajectory_point {
  path_point {
668 669 670 671 672 673
    x: 586913.24390717491
    y: 4141005.91116505
    theta: 2.4111715115398304
    kappa: -0.072297606766868472
    s: 4.1456351321141645
    dkappa: -0.010244825302281862
674 675
    ddkappa: 0
  }
676 677
  v: 3.8977249498427717
  a: -0.95068528615173875
678 679 680 681
  relative_time: 0.9400000000000005
}
trajectory_point {
  path_point {
682 683 684 685 686 687
    x: 586913.1883651549
    y: 4141005.965594714
    theta: 2.4044279549040333
    kappa: -0.073004401838699218
    s: 4.2234008333172035
    dkappa: -0.010147891552905155
688 689
    ddkappa: 0
  }
690 691
  v: 3.8789126616218681
  a: -0.93043845339948361
692 693 694 695
  relative_time: 0.96000000000000052
}
trajectory_point {
  path_point {
696 697 698 699 700 701
    x: 586913.13308893633
    y: 4141006.0197639
    theta: 2.3977166701756971
    kappa: -0.073707814478027
    s: 4.3007943796399273
    dkappa: -0.010051421688857582
702 703
    ddkappa: 0
  }
704 705
  v: 3.8605115119156563
  a: -0.90957658931763263
706
  relative_time: 0.98000000000000054
707 708 709
}
trajectory_point {
  path_point {
710 711 712 713 714 715
    x: 586913.0780725599
    y: 4141006.0736784474
    theta: 2.3910369338184543
    kappa: -0.074407920519009352
    s: 4.3778241147970407
    dkappa: -0.0099554053098272061
716 717
    ddkappa: 0
  }
718 719
  v: 3.8425334920726235
  a: -0.88813062171665125
720
  relative_time: 1.0000000000000004
721 722 723
}
trajectory_point {
  path_point {
724 725 726 727 728 729
    x: 586912.80666854931
    y: 4141006.3396469704
    theta: 2.35808479566467
    kappa: -0.077861648293719582
    s: 4.7578233152287464
    dkappa: -0.0094817421564297455
730 731
    ddkappa: 0
  }
732 733
  v: 3.7593667390675503
  a: -0.77322170429105852
734
  relative_time: 1.1000000000000005
735 736 737
}
trajectory_point {
  path_point {
738 739 740 741 742 743
    x: 586912.54420663859
    y: 4141006.6034280718
    theta: 2.3265783790037329
    kappa: -0.081161954825172564
    s: 5.1300986014645487
    dkappa: -0.0090070441012031974
744 745
    ddkappa: 0
  }
746 747
  v: 3.6882212650946951
  a: -0.64834937045696139
748
  relative_time: 1.2000000000000006
749 750 751
}
trajectory_point {
  path_point {
752 753 754 755 756 757
    x: 586912.30492319318
    y: 4141006.8801061977
    theta: 2.2998359438688851
    kappa: -0.08395268612238535
    s: 5.4958954751958649
    dkappa: -0.0084826758560411532
758 759
    ddkappa: 0
  }
760 761
  v: 3.6299001129795032
  a: -0.51737959652250021
762
  relative_time: 1.3000000000000007
763 764 765
}
trajectory_point {
  path_point {
766 767 768 769 770 771
    x: 586912.06902293349
    y: 4141007.1528724227
    theta: 2.2734716152296173
    kappa: -0.086703959770151551
    s: 5.856520412515116
    dkappa: -0.00796572155948075
772 773
    ddkappa: 0
  }
774 775
  v: 3.5848197279166025
  a: -0.38417835879581458
776
  relative_time: 1.4000000000000008
777 778 779
}
trajectory_point {
  path_point {
780 781 782 783 784 785
    x: 586911.84426555177
    y: 4141007.4295399436
    theta: 2.2440739097637188
    kappa: -0.08917936666465176
    s: 6.2133022041526464
    dkappa: -0.0073888342751167371
786 787
    ddkappa: 0
  }
788 789
  v: 3.5530099574698095
  a: -0.25261163358504346
790
  relative_time: 1.5000000000000009
791 792 793
}
trajectory_point {
  path_point {
794 795 796 797 798 799
    x: 586911.63758756034
    y: 4141007.7172516808
    theta: 2.2085528268786607
    kappa: -0.091166198535184984
    s: 6.5675532957136378
    dkappa: -0.0066910146275375414
800 801
    ddkappa: 0
  }
802 803
  v: 3.5341140515721254
  a: -0.12654539719832569
804
  relative_time: 1.600000000000001
805 806 807
}
trajectory_point {
  path_point {
808 809 810 811 812 813
    x: 586911.43165241671
    y: 4141008.0039293165
    theta: 2.1731594148810718
    kappa: -0.0931458892780397
    s: 6.9205311279150372
    dkappa: -0.0059957031032041265
814 815
    ddkappa: 0
  }
816 817
  v: 3.5273886625257376
  a: -0.0098456259438031157
818
  relative_time: 1.7000000000000011
819 820 821
}
trajectory_point {
  path_point {
822 823 824 825 826 827
    x: 586911.23834495689
    y: 4141008.2986605112
    theta: 2.1408774391282162
    kappa: -0.094731165316165336
    s: 7.2733994768224663
    dkappa: -0.0052223215701585786
828 829
    ddkappa: 0
  }
830 831
  v: 3.5317038450020197
  a: 0.093621703870386264
832
  relative_time: 1.8000000000000012
833 834 835
}
trajectory_point {
  path_point {
836 837 838 839 840 841
    x: 586911.0603700272
    y: 4141008.6044259658
    theta: 2.1124194721625926
    kappa: -0.095824168774696059
    s: 7.6271897940871405
    dkappa: -0.0043482345369028324
842 843
    ddkappa: 0
  }
844 845
  v: 3.5455430560415331
  a: 0.17999061593610288
846
  relative_time: 1.9000000000000012
847 848 849
}
trajectory_point {
  path_point {
850 851 852 853 854 855
    x: 586910.88149843959
    y: 4141008.9117319011
    theta: 2.0838181307247989
    kappa: -0.096922678908884091
    s: 7.9827625471827943
    dkappa: -0.0034697437538228518
856 857
    ddkappa: 0
  }
858 859
  v: 3.5670031550540213
  a: 0.24539513394520773
860
  relative_time: 2.0000000000000013
861 862 863
}
trajectory_point {
  path_point {
864 865 866 867 868 869
    x: 586910.71957384527
    y: 4141009.2305403417
    theta: 2.04992314762136
    kappa: -0.097392584614716976
    s: 8.3407766977221378
    dkappa: -0.0024689725121395437
870 871
    ddkappa: 0
  }
872 873
  v: 3.5941234061752141
  a: 0.29601331105416984
874
  relative_time: 2.1000000000000014
875 876 877
}
trajectory_point {
  path_point {
878 879 880 881 882 883
    x: 586910.57013615489
    y: 4141009.55912413
    theta: 2.0118715307424377
    kappa: -0.097382532700415358
    s: 8.7017461272490451
    dkappa: -0.0013715246069273906
884 885
    ddkappa: 0
  }
886 887
  v: 3.6260116523457619
  a: 0.34080654059032733
888
  relative_time: 2.2000000000000015
889 890 891
}
trajectory_point {
  path_point {
892 893 894 895 896 897
    x: 586910.41928946285
    y: 4141009.8908060323
    theta: 1.9734611369681057
    kappa: -0.097372386009730957
    s: 9.0661190255871684
    dkappa: -0.000263729205745234
898 899
    ddkappa: 0
  }
900 901
  v: 3.6621008505057917
  a: 0.38008385650183923
902
  relative_time: 2.3000000000000016
903 904 905
}
trajectory_point {
  path_point {
906 907 908 909 910 911
    x: 586910.29185557365
    y: 4141010.2358493139
    theta: 1.9349884303244425
    kappa: -0.096477986660296222
    s: 9.4342884234239115
    dkappa: 0.00089221519716478279
912 913
    ddkappa: 0
  }
914 915
  v: 3.7018548609902466
  a: 0.41415429273686477
916
  relative_time: 2.4000000000000017
917 918 919
}
trajectory_point {
  path_point {
920 921 922 923 924 925
    x: 586910.1718892036
    y: 4141010.5882985545
    theta: 1.8962037302125054
    kappa: -0.095258598461904279
    s: 9.80659528264992
    dkappa: 0.0020741894723220922
926 927
    ddkappa: 0
  }
928 929
  v: 3.7447684475288869
  a: 0.44332688324356306
930
  relative_time: 2.5000000000000018
931 932 933
}
trajectory_point {
  path_point {
934 935 936 937 938 939
    x: 586910.05049555807
    y: 4141010.9449409884
    theta: 1.85695759705186
    kappa: -0.094024702841453686
    s: 10.183331586698543
    dkappa: 0.0032702260450273037
940 941
    ddkappa: 0
  }
942 943
  v: 3.7903672772462871
  a: 0.46791066197009323
944
  relative_time: 2.6000000000000019
945 946 947
}
trajectory_point {
  path_point {
948 949 950 951 952 953
    x: 586909.96243654471
    y: 4141011.3160409178
    theta: 1.8277900185270664
    kappa: -0.09162225803186641
    s: 10.564743430885343
    dkappa: 0.0044114569234815736
954 955
    ddkappa: 0
  }
956 957
  v: 3.8382079206618389
  a: 0.48821466286461446
958
  relative_time: 2.700000000000002
959 960 961
}
trajectory_point {
  path_point {
962 963 964 965 966 967
    x: 586909.87339736125
    y: 4141011.6919298833
    theta: 1.7982936893445043
    kappa: -0.089184241828283523
    s: 10.951034112747552
    dkappa: 0.0055669935423139968
968 969
    ddkappa: 0
  }
970 971
  v: 3.8878778516897485
  a: 0.5045479198752858
972
  relative_time: 2.800000000000002
973 974 975
}
trajectory_point {
  path_point {
976 977 978 979 980 981
    x: 586909.79573463229
    y: 4141012.07510823
    theta: 1.7659062590404737
    kappa: -0.086384631197644363
    s: 11.342367222383567
    dkappa: 0.0066359219945945382
982 983
    ddkappa: 0
  }
984 985
  v: 3.93899544763904
  a: 0.51721946695026655
986
  relative_time: 2.9000000000000021
987 988 989
}
trajectory_point {
  path_point {
990 991 992 993 994 995
    x: 586909.739230885
    y: 4141012.4675640464
    theta: 1.7286569821228523
    kappa: -0.082964573423721544
    s: 11.738869732792431
    dkappa: 0.0075390462080637136
996 997
    ddkappa: 0
  }
998 999
  v: 3.9912099892135506
  a: 0.52653833803771555
1000
  relative_time: 3.0000000000000022
1001 1002 1003
}
trajectory_point {
  path_point {
1004 1005 1006 1007 1008 1009
    x: 586909.68197715387
    y: 4141012.8652289966
    theta: 1.6909132890525491
    kappa: -0.079499120626151
    s: 12.140635090213301
    dkappa: 0.0084541577468172282
1010 1011
    ddkappa: 0
  }
1012 1013
  v: 4.0442016605119369
  a: 0.53281356708579231
1014
  relative_time: 3.1000000000000023
1015 1016 1017
}
trajectory_point {
  path_point {
1018 1019 1020 1021 1022 1023
    x: 586909.64991180459
    y: 4141013.2708652085
    theta: 1.6556945548388935
    kappa: -0.075532728674128663
    s: 12.547726304464955
    dkappa: 0.009075375807823638
1024 1025
    ddkappa: 0
  }
1026 1027
  v: 4.0976815490276692
  a: 0.53635418804265578
1028
  relative_time: 3.2000000000000024
1029 1030 1031
}
trajectory_point {
  path_point {
1032 1033 1034 1035 1036 1037
    x: 586909.62338590273
    y: 4141013.6824640846
    theta: 1.6207070815725082
    kappa: -0.071409555448539525
    s: 12.960179039285253
    dkappa: 0.00963446222577449
1038 1039
    ddkappa: 0
  }
1040 1041
  v: 4.1513916456490332
  a: 0.53746923485646514
1042
  relative_time: 3.3000000000000025
1043 1044 1045
}
trajectory_point {
  path_point {
1046 1047 1048 1049 1050 1051
    x: 586909.60717089288
    y: 4141014.09973336
    theta: 1.5896385329654574
    kappa: -0.0671621618993351
    s: 13.378004702670616
    dkappa: 0.010066799693227399
1052 1053
    ddkappa: 0
  }
1054 1055
  v: 4.2051048446591324
  a: 0.53646774147537957
1056
  relative_time: 3.4000000000000026
1057 1058 1059
}
trajectory_point {
  path_point {
1060 1061 1062 1063 1064 1065
    x: 586909.60990312207
    y: 4141014.522913374
    theta: 1.5660348862912983
    kappa: -0.062733507046806219
    s: 13.801193537215529
    dkappa: 0.010263758668336152
1066 1067
    ddkappa: 0
  }
1068 1069
  v: 4.2586249437358843
  a: 0.533658741847558
1070
  relative_time: 3.5000000000000027
1071 1072 1073
}
trajectory_point {
  path_point {
1074 1075 1076 1077 1078 1079
    x: 586909.61266979773
    y: 4141014.9514286164
    theta: 1.5421336574526716
    kappa: -0.058249018080384247
    s: 14.229717710452002
    dkappa: 0.010463200796956451
1080 1081
    ddkappa: 0
  }
1082 1083
  v: 4.3117866439520247
  a: 0.52935126992115977
1084
  relative_time: 3.6000000000000028
1085 1086 1087
}
trajectory_point {
  path_point {
1088 1089 1090 1091 1092 1093
    x: 586909.64026191423
    y: 4141015.3843606971
    theta: 1.5210312632192098
    kappa: -0.053867080507382065
    s: 14.663534405189061
    dkappa: 0.01030765276234108
1094 1095
    ddkappa: 0
  }
1096 1097
  v: 4.3644555497751032
  a: 0.52385435964434413
1098
  relative_time: 3.7000000000000028
1099 1100 1101
}
trajectory_point {
  path_point {
1102 1103 1104 1105 1106 1107
    x: 586909.66840789537
    y: 4141015.8225121112
    theta: 1.4997016301617778
    kappa: -0.049433642517280316
    s: 15.102588909852228
    dkappa: 0.010147044170529914
1108 1109
    ddkappa: 0
  }
1110 1111
  v: 4.4165281690674849
  a: 0.51747704496526992
1112
  relative_time: 3.8000000000000029
1113 1114 1115
}
trajectory_point {
  path_point {
1116 1117 1118 1119 1120 1121
    x: 586909.71169924433
    y: 4141016.2645173455
    theta: 1.4802856451199116
    kappa: -0.045237788277045179
    s: 15.546817708823003
    dkappa: 0.0098085450872689318
1122 1123
    ddkappa: 0
  }
1124 1125
  v: 4.4679319130863533
  a: 0.51052835983209643
1126
  relative_time: 3.900000000000003
1127 1128 1129
}
trajectory_point {
  path_point {
1130 1131 1132 1133 1134 1135
    x: 586909.76202324964
    y: 4141016.71102425
    theta: 1.461601645849095
    kappa: -0.041121576923775022
    s: 15.996151572778343
    dkappa: 0.00938851334535312
1136 1137
    ddkappa: 0
  }
1138 1139
  v: 4.5186250964837091
  a: 0.50331733819298574
1140
  relative_time: 4.0000000000000027
1141 1142 1143
}
trajectory_point {
  path_point {
1144 1145 1146 1147 1148 1149
    x: 586909.82119965716
    y: 4141017.161430615
    theta: 1.4414388563431135
    kappa: -0.037239839954333089
    s: 16.450517755874035
    dkappa: 0.0088805051119666134
1150 1151
    ddkappa: 0
  }
1152 1153
  v: 4.5685612639957442
  a: 0.49508546136810111
1154
  relative_time: 4.1000000000000023
1155 1156 1157
}
trajectory_point {
  path_point {
1158 1159 1160 1161 1162 1163
    x: 586909.89071445051
    y: 4141017.6154554
    theta: 1.4195717040608002
    kappa: -0.0336439514197894
    s: 16.909833346061063
    dkappa: 0.00826957586420433
1164 1165
    ddkappa: 0
  }
1166 1167
  v: 4.6175842878633944
  a: 0.48511655772518875
1168
  relative_time: 4.200000000000002
1169 1170 1171
}
trajectory_point {
  path_point {
1172 1173 1174 1175 1176 1177
    x: 586909.96503052989
    y: 4141018.0735867927
    theta: 1.4001508333891293
    kappa: -0.030216739337929489
    s: 17.373998964765093
    dkappa: 0.0076222173624716366
1178 1179
    ddkappa: 0
  }
1180 1181
  v: 4.6655390931308318
  a: 0.47378318178376932
1182
  relative_time: 4.3000000000000016
1183 1184 1185
}
trajectory_point {
  path_point {
1186 1187 1188 1189 1190 1191
    x: 586910.0503601029
    y: 4141018.5346600348
    theta: 1.3872819276985506
    kappa: -0.027275582682476478
    s: 17.842901588688807
    dkappa: 0.0068926659583207969
1192 1193
    ddkappa: 0
  }
1194 1195
  v: 4.7123078602941817
  a: 0.46145788806336346
1196
  relative_time: 4.4000000000000012
1197 1198 1199
}
trajectory_point {
  path_point {
1200 1201 1202 1203 1204 1205
    x: 586910.13835254812
    y: 4141018.9999094196
    theta: 1.3746298681854974
    kappa: -0.024433689991182367
    s: 18.316418275357112
    dkappa: 0.0061442268923018089
1206 1207
    ddkappa: 0
  }
1208 1209
  v: 4.757810025301521
  a: 0.44851323108349184
1210
  relative_time: 4.5000000000000009
1211 1212 1213
}
trajectory_point {
  path_point {
1214 1215 1216 1217 1218 1219
    x: 586910.23697796313
    y: 4141019.4676257549
    theta: 1.3637041204706595
    kappa: -0.022253966148918176
    s: 18.794419888662297
    dkappa: 0.00532576588376236
1220 1221
    ddkappa: 0
  }
1222 1223
  v: 4.8020022795528812
  a: 0.43532176536367506
1224
  relative_time: 4.6000000000000005
1225 1226 1227
}
trajectory_point {
  path_point {
1228 1229 1230 1231 1232 1233
    x: 586910.337200761
    y: 4141019.9394468591
    theta: 1.3527896246471727
    kappa: -0.020137421344623714
    s: 19.276774824409269
    dkappa: 0.0044770449293041357
1234 1235
    ddkappa: 0
  }
1236 1237
  v: 4.8448785699002421
  a: 0.42225604542343376
1238
  relative_time: 4.7
1239 1240 1241
}
trajectory_point {
  path_point {
1242 1243 1244 1245 1246 1247
    x: 586910.4472678462
    y: 4141020.4134123651
    theta: 1.3432000268423048
    kappa: -0.019067215050873866
    s: 19.763352735860728
    dkappa: 0.003328406639270122
1248 1249
    ddkappa: 0
  }
1250 1251
  v: 4.8864700986475382
  a: 0.40968862578228865
1252
  relative_time: 4.8
1253 1254 1255
}
trajectory_point {
  path_point {
1256 1257 1258 1259 1260 1261
    x: 586910.55847404792
    y: 4141020.8913180223
    theta: 1.3336315334238753
    kappa: -0.017959986611228364
    s: 20.254028259282354
    dkappa: 0.0022274650586835637
1262 1263
    ddkappa: 0
  }
1264 1265
  v: 4.926845323550654
  a: 0.39799206095976036
1266
  relative_time: 4.8999999999999995
1267 1268 1269
}
trajectory_point {
  path_point {
1270 1271 1272 1273 1274 1275
    x: 586910.67880864907
    y: 4141021.3711144556
    theta: 1.3279339784351309
    kappa: -0.015758002843840536
    s: 20.748684739488031
    dkappa: 0.003341485037962718
1276 1277
    ddkappa: 0
  }
1278 1279
  v: 4.9661099578174275
  a: 0.38753890547536951
1280
  relative_time: 4.9999999999999991
1281 1282 1283
}
trajectory_point {
  path_point {
1284 1285 1286 1287 1288 1289
    x: 586910.800161323
    y: 4141021.8546518078
    theta: 1.3221797608434915
    kappa: -0.013543741720141514
    s: 21.247217955385008
    dkappa: 0.00444656121052244
1290 1291
    ddkappa: 0
  }
1292 1293
  v: 5.0044069701076488
  a: 0.37870171384863682
1294
  relative_time: 5.0999999999999988
1295 1296 1297
}
trajectory_point {
  path_point {
1298 1299 1300 1301 1302 1303
    x: 586910.92904288764
    y: 4141022.340158578
    theta: 1.3153236705710274
    kappa: -0.01175144067132956
    s: 21.749539845519116
    dkappa: 0.0040027529422281393
1304 1305
    ddkappa: 0
  }
1306 1307
  v: 5.0419165845330607
  a: 0.37185304059908281
1308
  relative_time: 5.1999999999999984
1309 1310 1311
}
trajectory_point {
  path_point {
1312 1313 1314 1315 1316 1317
    x: 586911.05901369231
    y: 4141022.8292248356
    theta: 1.3084687841327476
    kappa: -0.0099554969138267828
    s: 22.255582233619965
    dkappa: 0.0035584007501725137
1318 1319
    ddkappa: 0
  }
1320 1321
  v: 5.0788562806573561
  a: 0.36736544024622819
1322
  relative_time: 5.299999999999998
1323 1324 1325
}
trajectory_point {
  path_point {
1326 1327 1328 1329 1330 1331
    x: 586911.19469349761
    y: 4141023.3205533987
    theta: 1.3034034588351151
    kappa: -0.0084873216623098258
    s: 22.765300554146123
    dkappa: 0.0032078829389098535
1332 1333
    ddkappa: 0
  }
1334 1335
  v: 5.11548079349618
  a: 0.3656114673095936
1336
  relative_time: 5.3999999999999977
1337 1338 1339
}
trajectory_point {
  path_point {
1340 1341 1342 1343 1344 1345
    x: 586911.33160068165
    y: 4141023.815337697
    theta: 1.2984162805822335
    kappa: -0.0070289291451185844
    s: 23.278677577830322
    dkappa: 0.0028600446913506833
1346 1347
    ddkappa: 0
  }
1348 1349
  v: 5.1520821135171317
  a: 0.36696367630869975
1350
  relative_time: 5.4999999999999973
1351 1352 1353
}
trajectory_point {
  path_point {
1354 1355 1356 1357 1358 1359
    x: 586911.47276409622
    y: 4141024.312744108
    theta: 1.2948736613436562
    kappa: -0.0058227994240314124
    s: 23.795727137224652
    dkappa: 0.0025768820057564972
1360 1361
    ddkappa: 0
  }
1362 1363
  v: 5.1889894866397617
  a: 0.37179462176306721
1364
  relative_time: 5.599999999999997
1365 1366 1367
}
trajectory_point {
  path_point {
1368 1369 1370 1371 1372 1373
    x: 586911.61529285647
    y: 4141024.813630227
    theta: 1.2915851117998169
    kappa: -0.0046414764608452312
    s: 24.31649785224576
    dkappa: 0.0022992287079214922
1374 1375
    ddkappa: 0
  }
1376 1377
  v: 5.2265694142355716
  a: 0.38047685819221666
1378
  relative_time: 5.6999999999999966
1379 1380 1381
}
trajectory_point {
  path_point {
1382 1383 1384 1385 1386 1387
    x: 586911.76095816644
    y: 4141025.3175793793
    theta: 1.2899481692442265
    kappa: -0.00365222948233427
    s: 24.841076855720036
    dkappa: 0.0020647817616524307
1388 1389
    ddkappa: 0
  }
1390 1391
  v: 5.2652256531280148
  a: 0.39338294011566877
1392
  relative_time: 5.7999999999999963
1393
}
1394 1395
trajectory_point {
  path_point {
1396 1397 1398 1399 1400 1401
    x: 586911.90808051534
    y: 4141025.8252056483
    theta: 1.288332599260932
    kappa: -0.0027025707437169913
    s: 25.369593518928813
    dkappa: 0.0018387783144959502
1402 1403
    ddkappa: 0
  }
1404 1405
  v: 5.3053992155924989
  a: 0.41088542205294409
1406 1407 1408 1409
  relative_time: 5.8999999999999959
}
trajectory_point {
  path_point {
1410 1411 1412 1413 1414 1415
    x: 586912.05749416293
    y: 4141026.3364491472
    theta: 1.2868105729273438
    kappa: -0.0018937371435929625
    s: 25.902223177153569
    dkappa: 0.0016431830327211681
1416 1417
    ddkappa: 0
  }
1418 1419
  v: 5.3475683693563809
  a: 0.43335685852356337
1420 1421 1422 1423
  relative_time: 5.9999999999999956
}
trajectory_point {
  path_point {
1424 1425 1426 1427 1428 1429
    x: 586912.20838463248
    y: 4141026.8517803289
    theta: 1.2856366809735622
    kappa: -0.001136039749775579
    s: 26.4391908552211
    dkappa: 0.0014608428029744605
1430 1431
    ddkappa: 0
  }
1432 1433
  v: 5.3922486375989731
  a: 0.46116980404704727
1434 1435 1436 1437
  relative_time: 6.0999999999999952
}
trajectory_point {
  path_point {
1438 1439 1440 1441 1442 1443
    x: 586912.36102250253
    y: 4141027.3714100621
    theta: 1.2850771026264285
    kappa: -0.00047180051051321864
    s: 26.980774993048744
    dkappa: 0.0013026504636757261
1444 1445
    ddkappa: 0
  }
1446 1447
  v: 5.4399927989515371
  a: 0.49469681314291625
1448 1449 1450 1451
  relative_time: 6.1999999999999948
}
trajectory_point {
  path_point {
1452 1453 1454 1455 1456 1457
    x: 586912.51510623167
    y: 4141027.8957763426
    theta: 1.2848493920430597
    kappa: 0.00012675685562515385
    s: 27.527311171189563
    dkappa: 0.0011547192673918589
1458 1459
    ddkappa: 0
  }
1460 1461
  v: 5.4913908874972863
  a: 0.53431044033069108
1462 1463 1464 1465
  relative_time: 6.2999999999999945
}
trajectory_point {
  path_point {
1466 1467 1468 1469 1470 1471
    x: 586912.67074410978
    y: 4141028.4252605578
    theta: 1.2849300247554485
    kappa: 0.00066504051801814595
    s: 28.079195836377533
    dkappa: 0.0010161303533839257
1472 1473
    ddkappa: 0
  }
1474 1475
  v: 5.5470701927713888
  a: 0.58038324012989251
1476 1477 1478 1479
  relative_time: 6.3999999999999941
}
trajectory_point {
  path_point {
1480 1481 1482 1483 1484 1485
    x: 586912.82771183713
    y: 4141028.9604090424
    theta: 1.2854426964588965
    kappa: 0.0011274620147837264
    s: 28.636890027072738
    dkappa: 0.00089382682894631536
1486 1487
    ddkappa: 0
  }
1488 1489
  v: 5.6076952597609626
  a: 0.63328776706004108
1490 1491 1492 1493
  relative_time: 6.4999999999999938
}
trajectory_point {
  path_point {
1494 1495 1496 1497 1498 1499
    x: 586912.98633554147
    y: 4141029.5016777618
    theta: 1.2861403140526644
    kappa: 0.0015612721130407496
    s: 29.200923099006591
    dkappa: 0.00077750424190397638
1500 1501
    ddkappa: 0
  }
1502 1503
  v: 5.6739678889050786
  a: 0.6933965756406576
1504 1505 1506 1507
  relative_time: 6.5999999999999934
}
trajectory_point {
  path_point {
1508 1509 1510 1511 1512 1513
    x: 586913.146118331
    y: 4141030.0498383008
    theta: 1.2869231831530215
    kappa: 0.001908471064970386
    s: 29.771896450726988
    dkappa: 0.00067717265937321572
1514 1515
    ddkappa: 0
  }
1516 1517
  v: 5.74662713609476
  a: 0.76108222039126228
1518 1519 1520 1521
  relative_time: 6.6999999999999931
}
trajectory_point {
  path_point {
1522 1523 1524 1525 1526 1527
    x: 586913.30773943721
    y: 4141030.605397189
    theta: 1.2878684582546818
    kappa: 0.0022367276261852274
    s: 30.350487249143541
    dkappa: 0.00057930693202111808
1528 1529
    ddkappa: 0
  }
1530 1531
  v: 5.8264493126729811
  a: 0.83671725583137635
1532 1533 1534 1535
  relative_time: 6.7999999999999927
}
trajectory_point {
  path_point {
1536 1537 1538 1539 1540 1541
    x: 586913.47068569763
    y: 4141031.1692910772
    theta: 1.289466130151621
    kappa: 0.0024978473232294988
    s: 30.937452155072748
    dkappa: 0.00049074804883285947
1542 1543
    ddkappa: 0
  }
1544 1545
  v: 5.9142479854346695
  a: 0.92067423648051971
1546 1547 1548 1549
  relative_time: 6.8999999999999924
}
trajectory_point {
  path_point {
1550 1551 1552 1553 1554 1555
    x: 586913.63547139685
    y: 4141031.7422434008
    theta: 1.2909223291199545
    kappa: 0.0027269597743166244
    s: 31.5336310487832
    dkappa: 0.00040875800788435827
1556 1557
    ddkappa: 0
  }
1558 1559
  v: 6.0108739766267023
  a: 1.0133257168582139
1560 1561 1562 1563
  relative_time: 6.999999999999992
}
trajectory_point {
  path_point {
1564 1565 1566 1567 1568 1569
    x: 586913.80229923374
    y: 4141032.3251602557
    theta: 1.2922269213729036
    kappa: 0.0029217335371685147
    s: 32.139950755540774
    dkappa: 0.00033380178808394283
1570 1571
    ddkappa: 0
  }
1572 1573
  v: 6.1172153639479134
  a: 1.1150442514839791
1574 1575 1576 1577
  relative_time: 7.0999999999999917
}
trajectory_point {
  path_point {
1578 1579 1580 1581 1582 1583
    x: 586913.97069522366
    y: 4141032.919232145
    theta: 1.2942957868549971
    kappa: 0.0030627794426164017
    s: 32.757428771153833
    dkappa: 0.00026392700191738412
1584 1585
    ddkappa: 0
  }
1586 1587
  v: 6.2341974805490841
  a: 1.2262023948773357
1588 1589 1590 1591
  relative_time: 7.1999999999999913
}
trajectory_point {
  path_point {
1592 1593 1594 1595 1596 1597
    x: 586914.14170620078
    y: 4141033.5253158025
    theta: 1.2964042652695689
    kappa: 0.0031820507633338294
    s: 33.387176987518409
    dkappa: 0.00019707564427504163
1598 1599
    ddkappa: 0
  }
1600 1601
  v: 6.3627829150329509
  a: 1.3471727015578048
1602 1603 1604 1605
  relative_time: 7.2999999999999909
}
trajectory_point {
  path_point {
1606 1607 1608 1609 1610 1611
    x: 586914.31491906918
    y: 4141034.1447834093
    theta: 1.2980477256286456
    kappa: 0.0032595110383837585
    s: 34.030405418163383
    dkappa: 0.00013936852931027244
1612 1613
    ddkappa: 0
  }
1614 1615
  v: 6.5039715114541989
  a: 1.4783277260449068
1616 1617 1618 1619
  relative_time: 7.3999999999999906
}
trajectory_point {
  path_point {
1620 1621 1622 1623 1624 1625
    x: 586914.49066111632
    y: 4141034.7789006247
    theta: 1.3003587676235728
    kappa: 0.0033024814040539729
    s: 34.688425923795748
    dkappa: 8.4152956763357942e-05
1626 1627
    ddkappa: 0
  }
1628 1629
  v: 6.6588003693194686
  a: 1.6200400228581626
1630 1631 1632 1633
  relative_time: 7.49999999999999
}
trajectory_point {
  path_point {
1634 1635 1636 1637 1638 1639
    x: 586914.66965187865
    y: 4141035.4289373336
    theta: 1.3028752736696507
    kappa: 0.0033210995361844177
    s: 35.362655937845751
    dkappa: 3.1406194330523391e-05
1640 1641
    ddkappa: 0
  }
1642 1643
  v: 6.8283438435873531
  a: 1.7726821465170925
1644 1645 1646 1647
  relative_time: 7.59999999999999
}
trajectory_point {
  path_point {
1648 1649 1650 1651 1652 1653
    x: 586914.85158652777
    y: 4141036.0965577951
    theta: 1.3047247420631702
    kappa: 0.0033034111960134312
    s: 36.054622192012047
    dkappa: -1.3445230868145189e-05
1654 1655
    ddkappa: 0
  }
1656 1657
  v: 7.013713544668394
  a: 1.9366266515412174
1658 1659
  relative_time: 7.6999999999999895
}
1660 1661
trajectory_point {
  path_point {
1662 1663 1664 1665 1666 1667
    x: 586915.0369035661
    y: 4141036.7833359758
    theta: 1.3073052293231262
    kappa: 0.0032551118097178429
    s: 36.765964441807
    dkappa: -5.5678195974811159e-05
1668 1669
    ddkappa: 0
  }
1670 1671
  v: 7.2160583384250856
  a: 2.1122460924500581
1672 1673 1674 1675
  relative_time: 7.7999999999999892
}
trajectory_point {
  path_point {
1676 1677 1678 1679 1680 1681
    x: 586915.22631924087
    y: 4141037.490894991
    theta: 1.3098539831280389
    kappa: 0.0031827814533936013
    s: 37.498439192101785
    dkappa: -9.4532699908793556e-05
1682 1683
    ddkappa: 0
  }
1684 1685
  v: 7.4365643461718784
  a: 2.2999130237631347
1686 1687
  relative_time: 7.8999999999999888
}
1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701
trajectory_point {
  path_point {
    x: 586915.4201612469
    y: 4141038.2210878488
    theta: 1.3118135338582704
    kappa: 0.0030856761038141941
    s: 38.25392342267164
    dkappa: -0.00012838399400782433
    ddkappa: 0
  }
  v: 7.67645494467517
  a: 2.499999999999968
  relative_time: 7.9999999999999885
}
1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
decision {
  main_decision {
    cruise {
      change_lane_type: FORWARD
    }
  }
  object_decision {
  }
  vehicle_signal {
    turn_signal: TURN_RIGHT
  }
}
routing_header {
  timestamp_sec: 1509683595.9515159
  module_name: "routing"
  sequence_num: 2
}
1719
right_of_way_status: UNPROTECTED
1720 1721 1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734
lane_id {
  id: "12_1_-3"
}
lane_id {
  id: "133_1_-3"
}
lane_id {
  id: "88_1_-1"
}
lane_id {
  id: "21_1_-1"
}
lane_id {
  id: "22_1_-1"
}
D
Dong Li 已提交
1735 1736 1737
engage_advice {
  advice: KEEP_ENGAGED
}