Sleep in loop when Servo is paused too

moveit · Nov 21, 2023 · b0d672c · b0d672c
1 parent 7178a91
commit b0d672c
Showing 1 changed file with 3 additions and 0 deletions.
diff --git a/moveit_ros/moveit_servo/src/servo_node.cpp b/moveit_ros/moveit_servo/src/servo_node.cpp
@@ -302,7 +302,10 @@ void ServoNode::servoLoop()
   {
     // Skip processing if servoing is disabled.
     if (servo_paused_)
+    {
+      servo_frequency.sleep();
       continue;
+    }
 
     next_joint_state = std::nullopt;
     const CommandType expected_type = servo_->getCommandType();