From fd504a7d4cee8e28778fa718dbc7a0b53535b067 Mon Sep 17 00:00:00 2001 From: acki Date: Thu, 29 May 2025 11:48:40 -0400 Subject: [PATCH] sleep --- src/modelec_com/src/pcb_action_interface.cpp | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/src/modelec_com/src/pcb_action_interface.cpp b/src/modelec_com/src/pcb_action_interface.cpp index 172f236..2607da0 100644 --- a/src/modelec_com/src/pcb_action_interface.cpp +++ b/src/modelec_com/src/pcb_action_interface.cpp @@ -226,6 +226,8 @@ namespace Modelec for (auto & [key, angle] : v) { + rclcpp::sleep_for(std::chrono::milliseconds(100)); + SendOrder("SERVO" + std::to_string(id), {"POS" + std::to_string(key), std::to_string(static_cast(angle * 100))}); } } @@ -241,6 +243,8 @@ namespace Modelec for (auto & [id, v] : servo_value_) { + rclcpp::sleep_for(std::chrono::milliseconds(100)); + SendMove("SERVO" + std::to_string(id), {"POS" + std::to_string(v)}); } @@ -252,9 +256,13 @@ namespace Modelec for (auto & [id, v] : relay_value_) { + rclcpp::sleep_for(std::chrono::milliseconds(100)); + SendMove("RELAY" + std::to_string(id), {std::to_string(v)}); } + rclcpp::sleep_for(std::chrono::milliseconds(100)); + SendOrder("TIR", {"ARM", "1"}); }