fix(behavior_velocity): clear values before adding partition (autowar…

…efoundation#590) Signed-off-by: tanaka3 <ttatcoder@outlook.jp>
TomohitoAndo · May 16, 2022 · 9a8fcd1 · 9a8fcd1
1 parent ad00b4e
commit 9a8fcd1
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);