CC BY
32
_Доклады БГУИР_
2003 апрель-июнь Том 1, № 2
ИНФОРМАТИКА
УДК 681.5.015
СИНТЕЗ КОНФИГУРАЦИОННОГО ПРОСТРАНСТВА РОБОТОВ-МАНИПУЛЯТОРОВ НА ОСНОВЕ НЕЙРОННЫХ СЕТЕЙ
А.П. ПАШКЕВИЧ, ММ. КОЖЕВНИКОВ
Белорусский государственный университет информатики и радиоэлектроники П. Бровки, 6, Минск, 220013, Беларусь
Поступила в редакцию 7 мая 2003
Предложен метод синтеза конфигурационного пространства для робота-манипулятора на основе нейросетевой модели столкновений. Разработаны модификация нейронной сети типа КБРМ и алгоритм ее обучения. Эффективность подхода подтверждается примерами практического применения при программировании роботизированных технологических комплексов сварки для автомобильной промышленности.
Ключевые слова: робот, конфигурационное пространство, нейронные сети.
Введение
Эффективное внедрение и эксплуатация роботизированных технологических комплексов (РТК) сборки и сварки тесно связаны с созданием систем автономного программирования на основе геометрических моделей всех элементов РТК. При генерации управляющих программ в такой системе возникает необходимость синтеза свободной от столкновения с препятствиями траектории робота-манипулятора [4]. Эта задача может быть эффективно решена в конфигурационном пространстве, которое задается в виде дискретной карты. Каждому узлу такой карты ставится в соответствие определенная конфигурация робота, а искомая траектория находится путем решения задачи оптимизации на множестве этих узлов.
Традиционно конфигурационное пространство робота-манипулятора рассчитывается алгебраически. Чтобы упростить расчет конфигураций, при которых происходит столкновение манипулятора с препятствиями, эти препятствия и звенья манипулятора аппроксимируются простыми многоугольными объектами [4-6]. Основные недостатки таких алгоритмов связаны с низкой точностью, а также с тем, что время преобразования растет экспоненциально с числом степеней свободы манипулятора. Альтернативный подход к решению этой задачи, основанный на численных процедурах, предложен в работе [7]. Он позволяет эффективно синтезировать конфигурационное пространство для избыточных плоских манипуляторов, имеющих вращательные либо призматические сочленения. Однако для более сложных задач наиболее перспективным является представление модели столкновения в виде нейронной сети, которое позволяет существенно снизить затраты памяти, а также обеспечить высокое быстродействие [1]. В известных работах [2, 3] эффективность нейросетевой модели столкновения исследовалась для узкого класса манипуляторов, оси сочленений которых параллельны, что не включает большинство важных для практики случаев (промышленных манипуляторов типа PUMA, KUKA, например). Поэтому в данной работе предложен численный метод синтеза конфигурационного пространства роботов-манипуляторов для более общего случая, охватывающего типовые конструктивные решения, применяемые в промышленности.
Предлагаемый подход основан на последовательном построении следующих моделей:
1) нейросетевой модели столкновений робота на основе его трехмерной CAD модели;
2) векторной модели рабочего пространства на основе CAD моделей препятствий;
3) сопряженной векторной модели препятствий; 4) дискретной модели конфигурационного пространства робота на основе сопряженной векторной модели и модели столкновений. Модель конфигурационного пространства, полученная в соответствии с этим методом, позволяет учесть реальную форму звеньев манипулятора, технологического инструмента и препятствий и реализовать быстрое преобразование препятствий сложной формы в конфигурационное пространство.
Постановка задачи
Полное конфигурационное пространство робота М задается в виде множества его возможных конфигураций, включая те, при которых имеет место столкновение М с препятствиями Bj. Конфигурации, для которых не удовлетворяется соотношение M n B- = 0, определяют
области С-препятствий в полном конфигурационном пространстве. Если Bj статичны, то С-препятствия вследствие столкновений M с Вj задаются следующим образом:
COm(B]) = {g е CspaceM\(M)q nBj Ф0}, (1)
где q е Rn — точка в «-мерном конфигурационном пространстве CspaceM робота M; (M)q — робот M в конфигурации q.
Используя принятые обозначения, задача синтеза конфигурационного пространства может быть сформулирована следующим образом: Для заданных геометрических моделей объектов M и В- (манипулятора и препятствий соответственно) определить множество СО^В), описывающее границы С-препятствий в соответствии с выражением (1).
Синтез модели столкновений
Рассмотрим трехмерную модель манипулятора М с поворотными сочленениями (рис. 1,а), для которой вектор Pnvb=[xn yn zn]T определяет положение несмещенной виртуальной базы [8] для подмодели S2 при qi=a, а векторы K=[xk yk zk]T и G=[xa yaza]T задаются на основе геометрических параметров манипулятора. Если углы в сочленениях g4, g5, g6 зафиксированы, то столкновение манипулятора с препятствием В можно описать некоторым множеством углов q1, q2, q3 в сочленениях g1, g2, g3 соответственно. Необходимо отметить, что оси сочленений g2, g3 не параллельны оси сочленения g1, что существенно отличает рассматриваемую задачу от известных [1, 7]. В такой модели манипулятора выделим две подмодели. Первая из них S1 состоит из звеньев K1 и L1, причем K1 включает в себя звено l1, а L1 включат звенья l2, l3 при фиксированном значении угла в сочленении g3 (рис. 1,б).
Для этой подмодели столкновение робота М с примитивом T, расположенным на расстоянии dnvb от точки Pnvb, характеризуется парой централизованных углов Q11 -1. Значения этих углов не зависят от угла a, определяющего угловое положение примитива относительно оси Z. Вторая подмодель S образована звеньями
K2
и L (состоящими из l2 и l3 соответственно) при q1=0. Для этой подмодели столкновение М с примитивом, расположенным на расстоянии
dnvb от точки Pnvb, будет определяться углом Q20 ^ и соответствующей ему парой углов Q^ -1, причем эти углы не зависят от значения угла aq , определяющего угловое положение примитива относительно оси X.
а) б)
Рис. 1. Манипулятор KR125 и препятствия в его рабочем пространстве
а) б)
Рис. 2. Проекция манипулятора на плоскость XOY
Тогда модель столкновений робота-манипулятора можно определить как векторную функцию Ïq(dtwb), реализующую преобразование вида
Q = fç(dnvb),Q =bi'Q2>-Qn\Qie R31' (2)
где Q — множество централизованных конфигураций, задающих столкновения между манипулятором и примитивом T, расположенным на расстоянии dmb от несмещенной виртуальной базы Pnvb. Сопряженная векторная модель находится путем выполнения преобразований вида
dnvb = fcmb (о,Т,Ка), а = Л (о,Т), aq2 = f^ (о,Т,К,а) (3)
для каждого примитива, задающего геометрическую модель препятствия.
Необходимо отметить, что аналитический расчет модели столкновения вида (2) для сборочно-сварочных манипуляторов представляет значительную трудность вследствие сложной геометрической формы звеньев, а также технологического инструмента. Поэтому в данной работе предлагается численная процедура решения данной задачи, которая включает следующие этапы: 1) генерацию трехмерных С-пространственных структур на основе CAD модели робота; 2) нейросетевую аппроксимацию трехмерных С-пространственных структур.
Исходя из принятой модели столкновений (2), определим трехмерную С-пространственную структуру как множество централизованных углов Q1, Q2, Q3, задающих столкновения между примитивом, расположенным на расстоянии dnvb=const от несмещенной виртуальной базы Pnvb. Такой подход позволяет рассматривать трехмерную С-пространственную структуру как объединение плоских профилей, поэтому предлагаемый алгоритм генерации трехмерных С-пространственных структур на основе трехмерных CAD моделей манипулятора и примитива включает формирование следующих множеств:
профилей С-пространственных структур при фиксированных значениях Q2, Q3; профилей С-пространственных структур при фиксированном значении Qi; полных С-пространственных структур из полученных плоских профилей. Примеры С-пространственных структур для промышленного манипулятора KR125, полученных в соответствии с этим подходом, приведены на рис. 3.
Рис. 4. Нейронная сеть для аппроксимации С-пространственных структур
Для аппроксимации полученных С-пространственных структур в данной работе предлагается использовать двухслойную нейронную сеть типа RBFN (Radial Basis Function Networks) [1]. Эта сеть представляет собой двухслойную структуру, выходы узлов второго слоя которой формируются как линейная комбинация выходов базисных функций скрытого слоя:
Qt =Yw(t,k Wmb-ck), (4)
k=1
где Q<1a) — значения централизованных углов, описывающих плоский профиль
С-пространственной структуры относительно параметров Q2, Q3 при ае {1,2}; Q(a^s — значения централизованных углов, описывающих плоский профиль С-пространственной структуры относительно параметра Q¡ в дискретных точках 5е{1,...,5'} с разрешением 5' при те{2,3}, ае {0,1,2}; ^т,..к и ск — веса в выходном и скрытом слоях соответственно;/к — функция активации нейронов скрытого слоя.
Для активации нейронов скрытого слоя использована радиальная функция вида
а-к ■ X +1 если - а,к < х < 0,
а'г':к• X +1 если 0 < х < агк, (5)
0, если х <-а1к или х > агк,
где а 1,к = Ск - Ск1 аг,к = Ск+1 - Ск-
Предлагаемая в данной работе модификация алгоритма обучения КБЕЫ сети включает следующие шаги:
формирование скрытого слоя сети с малым количеством нейронов к'=7-8 (входное пространство имеет малое разрешение);
настройку весов выходного слоя, исходя из критерия минимизации квадрата отклонения на каждом выходном узле:
()= тш{} а=02, т=13 к=,=1,
т = 1,3 к = 1,К , 5 = 1,5' (6)
п> !
т,,к
при
Р 2
=!( - а(х,)), (7)
г=1
где хг &пуЪ ск;
расчет интерполяционной ошибки сети для значений ётЬ, которые использовались для обучения;
если интерполяционная ошибка сети выше заданного порога Т, то количество нейронов в скрытом слое сети увеличивается (т.е повышается разрешение входного пространства).
Шаги 2-4 повторяются до тех пор, пока интерполяционная ошибка в сети не станет ниже заданного порога Т.
Оптимальный вектор весов скрытого слоя, при котором величина ошибки аппроксимации на узле, минимальна, находится из уравнения
дтг= 2±(-QÍaЫ)) = 0, (8)
Р
, Р г_________- из соотношения:
решение которого на обучающем множестве {х,, 5 Р }Р=1 определяется
w = (Т Г )-1 ГТ О, (9)
где Г — план-матрица сети [8, 9]. Расчет оптимального весового вектора в соответствии с соотношением (9) проводится для каждого выходного узла. Необходимо отметить, что этот алгоритм позволяет осуществить обучение сети при невысокой размерности обучающего множества.
Преобразование препятствий в конфигурационное пространство
Предложенная модель столкновений далее используется для преобразования препятствий в конфигурационное пространство. Модель препятствий задается в виде ЖБ = ^Р 1XV , где
= [[ х2х3 ] — векторы, задающие положение примитивов, образующих препятствие в мировой системе координат (/=1...р). Эта модель используется для генерации сопряженной векторной модели:
В={
пуЪ 1 ] (10)
а ={а1, а2,..., а1Я, а1Я е[а[+]} (11)
"я, =1
] (12)
На первом шаге генерации фактического конфигурационного пространства реализуется последовательный расчет на основе нейросетевой модели (4) для каждого элемента множества Б . На втором шаге определяются координаты q\ точек на границе С-препятствий:
41 ={1^1,1 -А*}} = 12, = + (13)
Каждый полученный таким образом диапазон изменения 41 дискретизируется с шагом q10N е 4{ о N qí'o)N и для каждого дискретного значения угла в диапазоне е 4(0 N ] определяются координаты 42,43 точек на границе С-препятствий:
42 ={,а = 02, т = 2, 5 = 17, = , (14)
Чз ={,1, qifl!,2,--qifl!,N'}« = 0,2, m = 3, s = 1, s', ^ = qW . (15)
Следует отметить, что предложенный подход позволяет учесть сложную геометрию технологической оснастки, а также конструкций, используемых в сборочно-сварочных производствах. Эти достоинства позволяют применить разработанные алгоритмы для решения задачи синтеза конфигурационного пространства сборочно-сварочных роботов.
Применение предложенного алгоритма
Эффективность разработанных алгоритмов синтеза трехмерного конфигурационного пространства исследована экспериментально с использованием подсистемы аналитического программирования САПР ROBOMAX. Объектом исследования являлась модель РТК, включающая манипулятор KR125, оснащенный сварочными клещами, элементы кабины автомобиля Газель и технологическую оснастку. В качестве препятствия в данном случае рассматриваются сварная конструкция, технологическая оснастка, а также кондукторная плита. На основе трехмерных CAD моделей указанных элементов сформирована векторная модель препятствия, задаваемая как множество из 400 точек. Для формирования сопряженной векторной модели препятствия были использованы только те примитивы, которые попадают в рабочую зону манипулятора при данной компоновке ячейки. Таким образом, получена модель, имеющая размерность N'=296. Далее, с использованием нейросетевой модели столкновения для робота манипулятора KR125, построено трехмерное конфигурационное пространство (рис. 5,а).
50 45 40
35
ql'
30
25
20
15
10 50
а) б)
Рис. 5. Свободная от столкновений траектория в дискретном конфигурационном пространстве робота KR125 и соответствующая ей траектория в рабочем пространстве
В процессе исследования полученная модель трехмерного конфигурационного пространства была использована для определения последовательности конфигураций, реализующих свободную от столкновения траекторию между стартовой и целевой локациями робота. На основе этих последовательностей сформированы технологические программы на языке программирования робота SRCL (Siemens Robot Control Language). Тестирование программ в подсистеме автономного программирования САПР ROBOMAX показало, что они обеспечивают свободное от столкновения движение манипулятора. Траектории, полученные для точечного объекта в трехмерном конфигурационном пространстве, и соответствующие им траектории манипулятора в рабочем пространстве изображены на рис. 5. Таким образом, анализ результатов данных экспериментов показывает, что синтезированная модель трехмерного конфигурационного пространства корректна и позволяют реализовать искомые движения манипулятора в его рабочем пространстве.
Заключение
В данной работе предложен эффективный алгоритм синтеза трехмерного конфигурационного пространства для сборочно-сварочных манипуляторов. В отличие от известных процедур, он позволяет учесть реальную форму звеньев манипулятора, форму технологического инструмента и препятствий, что является актуальным для РТК сборки/сварки. Первый шаг разработанного алгоритма основан на построении нейросетевой модели столкновения для робота и сопряженной векторной модели препятствий. Далее на основе этих моделей реализуется преобразование препятствий в трехмерное конфигурационное пространство. Экспериментальная проверка предложенного алгоритма синтеза в САПР ROBOMAX показала, что он позволяет реализовать корректную трехмерную модель конфигурационного пространства сборочно-сварочного робота.
CONFIGURATION SPACE SYNTHESES FOR ROBOTIC MANIPULATORS ON THE BASE OF NEURAL NETWORKS
A.P. PASHKEVICH, M.M. KAZHEUNIKAU Abstract
The paper deals with configuration space syntheses for robotic manipulators. A new efficient method is proposed that is based on a neural network collision model. To generate the collision model, a modification of the Radial Basis Function Network (RBFN) is used, which is trained applying the developed algorithm. The method has been successfully applied to design of robotics manufacturing cells for automotive industry.
Литература
1. Althoefer K. Neuro-Fuzzy Motion Planning for Robotic Manipulators: PhD thesis.-Dept. Of Electronic and Electrical Eng., Kings's College. London, University of London, 1996.
2. Bonarini A., Fiorellato F. // Proceedings of the Joint 9th IFSA World Congress and 20th NAFIPS International Conference, 2001. P. 235-1240.
3. Curto B., Moreno V., Blanco F.J. // IEEE Transactions on Robotics and Automation. 2002. Vol. 18(1). P. 2431.
4. Latombe J.-K. Robot Motion Planning. Kluwer Academic, Boston, MA, USA, 1991.
5. Gupta K., Guo Z. // Proceedings of IEEE Conference of Robotics and Automation. 1992. P. 120-135.
6. Hwang Y.K. // Proceedings of IEEE International Conference on Robotics and Automation. 1991. P. 298-303.
7. Newman W.S., BranickyM.S. // The International Journal of Robotic Research. 1991. Vol.10, N 6. P. 50-72.
8. Pashkevich A., Ruano A., Kazheunikau M. // Proceedings of the 5th Portuguese Conference on Automatic Control (Controlo 2002). Universidade de Averiro, Portugal, 2002. P. 195-200.
9. Pashkevich A. Kazheunikau M. // Internationales wissenschaftliches colloquium. Technische Universitat Ilmenau (Thur.), 2002. P. 349-350.
