lane change not cancel bug

Signed-off-by: Zulfaqar Azmi <zulfaqar.azmi@tier4.jp>

Author: zulfaqar-azmi-t4

planning/behavior_path_lane_change_module/src/scene.cpp

@@ -1210,7 +1210,7 @@ FilteredByLanesObjects NormalLaneChange::filterObjectsByLanelets(
     };
 
     if (
-      check_optional_polygon(object, lanes_polygon.target) && is_lateral_far &&
+      check_optional_polygon(object, lanes_polygon.expanded_target) && is_lateral_far &&
       is_before_terminal()) {
       const auto ahead_of_ego =
         utils::lane_change::is_ahead_of_ego(common_data_ptr_, current_lanes_ref_path, object);

planning/behavior_path_lane_change_module/src/utils/utils.cpp

@@ -38,7 +38,6 @@
 #include <geometry_msgs/msg/detail/pose__struct.hpp>
 
 #include <boost/geometry/algorithms/detail/disjoint/interface.hpp>
-#include <boost/geometry/algorithms/difference.hpp>
 
 #include <lanelet2_core/LaneletMap.h>
 #include <lanelet2_core/geometry/LineString.h>
@@ -1212,18 +1211,11 @@ LanesPolygon create_lanes_polygon(const CommonDataPtr & common_data_ptr)
   const auto expanded_target_lanes = utils::lane_change::generateExpandedLanelets(
     lanes->target, common_data_ptr->direction, lc_param_ptr->lane_expansion_left_offset,
     lc_param_ptr->lane_expansion_right_offset);
-
-  const auto expanded_target_polygon = utils::lane_change::createPolygon(
+  lanes_polygon.expanded_target = utils::lane_change::createPolygon(
     expanded_target_lanes, 0.0, std::numeric_limits<double>::max());
 
   lanes_polygon.target_neighbor = *utils::lane_change::createPolygon(
     lanes->target_neighbor, 0.0, std::numeric_limits<double>::max());
-  std::vector<lanelet::BasicPolygon2d> difference;
-  boost::geometry::difference(*expanded_target_polygon, *lanes_polygon.target, difference);
-
-  if (!difference.empty()) {
-    lanes_polygon.expanded_target = std::make_optional<lanelet::BasicPolygon2d>(difference.front());
-  }
 
   lanes_polygon.preceding_target.reserve(lanes->preceding_target.size());
   for (const auto & preceding_lane : lanes->preceding_target) {