Improved overlap checking

If the surface angle difference between the two sensors was very low the
player would appear submerged after the overlap routine.