Решим систему алгебраических уравнений (1) относительно обобщенных координат (q1, q2). Введенные дополнительные переменные
представлены на рисунке.
По теореме косинусов имеем для треугольника ОРА:
![]()
Отсюда определяем значение угла
Учитывая, что угол
получаем выражение для второй обобщенной координаты:
![]()
По теореме синусов определим синус угла![]()

![]()
Подставим найденное выражение (2) в формулу (3):
Из прямоугольного треугольника ОРВ имеем
![]()
Тогда получаем следующее выражение для первой обобщенной координаты:
где![]()
Найденное решение (2), (4) обратной задачи о положении для двух-звенного манипулятора требует вычисления обратных тригонометрических, степенных и дробных функций. Решение является неоднозначным, в особых конфигурациях возникает неопределенность.
Оставить комментарий или два