Такой проект уже реализовывался на ПР (надо искать) . Проблем с позиционированием не было , из-за малой скорости движения по осям. Сам алгоритм не сложный.