Skip to content

Commit

Permalink
fix(lane_change): skip safety check for stopping vehicles (#4733)
Browse files Browse the repository at this point in the history
Signed-off-by: Fumiya Watanabe <[email protected]>
  • Loading branch information
rej55 authored Aug 24, 2023
1 parent 1e68b91 commit 2624ad0
Showing 1 changed file with 2 additions and 7 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -645,10 +645,6 @@ LaneChangeTargetObjectIndices NormalLaneChange::filterObject(
const auto & route_handler = *getRouteHandler();
const auto & common_parameters = planner_data_->parameters;
const auto & objects = *planner_data_->dynamic_object;
const auto & object_check_min_road_shoulder_width =
lane_change_parameters_->object_check_min_road_shoulder_width;
const auto & object_shiftable_ratio_threshold =
lane_change_parameters_->object_shiftable_ratio_threshold;

// Guard
if (objects.objects.empty()) {
Expand Down Expand Up @@ -709,9 +705,8 @@ LaneChangeTargetObjectIndices NormalLaneChange::filterObject(
// check if the object intersects with target lanes
if (target_polygon && boost::geometry::intersects(target_polygon.value(), obj_polygon)) {
// ignore static parked object that are in front of the ego vehicle in target lanes
bool is_parked_object = utils::lane_change::isParkedObject(
target_path, route_handler, extended_object, object_check_min_road_shoulder_width,
object_shiftable_ratio_threshold);
bool is_parked_object =
utils::lane_change::isParkedObject(target_path, route_handler, extended_object, 0.0, 0.0);
if (is_parked_object && min_dist_ego_to_obj > min_dist_to_lane_changing_start) {
continue;
}
Expand Down

0 comments on commit 2624ad0

Please sign in to comment.