From 159aaf46b51143c7adf7ef63d6f5f9e07d1cfffe Mon Sep 17 00:00:00 2001
From: acki <ackimixs@protonmail.com>
Date: Thu, 29 May 2025 18:08:24 -0400
Subject: [PATCH] log

---
 src/modelec_strat/src/navigation_helper.cpp | 9 +++++++++
 1 file changed, 9 insertions(+)

diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp
index 1057e4a..b8b24de 100644
--- a/src/modelec_strat/src/navigation_helper.cpp
+++ b/src/modelec_strat/src/navigation_helper.cpp
@@ -590,6 +590,15 @@ namespace Modelec
             std_msgs::msg::Bool start_odo_msg;
             start_odo_msg.data = false;
             start_odo_pub_->publish(start_odo_msg);
+
+            waypoints_.clear();
+
+            Waypoint w(*msg, -1, false);
+
+            waypoints_.emplace_back(w);
+
+            // SendWaypoint();
+            SendGoTo();
         }
     }