Skip to content

Commit

Permalink
fix(behavior_velocity_planner): fix safety status in intersection mod…
Browse files Browse the repository at this point in the history
…ule (tier4#1180)

Signed-off-by: Fumiya Watanabe <rej55.g@gmail.com>
  • Loading branch information
rej55 authored and boyali committed Sep 28, 2022
1 parent a95cb67 commit 225b619
Showing 1 changed file with 1 addition and 1 deletion.
Original file line number Diff line number Diff line change
Expand Up @@ -185,7 +185,7 @@ bool IntersectionModule::modifyPathVelocity(
const bool is_stop_required = is_stuck || !has_traffic_light_ || turn_direction_ != "straight";
const double base_link2front = planner_data_->vehicle_info_.max_longitudinal_offset_m;

setSafe(!(is_stop_required && is_entry_prohibited) || (state_machine_.getState() == State::GO));
setSafe(!(is_stop_required && is_entry_prohibited));
setDistance(tier4_autoware_utils::calcSignedArcLength(
input_path.points, planner_data_->current_pose.pose.position,
input_path.points.at(stop_line_idx).point.pose.position));
Expand Down

0 comments on commit 225b619

Please sign in to comment.