fix(behavior_velocity): clear values before adding partition (#590)

Signed-off-by: tanaka3 <ttatcoder@outlook.jp>
autowarefoundation · Mar 28, 2022 · 21a3037 · 21a3037
1 parent 35fd3e3
commit 21a3037
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/planning/behavior_velocity_planner/src/utilization/util.cpp b/planning/behavior_velocity_planner/src/utilization/util.cpp
@@ -146,6 +146,7 @@ void extractClosePartition(
   const geometry_msgs::msg::Point position, const BasicPolygons2d & all_partitions,
   BasicPolygons2d & close_partition, const double distance_thresh)
 {
+  close_partition.clear();
   for (const auto & p : all_partitions) {
     if (boost::geometry::distance(Point2d(position.x, position.y), p) < distance_thresh) {
       close_partition.emplace_back(p);