Finally finished line intersection heuristic