Skip to content

Commit

Permalink
fix(static_obstacle_avoidance): ego doesn't keep stopping in unsafe c…
Browse files Browse the repository at this point in the history
…ondition (autowarefoundation#10242)

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
  • Loading branch information
satoshi-ota authored and kotaro-hihara committed Mar 7, 2025
1 parent 53dd65b commit f8e0c4b
Showing 1 changed file with 2 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -1679,7 +1679,7 @@ void StaticObstacleAvoidanceModule::insertReturnDeadLine(
const auto min_return_distance =
helper_->getMinAvoidanceDistance(shift_length) + helper_->getNominalPrepareDistance(0.0);
const auto to_stop_line = data.to_return_point - min_return_distance - buffer;
if (to_stop_line < 0.0) {
if (to_stop_line < -1.0 * parameters_->stop_buffer) {
RCLCPP_WARN(getLogger(), "ego overran return shift dead line. do nothing.");
return;
}
Expand Down Expand Up @@ -1752,7 +1752,7 @@ void StaticObstacleAvoidanceModule::insertWaitPoint(
return;
}

if (data.to_stop_line < 0.0) {
if (data.to_stop_line < -1.0 * parameters_->stop_buffer) {
RCLCPP_WARN(getLogger(), "ego overran avoidance dead line. do nothing.");
return;
}
Expand Down

0 comments on commit f8e0c4b

Please sign in to comment.