Fixed implementation of collision detection with extrapolated coords