Update nav2_graceful_controller/src/graceful_controller.cpp

Co-authored-by: Steve Macenski <[email protected]> Signed-off-by: Michael Ferguson <[email protected]>
ros-navigation · Dec 17, 2024 · f3e9500 · f3e9500
1 parent 11c4b15
commit f3e9500
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/nav2_graceful_controller/src/graceful_controller.cpp b/nav2_graceful_controller/src/graceful_controller.cpp
@@ -430,7 +430,7 @@ void GracefulController::validateOrientations(
   if (path.empty()) {return;}
 
   // Check if we actually need to add orientations
-  for (size_t i = 0; i < path.size() - 1; ++i) {
+  for (size_t i = 1; i < path.size() - 1; ++i) {
     if (tf2::getYaw(path[i].pose.orientation) != 0.0) {return;}
   }