提交 1c98f940 编写于 作者: Z Zhang Liangliang 提交者: Dong Li

Planning: added a yeild test case in huanbaoyuan_bzone.

上级 c47e0700
......@@ -53,5 +53,19 @@ TEST_F(HuangbaoyuanBzoneTest, follow_01) {
RUN_GOLDEN_TEST;
}
/*
* test yield a vehicle with short distance
* A follow test case
*/
TEST_F(HuangbaoyuanBzoneTest, yield_01) {
std::string seq_num = "2";
FLAGS_test_routing_response_file = seq_num + "_routing.pb.txt";
FLAGS_test_prediction_file = seq_num + "_prediction.pb.txt";
FLAGS_test_localization_file = seq_num + "_localization.pb.txt";
FLAGS_test_chassis_file = seq_num + "_chassis.pb.txt";
PlanningTestBase::SetUp();
RUN_GOLDEN_TEST;
}
} // namespace planning
} // namespace apollo
engine_started: true
engine_rpm: 1754.25
speed_mps: 7.897222
odometer_m: 0
fuel_range_m: 0
throttle_percentage: 15.666438
brake_percentage: 16.562141
steering_percentage: -0.063829787
steering_torque_nm: -0.125
parking_brake: false
driving_mode: COMPLETE_AUTO_DRIVE
error_code: NO_ERROR
gear_location: GEAR_DRIVE
header {
timestamp_sec: 1505101393.3468192
module_name: "chassis"
sequence_num: 282201
}
signal {
turn_signal: TURN_NONE
horn: false
}
header {
timestamp_sec: 1505101393.3447967
module_name: "localization"
sequence_num: 339279
}
pose {
position {
x: 431290.62080435769
y: 4434163.4986545779
z: 37.649068114347756
}
orientation {
qx: 0.013311572863710507
qy: -0.015911126320045706
qz: -0.98399622400351683
qw: 0.17697759528805437
}
linear_velocity {
x: 2.5814399587564454
y: -7.628428665599718
z: 0.037299487377163931
}
linear_acceleration {
x: -0.18383662202527579
y: -0.50694497810611439
z: -0.017856213299102652
}
angular_velocity {
x: -0.0073818565566837252
y: -0.020557571246561164
z: 0.0074780197974178928
}
heading: -1.2152603056341071
linear_acceleration_vrf {
x: 0.34940166934072847
y: 0.41033822782005736
z: -0.025474909802842449
}
angular_velocity_vrf {
x: 0.013931754337978606
y: 0.0169608813469603
z: 0.0071596820370750493
}
euler_angles {
x: 0.02058005938950478
y: -0.036032473302519442
z: -1.2152603056341069
}
}
header {
timestamp_sec: 1505101393.3019331
module_name: "prediction"
sequence_num: 28068
}
prediction_obstacle {
perception_obstacle {
id: 4158
position {
x: 431296.87429503544
y: 4434154.3371385094
z: 36.9573671016528
}
theta: -1.3921904617986804
velocity {
x: 2.3102715015411377
y: -12.797189712524414
z: 0
}
length: 3.3672661781311035
width: 2.0058133602142334
height: 1.5423381328582764
polygon_point {
x: 431296.33161370753
y: 4434155.949719443
z: 36.924911757003478
}
polygon_point {
x: 431296.89339112473
y: 4434156.0083878208
z: 36.938396735268952
}
polygon_point {
x: 431297.25667218777
y: 4434155.97731573
z: 36.94726413645752
}
polygon_point {
x: 431297.61403230415
y: 4434155.88530886
z: 36.956118026279711
}
polygon_point {
x: 431297.77263301687
y: 4434154.6420603916
z: 36.962611459158339
}
polygon_point {
x: 431296.8649937968
y: 4434152.8384185694
z: 36.944468245431928
}
polygon_point {
x: 431296.75801689969
y: 4434152.7424579421
z: 36.942081157241013
}
polygon_point {
x: 431296.72408223752
y: 4434152.7208246123
z: 36.941305158172746
}
polygon_point {
x: 431296.4043362916
y: 4434152.5387077313
z: 36.93394706810647
}
polygon_point {
x: 431296.30206146132
y: 4434152.5320757786
z: 36.931483415949209
}
polygon_point {
x: 431296.05896869168
y: 4434153.2152535506
z: 36.924137276600639
}
polygon_point {
x: 431295.74234338262
y: 4434155.6332200859
z: 36.911310499179784
}
polygon_point {
x: 431296.1361018655
y: 4434155.8770893607
z: 36.920329999808914
}
tracking_time: 57.699061155319214
type: UNKNOWN
timestamp: 0
}
timestamp: 1505101393.3015127
predicted_period: 3
trajectory {
probability: 1
trajectory_point {
path_point {
x: 431296.87429503544
y: 4434154.3371385094
z: 0
theta: -1.395290767519392
}
v: 13.004053942873885
a: 0.85043566191641462
relative_time: 0
}
trajectory_point {
path_point {
x: 431297.10111647064
y: 4434153.058046421
z: 0
theta: -1.4015107181298847
}
v: 12.977022157450948
a: 0.85043566191641462
relative_time: 0.1
}
trajectory_point {
path_point {
x: 431297.31952647591
y: 4434151.7802080987
z: 0
theta: -1.4077561782177936
}
v: 12.950492423729418
a: 0.85043566191641462
relative_time: 0.2
}
trajectory_point {
path_point {
x: 431297.5295250513
y: 4434150.5036235414
z: 0
theta: -1.414026814844852
}
v: 12.924467833356795
a: 0.85043566191641462
relative_time: 0.30000000000000004
}
trajectory_point {
path_point {
x: 431297.73111219675
y: 4434149.22829275
z: 0
theta: -1.4203222844643495
}
v: 12.898951443825853
a: 0.85043566191641462
relative_time: 0.4
}
trajectory_point {
path_point {
x: 431297.92428791232
y: 4434147.954215724
z: 0
theta: -1.4266422329304784
}
v: 12.873946276926157
a: 0.85043566191641462
relative_time: 0.5
}
trajectory_point {
path_point {
x: 431298.109052198
y: 4434146.6813924639
z: 0
theta: -1.4329862955171528
}
v: 12.849455317190912
a: 0.85043566191641462
relative_time: 0.60000000000000009
}
trajectory_point {
path_point {
x: 431298.28540505376
y: 4434145.40982297
z: 0
theta: -1.4393540969464997
}
v: 12.82548151034073
a: 0.85043566191641462
relative_time: 0.70000000000000007
}
trajectory_point {
path_point {
x: 431298.45334647957
y: 4434144.1395072415
z: 0
theta: -1.4457452514272087
}
v: 12.802027761725844
a: 0.85043566191641462
relative_time: 0.8
}
trajectory_point {
path_point {
x: 431298.6128764755
y: 4434142.8704452785
z: 0
theta: -1.452159362702919
}
v: 12.779096934768425
a: 0.85043566191641462
relative_time: 0.9
}
trajectory_point {
path_point {
x: 431298.76399504155
y: 4434141.6026370814
z: 0
theta: -1.4585960241107991
}
v: 12.756691849406627
a: 0.85043566191641462
relative_time: 1
}
trajectory_point {
path_point {
x: 431298.90670217766
y: 4434140.3360826494
z: 0
theta: -1.4650548186504697
}
v: 12.73481528054209
a: 0.85043566191641462
relative_time: 1.1
}
trajectory_point {
path_point {
x: 431299.04099788383
y: 4434139.0707819834
z: 0
theta: -1.4715353190633953
}
v: 12.713469956492617
a: 0.85043566191641462
relative_time: 1.2000000000000002
}
trajectory_point {
path_point {
x: 431299.16688216012
y: 4434137.8067350835
z: 0
theta: -1.4780370879228606
}
v: 12.69265855745177
a: 0.85043566191641462
relative_time: 1.3
}
trajectory_point {
path_point {
x: 431299.28435500647
y: 4434136.5439419486
z: 0
theta: -1.4845596777346275
}
v: 12.672383713957215
a: 0.85043566191641462
relative_time: 1.4000000000000001
}
trajectory_point {
path_point {
x: 431299.39341642294
y: 4434135.28240258
z: 0
theta: -1.4911026310483504
}
v: 12.652648005369613
a: 0.85043566191641462
relative_time: 1.5
}
trajectory_point {
path_point {
x: 431299.49406640953
y: 4434134.0221169768
z: 0
theta: -1.4976654805798071
}
v: 12.6334539583639
a: 0.85043566191641462
relative_time: 1.6
}
trajectory_point {
path_point {
x: 431299.58630496619
y: 4434132.763085139
z: 0
theta: -1.5042477493439925
}
v: 12.614804045434809
a: 0.85043566191641462
relative_time: 1.7000000000000002
}
trajectory_point {
path_point {
x: 431299.67013209296
y: 4434131.5053070672
z: 0
theta: -1.5108489507990832
}
v: 12.596700683418559
a: 0.85043566191641462
relative_time: 1.8
}
trajectory_point {
path_point {
x: 431299.74554778979
y: 4434130.2487827614
z: 0
theta: -1.517468589001286
}
v: 12.579146232032521
a: 0.85043566191641462
relative_time: 1.9000000000000001
}
trajectory_point {
path_point {
x: 431299.81255205668
y: 4434128.9935122207
z: 0
theta: -1.5241061587705427
}
v: 12.562142992434831
a: 0.85043566191641462
relative_time: 2
}
trajectory_point {
path_point {
x: 431299.8711448937
y: 4434127.739495446
z: 0
theta: -1.5307611458670434
}
v: 12.545693205805817
a: 0.85043566191641462
relative_time: 2.1
}
trajectory_point {
path_point {
x: 431299.92132630083
y: 4434126.4867324373
z: 0
theta: -1.5374330271784975
}
v: 12.529799051953153
a: 0.85043566191641462
relative_time: 2.2
}
trajectory_point {
path_point {
x: 431299.963096278
y: 4434125.2352231937
z: 0
theta: -1.5441212709180629
}
v: 12.514462647942628
a: 0.85043566191641462
relative_time: 2.3000000000000003
}
trajectory_point {
path_point {
x: 431299.99645482533
y: 4434123.984967716
z: 0
theta: -1.550825336832832
}
v: 12.499686046756434
a: 0.85043566191641462
relative_time: 2.4000000000000004
}
trajectory_point {
path_point {
x: 431300.02140194271
y: 4434122.7359660044
z: 0
theta: -1.5575446764227407
}
v: 12.485471235980841
a: 0.85043566191641462
relative_time: 2.5
}
trajectory_point {
path_point {
x: 431300.03793763014
y: 4434121.4882180579
z: 0
theta: -1.5642787331697479
}
v: 12.471820136525123
a: 0.85043566191641462
relative_time: 2.6
}
trajectory_point {
path_point {
x: 431300.0460618877
y: 4434120.2417238774
z: 0
theta: -1.5710269427771091
}
v: 12.458734601373584
a: 0.85043566191641462
relative_time: 2.7
}
trajectory_point {
path_point {
x: 431300.04577471537
y: 4434118.9964834619
z: 0
theta: -1.577788733418541
}
v: 12.446216414372458
a: 0.85043566191641462
relative_time: 2.8000000000000003
}
trajectory_point {
path_point {
x: 431300.03707611311
y: 4434117.7524968134
z: 0
theta: -1.577788733418541
}
v: 12.434267289053528
a: 0.85043566191641462
relative_time: 2.9000000000000004
}
}
}
perception_error_code: OK
header {
timestamp_sec: 1505101372.3203726
module_name: "routing"
sequence_num: 29
}
route {
road_info {
id: "131-72-64"
in_lane {
id: "64_1_-1"
s: 63.683761497934711
}
out_lane {
id: "72_1_-1"
s: 42.389566612060662
}
passage_region {
segment {
id: "64_1_-1"
start_s: 63.683761497934711
end_s: 144.45
}
segment {
id: "131_1_-1"
start_s: 0
end_s: 36.9394
}
segment {
id: "72_1_-1"
start_s: 0
end_s: 42.389566612060662
}
}
}
}
measurement {
distance: 160.09520511412595
}
routing_request {
header {
timestamp_sec: 1505101372.320029
module_name: "dreamview"
sequence_num: 35
}
start {
id: "64_1_-1"
s: 63.683761497934711
pose {
x: 431259.224200729
y: 4434253.73378437
}
}
end {
id: "72_1_-1"
s: 42.389566612060662
pose {
x: 431311.80160710122
y: 4434102.6230789386
}
}
}
map_version: "1.400000"
error_code {
error_id: SUCCESS
error_string: "Success!"
}
......@@ -14,2247 +14,2247 @@ trajectory_point {
ddkappa: 0
}
v: 2.1388888359069824
a: -0.47672964337296797
a: -0.476729643372968
relative_time: 0
}
trajectory_point {
path_point {
x: 431261.70905962924
y: 4434248.4256328885
theta: -1.10752193779367
kappa: -0.00059663641077774233
s: 0.10634360914577207
x: 431261.70905852632
y: 4434248.4256351013
theta: -1.1075219305531434
kappa: -0.0005966225451644174
s: 0.1063411377589486
dkappa: 0
ddkappa: 0
}
v: 2.1147583810902097
a: -0.48838750341579645
v: 2.114611993486462
a: -0.49409214172856253
relative_time: 0.05
}
trajectory_point {
path_point {
x: 431261.7559743718
y: 4434248.3315594979
theta: -1.1078299205050792
kappa: -0.0011864233355915212
s: 0.21146637584035732
x: 431261.7559658832
y: 4434248.3315765187
theta: -1.1078298647793594
kappa: -0.0011863166208633865
s: 0.21144735516187732
dkappa: 0
ddkappa: 0
}
v: 2.0900601901536167
a: -0.49943908816578242
v: 2.0895044215982468
a: -0.50996664823690963
relative_time: 0.1
}
trajectory_point {
path_point {
x: 431261.80233194
y: 4434248.2386033516
theta: -1.108134245672973
kappa: -0.0017692057632960594
s: 0.3153406711218808
x: 431261.80230439745
y: 4434248.23865858
theta: -1.1081340648638538
kappa: -0.0017688595140597301
s: 0.31527895615982005
dkappa: 0
ddkappa: 0
}
v: 2.0648245768618456
a: -0.5098843976229257
v: 2.0636393459112745
a: -0.52440011983502921
relative_time: 0.15000000000000002
}
trajectory_point {
path_point {
x: 431261.84812067979
y: 4434248.1467878195
theta: -1.1084348367311043
kappa: -0.0023448371864520749
s: 0.41794038171669962
x: 431261.84805796127
y: 4434248.1469135825
theta: -1.1084344250009373
kappa: -0.0023440487238828413
s: 0.41779984729108632
dkappa: 0
ddkappa: 0
}
v: 2.0390818549795382
a: -0.51972343178722646
v: 2.0370876442476309
a: -0.53743951345994134
relative_time: 0.2
}
trajectory_point {
path_point {
x: 431261.89332961361
y: 4434248.0561349131
theta: -1.1087316215578515
kappa: -0.002913179601326281
s: 0.519240910039403
x: 431261.893212022
y: 4434248.0563707082
theta: -1.1087308495997763
kappa: -0.0029117013030038096
s: 0.51897742028891858
dkappa: 0
ddkappa: 0
}
v: 2.0128623382713369
a: -0.52895619065868471
v: 2.0099178465825505
a: -0.54913178604866608
relative_time: 0.25
}
trajectory_point {
path_point {
x: 431261.93794844043
y: 4434247.9666652894
theta: -1.1090245324762278
kappa: -0.0034741035078913875
s: 0.61921917419281247
x: 431261.93775353
y: 4434247.9670561235
theta: -1.1090232529405137
kappa: -0.003471653199010551
s: 0.61878243468914984
dkappa: 0
ddkappa: 0
}
v: 1.9861963405018839
a: -0.53758267423730033
v: 1.9821961350444171
a: -0.55952389453822327
relative_time: 0.3
}
trajectory_point {
path_point {
x: 431261.98196753557
y: 4434247.8783982471
theta: -1.1093135062538706
kappa: -0.004027487909826097
s: 0.71785360796798114
x: 431261.98167088639
y: 4434247.8789930874
theta: -1.109311558830353
kappa: -0.0040237585957829348
s: 0.71718890043786088
dkappa: 0
ddkappa: 0
}
v: 1.959114175435821
a: -0.54560288252307332
v: 1.9539863439147638
a: -0.56866279586563317
relative_time: 0.35
}
trajectory_point {
path_point {
x: 431262.02537795069
y: 4434247.7913517291
theta: -1.1095984841030129
kappa: -0.0045732203145151121
s: 0.81512416084419514
x: 431262.0249538903
y: 4434247.7922020545
theta: -1.1095957002596077
kappa: -0.0045678892548679162
s: 0.81417396049903823
dkappa: 0
ddkappa: 0
}
v: 1.9316461568377905
a: -0.55301681551600379
v: 1.9253499596282726
a: -0.57659544696791554
relative_time: 0.39999999999999997
}
trajectory_point {
path_point {
x: 431262.06817141414
y: 4434247.7055423222
theta: -1.109879411680436
kappa: -0.0051111967330491241
s: 0.91101229798897143
x: 431262.06759368686
y: 4434247.70670078
theta: -1.1098756190577206
kappa: -0.005103933856854659
s: 0.90971777346223071
dkappa: 0
ddkappa: 0
}
v: 1.9038225984724346
a: -0.55982447321609163
v: 1.8963461207727741
a: -0.58336880478209063
relative_time: 0.44999999999999996
}
trajectory_point {
path_point {
x: 431262.110301941
y: 4434247.6209662436
theta: -1.1101939271518662
kappa: -0.0056297519358119693
s: 1.0055010002580602
x: 431262.10955269809
y: 4434247.6224895595
theta: -1.1101807337087917
kappa: -0.0056227510012011933
s: 1.0038033961502077
dkappa: 0
ddkappa: 0
}
v: 1.8756738141043954
a: -0.56602585562333685
v: 1.8670316180892483
a: -0.5890298262451783
relative_time: 0.49999999999999994
}
trajectory_point {
path_point {
x: 431262.151380336
y: 4434247.5374480356
theta: -1.1109172799282
kappa: -0.0060135889754906113
s: 1.0985747641954435
x: 431262.15042785282
y: 4434247.539384569
theta: -1.1109005075341771
kappa: -0.0060046889600550235
s: 1.0964166662266166
dkappa: 0
ddkappa: 0
}
v: 1.847230117498315
a: -0.57162096273773955
v: 1.837460894471824
a: -0.59362546829419849
relative_time: 0.54999999999999993
}
trajectory_point {
path_point {
x: 431262.19182807021
y: 4434247.455212051
theta: -1.1116295305116377
kappa: -0.006391533111081725
s: 1.1902196020333353
x: 431262.190648105
y: 4434247.4576110877
theta: -1.1116087522800526
kappa: -0.0063805075019781029
s: 1.1875460848036392
dkappa: 0
ddkappa: 0
}
v: 1.8185218224188355
a: -0.57660979455929973
v: 1.8076860449677792
a: -0.59720268786617148
relative_time: 0.6
}
trajectory_point {
path_point {
x: 431262.23163963872
y: 4434247.3742694817
theta: -1.1123305811176794
kappa: -0.00676353290761704
s: 1.2804230416921814
x: 431262.23020950344
y: 4434247.37717715
theta: -1.1123053975200956
kappa: -0.0067501697054122792
s: 1.2771826990496506
dkappa: 0
ddkappa: 0
}
v: 1.789579242630599
a: -0.58099235108801728
v: 1.7777568167775406
a: -0.599808441898117
relative_time: 0.65
}
trajectory_point {
path_point {
x: 431262.27081020607
y: 4434247.2946301587
theta: -1.1130203458092105
kappa: -0.0071295431808401939
s: 1.36917412678066
x: 431262.26910916856
y: 4434247.29808861
theta: -1.1129903917730153
kappa: -0.0071136486646309633
s: 1.3653199847968758
dkappa: 0
ddkappa: 0
}
v: 1.7604326918982478
a: -0.5847686323238922
v: 1.7477206092546842
a: -0.6014896873270551
relative_time: 0.70000000000000007
}
trajectory_point {
path_point {
x: 431262.30933560553
y: 4434247.2163025541
theta: -1.1136987504948945
kappa: -0.0074895249972067261
s: 1.4564634165956818
x: 431262.30734524096
y: 4434247.2203492476
theta: -1.1136637015881619
kappa: -0.0074709270056120512
s: 1.451953729149047
dkappa: 0
ddkappa: 0
}
v: 1.7311124839864238
a: -0.58793863826692461
v: 1.7176224739059349
a: -0.602293381090006
relative_time: 0.75000000000000011
}
trajectory_point {
path_point {
x: 431262.3472123394
y: 4434247.1392937787
theta: -1.1143657329273553
kappa: -0.007843445673884078
s: 1.5422829861223888
x: 431262.34491682961
y: 4434247.1439608755
theta: -1.1143253106308575
kappa: -0.007821996401910853
s: 1.5370819130890621
dkappa: 0
ddkappa: 0
}
v: 1.7016489326597695
a: -0.59050236891711438
v: 1.6875051143911663
a: -0.60226648012398953
relative_time: 0.80000000000000016
}
trajectory_point {
path_point {
x: 431262.38443757885
y: 4434247.0636095833
theta: -1.1150212427011714
kappa: -0.00819127877875159
s: 1.6266264260341556
x: 431262.38182395988
y: 4434247.0689234417
theta: -1.1149752187675055
kappa: -0.0081668570905330078
s: 1.62070459408664
dkappa: 0
ddkappa: 0
}
v: 1.6720723516829263
a: -0.59245982427446164
v: 1.6574088865234016
a: -0.60145594136602576
relative_time: 0.8500000000000002
}
trajectory_point {
path_point {
x: 431262.421009164
y: 4434246.9892543592
theta: -1.1156652412507022
kappa: -0.0085330041304005153
s: 1.7094888426925892
x: 431262.41806752171
y: 4434246.9952351358
theta: -1.1156134411505154
kappa: -0.0085055173878074136
s: 1.7028237887059809
dkappa: 0
ddkappa: 0
}
v: 1.6424130548205371
a: -0.59381100433896628
v: 1.6273717982688125
a: -0.5999087217531347
relative_time: 0.90000000000000024
}
trajectory_point {
path_point {
x: 431262.45692560414
y: 4434246.9162311386
theta: -1.1162977018477636
kappa: -0.0088686077981340022
s: 1.790866858147528
x: 431262.45364921808
y: 4434246.9228924969
theta: -1.1162400073030909
kappa: -0.008837993205259154
s: 1.7834433552134223
dkappa: 0
ddkappa: 0
}
v: 1.6127013558372438
a: -0.59455590911062828
v: 1.59742950974672
a: -0.5976717782223363
relative_time: 0.95000000000000029
}
trajectory_point {
path_point {
x: 431262.49218607729
y: 4434246.8445415925
theta: -1.1169186095991759
kappa: -0.0091980821019671029
s: 1.8707586101370426
x: 431262.48857151275
y: 4434246.8518905155
theta: -1.1168549602039188
kappa: -0.0091643075654824057
s: 1.8625688761850951
dkappa: 0
ddkappa: 0
}
v: 1.5829675684976885
a: -0.59469453858944776
v: 1.5676153332295937
a: -0.59479206771065063
relative_time: 1.0000000000000002
}
trajectory_point {
path_point {
x: 431262.52679043048
y: 4434246.774186031
theta: -1.1175279614442011
kappa: -0.009521425612626774
s: 1.9491637520874365
x: 431262.5228375789
y: 4434246.7822227394
theta: -1.1174583553717938
kappa: -0.0094844901180133837
s: 1.940207541114584
dkappa: 0
ddkappa: 0
}
v: 1.5532420065665131
a: -0.59422689277542462
v: 1.5379602331430526
a: -0.59131654715509763
relative_time: 1.0500000000000003
}
trajectory_point {
path_point {
x: 431262.56047730363
y: 4434246.70503615
theta: -1.1182310394118609
kappa: -0.0097990414703512021
s: 2.0260834531132441
x: 431262.55627274833
y: 4434246.7137946431
theta: -1.1181220156388705
kappa: -0.0097715835394354446
s: 2.0163680290205828
dkappa: 0
ddkappa: 0
}
v: 1.52355498380836
a: -0.593152971668559
v: 1.5084928260658645
a: -0.58729217349269747
relative_time: 1.1000000000000003
}
trajectory_point {
path_point {
x: 431262.59312423773
y: 4434246.6370294569
theta: -1.1190775757704183
kappa: -0.010012242911885209
s: 2.1015203980172337
x: 431262.58859744843
y: 4434246.646459193
theta: -1.1189601955297126
kappa: -0.009982680625584538
s: 2.0910603910545511
dkappa: 0
ddkappa: 0
}
v: 1.493936813987871
a: -0.59147277526885067
v: 1.4792393807299464
a: -0.58276590366047
relative_time: 1.1500000000000004
}
trajectory_point {
path_point {
x: 431262.62513129553
y: 4434246.5703556864
theta: -1.1199075262550175
kappa: -0.010221265629157778
s: 2.1754787872904036
x: 431262.62029167876
y: 4434246.5804370726
theta: -1.1197820335174578
kappa: -0.010189660417214115
s: 2.1642959331083755
dkappa: 0
ddkappa: 0
}
v: 1.4644178108696888
a: -0.58918630357629986
v: 1.4502238180203644
a: -0.57778469459543536
relative_time: 1.2000000000000004
}
trajectory_point {
path_point {
x: 431262.65650095092
y: 4434246.5050096866
theta: -1.1207209535382805
kappa: -0.010426125777351941
s: 2.2479643371119851
x: 431262.65136082459
y: 4434246.5157170631
theta: -1.1205876677968398
kappa: -0.010392558081664288
s: 2.2360870984220229
dkappa: 0
ddkappa: 0
}
v: 1.4350282882184551
a: -0.58629355659090643
v: 1.4214677109753326
a: -0.57239550323461341
relative_time: 1.2500000000000004
}
trajectory_point {
path_point {
x: 431262.68723633362
y: 4434246.4409849383
theta: -1.1215179374431525
kappa: -0.010626843795319911
s: 2.3189842793494422
x: 431262.68181071227
y: 4434246.4522870276
theta: -1.1213772481465321
kappa: -0.010591411668895006
s: 2.3064473501912004
dkappa: 0
ddkappa: 0
}
v: 1.4057985597988121
a: -0.58279453431267036
v: 1.3929902847862157
a: -0.56664528651502422
relative_time: 1.3000000000000005
}
trajectory_point {
path_point {
x: 431262.71734122932
y: 4434246.3782735551
theta: -1.1222985749355707
kappa: -0.010823444405583081
s: 2.3885473615584703
x: 431262.71164755884
y: 4434246.3901340161
theta: -1.1221509346036769
kappa: -0.010786261779709407
s: 2.3753910541750112
dkappa: 0
ddkappa: 0
}
v: 1.3767589393754021
a: -0.57868923674159178
v: 1.3648084167975263
a: -0.56058100137368794
relative_time: 1.3500000000000005
}
trajectory_point {
path_point {
x: 431262.74682007963
y: 4434246.3168662833
theta: -1.1230629801170502
kappa: -0.011015956614332023
s: 2.4566638469829969
x: 431262.74087792134
y: 4434246.3292443687
theta: -1.1229088961385332
kappa: -0.010977151233977182
s: 2.4429333613036142
dkappa: 0
ddkappa: 0
}
v: 1.347939740712867
a: -0.57397766387767069
v: 1.3369366365069255
a: -0.55424960474762441
relative_time: 1.4000000000000006
}
trajectory_point {
path_point {
x: 431262.77567798214
y: 4434246.2567525059
theta: -1.1238112842172303
kappa: -0.011204413711426494
s: 2.5233455145551824
x: 431262.76950864564
y: 4434246.2696038252
theta: -1.1236513093292932
kappa: -0.01116412473885791
s: 2.5090900902858784
dkappa: 0
ddkappa: 0
}
v: 1.319371277575849
a: -0.56865981572090685
v: 1.3093871255652254
a: -0.54769805357385359
relative_time: 1.4500000000000006
}
trajectory_point {
path_point {
x: 431262.80392069044
y: 4434246.1979202367
theta: -1.1245436355864182
kappa: -0.011388853270395426
s: 2.588605658895418
x: 431262.79754681571
y: 4434246.21119763
theta: -1.1243783570371113
kappa: -0.011347228557024427
s: 2.5738776102170435
dkappa: 0
ddkappa: 0
}
v: 1.2910838637289903
a: -0.56273569227130049
v: 1.2821697177763851
a: -0.54097330478939565
relative_time: 1.5000000000000007
}
trajectory_point {
path_point {
x: 431262.83155461395
y: 4434246.1403561253
theta: -1.1252601996881662
kappa: -0.011569317148436942
s: 2.6524590903123282
x: 431262.82499970309
y: 4434246.154010633
theta: -1.1250902270813832
kappa: -0.011526510174886168
s: 2.6373127231863758
dkappa: 0
ddkappa: 0
}
v: 1.2631078129369331
a: -0.55620529352885162
v: 1.2552918990975135
a: -0.53412231533127064
relative_time: 1.5500000000000007
}
trajectory_point {
path_point {
x: 431262.85858681804
y: 4434246.084045453
theta: -1.125961159091913
kappa: -0.011745851486418338
s: 2.714922134802769
x: 431262.85187471577
y: 4434246.0980274044
theta: -1.1257871109153053
kappa: -0.011702017970812521
s: 2.6994125468848247
dkappa: 0
ddkappa: 0
}
v: 1.2354734389643194
a: -0.54906861949356012
v: 1.2287588076388687
a: -0.5271920421364984
relative_time: 1.6000000000000008
}
trajectory_point {
path_point {
x: 431262.88502502418
y: 4434246.0289721349
theta: -1.1266467134657234
kappa: -0.01191850670887609
s: 2.7760126340518281
x: 431262.87817934749
y: 4434246.0432323348
theta: -1.126469202301746
kappa: -0.011873800883356189
s: 2.7601943972126826
dkappa: 0
ddkappa: 0
}
v: 1.208211055575791
a: -0.541325670165426
v: 1.2025732336638575
a: -0.5202294421420991
relative_time: 1.6500000000000008
}
trajectory_point {
path_point {
x: 431262.91087760968
y: 4434245.97511872
theta: -1.1273170795691485
kappa: -0.012087337524015864
s: 2.8357499454328265
x: 431262.9039211272
y: 4434245.98960974
theta: -1.1271366959894418
kappa: -0.01204190807947653
s: 2.81967567088724
dkappa: 0
ddkappa: 0
}
v: 1.1813509765359906
a: -0.53297644554444934
v: 1.1767356195890355
a: -0.51328147228509258
relative_time: 1.7000000000000008
}
trajectory_point {
path_point {
x: 431262.93615360768
y: 4434245.9224663936
theta: -1.1279724912462354
kappa: -0.012252402923712498
s: 2.8941549420073169
x: 431262.92910756788
y: 4434245.93714397
theta: -1.1277897863895412
kappa: -0.012206388622762921
s: 2.8778737280504441
dkappa: 0
ddkappa: 0
}
v: 1.15492351560956
a: -0.52402094563063006
v: 1.1512440599841081
a: -0.5063950895024989
relative_time: 1.7500000000000009
}
trajectory_point {
path_point {
x: 431262.96086270752
y: 4434245.8709949693
theta: -1.1286131994187054
kappa: -0.012413766183510016
s: 2.9512500125250831
x: 431262.95374611573
y: 4434245.8858195124
theta: -1.1284286662525047
kappa: -0.0123672911416581
s: 2.9348057748765561
dkappa: 0
ddkappa: 0
}
v: 1.1289589865611416
a: -0.51445917042396827
v: 1.1260943015719285
a: -0.49961725073133817
relative_time: 1.8000000000000009
}
trajectory_point {
path_point {
x: 431262.98486121983
y: 4434245.8206101311
theta: -1.1292702700099604
kappa: -0.012556265431159759
s: 3.0070590614241421
x: 431262.97784409969
y: 4434245.8356211009
theta: -1.1290535253453693
kappa: -0.012524663497681523
s: 2.9904887461798086
dkappa: 0
ddkappa: 0
}
v: 1.1034877031553771
a: -0.50429111992446385
v: 1.1012797432284998
a: -0.49299491290863023
relative_time: 1.850000000000001
}
trajectory_point {
path_point {
x: 431263.00785390474
y: 4434245.7711442895
theta: -1.1300052255443784
kappa: -0.012649694361949643
s: 3.0616075088307424
x: 431263.00082805031
y: 4434245.7862595227
theta: -1.1297806451303309
kappa: -0.01262114536623562
s: 3.0449391880220635
dkappa: 0
ddkappa: 0
}
v: 1.078539979156909
a: -0.49351679413211691
v: 1.076791435982974
a: -0.48657503297139537
relative_time: 1.900000000000001
}
trajectory_point {
path_point {
x: 431263.03032658785
y: 4434245.7227971638
theta: -1.1307235654143772
kappa: -0.012741010307481
s: 3.1149222905593654
x: 431263.02326666319
y: 4434245.7379856957
theta: -1.130497894146212
kappa: -0.012712322869563751
s: 3.0981731403204691
dkappa: 0
ddkappa: 0
}
v: 1.0541461283303795
a: -0.48213619304692729
v: 1.0526180830176519
a: -0.48040456785665347
relative_time: 1.9500000000000011
}
trajectory_point {
path_point {
x: 431263.05229126191
y: 4434245.6755429562
theta: -1.1314256718351712
kappa: -0.012830261998627105
s: 3.1670318581127237
x: 431263.04519901227
y: 4434245.690801031
theta: -1.1311989657568451
kappa: -0.012801443211105882
s: 3.1502060194551147
dkappa: 0
ddkappa: 0
}
v: 1.0303364644404305
a: -0.47014931666889537
v: 1.0287460396679837
a: -0.47453047450142488
relative_time: 2.0000000000000009
}
trajectory_point {
path_point {
x: 431263.0737596695
y: 4434245.6293564029
theta: -1.1321119191518905
kappa: -0.012917497150894089
s: 3.2179640701717909
x: 431263.0666315878
y: 4434245.644691566
theta: -1.1318840663935195
kappa: -0.012888532762778022
s: 3.2010532226596133
dkappa: 0
ddkappa: 0
}
v: 1.0070134353831939
a: -0.46277922135703792
v: 1.0052033614938591
a: -0.46717775628019825
relative_time: 2.0500000000000007
}
trajectory_point {
path_point {
x: 431263.09474040871
y: 4434245.5842190068
theta: -1.132782581296194
kappa: -0.013002750701738282
s: 3.2677393249577946
x: 431263.08757186314
y: 4434245.5996412225
theta: -1.132553434022078
kappa: -0.012973621891837411
s: 3.250732479846103
dkappa: 0
ddkappa: 0
}
v: 0.98405780473108029
a: -0.45545338046397321
v: 0.98202813385530829
a: -0.45983284913831968
relative_time: 2.1000000000000005
}
trajectory_point {
path_point {
x: 431263.11524119932
y: 4434245.5401141588
theta: -1.1334379042223506
kappa: -0.013086054019856429
s: 3.3163759370729684
x: 431263.10802757781
y: 4434245.5556333493
theta: -1.1332073152195257
kappa: -0.01305674204777307
s: 3.2992621527873642
dkappa: 0
ddkappa: 0
}
v: 0.96146735976315023
a: -0.44817179398970131
v: 0.9592199067893874
a: -0.45249812943484269
relative_time: 2.1500000000000004
}
trajectory_point {
path_point {
x: 431263.1352697144
y: 4434245.497025352
theta: -1.1340781324831244
kappa: -0.013167438284451192
s: 3.3638921104834969
x: 431263.12800646084
y: 4434245.5126513187
theta: -1.1338459563100558
kappa: -0.01313792463645219
s: 3.3466605777875804
dkappa: 0
ddkappa: 0
}
v: 0.93923988775846379
a: -0.44093446193422214
v: 0.9367781115152
a: -0.44517597352882077
relative_time: 2.2
}
trajectory_point {
path_point {
x: 431263.15483358048
y: 4434245.4549361775
theta: -1.1347035092228883
kappa: -0.01324693448523117
s: 3.4103059385195196
x: 431263.14751622791
y: 4434245.4706785325
theta: -1.1344696032780346
kappa: -0.01321720100994473
s: 3.3929460597414418
dkappa: 0
ddkappa: 0
}
v: 0.91737317599608159
a: -0.43374138429753573
v: 0.9147020604338969
a: -0.43786875777930745
relative_time: 2.25
}
trajectory_point {
path_point {
x: 431263.17394037754
y: 4434245.41383033
theta: -1.1353142761711514
kappa: -0.013324573422410875
s: 3.4556354038751276
x: 431263.16656457889
y: 4434245.4296984235
theta: -1.135078501681386
kappa: -0.013294602456348021
s: 3.4381368661932479
dkappa: 0
ddkappa: 0
}
v: 0.89586501175506383
a: -0.42659256107964211
v: 0.89299094712867666
a: -0.43057885854535632
relative_time: 2.3
}
trajectory_point {
path_point {
x: 431263.1925976387
y: 4434245.3736916
theta: -1.135910673636477
kappa: -0.013400385706710751
s: 3.4998983786083659
x: 431263.18515919556
y: 4434245.3896944672
theta: -1.1356728965653666
kappa: -0.013370160189611395
s: 3.482251221396008
dkappa: 0
ddkappa: 0
}
v: 0.87471318231447093
a: -0.41948799228054123
v: 0.87164384636478454
a: -0.42330865218602082
relative_time: 2.3499999999999996
}
trajectory_point {
path_point {
x: 431263.21081285062
y: 4434245.3345038854
theta: -1.1364929405007749
kappa: -0.013474401759357168
s: 3.5431126241412323
x: 431263.20330773876
y: 4434245.35065018
theta: -1.1362530323767106
kappa: -0.013443905339360775
s: 3.5253073003705464
dkappa: 0
ddkappa: 0
}
v: 0.85391547495336328
a: -0.4124276779002331
v: 0.85065971408951357
a: -0.41606051506035446
relative_time: 2.3999999999999995
}
trajectory_point {
path_point {
x: 431263.2285934533
y: 4434245.2962511759
theta: -1.1370613142139503
kappa: -0.013546651812082415
s: 3.5852957912596777
x: 431263.22101784631
y: 4434245.3125491329
theta: -1.1368191528781311
kappa: -0.013515868940723295
s: 3.5673232229646019
dkappa: 0
ddkappa: 0
}
v: 0.83346967695080121
a: -0.40541161793871772
v: 0.83003738743220379
a: -0.40883682352741091
relative_time: 2.4499999999999993
}
trajectory_point {
path_point {
x: 431263.24594684003
y: 4434245.2589175673
theta: -1.137616030788889
kappa: -0.013617165907124714
s: 3.6264654201136057
x: 431263.23829713
y: 4434245.2753749471
theta: -1.1373715010631607
kappa: -0.013586081924151918
s: 3.6083170479119322
dkappa: 0
ddkappa: 0
}
v: 0.81337357558584511
a: -0.39843981239599507
v: 0.80977558470424293
a: -0.40163995394624352
relative_time: 2.4999999999999991
}
trajectory_point {
path_point {
x: 431263.26288035756
y: 4434245.2224872541
theta: -1.138157324796764
kappa: -0.013685973897228206
s: 3.6666389402168731
x: 431263.25515317358
y: 4434245.23911131
theta: -1.1379103190713169
kappa: -0.01365457510525003
s: 3.6483067668914155
dkappa: 0
ddkappa: 0
}
v: 0.7936249581375554
a: -0.39151226127206523
v: 0.78987290539906585
a: -0.39447228267590595
relative_time: 2.5499999999999989
}
trajectory_point {
path_point {
x: 431263.27940130583
y: 4434245.1869445313
theta: -1.1386854293626487
kappa: -0.013753105445642958
s: 3.70583367044729
x: 431263.27159352996
y: 4434245.2037419705
theta: -1.138435848103579
kappa: -0.013721379174596055
s: 3.6873102985861528
dkappa: 0
ddkappa: 0
}
v: 0.77422161188499228
a: -0.38462896456692813
v: 0.77032783019215456
a: -0.38733618607545173
relative_time: 2.5999999999999988
}
trajectory_point {
path_point {
x: 431263.29551693844
y: 4434245.1522737946
theta: -1.1392005761614175
kappa: -0.013818590026124964
s: 3.7440668190466182
x: 431263.28762571869
y: 4434245.1692507518
theta: -1.1389483283381576
kappa: -0.01378652468756808
s: 3.7253454827425707
dkappa: 0
ddkappa: 0
}
v: 0.75516132410721615
a: -0.37778992228058383
v: 0.75113872094103851
a: -0.38023404050393428
relative_time: 2.6499999999999986
}
trajectory_point {
path_point {
x: 431263.31123446213
y: 4434245.1184595376
theta: -1.1397029954139206
kappa: -0.013882456922936144
s: 3.7813554836205752
x: 431263.30325722363
y: 4434245.1356215533
theta: -1.139447998846548
kappa: -0.01385004205416844
s: 3.7624300742295227
dkappa: 0
ddkappa: 0
}
v: 0.73644188208328742
a: -0.37099513441303222
v: 0.73230382068529465
a: -0.37316822232040714
relative_time: 2.6999999999999984
}
trajectory_point {
path_point {
x: 431263.3265610371
y: 4434245.0854863571
theta: -1.1401929158834216
kappa: -0.01394473523084434
s: 3.8177166511388285
x: 431263.31849549041
y: 4434245.102838357
theta: -1.1399350975098512
kappa: -0.013911961528848353
s: 3.7985817370973933
dkappa: 0
ddkappa: 0
}
v: 0.71806107309226652
a: -0.36424460096427341
v: 0.71382125364654714
a: -0.36614110788392396
relative_time: 2.7499999999999982
}
trajectory_point {
path_point {
x: 431263.34150377678
y: 4434245.05333895
theta: -1.1406705648722775
kappa: -0.014005453855123319
s: 3.8531671979350008
x: 431263.3333479237
y: 4434245.0708852326
theta: -1.1404098609353472
kappa: -0.013972313200332508
s: 3.8338180386371983
dkappa: 0
ddkappa: 0
}
v: 0.70001668441321363
a: -0.35753832193430735
v: 0.69568902522846754
a: -0.35915507355353815
relative_time: 2.799999999999998
}
trajectory_point {
path_point {
x: 431263.35606974817
y: 4434245.0220021121
theta: -1.1411361682188552
kappa: -0.014064641511552779
s: 3.8877238897066668
x: 431263.34782188508
y: 4434245.0397463422
theta: -1.1408725243733127
kappa: -0.014031126981443697
s: 3.8681564434396893
dkappa: 0
ddkappa: 0
}
v: 0.68230650332518938
a: -0.35087629732313408
v: 0.67790502201677438
a: -0.35221249568830326
relative_time: 2.8499999999999979
}
trajectory_point {
path_point {
x: 431263.37026597152
y: 4434244.99146074
theta: -1.1415899502946671
kappa: -0.014122326726418336
s: 3.9214033815153546
x: 431263.36192469019
y: 4434245.0094059473
theta: -1.1413233216340664
kappa: -0.014088432598927406
s: 3.9016143074544547
dkappa: 0
ddkappa: 0
}
v: 0.66492831710725375
a: -0.34425852713075356
v: 0.66046701177923384
a: -0.34531575064727282
relative_time: 2.8999999999999977
}
trajectory_point {
path_point {
x: 431263.38409942039
y: 4434244.96169983
theta: -1.1420321340017145
kappa: -0.014178537836511537
s: 3.9542222177865445
x: 431263.37566360651
y: 4434244.9798484137
theta: -1.1417624850052313
kappa: -0.014144259583276437
s: 3.9342088720490218
dkappa: 0
ddkappa: 0
}
v: 0.64787991303846759
a: -0.33768501135716572
v: 0.64337264346565948
a: -0.33846721478950043
relative_time: 2.9499999999999975
}
trajectory_point {
path_point {
x: 431263.39757702191
y: 4434244.9327044822
theta: -1.1424629407700284
kappa: -0.014233302989129847
s: 3.986196832309671
x: 431263.38904585055
y: 4434244.9510582145
theta: -1.1421902451692025
kappa: -0.014198637258555514
s: 3.9659572580679607
dkappa: 0
ddkappa: 0
}
v: 0.63115907839789087
a: -0.33115575000237074
v: 0.62661944720791207
a: -0.33166926447403955
relative_time: 2.9999999999999973
}
trajectory_point {
path_point {
x: 431263.41036876128
y: 4434244.9043061733
theta: -1.1429148058344887
kappa: -0.014262145096672065
s: 4.017343548238121
x: 431263.40200403717
y: 4434244.9229859244
theta: -1.1426139594162523
kappa: -0.014246172231925957
s: 3.9968764598919853
dkappa: 0
ddkappa: 0
}
v: 0.614763600464584
a: -0.32467074306636845
v: 0.61020483431989958
a: -0.32492427605994367
relative_time: 3.0499999999999972
}
trajectory_point {
path_point {
x: 431263.42276642873
y: 4434244.8766202228
theta: -1.1433607037524767
kappa: -0.014285819071234863
s: 4.0476785780892346
x: 431263.41430846159
y: 4434244.8955082
theta: -1.1430565018884511
kappa: -0.01426966815414637
s: 4.0269833394970549
dkappa: 0
ddkappa: 0
}
v: 0.59869126651760751
a: -0.3182299905491589
v: 0.59412609729757748
a: -0.31823462590626628
relative_time: 3.099999999999997
}
trajectory_point {
path_point {
x: 431263.43483894772
y: 4434244.84966038
theta: -1.1437949097766842
kappa: -0.014308872158324923
s: 4.0772180237443045
x: 431263.42628773162
y: 4434244.8687565969
theta: -1.1434873523804112
kappa: -0.014292543177661812
s: 4.0562946205134809
dkappa: 0
ddkappa: 0
}
v: 0.5829398638360217
a: -0.31183349245074221
v: 0.57838040981894856
a: -0.31160269037206112
relative_time: 3.1499999999999968
}
trajectory_point {
path_point {
x: 431263.44659285375
y: 4434244.82341205
theta: -1.1442176586120265
kappa: -0.014331316837782715
s: 4.1059778764485779
x: 431263.43794862315
y: 4434244.8427159823
theta: -1.1439067542368073
kappa: -0.014314810241274864
s: 4.0848268822850224
dkappa: 0
ddkappa: 0
}
v: 0.56750717969888687
a: -0.30548124877111821
v: 0.56296482674406279
a: -0.30503084581638151
relative_time: 3.1999999999999966
}
trajectory_point {
path_point {
x: 431263.45803463703
y: 4434244.79786074
theta: -1.1446291833720694
kappa: -0.01435316550310645
s: 4.1339740168112522
x: 431263.4492978506
y: 4434244.8173713638
theta: -1.1443149486292221
kappa: -0.014336482166548042
s: 4.1125965539279941
dkappa: 0
ddkappa: 0
}
v: 0.55239100138526342
a: -0.29917325951028695
v: 0.54787628411501754
a: -0.2985214685982811
relative_time: 3.2499999999999964
}
trajectory_point {
path_point {
x: 431263.46917074267
y: 4434244.7729920549
theta: -1.145029715576213
kappa: -0.01437443046145208
s: 4.1612222148054805
x: 431263.46034206467
y: 4434244.7927078884
theta: -1.1447121744659587
kappa: -0.014357571653167429
s: 4.1396199083903671
dkappa: 0
ddkappa: 0
}
v: 0.53758911617421179
a: -0.29290952466824849
v: 0.53311159915595752
a: -0.29207693507681332
relative_time: 3.2999999999999963
}
trajectory_point {
path_point {
x: 431263.48000757053
y: 4434244.7487917058
theta: -1.1454194851470658
kappa: -0.014395123933633307
s: 4.1877381297683671
x: 431263.47108784958
y: 4434244.7687108526
theta: -1.1450986683020514
kappa: -0.014378091274306282
s: 4.1659130565108695
dkappa: 0
ddkappa: 0
}
v: 0.52309931134479215
a: -0.28669004424500277
v: 0.51866747027307492
a: -0.2856996216110318
relative_time: 3.3499999999999961
}
trajectory_point {
path_point {
x: 431263.49055147514
y: 4434244.7252455
theta: -1.1457987204079985
kappa: -0.014415258054121569
s: 4.21353731040097
x: 431263.48154172109
y: 4434244.7453657053
theta: -1.1454746642494591
kappa: -0.014398053471988671
s: 4.1914919410780911
dkappa: 0
ddkappa: 0
}
v: 0.508919374176065
a: -0.2805148182405498
v: 0.5045404770546088
a: -0.27939190455998991
relative_time: 3.3999999999999959
}
trajectory_point {
path_point {
x: 431263.50080876605
y: 4434244.7023393493
theta: -1.1461676480808676
kappa: -0.014434844871046043
s: 4.2386351947683023
x: 431263.49171012384
y: 4434244.7226580549
theta: -1.1458403938874362
kappa: -0.014417470552453097
s: 4.2163723308895849
dkappa: 0
ddkappa: 0
}
v: 0.49504709194709073
a: -0.27438384665488968
v: 0.49072708027084611
a: -0.27315616028274137
relative_time: 3.4499999999999957
}
trajectory_point {
path_point {
x: 431263.51078570727
y: 4434244.6800592626
theta: -1.1465264932838981
kappa: -0.014453896346193658
s: 4.2630471102993264
x: 431263.50159942871
y: 4434244.7005736735
theta: -1.1461960861730671
kappa: -0.014436354681516102
s: 4.24056981481097
dkappa: 0
ddkappa: 0
}
v: 0.48148025193692967
a: -0.2682971294880222
v: 0.47722362187412071
a: -0.26699476513833953
relative_time: 3.4999999999999956
}
trajectory_point {
path_point {
x: 431263.52048851788
y: 4434244.6583913518
theta: -1.1468754795297185
kappa: -0.014472424355009077
s: 4.28678827378696
x: 431263.51121593086
y: 4434244.6790985055
theta: -1.1465419673519559
kappa: -0.014454717879935909
s: 4.2640997958350306
dkappa: 0
ddkappa: 0
}
v: 0.46821664142464214
a: -0.26225466673994752
v: 0.46402632499881391
a: -0.26091009548583805
relative_time: 3.5499999999999954
}
trajectory_point {
path_point {
x: 431263.52992337162
y: 4434244.6373218326
theta: -1.1472148287235353
kappa: -0.01449044068659471
s: 4.3098737913880729
x: 431263.52056584693
y: 4434244.6582186641
theta: -1.1468782608690617
kappa: -0.014472572018776029
s: 4.2869774851408247
dkappa: 0
ddkappa: 0
}
v: 0.45525404768928845
a: -0.25625645841066563
v: 0.45113129396135432
a: -0.25490452768429039
relative_time: 3.5999999999999952
}
trajectory_point {
path_point {
x: 431263.539096397
y: 4434244.6168370172
theta: -1.1475447611614407
kappa: -0.014507957043710711
s: 4.3323186586234881
x: 431263.52965531277
y: 4434244.63792045
theta: -1.1472051872796727
kappa: -0.014489928814768892
s: 4.3092178961527807
dkappa: 0
ddkappa: 0
}
v: 0.442590258009929
a: -0.25030250450017644
v: 0.43853451426021817
a: -0.24898043809275006
relative_time: 3.649999999999995
}
trajectory_point {
path_point {
x: 431263.54801367747
y: 4434244.5969233206
theta: -1.1478654955288479
kappa: -0.014524985042774968
s: 4.3541377603779834
x: 431263.53849038115
y: 4434244.6181903463
theta: -1.1475229641605065
kappa: -0.01450679982567947
s: 4.3308358385998034
dkappa: 0
ddkappa: 0
}
v: 0.43022305966562435
a: -0.24439280500848
v: 0.42623185257592844
a: -0.24314020307027068
relative_time: 3.6999999999999948
}
trajectory_point {
path_point {
x: 431263.556681251
y: 4434244.5775672588
theta: -1.1481772488990396
kappa: -0.014541536213863122
s: 4.3753458709002855
x: 431263.54707701883
y: 4434244.5990150264
theta: -1.147831806020932
kappa: -0.014523196445668893
s: 4.3518459125743743
dkappa: 0
ddkappa: 0
}
v: 0.41815023993543465
a: -0.23852735993557636
v: 0.41421905677105586
a: -0.23738619897590568
relative_time: 3.7499999999999947
}
trajectory_point {
path_point {
x: 431263.56510511052
y: 4434244.558755449
theta: -1.1484802367318308
kappa: -0.014557622000708549
s: 4.3959576538030793
x: 431263.55542110471
y: 4434244.5803813646
theta: -1.1481319242143055
kappa: -0.01453912990065807
s: 4.3722625025916528
dkappa: 0
ddkappa: 0
}
v: 0.40636958609842022
a: -0.23270616928146551
v: 0.40249175589021846
a: -0.23172080216870863
relative_time: 3.7999999999999945
}
trajectory_point {
path_point {
x: 431263.57329120371
y: 4434244.5404746085
theta: -1.1487746728723314
kappa: -0.014573253760702367
s: 4.4159876620629976
x: 431263.56352842704
y: 4434244.5622764323
theta: -1.1484235268494105
kappa: -0.01455461124369133
s: 4.3920997716485841
dkappa: 0
ddkappa: 0
}
v: 0.39487888543364169
a: -0.22692923304614737
v: 0.39104546016008135
a: -0.22614638900773304
relative_time: 3.8499999999999943
}
trajectory_point {
path_point {
x: 431263.58124543307
y: 4434244.5227115573
theta: -1.1490607695498067
kappa: -0.014588442764893444
s: 4.4354503380206314
x: 431263.57140468119
y: 4434244.5446875123
theta: -1.1487068187019966
kappa: -0.014569651350300011
s: 4.4113716552829949
dkappa: 0
ddkappa: 0
}
v: 0.38367592522015903
a: -0.22119655122962198
v: 0.37987556098935737
a: -0.22066533585203246
relative_time: 3.8999999999999941
}
trajectory_point {
path_point {
x: 431263.58897365577
y: 4434244.505453215
theta: -1.1493387373766291
kappa: -0.014603200197988383
s: 4.45436001338052
x: 431263.5790554671
y: 4434244.5276020989
theta: -1.1489820011264125
kappa: -0.014584260913866109
s: 4.4300918556327
dkappa: 0
ddkappa: 0
}
v: 0.37275849273703288
a: -0.21550812383188939
v: 0.36897733096880614
a: -0.21528001906066041
relative_time: 3.949999999999994
}
trajectory_point {
path_point {
x: 431263.5964816839
y: 4434244.4886866026
theta: -1.149608785347312
kappa: -0.014617537158351531
s: 4.4727309092111582
x: 431263.58648628683
y: 4434244.5110079031
theta: -1.1492492719673226
kappa: -0.014598450440985898
s: 4.4482738354946019
dkappa: 0
ddkappa: 0
}
v: 0.36212437526332375
a: -0.20986395085294957
v: 0.35834592387123509
a: -0.20999281499267042
relative_time: 3.9999999999999938
}
trajectory_point {
path_point {
x: 431263.60377522151
y: 4434244.47239898
theta: -1.1498711185803685
kappa: -0.014631464538166303
s: 4.49057698238777
x: 431263.59370256041
y: 4434244.4948928226
theta: -1.1495088261201616
kappa: -0.014612230281270986
s: 4.4659308565107771
dkappa: 0
ddkappa: 0
}
v: 0.35176208903366885
a: -0.20463948295363796
v: 0.34797906564784087
a: -0.20469494390186821
relative_time: 4.0499999999999936
}
trajectory_point {
path_point {
x: 431263.61085966695
y: 4434244.4565782929
theta: -1.1501259312069823
kappa: -0.014644992645934902
s: 4.5079114418762227
x: 431263.60070968454
y: 4434244.4792448077
theta: -1.1497608576508016
kappa: -0.014625610739924711
s: 4.4830761234200418
dkappa: 0
ddkappa: 0
}
v: 0.3416592285059209
a: -0.19948692277667318
v: 0.3378750897084743
a: -0.19947745916550852
relative_time: 4.0999999999999934
}
trajectory_point {
path_point {
x: 431263.61774028477
y: 4434244.4412127854
theta: -1.150373412549234
kappa: -0.014658131534521879
s: 4.5247471690769583
x: 431263.6075129899
y: 4434244.4640519517
theta: -1.1500055582654134
kappa: -0.014638601996545098
s: 4.4997226800148171
dkappa: 0
ddkappa: 0
}
v: 0.33181219829396247
a: -0.19440627032205515
v: 0.328029986405322
a: -0.19433997398723693
relative_time: 4.1499999999999932
}
trajectory_point {
path_point {
x: 431263.62442226603
y: 4434244.426290866
theta: -1.1506137492920083
kappa: -0.014670891116496762
s: 4.5410968656211139
x: 431263.61411772587
y: 4434244.4493025327
theta: -1.150243116735733
kappa: -0.014651214074647624
s: 4.5158833700886332
dkappa: 0
ddkappa: 0
}
v: 0.32221740301167634
a: -0.18939752558978387
v: 0.31843976543038843
a: -0.18928210157069905
relative_time: 4.1999999999999931
}
trajectory_point {
path_point {
x: 431263.63091072824
y: 4434244.4118011035
theta: -1.1508471254823871
kappa: -0.014683281164134043
s: 4.5569730533705188
x: 431263.62052906008
y: 4434244.43498501
theta: -1.1504737189126668
kappa: -0.014663456842419882
s: 4.5315708384031126
dkappa: 0
ddkappa: 0
}
v: 0.31287124727294507
a: -0.18446068857985931
v: 0.30910045581549583
a: -0.18430345511954049
relative_time: 4.2499999999999929
}
trajectory_point {
path_point {
x: 431263.63721071556
y: 4434244.3977322364
theta: -1.1510737225290986
kappa: -0.014695311309413182
s: 4.5723880744176988
x: 431263.62675207946
y: 4434244.421088024
theta: -1.150697547739949
kappa: -0.014675340013476222
s: 4.546797531654966
dkappa: 0
ddkappa: 0
}
v: 0.30377013569165134
a: -0.17959575929228153
v: 0.300008105932284
a: -0.17940364783740692
relative_time: 4.2999999999999927
}
trajectory_point {
path_point {
x: 431263.64332719869
y: 4434244.3840731625
theta: -1.1512937192020152
kappa: -0.014706991044018611
s: 4.5873540910858726
x: 431263.63279179035
y: 4434244.4076003945
theta: -1.1509147832678523
kappa: -0.014686873147612411
s: 4.5615756994429821
dkappa: 0
ddkappa: 0
}
v: 0.29491047288167788
a: -0.17480273772705046
v: 0.29115878349221069
a: -0.17458229292794397
relative_time: 4.3499999999999925
}
trajectory_point {
path_point {
x: 431263.64926507475
y: 4434244.3708129469
theta: -1.1515072916316995
kappa: -0.014718329719339725
s: 4.6018830859289528
x: 431263.63865311886
y: 4434244.3945111223
theta: -1.1511256026669419
kappa: -0.014698065651560304
s: 4.5759173952350158
dkappa: 0
ddkappa: 0
}
v: 0.28628866345690723
a: -0.17008162388416614
v: 0.28254857554655111
a: -0.1698390035947972
relative_time: 4.3999999999999924
}
trajectory_point {
path_point {
x: 431263.65502916742
y: 4434244.3579408173
theta: -1.1517146133089888
kappa: -0.014729336546470894
s: 4.6159868617315478
x: 431263.64434091141
y: 4434244.3818093827
theta: -1.1513301802418756
kappa: -0.01470892677974248
s: 4.5898344773349846
dkappa: 0
ddkappa: 0
}
v: 0.2779011120312222
a: -0.16543241776362858
v: 0.27417358848639833
a: -0.1651733930416123
relative_time: 4.4499999999999922
}
trajectory_point {
path_point {
x: 431263.66062422685
y: 4434244.3454461657
theta: -1.1519158550846236
kappa: -0.014740020596211448
s: 4.6296770415089581
x: 431263.64985993493
y: 4434244.3694845308
theta: -1.1515286874452413
kappa: -0.014719465635026904
s: 4.6033386098498523
dkappa: 0
ddkappa: 0
}
v: 0.26974422321850533
a: -0.16085511936543773
v: 0.26602994804266311
a: -0.16058507447203488
relative_time: 4.499999999999992
}
trajectory_point {
path_point {
x: 431263.66605492996
y: 4434244.3333185473
theta: -1.1521111851689099
kappa: -0.014750390799065696
s: 4.6429650685071788
x: 431263.65521487757
y: 4434244.3575260974
theta: -1.1517212928914318
kappa: -0.014729691169481599
s: 4.6164412636566254
dkappa: 0
ddkappa: 0
}
v: 0.26181440163263936
a: -0.15634972868959363
v: 0.25811379928607403
a: -0.15607366108971052
relative_time: 4.5499999999999918
}
trajectory_point {
path_point {
x: 431263.67132587987
y: 4434244.3215476824
theta: -1.1523007691314142
kappa: -0.014760455945242903
s: 4.6558622062029009
x: 431263.66041034879
y: 4434244.3459237888
theta: -1.1519081623705529
kappa: -0.014739612185129274
s: 4.6291537173693431
dkappa: 0
ddkappa: 0
}
v: 0.25410805188750696
a: -0.15191624573609627
v: 0.25042130662717715
a: -0.15163876609828492
relative_time: 4.5999999999999917
}
trajectory_point {
path_point {
x: 431263.67644160654
y: 4434244.3101234566
theta: -1.1524847699006915
kappa: -0.014770224684657312
s: 4.6683795383035065
x: 431263.66545087984
y: 4434244.3346674861
theta: -1.1520894588623634
kappa: -0.014749237334702006
s: 4.6414870583060663
dkappa: 0
ddkappa: 0
}
v: 0.24662157859699069
a: -0.14755467050494567
v: 0.24294865381633649
a: -0.14728000270140362
relative_time: 4.6499999999999915
}
trajectory_point {
path_point {
x: 431263.68140656629
y: 4434244.2990359161
theta: -1.1526633477640398
kappa: -0.01477970552692813
s: 4.6805279687470751
x: 431263.67034092417
y: 4434244.3237472437
theta: -1.1522653425502409
kappa: -0.014758575122395885
s: 4.65345218345587
dkappa: 0
ddkappa: 0
}
v: 0.2393513863749733
a: -0.14326500299614181
v: 0.23569204394373366
a: -0.14299698410271233
relative_time: 4.6999999999999913
}
trajectory_point {
path_point {
x: 431263.68622514186
y: 4434244.2882752754
theta: -1.1528366603672811
kappa: -0.014788906841379533
s: 4.6923182217023767
x: 431263.67508485809
y: 4434244.31315329
theta: -1.1524359708351759
kappa: -0.014767633904625665
s: 4.6650598004458326
dkappa: 0
ddkappa: 0
}
v: 0.23229387983533742
a: -0.13904724320968467
v: 0.22864769943936805
a: -0.13878932350585663
relative_time: 4.7499999999999911
}
trajectory_point {
path_point {
x: 431263.69090164278
y: 4434244.27783191
theta: -1.1530048627145655
kappa: -0.014797836857040662
s: 4.7037608415688794
x: 431263.6796869805
y: 4434244.3028760236
theta: -1.1526014983497888
kappa: -0.014776421890779427
s: 4.6763204285080295
dkappa: 0
ddkappa: 0
}
v: 0.22544546359196577
a: -0.13490139114557428
v: 0.22181186207305673
a: -0.13465663411448214
relative_time: 4.7999999999999909
}
trajectory_point {
path_point {
x: 431263.69544030505
y: 4434244.26769636
theta: -1.1531681071681983
kappa: -0.014806503662645638
s: 4.7148661929767428
x: 431263.68415151408
y: 4434244.2929060142
theta: -1.1527620769723672
kappa: -0.014784947143973239
s: 4.6872443994465218
dkappa: 0
ddkappa: 0
}
v: 0.21880254225874093
a: -0.13082744680381064
v: 0.21518079295443443
a: -0.13059852913223449
relative_time: 4.8499999999999908
}
trajectory_point {
path_point {
x: 431263.699845291
y: 4434244.25785933
theta: -1.1533265434484861
kappa: -0.014814915206633535
s: 4.72564446078682
x: 431263.68848260504
y: 4434244.2832340039
theta: -1.1529178558409257
kappa: -0.014793217581805806
s: 4.697841858604348
dkappa: 0
ddkappa: 0
}
v: 0.21236152044954565
a: -0.12682541018439375
v: 0.20875077253295377
a: -0.12661462176275934
relative_time: 4.8999999999999906
}
trajectory_point {
path_point {
x: 431263.70412068965
y: 4434244.2483116891
theta: -1.1534803186336002
kappa: -0.014823079297148404
s: 4.7361056500906624
x: 431263.692684324
y: 4434244.2738509011
theta: -1.1530689813672803
kappa: -0.014801240977113123
s: 4.7081227658305131
dkappa: 0
ddkappa: 0
}
v: 0.2061188027782625
a: -0.12289528128732358
v: 0.20251810059788491
a: -0.12270452520970225
relative_time: 4.94999999999999
}
trajectory_point {
path_point {
x: 431263.70827051654
y: 4434244.23904447
theta: -1.1536295771594585
kappa: -0.014831003602039265
s: 4.74625958621051
x: 431263.69676066592
y: 4434244.2647477854
theta: -1.1532155972511424
kappa: -0.014809024958723136
s: 4.7180968964469834
dkappa: 0
ddkappa: 0
}
v: 0.20007079385877422
a: -0.11903706011260017
v: 0.19647909627831586
a: -0.11886785267670889
relative_time: 4.99999999999999
}
trajectory_point {
path_point {
x: 431263.7122987138
y: 4434244.2300488688
theta: -1.1537744608196199
kappa: -0.0148386956488601
s: 4.7561159146993006
x: 431263.700715551
y: 4434244.2559159026
theta: -1.1533578444942258
kappa: -0.014816577012210407
s: 4.7277738422156732
dkappa: 0
ddkappa: 0
}
v: 0.19421389830496341
a: -0.11525074666022349
v: 0.19063009804315226
a: -0.11510421736742489
relative_time: 5.04999999999999
}
trajectory_point {
path_point {
x: 431263.71620914986
y: 4434244.2213162463
theta: -1.1539151087651947
kappa: -0.014846162824869866
s: 4.7656841013406659
x: 431263.70455282449
y: 4434244.2473466638
theta: -1.1534958614143671
kappa: -0.014823904480650751
s: 4.73716301230544
dkappa: 0
ddkappa: 0
}
v: 0.18854452073071279
a: -0.11153634093019354
v: 0.18496746370111747
a: -0.11141323248549585
relative_time: 5.09999999999999
}
trajectory_point {
path_point {
x: 431263.72000562004
y: 4434244.2128381291
theta: -1.154051657504765
kappa: -0.014853412377032485
s: 4.7749734321489292
x: 431263.70827625785
y: 4434244.2390316483
theta: -1.1536297836596598
kappa: -0.014831014565375904
s: 4.7462736342590688
dkappa: 0
ddkappa: 0
}
v: 0.183059065749905
a: -0.10789384292251035
v: 0.17948757040075269
a: -0.10779451123456742
relative_time: 5.14999999999999
}
trajectory_point {
path_point {
x: 431263.72369184578
y: 4434244.2046062043
theta: -1.1541842409043188
kappa: -0.01486045141201685
s: 4.7839930133691118
x: 431263.71188954834
y: 4434244.2309626
theta: -1.1537597442225971
kappa: -0.014837914326728182
s: 4.755114754960271
dkappa: 0
ddkappa: 0
}
v: 0.17775393797642267
a: -0.1043232526371739
v: 0.17418681463041669
a: -0.10424766681828519
relative_time: 5.1999999999999895
}
trajectory_point {
path_point {
x: 431263.72727147531
y: 4434244.1966123255
theta: -1.1543129901871909
kappa: -0.014867286896196815
s: 4.792751771476925
x: 431263.71539631992
y: 4434244.2231314247
theta: -1.1538858734542272
kappa: -0.014844610684815126
s: 4.7636952416006695
dkappa: 0
ddkappa: 0
}
v: 0.17262554202414851
a: -0.1008245700741842
v: 0.169061612218286
a: -0.10077231244029482
relative_time: 5.2499999999999893
}
trajectory_point {
path_point {
x: 431263.73074808344
y: 4434244.18884851
theta: -1.1544380339340161
kappa: -0.01487392565565121
s: 4.8012584531787779
x: 431263.71880012343
y: 4434244.2155301934
theta: -1.1540082990783156
kappa: -0.014851110420264171
s: 4.7720237826467917
dkappa: 0
ddkappa: 0
}
v: 0.16767028250696517
a: -0.097397795233541237
v: 0.16410839833235494
a: -0.097368061304241915
relative_time: 5.2999999999999892
}
trajectory_point {
path_point {
x: 431263.73412517132
y: 4434244.1813069386
theta: -1.1545594980826888
kappa: -0.014880374376163834
s: 4.8095216254117714
x: 431263.72210443724
y: 4434244.2081511384
theta: -1.1541271462055169
kappa: -0.014857420174977293
s: 4.7801088888070611
dkappa: 0
ddkappa: 0
}
v: 0.16288456403875531
a: -0.09404292811524502
v: 0.15932362748043546
a: -0.09403452661377211
relative_time: 5.349999999999989
}
trajectory_point {
path_point {
x: 431263.73740616674
y: 4434244.1739799576
theta: -1.154677505928329
kappa: -0.014886639603223447
s: 4.8175496753437006
x: 431263.72531266732
y: 4434244.2009866536
theta: -1.1542425373475518
kappa: -0.014863546452885665
s: 4.7879588939987849
dkappa: 0
ddkappa: 0
}
v: 0.15826479123340159
a: -0.090759968719295522
v: 0.15470377351015729
a: -0.090771321572531011
relative_time: 5.3999999999999888
}
trajectory_point {
path_point {
x: 431263.74059442396
y: 4434244.1668600757
theta: -1.1547921781232566
kappa: -0.014892727742023784
s: 4.8253508103730569
x: 431263.72842814768
y: 4434244.194029293
theta: -1.1543545924313934
kappa: -0.014869495620704323
s: 4.79558195631515
dkappa: 0
ddkappa: 0
}
v: 0.15380736870478667
a: -0.087548917045692787
v: 0.15024532960896786
a: -0.0875780593841643
relative_time: 5.4499999999999886
}
trajectory_point {
path_point {
x: 431263.74369322381
y: 4434244.1599399662
theta: -1.1549036326769713
kappa: -0.014898645057463545
s: 4.8329330581290231
x: 431263.73145414121
y: 4434244.187271771
theta: -1.1544634288134559
kappa: -0.014875273908686808
s: 4.80298605899221
dkappa: 0
ddkappa: 0
}
v: 0.14950870106679323
a: -0.084409773094436785
v: 0.1459448083041322
a: -0.08445435325231751
relative_time: 5.4999999999999885
}
trajectory_point {
path_point {
x: 431263.74670577364
y: 4434244.1532124653
theta: -1.1550119849561356
kappa: -0.014904397674146396
s: 4.8403042664714775
x: 431263.73439383938
y: 4434244.1807069611
theta: -1.1545691612937914
kappa: -0.014880887411379839
s: 4.810179011375876
dkappa: 0
ddkappa: 0
}
v: 0.14536519293330394
a: -0.0813425368655275
v: 0.14179874146273333
a: -0.081399816380636369
relative_time: 5.5499999999999883
}
trajectory_point {
path_point {
x: 431263.74963520741
y: 4434244.1466705771
theta: -1.1551173476845646
kappa: -0.01490999157638098
s: 4.8474721034909933
x: 431263.73725036316
y: 4434244.1743278913
theta: -1.1546719021302894
kappa: -0.014886342088377948
s: 4.8171684498889116
dkappa: 0
ddkappa: 0
}
v: 0.14137324891820141
a: -0.078347208358965
v: 0.13780368029167175
a: -0.0784140619727664
relative_time: 5.5999999999999881
}
trajectory_point {
path_point {
x: 431263.75248458539
y: 4434244.1403074656
theta: -1.1552198309432189
kappa: -0.014915432608180897
s: 4.8544440575088359
x: 431263.74002676323
y: 4434244.1681277519
theta: -1.1547717610528803
kappa: -0.014891643765078157
s: 4.8239618389979171
dkappa: 0
ddkappa: 0
}
v: 0.13752927363536835
a: -0.07542378757474924
v: 0.13395619533766578
a: -0.0754967032323533
relative_time: 5.6499999999999879
}
trajectory_point {
path_point {
x: 431263.75525689468
y: 4434244.1341164606
theta: -1.1553195421702005
kappa: -0.014920726473264726
s: 4.8612274370769661
x: 431263.74272602034
y: 4434244.1620998839
theta: -1.1548688452777434
kappa: -0.01489679813343462
s: 4.8305664721803261
dkappa: 0
ddkappa: 0
}
v: 0.13382967169868742
a: -0.0725722745128802
v: 0.13025287648725145
a: -0.072647353363042649
relative_time: 5.6999999999999877
}
trajectory_point {
path_point {
x: 431263.75795504864
y: 4434244.1280910568
theta: -1.1554165861607526
kappa: -0.014925878735056009
s: 4.867829370978038
x: 431263.74535104586
y: 4434244.1562377866
theta: -1.1549632595215171
kappa: -0.014901810752713289
s: 4.8369894728913962
dkappa: 0
ddkappa: 0
}
v: 0.1302708477220412
a: -0.069792669173357913
v: 0.12669033296678239
a: -0.069865625568480139
relative_time: 5.7499999999999876
}
trajectory_point {
path_point {
x: 431263.76058188733
y: 4434244.1222249111
theta: -1.1555110650672615
kappa: -0.014930894816683252
s: 4.8742568082254021
x: 431263.74790468195
y: 4434244.1505351141
theta: -1.1550551060155125
kappa: -0.014906687050246564
s: 4.8432377955311958
dkappa: 0
ddkappa: 0
}
v: 0.12684920631931251
a: -0.067084971556182343
v: 0.12326519334243016
a: -0.067151133052311324
relative_time: 5.7999999999999874
}
trajectory_point {
path_point {
x: 431263.76314017724
y: 4434244.116511845
theta: -1.1556030783992612
kappa: -0.014935780000979938
s: 4.8805165180631
x: 431263.75038970204
y: 4434244.1449856721
theta: -1.1551444845199277
kappa: -0.014911432322187945
s: 4.8493182264115973
dkappa: 0
ddkappa: 0
}
v: 0.12356115210438393
a: -0.06444918166135355
v: 0.11997410552018395
a: -0.06450348901818187
relative_time: 5.8499999999999872
}
trajectory_point {
path_point {
x: 431263.76563261141
y: 4434244.110945846
theta: -1.1556927230234391
kappa: -0.014940539430484514
s: 4.8866150899658685
x: 431263.75280881149
y: 4434244.1395834181
theta: -1.1552314923380655
kappa: -0.014916051734266701
s: 4.8552373847232682
dkappa: 0
ddkappa: 0
}
v: 0.12040308969113808
a: -0.061885299488871476
v: 0.1168137367458506
a: -0.061922306669737359
relative_time: 5.899999999999987
}
trajectory_point {
path_point {
x: 431263.76806180959
y: 4434244.1055210624
theta: -1.1557800931636448
kappa: -0.014945178107440392
s: 4.8925589336391395
x: 431263.75516464742
y: 4434244.1343224635
theta: -1.1553162243305537
kappa: -0.014920550322542518
s: 4.861001723502663
dkappa: 0
ddkappa: 0
}
v: 0.11737142369345768
a: -0.059393325038736178
v: 0.11378077360505479
a: -0.059407199210623485
relative_time: 5.9499999999999869
}
trajectory_point {
path_point {
x: 431263.77043031767
y: 4434244.10023181
theta: -1.1558652804008982
kappa: -0.014949700893795959
s: 4.8983542790190384
x: 431263.75745977979
y: 4434244.12919707
theta: -1.1553987729295634
kappa: -0.014924932994160152
s: 4.8666175305990125
dkappa: 0
ddkappa: 0
}
v: 0.11446255872522537
a: -0.056973258310947572
v: 0.1108719220232387
a: -0.0569577798444858
relative_time: 5.9999999999999867
}
trajectory_point {
path_point {
x: 431263.77274058922
y: 4434244.0950726075
theta: -1.1559483729813151
kappa: -0.014954112474460038
s: 4.9040071291891874
x: 431263.75969671737
y: 4434244.1242016349
theta: -1.1554792283745554
kappa: -0.014929204539865217
s: 4.872090944711621
dkappa: 0
ddkappa: 0
}
v: 0.11167013678960847
a: -0.054730613247121258
v: 0.10808480183134665
a: -0.054538634268755951
relative_time: 6.0499999999999865
}
trajectory_point {
path_point {
x: 431263.77499493741
y: 4434244.0900382921
theta: -1.1560294541066436
kappa: -0.014958417266541606
s: 4.9095231440835514
x: 431263.76187792543
y: 4434244.119330653
theta: -1.1555576793368278
kappa: -0.014933369667162398
s: 4.8774279978776836
dkappa: 0
ddkappa: 0
}
v: 0.10898879798717494
a: -0.052529932983605448
v: 0.10541690972644738
a: -0.052188420887931179
relative_time: 6.0999999999999863
}
trajectory_point {
path_point {
x: 431263.77719561057
y: 4434244.0851238407
theta: -1.1561086046524114
kappa: -0.014962619563661673
s: 4.9149078254027909
x: 431263.76400580531
y: 4434244.1145787612
theta: -1.1556342121912124
kappa: -0.014937432961647902
s: 4.8826345659249988
dkappa: 0
ddkappa: 0
}
v: 0.10641644407790943
a: -0.050371217520400018
v: 0.10286483442032544
a: -0.049905726840792752
relative_time: 6.1499999999999861
}
trajectory_point {
path_point {
x: 431263.77934481454
y: 4434244.0803243285
theta: -1.1561859039517164
kappa: -0.014966723577566128
s: 4.9201665699355619
x: 431263.7660826894
y: 4434244.1099407505
theta: -1.1557089108310363
kappa: -0.014941398877184835
s: 4.88771635588303
dkappa: 0
ddkappa: 0
}
v: 0.10395097682179644
a: -0.04825446685750498
v: 0.100425235267827
a: -0.047689139266121928
relative_time: 6.199999999999986
}
trajectory_point {
path_point {
x: 431263.78144471196
y: 4434244.0756349256
theta: -1.1562614297952341
kappa: -0.014970733438125754
s: 4.9253046695585221
x: 431263.76811084268
y: 4434244.1054115631
theta: -1.1557818567200524
kappa: -0.014945271738659767
s: 4.8926789095150607
dkappa: 0
ddkappa: 0
}
v: 0.10159029797882045
a: -0.046179680994920327
v: 0.09809484226685912
a: -0.045537245302699945
relative_time: 6.2499999999999858
}
trajectory_point {
path_point {
x: 431263.7834974227
y: 4434244.0710508982
theta: -1.1563352584312268
kappa: -0.014974653193336218
s: 4.9303273112363293
x: 431263.77009246382
y: 4434244.1009862907
theta: -1.1558531289443708
kappa: -0.014949055744739259
s: 4.8975276068503453
dkappa: 0
ddkappa: 0
}
v: 0.099332309308965916
a: -0.044146859932646061
v: 0.095870456058389855
a: -0.043448632089308048
relative_time: 6.2999999999999856
}
trajectory_point {
path_point {
x: 431263.78550502378
y: 4434244.0665676082
theta: -1.1564074645655511
kappa: -0.014978486809318067
s: 4.9352395770216377
x: 431263.772029687
y: 4434244.0966601651
theta: -1.1559228042643908
kappa: -0.014952754970626444
s: 4.9022676697162622
dkappa: 0
ddkappa: 0
}
v: 0.097174912572217359
a: -0.042156003670682181
v: 0.09374894792644814
a: -0.0414218867647275
relative_time: 6.3499999999999854
}
trajectory_point {
path_point {
x: 431263.78746954922
y: 4434244.0621805117
theta: -1.1564781213616677
kappa: -0.014982238170316738
s: 4.9400464440551026
x: 431263.7739245831
y: 4434244.0924285622
theta: -1.1559909571667306
kappa: -0.014956373370817563
s: 4.906904165270471
dkappa: 0
ddkappa: 0
}
v: 0.095116009528559212
a: -0.040207112209028686
v: 0.0917272597981239
a: -0.039455596467739537
relative_time: 6.3999999999999853
}
trajectory_point {
path_point {
x: 431263.78939299035
y: 4434244.0578851644
theta: -1.1565473004406506
kappa: -0.014985911078702554
s: 4.9447527845653783
x: 431263.77577916125
y: 4434244.0882869959
theta: -1.1560576599161598
kappa: -0.014959914781858518
s: 4.911442009533058
dkappa: 0
ddkappa: 0
}
v: 0.093153501937975988
a: -0.038300185547685578
v: 0.089802404243567974
a: -0.037548348337125406
relative_time: 6.4499999999999851
}
trajectory_point {
path_point {
x: 431263.7912772955
y: 4434244.0536772134
theta: -1.1566150718811961
kappa: -0.014989509254970721
s: 4.9493633658691172
x: 431263.77759537037
y: 4434244.084231114
theta: -1.1561229826075297
kappa: -0.01496338292510143
s: 4.9158859709186977
dkappa: 0
ddkappa: 0
}
v: 0.091285291560452161
a: -0.036435223686652848
v: 0.087971464475992134
a: -0.035698729511666361
relative_time: 6.4999999999999849
}
trajectory_point {
path_point {
x: 431263.79312437022
y: 4434244.0495524025
theta: -1.1566815042196332
kappa: -0.014993036337741334
s: 4.9538828503709738
x: 431263.77937510016
y: 4434244.0802566959
theta: -1.1561869932177038
kappa: -0.014966781409461191
s: 4.9202406737687987
dkappa: 0
ddkappa: 0
}
v: 0.0895092801559722
a: -0.034612226625930512
v: 0.086231594351669077
a: -0.033905327130143645
relative_time: 6.5499999999999847
}
trajectory_point {
path_point {
x: 431263.79493607709
y: 4434244.0455065761
theta: -1.1567466644499322
kappa: -0.014996495883759373
s: 4.9583157955635988
x: 431263.7811201833
y: 4434244.07635965
theta: -1.1562497576574882
kappa: -0.014970113734172008
s: 4.9245106018836617
dkappa: 0
ddkappa: 0
}
v: 0.087823369484520616
a: -0.032831194365518568
v: 0.08458001836993248
a: -0.032166728331338518
relative_time: 6.5999999999999845
}
trajectory_point {
path_point {
x: 431263.79671423574
y: 4434244.0415356662
theta: -1.1568106180237145
kappa: -0.0149998913678947
s: 4.9626666540276432
x: 431263.78283239622
y: 4434244.0725360075
theta: -1.1563113398235625
kappa: -0.014973383291543968
s: 4.9287001020546288
dkappa: 0
ddkappa: 0
}
v: 0.086225461306081858
a: -0.031092126905416996
v: 0.083014031673176919
a: -0.030481520254032217
relative_time: 6.6499999999999844
}
trajectory_point {
path_point {
x: 431263.79846062307
y: 4434244.0376357073
theta: -1.1568734288502622
kappa: -0.015003226183142067
s: 4.9669397734317569
x: 431263.78451346088
y: 4434244.0687819244
theta: -1.1563718016504081
kappa: -0.014976593369719579
s: 4.93281338759624
dkappa: 0
ddkappa: 0
}
v: 0.084713457380640428
a: -0.029395024245625821
v: 0.081531000046857927
a: -0.028848290037005994
relative_time: 6.6999999999999842
}
trajectory_point {
path_point {
x: 431263.80017697316
y: 4434244.033802826
theta: -1.1569351592965273
kappa: -0.015006503640621106
s: 4.97113939653259
x: 431263.7861650461
y: 4434244.0650936738
theta: -1.1564312031622392
kappa: -0.014979747155430337
s: 4.9368545418783842
dkappa: 0
ddkappa: 0
}
v: 0.083285259468180786
a: -0.027739886386145027
v: 0.080128359919491979
a: -0.027265624819041091
relative_time: 6.749999999999984
}
trajectory_point {
path_point {
x: 431263.80186497705
y: 4434244.0300332466
theta: -1.1569958701871412
kappa: -0.015009726969576344
s: 4.97526966117479
x: 431263.78778876906
y: 4434244.0614676429
theta: -1.15648960252493
kappa: -0.014982847736753258
s: 4.9408275218584521
dkappa: 0
ddkappa: 0
}
v: 0.081938769328687433
a: -0.026126713326974617
v: 0.078803618362656452
a: -0.025732111738918772
relative_time: 6.7999999999999838
}
trajectory_point {
path_point {
x: 431263.80352628289
y: 4434244.0263232877
theta: -1.1570556208044229
kappa: -0.015012899317377185
s: 4.9793346002910077
x: 431263.7893861967
y: 4434244.0579003356
theta: -1.1565470560979449
kappa: -0.014985898105867449
s: 4.9447361616134895
dkappa: 0
ddkappa: 0
}
v: 0.080671888722144813
a: -0.024555505068114603
v: 0.077554353090989708
a: -0.024246337935420269
relative_time: 6.8499999999999837
}
trajectory_point {
path_point {
x: 431263.80516249617
y: 4434244.0226693647
theta: -1.157114468888389
kappa: -0.015016023749517923
s: 4.9833381419018874
x: 431263.79095884727
y: 4434244.0543883583
theta: -1.1566036184862662
kappa: -0.014988901161810652
s: 4.9485841758723526
dkappa: 0
ddkappa: 0
}
v: 0.079482519408537469
a: -0.02302626160956496
v: 0.076378212462191022
a: -0.022806890547326833
relative_time: 6.8999999999999835
}
trajectory_point {
path_point {
x: 431263.80677517923
y: 4434244.0190679887
theta: -1.1571724706367612
kappa: -0.015019103249617737
s: 4.9872841091160769
x: 431263.79250819149
y: 4434244.0509284269
theta: -1.1566593425923211
kappa: -0.014991859713235795
s: 4.952375163547857
dkappa: 0
ddkappa: 0
}
v: 0.078368563147849818
a: -0.021538982951325718
v: 0.0752729154770206
a: -0.021412356713419713
relative_time: 6.9499999999999833
}
trajectory_point {
path_point {
x: 431263.8083304821
y: 4434244.0155002447
theta: -1.15723069563693
kappa: -0.0150202057916536
s: 4.991176220130221
x: 431263.79403565446
y: 4434244.0475173611
theta: -1.1567142796679097
kappa: -0.014994776481167548
s: 4.9561126112689324
dkappa: 0
ddkappa: 0
}
v: 0.077327921700066388
a: -0.020093669093396854
v: 0.0742362517792996
a: -0.020061323572480166
relative_time: 6.9999999999999831
}
trajectory_point {
path_point {
x: 431263.8098479975
y: 4434244.0119707827
theta: -1.1572886772425786
kappa: -0.015020325251613034
s: 4.9950180882289645
x: 431263.79554261663
y: 4434244.0441520764
theta: -1.1567684793661328
kappa: -0.01499765410175888
s: 4.959799896912779
dkappa: 0
ddkappa: 0
}
v: 0.076358496825171651
a: -0.01869032003577837
v: 0.073266081655910115
a: -0.018752378263289432
relative_time: 7.0499999999999829
}
trajectory_point {
path_point {
x: 431263.8113470531
y: 4434244.0084842555
theta: -1.1573459535779491
kappa: -0.015020443258397491
s: 4.9988132217849524
x: 431263.79703041539
y: 4434244.0408295868
theta: -1.1568219897933165
kappa: -0.015000495129047596
s: 4.9634402931370154
dkappa: 0
ddkappa: 0
}
v: 0.075458190283150053
a: -0.017328935778470285
v: 0.072360336036795161
a: -0.017484107924628761
relative_time: 7.0999999999999828
}
trajectory_point {
path_point {
x: 431263.81282899313
y: 4434244.0050375359
theta: -1.1574025760061255
kappa: -0.015020559917834983
s: 5.0025650242588275
x: 431263.79850034689
y: 4434244.0375469979
theta: -1.15687485756094
kappa: -0.015003302037712911
s: 4.9670369709118338
dkappa: 0
ddkappa: 0
}
v: 0.074624903833986123
a: -0.016009516321472579
v: 0.071517016494958729
a: -0.0162550996952794
relative_time: 7.1499999999999826
}
trajectory_point {
path_point {
x: 431263.81429512054
y: 4434244.0016275942
theta: -1.1574585943070685
kappa: -0.015020675332491372
s: 5.0062767941992314
x: 431263.79995366686
y: 4434244.0343015045
theta: -1.1569271278375604
kappa: -0.015006077225831981
s: 4.9705930030521541
dkappa: 0
ddkappa: 0
}
v: 0.0738565392376643
a: -0.014732061664785266
v: 0.070734195246465681
a: -0.015063940714022589
relative_time: 7.1999999999999824
}
trajectory_point {
path_point {
x: 431263.81574669684
y: 4434243.998251494
theta: -1.1575140566776008
kappa: -0.015020789601670349
s: 5.0099517252428072
x: 431263.80139159237
y: 4434244.03109039
theta: -1.1569788444007389
kappa: -0.01500882301763647
s: 4.9741113677497752
dkappa: 0
ddkappa: 0
}
v: 0.0731509982541691
a: -0.013496571808408332
v: 0.0700100151504419
a: -0.013909218119639598
relative_time: 7.2499999999999822
}
trajectory_point {
path_point {
x: 431263.81718494196
y: 4434243.9949064013
theta: -1.1575690097313918
kappa: -0.015020902821413454
s: 5.0135929061141953
x: 431263.80281530356
y: 4434244.0279110176
theta: -1.1570300496889647
kappa: -0.015011541666269099
s: 4.97759495210553
dkappa: 0
ddkappa: 0
}
v: 0.072506182643484962
a: -0.012303046752341777
v: 0.069342689709074146
a: -0.012789519050911663
relative_time: 7.2999999999999821
}
trajectory_point {
path_point {
x: 431263.8186110346
y: 4434243.9915895732
theta: -1.1576234984989462
kappa: -0.015021015084500065
s: 5.0172033206260362
x: 431263.80422594445
y: 4434244.024760833
theta: -1.15708078485358
kappa: -0.015014235356540194
s: 4.9810465556614352
dkappa: 0
ddkappa: 0
}
v: 0.0719199941655964
a: -0.011151486496585622
v: 0.068730503067610138
a: -0.011703430646620022
relative_time: 7.3499999999999819
}
trajectory_point {
path_point {
x: 431263.82002611185
y: 4434243.988298364
theta: -1.15767756642759
kappa: -0.015021126480447405
s: 5.020785847678968
x: 431263.80562462483
y: 4434244.0216373587
theta: -1.1571310898107048
kappa: -0.015016906207684248
s: 4.9844688939328483
dkappa: 0
ddkappa: 0
}
v: 0.0713903345804879
a: -0.010041891041139846
v: 0.068171810014358528
a: -0.010649540045545941
relative_time: 7.3999999999999817
}
trajectory_point {
path_point {
x: 431263.8214312694
y: 4434243.9850302255
theta: -1.1577312553814594
kappa: -0.01502123709551053
s: 5.024343261261631
x: 431263.80701242172
y: 4434244.0185381891
theta: -1.1571810032931593
kappa: -0.015019556276116459
s: 4.9878646019406183
dkappa: 0
ddkappa: 0
}
v: 0.07091510564814392
a: -0.0089742603860044623
v: 0.0676650359806889
a: -0.0096264343864706572
relative_time: 7.4499999999999815
}
trajectory_point {
path_point {
x: 431263.82282756153
y: 4434243.9817827074
theta: -1.1577846056414891
kappa: -0.015021347012682351
s: 5.0278782304506615
x: 431263.80835418869
y: 4434244.0154451067
theta: -1.1572316014244266
kappa: -0.015020207657855519
s: 4.9912362377432382
dkappa: 0
ddkappa: 0
}
v: 0.070492209128548949
a: -0.0079485945311794579
v: 0.067208677041031784
a: -0.00863270080817543
relative_time: 7.4999999999999813
}
trajectory_point {
path_point {
x: 431263.82421600114
y: 4434243.9785534525
theta: -1.1578376559054029
kappa: -0.015021456311693607
s: 5.0313933194106983
x: 431263.80967743817
y: 4434244.0123674721
theta: -1.1572821604655021
kappa: -0.015020311825050972
s: 4.994586285969
dkappa: 0
ddkappa: 0
}
v: 0.07011954678168747
a: -0.0069648934766648393
v: 0.06680129991287867
a: -0.0076669264494414885
relative_time: 7.5499999999999812
}
trajectory_point {
path_point {
x: 431263.82559755951
y: 4434243.9753402025
theta: -1.1578904432877022
kappa: -0.015021565069012885
s: 5.0348909873943759
x: 431263.81099311443
y: 4434244.0093074506
theta: -1.1573324301870216
kappa: -0.015020415396081377
s: 4.9979171613481475
dkappa: 0
ddkappa: 0
}
v: 0.069795020367543967
a: -0.0060231572224606136
v: 0.066441541956781938
a: -0.0067276984490500791
relative_time: 7.599999999999981
}
trajectory_point {
path_point {
x: 431263.82697316667
y: 4434243.9721407928
theta: -1.1579430033196576
kappa: -0.015021673357846611
s: 5.03837358874233
x: 431263.81230214512
y: 4434244.0062628863
theta: -1.1573824460297444
kappa: -0.015020518443967333
s: 5.0012312122450266
dkappa: 0
ddkappa: 0
}
v: 0.069516531646102914
a: -0.0051233857685667739
v: 0.066128111176354948
a: -0.0058136039457824876
relative_time: 7.6499999999999808
}
trajectory_point {
path_point {
x: 431263.82834371115
y: 4434243.96895316
theta: -1.1579953699492995
kappa: -0.015021781248139056
s: 5.0418433728831973
x: 431263.81360543316
y: 4434244.0032316791
theta: -1.1574322424862531
kappa: -0.015020621039775674
s: 5.0045307241902419
dkappa: 0
ddkappa: 0
}
v: 0.069281982377348783
a: -0.004265579114983313
v: 0.065859786218271932
a: -0.004923230078419924
relative_time: 7.6999999999999806
}
trajectory_point {
path_point {
x: 431263.82971004
y: 4434243.9657753306
theta: -1.15804757554141
kappa: -0.015021888806572327
s: 5.04530248433361
x: 431263.81490385759
y: 4434244.0002117837
theta: -1.1574818531542568
kappa: -0.015020723252729289
s: 5.0078179234128086
dkappa: 0
ddkappa: 0
}
v: 0.069089274321266075
a: -0.0034497372617102381
v: 0.065635416372268177
a: -0.0040551639857436539
relative_time: 7.7499999999999805
}
trajectory_point {
path_point {
x: 431263.83107295877
y: 4434243.9626054335
theta: -1.1580996508775139
kappa: -0.015021996096566379
s: 5.0487529626982015
x: 431263.81619827595
y: 4434243.9972012052
theta: -1.1575313107898901
kappa: -0.015020825150316967
s: 5.0110949803723042
dkappa: 0
ddkappa: 0
}
v: 0.068936309237839249
a: -0.0026758602087475561
v: 0.0654539215711398
a: -0.003207992806534922
relative_time: 7.79999999999998
}
trajectory_point {
path_point {
x: 431263.8324332317
y: 4434243.9594416888
theta: -1.1581516251558712
kappa: -0.015022103178279
s: 5.0521967426696044
x: 431263.81748952478
y: 4434243.9941979982
theta: -1.1575806473610177
kappa: -0.015020926798403214
s: 5.0143640132910221
dkappa: 0
ddkappa: 0
}
v: 0.0688209888870528
a: -0.001943947956095253
v: 0.06531429239074385
a: -0.002380303679574973
relative_time: 7.84999999999998
}
trajectory_point {
path_point {
x: 431263.83379158156
y: 4434243.9562824173
theta: -1.1582035259914703
kappa: -0.015022210108605825
s: 5.0556356540284506
x: 431263.81877842167
y: 4434243.9912002608
theta: -1.1576298941005347
kappa: -0.015021028261338089
s: 5.0176270916861263
dkappa: 0
ddkappa: 0
}
v: 0.068741215028891217
a: -0.0012540005037533358
v: 0.065215590049998468
a: -0.0015706837436450585
relative_time: 7.89999999999998
}
trajectory_point {
path_point {
x: 431263.83514868969
y: 4434243.9531260338
theta: -1.1582553794160191
kappa: -0.015022316941180332
s: 5.05907142164337
x: 431263.82006576611
y: 4434243.9882061351
theta: -1.1576790815596714
kappa: -0.015021129602067031
s: 5.0208862399018033
dkappa: 0
ddkappa: 0
}
v: 0.068694889423338956
a: -0.0006060178517218115
v: 0.065156946410882516
a: -0.00077772013752641644
relative_time: 7.94999999999998
}
trajectory_point {
path_point {
x: 431263.83650519594
y: 4434243.94997105
theta: -1.1583072098779397
kappa: -0.015022423726373833
s: 5.0625056654709946
x: 431263.82135234139
y: 4434243.9852137985
theta: -1.1577282396612962
kappa: -0.015021230882240692
s: 5.0241434406414127
dkappa: 0
ddkappa: 0
}
v: 0.068679913830380523
a: -6.7307270867900115e-16
v: 0.065137563978435925
a: -3.1918911957973251e-16
relative_time: 7.99999999999998
}
decision {
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册