We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 13b96ad commit 2a1a3ecCopy full SHA for 2a1a3ec
planning/behavior_path_planner/src/scene_module/dynamic_avoidance/dynamic_avoidance_module.cpp
@@ -372,7 +372,10 @@ DynamicAvoidanceModule::calcTargetObjectsCandidate()
372
const bool is_object_on_ego_path =
373
obj_dist_to_path <
374
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) {
+ 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) {
379
continue;
380
}
381
0 commit comments