diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp index a2a80ce..3b1c79b 100644 --- a/src/modelec_strat/src/navigation_helper.cpp +++ b/src/modelec_strat/src/navigation_helper.cpp @@ -429,6 +429,8 @@ namespace Modelec void NavigationHelper::SetPos(const Point& pos) { + RCLCPP_INFO(node_->get_logger(), "Set position to x: %d, y: %d, theta: %f", pos.x, pos.y, pos.theta); + PosMsg msg; msg.x = pos.x; msg.y = pos.y;