Skip to content

Commit b586fd9

Browse files
mitukou1109kosuke55
authored andcommitted
check builder output instead of input size
Signed-off-by: mitukou1109 <mitukou1109@gmail.com>
1 parent 91e6781 commit b586fd9

File tree

1 file changed

+4
-7
lines changed
  • planning/autoware_path_generator/src

1 file changed

+4
-7
lines changed

planning/autoware_path_generator/src/utils.cpp

+4-7
Original file line numberDiff line numberDiff line change
@@ -429,13 +429,6 @@ std::vector<geometry_msgs::msg::Point> crop_line_string(
429429
const std::vector<geometry_msgs::msg::Point> & line_string, const double s_start,
430430
const double s_end)
431431
{
432-
if (line_string.size() < 2) {
433-
RCLCPP_WARN(
434-
rclcpp::get_logger("path_generator").get_child("utils").get_child(__func__),
435-
"Input line string has less than 2 points, returning input as is");
436-
return line_string;
437-
}
438-
439432
if (s_start < 0.) {
440433
RCLCPP_WARN(
441434
rclcpp::get_logger("path_generator").get_child("utils").get_child(__func__),
@@ -453,6 +446,10 @@ std::vector<geometry_msgs::msg::Point> crop_line_string(
453446
auto trajectory = autoware::trajectory::Trajectory<geometry_msgs::msg::Point>::Builder()
454447
.set_xy_interpolator<trajectory::interpolator::Linear>()
455448
.build(line_string);
449+
if (!trajectory) {
450+
return {};
451+
}
452+
456453
trajectory->crop(s_start, s_end - s_start);
457454
return trajectory->restore();
458455
}

0 commit comments

Comments
 (0)