This commit is contained in:
acki
2025-05-29 15:05:25 -04:00
parent 4caa24d981
commit 5d5b030524

View File

@@ -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());