Added step length to collision calculations