modelec/modelec-marcel-ROS
1
0
Fork 0
mirror of https://github.com/modelec/modelec-marcel-ROS.git synced 2026-01-18 16:47:43 +01:00
Code Issues Packages Projects Releases Wiki Activity

log

Browse Source
This commit is contained in:
acki
2025-05-29 15:05:25 -04:00
parent 4caa24d981
commit 5d5b030524
1 changed files with 4 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/modelec_strat/src/navigation_helper.cpp
View File

@@ -727,6 +727,8 @@ namespace Modelec
} }
}*/ }*/
RCLCPP_INFO(node_->get_logger(), "Waypoint reached, id: %d", waypoint_queue_.front().id);
if (await_rotate_) if (await_rotate_)
{ {
await_rotate_ = false; await_rotate_ = false;
@@ -741,6 +743,8 @@ namespace Modelec
} }
else else
{ {
RCLCPP_INFO(node_->get_logger(), "Waypoint reached 2");
if (!waypoint_queue_.empty()) if (!waypoint_queue_.empty())
{ {
waypoint_pub_->publish(waypoint_queue_.front().ToMsg()); waypoint_pub_->publish(waypoint_queue_.front().ToMsg());