diff --git a/planning/autoware_obstacle_cruise_planner/src/node.cpp b/planning/autoware_obstacle_cruise_planner/src/node.cpp index 038c892bcb072..b4cc7a22b7902 100644 --- a/planning/autoware_obstacle_cruise_planner/src/node.cpp +++ b/planning/autoware_obstacle_cruise_planner/src/node.cpp @@ -1878,7 +1878,7 @@ double ObstacleCruisePlannerNode::calcCollisionTimeMargin( const double time_to_start_cross = (rclcpp::Time(collision_points.front().stamp) - now()).seconds(); const double time_to_end_cross = (rclcpp::Time(collision_points.back().stamp) - now()).seconds(); - + if (time_to_reach_collision_point < time_to_start_cross) { // Ego goes first. return time_to_start_cross - time_to_reach_collision_point; }