fix(behavior_velocity): fix segfo at for unstable clock (#1300)

Signed-off-by: tanaka3 <[email protected]>
tier4 · Jul 11, 2022 · 18d21ab · 18d21ab
1 parent 0823848
commit 18d21ab
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/planning/behavior_velocity_planner/src/node.cpp b/planning/behavior_velocity_planner/src/node.cpp
@@ -301,6 +301,9 @@ void BehaviorVelocityPlannerNode::onVehicleVelocity(
       break;
     }
 
+    if (planner_data_.velocity_buffer.empty()) {
+      break;
+    }
     // Remove old data
     planner_data_.velocity_buffer.pop_back();
   }