Научная статья на тему 'РАЗРАБОТКА ПРОГРАММНОГО МОДУЛЯ ДЛЯ МОДЕЛИРОВАНИЯ КИНЕМАТИКИ И ДИНАМИКИ МАНИПУЛЯТОРА'

РАЗРАБОТКА ПРОГРАММНОГО МОДУЛЯ ДЛЯ МОДЕЛИРОВАНИЯ КИНЕМАТИКИ И ДИНАМИКИ МАНИПУЛЯТОРА Текст научной статьи по специальности «Компьютерные и информационные науки»

CC BY
209
26
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
КОМПЬЮТЕРНОЕ МОДЕЛИРОВАНИЕ / МОДЕЛИРОВАНИЕ КИНЕМАТИКИ / МЕТОД ЛЕВЕНБЕРГА - МАРКВАРДТА / МОДЕЛИРОВАНИЕ ДИНАМИКИ / МЕТОД НЬЮТОНА - ЭЙЛЕРА / МАНИПУЛЯТОР

Аннотация научной статьи по компьютерным и информационным наукам, автор научной работы — Ту Раин

В статье предлагается разработка программного модуля для моделирования кинематики и динамики манипулятора с пятью степенями подвижности. Для решения прямой задачи кинематики манипулятора использован метод Денавита - Хартенберга. Для решения обратной задачи кинематики и динамики манипулятора использованы аналитические методы - метод Левенберга - Марквардта, метод Ньютона - Эйлера и метод мягких вычислений - адаптивная нейро-нечеткая система вывода. Разработан программный модуль для моделирования кинематики и динамики манипулятора с использованием программного комплекса системы автоматизированного проектирования SolidWorks и программы MatLab. Полученный программный модуль позволяет выполнять моделирование кинематики и динамики манипулятора на основе описываемых методов, визуализацию результатов моделирования, формирование траектории для целевого положения и ориентации рабочего органа манипулятора, имитационное моделирование движения манипулятора по заданной траектории.

i Надоели баннеры? Вы всегда можете отключить рекламу.
iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

DEVELOPMENT OF PROGRAM MODULE FOR MODELING KINEMATICS AND DYNAMICS OF MANIPULATOR

The article proposes the development of a software module for modeling the kinematics and dynamics of a manipulator with five degrees of freedom. To solve the forward kinematics problem of the manipulator, the Denavit-Hartenberg method was used. To solve the inverse the kinematics problem and inverse dynamics problem of the manipulator, analytical methods - the Levenberg - Marquardt method, the Newton - Euler method, and the soft computing method - adaptive neuro-fuzzy inference system were used. And a software module was developed for modeling the kinematics and dynamics of the manipulator using computer-aided design application SolidWorks and the MatLab program. The developed software module is able to simulate the kinematics and dynamics of the manipulator based on the described methods, visualize the simulation results, generate a trajectory for the target position and orientation of the end-effector of the manipulator, simulate the movement of the manipulator along a given trajectory.

Текст научной работы на тему «РАЗРАБОТКА ПРОГРАММНОГО МОДУЛЯ ДЛЯ МОДЕЛИРОВАНИЯ КИНЕМАТИКИ И ДИНАМИКИ МАНИПУЛЯТОРА»

Прикладная математика & Физика, 2023, том 55, № 1. С. 70-83. Applied Mathematics & Physics, 2023, Volume 55, No 1. P. 70-83.

УДК 004.896 DOI 10.52575/2687-0959-2023-55-1-70-83

MSC 93C85

оригинальное исследование

РАЗРАБОТКА ПРОГРАММНОГО МОДУЛЯ ДЛЯ МОДЕЛИРОВАНИЯ КИНЕМАТИКИ

И ДИНАМИКИ МАНИПУЛЯТОРА

Ту Раин

(Статья представлена членом редакционной коллегии С. М. Ситником)

Белгородский государственный национальный исследовательский университет,

Белгород, 308015, Россия

E-mail: [email protected]

Аннотация. В статье предлагается разработка программного модуля для моделирования кинематики и динамики манипулятора с пятью степенями подвижности. Для решения прямой задачи кинематики манипулятора использован метод Денавита - Хартенберга. Для решения обратной задачи кинематики и динамики манипулятора использованы аналитические методы - метод Левенберга - Марквардта, метод Ньютона - Эйлера и метод мягких вычислений -адаптивная нейро-нечеткая система вывода. Разработан программный модуль для моделирования кинематики и динамики манипулятора с использованием программного комплекса системы автоматизированного проектирования SolidWorks и программы MatLab. Полученный программный модуль позволяет выполнять моделирование кинематики и динамики манипулятора на основе описываемых методов, визуализацию результатов моделирования, формирование траектории для целевого положения и ориентации рабочего органа манипулятора, имитационное моделирование движения манипулятора по заданной траектории.

Ключевые слова: компьютерное моделирование, моделирование кинематики, метод Левенберга - Марквардта, моделирование динамики, метод Ньютона - Эйлера, манипулятор

Для цитирования: Ту Раин. 2023. Разработка программного модуля для моделирования кинематики и динамики манипулятора. Прикладная математика & Физика, 55(1): 70-83. DDI 10.52575/2687-0959-2023-55-1-70-83_

DEVELOPMENT OF PROGRAM MODULE FOR MODELING KINEMATICS AND DYNAMICS

OF MANIPULATOR

Thu Rain

(Article submitted by a member of the editorial board S. M. Sitnik)

Belgorod National Research University, Belgorod, 308015, Russia E-mail: [email protected]

Abstract. The article proposes the development of a software module for modeling the kinematics and dynamics of a manipulator with five degrees of freedom. To solve the forward kinematics problem of the manipulator, the Denavit-Hartenberg method was used. To solve the inverse the kinematics problem and inverse dynamics problem of the manipulator, analytical methods - the Levenberg - Marquardt method, the Newton - Euler method, and the soft computing method - adaptive neuro-fuzzy inference system were used. And a software module was developed for modeling the kinematics and dynamics of the manipulator using computer-aided design application SolidWorks and the MatLab program. The developed software module is able to simulate the kinematics and dynamics of the manipulator based on the described methods, visualize the simulation results, generate a trajectory for the target position and orientation of the end-effector of the manipulator, simulate the movement of the manipulator along a given trajectory.

Keywords: Computer Modeling, Kinematics Modeling, Levenberg - Marquardt Method, Dynamics Modeling, Newton - Euler Method, Manipulator

For citation: Thu Rain. 2023. Development of program module for modeling kinematics and dynamics of manipulator. Applied Mathematics & Physics, 55(1): 70-83. (in Russian) DOI 10.52575/2687-0959-2023-55-1-70-83

1. Введение. Разработки программного обеспечения для кинематического и динамического моделирования манипуляторов требуются для исследования движения рабочего органа, анализа конструкций, разработки системы автоматического управления и алгоритмов функционирования манипуляторов [16, 9, 7, 4]. Одним из основных преимуществ программных симуляций является то, что они могут

предоставить пользователям практическую обратную связь при разработке реальных систем. Это позволяет разработчику определить правильность и эффективность проекта еще до того, как система будет построена.

Существует несколько алгоритмов программного обеспечения для моделирования манипуляторов. Во многих работах для кинематического анализа различных манипуляторов использовалась программа RoboAnalyzer [11,15, 7,14]. Программное обеспечение для автоматизированного проектирования «САПР», такое как SolidWorks, CATIA и Autodesk, также используется для моделирования манипуляторов [3, 12]. В статье [13] рассмотрены методы моделирования манипуляторов с использованием различных программ, таких как GraspIt!, OpenGrasp, MATLAB/Simulink, SynGrasp, V-Realm Builder и ADAMS.

В статях [6, 8] предлагаются методологии создания веб-графического пользовательского интерфейса для моделирования движения и кинематического исследования промышленных манипуляторов. В них описываются простые и понятные методы моделирования с использованием Web Graphics Library «WebGL» для создания любой трехмерной виртуальной модели манипуляторов на холсте HTML для имитации движения и различных видов анализа. Моделирование кинематического управления манипулятором на основе адаптивной нейро-нечеткой системы вывода «АНСВ» было представлено в работе [1]. В статье [17] разработана динамическая модель манипулятора с 6 степенями свободы с помощью уравнений Ньютона - Эйлера и проанализировано его динамическое поведение. Динамическое моделирование было выполнено с помощью программного обеспечения для динамического моделирования ADAMS. В работе [10] представлен метод анализа сил и моментов манипулятора с тремя степенями свободы, основанный на имитационной модели манипулятора в среде Matlab/Simulink, и проведено сравнение полученных результатов с математическим расчетом.

В данной работе приводится проектирование и реализация программного модуля компьютерного и имитационного моделирования манипулятора в рабочей зоне, реализующие разработанные алгоритмы и методы, позволит применять их в разработке манипуляторов, системах управления манипуляторами. Данный программный модуль компьютерного и имитационного моделирования также позволяет проводить эксперименты, необходимые для исследования предложенных в работе методов и алгоритмов. Разработанные программные модули предоставляют следующие функциональности: визуализация 3D-моделирования; взаимодействие с пользователем через графический интерфейс; расчет обратной задачи кинематики «ОЗК» манипулятора на основе метода Левенберга - Марквардта и АНСВ; расчет обратной задачи динамики «ОЗД» манипулятора на основе метода Ньютона - Эйлера и АНСВ; формирование траектории для целевого положения и ориентации рабочего органа манипулятора; имитационное моделирование движения манипулятора по заданной траектории.

2. Методология. Для программирования математического моделирования манипулятора была выбрана среда «MATLAB» Для реализации 3D-моделирования выбрана САПР-программа«SolidWorks» с целью достижения фактического размера, степени свободы и других факторов, касающихся анимации и моделирования манипулятора, будет разложен манипулятор с пятью степенями свободы, как показано на рисунке 1.

Рис. 1. Манипулятор с пятью степенями свободы Fig. 1. Manipulator with five degrees of freedom

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

Рис. 2. 3Б-детали манипулятора с пятью степенями свободы Fig. 2. 3D parts of manipulator with five degrees of freedom

На рисунке 2 показаны разработанные 3D-детали звеньев манипулятора с пятью степенями свободы.

После разработки 3D-деталей отдельные детали были собраны в один файл «сборка». После ввода деталей в сборку были введены шарниры вращения манипулятора. Также при виртуальной сборке манипулятора, помимо обычных ограничений, 3D-детали помещаются в вертикальное положение. Это положение было принято для облегчения следующих шагов; собранное положение рассматривается как исходное, и все изменения углов стыков рассчитываются в соответствии с этим положением. Полученная 3D-модель, выбор системы координат и кинематические параметры манипулятора представлены на рисунке 3.

Рис. 3. 3Б-модель сборки манипулятора с пятью степенями свободы Fig. 3. 3D assembly model of manipulator with five degrees of freedom

Значения соответствующих параметров указаны в таблице 1 и геометрических параметров в таблице 2.

Таблица 1. Параметры Денавита - Хартенберга (Д-Х) манипулятора с пятью степенями свободы Table 1. Denavit-Hartenberg parameters of manipulator with five degrees of freedom

Звено üi — 1 (м) a; — 1 (рад) d (м) 0 (рад)

1 0 к/2 d1 01

2 0.246 0 0 02

3 0.163 0 0 0з

4 0 —л/2 0 04

5 0 0 0.165 05

Затем модель интерпретируется в формат URDF (Унифицированный формат описания робототехники) для проведения моделирования и анализа. На рисунке 4 показан процесс перевода САПР, который, по

Таблица 2. Геометрические параметры манипулятора Table 2. Geometric parameters of the manipulator

Звено Высота (м) Радиус (м) Масса (кг)

1 0.071 0.06 0.102

2 0.295 0.035 0.569

3 0.205 0.035 0.310

4 0.091 0.035 0.123

5 0.08 0.05 0.142

сути, состоит из двух этапов. Первоначально сборка САПР, разработанная в БоШШогкБ, экспортируется в формат иКББ. Затем файл иКББ импортируется в МАТЬАБ для создания имитационной модели, которая будет открыта в среде моделирования.

Рис. 4. Процесс перевода САПР Fig. 4. The process of CAD assembly file translation

3. Разработка компонентов программного интерфейса «GUI». Для упрощения экспериментальной работы и получения лучшего представления о поведении системы в среде MATLAB был разработан графический пользовательский интерфейс (GUI) с использованием инструмента Среды разработки графического пользовательского интерфейса MATLAB (GUIDE). Для выбранного набора параметров графический интерфейс выполняет моделирование, отображающее временные характеристики углов сочленения, крутящих моментов в сочленениях и положения рабочего органа манипулятора. На рисунке 5 изображено основное окно программы, в левой части которого находится группа меню, в центральной части находятся панели вводов и выводов и в правой части находится панель визуализации манипулятора. Используя переключатели в группе меню, пользователь выбирает необходимый тип задачи:

1. Прямая задача кинематики,

2. Обратная задача кинематики,

3. Траектория и динамика.

Рис. 5. Основное окно программы Fig. 5. The main window of the program

4. Разработка программного компонента решения прямой задачи кинематики манипулятора.

Определение положения и ориентации рабочего органа при заданных значений вектора обобщенных координат манипулятора называется прямой задачей кинематики. Прямую задачу кинематики манипулятора формулируют следующим образом: по заданному вектору обобщенных координат

в = (в1, в2, в3, 64, в5)Т найти положение и ориентацию рабочего органа 5 = /(в). Положение и ориентацию рабочего органа будем искать в форме матрицы однородного преобразования:

Ti =

пх

Пу

nz 0

Рх ру

az 0

Согласно правилам Денавита - Хартенберга, матрица однородного преобразования Т;, которая имеет вид

Ti =

c6i -sOiCai sdisai ai cat

s6i cdi CŒi -cdiSŒi ai SŒi

0 s ai cai di

0 0 0 1

задает переход от системы координат (г-ого) звена к системе координат (г-ого) звена. Выполняя необходимые вычисления, получим ориентацию рабочего органа:

Пх = ^5 - С5 [с4 (С^з - С1С2С3) + 54(С^з + С!СЗ52)], Пу = -С^5 - С5 [С4 (515253 - С2СЗ51) + 54 (С25^З + СЗ5^2 )], Пг = С5 (С4^23 + $4С2ЗХ Ох = с551 + [С4(с 15253 - С1С2С3) + 54(с^3 + С1Сз$2)],

Оу = 55 [с4(515253 - С2Сз51) + 54(с25^3 + С35152)] - С1С5,

Ог = -55 [С4(с25З + СЗ52) + 54(С2С3 - 525З)], йх = С4 (С 1С253 + С1СЗ52) - 54 (С1525З - С1С2С3), ау = С4(с2х1х3 + С3Х1Х2) - х4(х1х2х3 - C2C3S1),

az = S4 (C2S3 + C3S2) - С4 (С2С3 - S2S3).

А положение рабочего органа:

рх = d5 [с4(cic2S3 + cic3S2) - S4(C1S2S3 - с 1С2С3)] + a2CiC2 + азСхС2С3 - а3с 1S2S3, ру = d5 [с4(C2S1S3 + с3S1S2) - S4(S1S2S3 - C2C3S1)] + a2C2Si + a3C2C3Si - a3SiS2S3, pz = di + a,2S2 - d5 [C4(с2C3 - S2S3) - S4(C2S3 + C3S2)] + a.3C2S3 + 0,30382.

На рисунке 6 приведена блок-схема алгоритма программного компонента прямой задачи кинематики.

Рис. 6. Блок-схема алгоритма программы прямой задачи кинематики Fig. 6. Block diagram of the program algorithm for the forward kinematics

5. Разработка программного компонента решения обратной задачи кинематики манипулятора. Метод Левенберга - Марквардта. Определение вектора обобщенных координат, который позволяет

0

a

X

0

a

у

у

манипулятору достичь желаемых положения и ориентаций рабочего органа, называется обратной задачей кинематики. В данной работе для численного решения обратной задачи кинематики используется метод Левенберга - Марквардта. Кинематические параметры манипулятора представлены набором ограничений, которые накладываются на вектор обобщенных координат. Ограничение по положению рабочего органа можно записать как:

Р1 (в) = р\,

где р е К3 - текущее положение рабочего органа; рл е К3 - целевое положение в пространстве. Для ограничения ориентации

(0) = Д?,

где ^ е 50(3) - ориентация рабочего органа; Rf е 50(3) - целевая ориентация в пространстве. В обоих случаях вектор невязок е;(в) может быть определен как

ei (в) =

¡Pf - Pi (в) \а (Rf Ri (в)т)

где а (Я) е К3 для произвольного R е 50 (3) - эквивалентный вектор угла-оси.

Принимая число всех ограничений 3т, определим вектор невязок е(в) е К3 ™ как:

е (в) = [е\ (в) е[ (в)

\(в )Г.

Решение обратной задачи кинематики сводится к решению следующего нелинейного уравнения:

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

е (в) = 0.

Рис. 7. Блок-схема алгоритма Левенберга - Марквардта Fig. 7. Block diagram of the Levenberg - Marquardt algorithm

Алгоритм метода Левенберга - Марквардта представлен на рисунке 7 в виде блок-схемы и включает следующие этапы:

e

Шаг 1. Инициализация значений, которые будут использоваться для настройки коэффициента демпфирования: параметров в, весовой матрицы We, параметра X, а также Aup и Adown.

Шаг 2. Проверка счетчика итераций: если счетчик итераций не достиг максимального количества шагов, то переход к шагу 3, если достиг, то переход к концу алгоритма. Шаг 3. Расчет матрицы преобразования Т; и оценка вектора невязок е. Шаг 4. Проверка: если С < toi, то переход к концу; если С > toi, то переход к шагу 5.

Шаг 5. Вычисление матрицы Якобиана ],gk = JWeJ + XI, функции стоимости, VC = JT WEe и С = — e2.

Шаг 6. Вычисление нового значения в„

_1V С.

Шаг 7. Оценка нового вектора невязок епе„ в точке, заданной и вычисление функции оценки в 1 2

новой точке С„е„ = ^enew.

Шаг 8. Проверка: если Спе„ > С, то отклонить шаг, сохранить старый параметр предположения в и старые невязки е, и настроить X = X X Хир и переход к шагу 2.

Шаг 9. Проверка: если Спек < С, то принимать шаг в = и установить е = епет и X = Л/Лаота и переход к шагу 2.

6. Адаптивная нейро-нечеткая система вывода «АНСВ» для рушения ОЗК. В этой работе для прогнозирования углов относительно поворота и крутящего момента сочленений звеньев манипулятора, необходимых для выполнения заданной траектории в рабочей зоне, используется АНСВ как другой способ. АНСВ состоит из нейронов, соединенных направленными связями, в которых каждый нейрон выполняет определенную функцию на своих входящих сигналах для генерации выходного сигнала одного нейрона. Для прогнозирования углов относительно поворота сочленений звеньев манипулятора используются 5 АНСВ. В каждой АНСВ значения координаты (рх,ру,рх), задающие положение и значения (у, ¡3, а), задающие ориентацию схвата манипулятора работают как входные значения, а значения углов относительно поворота звеньев (в1, в2, в3, в4, в5) работают как выходные значения. На рисунке 8 представлены структуры АНСВ с шестью входами и одним выходом для прогнозирования ОЗК, а сводка параметров и факторов, учитываемых при разработке модели АНСВ, представлена в таблице 3.

Рис. 8. Структуры АНСВ (а) звена-1, (б) звена-2, (в) звена-3, (г) звена-4 и (д) звена-5 для решения ОЗК Fig. 8. Structures of ANFIS (a) link-1, (b) link-2, (c) link-3, (d) link-4 and (e) link-5 for solving inverse kinematics problem

На рисунке 9 приведена блок-схема алгоритма программного компонента обратной задачи кинематики.

Таблица 3. Параметры и факторы моделей АНСВ для ОЗК Table 3. Parameters and Factors of ANFIS Models for inverse kinematics problem

Звено AHCB-1 AHCB-2 AHCB-3 AHCB-4 AHCB-5

Количество входов 6 6 6 6 6

Количество выходов 1 1 1 1 1

Тип функций принадлежности Gaussian Gaussian Gaussian Gaussian Gaussian

Количество функций принадлежности 23 21 25 26 31

Количество узлов 331 303 359 373 443

Рис. 9. Блок-схема алгоритма программы обратной задачи кинематики Fig. 9. Block diagram of the program algorithm for the inverse kinematics

7. Разработка программного компонента решения обратной задачи динамики манипулятора. Метод Ньютона - Эйлера для рушения ОЗД. Определение самих управляющих крутящих моментов, обеспечивающих требуемые законы движения звеньев, является обратной задачей динамики. Алгоритм Ньютона - Эйлера состоит из двух частей - прямой рекурсии и обратной рекурсии. Прямая рекурсия позволяет определить скорости и ускорения звеньев, обобщенные силы и моменты сил, действующих на

все звенья 1 - п. Рекурсивные уравнения имеют следующий вид:

^1+1 = Щ+1&1 + 0;+1.2Г;+1 с°¡+1 = Щ со; + Щ х + вщ^т

Щ+1 = Д-+1 (соI х Ь?1 + ^ х Ь!+1) + щ +1 = со¡+1 х + а 1+1 х (ащ х Ь^+1+1) + Щ+1,

где - угловая скорость звена ¿; ¿>; - угловое ускорение звена г; Щ+1 - матрица перехода от системы координат звена I в систему координат звена I + 1; 0; - угловая скорость вращения шарнира I; 0; - угловое ускорение вращательного шарнира I; - ось вращательного сочленения [; Ъ1+ - вектор от начала системы координат I до начала системы координат I + 1; Ъ1С - вектор от начала системы координат I до центра масс звена I; щ - ускорение начала системы координат звена I; ¿>'с - ускорение центра масс звена ¿.

Зная линейное и угловое ускорения центра масс для каждого звена, можно использовать уравнения Ньютона - Эйлера для вычисления моментов сил инерции, приложенных в центре масс каждого из звеньев. Таким образом, имеем

Рг+1 = тц1'Ъс1 N¡+1 = и+1Сд¡+1 + х

где р1 - общая внешняя сила на звено I; т; - общая масса звена I; Ы^ - суммарный внешний крутящий момент на звене I; II - тензор инерции звена I относительно его центра масс. Обратная рекурсия требует вычисления сил и моментов сил взаимодействия, а также моментов, развиваемых в приводах, начиная от конечного звена манипулятора (п) и обратно к основанию.

/1 = Я!+1 ^+1 + Р1, т = N1 + Щ+1п1+1 + ъ1с, х Р1 + Ъ\+1 х Щ+1/¡+1, т1 = пТ '¿I,

где £ - сила, действующая на звено (г) со стороны звена (г"1); п; - момент, действующий на звено (г) со стороны звена (Г1); ъ - входной крутящий момент в шарнире (г). На рисунке 10 представлена блок-схема алгоритма для метода Ньютона - Эйлера, который используется для решения обратной задачи динамики манипулятора [2].

Рис. 10. Блок-схема алгоритма Ньютона - Эйлера для решения обратной задачи динамики манипулятора Fig. 10. Block diagram of the Newton - Euler algorithm for solving the inverse dynamics problem of manipulator

8. Адаптивная нейро-нечеткая система вывода «АНСВ» для рушения ОЗД. Для прогнозирования и крутящего момента сочленений звеньев манипулятора используются 5 АНСВ. В каждой АНСВ, значения

(0;, 0;, 0;), задающие векторы положений, скоростей и ускорений в шарнирах соответственно работают как входные значения, а значения (г;), задающие векторы крутящего момента, работают как выходные значения. На рисунке 11 представлены структуры АНСВ с двенадцатью входами и одним выходом для прогнозирования ОЗД, а сводка параметров и факторов, учитываемых при разработке модели АНСВ, представлена в таблице 4.

(д)

Рис. 11. Структуры АНСВ (а) звена-1, (б) звена-2, (в) звена-3, (г) звена-4 и (д) звена-5 для решения ОЗД Fig. 11. Structures of ANFIS (a) link-1, (b) link-2, (c) link-3, (d) link-4 and (e) link-5 for solving inverse dynamics problems

Таблица 4. Параметры и факторы моделей АНСВ для ОЗД Table 4. Parameters and Factors of ANFIS Models for inverse dynamics problem

Звено AHCB-1 AHCB-2 AHCB-3 AHCB-4 AHCB-5

Количество входов 12 12 12 12 12

Количество выходов 1 1 1 1 1

Тип функций принадлежности Gaussian Gaussian Gaussian Gaussian Gaussian

Количество функций принадлежности 12 11 12 12 11

Количество узлов 327 301 327 327 301

На рисунке 12 приведена блок-схема алгоритма программного компонента обратной задачи динамики.

Рис. 12. Блок-схема алгоритма программы обратной задачи динамики Fig. 12. Block diagram of the program algorithm for the inverse dynamics

9. Результаты моделирования. При запуске приложения на экране появляется форма, см. рисунок 5. В режиме прямой кинематики пользователь определяет значения углов, перетаскивая ползунок в пяти суставах соответственно или вводя значение углов через текстовое поле (показано в окне в верхней центральной части экрана). При изменении значений углов манипулятор в 3D-пространстве будет перемещаться в соответствующие положения и ориентации в режиме реального времени (отображается в окне в правой части экрана). На основе заданных значений углов звеньев программа вычисляет положение и ориентацию рабочего органа при нажатии кнопки «Calculate». Как показано на рисунке 13, значения углов пяти звеньев манипулятора и их соответствующее положение и ориентация рабочего органа показаны в текстовых полях.

Рис. 13. Программа в режиме прямой кинематики Fig. 13. Program in forward kinematics mode

В режиме обратной кинематики определяется вектор обобщенных координат сочленений звеньев, который позволяет манипулятору достичь желаемых положения и ориентаций рабочего органа. Желаемое положение и ориентацию рабочего органа манипулятора можно настроить, введя положение и ориентацию с помощью текстовых полей (показано в окне в верхней левой части экрана) или исходя из результата режима прямой кинематики (рисунок 14). В методе расчета выбор включает возможность использования метода АНСВ или численного метода. Затем вектор обобщенных координат сочленений звеньев будет рассчитано в режиме реального времени по обратному кинематическому алгоритму программы-скрипта (см. рисунок 9).

Рис. 14. Программа в режиме обратной кинематики Fig. 14. Program in inverse kinematics mode

Режим обратной динамики определяет требуемые крутящие моменты для обеспечения движения исполнительного звена манипулятора по заданной траектории. В этом режиме, во-первых, необходимо настроить траекторию рабочего органа в обратной динамике. Здесь в программе используется метод планирования траектории на основе вектора обобщенных координат шарнирных сочленений звеньев манипулятора. Пположения, скорости и ускорения сочленений будут рассчитываться с помощью про-грммы формирования траектории. В методе расчета выбор включает возможность использования метода АНСВ или численного метода. Крутящие моменты каждого сочленения, требуемые для обеспечения движения по заданной траектории, будут рассчитываться по обратному динамическому алгоритму программы-скрипта (см. рисунок 12). В виртуальной среде можно отобразить траекторию движения

рабочего органа манипулятора, рисунок 15. А также требуемые крутящие моменты, положение, угловая скорость и угловое ускорение каждого звена могут отобразиться с помощью графиков, которые могут служить ориентиром для проектирования системы управления и конструкции манипулятора.

Рис. 15. Программа в режиме обратной динамики Fig. 15. Program in inverse dynamics mode

Заключение. В данной работе использован язык программирования MATLAB для программирования математического моделирования. Для реализации 3Б-модели манипулятора использована САПР-программа «SolidWorks». Разработаны программные модули для компьютерного и имитационного моделирования перемещения манипулятора в рабочей зоне со следующими функциями: визуализация 3Б-моделирования; взаимодействие с пользователем через графический интерфейс; расчет ОЗК манипулятора на основе метода Левенберга - Марквардта; расчет ОЗК манипулятора на основе АНСВ; расчет ОЗД манипулятора на основе метода Ньютона - Эйлера и визуализация результатов; расчет ОЗД манипулятора на основе АНСВ и визуализация результатов; формирование траектории для целевого положения и ориентации рабочего органа манипулятора; имитационное моделирование движения манипулятора по заданной траектории.

Список литературы

1. Раин Т., Довгаль В. М., Ян Н. С. 2018. Моделирование кинематического управления роботом-манипулятором «Intelbot» на основе адаптивной нейро-нечеткой системы вывода (ANFIS). Научные ведомости БелГУ. Сер. Экономика. Информатика, 45(3): 497-509.

2. Раин Т., Ян Н. С. 2019. Моделирование динамики манипулятора с использованием адаптивной нейро-нечеткой системы вывода. Научный журнал «Моделирование, оптимизация и информационные технологии», 7(4): 1-14.

3. Adam S. A., Zhou Ji-Pin, Zhang Yi-hua. 2017. Modeling and simulation of 5DOF robot manipulator and trajectory using MATLAB and CATIA. 3rd International Conference on Control, Automation and Robotics (ICCAR): 36-40. D0I:10.1109/ICCAR.2017.7942657.

4. Amit T., Vinod K. 2020. Design, simulation, and analysis of a 6-axis robot using robot visualization software. IOP Conference Series: Materials Science and Engineering, 872: 1-9. DOI 10.1088/1757-899X/872/1/012040

5. Chauhan S. S., Khare A. K. 2020. Kinematic Analysis of the ABB IRB 1520 Industrial Robot Using RoboAnalyzer Software. Evergreen. Joint Journal of Novel Carbon Resource Sciences & Green Asia Strategy, 07(04): 510-518.

6. Dey U., Cheruvu S. K. 2020. A web-based integrated GUI for 3D modeling, kinematic study, and control of robotic manipulators. Computer Applications in Engineering Education, 28(4): 1028-1040.

7. George E. I., Smith R., Levy J. S., Brand T. C. 2019. Simulation in Robotic Surgery. Comprehensive Healthcare Simulation: Surgery and Surgical Subspecialties, Comprehensive: 191-220. https://doi.org/10.1007/978-3-319-98276-2_17

8. Kuruganti Y. S., Ganesh A. S. D., Ivan D. D., Chittawadigi R. G. 2021. Effective Teaching of Homogenous Transformations and Robot Simulation Using Web Technologies. Congress on Intelligent Systems. CIS 2020. Advances in Intelligent Systems and Computing, 1335: 687-699.

9. Maram S., Yashaswi K., Chittawadigi R., Saha S. 2019. Effective Teaching and Learning of Homogenous Transformation Matrix using RoboAnalyzer Software. In Proceedings of the Advances in Robotics (AIR 2019): 4th International Conference of the Robotics Society: 1-5. https://doi.org/10.1145/3352593.3352611

10. Mickoski I., Mickoski H., Djidrov M. 2018. Dynamic modeling and simulation of three-member robot manipulator. Mathematical Models in Engineering, 4(4), Issue 4: 183-190. https://doi.org/10.21595/mme.2018.20319

11. Othayoth R. S., Chittawadigi R. G., Joshi R. P., Saha S. K. 2017. Robot kinematics made easy using RoboAnalyzer software. Computer Applications in Engineering Education 25(5): 669-680.

12. Sabnis C. V., Anjana N. R., Talli A., Giriyapur A. C. 2021. Modelling and Simulation of Industrial Robot Using SolidWorks. Advances in Industrial Machines and Mechanisms. Select Proceedings of IPROMM 2020: 173-182. https://doi.org/10.1007/978-981-16-1769-0_16

13. Shivani R., Shruti T., Chaitali P. 2017. A Parallel Study of Designing and Simulation of Industrial Robotics. International Journal of Electrical, Electronics and Data Communication (IJEEDC), 5(2): 55-60.

14. Sinha S. S., Chittawadigi R. G., Saha S. K. 2018. Inverse Kinematics for General 6 R Manipulators in RoboAnalyzer. The 5th Joint International Conference on Multibody System Dynamics (IMSD 2018): 1-9.

15. Talli A., Marebal D. 2021. Kinematic Analysis and Simulation of Robotic Manipulator Based on RoboAnalyzer. Smart Sensors Measurements and Instrumentation. Lecture Notes in Electrical Engineering, 750: 59-69.

16. Xu X. et al., 2018. Robotic kinematics teaching system with virtual reality, remote control and an on-site laboratory, Int. J. Mech. Eng. Educ. 48(3): 197-220.

17. Yang L., Zhang X. 2015. Dynamics Modeling and Simulation of Robot Manipulator. Intelligent Robotics and Applications. Lecture Notes in Computer Science, 9246: 524-535. https://doi.org/10.1007/978-3-319-22873-0_47

References

1. Rain T., Dovgal V. M., Yan N. S. 2018. Modelling of the adaptive neuro-fuzzy inference system based control of 5-dof robotic manipulator "Intelbot". Belgorod State University Scientific Bulletin. (Economics. Information Technologies), 45(3): 497-509 (in Russian).

2. Rain T., Yan N. S. 2019. Dynamic modelling of manipulator using adaptive neuro fuzzy inference system Modeling, Optimization And Information Technology (MOIT), 7(4): 1-14 (in Russian).

3. Adam S. A., Zhou Ji-Pin, Zhang Yi-hua. 2017. Modeling and simulation of 5DOF robot manipulator and trajectory using MATLAB and CATIA. 3rd International Conference on Control, Automation and Robotics (ICCAR): 36-40. DOI:10.1109/ICCAR.2017.7942657.

4. Amit T., Vinod K. 2020. Design, simulation, and analysis of a 6-axis robot using robot visualization software. IOP Conference Series: Materials Science and Engineering, 872: 1-9.

DOI 10.1088/1757-899X/872/1/012040

5. Chauhan S. S., Khare A. K. 2020. Kinematic Analysis of the ABB IRB 1520 Industrial Robot Using RoboAnalyzer Software. Evergreen. Joint Journal of Novel Carbon Resource Sciences & Green Asia Strategy, 07(04): 510-518.

6. Dey U., Cheruvu S. K. 2020. A web-based integrated GUI for 3D modeling, kinematic study, and control of robotic manipulators. Computer Applications in Engineering Education, 28(4): 1028-1040.

7. George E. I., Smith R., Levy J. S., Brand T. C. 2019. Simulation in Robotic Surgery. Comprehensive Healthcare Simulation: Surgery and Surgical Subspecialties, Comprehensive: 191-220. https://doi.org/10.1007/978-3-319-98276-2_17

8. Kuruganti Y. S., Ganesh A. S. D., Ivan D. D., Chittawadigi R. G. 2021. Effective Teaching of Homogenous Transformations and Robot Simulation Using Web Technologies. Congress on Intelligent Systems. CIS 2020. Advances in Intelligent Systems and Computing, 1335: 687-699.

9. Maram S., Yashaswi K., Chittawadigi R., Saha S. 2019. Effective Teaching and Learning of Homogenous Transformation Matrix using RoboAnalyzer Software. In Proceedings of the Advances in Robotics (AIR 2019): 4th International Conference of the Robotics Society: 1-5. https://doi.org/10.1145/3352593.3352611

10. Mickoski I., Mickoski H., Djidrov M. 2018. Dynamic modeling and simulation of three-member robot manipulator. Mathematical Models in Engineering, 4(4), Issue 4: 183-190. https://doi.org/10.21595/mme.2018.20319

11. Othayoth R. S., Chittawadigi R. G., Joshi R. P., Saha S. K. 2017. Robot kinematics made easy using RoboAnalyzer software. Computer Applications in Engineering Education 25(5): 669-680.

12. Sabnis C. V., Anjana N. R., Talli A., Giriyapur A. C. 2021. Modelling and Simulation of Industrial Robot Using SolidWorks. Advances in Industrial Machines and Mechanisms. Select Proceedings of IPROMM 2020: 173-182. https://doi.org/10.1007/978-981-16-1769-0_16

13. Shivani R., Shruti T., Chaitali P. 2017. A Parallel Study of Designing and Simulation of Industrial Robotics. International Journal of Electrical, Electronics and Data Communication (IJEEDC), 5(2): 55-60.

14. Sinha S. S., Chittawadigi R. G., Saha S. K. 2018. Inverse Kinematics for General 6 R Manipulators in RoboAnalyzer. The 5th Joint International Conference on Multibody System Dynamics (IMSD 2018): 1-9.

15. Talli A., Marebal D. 2021. Kinematic Analysis and Simulation of Robotic Manipulator Based on RoboAnalyzer. Smart Sensors Measurements and Instrumentation. Lecture Notes in Electrical Engineering, 750: 59-69.

16. Xu X. et al., 2018. Robotic kinematics teaching system with virtual reality, remote control and an on-site laboratory, Int. J. Mech. Eng. Educ. 48(3): 197-220.

17. Yang L., Zhang X. 2015. Dynamics Modeling and Simulation of Robot Manipulator. Intelligent Robotics and Applications. Lecture Notes in Computer Science, 9246: 525-535. https://doi.org/10.1007/978-3-319-22873-0_47

Конфликт интересов: о потенциальном конфликте интересов не сообщалось.

Conflict of interest: no potential conflict of interest related to this article was reported.

Поступила в редакцию 26.12.2022 Поступила после рецензирования 13.02.2023 Принята к публикации 17.02.2023

Received 26.12.2022 Revised 13.02.2023 Accepted 17.02.2023

СВЕДЕНИЯ ОБ АВТОРЕ Ту Раин - научный соискатель кафедры математического и программного обеспечения информационных систем, Белгородский государственный национальный исследовательский университет ул. Победы, 85, Белгород, 308015, Россия

INFORMATION ABOUT THE AUTHOR

Thu Rain - Research Applicant, Department of Mathematical and Software Information Systems, Belgorod National Research University, Belgorod, Russia

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.