Fix path comparison to avoid unnecessary updates (#5009)

Tacha-S · web-flow · commit d9cc4ba320e3 · 2025-03-24T11:28:20.000-07:00
Signed-off-by: Tatsuro Sakaguchi &lt;tatsuro.sakaguchi@g.softbank.co.jp&gt;
diff --git a/nav2_behavior_tree/plugins/action/follow_path_action.cpp b/nav2_behavior_tree/plugins/action/follow_path_action.cpp
@@ -66,7 +66,7 @@ void FollowPathAction::on_wait_for_result(
   getInput("path", new_path);
 
   // Check if it is not same with the current one
-  if (goal_.path != new_path) {
+  if (goal_.path != new_path && new_path != nav_msgs::msg::Path()) {
     // the action server on the next loop iteration
     goal_.path = new_path;
     goal_updated_ = true;
