diff --git a/nav2_waypoint_follower/src/waypoint_follower.cpp b/nav2_waypoint_follower/src/waypoint_follower.cpp index ab121b52878..3230c6a7707 100644 --- a/nav2_waypoint_follower/src/waypoint_follower.cpp +++ b/nav2_waypoint_follower/src/waypoint_follower.cpp @@ -127,6 +127,11 @@ WaypointFollower::followWaypoints() get_logger(), "Received follow waypoint request with %i waypoints.", static_cast(goal->poses.size())); + if (goal->poses.size() == 0) { + action_server_->succeeded_current(result); + return; + } + rclcpp::Rate r(loop_rate_); uint32_t goal_index = 0; bool new_goal = true;