CC BY
105
МАШИНОСТРОЕНИЕ И МАШИНОВЕДЕНИЕ
УДК 681.5.015
ПЛАНИРОВАНИЕ ТРАЕКТОРИЙ РОБОТОВ-МАНИПУЛЯТОРОВ В ТЕХНОЛОГИЧЕСКОМ ПРОЦЕССЕ ТОЧЕЧНОЙ КОНТАКТНОЙ СВАРКИ
М. М. КОЖЕВНИКОВ, И. Э. ИЛЮШИН, А. В. СТАРОВОЙТОВ, В. Н. КОСЫРЕВ
Учреждение образования «Могилевский государственный университет продовольствия», Республика Беларусь
Введение
Задача планирования траектории промышленных роботов-манипуляторов с учетом сложной геометрии рабочего пространства и технологических ограничений возникает при создании современных роботизированных технологических комплексов (РТК) точечной контактной сварки (ТКС). Решение такой задачи позволит повысить эффективность эксплуатации действующих РТК точечной контактной сварки, а также сократить сроки технического переоснащения и переналадки оборудования на предприятиях машиностроительной отрасли.
В известных работах предложен ряд алгоритмов планирования траекторий антропоморфных роботов-манипуляторов, позволяющих эффективно обойти как проблему размерности конфигурационного пространства, так и учесть сложную геометрию препятствий в рабочем пространстве. Подробный обзор и анализ таких алгоритмов представлен в фундаментальных работах [1], [2]. Эти алгоритмы основаны на дискретной модели конфигурационного пространства робота, формируемой путем поиска свободных от столкновения положений робота и локальных участков траекторий между локальными положениями. Далее эта модель используется для глобального поиска траектории между заданным начальным и конечным положением робота. В частности, в работе [3] предложен вероятностный алгоритм планирования траектории, который ведет поиск нескольких решений, что увеличивает вероятность получения результата за фиксированное время. В работах [4], [5] представлены алгоритмы планирования, которые для решения задачи планирования используют концепцию мультиграфа задачи движения (taskmotion тпШ^арк, ТММ).
Необходимо отметить, что использование таких алгоритмов при планировании траектории сварочных роботов-манипуляторов существенно осложняется тем, что они используют нерегулярную структуру соседних элементов мультиграфа для описания конфигурационного пространства робота [6]—[12], соответственно, траектория робота может быть найдена за конечное время лишь с определенной вероятностью, также практически невозможно учесть технологические ограничения на положение и ориентацию сварочных клещей.
Целью данной работы является разработка нового метода планирования траекторий роботов-манипуляторов, основанного на детерминистической дискретизации пространства углов ориентации клещей ТКС относительно шва. В отличие от известных этот метод эффективно учитывает технологические ограничения на ориентацию сварочных клещей и сложную форму препятствий, характерную для РТК точечной контактной сварки.
Метод планирования траектории сварочного робота-манипулятора
Рассмотрим типичную компоновку РТК точечной контактной сварки (рис. 1, а), включающую в себя робот-манипулятор, оснащенный клещами, и свариваемую конструкцию, закрепленную на кондукторной плите с помощью прижимов. На поверхности конструкции определена модель сварного шва в виде множества точек {р
декартовы координаты которых определяются множеством векторов {xi Ориентация электродов сварочных клещей в каждой точке шва р определяется двумя углами а и Р (рис. 1, б). Первый задает угол наклона плоскости движения электрода, второй - угол наклона электрода к линии шва. Величина углов а и Р в технологическом процессе точечной контактной сварки может изменятся в допустимом диапазоне ±10°. Угол у определяет совместно с а и Р ориентацию сварочных клещей и может принимать произвольные значения в диапазоне ±180° [13].
а) б)
Рис. 1. Роботизированный технологический комплекс точечной контактной сварки и ориентация сварочных клещей: а - позиционирование технологического инструмента в точке р • б - углы ориентации технологического инструмента в точке р {
С учетом этого зададим допустимые диапазоны изменения углов ориентации сварочных клещей в виде:
а ■ <а<а • В ■ <В<В • у ■ <у<у (1)
^шт — ^ — шах > Ршт — Р — Ршах> ! шт — ! — ! шах' \ /
Разобьем допустимые диапазоны изменения углов ориентации с параметром дискретизации п и сформируем таким образом следующие множества значений:
{, X{Р, X=1; (у, X(2)
где а1 =аmin; аn =аmax; ßl = ^ ßn =ßmax; Yl = Ymin; Yn = Ymax'
Тогда дискретное пространство углов ориентации сварочных клещей, помещенных в точку шва p, будет содержать N0 = n3 точек с координатами, определяемыми
множеством векторов [а1 ., Р., у..]Т, . = 1, ..., N0. Применение такого подхода к представлению углов ориентации основано на результатах, полученных в работах [2], [3], и используется в предлагаемом методе планирования траектории роботов с целью учета ограничений на ориентацию сварочных клещей. Наглядно такой подход к дискретизации пространства углов ориентации показан на рис. 2.
Рис. 2. Дискретное пространство углов ориентации сварочных клещей
Вектор, описывающий углы в сочленениях робота-манипулятора, обеспечивающие позиционирование сварочных клещей в точку шва р { с координатами х, и ори-
ентацией клещей [а., Р., у. ]Т, может быть определен следующим образом:
ц. = кп([а.., р., у . ]Т, X,., еоп/),
(3)
где Шп(*) - функция вычисления обратного кинематического преобразования; еоп/ - индикатор конфигурации робота-манипулятора.
Необходимо отметить, что в данной работе рассматривается класс промышленных роботов-манипуляторов, без кинематической избыточности, для которых при заданном значении индикатора конфигурации еоп/ решение (3) единственно. Методы решения (3) подробно исследованы в работах [6], [13]. Определим в конфигурационном пространстве робота-манипулятора множество конфигураций, соответствующих точке шва р, и множеству допустимых в этой точке дискретных значений
углов ориентации [а., Р.., у. ]Т,. = 1, ..., N0 следующим образом:
Ц = {;Ьп([а., р., у.]Т
х,., еоп,
А п С/,
(4)
где С/ - множество векторов, определяющее свободное от столкновений с препятствиями конфигурационное пространство робота-манипулятора:
С/ = {ц|М (д)п В = 0 X (5)
где М(ц) - геометрическая модель робота-манипулятора в конфигурации; qmm < Ц < Цшах, Цшт, Цшах - векторы, определяющие нижнее и верхнее конструктивные ограничения на изменение углов в сочленениях робота-манипулятора; В - множество препятствий.
Решение задачи моделирования свободного от столкновений конфигурационного пространства С/ (5) выполнено с использованием алгоритмов, предложенных в предыдущих авторских работах [14], [15]. Программные реализации этих алгоритмов уже успешно интегрированы в САПР ЯоЬошах [15], в которой проводилось тестирование предложенного метода.
Необходимо отметить, что в качестве препятствий в РТК точечной контактной рассматриваются все его элементы, находящиеся в рабочей зоне робота и препятствующие его движению по перемещению клещей, а именно: свариваемая конструкция, прижимные приспособления, кондукторная плита, ограждение РТК и т. д. В качестве критерия качества траектории движения робота манипулятора при сварке шва предлагается использовать суммарное время перемещения сварочных клещей по точкам шва:
т = Жг + р / V, (6)
где Лt - время сварки одной точки; р - длина пути сварочных клещей при их движении в направлении от начальной к конечной точке сварки; V - скорость движения сварочных клещей.
Тогда задача планирования траектории движения робота-манипулятора по перемещению сварочных клещей по точкам шва р1 может быть сформулирована следующим образом: среди всех траекторий, последовательно соединяющих конфигурации робота-манипулятора, входящие в множества ц1, ц2, •••, Цы и определяемые выражением (4), найти траекторию с минимальным суммарным временем перемещения сварочных клещей по точкам шва (6).
Для ее решения поставленной задачи разработана процедура, включающая следующие этапы.
1. Формируется модель свободного конфигурационного пространства робота (5) в виде неориентированного графа:
БС/ = (V, Е). (7)
Вершины V ^ С/ этого графа представляют собой множество свободных от столкновений конфигураций робота. Формирование множества V осуществляется следующим образом: генерируется конфигурация робота-манипулятора и выполняется тест столкновения робота с препятствиями. Если столкновений нет, то конфигурация добавляется в множество V, в противном случае она отбрасывается. Ребрам Е графа ставятся в соответствие «простые» (прямолинейные) участки траекторий сварочных клещей между свободными от столкновений конфигурациями робота из множества V.
2. Выполняется поиск «простых» траекторий между элементами множеств Ц и Ц+1, вычисляемых по (4). Если таковых не существует (не существует прямолинейной траектории сварочных клещей между точками сварного шва р1 и р1+1), то выполняется поиск «простых» траекторий между конфигурациями из множеств Ц и ц1+1 и конфигурациями из множества Е, лежащих в окрестности Ц и ц1+1 . Если таковые существуют, то соответствующее ребро добавляется в множество V, а конфигурации Ц
и (^добавляются в множество Е. Весовой коэффициент каждого ребра вычисляется следующим образом: тг = рг / V, где рг - длина «простого» пути сварочных клещей между элементами множества Е.
3. Шаги 1-2 повторяются для всех точек свариваемого шва {pi }"=1. Повторение
этих шагов позволяет сформировать неориентированный граф БС/, который включает как конфигурации робота, соответствующие точкам свариваемого шва, так и дополнительные (промежуточные) конфигурации, необходимые для обхода препятствий, а также «простые» участки траекторий между этими конфигурациями.
4. Выполняется поиск множества кратчайших путей на графе БС/ от элементов множества ( до элементов множества С. Из полученного таким образом множества путей выбирается такой путь, при перемещении робота-манипулятора по «простым» участкам траектории которого суммарное время передвижения сварочных клещей (6) будет минимальным.
Таблица 1
Алгоритм планирования траектории для РТК ТКС
Исходные данные: Геометрическая модель РТК ТКС - М((), В; Геометрическая модель шва - {х1 , {/1 }|=1.
1 i ^ 1; V ^ 0; E ^ 0;
2 повторять
3 Gen(q');
4 если M(q) n B = 0
5 то V ^ qi;
6 E ^ Lin(q\ E);
7 i ^ i + 1;
8 до тех пор пока i < Nd;
9 i ^ 1;
10 повторять
11 q ^ search(a!, ß!, уг, X, conf);
12 q'+1 ^ search(ai+l, ßi+1, yi+1, xi+1, conf);
13 Если Lin(q\ qi+1) Ф 0
14 то V ^ (q\ ql + 1), E ^ (Lin(q\ E), Lin(ql+1, E)), т ^ (weight(Lin(ql, E), Lin(ql + 1, E));
15 i ^ i + 1;
16 до тех пор пока i < N;
17 Trag ^ Graph Search (V, E, т, q1, qN);
18 path ^ OptTrag(Trag).
Алгоритм планирования траектории для РТК ТКС
С учетом специфики и возможностей геометрического моделирования роботов-манипуляторов в современных САО-системах на основе предложенного метода разработан алгоритм планирования траектории, ориентированный на интеграцию в модуль автономного программирования РТК точечной контактной сварки, приведенный в табл. 1. Алгоритм использует следующие обозначения: {/ — множество векторов, определяющих направление подхода сварочных клещей к точкам свариваемого шва pi; Gen(q1) - функция генерации некоторой конфигурации робота-манипулятора (; Lin((, Е) - функция генерации линейного («простого») участка траектории между конфигурацией ( и конфигурациями, входящими в множество Е; N - количество вершин графа БС/ search(a\ р1, у1, х1, соп/) - функция поиска сво-
бодных от столкновений конфигураций робота в точке свариваемого шва pi; weight(e1, е2) - функция вычисления весовой функции тг для ребер графа ei и е2; GraphSearch(V, E, т, q1, qN) - функция поиска кратчайших путей на графе DCf - элементов множества q1 до элементов множества q; OptTrag(Trag) - функция поиска оптимального в смысле критерия (3) пути path из множества путей Trag.
в) г)
Рис. 3. Моделирование траектории движения робота 1Я161 в процессе ТКС: а - позиционирование технологического инструмента в точке р2; б - позиционирование технологического инструмента в точке р3; в - вид сверху на РТК с позиционированием технологического инструмента в точке р2; г - вид сверху на РТК с позиционированием технологического инструмента в точке р3
Исследование эффективности метода
Исследование эффективности предложенного метода выполнялось в среде САПР ЯОВОМАХ. Разработанный алгоритм планирования траектории реализован на языке программирования С++ в виде автономного модуля и интегрирован в данную САПР. В качестве объекта использовалась роботизированная ячейка, включающая робот-манипулятор ГОЛ61, оснащенный клещами для точечной контактной сварки, свариваемую деталь (деталь кабины автомобиля ГАЗель), кондукторную плиту и технологическую оснастку (рис. 3). Свариваемый шов, а также фрагменты траекторий движения сварочных клещей при обходе прижимов показаны на рисунках утолщенной линией. В качестве препятствий в данном случае рассматриваются сварная конструкция, технологическая оснастка (прижимы), а также кондукторная плита. На рис. 3, а и б показана полученная на основе разработанного алгоритма последовательность движений робота -манипулятора и сварочных клещей. Электрод клещей движется от точки р1 к точке р2 по прямолинейной траектории, далее посредством двух промежуточных точек рр21, рр22 выполняется обход прижима и выход на точку сварного шва р3 (рис. 3, а, в, г). Аналогич-
ным образом сварочные клещи перемещаются по остальным 13 точкам сварного шва с автоматическим обходом второго прижима через промежуточные точки рр111, рр112 (рис. 3, б). Во всех 13 точках сварного шва ориентация сварочных клещей остается в допустимых пределах: а = ±10° и Р = ±10°.
Важно отметить, что в приведенном примере реализации каждому частному положению сварочных клещей соответствует по 8 возможных решений обратной задачи кинематики робота-манипулятора ГОЛ61 для каждой тройки дискретных углов ориентации (2) из области их допустимых значений (1). Таким образом, одна и та же траектория движения рабочей точки сварочных клещей может быть реализована путем движения робота-манипулятора ГОЛ61 через различные конфигурации из допустимого множества (4). Соответственно, реализованный алгоритм планирования траектории выполняет как поиск траекторий робота, проходящих через различные конфигурации из допустимого множества (4), так и выбор оптимальной траектории, обеспечивающей минимальное суммарное время перемещения сварочных клещей.
Таблица 2
Время генерации траектории обхода прижима при различных значениях
параметра дискретизации N
Параметр дискретизации Nd Количество тестов столкновения Время поиска траектории по обходу прижима, с
20 8000 0,3
50 25000 22,3
100 1000000 122,2
Для различных значений параметра дискретизации конфигурационного пространства Nd экспериментально было определено количество тестов столкновений и приблизительное время вычислений (табл. 2) по формированию участка траектории для автоматического обхода прижима. Эксперименты проводились на ЭВМ с тактовой частотой процессора 3 ГГц. Из табл. 2 видно, что алгоритм сходится за приемлемое для практики время.
На основе полученной траектории сформирована технологическая программа на языке программирования робота SRCL (Siemens Robot Control Language). Тестирование этой программы в подсистеме off-line программирования САПР ROBOMAX показало, что она обеспечивает свободное от столкновения движение манипулятора и требуемую ориентацию сварочных клещей. Таким образом, анализ результатов данных экспериментов позволяет сделать вывод о том, что предлагаемый подход эффективен при планировании траекторий в РТК точечной контактной сварки.
Заключение
В данной работе предложен новый метод планирования траектории промышленных роботов-манипуляторов для процесса точечной контактной сварки, который в отличие от известных позволяет эффективно учесть технологические ограничения на ориентацию сварочных клещей, а также сложную форму элементов роботизированного комплекса. Предложенный подход основан на детерминистической дискретизации пространства углов ориентации клещей ТКС относительно шва и их отображении в конфигурационное пространство робота.
Эффективность предложенного метода планирования подтверждается результатами тестирования в среде САПР ROBOMAX.
Литература
1. Principles of Robot Motion: Theory, Algorithms, and Implementations / H. Choset [et al.]. - Boston : MIT Press, 2005. - 680 p.
2. LaValle, S. M. Planning Algorithms / S. M. LaValle. - Cambridge University Press, Cambridge, U.K., 2006. - 1023 p.
3. Lahijanian, M. A. Sampling-Based Strategy Planner for Nondeterministic Hybrid Systems / M. A. Lahijanian, L. E. Kavraki, M. Y. Vardi // International Conference on Robotics and Automation, Hong Kong, China, 2014. - P. 3005-3012.
4. Iterative Temporal Motion Planning for Hybrid Systems in Partially Unknown Environments / M. R. Maly [et al.] // ACM International Conference on Hybrid Systems: Computation and Control (HSCC), Philadelphia, PA, USA, ACM, 2013. - P. 353-362.
5. Sucan, I. A. Accounting for Uncertainty in Simultaneous Task and Motion Planning Using Task Motion Multigraphs / I. A. Sucan, L. E. Kavraki // IEEE International Conference on Robotics and Automation. - St. Paul. - 2012. - P. 4822-4828.
6. Kavraki, L. E. Motion planning / L. E. Kavraki, S. M. LaValle. // Springer Handbook of Robotics ; editors: B. Siciliano and O. Khatib. - Springer-Verlag, 2008. - 1628 p.
7. Geraerts, R. J. A comparative study of probabilistic roadmap planners / R. J. Geraerts, M. H. Overmars // Algorithmic Foundations of Robotics V. - Berlin : Springer-Verlag, 2003. - P. 43-58.
8. Geraerts, G. J. Reachability-based Analysis for Probabilistic Roadmap Planners / G. J. Geraerts, M. H. Overmars // Journal of Robotics and Autonomous Systems. -2007. - № 55. - Р. 824-836.
9. Geraerts, R. J. Sampling and Node Adding in Probabilistic Roadmap Planners / R. J. Geraerts, M. H. Overmars // Journal of Robotics and Autonomous Systems. -2006. - № 54. - P. 165-173.
10. LaValle, S. M. On the relationship between classical grid search and probabilistic road-maps / S. M. LaValle, M. Branicky, S. R. Lindemann // International Journal of Robotic Research. - 2004. - № 23 (7/8). - P. 673-692.
11. Quasi-randomized path planning / M. Branicky [et al.] // International Conference on Robotic and Automation, Seoul, Korea, 2001. - P. 1481-1487.
12. Yershova, A. Improving motion planning algorithms by efficient nearest-neighbor searching / A. Yershova, S. M. LaValle // IEEE Transactions on Robotics. - 2007. -№ 23 (1). - P. 151-157.
13. Пашкевич, А. П. Автоматизированное проектирование промышленных роботов и робототехнологических комплексов для сборочно-сварочных производств / А. П. Пашкевич. - Минск : БГУИР, 1996. - 107 с.
14. Пашкевич, А. П. Синтез конфигурационного пространства роботов-манипуляторов на основе нейронных сетей / А. П. Пашкевич, М. М. Кожевников // Докл. БГУИР. -Минск, 2003. - Т. 1, № 2. - С. 121-128.
15. Пашкевич, А. П. Нейросетевая модель для синтеза конфигурационного пространства манипуляторов / А. П. Пашкевич, М. М. Кожевников // Нейрокомпьютеры: Разработка и применение. - 2004. - № 1. - С. 40-50.
Получено 02.11.2015 г.
