From 3040b23e3dc32812971b87942674081c696f7bbc Mon Sep 17 00:00:00 2001
From: acki <ackimixs@protonmail.com>
Date: Thu, 29 May 2025 13:09:01 -0400
Subject: [PATCH] log

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

diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp
index 11f7071..5835223 100644
--- a/src/modelec_strat/src/navigation_helper.cpp
+++ b/src/modelec_strat/src/navigation_helper.cpp
@@ -138,7 +138,10 @@ namespace Modelec
             waypoint_queue_.push(w);
         }
 
-        waypoint_pub_->publish(waypoint_queue_.front().ToMsg());
+        auto w = waypoint_queue_.front().ToMsg();
+        RCLCPP_DEBUG(node_->get_logger(), "Sending waypoint: x: %f, y: %f, theta: %f, id: %d",
+                     w.x, w.y, w.theta, w.id);
+        waypoint_pub_->publish(w);
         waypoint_queue_.pop();
     }