Разработка программной реализации алгоритмов, Прямая задача кинематики, Обратная