Поведение контроллера определяется этими формулами
по моему эта задача называется инверсной кинематикой - по требуемому положению конца манипулятора относительно начала найти углы суставов. Прямая кинематика ищет положение конца манипулятора относительно начала при известных углах суставов.
В шестиноге для каждой ноги относительно всё просто - т.к. решение если есть, то однозначно
а вот с манипуляторами может быть сложнее - там неоднозначные решения.