fix(predicted_path_checker): check if trajectory size (autowarefoundation#6730)

check trajectory size

Signed-off-by: beyza <bnk@leodrive.ai>
Co-authored-by: beyza <bnk@leodrive.ai>

Author: 2 people

control/predicted_path_checker/src/predicted_path_checker_node/predicted_path_checker_node.cpp

@@ -537,6 +537,10 @@ void PredictedPathCheckerNode::filterObstacles(
   const Pose & ego_pose, const TrajectoryPoints & traj, const double dist_threshold,
   const bool use_prediction, PredictedObjects & filtered_objects)
 {
+  if (traj.size() < 2) {
+    RCLCPP_ERROR(rclcpp::get_logger("predicted_path_checker"), "Trajectory size is less than 2.");
+    return;
+  }
   filtered_objects.header.frame_id = object_ptr_.get()->header.frame_id;
   filtered_objects.header.stamp = this->now();