From 35380e5faeec59c49dee5d616f1ebaba821141b5 Mon Sep 17 00:00:00 2001
From: acki <ackimixs@protonmail.com>
Date: Thu, 29 May 2025 18:10:52 -0400
Subject: [PATCH] log

---
 src/modelec_strat/src/navigation_helper.cpp | 10 ++++++----
 1 file changed, 6 insertions(+), 4 deletions(-)

diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp
index b8b24de..676adbb 100644
--- a/src/modelec_strat/src/navigation_helper.cpp
+++ b/src/modelec_strat/src/navigation_helper.cpp
@@ -553,10 +553,13 @@ namespace Modelec
 
         if (last_was_close_enemy_)
         {
-            RCLCPP_INFO(node_->get_logger(), "Enemy was close try to replanning...");
-            if (Replan(false))
+            if (Point::distance(Point(msg->x, msg->y, msg->theta), Point(current_pos_->x, current_pos_->y, current_pos_->theta)) > 400)
             {
-                last_was_close_enemy_ = false;
+                RCLCPP_INFO(node_->get_logger(), "Enemy was close try to replanning...");
+                if (Replan(false))
+                {
+                    last_was_close_enemy_ = false;
+                }
             }
 
             return;
@@ -597,7 +600,6 @@ namespace Modelec
 
             waypoints_.emplace_back(w);
 
-            // SendWaypoint();
             SendGoTo();
         }
     }