Intersection algorithm not finished, but almost