Синтез траектории движения механизма манипулятора в пространстве обобщенных координат на основе использования областей, задающих разрешенные конфигурации

Размещено на http://www.allbest.ru/

Статья по теме:

Синтез траектории движения механизма манипулятора в пространстве обобщенных координат на основе использования областей, задающих разрешенные конфигурации

Ф.Н. Притыкин, Д. И. Нефедов

Омский государственный технический университет, г. Омск

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

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

Создание и использование автономно функционирующих робототехнических систем является одним из приоритетных направлений исследований. Автономное функционирование робота при наличии запретных зон может быть возможным благодаря использованию интеллектуальных систем управления [1]. В работе [2] с целью обеспечения автономного функционирования робота предложено использовать систему управления, одной из составных частей которой является наличие блока предназначенного для обеспечения виртуального моделирования на начальном этапе реализации движения. Двигательные возможности механизма манипулятора в этом случае оценивают на основе виртуального моделирования движения, где используют модель окружающей среды и механизма манипулятора. Если движение смоделировано виртуально, далее выполняется реализация конкретных движений. Анализ положения механизма манипулятора и заранее известных запретных зон может быть осуществлен на основе исследования разрешенных и запрещенных конфигураций [3,4]. В работах [5,6] предложено определять в аналитическом виде область разрешенных конфигураций мобильного робота «Варан» на основе использования совокупностей областей задаваемых плоскостями и поверхностями второго порядка. Для этого использована теория множеств. Рассмотрим задачу синтеза траектории движений манипулятора данного робота, в пространстве обобщенных координат (в конфигурационном пространстве Lq) на основе использования области разрешенных конфигураций [6]. Конфигурационное пространство задают ортогональными осями системы координат, по направлению которых откладывают значения обобщенных координат qi (1<i<n),определяющих углы поворота в шарнирах (см. рис. 1аб). Единицами измерения по осям в этом случае принимаются градусы. Если конфигурация, определяющая положение кинематической цепи робота, удовлетворяет заданным требованиям, она считается разрешенной, в противном случае - неразрешенной.

Условимся положение механизма манипулятора состоящего из n-звеньев, определять точкой (которую обозначим точкой Вi) в n-мерном пространстве конфигураций Lq. Точка Вi находится вектором q(q1, q2, …, qn).

манипулятор механизм конфигурация

а б

Рис. 1 - Механизм манипулятора мобильного робота «Варан»: а - общий вид мобильного робота; б - кинематическая схема механизма манипулятора и положение запретной зоны

Для пространственного пятизвенного механизма, представленного на рис. 1аб, для случая, когда q1= 0 пространство конфигураций Lq будет трехмерным. Механизм манипулятора при этом установлен на транспортной тележке.Центр выходного звена (ВЗ) механизма манипулятора в пространстве положений захвата Oo определяется координатами xo4 и yo4 (ориентация ВЗ может быть какой угодно). На рис. 2а представлено множество конфигураций для которых центр ВЗ занимает одно и тоже положение определяемое радис вектором RA(xA, yA) точки А1. Множество конфигураций построено графическим способом на основе построения окружностей радиусы которых равны длинам звеньев механизма. Произвольной точки BiLq (знак определяет принадлежность точки пространству Lq) соответствует единственная точка О4Oo. Данное соответствие будет нелинейным, так как оно определяется тригонометрическими функциями (называемыми функциями положения):

xо4= cosq3(l2 (cosq1 cosq2sinq1sinq2) + l1 cosq1) sinq3 (l2.(sinq1 cosq2 + cosq1 sinq2) + l1 sinq1) + l3cosq3,(1)

yo4=sinq3(l2 (cosq1 cosq2 sinq1 sinq2) + l1 cosq1) cosq3 (l2.(sinq1 cosq2 + cosq1 sinq2) + l1 sinq1) + l3cosq3,

гдеl1, l2иl2 - определяют длины звеньев механизма. Для рассматриваемого примера l1=900мм, l2=700мм и l2=500мм. Обратное соответствие точек будет многозначным. Точке А1Oo будет соответствовать однопараметрическое множество точек BiLq принадлежащих линии lA1.На рис. 2б представлено изображение кривой lA1Lq. Другим точкам траектории движения ВЗ А2, А3, … будут соответствовать другие кривые lA2, lA3, … которые в совокупности определяют каркас поверхности (см. рис. 2б).

а б

Рис. 2 - Положения точек Аi и Bi пространств Оои Lq: а - множество конфигураций для которых Ro4(xo4, yo4) = RA1(xA, yA);б - изображение поверхности в пространстве Lq

Известно, что синтез движения манипулятора по заданной траектории A1А3 центра ВЗ может быть осуществлен единственным образом по критерию минимизации объёма движения [7]. При этом на поверхности определится криваяlm соответствующая заданному движению. Пусть в пространстве Ooзадана запретная зона P в виде горизонтальной плоскости уровня (соответствует функционированию мобильного робота в туннеле). При наличии запретной зоны Р и заданных предельных значения обобщенных координат в пространстве Lq разрешенные конфигурации заданные точками Вi определяют область [6]. По анализу взаимного положения кривой lm и области можно судить возможно или нет смоделировать движение по заданной траектории ВЗ без столкновения с препятствием на виртуальном уровне (кривая lm должна целиком принадлежать области ).

На рис. 3аб изображены множество разрешенных конфигураций в декартовом пространстве Оо и соответствующая этим конфигурациям область при qi=15o. Данная область исследовалась в работах [5,6]. Анализ формы области Л показывает, что при некотором положении запретной зоны Рв неподвижном пространстве Оо в области Л существуют пустоты, которые задают запрещенные конфигурации. В общем случае точки Bн и Bц/, задающие начальную и конечную конфигурации заданной траектории, соответствующие точкам А1=О4 и А3 положениям ВЗ, могут располагаться в различных частях области Л (см рис. 3б). Точка А3задает целевую точку ВЗ.

а б

Рис.3 Определение разрешенных конфигураций: а - изображения множества Nkol разрешенных конфигураций при zор =1200мм; б изображение области в пространстве Lq

Положение конечной конфигурации, заданной точкой Вц/ при наличии двигательной избыточности, определяется синтезом движения по критерию минимизации объема движения по вектору скоростей [7]. Рассмотрим алгоритм синтеза траектории lв/в пространстве Lq, позволяющий исключить ее пересечение с граничными поверхностями области Л, и располагающейся в данной области. При этом центр ВЗ должен перемещаться по траектории, заданной отрезком прямой А1А3. На рис. 4а представлены изображения области построенные в САПР АСАD соответственно при значении zop = 1000 мм и zop = 1300 мм (точки Bi изображены в пространстве Lq совокупностью сфер). Взаимное положение поверхности и области представлено на рис.4б.Проекции кривой lm, соответствующей критерию минимизации объема движения, на рисунке 4в обозначены lm1и lm2. Плоскости проекций, изображенные на рис. 4в, определяют обобщенными координатами q2q3и q3q4. Пусть траектория lm, соответствующая синтезу движений центра ВЗ по отрезку А1А3, пересекает границу области Л в точках Bm(Bm1, Bm2)и Bn(Bn1, Bn2).

а б

в

Рис. 4 - Синтез траектории движения манипулятора в пространстве Lq: а изображение области ; б взаимное положение поверхности и области ; в проекции областиЛ разрешенных конфигураций и кривой lm

С целью определения траектории в пространстве Lq, располагающейся целиком в области Л, определим вспомогательную точку Bf. Для нахождения указанной точки Bf(Bf1,Bf2) Bf6, имеющей наименьшее значение обобщенной координаты q2(где, 6поверхность параболического цилиндра, который ограничивает фрагмент области [6]), необходимо найти линию пересечения плоскости Д(Bm, Bn, F)(точки Bm, Bn, F задают положение плоскости в пространстве Lq) с поверхностью, определяемой параболическим цилиндром 6.Точки FиF/принадлежат прямой n, которая перпендикулярна горизонтальной плоскости проекцииОqq3q4 (координаты q3и q4 для точек FиF/совпадают). При этом F/lm определяется точкой, принадлежащей траектории lmи имеющей одинаковое удаление от точек Bmи Bn. Координата q2точки Fравна нулю.

Коэффициенты A, B, C и D уравнения плоскости Д вычисляют на основе использования координат трех точек Bm, Bn и F. Точки линии пересечения кривой lp=Д?Щ6определяют совместным решением уравнений:

Размещено на http://www.allbest.ru/

(2)

где первое уравнение системы (2) определяет уравнение плоскости (Bm,Bn,F), а второе уравнение задает параболический цилиндр [9]. Параметры , , иопределяют форму параболического цилиндра [6]. На кривой lpнеобходимо определить точку Вfимеющую минимальное значение обобщенной координаты q2.

Если же точка пересечения кривой lm существует с поверхностью эллиптического цилиндра Щ5 [6], то уравнение линии пересечения кривой lp определится совместным решением следующих уравнений:

(3)

где первое уравнение системы (2) определяет плоскость /(Bm, Bn, F/),а второе определяет уравнение эллиптического цилиндра. Параметры , , ,, ,иопределяют форму эллиптического цилиндра [6]. В этом случае необходимо определить точку Еflp, имеющую максимальное удаление de от горизонтальной проекции прямой заданной точками Bm1и Bn1.

После вычисления точки Bf или Еf необходимо на поверхности итерационным образом определить точку Bf/ пересечения отрезка прямой BfF/или ЕfF/ с поверхностью . Поверхность при этом задается массивом точек А1, B1, C1,и т. п., которые затем интерполируются методом Лагранжа [10]. Уравнение поверхности имеет следующий вид:

Размещено на http://www.allbest.ru/

где qA12,qA14, …, qЕ14координаты массива точек А1, В1, …, Е1 принадлежащих поверхности . Координаты данных точек, располагающих в различных параллельных плоскостях (q3 = const),заданы с помощью полиномов третьей степени:

Размещено на http://www.allbest.ru/

Размещено на http://www.allbest.ru/

(5)

где, Размещено на http://www.allbest.ru/

определяют коэффициенты полиномов. Уравнения интерполирующих полиномов (5, 6) располагающихся в параллельных плоскостях получают при подстановке в систему уравнение (7) координат точек узлов интерполяции:

Определим точки Bm/Ли Bn/Размещено на http://www.allbest.ru/

Лкоторые находятся на траектории lmи удалены от точек Bmи Bn на расстоянии 3-5 отрезков, равных модулю абсолютной скорости центра ВЗ (длина одного отрезка равна смещению ВЗ за одну итерацию при синтезе малых движенийпо вектору скоростей). Тогда планируемая траектория должна проходить через точки Bm/, Bn/ иBf/. На рис. 4в на поверхности изображена кривая lm, соответствующая смещению центра ВЗ по отрезку А1А3 по критерию минимизации объема движения. На этом же рисунке указаны положения точек Bm/, Bn/, Bfи Bf/. Для нахождения маршрута движения в пространстве Lqнеобходимо участок траектории lm, на котором находятся точки Bn/,F/иBm/, заменить участком lm/У, на котором находятся точки Bn/Размещено на http://www.allbest.ru/

, Bm/и Bf/. Положение траектории lm/определяется пересечением поверхности с плоскостью Д/, проходящей через точки Bn/, Bm/и Bf/. Для этого необходимо последовательно определять пересечение линий уровня поверхности (4) (соответствующих заданным значениям q3) с плоскостью Д/. При этом получают численным методом совокупность точек, задающих траекторию lm/. Очевидно, что на участке траектории (Bn/, Bm/, Bf/) движение манипулятора осуществляется без учета критерия минимизации объема движения. Схема алгоритма синтеза траектории движения в конфигурационном пространстве представлена на рис. 5.На рис. 5 приняты следующие обозначения: 1- начало; 2 - Задание точекАн и Ац, определяющих начальное и целевое положение ВЗ; 3 - Синтез движения от точки А1 к целевой точке А3по критерию минимизации объема движения, вычисление траектории lmв пространстве Lq; 4 - Определение точек пересечения Bmи Bnкривой lmс областью Л; 5 - Bm=nill, Bn=nill;6 - Вычисление точки F/Размещено на http://www.allbest.ru/

Размещено на http://www.allbest.ru/

lm, F/Bm=F/Bn. Задание координат точки F; 7 - Вычисление коэффициентов уравнений плоскостей (Bm,Bn,F)и /(Bm,Bn, E/); 8 - вычисление точки Bfи Еfпринадлежащей кривой lpпо соотношениям (2) и (3)при выполнении условий q2 =min(для точки Bf), dе - mах (для точки Еf) (где dе - параметр определяет расстояние проекции текущей точки Еflp до проекции прямой на плоскости q3q4, заданной точками Вmи Вn; 9 - Определение точек Bm/и Bn/ ;10 - Вычисление точки Bf/Размещено на http://www.allbest.ru/

, Bf=BfF?или Еf/Размещено на http://www.allbest.ru/

, Bf=ЕfF/?; 11 - Вычисление коэффициентов уравнения плоскостей //(Bm/,Bn/,Вf/)или ///(Bm/,Bn/,Ef/); 12 - Вычисление координат точек кривой lm/= //, lm/= ///, (определение пересечения линий уровняq3=const поверхности с плоскостью Д// или ///); 13 - Определение точек Mи N пересечения кривой lm/с областью Л; 14 - N=nill, M=nill; 15 Вывод координат точек траектории движения заданной в пространстве Lq; 16 Конец.

Рис. 5 - Схема алгоритма синтеза траектории движения манипулятора в пространстве Lq

На рис. 6а представлены результаты виртуального моделирования движений механизма манипулятора при использовании критерия минимизации объема движения и отсутствии запретной зоны. Моделирование движения выполнено в системе САПР ACADс использованием алгоритмического языка программирования AutoLISP.

а б

Рис. 6 Результаты синтеза движений манипулятора: а синтез по критерию минимизации объема движения, б синтез при наличии запретной зоны

На рис. 6б соответственно показан синтез движений при наличии запретной зоны. Использование алгоритма, представленного на рисунке 5, позволяет на виртуальном уровне синтезировать траекторию движения от начальной до целевой точки ВЗ. Данная траектория движения обеспечивает заданное удаление от запретных зон и отсутствие тупиковых ситуаций при синтезе движений по вектору скоростей. Результаты исследований могут быть использованы при разработке интеллектуальных систем управления роботами.

Литература

1. Ющенко, А. С.Интеллектуальное планирование в деятельности роботов // Мехатроника, автоматизация, управление. 2005. №3. С. 5 18.

2. Hasegawa T., Suehiro T., Takase K. A model-based manipulation system with skill-based execution. // "IEEE Trans. Rob. andAutom.", 1992, 8, №5, pp 535544.

3. Isto P.A. Parallel motion planner for systems with many degrees of freedom // Proc. of the 10th Intemat. Conf. on Advanced Robotics (ICAR 2001), August 2225, 2001, Hotel Mercure Buda, Budapest, Hungary. pp. 339344.

4. Lopatin P. K.Algorithm of a manipulator movement amidst unknown obstacles // Proc. of the 10th International Conference on Advanced Robotics (ICAR 2001). August 2225. 2001. Hotel Mer- cure Buda, Budapest, Hungary. pp. 327331.

5. Притыкин, Ф.Н., Нефедов Д.И., Рингельман А.В. Исследование областей, задающих множества разрешенных конфигураций при нахождении механизма мобильного манипулятора в близости от запретных зон / Инженерный вестник Дона, 2015 - № 2. Часть 2,URL:ivdon.ru/magazine/archive/n2p2y2015/3007.

6. Притыкин, Ф.Н., Осадчий А.Ю., Нефедов Д.И. Аналитическое описание области, задающей множество разрешенных конфигураций механизма мобильного манипулятора с учетом положения запретных зон / Евразийский союз ученых (ЕСУ), 2015 № 10(19), С. 119-123.

7. Кобринский, А. А., Кобринский, А.Е. Манипуляционные системы роботов. - М.: Наука. 1985. - 343 c.

8. Притыкин, Ф.Н., Осадчий А.Ю.Способ кодирования информации при задании геометрических моделей исполнительных механизмов роботов // Инженерный вестник Дона, 2014, № 2. URL: indon.ru/ magazine//archive/n2y2014/2363/.

9. Корн Г., Корн Т. Справочник по математике.- М.: Наука. 1984. - 831 с.

10. Фокс А., Пратт М. Вычислительная геометрия. Применение в проектировании и на производстве. Пер. с англ. - М: Мир, 1982.- 340 с.

11. Yushchenko, A. S. Mekhatronika, avtomatizaciya, upravlenie. 2005. №3. рp. 518.

12. Hasegawa T., Suehiro T., Takase K. "IEEE Trans. Rob. andAutom.» 1992, 8, №5, pp. 535544.

13. Isto P. Proc. of the 10th Intemat. Conf. on Advanced Robotics (ICAR 2001), August 2225, 2001, Hotel Mercure Buda, Budapest, Hungary.pp. 339--344.

14. Lopatin P. K. Proc. of the 10th International Conference on Advanced Robotics (ICAR 2001). August 2225.2001. Hotel Mercure Buda, Budapest, Hungary.pp. 327331.

15. Pritykin F.N., Nefedov D.I., Ringel'man A.V. Inћenernyj vestnik Dona (Rus), 2015 № 2. Chast' 2, URL:ivdon.ru/magazine/archive/n2p2y2015/3007.

16. Pritykin, F.N., Osadchij A.Yu., Nefedov D.I. Evrazijskij soyuz uchenyh (ESU), 2015. № 10(19), pp. 119-123.

17. Kobrinskij, A. A., Kobrinskij A. E. Manipulyacionnye sistemy robotov [Manipulative robots system]. M.: Nauka. 1985. 343 p.

18. Pritykin, F. N., Osadchij A. Yu. Inћenernyj vestnik Dona (Rus), 2014, № 2. URL: indon.ru/magazine//archive/n2y2014/2363/.

19. Korn G., Korn T. Spravochnikpomatematike. [Handbook of Mathematics] M.: Nauka. 1984. 831р.

20. Foks A., Pratt M. Vychislitel'naya geometriya. Primenenie v proektirovanii i na proizvodstve. Per. s angl. [Computational geometry. The use in the design and manufacturing. Translate from English] M: Mir, 1982.340 р.

Размещено на Allbest.ru