fix(obstacle_avoidance_planner): fix lat_dist_to_front_bound comparis…

…on (autowarefoundation#2594) (#236)

fix(obstacle_avoidance_planner): fix lat_dist_to_front_bound comparison (autowarefoundation#2594)

* fix(obstacle_avoidance_planner): fix lat_dist_to_front_bound comparison

Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com>

* fix: update comment

Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com>

Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com>

Signed-off-by: Mehmet Dogru <42mehmetdogru42@gmail.com>
Co-authored-by: Mehmet Dogru <48479081+mehmetdogru@users.noreply.github.com>

planning/obstacle_avoidance_planner/src/utils/utils.cpp

@@ -641,10 +641,10 @@ bool isOutsideDrivableArea(
   const auto left_start_point = getStartPoint(left_bound, right_bound.front());
   const auto right_start_point = getStartPoint(right_bound, left_bound.front());
 
-  // ignore point in front of the front line
+  // ignore point behind of the front line
   const std::vector<geometry_msgs::msg::Point> front_bound = {left_start_point, right_start_point};
   const double lat_dist_to_front_bound = motion_utils::calcLateralOffset(front_bound, point);
-  if (lat_dist_to_front_bound > min_dist) {
+  if (lat_dist_to_front_bound < -min_dist) {
     return false;
   }