Skip to content

Commit 50612a6

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

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
@@ -460,13 +460,6 @@ std::vector<geometry_msgs::msg::Point> crop_line_string(
460460
const std::vector<geometry_msgs::msg::Point> & line_string, const double s_start,
461461
const double s_end)
462462
{
463-
if (line_string.size() < 2) {
464-
RCLCPP_WARN(
465-
rclcpp::get_logger("path_generator").get_child("utils").get_child(__func__),
466-
"Input line string has less than 2 points, returning input as is");
467-
return line_string;
468-
}
469-
470463
if (s_start < 0.) {
471464
RCLCPP_WARN(
472465
rclcpp::get_logger("path_generator").get_child("utils").get_child(__func__),
@@ -484,6 +477,10 @@ std::vector<geometry_msgs::msg::Point> crop_line_string(
484477
auto trajectory = autoware::trajectory::Trajectory<geometry_msgs::msg::Point>::Builder()
485478
.set_xy_interpolator<trajectory::interpolator::Linear>()
486479
.build(line_string);
480+
if (!trajectory) {
481+
return {};
482+
}
483+
487484
trajectory->crop(s_start, s_end - s_start);
488485
return trajectory->restore();
489486
}

0 commit comments

Comments
 (0)