提交 e43fafb0 编写于 作者: H Hongyi 提交者: Qi Luo

Planning: fix integration test

上级 4ed0779b
...@@ -13,8 +13,8 @@ trajectory_point { ...@@ -13,8 +13,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -28,8 +28,8 @@ trajectory_point { ...@@ -28,8 +28,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -43,8 +43,8 @@ trajectory_point { ...@@ -43,8 +43,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -58,8 +58,8 @@ trajectory_point { ...@@ -58,8 +58,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -73,8 +73,8 @@ trajectory_point { ...@@ -73,8 +73,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -88,8 +88,8 @@ trajectory_point { ...@@ -88,8 +88,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -103,8 +103,8 @@ trajectory_point { ...@@ -103,8 +103,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -118,8 +118,8 @@ trajectory_point { ...@@ -118,8 +118,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -133,8 +133,8 @@ trajectory_point { ...@@ -133,8 +133,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -148,8 +148,8 @@ trajectory_point { ...@@ -148,8 +148,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -163,8 +163,8 @@ trajectory_point { ...@@ -163,8 +163,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -178,8 +178,8 @@ trajectory_point { ...@@ -178,8 +178,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -193,8 +193,8 @@ trajectory_point { ...@@ -193,8 +193,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -208,8 +208,8 @@ trajectory_point { ...@@ -208,8 +208,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -223,8 +223,8 @@ trajectory_point { ...@@ -223,8 +223,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -238,8 +238,8 @@ trajectory_point { ...@@ -238,8 +238,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -253,8 +253,8 @@ trajectory_point { ...@@ -253,8 +253,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -268,8 +268,8 @@ trajectory_point { ...@@ -268,8 +268,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -283,8 +283,8 @@ trajectory_point { ...@@ -283,8 +283,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -298,8 +298,8 @@ trajectory_point { ...@@ -298,8 +298,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -313,8 +313,8 @@ trajectory_point { ...@@ -313,8 +313,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -328,8 +328,8 @@ trajectory_point { ...@@ -328,8 +328,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -343,8 +343,8 @@ trajectory_point { ...@@ -343,8 +343,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -358,8 +358,8 @@ trajectory_point { ...@@ -358,8 +358,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -373,8 +373,8 @@ trajectory_point { ...@@ -373,8 +373,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -388,8 +388,8 @@ trajectory_point { ...@@ -388,8 +388,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -403,8 +403,8 @@ trajectory_point { ...@@ -403,8 +403,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -418,8 +418,8 @@ trajectory_point { ...@@ -418,8 +418,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -433,8 +433,8 @@ trajectory_point { ...@@ -433,8 +433,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -448,8 +448,8 @@ trajectory_point { ...@@ -448,8 +448,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -463,8 +463,8 @@ trajectory_point { ...@@ -463,8 +463,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -478,8 +478,8 @@ trajectory_point { ...@@ -478,8 +478,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -493,8 +493,8 @@ trajectory_point { ...@@ -493,8 +493,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -508,8 +508,8 @@ trajectory_point { ...@@ -508,8 +508,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -523,8 +523,8 @@ trajectory_point { ...@@ -523,8 +523,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -538,8 +538,8 @@ trajectory_point { ...@@ -538,8 +538,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -553,8 +553,8 @@ trajectory_point { ...@@ -553,8 +553,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -568,8 +568,8 @@ trajectory_point { ...@@ -568,8 +568,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -583,8 +583,8 @@ trajectory_point { ...@@ -583,8 +583,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -598,8 +598,8 @@ trajectory_point { ...@@ -598,8 +598,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -613,8 +613,8 @@ trajectory_point { ...@@ -613,8 +613,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -628,8 +628,8 @@ trajectory_point { ...@@ -628,8 +628,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -643,8 +643,8 @@ trajectory_point { ...@@ -643,8 +643,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -658,8 +658,8 @@ trajectory_point { ...@@ -658,8 +658,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -673,8 +673,8 @@ trajectory_point { ...@@ -673,8 +673,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -688,8 +688,8 @@ trajectory_point { ...@@ -688,8 +688,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -703,8 +703,8 @@ trajectory_point { ...@@ -703,8 +703,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -718,8 +718,8 @@ trajectory_point { ...@@ -718,8 +718,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -733,8 +733,8 @@ trajectory_point { ...@@ -733,8 +733,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -748,8 +748,8 @@ trajectory_point { ...@@ -748,8 +748,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -763,8 +763,8 @@ trajectory_point { ...@@ -763,8 +763,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -778,8 +778,8 @@ trajectory_point { ...@@ -778,8 +778,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -793,8 +793,8 @@ trajectory_point { ...@@ -793,8 +793,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -808,8 +808,8 @@ trajectory_point { ...@@ -808,8 +808,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -823,8 +823,8 @@ trajectory_point { ...@@ -823,8 +823,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -838,8 +838,8 @@ trajectory_point { ...@@ -838,8 +838,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -853,8 +853,8 @@ trajectory_point { ...@@ -853,8 +853,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -868,8 +868,8 @@ trajectory_point { ...@@ -868,8 +868,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -883,8 +883,8 @@ trajectory_point { ...@@ -883,8 +883,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -898,8 +898,8 @@ trajectory_point { ...@@ -898,8 +898,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -913,8 +913,8 @@ trajectory_point { ...@@ -913,8 +913,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -928,8 +928,8 @@ trajectory_point { ...@@ -928,8 +928,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -943,8 +943,8 @@ trajectory_point { ...@@ -943,8 +943,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -958,8 +958,8 @@ trajectory_point { ...@@ -958,8 +958,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -973,8 +973,8 @@ trajectory_point { ...@@ -973,8 +973,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -988,8 +988,8 @@ trajectory_point { ...@@ -988,8 +988,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -1003,8 +1003,8 @@ trajectory_point { ...@@ -1003,8 +1003,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -1018,8 +1018,8 @@ trajectory_point { ...@@ -1018,8 +1018,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -1033,8 +1033,8 @@ trajectory_point { ...@@ -1033,8 +1033,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -1048,8 +1048,8 @@ trajectory_point { ...@@ -1048,8 +1048,8 @@ trajectory_point {
x: 586354.03050066391 x: 586354.03050066391
y: 4140735.5238598073 y: 4140735.5238598073
z: 0 z: 0
theta: 1.3120887936079759 theta: 1.3120887936392123
kappa: 9.1876173836100386e-16 kappa: 4.5203407479910366e-15
s: 0 s: 0
dkappa: 0 dkappa: 0
ddkappa: 0 ddkappa: 0
...@@ -1061,13 +1061,13 @@ trajectory_point { ...@@ -1061,13 +1061,13 @@ trajectory_point {
decision { decision {
main_decision { main_decision {
stop { stop {
reason_code: STOP_REASON_HEAD_VEHICLE reason_code: STOP_REASON_STOP_SIGN
reason: "stop by 2352_0" reason: "stop by SS_2"
stop_point { stop_point {
x: 586353.37680918071 x: 586367.08466100844
y: 4140733.21346399 y: 4140784.0102793546
} }
stop_heading: 1.3219597809209793 stop_heading: 1.2863090794017198
change_lane_type: FORWARD change_lane_type: FORWARD
} }
} }
...@@ -1076,14 +1076,14 @@ decision { ...@@ -1076,14 +1076,14 @@ decision {
id: "2352_0" id: "2352_0"
perception_id: 2352 perception_id: 2352
object_decision { object_decision {
stop { follow {
distance_s: -6 distance_s: -3
stop_point { fence_point {
x: 586353.37680918071 x: 586354.41084815562
y: 4140733.21346399 y: 4140737.2841842384
z: 0 z: 0
} }
stop_heading: 1.3219597809209793 fence_heading: 1.3218977986964826
} }
} }
} }
......
...@@ -27,11 +27,11 @@ decision { ...@@ -27,11 +27,11 @@ decision {
follow { follow {
distance_s: -3 distance_s: -3
fence_point { fence_point {
x: 586260.233675317 x: 586260.58647816256
y: 4141284.4917570944 y: 4141283.163007583
z: 0 z: 0
} }
fence_heading: -1.3577543487779731 fence_heading: -1.2899817911884237
} }
} }
} }
...@@ -42,11 +42,11 @@ decision { ...@@ -42,11 +42,11 @@ decision {
follow { follow {
distance_s: -3 distance_s: -3
fence_point { fence_point {
x: 586260.20623721776 x: 586260.5296822344
y: 4141284.6137085222 y: 4141283.3547710115
z: 0 z: 0
} }
fence_heading: -1.3577543487779731 fence_heading: -1.307273239870101
} }
} }
} }
......
...@@ -27,11 +27,11 @@ decision { ...@@ -27,11 +27,11 @@ decision {
follow { follow {
distance_s: -3 distance_s: -3
fence_point { fence_point {
x: 586260.233675317 x: 586260.58647816256
y: 4141284.4917570944 y: 4141283.163007583
z: 0 z: 0
} }
fence_heading: -1.3577543487779731 fence_heading: -1.2899817911884237
} }
} }
} }
...@@ -42,11 +42,11 @@ decision { ...@@ -42,11 +42,11 @@ decision {
follow { follow {
distance_s: -3 distance_s: -3
fence_point { fence_point {
x: 586260.20623721776 x: 586260.5296822344
y: 4141284.6137085222 y: 4141283.3547710115
z: 0 z: 0
} }
fence_heading: -1.3577543487779731 fence_heading: -1.307273239870101
} }
} }
} }
......
...@@ -20,11 +20,11 @@ decision { ...@@ -20,11 +20,11 @@ decision {
follow { follow {
distance_s: -5.08480716496706 distance_s: -5.08480716496706
fence_point { fence_point {
x: 586426.57010789728 x: 586426.79565415136
y: 4140685.9955443493 y: 4140686.9697767082
z: 0 z: 0
} }
fence_heading: 1.3422560695149219 fence_heading: 1.3435817605884139
} }
} }
} }
......
...@@ -20,11 +20,11 @@ decision { ...@@ -20,11 +20,11 @@ decision {
follow { follow {
distance_s: -3 distance_s: -3
fence_point { fence_point {
x: 586436.26475142757 x: 586436.73277672951
y: 4140725.6605456178 y: 4140727.4729266441
z: 0 z: 0
} }
fence_heading: 1.3183887244443382 fence_heading: 1.3179028672254074
} }
} }
} }
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册