AABB now uses Point3d instead of Vector3d
Made sure that detected edge points are ahead of the sample point