CC BY
153
УДК 621.805.08: 004.021
А.Н. Горитов, М.Ф. Молокова
Расчёт динамических характеристик манипулятора
Проектирование роботов, решение задач управления манипулятором, анализ кинематической структуры приводят к необходимости изучения динамических процессов, происходящих во время функционирования робота. В статье рассмотрена модификация системы моделирования РАУМС. Модификация системы позволяет выполнять расчёты динамических характеристик исследуемых объектов, а также включает в себя модификацию модели компонентов и внедрение в систему блока по расчёту динамических характеристик манипулятора. Реализованный алгоритм основан на методе Лагранжа-Эйлера и позволяет решать прямую и обратную задачу динамики. Результат выполнения расчётов представлен в виде таблицы и графика изменения динамических характеристик в момент времени. В результате разработки модуля были расширены возможности моделирования в плане анализа динамических характеристик робота.
Ключевые слова: робот-манипулятор, прямая задача динамики, обратная задача динамики, метод Лагранжа-
Эйлера, система РАУМС.
ао1: 10.21293/1818-0442-2017-20-4-113-116
Современные роботы - это сложные устройства, сочетающие в себе точную механику, электроприводную технику и цифровое управление [1].
Большое разнообразие возможных конструкций роботов-манипуляторов и сложность их математического описания придают особую актуальность проблеме моделирования функционирования роботов (имитационное моделирование) при выполнении заданных операций. Потребности в моделировании возникают как на этапе проектирования, так и при создании и эксплуатации этих устройств.
Проведенный системный анализ проблемы моделирования позволяет выявить цель, направления, задания и задачи, подлежащие исследованию [2].
Одной из важных задач, выделенных на основе системного анализа, является анализ динамических характеристик функционирования робота-манипулятора. Изучение динамических процессов в приводах робота позволяет определить динамические нагрузки, воздействующие на звенья кинематической цепи в процессе их перемещения [3]. После этого при реализации заданных движений манипулятора можно определить усилия в приводах, это позволяет провести расчёты и выбрать необходимые приводы.
При динамическом анализе роботов рассматривают два класса задач: динамический анализ движения и динамический силовой анализ [4, 5]. При решении первой задачи вычисляются ускорения и силы реакций по заданным внешним силам и моментам двигателей. После этого путем интегрирования ускорения вычисляются скорости и ускорения. Во второй задаче задаётся необходимое движение робота, а затем находятся неизвестные силы, обеспечивающие необходимое перемещение.
При работе в системе проектирования РАУМС (расчёт и анализ управляемых механических систем) [6] возникла необходимость реализации задачи динамики. Особенностью РАУМС в отличие от других программ является возможность выполнения задач, учитывая рабочую среду, в которой проводятся исследования основного объекта.
Цель работы - разработать алгоритмы формирования и решения систем уравнений, позволяющих решить прямую и обратную задачу динамики манипулятора.
Прямая задача динамики В робототехнике предложено несколько методов математического описания движения роботов. Эти методы основаны на использовании классических принципов и уравнений механики: Лагранжа-Эйлера [7, 8], Ньютона-Эйлера [9], Гаусса [10]. Метод Лагранжа-Эйлера позволяет получить удобную для анализа форму уравнений движения. Метод Ньютона-Эйлера не подходит для решения поставленной задачи в связи с большим объемом вычислений, связанным с необходимостью вычисления матрицы вторых производных. Метод Гаусса является итерационным методом решения получаемых линейных уравнений. По числу арифметических операций этот метод нельзя назвать экономным. Так как для нас важна не только точность решения, но и время расчётов и форма уравнения, то для расчётов использовался метод Лагранжа-Эйлера.
Запишем уравнение Лагранжа-Эйлера для поиска динамических характеристик (1):
Ж
дЬ
дд,■
дЬ
(1)
дд,
В уравнении (1) Ь - функция Лагранжа, Ь = К - Р, К - полная кинетическая энергия манипулятора, Р - полная потенциальная энергия манипулятора, д, - обобщённые переменные манипулятора, д, - первая производная по времени обобщённых переменных, т, - обобщённые силы или моменты, создаваемые в , сочленении для реализации заданного движения , -го звена.
Уравнение (2) описывает динамику движения робота в векторном виде:
п п п
т, = Е А,кд(1 )к + ЕЕ Кктд(1 )к д(1 )т -, (2)
к=1 к=1т=1
где гг - обобщённые силы в г -м сочленении для
реализации движения г -го звена, Д-,к определяется
формулой (3), устанавливает связь сил и моментов которые действуют в сочленениях с ускорениями присоединённых переменных, Ьгкт - определяется
равенством (4) и (5), устанавливает связь сил и моментов, которые действуют в сочленениях со скоростями изменения присоединенных переменных, сг определяется равенством (6), вычисляет силу тяжести, воздействующую на звенья манипулятора, ¿(/)к - обобщённое ускорение, ¿(/)т - обобщённая скорость, п - количество звеньев робота-манипулятора.
Коэффициенты Бгк определяются равенством
Тг (и к и у-ир, г ,к=1,2,..., п. (3)
Бк = I
у=тах(г,к)
Коэффициенты Иц- определяются равенством
% =
I Тг (и ¡кт J у ),
у=тах(г,к ,т)
г,к ,т = 1,2,...,п, (4)
Ь =11 ЬктЯк Шт (О г =1,2,...,п, (5)
к=1т=1
где и — - матрица, описывает изменения положения г -го звена, возникающие при движении в у -м сочленении манипулятора; 3 - - матрица моментов инерции - -го звена; Тг - след полученной матрицы. Коэффициенты сг определяются равенством
п
сг =1 (-т}ё И -г гу ) г n,
] ='
ту
(6)
где т- - масса у -го звена; И — - матрица описывает изменения положения г звена, возникающие при движении в - сочленении манипулятора; г- - вектор центра масс г звена в собственной системе отсчёта, g - сила тяжести [7].
Обратная задача динамики Для решения обратной задачи динамики уравнение (2) примет следующий вид:
¿(0/ =
О -11 /ЪктЧкЧт - с г)
к=1т=1
г =1, п.
(7)
I А,к к=1
Значения обобщённой переменной и её производной вычисляются следующим образом:
¿(/ + А/)г =д(/)г + д(/)г • А/, г = 1,п, (8)
¿(/ + А/)г =д(/)г + д(/)г • А/, г = 1,п, (9)
где А/ - изменение времени.
Общий алгоритм решения прямой и обратной задачи динамики изображён на рис. 1.
Более подробный алгоритм нахождения обобщённых сил изображён на рис. 2.
Более подробный алгоритм определения характера движения для звеньев изображён на рис. 3.
Рис. 1. Общий алгоритм решения задачи динамики
Рис. 2. Алгоритм нахождения сил и моментов
Описание исследуемого объекта в системе РАУМС строится на основе его компонентного представления. Формирование уравнения Лагранжа-Эйлера потребовало модификации программных модулей. Они были дополнены блоками формирования матрицы инерции, разработаны модели компонентов - силы и моменты силы. Для включения в систему моделирования разработанные модели были преобразованы в соответствии с общей структурой модели компонента [11]. Кроме того разработано два новых модуля: один, отвечающий за решения прямой задачи динамики, и второй, отвечающий за решение обратной задачи динамики. Результаты выполненных расчётов выводятся в виде таблицы и в виде графика.
^^""начало"""^^
_ I _
Входные данные: параметры компонента; обобщённые
переменные §(?); масса т каждого звена; п количество кинематических
Вычисления матрицы инерции
Вычисления коэффициента О
по формуле (3) +
Вычисления коэффициента И по
формуле (4) и (5) +
Вычисления коэффициента с по
формуле (6) +
Нахождение ускорения § (?) из полученной системы (7)
V
Вычисление §(?), § (?) по формуле (8)и (9)
Рис. 3. Алгоритм определения характера движения звеньев
Разработанный модуль позволяет для произвольного робота манипулятора автоматически составлять уравнения и решать как прямую, так и обратную задачу динамики; находить обобщённые силы, которые необходимо задать для перемещения звеньев манипулятора по заданной траектории при решении прямой задачи динамики; вычислить траекторию движения, скорость и ускорения каждого звена манипулятора при решении обратной задачи динамики.
Литература
1. Кориков А.М. О развитии понятия «мехатроника» // Доклады ТУСУРа. - 2010. - Т. 1(21), № 2. - С. 199-202.
2. Горитов А.Н. Моделирование адаптивных меха-тронных систем / А.Н. Горитов, А.М. Кориков. - Томск: В-Спектр, 2007. - 292 с.
3. Булгаков А.Г. Промышленные роботы. Кинематика, динамика, контроль и управление. Сер.: Библиотека инженера / А.Г. Булгаков, В. А. Воробьев. - М.: СОЛОН-ПРЕСС, 2007. - 488 с.
4. Sam-Sang You. Dynamics and controls for robot manipulators with open and closed kinematic chain mechanisms. -Iowa State University, 1994. - 157 p.
5. Юревич Е.И. Основы робототехники. - СПб.: БХВ-Петербург, 2005. - 416 с.
6. Горитов А.Н. Моделирование манипуляционных робототехнических систем в условиях неполной информации о внешней среде. - Томск: Изд-во Института оптики атмосферы СО РАН, 2005. - 276 с.
7. X.-J. Liu. Kinematics, Dynamics and Dimensional Synthesis of a Novel 2-DoF Translational Manipulator / X.-J. Liu, Q.-M. Wang, J. Wang // Journal of Intelligent and Robotic Systems. - 2004. - Vol. 41, No. 4. - P. 205-224.
8. Da-quan Li. Dynamics Modeling, Control System Design and Simulation of Manipulator Based on Lagrange Equation / Da-quan Li, Hua-jie Hong and Xian-liang Jiang // Mechanism and Machine Science. - 2016. - P. 1129-1141.
9. Фу К. Робототехника / К. Фу, Р. Гонсалис, К. Ли. -М.: Мир, 1989. - 624 с.
10. Фролова К.В. Механика промышленных роботов: учеб. пособие для вузов: в 3 кн. - Кн. 1: Кинематика и динамика. - М.: Высш. шк., 1988. - 304 с.
11. Горитов А.Н. Структура модели компонента системы автоматизированного моделирования робототехни-ческих комплексов // Программные продукты и системы: Приложение к журналу «Проблемы теории и практики управления». - 2001. - № 2. - С. 20-22.
Заключение
На основе метода Лагранжа-Эйлера разработан алгоритм формирования уравнений Лагранжа-Эйле-ра для произвольного манипулятора. Реализован метод решения уравнения Лагранжа-Эйлера в рамках системы РАУМС. Это позволяет анализировать динамические характеристики манипулятора с учетом объектов внешней среды.
Выполнена модификация модулей системы РАУМС для того, чтобы обеспечить формирование и решение уравнения Лагранжа-Эйлера.
Горитов Александр Николаевич
Д-р техн. наук, профессор каф.
автоматизированной системы управления (АСУ) ТУСУРа Тел: +7 (382-2) 70-15-36 Эл.почта: [email protected]
Молокова Мария Федоровна
Магистрант каф. АСУ ТУСУРа
Тел.: +7-913-852-24-07
Эл. почта: [email protected]
Goritov A.N., Molokova M.F. Calculation of the dynamic characteristics of the manipulator
Designing robots, solving manipulator control problems, analyzing the kinematic structure leads to the need to study the dynamic processes that occur during the operation of the robot. In the report, the modification of the RAUMS simulation system is considered. Modification of the system allows performing calculations of the dynamic characteristics of the objects under study. It also includes the modification of the component model and the integration into the system of the
unit for calculating the dynamic characteristics of the manipulator. The implemented algorithm is based on the Lagrange-Euler method and allows solving the direct and inverse problem of dynamics. The result of the calculations is presented in a table and a graph of the change in the dynamic characteristics at the time. As a result of the development of the module, the modeling capabilities were expanded, in terms of analysis of the dynamic characteristics of the robot. Keywords: Robot - manipulator, direct problem of dynamics, inverse dynamic problem, Lagrange-Euler method, RAUMS system.
