Движок работает на ура, метод расстояния от точки до отрезка заменен кодом Навального. Осталось рисование и тесты. Вотъ.