From 5d5b03052434464a3ef8a2483d214f1347c08e32 Mon Sep 17 00:00:00 2001
From: acki <ackimixs@protonmail.com>
Date: Thu, 29 May 2025 15:05:25 -0400
Subject: [PATCH] log

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

diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp
index 6b8b757..a07bc23 100644
--- a/src/modelec_strat/src/navigation_helper.cpp
+++ b/src/modelec_strat/src/navigation_helper.cpp
@@ -727,6 +727,8 @@ namespace Modelec
             }
         }*/
 
+        RCLCPP_INFO(node_->get_logger(), "Waypoint reached, id: %d", waypoint_queue_.front().id);
+
         if (await_rotate_)
         {
             await_rotate_ = false;
@@ -741,6 +743,8 @@ namespace Modelec
         }
         else
         {
+            RCLCPP_INFO(node_->get_logger(), "Waypoint reached 2");
+
             if (!waypoint_queue_.empty())
             {
                 waypoint_pub_->publish(waypoint_queue_.front().ToMsg());