Skip to content

Commit 2a1a3ec

Browse files
authored
fix(dynamic_avoidance): not avoid objects on ego's path (#4407)
Signed-off-by: Takayuki Murooka <takayuki5168@gmail.com>
1 parent 13b96ad commit 2a1a3ec

File tree

1 file changed

+4
-1
lines changed

1 file changed

+4
-1
lines changed

planning/behavior_path_planner/src/scene_module/dynamic_avoidance/dynamic_avoidance_module.cpp

+4-1
Original file line numberDiff line numberDiff line change
@@ -372,7 +372,10 @@ DynamicAvoidanceModule::calcTargetObjectsCandidate()
372372
const bool is_object_on_ego_path =
373373
obj_dist_to_path <
374374
planner_data_->parameters.vehicle_width / 2.0 + parameters_->min_obj_lat_offset_to_ego_path;
375-
if (is_object_on_ego_path && std::abs(obj_angle) < parameters_->max_front_object_angle) {
375+
const bool is_object_aligned_to_path =
376+
std::abs(obj_angle) < parameters_->max_front_object_angle ||
377+
M_PI - parameters_->max_front_object_angle < std::abs(obj_angle);
378+
if (is_object_on_ego_path && is_object_aligned_to_path) {
376379
continue;
377380
}
378381

0 commit comments

Comments
 (0)