diff --git a/src/modelec_com/src/pcb_odo_interface.cpp b/src/modelec_com/src/pcb_odo_interface.cpp index 144f9a1..7a10314 100644 --- a/src/modelec_com/src/pcb_odo_interface.cpp +++ b/src/modelec_com/src/pcb_odo_interface.cpp @@ -106,6 +106,8 @@ namespace Modelec "odometry/add_waypoint", 30, [this](const modelec_interfaces::msg::OdometryAddWaypoint::SharedPtr msg) { + RCLCPP_INFO(this->get_logger(), "Received add waypoint request: %d %s %d %d %f", + msg->id, msg->is_end ? "end" : "not end", msg->x, msg->y, msg->theta); AddWaypointCallback(msg); });