diff --git a/src/modelec_strat/src/navigation_helper.cpp b/src/modelec_strat/src/navigation_helper.cpp index 5b8d287..bd9c7f3 100644 --- a/src/modelec_strat/src/navigation_helper.cpp +++ b/src/modelec_strat/src/navigation_helper.cpp @@ -777,6 +777,7 @@ namespace Modelec void NavigationHelper::OnPos(const PosMsg::SharedPtr msg) { + RCLCPP_INFO(node_->get_logger(), "Current position updated to x: %f, y: %f, theta: %f", msg->x, msg->y, msg->theta); current_pos_ = msg; pathfinding_->SetCurrentPos(msg); }