получаем
где – координаты центра масс звена I в i-й системе координат.
Таким образом, полная кинетическая энергия манипулятора равна
(4)
Потенциальная энергия выемочного манипулятора ВМФ-5. Полная потенциальная энергия, связанная с весом манипуляционного робота, по-прежнему определяется как сумма всех потенциальных энергий отдельных звеньев. Следовательно,
(5)
где – вектор положения центра масс i-го звена, выраженный в i-й системе координат, а g – вектор ускорения свободного падения.
Функция Лагранжа .
Из формул (3.4, 3.5) получаем:
Вспомните, что мы пытаемся вывести уравнения динамики с помощью уравнений Лагранжа-Эйлера, т. е.
(6)
Заметим, что
Достарыңызбен бөлісу: |