Velocity and Skipping

Change the way velocity is calculated in Update.
Added a return in filter to skip when calculation is unnecessary.