diff --git a/ur_robot_driver/src/controller_stopper.cpp b/ur_robot_driver/src/controller_stopper.cpp index 26f0286e..0fc37267 100644 --- a/ur_robot_driver/src/controller_stopper.cpp +++ b/ur_robot_driver/src/controller_stopper.cpp @@ -42,6 +42,8 @@ #include #include +#include + #include "ur_robot_driver/controller_stopper.hpp" ControllerStopper::ControllerStopper(const rclcpp::Node::SharedPtr& node, bool stop_controllers_on_startup) @@ -89,6 +91,7 @@ ControllerStopper::ControllerStopper(const rclcpp::Node::SharedPtr& node, bool s } } } + rclcpp::sleep_for(std::chrono::milliseconds(100)); } auto request_switch_controller = std::make_shared(); request_switch_controller->strictness = request_switch_controller->STRICT;