Skip to content

Commit ffd9f60

Browse files
tkimura4boyali
authored andcommitted
fix: stop for wrong-way car (tier4#1309)
Signed-off-by: tomoya.kimura <tomoya.kimura@tier4.jp>
1 parent 1764633 commit ffd9f60

File tree

1 file changed

+2
-2
lines changed
  • planning/obstacle_cruise_planner/src

1 file changed

+2
-2
lines changed

planning/obstacle_cruise_planner/src/node.cpp

+2-2
Original file line numberDiff line numberDiff line change
@@ -803,12 +803,12 @@ void ObstacleCruisePlannerNode::updateHasStopped(std::vector<TargetObstacle> & t
803803
});
804804
const bool has_already_stopped = (itr != prev_target_obstacles_.end()) && itr->has_stopped;
805805
if (has_already_stopped) {
806-
if (std::abs(obstacle.velocity) < obstacle_velocity_threshold_from_stop_to_cruise_) {
806+
if (obstacle.velocity < obstacle_velocity_threshold_from_stop_to_cruise_) {
807807
obstacle.has_stopped = true;
808808
continue;
809809
}
810810
} else {
811-
if (std::abs(obstacle.velocity) < obstacle_velocity_threshold_from_cruise_to_stop_) {
811+
if (obstacle.velocity < obstacle_velocity_threshold_from_cruise_to_stop_) {
812812
obstacle.has_stopped = true;
813813
continue;
814814
}

0 commit comments

Comments
 (0)