File tree 1 file changed +6
-0
lines changed
planning/behavior_velocity_dynamic_obstacle_stop_module/src
1 file changed +6
-0
lines changed Original file line number Diff line number Diff line change @@ -56,6 +56,12 @@ std::vector<autoware_auto_perception_msgs::msg::PredictedObject> filter_predicte
56
56
const auto obj_arc_length = motion_utils::calcSignedArcLength (
57
57
ego_data.path .points , ego_data.pose .position ,
58
58
o.kinematics .initial_pose_with_covariance .pose .position );
59
+ if (!params.ignore_objects_behind_ego ){
60
+ return (obj_arc_length < 0.0 &&
61
+ std::abs (obj_arc_length) < params.behind_object_distance_threshold + o.shape .dimensions .x / 2.0 ) ||
62
+ obj_arc_length > ego_data.longitudinal_offset_to_first_path_idx +
63
+ params.ego_longitudinal_offset + o.shape .dimensions .x / 2.0 ;
64
+ }
59
65
return obj_arc_length > ego_data.longitudinal_offset_to_first_path_idx +
60
66
params.ego_longitudinal_offset + o.shape .dimensions .x / 2.0 ;
61
67
};
You can’t perform that action at this time.
0 commit comments