Always reset the smoothing filter when paused

moveit · Aug 12, 2024 · 37bc770 · 37bc770
1 parent a696127
commit 37bc770
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;
     }