An innovative algorithm for the velocity estimation both during dynamics and at steady state