fix: path distance calculator (#975)

Signed-off-by: tomoya.kimura <[email protected]>
tier4 · May 26, 2022 · b76b6e1 · b76b6e1
1 parent 1d5a7b3
commit b76b6e1
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/common/path_distance_calculator/src/path_distance_calculator.cpp b/common/path_distance_calculator/src/path_distance_calculator.cpp
@@ -47,6 +47,10 @@ PathDistanceCalculator::PathDistanceCalculator(const rclcpp::NodeOptions & optio
       RCLCPP_WARN_THROTTLE(get_logger(), *get_clock(), 5000, "path empty");
     }
 
+    if (path->points.size() == 1) {
+      RCLCPP_WARN_THROTTLE(get_logger(), *get_clock(), 5000, "too short path");
+    }
+
     const double distance = tier4_autoware_utils::calcSignedArcLength(
       path->points, pose->pose.position, path->points.size() - 1);