Skip to content

Commit 7a9c4ad

Browse files
committed
skip pred paths with only 1 non-overlapping point to avoid error msgs
Signed-off-by: Maxime CLEMENT <maxime.clement@tier4.jp>
1 parent 9813c12 commit 7a9c4ad

File tree

1 file changed

+1
-0
lines changed

1 file changed

+1
-0
lines changed

planning/behavior_velocity_out_of_lane_module/src/decisions.cpp

+1
Original file line numberDiff line numberDiff line change
@@ -79,6 +79,7 @@ std::optional<std::pair<double, double>> object_time_to_range(
7979

8080
for (const auto & predicted_path : object.kinematics.predicted_paths) {
8181
const auto unique_path_points = motion_utils::removeOverlapPoints(predicted_path.path);
82+
if(unique_path_points.size() < 2) continue;
8283
const auto time_step = rclcpp::Duration(predicted_path.time_step).seconds();
8384
const auto enter_point =
8485
geometry_msgs::msg::Point().set__x(range.entering_point.x()).set__y(range.entering_point.y());

0 commit comments

Comments
 (0)