We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
1 parent 1aa5bb9 commit b5b37c7Copy full SHA for b5b37c7
control/predicted_path_checker/src/predicted_path_checker_node/predicted_path_checker_node.cpp
@@ -549,6 +549,9 @@ void PredictedPathCheckerNode::filterObstacles(
549
550
// Check is it near to trajectory
551
const double max_length = utils::calcObstacleMaxLength(object.shape);
552
+ if (traj.size() < 2){
553
+ continue;
554
+ }
555
const size_t seg_idx = motion_utils::findNearestSegmentIndex(
556
traj, object.kinematics.initial_pose_with_covariance.pose.position);
557
const auto p_front = tier4_autoware_utils::getPoint(traj.at(seg_idx));
0 commit comments