plannerd: position std size check bug

4 years ago · 791de68689
parent c1c402a821
commit 791de68689
1 changed files with 1 additions and 1 deletions
--- a/selfdrive/controls/lib/lateral_planner.py
+++ b/selfdrive/controls/lib/lateral_planner.py
@ -83,7 +83,7 @@ class LateralPlanner():
      self.path_xyz = np.column_stack([md.position.x, md.position.y, md.position.z])
      self.t_idxs = np.array(md.position.t)
      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])

    # Lane change logic