Merge branch 'main' into feat/add-pose-interpolation

autowarefoundation · Jun 14, 2022 · f65af81 · f65af81
2 parents 830ef5a + 785c8d6
commit f65af81
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/planning/obstacle_cruise_planner/src/node.cpp b/planning/obstacle_cruise_planner/src/node.cpp
@@ -533,7 +533,9 @@ std::vector<TargetObstacle> ObstacleCruisePlannerNode::filterObstacles(
     const double dist_from_obstacle_to_traj = [&]() {
       return tier4_autoware_utils::calcLateralOffset(decimated_traj.points, object_pose.position);
     }();
-    if (dist_from_obstacle_to_traj > obstacle_filtering_param_.rough_detection_area_expand_width) {
+    if (
+      std::fabs(dist_from_obstacle_to_traj) >
+      obstacle_filtering_param_.rough_detection_area_expand_width) {
       RCLCPP_INFO_EXPRESSION(
         get_logger(), is_showing_debug_info_,
         "Ignore obstacles since it is far from the trajectory.");