Skip to content

Commit dbde7b7

Browse files
committed
Wait for ready state before starting communication
1 parent 90f0de6 commit dbde7b7

File tree

1 file changed

+5
-0
lines changed

1 file changed

+5
-0
lines changed

robotiq_hande_driver/hardware/src/hande_hardware_interface.cpp

Lines changed: 5 additions & 0 deletions
Original file line numberDiff line numberDiff line change
@@ -186,6 +186,11 @@ HWI::CallbackReturn RobotiqHandeHardwareInterface::on_activate(
186186
th_comm_enabled_.store(true, std::memory_order_relaxed);
187187
th_comm_.emplace(&RobotiqHandeHardwareInterface::gripper_communication, this);
188188
}
189+
190+
RCLCPP_INFO(get_logger(), "%sWaiting for Hand-E complete activation%s", color::BCYAN, color::RESET);
191+
while(!gripper_driver_.get_status().is_ready) {
192+
std::this_thread::sleep_for(th_sleep_rate_);
193+
}
189194
} catch(const std::exception& e) {
190195
RCLCPP_ERROR(
191196
get_logger(),

0 commit comments

Comments
 (0)