diff --git a/src/modelec_com/src/pcb_odo_interface.cpp b/src/modelec_com/src/pcb_odo_interface.cpp
index b5a4f62..4116371 100644
--- a/src/modelec_com/src/pcb_odo_interface.cpp
+++ b/src/modelec_com/src/pcb_odo_interface.cpp
@@ -170,6 +170,8 @@ namespace Modelec
             }
             else if (tokens[1] == "WAYPOINT")
             {
+                RCLCPP_INFO(this->get_logger(), "Waypoint reached: ID %s", tokens[2].c_str());
+
                 int id = std::stoi(tokens[2]);
 
                 auto message = modelec_interfaces::msg::OdometryWaypoint();