fix(avoidance): don't ignore objects on straight lane in intersection

planning/behavior_path_avoidance_module/src/utils.cpp

@@ -1,4 +1,4 @@
 // Copyright 2023 TIER IV, Inc.
 //
 // Licensed under the Apache License, Version 2.0 (the "License");
 // you may not use this file except in compliance with the License.
@@ -635,41 +635,39 @@
     return true;
   }
 
-  // always ignore all merging objects.
-  if (object.behavior == ObjectData::Behavior::MERGING) {
-    object.reason = "MergingToEgoLane";
-    return false;
-  }
-
-  // Object is on center line -> ignore.
-  if (std::abs(object.to_centerline) < parameters->threshold_distance_object_is_on_center) {
-    object.reason = AvoidanceDebugFactor::TOO_NEAR_TO_CENTERLINE;
-    return false;
-  }
-
+  // check vehicle shift ratio
   lanelet::BasicPoint2d object_centroid(object.centroid.x(), object.centroid.y());
   const auto on_ego_driving_lane =
     within(object_centroid, object.overhang_lanelet.polygon2d().basicPolygon());
   if (on_ego_driving_lane) {
     if (isObjectOnRoadShoulder(object, planner_data->route_handler, parameters)) {
       return true;
     } else {
       object.reason = AvoidanceDebugFactor::NOT_PARKING_OBJECT;
       return false;
     }
   }
 
-  if (!object.is_within_intersection) {
-    return true;
+  // Object is on center line -> ignore.
+  if (std::abs(object.to_centerline) < parameters->threshold_distance_object_is_on_center) {
+    object.reason = AvoidanceDebugFactor::TOO_NEAR_TO_CENTERLINE;
+    return false;
   }
 
-  std::string turn_direction = object.overhang_lanelet.attributeOr("turn_direction", "else");
-  if (turn_direction == "straight") {
-    return true;
+  if (object.is_within_intersection) {
+    std::string turn_direction = object.overhang_lanelet.attributeOr("turn_direction", "else");
+    if (turn_direction == "straight") {
+      return true;
+    }
+
+    if (object.behavior == ObjectData::Behavior::NONE) {
+      object.reason = "ParallelToEgoLane";
+      return false;
+    }
   }
 
-  if (object.behavior == ObjectData::Behavior::NONE) {
-    object.reason = "ParallelToEgoLane";
+  if (object.behavior == ObjectData::Behavior::MERGING) {
+    object.reason = "MergingToEgoLane";
     return false;
   }