Corregido como se calcula el angulo final en moveForNextPoint
Añadido TODO