Аннотация 2
Введение 3
1 Описание роботов-манипуляторов 5
1.1 Задание ориентации звеньев робота 7
1.2 Представление Денавита-Хартенберга 9
1.3 Пример описания ориентации рабочего органа 13
2 Решение прямой задачи кинематики (ПЗК) для манипулятора PUMA560 16
2.1 Кинематика манипулятора Puma 560 16
2.2 Решение ПЗК для Puma 560 на языке программирования C++ 19
2.3 Результаты 22
3 Обратная задача кинематики (ОЗК) 25
3.1 Способы решения ОЗК 25
3.2 Проблемы решения ОЗК и предлагаемые решения 30
4 Решение ОЗК для манипулятора IRB 4600-40-2.55 в среде CoppeliaSim 32
4.1 Промышленный манипулятор IRB 4600-40-2.55 32
4.2 Среда моделирования CoppeliaSim 36
4.3 Обратная задача кинематики 37
4.4 Визуализация 43
Заключение 50
Список использованных источников и литературы 51
Приложение А Код программы для сцены 53
В основе всех действий робота лежит перемещение его рабочего органа. Интуитивно понятно: для осуществления движения концевой точки манипулятора необходимо каким- то образом двигать и звенья. Здесь важно понимать кинематику робота: как он устроен, каким образом соединяются его звенья, какие из них подвижные и какие выполняют движения. Кроме этого, необходимо уметь использовать разные способы определения положения рабочего органа в зависимости от его конструкции.
В стационарных промышленных роботах движение исполнительного рабочего органа является исполнительным и, соответственно, получается из перемещений и поворотов всех звеньев. Понимание, каким образом необходимо осуществить движение звеньев робота, чтобы рабочий орган оказался в конкретной точке рабочего пространства, необходимо для всех производственных операций. Безусловно, здесь важно понимать кинематику робота: как он устроен, каким образом соединяются его звенья, какие из них подвижные и какие выполняются движения. Кроме этого, необходимо уметь использовать разные способы определения положения рабочего органа в зависимости от его конструкции.
Одним из главных шагов в работе с роботами является решение обратной задачи кинематики. Она позволяет получить углы и перемещения всех звеньев робота для достижения конкретной точки в пространстве.
Целью работы является создание программ расчёта прямой и обратной задач кинематики промышленного робота-манипулятора.
Задачи, решаемые в работе:
1. Изучение метода решения прямой задачи кинематики робота-манипулятора PUMA
560;
2. Изучение языка программирования;
3. Создание расчётной программы для компьютера решения прямой кинематической
задачи, анализ результатов;
4. Изучение метода решения обратной задачи кинематики робота-манипулятора IRB
4600-40-2.55;
5. Изучение среды моделирования роботов CoppeliaSim;
6. Решение обратной кинематической задачи и визуализация движения звеньев
промышленного робот в CoppeliaSim, анализ результатов.
Объектом исследования является кинематика роботов-манипуляторов. Предметом исследования являются прямая и обратная задачи кинематики роботов-манипуляторов PUMA 560 и IRB 4600-40-2.55.
Теоретическую основу данной работы составляют важные, по мнению автора, труды Т.И. Горбенко «Основы мехатроники и робототехники», Дж. Крейга «Введение в робототехнику» и О. И. Борисова «Методы управления робототехническими приложениями».
Соответственно, к теоретическим методам познания, использованным в работе, можно отнести анализ литературы и способов решений прямой и обратной задач кинематики. В качестве эмпирических методов исследования в текущей работе использовалось математическое описание решения с элементами компьютерного моделирования.
Результаты и теоретическую информацию, описанные в данной работе, можно использовать для решения задач о планировании перемещений рабочего органа манипулятора, что является следующим логическим шагом после решения обратной задачи кинематики. Кроме этого, на основе приведенного материала можно моделировать более сложную траекторию движения робота.
В ходе работы создана программа расчёта прямой задачи кинематики и сделана визуализация движения звеньев промышленного робота-манипулятора.
Для описания положения рабочего органа относительно стойки, что является целью решения прямой задачи кинематики, было рассмотрено представление Денавита- Хартенберга, заключающееся во введении для каждого сочленения робота четырех параметров, по которым можно отследить изменение положения системы координат, связанной с одной кинематической парой, относительно системы координат, связанной с предыдущей кинематической парой. Этот метод был перенесен на робот-манипулятор Puma 560.
Кроме того, был изучен необходимый для создания программы функционал языка программирования c++ и среды разработки Microsoft Visual Studio, где было получено решение ПЗК для робота-манипулятора Puma 560. Проведен анализ результатов.
Решение ОЗК было рассмотрено на примере робота-манипулятора IRB 4600-40-2.55. Для него в среде моделирования CoppeliaSim была проведена визуализация движения звеньев и создана сцена. Анализ результатов проведен для нескольких режимов работы: с решением обратной задачи кинематики, без него и с целью, находящейся за пределами рабочей зоны робота.
1 Горбенко М. В. Основы мехатроники и робототехники : учеб. пособие / Горбенко М. В., Горбенко Т. И. - Томск : Томский государственный университет, 2012. - 126 с.
2 Крейг Д. Введение в робототехнику. Механика и управление / Д. Крейг. - М. : Институт компьютерных исследований, 2013. - 564 с.
3 IRB 4600, Data sheet [Электронный ресурс] // ABB, 2020. - URL:
https://search.abb.com/library/Download.aspx?DocumentID=ROB0109EN_G&LanguageCode= en&DocumentPartId=&Action=Launch (дата обращения: 23.05.2021)
4 Робот SCARA от FANUC, [Электронный ресурс] // FANUC, 2019. - URL:
https://www.fanuc.eu/ru/ru/страница-фильтра-роботов/scara-series/scara-sr-6ia (дата
обращения: 23.05.2021)
5 Портальный робот от KUKA, [Электронный ресурс] // KUKA, 2019. - URL: https://www.kuka.com/ru-ru/продукция-услуги/промышленная- робототехника/промышленные-роботы/линейные-роботы (дата обращения: 23.05.2021)
6 Corke P.I. A Simple and Systematic Approach to Assigning Denavit-Hartenberg Parameters / Peter I. Corke // IEEE Transactions on robotics. - 2007. - V. 23, is. 3. - P. 590-594.
7 Борисов О. И. Методы управления робототехническими приложениями : учеб. пособие / Борисов О. И., Громов В. С., Пыркин А. А. - СПб.: Университет ИТМО, 2016. - 108 c.
8 Unimate PUMA Mark III Robot 700 Series Models 761/762 Equipment Manual // US : Unimation Inc., 1986. - Pt. 2. - P. 332.
9 Corke P.I. The Unimation Puma servo system / Peter I. Corke. - Australia : CSIRO Division of Manufacturing Technology, 1994. - P. 54.
10 Unimate Puma Robot 550/560 Series and Programming manual. - US : Unimation Inc., 1982. - Pt. 1. - P. 325.
11 Горбенко Т. И. Практикум по теории механизмов и машин : учебное пособие / Т. И. Горбенко, М. В. Горбенко ; Том. гос. ун-т, Ин-т дистанционного образования. -Томск : ИДО ТГУ, 2010. - URL: http://vital.lib.tsu.ru/vital/access/manager/Repository/vtls:000405287 (дата обращения: 23.05.2021)
12 IRB 4600, Product specification [Электронный ресурс] // ABB, 2020. - URL: https://search.abb.com/library/Download.aspx?DocumentID=3HAC032885- 001&LanguageCode=en&DocumentPartId=&Action=Launch (дата обращения: 23.05.2021)
13 Сорокин С. В. Основы разработки и программирования робототехнических систем : учеб. пособие / Сорокин С. В., Солдатенко И. С. - Тверь : Тверской государственный университет, 2017. - 157 с.
14 Бжихатлов И. А. Моделирование робототехнических систем в программе V- REP : учебно-методическое пособие / Бжихатлов И. А. - СПб.: Университет ИТМО, 2018. - 59 с.
15 Использование Remote API в робосимуляторе V-REP [Электронный ресурс] // Habr, 2015. - URL: https://habr.com/ru/post/268313/ (дата обращения: 23.05.2021)... 16