Pimpest/toid
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Added debug print for robot position

Browse Source
This commit is contained in:
Pimpest
2026-04-17 05:48:26 +02:00
parent 50ec8e3a83
commit 35081044de
1 changed files with 1 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
toid_odometry/src/odometry.cpp
View File

@@ -203,6 +203,7 @@ private:
o.child_frame_id = t.child_frame_id; o.child_frame_id = t.child_frame_id;
t.transform = make_transform(state.x, state.y, state.theta); 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; const auto& [x,y,z] = t.transform.translation;
o.pose.pose.position.x = x; o.pose.pose.position.x = x;