|
|
@ -83,7 +83,7 @@ class LateralPlanner(): |
|
|
|
self.path_xyz = np.column_stack([md.position.x, md.position.y, md.position.z]) |
|
|
|
self.path_xyz = np.column_stack([md.position.x, md.position.y, md.position.z]) |
|
|
|
self.t_idxs = np.array(md.position.t) |
|
|
|
self.t_idxs = np.array(md.position.t) |
|
|
|
self.plan_yaw = list(md.orientation.z) |
|
|
|
self.plan_yaw = list(md.orientation.z) |
|
|
|
if len(md.orientation.xStd) == TRAJECTORY_SIZE: |
|
|
|
if len(md.position.xStd) == TRAJECTORY_SIZE: |
|
|
|
self.path_xyz_stds = np.column_stack([md.position.xStd, md.position.yStd, md.position.zStd]) |
|
|
|
self.path_xyz_stds = np.column_stack([md.position.xStd, md.position.yStd, md.position.zStd]) |
|
|
|
|
|
|
|
|
|
|
|
# Lane change logic |
|
|
|
# Lane change logic |
|
|
|