Для потомков, которых подобный вопрос будет также терзать:
для любых зданий геометрический алгоритм пересечения пути юнита с n-угольником, у которого известны координаты вершин (которые по совместительству могут являться waypoint-ами), можно найти здесь
http://doc-for-prog.narod.ru/topics/math/crossing.html
Как раз то, что доктор прописал, LinePick в баню!
