@@ -333,10 +333,8 @@ bool DefaultPlanner::is_goal_valid(
333
333
334
334
lanelet::ConstLanelet goal_lanelet;
335
335
lanelet::ConstLanelets goal_lanelets;
336
- if (!lanelet::utils::query::getCurrentLanelets (
337
- road_lanelets_, goal, &goal_lanelets)) {
338
- if (!lanelet::utils::query::getClosestLanelet (
339
- road_lanelets_, goal, &goal_lanelet)) {
336
+ if (!lanelet::utils::query::getCurrentLanelets (road_lanelets_, goal, &goal_lanelets)) {
337
+ if (!lanelet::utils::query::getClosestLanelet (road_lanelets_, goal, &goal_lanelet)) {
340
338
}
341
339
goal_lanelets = {goal_lanelet};
342
340
}
@@ -356,7 +354,8 @@ bool DefaultPlanner::is_goal_valid(
356
354
for (const auto & gl_llt : goal_lanelets) {
357
355
if (
358
356
param_.check_footprint_inside_lanes &&
359
- !check_goal_footprint_inside_lanes (gl_llt, combined_prev_lanelet, polygon_footprint, next_lane_length) &&
357
+ !check_goal_footprint_inside_lanes (
358
+ gl_llt, combined_prev_lanelet, polygon_footprint, next_lane_length) &&
360
359
!is_in_parking_lot (
361
360
lanelet::utils::query::getAllParkingLots (lanelet_map_ptr_),
362
361
lanelet::utils::conversion::toLaneletPoint (goal.position ))) {
0 commit comments