Reduced position error permitted
Fixed ground collision bug