Improved velocity handling. Fixed idle falling through floor.