Added Velocity Observer by Ugo Pataccini