CC BY
40
Доклады БГУИР
2016 № 1 (95)
УДК 681.5.015
КОМБИНИРОВАННЫЙ МЕТОД СИНТЕЗА ТРАЕКТОРИЙ СБОРОЧНО-СВАРОЧНЫХ РОБОТОВ-МАНИПУЛЯТОРОВ В РАБОЧЕЙ
СРЕДЕ С ПРЕПЯТСТВИЯМИ
ММ. КОЖЕВНИКОВ, О.А. ЧУМАКОВ*, И.Э. ИЛЮШИН, А.В. СТАРОВОЙТОВ
Могилевский государственный университет продовольствия Шмидта, 3, Могилев, 3212027, Беларусь
*Белорусский государственный университет информатики и радиоэлектроники П. Бровки, 6, Минск, 220013, Беларусь
Поступила в редакцию 30 июля 2015
Предложен новый метод синтеза траекторий сборочно-сварочных роботов-манипуляторов в рабочей среде с препятствиями, который, в отличие от известных методов, позволяет эффективно учитывать сложную форму элементов роботизированного технологического комплекса. Эффективность разработанного метода подтверждается результатами тестирования.
Ключевые слова: робот-манипулятор, синтез траекторий, конфигурационное пространство.
Введение
Задача синтеза траекторий роботов-манипуляторов в рабочей среде с препятствиями возникает при создании современных промышленных роботизированных технологических комплексов (РТК) преимущественно в машиностроении. Поскольку данная задача является довольно трудоемкой, то разработка эффективных методов ее решения позволит повысить эффективность сборочно-сварочных технологических процессов за счет сокращения сроков ввода новых РТК в эксплуатацию и сокращения сроков переналадки действующих комплексов.
В известных работах предложен ряд алгоритмов синтеза траекторий роботов в среде с препятствиями [1, 2], которые основаны на дискретной модели свободного от столкновений конфигурационного пространства. Задача синтеза при этом сводится к поиску кратчайшего пути на графе, ребрам которого ставятся в соответствие линейные либо дуговые фрагменты траектории робота, при движении по которым отсутствуют столкновения и удовлетворяются конструктивные ограничения. В ряде последних исследований [3, 4] реализованы алгоритмы синтеза выполняющие поиск нескольких решений, что увеличивает вероятность нахождения траектории за фиксированное время. В частности, в работе [5] синтез реализован с использованием концепции мультиграфа задачи движения (ТММ).
Необходимо отметить, что известные алгоритмы синтеза траекторий позволяют эффективно обойти проблему размерности конфигурационного пространства роботов [6-9], но не учитывают форму препятствий и форму звеньев манипулятора, что приводит к реализации траекторий низкого качества с большим объемом движений [6]. При использовании таких алгоритмов траектория робота может быть найдена за конечное время также лишь с определенной вероятностью, т.е. свойство «полноты» решения теряется [6, 10].
В данной работе предложен новый комбинированный метод синтеза траекторий роботов-манипуляторов в рабочей среде с препятствиями, основанный на использовании решетчатой дискретизации «насыщенных» препятствиями зон конфигурационного пространства. Такой подход, в отличие от известных, позволяет эффективно учитывать
сложную форму препятствий, характерную для сборочно-сварочных роботизированных комплексов. В соответствии с этим подходом синтез свободной от столкновений траектории осуществляется путем поиска кратчайшего пути на графе, ребрам которого ставятся в соответствие линейные движения робота между промежуточными конфигурациями, найденными как путем рандомизированной дискретизации (в зонах с малым количеством препятствий), так и путем решетчатой дискретизации (в зонах с большим количеством препятствий сложной формы.) Такой метод позволяет синтезировать участки траекторий робота в наиболее сложных зонах выполнения технологических операций сборки/сварки без предварительной проверки его движений на столкновение, что обеспечивает приемлемое количество тестов столкновения при сохранении свойства «полноты» при фиксированном шаге дискретизации.
Комбинированный метод синтеза траектории роботов-манипуляторов
Рассматривается робот-манипулятор, имеющий n поворотных сочленений, в рабочей зоне которого расположено некоторое множество препятствий B = {Bi,B2,...,Bm}. Конфигурацию этого робота зададим в виде вектора q = [qi]T, где qi - величины углов в сочленениях (i = l:n). Ограничения на изменения углов в сочленениях зададим в виде q^ < q < qmax , где qmm, qmax— векторы, определяющие нижнее и верхнее конструктивные ограничения на изменение углов в сочленениях робота-манипулятора. Зададим геометрическую модель робота-манипулятора, установленного в конфигурацию q, в виде множества M(q). Тогда свободное от столкновений конфигурационное пространство определяется как
Cf ={q eC|M ( q )n B = 0}. (l)
Задача определения пересечения множеств M(q) и B решается путем проведения теста столкновения между роботом и препятствиями [2]. Прямолинейный участок траектории между двумя конфигурациями qa и qb (аФЪ, qa, qbeC/,) задается в виде множества векторов
db = {dk M(dk)nB = 0} , (2)
где dk= qa+(h/Nh)(qb-qa), h=0:Nh, Nh>N — параметр дискретизации прямолинейного участка траектории.
Дискретная конфигурация робота qbeC/, является соседней с конфигурацией qaeC/, если между ними существует прямолинейный участок траектории dab и D(qa, qb)<d, где D(») -симметричная функция, характеризующая расстояние между двумя локациями робота-манипулятора. Траектория, соединяющая стартовую qsi и целевую qSg конфигурации робота, представляет собой последовательность, состоящую из соседних конфигураций qsi, qs2,..., qsgeDC/, и прямолинейных участков, соединяющих эти конфигурации dsis2, dsis2,..., d(sg-i>g. В качестве критерия качества траектории движения робота манипулятора при сварке шва предлагается использовать суммарное время перемещения технологического инструмента:
т = NAt + p/v, (3)
где N - количество операций выполняемых роботом в технологическом процессе сборки/сварки, At — время выполнения одной операции, p — длина пути технологического инструмента при его движении в направлении от начальной к конечной локации, v — скорость движения технологического инструмента.
Тогда задача синтеза траектории робота-манипулятора может быть сформулирована следующим образом: среди всех последовательностей дискретных конфигураций qsi, qs2,..., qSgeC/, координаты которых лежат внутри области, ограниченной предельно допустимыми значениями углов в сочленениях q^ < q < qmx, найти последовательность, на которой достигает минимума критерий качества (3).
Для описания конфигурационного пространства робота применена статистическая модель, представленная в виде неориентированного графа R = (V, E). Вершины V этого графа
представляют собой множество свободных от столкновений конфигураций робота, координаты которых являются случайными величинами.
б
Рис. 1. Комбинированный подход к дискретизации конфигурационного пространства
робота-манипулятора
Формирование множества V, осуществляется следующим образом: генерируется случайная конфигурация робота-манипулятора и выполняется тест столкновения робота с препятствиями. Если столкновения нет, то конфигурация добавляется в множество V, в противном случае она отбрасывается. Ребрам Е графа ставятся в соответствие прямолинейные участки траекторий между свободными от столкновений конфигурациями рис. 1, а. Зона, насыщенная препятствиями (так называемый «узкий коридор» [1]) - рис. 1, б, дискретизируется регулярной решеткой, поскольку вероятность выявления такой зоны рандомизированным методом близка к нулю. Соответствующие вершины и ребра решетки добавляются в граф Я. Такой подход к формированию статистической модели позволяет эффективно решить проблему размерности, возникающую при планировании траекторий промышленных роботов-манипуляторов [1, 2, 6].
Предложенный комбинированный метод синтеза траектории предполагает реализацию следующих этапов.
1. Генерируется множество V, состоящее из Nmax свободных от столкновений конфигураций робота-манипулятора.
2. Выполняется поиск прямолинейных участков траекторий между соседними конфигурациями Цг, Ц] и найденные участки заносятся в множество Е.
3. Если между соседними конфигурациями Цг, ц нет прямолинейного участка траектории и эти конфигурации находятся в зоне, насыщенной препятствиями, то выполняется поиск криволинейного участка траектории между ц и ц, дискретезированного регулярной решеткой О. Если такой участок траектории найден, то он добавляется в граф Я.
4. Формирование множества Е выполняется путем циклического повторения шагов 2, 3 Ктах раз.
5. Выполняется поиск кратчайшего пути на графе Я исходя из критерия качества (3).
Алгоритм синтеза траектории роботов-манипуляторов
С учетом специфики и возможностей геометрического моделирования роботов-манипуляторов в современных CAD-системах на основе предложенного метода разработан алгоритм планирования траектории, ориентированный на интеграцию в систему автономного программирования сборочно-сварочных роботизированнных технологических комплексов (табл. 1). Алгоритм использует следующие обозначения. Randq - функция генерации вектора конфигурации с координатами. имеющими случайные значения в допустимом диапазоне qmm ^ q ^ qmax. Rand - функция генерации случайных целых чисел i Ф j в диапазоне от 1 до Nmax. EPath - функция вычисления прямолинейного участка траектории между двумя конфигурациями qi и q,-; TTest - функция, выполняющая оценку «насыщенности» окрестности конфигурации q препятствиями, путем генерации случайных конфигураций в ее окрестности и тестировании их на столкновение. В случае если количество столкновений превышает допустимый предел, функция TTest возвращает 1, указывая на то, что окрестность конфигурации q «насыщена» препятствиями. Connect - функция выполняющая поиск конфигураций (qS, qg) на решетке дискретизации G, являющихся соседними с
конфигурациями (д , д^ ) . ОгаркБеагек - функция поиска кратчайшего пути на графе Я исходя из критерия качества (3).
Таблица 1. Алгоритм синтеза траектории сборочно-сварочных роботов манипуляторов
Исходные данные: геометрическая модель РТК - M(q), B, начальная и целевая конфигурации робота - qs, qg.
1 —1; V— qs, qg,
2 повторять
3 qi—Randq;
4 если qi^Cf
5 то V— qi,
6 i—i+1;
7 до тех пор пока i <Мтх,
8
9 повторять
10 (ij)—Rand( 1 Nmax);
11 если (D(qi, qj)<d и EPath(qi, qj)*0)
12 то Е^ EPath(qi, qj)
13 иначе
14 если (D(qi, qj)<d и (TTest (qi)=1 или TTest (qj)=1))
15 то (qS, qg ) ^Connect (qt, q ,G),
16: R^SearchGridPath (qst, qg) ,
17: V^(EPath (q , qs) , EPpath (qj, qg) );
18 k^k+1;
19 до тех пор пока к <Kmax;
20 path^GraphSearch(R, qs, qg);
Особого внимания заслуживает рассмотрение процедуры БеагекОпёРа(к, разработанной на основе методики, предложенной в предыдущих работах авторов данной статьи [11-14]. Процедура выполняет поиск криволинейной траектории между двумя конфигурациями робота-манипулятора (д*, д^) , путем дискретизации окрестности данных конфигураций дискретной решеткой. Соответственно, в результате выполнения процедуры в граф Я добавляются вершины и ребра, принадлежавшие криволинейному участку траектории между (д*, д^) .
Алгоритм процедуры БеагекОпёРаЛ приведен в табл. 2.
Алгоритм использует следующие обозначения: N0 — начальное значение параметра дискретизации конфигурационного пространства робота решеткой; N1^ - максимально допустимое значение параметра дискретизации конфигурационного пространства робота решеткой; N - шаг изменения параметра дискретизации; Р — криволинейная траектория робота. Алгоритм использует следующие функции: шахД ) - функция, возвращающая
максимальное значение весовой ф из множества ; maxb( ф^) — функция, возвращающая
индекс Ь максимального значения весовой функции из множества фА ; ^(ф) — функция,
возвращающая конфигурацию робота, соответствующую значению весовой функции ф; ехр1оге^(фа), #(фь)) — функция проверки существования прямолинейного участка траектории между двумя конфигурациями робота q(фa) и q(фь) в соответствии с формулой (2). Если такой участок траектории существует, функция возвращает «1», в противном случае она возвращает «0».
Таблица 2. Алгоритм процедуры 8еагсЬСг1иРаШ
Исходные данные: геометрическая модель РТК - М(д), В, начальная и целевая конфигурации робота -
Ч* ч* , Ч* = Ч* ■
1 установить начальное значение параметра дискретизации N^N0;
2 повторять
3 вычислить Уа для параметра дискретизации N
4 установить весовые коэффициенты для ребер решетки Т^, ^ 1/3п (к=1:й);
5 повторять
6 вычислить весовую функцию фа (а=1:^);
7 а-^.51;
8 повторять
9 Ф^т^ );
10 Ь-^тахЬ( ф^ );
11 р^ехр1оге(д(фа), д(фь));
12 Р^Ыфа), 9(фь)};
13 если Ь = sg то возвратить фрагмент траектории Р;
14 а^Ь;
15 до тех пор пока р=0;
16 ^ ^0;
17 Р^0;
18 до тех пор пока ф^=0;
19
20 до тех пор пока N < Nmаx■
Данный алгоритм функционирует следующим образом. Первоначально конфигурационное пространство робота дискретизируется с низким разрешением N0 и предполагается, что между всеми соседними конфигурациями существуют прямолинейные участки траектории, т.е. всем весовым коэффициентам ребер решетки присваивается значение 1/3«. Далее вычисляется весовая функция для каждого узла решетки фа (а = 1:Nn) и ищется траектория между стартовой qSl и целевой qSg конфигурациями путем подъема в направлении градиента весовой функции узлов решетки. Для этого отрезки, соединяющие соседние конфигурации qa и чь , дискретизируются с высоким разрешением Nh в соответствии с (2) и для
каждой дискретной конфигурации робота йк выполняется тест столкновения. Если столкновения отсутствуют, то выбираются две новые конфигурации на решетке низкого разрешения в направлении градиента. Если обнаружено столкновение, то значение весового коэффициента ребра решетки устанавливается в нуль.
Значения весовой функции фа для каждого узла решетки вычисляются на основе следующей итерационной формулы:
ф!'+1)= /а (¿ТьД^ ^ ) , (4)
где I — номер итерации, Уа — параметр, значение которого определяется следующим образом: Уа = —1, если qa£Cf ;Уа = 1 если qa = qsg; Уа = 0 во всех остальных случаях. Нелинейная функция fa имеет следующий вид:
, . [ 0, если х < 0
/а (х)=капЬ(х), если х > 0' (5)
Величина весовых коэффициентов ребер решетки ТаЪ^ выбирается исходя из
достаточных условий сходимости итерационной процедуры (4), полученных в работах [11, 14]. В частности, Т^ = 13п, если существует прямолинейный участок траектории между
конфигурациями да и дь и Т. = 0 в противном случае.
б в Рис. 2. Роботизированная ячейка для дуговой сварки и траектории движения сварочной горелки
Исследование эффективности метода
Исследование эффективности предложенного метода выполнялось в среде САПР ROBOMAX. Предложенный алгоритм синтеза реализован на языке программирования С++ и интегрирован в данную САПР. В качестве объекта исследования использовалась роботизированная ячейка для дуговой сварки металлической конструкции, состоящей из 9 труб. Ячейка включает робот-манипулятор KR125, оснащенный сварочной горелкой (рис. 2, а). На трехмерную модель металлоконструкции нанесено 14 сварных швов, имеющих форму эллипса, изогнутого в пространстве. Предложенный алгоритм позволил выполнить синтез свободных от столкновений траекторий робота-манипулятора, обеспечивающих движение сварочной горелки вдоль каждого из 14 швов. На основе полученных траекторий сформированы технологические программы сварки на языке программирования робота SRCL (Siemens Robot Control Language). Тестирование этих программ в подсистеме off-line программирования САПР ROBOMAX показало, что они обеспечивают свободное от столкновений движение робота-манипулятора. Примеры позиционирования сварочной горелки на линии пространственного сварного шва, при выполнении роботом технологической программы, приведены на рис. 2, б, в. Анализ результатов данных экспериментов позволяет сделать вывод о том, что предлагаемый подход эффективен при синтезе траекторий роботов-манипуляторов в рабочей среде с препятствиями.
Заключение
Предложен новый комбинированный метод синтеза траекторий сборочно-сварочных роботов-манипуляторов в рабочей среде с препятствиями, основанный на использовании решетчатой дискретизации «насыщенных» препятствиями зон конфигурационного пространства. Такой подход, в отличие от известных, позволяет эффективно учитывать сложную форму препятствий, характерную для сборочно-сварочных роботизированных комплексов. В соответствии с этим подходом синтез свободной от столкновений траектории осуществляется путем поиска кратчайшего пути на графе, ребрам которого ставятся в соответствие линейные движения робота между промежуточными конфигурациями, найденными как путем рандомизированной дискретизации, так и путем решетчатой дискретизации в локальных зонах с большим количеством препятствий сложной формы. Эффективность предложенного метода планирования подтверждается результатами тестирования в среде САПР ROBOMAX.
COMBINED METHOD FOR TRAGECTORY SYNTHESES OF ASSAMBLY AND WELDING ROBOTIC-MANIPULATORS IN WORKSPACE WITH OBSTACLES
М.М. KOZHEVNIKOV, OA. CHUMAKOV, I.E. ILUSHIN, A.V. STAROVOITOV
Abstract
A new method is proposed for trajectory syntheses of assembly and welding robotic manipulators in workspace with obstacles, which in contrast to known effectively take in to account complex shape of the elements of the robotic technological cell. The effectiveness of the proposed method is confirmed by the tests results.
Keywords: manipulator robot, trajectories synthesis, configurational space.
Список литературы
1. Choset H., Lynch K.M., Hutchinson S. et. al. Principles of Robot Motion: Theory, Algorithms, and Implementations. Cambridge, 2006.
2. LaValle S.M. Planning Algorithms. Cambridge, 2006.
3. Lahijanian M. A., Kavraki L. E., Vardi M. Y. // International Conference on Robotics and Automation. Hong Kong, 2014. P. 3005-3012.
4. Maly M.R., Lahijanian M. A., Kavraki L.E. et. al // ACM International Conference on Hybrid Systems: Computation and Control (HSCC). Philadelphia, 2013. P. 353-362.
5. Sucan I.A., Kavraki L.E. // IEEE International Conference on Robotics and Automation. St. Paul, 2012. P. 4822-4828.
6. Motion planning. Springer Handbook of Robotics / edited by B. Siciliano and O. Khatib. Springer-Verlag, 2008.
7. GeraertsR.J., OvermarsM.H. // Algorithmic Foundations of Robotics V. Berlin 2003. P. 43-58.
8. Geraerts R.J., Overmars M.H. // Journal of Robotics and Autonomous Systems. 2007. № 55. Р. 824-836.
9. Geraerts R.J., Overmars M.H. // Journal of Robotics and Autonomous Systems. 2006. № 54. P. 165-173.
10. LaValle S.M., Branicky M., Lindemann S.R. // International Journal of Robotic Research. 2004. № 23(7/8). P. 673-692.
11. Pashkevich A.P., Kazheunikau M.M., Ruano, A.E. // International Journal of Systems Science. 2006. № 37 (8). P. 555-564.
12. Кожевников М.М, Пашкевич А.П., Чумаков О.А. // Докл. БГУИР. 2010. № 4 (50), C. 55-62.
13. Кожевников М.М., Ульянов Н.И., Субоч С.Н. // Вест. Белорусского республиканского фонда фундаментальных исследований. 2011. № 1. C. 44-55.
14. Кожевников М.М. Господ А.В. // Исследования наукограда. 2012. № 1 (1). C. 37-41.
