Collision works proper, and added diagonals to floor calculation