debug

src/modelec_com/include/modelec_com/pcb_odo_interface.hpp

@@ -84,6 +84,8 @@ namespace Modelec
         rclcpp::Subscription<std_msgs::msg::Bool>::SharedPtr start_odo_sub_;
         bool start_odo_ = false;
 
+        rclcpp::TimerBase::SharedPtr odo_get_pos_timer_;
+
         // Promises and mutexes to synchronize service responses asynchronously
         std::queue<std::promise<long>> tof_promises_;
         std::mutex tof_mutex_;

src/modelec_com/src/pcb_odo_interface.cpp

@@ -181,6 +181,16 @@ namespace Modelec
                     SendOrder("START", {std::to_string(msg->data)});
                 }
             });
+
+        odo_get_pos_timer_ = this->create_wall_timer(
+            std::chrono::milliseconds(100),
+            [this]()
+            {
+                if (isOk && start_odo_)
+                {
+                    GetPos();
+                }
+            });
     }
 
     PCBOdoInterface::~PCBOdoInterface()