fix(obstacle_avoidance_planner): empty points handling (#1070)

Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
tier4 · Jun 10, 2022 · 7c1dfec · 7c1dfec
1 parent 700f072
commit 7c1dfec
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/planning/obstacle_avoidance_planner/src/node.cpp b/planning/obstacle_avoidance_planner/src/node.cpp
@@ -1105,6 +1105,10 @@ void ObstacleAvoidancePlanner::insertZeroVelocityOutsideDrivableArea(
   std::vector<autoware_auto_planning_msgs::msg::TrajectoryPoint> & traj_points,
   const CVMaps & cv_maps)
 {
+  if (traj_points.empty()) {
+    return;
+  }
+
   stop_watch_.tic(__func__);
 
   const auto & map_info = cv_maps.map_info;