From afeb26acd43ed542c65cfea7679db43612eeeeb7 Mon Sep 17 00:00:00 2001 From: redvinaa Date: Tue, 26 Sep 2023 16:10:49 +0200 Subject: [PATCH] Fix distance remaining crash --- nav2_bt_navigator/src/navigators/navigate_to_pose.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/nav2_bt_navigator/src/navigators/navigate_to_pose.cpp b/nav2_bt_navigator/src/navigators/navigate_to_pose.cpp index 7a521a210d..1ddb0f82ae 100644 --- a/nav2_bt_navigator/src/navigators/navigate_to_pose.cpp +++ b/nav2_bt_navigator/src/navigators/navigate_to_pose.cpp @@ -179,7 +179,7 @@ NavigateToPoseNavigator::onLoop() } // Add orientation difference to distance - if (current_angular_speed > 0.01) { + if (current_angular_speed > 0.01 && current_path.poses.size() > 0) { tf2::Quaternion q( current_pose.pose.orientation.x, current_pose.pose.orientation.y,