[moveit_servo] avoid race condition when calling ~/pause_servo

[moveit_servo] avoid race condition when calling ~/pause_servo #7666