Always reset the smoothing filter when paused

AndyZe · Aug 12, 2024 · 3686dae · 3686dae
1 parent ba4f0e6
commit 3686dae
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/moveit_ros/moveit_servo/src/servo_node.cpp b/moveit_ros/moveit_servo/src/servo_node.cpp
@@ -315,6 +315,7 @@ void ServoNode::servoLoop()
     // Skip processing if servoing is disabled.
     if (servo_paused_)
     {
+      servo_->resetSmoothing(current_state);
       servo_frequency.sleep();
       continue;
     }