Skip to content

Commit

Permalink
refactor(static_avoidance): modify getAdjacentLane function (#7843)
Browse files Browse the repository at this point in the history
add getLeftOppositeLanelers in getAdjacentLane function

Signed-off-by: Go Sakayori <gsakayori@gmail.com>
  • Loading branch information
go-sakayori authored Jul 4, 2024
1 parent f29d560 commit 0176961
Showing 1 changed file with 11 additions and 0 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -1993,6 +1993,17 @@ lanelet::ConstLanelets getAdjacentLane(
lanes.push_back(opt_right_lane.value());
}

const auto left_opposite_lanes = rh->getLeftOppositeLanelets(lane);
if (!is_right_shift && !left_opposite_lanes.empty()) {
lanes.push_back(left_opposite_lanes.front());

for (const auto & prev_lane : rh->getPreviousLanelets(left_opposite_lanes.front())) {
if (!exist(prev_lane.id())) {
lanes.push_back(prev_lane);
}
}
}

const auto right_opposite_lanes = rh->getRightOppositeLanelets(lane);
if (is_right_shift && !right_opposite_lanes.empty()) {
lanes.push_back(right_opposite_lanes.front());
Expand Down

0 comments on commit 0176961

Please sign in to comment.