при таком подходе надо останавливать чтобы вбить новую точку или в движении с большим риском вбивать новые точки. Попробовал так. Опасно и простой. Лучше заранее иметь маршрут.