@@ -1005,22 +1005,21 @@ void NormalLaneChange::filterObjectsByLanelets(
1005
1005
1006
1006
// get backward lanes
1007
1007
const auto backward_length = lane_change_parameters_->backward_lane_length ;
1008
- const auto target_backward_lanes =
1009
- [&]() -> std::vector<lanelet::ConstLanelets> {
1010
- if (target_lanes.empty ()) {
1011
- return {};
1012
- }
1008
+ const auto target_backward_lanes = [&]() -> std::vector<lanelet::ConstLanelets> {
1009
+ if (target_lanes.empty ()) {
1010
+ return {};
1011
+ }
1013
1012
1014
- const auto arc_length = lanelet::utils::getArcCoordinates (target_lanes, current_pose);
1013
+ const auto arc_length = lanelet::utils::getArcCoordinates (target_lanes, current_pose);
1015
1014
1016
- if (arc_length.length >= backward_length) {
1017
- return {};
1018
- }
1015
+ if (arc_length.length >= backward_length) {
1016
+ return {};
1017
+ }
1019
1018
1020
- const auto & front_lane = target_lanes.front ();
1021
- return route_handler->getPrecedingLaneletSequence (
1022
- front_lane, std::abs (backward_length - arc_length.length ), {front_lane});
1023
- }();
1019
+ const auto & front_lane = target_lanes.front ();
1020
+ return route_handler->getPrecedingLaneletSequence (
1021
+ front_lane, std::abs (backward_length - arc_length.length ), {front_lane});
1022
+ }();
1024
1023
1025
1024
{
1026
1025
lane_change_debug_.current_lanes = current_lanes;
@@ -1039,7 +1038,7 @@ void NormalLaneChange::filterObjectsByLanelets(
1039
1038
1040
1039
for (const auto & lanes : target_backward_lanes) {
1041
1040
backward_lanes.insert (backward_lanes.end (), lanes.begin (), lanes.end ());
1042
- }
1041
+ }
1043
1042
1044
1043
lane_change_debug_.target_backward_lanes = backward_lanes;
1045
1044
}
0 commit comments