Added goal accepted check before flagging navigator as running (ros-n…

…avigation#2949)
EnjoyRobotics · Jun 30, 2022 · 45e58eb · 45e58eb
1 parent 775dd9c
commit 45e58eb
Showing 1 changed file with 6 additions and 2 deletions.
diff --git a/nav2_bt_navigator/include/nav2_bt_navigator/navigator.hpp b/nav2_bt_navigator/include/nav2_bt_navigator/navigator.hpp
@@ -255,9 +255,13 @@ class Navigator
       return false;
     }
 
-    plugin_muxer_->startNavigating(getName());
+    bool goal_accepted = goalReceived(goal);
 
-    return goalReceived(goal);
+    if (goal_accepted) {
+      plugin_muxer_->startNavigating(getName());
+    }
+
+    return goal_accepted;
   }
 
   /**