Skip to content

Commit be8521d

Browse files
committed
fix(avoidance): fix bug in turn signal decision
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
1 parent 1c4c3e3 commit be8521d

File tree

1 file changed

+9
-5
lines changed
  • planning/behavior_path_avoidance_module/src

1 file changed

+9
-5
lines changed

planning/behavior_path_avoidance_module/src/utils.cpp

+9-5
Original file line numberDiff line numberDiff line change
@@ -2278,11 +2278,15 @@ TurnSignalInfo calcTurnSignalInfo(
22782278
return {};
22792279
}
22802280

2281-
const auto left_lane = rh->getLeftLanelet(lanelet, true, true);
2282-
const auto right_lane = rh->getRightLanelet(lanelet, true, true);
2283-
2284-
if (!existShiftSideLane(
2285-
start_shift_length, end_shift_length, !left_lane.has_value(), !right_lane.has_value())) {
2281+
const auto left_same_direction_lane = rh->getLeftLanelet(lanelet, true, true);
2282+
const auto left_opposite_lanes = rh->getLeftOppositeLanelets(lanelet);
2283+
const auto right_same_direction_lane = rh->getRightLanelet(lanelet, true, true);
2284+
const auto right_opposite_lanes = rh->getRightOppositeLanelets(lanelet);
2285+
const auto has_left_lane = left_same_direction_lane.has_value() || !left_opposite_lanes.empty();
2286+
const auto has_right_lane =
2287+
right_same_direction_lane.has_value() || !right_opposite_lanes.empty();
2288+
2289+
if (!existShiftSideLane(start_shift_length, end_shift_length, !has_left_lane, !has_right_lane)) {
22862290
return {};
22872291
}
22882292

0 commit comments

Comments
 (0)