Skip to content

Commit e594514

Browse files
fix(start_planner): issue when ego does not straddle lane bounds and starts from 0 speed (autowarefoundation#7004)
* fix issue when ego does not straddle lane bounds and starts from 0 speed Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com> * add new status for ego departed Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com> --------- Signed-off-by: Daniel Sanchez <danielsanchezaran@gmail.com>
1 parent cca5923 commit e594514

File tree

1 file changed

+4
-1
lines changed

1 file changed

+4
-1
lines changed

planning/behavior_path_planner_common/src/turn_signal_decider.cpp

+4-1
Original file line numberDiff line numberDiff line change
@@ -731,10 +731,13 @@ std::pair<TurnSignalInfo, bool> TurnSignalDecider::getBehaviorTurnSignalInfo(
731731
return std::make_pair(TurnSignalInfo{}, true);
732732
}
733733

734-
if (!straddleRoadBound(path, shift_line, current_lanelets, p.vehicle_info)) {
734+
// Check if the ego will cross lane bounds.
735+
// Note that pull out requires blinkers, even if the ego does not cross lane bounds
736+
if (!is_pull_out && !straddleRoadBound(path, shift_line, current_lanelets, p.vehicle_info)) {
735737
return std::make_pair(TurnSignalInfo{}, true);
736738
}
737739

740+
// If the ego has stopped and its close to completing its shift, turn off the blinkers
738741
constexpr double STOPPED_THRESHOLD = 0.1; // [m/s]
739742
if (ego_speed < STOPPED_THRESHOLD && !override_ego_stopped_check) {
740743
if (isNearEndOfShift(

0 commit comments

Comments
 (0)