Машинное моделирование
Для проверки правильности решения обратной задачи кинематики манипулятора Пума, изображенного на рис. 5.4, может быть составлена программа для ЭВМ.
Рисунок 9.1. Блок-схема модели решения обратной задачи кинематики
на ЭВМ.
Первоначально в программе задаётся положение манипулятора в пределах допустимых значений присоединенных углов (решение прямой задачи кинематики, формирование матрицы манипулятора Т).
Значение индикаторов совместно с матрицей Т является входами в программу решения обратной задачи кинематики, вычисляющую присоединенные углы, которые должны совпасть с присоединенными углами по решению прямой задачи кинематики.
Динамика манипулятора
Предметом динамики манипулятора как раздела робототехники является математическое описание действующих на манипулятор сил и моментов в форме уравнений динамики движения. Также уравнения необходимы для моделирования движения манипулятора с помощью ЭВМ, при выборе законов уравнения и при оценке качества кинематической схемы и конструкции манипулятора.
Задача управления включает задачу формирования динамической модели реального манипулятора и задачу выбора законов или стратегий управления, обеспечивающих выполнение поставленных целей.
Динамическая модель манипулятора может быть построена на основе использования известных законов ньютоновой или лагранжевой механики. Результатом применения этих законов является уравнения, связывающие действующие в сочленениях силы и моменты с кинематическими характеристиками и параметрами движения звеньев.
Таким образом, уравнения динамики движения реального манипулятора могут быть получены методами Лагранжа-Эйлера или Ньютона-Эйлера. Уравнения Лагранжа-Эйлера обеспечивают строгое описание динамики манипулятора. Их можно использовать для решения прямой и обратной задачи динамики.
Прямая задача состоит в том, чтобы по заданным силам и моментам определить обобщённые ускорения, интегрирование которых позволит получить значения обобщённых координат и скоростей.
Обратная задача динамики заключается в том, чтобы по заданным обобщённым координатам, скоростям и ускорениям определить действующие в сочленениях манипулятора силы и моменты.
Для решения обеих задач, как правило, необходимо вычислить динамические коэффициенты и
. Вычисление этих коэффициентов требует выполнения очень большого числа арифметических операций. В связи с этим уравнения Лагранжа-Эйлера без дополнительных упрощений практически неприменимы для управления манипулятором в реальном времени.
С целью получения более эффективных с вычислительной точки зрения алгоритмов расчёта обобщённых сил и моментов используют уравнения Ньютона-Эйлера, которые просты по содержанию, но весьма трудоёмки. Результатом является система прямых и обратных рекуррентных уравнений, последовательно применяемых к звеньям манипулятора. Это позволяет реализовать простые законы управлением манипулятора в реальном времени.
Метод Лагранжа-Эйлера
Полное описание движения манипулятора можно получить, применяя метод Лагранжа-Эйлера для неконсервативных систем. Описав кинематику манипулятора с помощью матричного представления Денавита-Хартенберга, можно получить уравнение динамики. Такое совместное использование Д-Х-представления и метода Лагранжа приводит к компактной векторно-математической форме уравнений движения, удобной для аналитического исследования и допускающей реализацию на ЭВМ.
Вывод уравнений динамики движения манипулятора основан на следующем:
1. На описании взаимного пространственного расположения систем координат i-го и (i-1)-го звеньев с помощью матрицы преобразования однородных координат . Эта матрица преобразует координаты произвольной точки относительно i-й системы координаты этой же точки относительно (i-1)-й системы координат.
2. На использовании уравнения Лагранжа-Эйлера:
;
, (9-9)
где L-функция Лагранжа (L=K-P);
K-полная кинетическая энергии манипулятора;
P-полная потенциальна энергия манипулятора
-обобщённые координаты манипулятора;
-первая производная по времени обобщённых координат;
-обобщённые силы (или моменты), создаваемые в i-м сочленении для реализации заданного движения i-го звена.
Для того, чтобы воспользоваться уравнением Лагранжа-Эйлера, необходимо выбрать систему обобщённых координат. Обобщённые координаты представляют собой набор координат, обеспечивающий, полное описание положения рассматриваемой физической системы в абсолютной системе координат. Существуют различные системы обобщенных координат, пригодные для описания простого манипулятора с вращательными и поступательными сочленениями. Однако, поскольку углы поворотов в сочленениях непосредственно доступны измерению с помощью потенциометров или других датчиков, то они составляют наиболее естественную систему обобщенных координат. В этом случае обобщённые координаты совпадают с присоединенными переменными манипулятора. В частности, если i-е сочленение вращательное, то , если же i-е сочленение поступательное, то
.