From 35081044de1d1862e158d33d1a0db5257cd8d074 Mon Sep 17 00:00:00 2001
From: Pimpest <82343504+pimpest@users.noreply.github.com>
Date: Fri, 17 Apr 2026 05:48:26 +0200
Subject: [PATCH] Added debug print for robot position

---
 toid_odometry/src/odometry.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/toid_odometry/src/odometry.cpp b/toid_odometry/src/odometry.cpp
index b99d7d8..95b5a50 100644
--- a/toid_odometry/src/odometry.cpp
+++ b/toid_odometry/src/odometry.cpp
@@ -203,6 +203,7 @@ private:
         o.child_frame_id = t.child_frame_id;
 
         t.transform = make_transform(state.x, state.y, state.theta);
+        RCLCPP_DEBUG_THROTTLE(this->get_logger(), *this->get_clock(), 500, "Robot position: %lf %lf %lf", state.x, state.y, state.theta);
 
         const auto& [x,y,z] = t.transform.translation;
         o.pose.pose.position.x = x;