CC BY-NC
10Исследование геометрических параметров задающих область разрешенных конфигураций при изменении положения запретных зон
Притыкин Федор Николаевич
доктор технических наук профессор, Омский государственный технический университет 644050, Россия, Омская область, г. Омск, проспектШра, 11, ауд. Зв-516
И pritykin@mail.ru
Нефедов Дмитрий №оревич
аспирант, Омский государственный технический университет 644050, Россия, Омская область, г. Омск, проспектШра, 11
0 3demon@bk.ru
Статья из рубрики "Автоматизированные системы управления технологическими процессами"
Аннотация.
Предметом исследования является модуль автоматического обнаружения столкновений механизма манипулятора, с запретными зонами используемый в в базе знаний интеллектуальных системах управления роботами. Объектом исследования является область разрешенных конфигураций, заданная в пространстве обобщенных координат. Авторы подробно рассматривают такие аспекты как параметрическое задание области разрешенных конфигураций при наличии запретных зон в рабочем пространстве механизма манипулятора. Предложено использовать достаточное условие определения столкновений механизма манипулятора и запретных зон, основанное на использовании области разрешенных конфигураций. Методология исследования основана на изучении сечений задающих форму и положение области разрешенных конфигураций. Все разрешенные конфигурации в пространстве обобщенных координат, отображены геометрическим объектом. Данный геометрический объект задан аналитическим способом с помощью использования нескольких кинематических поверхностей, его ограничивающих. Приведены результаты моделирования, которые позволили разработать параметрический способ задания совокупности сечений, задающих форму и положение области разрешенных конфигураций при различном положении запретных зон. Основным выводом проведенного исследования является сокращение времени расчетов тестовых заданий, связанных с виртуальным моделированием движения механизма манипулятора мобильного робота «Варан» при использовании разработанного алгоритма обнаружения столкновений механизма со средой. Особым вкладом авторов в исследование темы является разработка параметрического способа задания области разрешенных конфигураций, используемой при интеллектуальном управлении движением механизма манипулятора в заранее известной внешней среде. Новизна исследований заключается в разработке более производительного метода анализа информации о положении механизма манипулятора и запретных зон на основе полученных аналитических зависимостей.
нтез движений роботов, область разрешенных скоростей, параметры
DOI:
10.7256/2454-0714.2018.4.25176
Дата направления в редакцию:
16-05-2018
Дата рецензирования:
27-05-2018
Ключевые слова: механизм манипулятора, запретные зоны, си виртуальное моделирование, кинематические поверхности, конфигураций, пространство обобщенных координат, вектор формы образующих, параметры положения образующих
Введение
С развитием технологий автоматизации в промышленности массово распространяется практика использования автономных роботов для выполнения различных задач. Чтобы удовлетворить все более возрастающие требования, необходимо совершенствовать способы анализа окружающей среды роботом и модифицировать алгоритмы, отражающие работу и последовательность действий автономного робота при решении поставленных задач. В связи с этим в настоящее время интенсивно ведутся работы по созданию
интеллектуальных роботов [1-4]. Предметом интеллектуального управления движением робота является определение его текущего, целевого и промежуточных положений механизма манипулятора в пространстве. Поэтому определение траектории движения робота с учетом окружающей внешней среды, это задача оптимизации выполнения операций по перемещению ВЗ из начального положения в целевое.
Одним из способов интеллектуального управления движением манипулятора в сложно организованной среде является способ, основанный на использовании алгоритма построения движения по вектору скоростей [5-7]. Построение движения механизма манипулятора этим способом может быть основано на анализе текущих ситуаций с исследованием совокупностей разрешенных и запрещенных конфигураций [8,9]. В работе
был предложен способ анализа взаимного положения механизма манипулятора и запретных зон, основанный на использовании области разрешенных конфигураций при виртуальном моделировании движений роботов. С этой целью указанная область задается аналитически, а полученный мат. аппарат используется для модификации траектории движения манипулятора в пространстве обобщенных координат. Область разрешенных конфигураций при этом выступает в качестве базы знаний, характеризующей прошлый опыт построения дискретных положений механизма манипулятора с учетом заранее известных запретных зон.
Таким образом, интеллектуальное управление («поведение») робота можно улучшить использованием базы знаний о конечном числе стандартных ситуаций. Эти ситуации определяют положением запретных зон, траекторий движения центра ВЗ, и др. Базы
знаний представлены в виде зависимостей параметров, определяющих области разрешенных конфигураций в пространстве обобщенных координат и параметров, задающих ограничения на положения механизма манипулятора.
Постановка задачи исследования
На рисунке 1 изображена кинематическая схема механизма манипулятора мобильного робота «Варан» и положение запретных зон Р 1 и Р 2. Высота нижнего уровня проема для рассматриваемого примера в системе координат О 1 принята равной хп = 500 мм, а высота самого проема может изменяться (для тестового задания данная высота определяется параметром гор = 500 мм), минимальное безопасное удаление основания манипулятора от препятствия принято равным х0р = 800 мм (см. рис. 1). Геометрические
параметры, задающие механизм манипулятора представлены в работе Обобщенные координаты на рисунке обозначены q/■ . Для того чтобы оценить влияние положения
запретной зоны Р^ на форму области разрешенных конфигураций, необходимо
рассмотреть два случая расположения запретных зон.
В первом случае запретная зона пусть задана в виде горизонтальной плоскости уровня, а во втором - в виде нескольких фронтально проецирующих плоскостей, которые в совокупности на фронтальной проекции изображаются в виде четырёх угольника Р^ (см. рис. 1). Движения звеньев механизма будем исследовать в плоскости параллельной фронтальной плоскости проекций при q 1 = 0.
Очевидно, что запретная зона, заданная горизонтальной плоскостью уровня А (см. рис. 1), создает в пространстве обобщенных координат Lq область разрешенных конфигураций Л. Эту область Л рационально задать с помощью использования нескольких кинематических поверхностей, образующими которой являются прямые или эллипсы I/ . Параметры формы образующих фрагментов эллипсов этих поверхностей, определяемые размерами большой и малой полуосей, изменяются в различных сечениях, при изменении обобщенной координатой q2■
Обозначения параметров положения и формы эллипсов 1у и 1д являющихся фрагментами образующих кинематических поверхностей представлены на рисунке 2аб (для задания границ сечений используется восемь различных линий I/ .
Рис.1. Кинематическая схема механизма манипулятора мобильного робота «Варан» и
положение запретных зон
В настоящей работе предложен параметрический способ задания области разрешенных конфигураций L , который использован при создании базы знаний о прошлом опыте синтеза движений механизма манипулятора при различных произвольных значениях параметров г 0р и х 0р (см. рис. 1). Параметры г 0р и х 0р определяют при этом положение
запретной зоны Р^ .
Параметрический способ задания области разрешенных конфигураций
Условимся область запрещенных конфигураций, заданную фрагментами кинематических поверхностей с образующими /7 и /д , обозначать fi7 и fi3 (см. рис. 2аб). Методика
задания области разрешенных конфигураций ранее была предложена в работах I"10-121, где используются так же области fii - fig. При этом область L получают на основе использования операций объединения и вычитания теории множеств, выполняемых с
областями Qi -U-31. На рисунке 2аб представлены сечения области разрешенных конфигураций L соответственно при значении обобщенной координаты q 2 равной сорока
и двадцати градусов при этом zop = 1000мм. На данном рисунке изображены эллипсы /7 и
/д используемые для задания фрагментов наружного контура сечений области L .
а б
Рис. 2 - Определение параметров положения и формы эллипсов /7 и / д фрагментов наружного контура сечения области L при наличии запретной зоны, заданной в виде горизонтальной плоскости уровня при г0р = 1000мм : а - эллипс /7 при q 2 = 40° ; б -
эллипс / д при q 2 = 20°
П а р а м е тр ы
т,
£27
_П7 П8
т.
, ,П£
: на рисунке 2аб определяют положение центров
Q7 т П7 П8 ,П8
эллипсов /7 и \д , а параметры а • " а 11 ^ задают значения большой и малой полуосей соответственно эллипсов /7 и /д . Значения указанных параметров вычисляют с помощью функций от значений обобщенной координаты q 2. С этой целью используются
П7 ¡07
полиномы третей степени. Зависимости указанных параметров формы я и
положения ■■ эллипса /7 имеют следующий вид:
На основе использования уравнений (1) для эллипса /7 и аналогичных уравнений для эллипса /g неравенства, определяющие точки принадлежащие областям и fis
пространства Lq и задающие запрещенные конфигурации для этого случая имеют следующий вид:
Неравенства (2-3) получают на основе использования преобразований координат при
Oз.^qъq^ и Оз<? 4 связанных с эллипсами к системе О^Ч* задающей
переходе от систем
репер плоскости сечения в пространстве обобщенных координат Lq (см. рис. 2аб). Центры систем координат Оэл и О /эл совпадают с центрами эллипсов /7 и /д .
Для определения коэффициентов неравенства (2-3) для случая, когда запретная зона
задана горизонтальной плоскостью уровня Л зависимости коэффициентов
_сй
= f1 (zop
" = f2 (Z0P ), ..., f4 (Z0p ), 4 ■' = fg (Z0p ), f10 (Z0p ), ..., =f13 (Z0p ), = " = f-
f14
(z0p ), .... представим в виде интерполяционных полиномов третей степени. Для решения этой задачи используем полиномы, которые склеиваются в узловых точках. Пусть на
отрезке ** заданы узлы
П7-4 ,„т-2 7-1+1
га 12 ■/ Î+I
" = -- с Г <___<" = ~
,а также /+1 значений параметра
(определяющих коэффициент
полинома задающего
значение координаты
07
-Д7
центра эллипса /7 (см. рис. 2а)) по направлению оси q^
«7-4 ...ÎÎ7-2
/Я,, 3 Ш .
„П7-/+1
определяются экспериментальными
Значения параметра "'■ , 1 исследованиями построенных сечений для различных положений запретной зоны Р^
Для решения указанной задачи используем полином третьей степени:
Li 1 ор 2 вр 3 вр вр ар ор
(4)
На основе изложенной методики, возможно, определять значения для других коэффициентов неравенства (1). Коэффициенты неравенств (1-2) в этом случае в
соответствии с описанным выше методом определяются следующими шестнадцатью зависимостями:
Расчетные значения коэффициентов полиномов определяют на основе задания совокупностей узловых точек, полученных в результате вычислительных экспериментов с различными значениями параметра г0р . Полученные зависимости (4-7) позволяют для различных высот туннеля или значений параметра г0р рассчитывать значения коэффициентов полиномов используемых в неравенствах (1-2). Аналогичным образом значения коэффициентов неравенства (2) могут быть определены для нахождения
положения центра эллипса Ig и параметров его формы (соотношения "r- =f± (zop ), =
f2 (zop ), ..., f4 (Zop ), - f5 (Zop ), - h (Zop ), ■■■ , >™ = f13 (Zop ), ^ =f 14 (Z0p ).
.... ) (см. рис. 2б).
На рисунке 3абв приведены результаты расчетов коэффициентов соотношений (4-7) и на основе этого графическое представление функций = fi$(q2 , z0p), я° - f1б(Я2 < zop )'и = fi7(q2 , z0p) определяющих положение и форму эллипса /7 в различных сечениях. Всвязи с тем, что смещение центра эллипса по направлению оси q^ незначительное функция = fig(q2 1 z0p) имеет отображение на графике близкое к плоскости. Поэтому в данной работе график указанной функции не приводится.
Определим аналогичным образом положения центров эллипсов и значения длин большой и малой полуосей для случая, когда запретная зона ограничивается фронтально проецирующими плоскостями (образующими контур прямоугольника Pi см. рис. 1) в зависимости от значений x0p и zop . Результаты вычислительных экспириментов и расчета графиков функций f19(q2 , zop), = f20(^2 > zop )и 7 = f21(q2 , zop) для
трех различных значений параметра х0р представлены на рисунке 4абв.
Рис. 3 - Изображение графиков-функций: а
= , гор) ;
б - = Ьб(Я2 , 2ор) ; в - = f1у(Я2 / гор)
Рис. 4 - Графики-функции а
= *19 ( Я 2 / 2ор ); б - ; = f20 г я 2 / ^ :
"" = Г21( Я 2, zор )
Анализ графиков, представленных на рисунках 3абв и 4абв показывает, закономерности изменения значений параметров, определяющих положение и форму фрагментов эллипсов используемых для задания границ сечений области разрешенных конфигураций Л, от значений z0р и х0р, задающих положение запретной зоны Р1 .
С целью определения закономерностей изменения значений , и в зависимости от положения запретной зоны, которое задано параметрами х0р и z0p , а так же от
координаты я 2 , найдены значение данных параметров для различных точек
пространства обобщенных координат.
Результаты расчётов для десяти различных точек с некоторым шагом представлены в таблице. Для моделирования гиперповерхностей в трех четырёхмерных пространствах, определяемых параметрами (хор , гор , ц2/ ап ) , (хор , гор , ц2/ 6°7) и (хор , гор , ц2/ '"П ) выбираем для первого пространства узловую точку А д ^ (хор , г0р , ц2 , а" ) А д 1
(75см, 75см, 110°, 58°) (см. табл.) Через данную точку проведём по три
перпендикулярные 3-плоскости а/ (/ = 1, 2, 3) и а / (/ = 1, 2, 3).
Таблица
Значения координат узловых точек интерполирования
в
Хор т Й!- 42 ?рад П7 Ъ " град град
А1 75 75 но 58 25 -107
А: 80 80 90 107 43 -94
А? 100 100 50 150 43 12
А4 120 120 10 48 24 77
А; 80 80 80 108 37 -64
Ае 100 100 60 95 26 -20
А- 120 120 20 78 34 64
Ае 80 80 70 133 50 -53
а5 100 100 40 136 39 24
Аю 120 120 30 105 43 51
В каждой из 3-плоскостей о_/ моделируем интерполирующие кривые данных массивов точек, которые будут являться одномерными образующими моделируемой гиперповерхности. Уравнения трех гиперповерхностей в трех различных четырёх мерных пространствах будут следующие:
В качестве одномерных образующих пространства с координатами х0р , z0p , и а7, выбираем интерполирующие полиномы третьего порядка. Для этого в каждой из плоскостей а/ выбираем по четыре узла интерполирования
Первые и вторые компаненты списка координат х 0р и zop точек л/ и т.п. заданы в сантиметрах, а третья ц2 и четвертая в градусах. Уравнения интерполирующих полиномов располагающих в трёх взаимно перпендикулярных плоскостях а1 , 02 и 03 будут следующие:
Коэффициенты уравнений (10) вычисляют решением трёх систем состоящих из четырех уравнений с четырьмя неизвестными. Первое уравнение получают при подстановке в первое уранение системы (10) координат точек Л-/, л/ , л/ и Л^ .
Га-П7 -1 Х0 + С1 +
-2 + с2 Х1 +
-3 — хо + са Х1 +
-4 ~ хо + с4 Х1 +
Ссг) ' xz "I" (сг) ' *з
(с3)г
+ С^)3
(11)
Решая данную систему (вместо с/ подставляя поочередно координату хор точек А/, А^ ,
Аз( и А^ ), получаем коэффициенты хд , х- , х2 и х^ первого уравнения системы (10) для
переменной а7. Подставляя поочередно координату юр точек АА^ , Аз(/ и А^ , получаем коэффициенты хд , х- , х2 и второго уравнения (10). Анологичным образом
определяются уравнения (10) для переменных Ь7 и т^7 . Для получения первого
уравнения моделирующей гиперповерхности (9), необходимо суммировать уравнения
(10) и сумму поделить на три Ц41. Уравнения гиперповерхностей третьего порядка после этого принимают следующий вид:
а =
(о.0009 ■ хор + 0.0031 ■ + 0.0002 ■ ) +
М-
+ + 0,39 +0,28.
■0.337 - х^ - 0,937 ■ z^ - 0,058 ■ q2
■ +393,01:
)
b(77 =
(0ДЮ17-4 + 0.0008 ■
0.000'L ■ ql ) + (-0,S28 ■ x\
0,27S ■ z^ + 0.022 ■ )
+ (SW7 4, + 27,79 ■ zBf
L,2S.4:)
2505,91;
m
ai
= (
0.0022 ■ ^ + 0 0015 ^
3 + 0.0001 ql I +
+ (б+,82 ■ Хшр + 52,28 ■ Ы + 0,62 ■ q
) + (-0,663 )
op
3920.08.
0,499 ■ ^ - 0,027 ■ q22j
Уравнения (12) позволяют в приближенном виде определять значения , и т в зависимости от значения переменных х0р , г0р и ц2 . Относительная максимальная
погрешность определения параметров дП , ¡>п' и в заданной области (см. табл.) на основе использования соотношений (12) составляет 10-15 процентов.
Моделирование движения манипулятора с использованием области разрешенных конфигураций
(12) ш
В работе по результатам теоретических исследований выполнено решение тестовой задачи связанной с перемещения центра ВЗ при наличии запретной зоны P i (см. рис.
5абв). При этом использовался алгоритм виртуального моделирования движения механизма манипулятора на основе синтеза движений по вектору скоростей изложенный
в работе i11^. Значения обобщенных координат определялись на основе использования параметрического способа задания области разрешенных конфигураций L . Моделирование движения выполнено в системе САПР ACAD с использованием алгоритмического языка программирования AutoLISP. На рисунке 5а представлены результаты моделирования движения механизма манипулятора при отсутствии запретных зон. Соответственно на рисунке 5бв показан синтез движений при наличии запретных зон с использованием разработанного алгоритма анализа текущих ситуаций. При моделировании движений представленных на рисунках 5б и 5в использовался масштаб
отображения вектора Lqh , который был принят равным h = 1 и h = 2 i11!. По результатам
синтеза движений определены графики функций q = f ( t ) , отражающие изменение
обобщенных координат q¡ (см. рис. баб). Где t определяет текущий параметр движения. Анализ графиков показывает, что использование масштаба отображения Lqh позволяет уменьшить кривизну траекторий, что позволяет так же уменьшить динамические нагрузки
на исполнительный механизм.
Рис. 5. Результаты синтеза движений манипулятора: а - синтез по критерию минимизации объема движения при отсутствии запретных зон, б - синтез при значении h =1 ; в -
синтез при значении h =2
Рис. б Графики изменения обобщенных координат при синтезе движений манипулятора с анализом пересечения вектора Lqh и области L :
а - при значении h =1 ; б - при значении h =2
Заключение и выводы
Полученные зависимости позволяют построить область разрешенных конфигураций, являющейся базой знаний при интеллектуальном управлении движением механизма манипулятора в заранее известной внешней среде. Использование полученной области при синтезе траектории в конфигурационном пространстве Q позволяет проводить коррекцию движения манипулятора с целью предвидения и исключения тупиковых ситуаций при синтезе движений по вектору скоростей.
Использование разработанного алгоритма оценки текущих ситуаций, позволяет на виртуальном уровне синтезировать траекторию движения от начальной до целевой точки ВЗ. Время расчета тестового задания при использовании разработанного метода сокращается на порядок по сравнению со способом, при котором для каждой итерации определяется пересечение примитивов задающих звенья механизма манипулятора и запретных зон.
Библиография
1. Афонин, В. Л. Интеллектуальные робототехнические системы / В. Л. Афонин, В. А. Макушкин. - М. : Интернет-университет информационных технологий, 2010. - 208 с.
2- Григорьев, С. Н. Современное состояние и перспективы развития промышленной робототехники / С. Н. Григорьев, А. Г. Андреев, С. П. Ивановский // Мехатроника, автоматизация, управление. - 2013. - № 1. - С. 30-34.
3. Лохин, В. М. Повышение адаптивных свойств автономных роботов на базе интеллектуальных технологий / В. М. Лохин, С. В. Манько, М. П Романов. // Экстремальная робототехника. - 2015. - № 1 (1). - С. 59-67.
4. Юсупов, Р. М. Интеллектуализация процессов управления и навигации робототехнических систем / Р. М. Юсупов, А. В. Тимофеев // Экстремальная робототехника. - 2014. - Т. 1, № 1. - С. 16-21.
5. Whitney, D. E. The Mathematics of Coordinated Control of Prosthetic Arms and Manipulators / D. E. Whitney // J. Dyn. Sys., Meas., Control. - 2010. - № 94 (4). - P. 303-309.
6. Кобринский, А. А. Манипуляционные системы роботов / А. А. Кобринский, А. Е. Кобринский. - М. : Наука. 1985. - 343 с.
7. Корендясев, А. И. Манипуляционные системы роботов / А. И. Корендясев, Б. Л. Саламандра, Л. И. Тывес. - М. : Машиностроение, 1989. - 472 с.
8. Lopatin P. Investigation of a Target Reachability by a Manipulator in an Unknown Environment. International Conference on Mechatronics and Automation. 2016. August 7-10, Harbin, China.
9. Лопатин, П.К., Исследование достижимости целевых состояний в неизвестной статической среде / П.К. Лопатин // Мехатроника, автоматизация, управление. -2009. - №4. - С. 2 - 6.
10. Притыкин, Ф. Н. Исследование поверхностей, задающих границы области разрешенных конфигураций механизма мобильного манипулятора при наличии запретных зон / Ф. Н. Притыкин, Д. И. Нефедов // Мехатроника, автоматизация, управление. - 2016. - № 6, - т. 17. - С. 404-413.
11. Притыкин, Ф. Н. Геометрический анализ текущих ситуаций, характеризующих положение манипулятора и окружающей среды на основе использования области разрешенных конфигураций [Электронный ресурс] / Ф. Н. Притыкин , В. Г. Хомченко, Д. И. Нефедов // Программные системы и вычислительные методы. -2017. - № 2. - Режим доступа: http://e-notabene.ru/ppsvm/article_22685.html
12. Притыкин, Ф.Н. Исследование влияния запретных зон на форму и положение области разрешенных конфигураций механизма манипулятора / Ф.Н. Притыкин, Д.И. Нефедов // Омский научный вестник. - 2017. - Т. 1, № 1. - С. 19 - 24.
13. Рвачев, В. Л. Теория R-функций и некоторые ее приложения / В. Л. Рвачев. - Киев, 1982. - 252 с.
14. Вертинская, Н. Д. Задачи геометрического моделирования технологических процессов: научно-методическое пособие / Н. Д. Вертинская. - М. : Издательский дом Академии Естествознания, 2015. - 132 с.
