Prevent invalid accesses on paths in path_longer_on_approach (ros-nav…

…igation#4375) * Prevent invalid accesses on paths in path_longer_on_approach * Fix format of the change
Marc-Morcos · Jul 4, 2024 · a169386 · a169386
1 parent 6ad94e7
commit a169386
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/nav2_behavior_tree/plugins/decorator/path_longer_on_approach.cpp b/nav2_behavior_tree/plugins/decorator/path_longer_on_approach.cpp
@@ -63,7 +63,9 @@ inline BT::NodeStatus PathLongerOnApproach::tick()
   getInput("length_factor", length_factor_);
 
   if (first_time_ == false) {
-    if (old_path_.poses.back() != new_path_.poses.back()) {
+    if (old_path_.poses.empty() || new_path_.poses.empty() ||
+      old_path_.poses.back() != new_path_.poses.back())
+    {
       first_time_ = true;
     }
   }