Digital filter for compensation of servo loop