Научная статья на тему 'Планирование траектории манипулятора для движущейся цели'

Планирование траектории манипулятора для движущейся цели Текст научной статьи по специальности «Электротехника, электронная техника, информационные технологии»

CC BY-NC
497
61
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ОПТИМИЗАЦИЯ / ОЦЕНКА СКОРОСТИ ДРЕЙФА / ДВИЖУЩАЯСЯ ЦЕЛЬ / КОМБИНИРОВАННЫЙ ПОИСКОВОЙ МЕТОД / ОБРАТНАЯ ЗАДАЧА КИНЕМАТИКИ / КОМПЕНСАЦИЯ ЦЕЛЕВОЙ ФУНКЦИИ / ПЛАНИРОВАНИЕ ТРАЕКТОРИИ / МНОГОЗВЕННЫЙ МАНИПУЛЯТОР / РОБОТОТЕХНИКА / ДРЕЙФ ЦЕЛЕВОЙ ФУНКЦИИ

Аннотация научной статьи по электротехнике, электронной технике, информационным технологиям, автор научной работы — Галемов Руслан Тахирович, Масальский Геннадий Борисович

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

i Надоели баннеры? Вы всегда можете отключить рекламу.

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Галемов Руслан Тахирович, Масальский Геннадий Борисович

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.
i Надоели баннеры? Вы всегда можете отключить рекламу.

Текст научной работы на тему «Планирование траектории манипулятора для движущейся цели»

Планирование траектории манипулятора для движущейся цели

Галемов Руслан Тахирович

аспирант, кафедра робототехники и технической кибернетики, Сибирский Федеральный Университет 660041, Россия, Красноярский край, г. Красноярск, проспект Свободный, 79

И galemovruslan@gmail.com

Масальский Геннадий Борисович

кандидат технических наук

профессор, кафедра робототехники и технической кибернетики, Сибирский федеральный университет 660041, Россия, Красноярский край, г. Красноярск, проспект Свободный, 79

И gmasalsky@sfu-kras.ru Статья из рубрики "Автоматизированные системы управления технологическими процессами"

Аннотация.

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

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

DOI:

10.25136/2306-4196.2018.2.25478 Дата направления в редакцию:

26-02-2018

Дата рецензирования:

09-03-2018

Дата публикации:

11-03-2018

Введение

Можно выделить три подхода к решению задачи слежения рабочим органом манипулятора за движущейся целью: построение траектории через инвертированный Якобиан, планирование маршрута в пространстве состояний и интеллектуальные подходы к решению обратной задачи кинематики. Метод инвертированного Якобиана является одним из самых распространенных способов решения обратной задачи кинематики (ОЗК) манипулятора Ш,!2!. Он используется в системах управления, основанных на отслеживании цели средствами технического зрения -И-110!.

Планирование маршрута в пространстве состояний использует алгоритмы поиска пути. Здесь широко применяется метод быстрорастущих случайных деревьев Один из подходов к решению задачи построения траектории заключается в нахождении целевых конфигураций манипулятора с помощью грубого решения ОЗК и построения пути от начальной до целевой конфигурации, используя быстрорастущие случайные деревья 1121,1131. Другой подход основан на поиске пути с использованием эвристик, направляющих поиск к более предпочтительной цели 1141,!151. Именно этот подход используется для слежения за движущейся целью !16!.

Нейронные сети приобрели широкое распространение в решении ОЗК и планирования пути. Они могут обучаться как на моделях, так и во время работы манипулятора. С их помощью строятся траектории в пространстве конфигураций по требуемым положениям в рабочем пространстве. Классическое обучение с обратным распространением ошибки, когда на вход подавался вектор положений рабочего органа манипулятора, а на выходе получался вектор обобщенных координат, показывало большое время обучения и большую ошибку !17!. Поэтому были предложены работающие параллельно нейронные сети !18!, среди которых выбиралось лучшее решение. Также для каждой обобщенной координаты использовались независимые нейронные сети Другой подход

подразумевал изменение алгоритмов обучения, так в !20! использовался метод

электромагнетизма !21]. В !22! предложено обучать нейронную сеть на небольшом связанном участке рабочего пространства и записывать веса сети в таблицу поиска. Количество таблиц равно количеству участков и выбор таблицы обусловлен текущим положением цели.

Среди интеллектуальных алгоритмов, используемых для планирования пути, также распространены генетические алгоритмы (ГА). В !22! показана способность ГА решать ОЗК. В123^ сравниваются способы кодирования «особей» обобщенных координат при планировании пути. Результаты показали, что при бинарном кодировании траектория

имеет частые выбросы обобщенных координат, тогда как числовое кодирование дает

гладкую траекторию. В ^^ представлено применение обратной связи в генетическом алгоритме. При таком подходе популяция состоит не из конфигураций манипулятора, а из смещений рабочего органа на основе которых получают смещения обобщенных

координат. В ^^ показан подход, сочетающий генетический алгоритм с алгоритмом имитации отжига, который настраивает вероятности скрещивания и мутации.

В данной статье рассматривается задача слежения рабочего органа манипулятора за движущейся целью. Это достигается путем решения обратной задачи кинематики в каждый момент времени. Решение ОЗК производится комбинированным поисковым методом (КПМ), представляющим из себя комбинацию генетического алгоритма и симплексного поиска. Поскольку цель движется непрерывно, то слежение за движущейся целью можно рассматривать как задачу оптимизации с дрейфующим экстремумом. Здесь предлагается модификация КПМ, способная решать обратную задачу кинематики с движущейся целью.

Прямая и обратная задачи кинематики манипулятора

Решениепрямой задачи кинематики(ПЗК) для манипулятора, при известной структуре, есть расчет изменения координат рабочего органа (РО) относительно координат основания в рабочем пространстве при известных углах поворота его сочленений. В общем виде эта задача выглядит следующим образом:

где ц - вектор лх1 обобщенных координат (углов поворота в звеньях) манипулятора;

г] _ матрица размерности 3x4^ здесь г - вектор, размерности Зх1, положения РО

рабочем пространстве ^ [р* р*1- матрица размерности 3х3, где р-, р*

>чем пространстве * ¡> матрица размерности где

векторы, размерности Зх1, составляющие локальную систему координат РО

манипулятора в рабочем пространстве . Компоненты матрицы Т представлены на

УУ1 )71

рисунке 1. Обозначим ги р степени свободы РО на перемещение и вращение

~ т = тг +т „

соответственно. Величина у ? зависит от конструкции манипулятора. Для

планарного манипулятора т = 3 т. к. РО может двигаться вдоль двух осей и вращаться

вокруг одной оси. Максимальное значение т = 6, тогда РО может перемещаться и

вращаться по трем осям Декартовой системы координат.

Рис. 1 - Рабочее пространство манипулятора

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

параметрами Денавита-Хартенберга. Список и значения параметров представлены в таблице 1.

Таблица 1- Параметры Денавита-Хартенберга

Параметр Значение

Угол между осями и ^ вокруг оси 2'-1

а, Угол между осями и вокруг оси х'

Расстояние между осями 2'-1 и вдоль оси х

Расстояние от основания / -1 системы координат до оси х'

вдоль 2'-1

Тип сочленения: 1- призматическое, 0-вращательное.

Эти параметры используются для формирования матриц трансформации. Положение и ориентация системы координат / -го сочленения по отношению к (/ -1)-му сочленениюописывается матрицей трансформации:

А' -Ам -

О 0 0 1

, (2)

где

Решение прямой задачи кинематики находится из трансформации п -го сочленения по отношению к основанию манипулятора

А™ - А1 А2 А™

. (3)

Матрица Т извлекается из

Обратная задачи кинематики(ОЗК) служит для поиска углов в сочленениях манипулятора q при известной матрице T РО и выводится из (1)

ч = Г(т)

. (4)

Решение ОЗК напрямую связано с основной целью манипулятора - расположением рабочего органа с определенной позицией и ориентацией. Трудность решения ОЗК

заключается в том, что ^ ^ сложно аналитически выразить из

. Кроме того, для

манипуляторов с числом степеней свободы для точек а и Ь при ^ 751« задача (1)

может давать -/С<1?) поэтому существует более одного решения (4), т.е. функция многоэкстремальная. При этом эти решения могут сильно отличаться друг от друга.

Решение обратной задачи кинематики комбинированным поисковым методом

Для манипулятора с п звеньями комбинированный поисковой метод решает следующую задачу оптимизации:

1 " ¡.1

где

, t - непрерывное время, - начальное значение

обобщенных координат /' -го звена, - нормированная сумма длин звеньев

манипулятора с / -го до п -го, ориентацию рабочего органа равное:

функциональное ограничение на положение и

= (7)

(8) (9)

где

2 расстояния от текущего (для момента времени t ) положения РО

Уо

Ф

манипулятора до цели по осям "и, -1 и и ""соответственно; ■^ и-х,у,г _ уГОл между осью системы координат цели и соответствующей осью системы координат РО манипулятора; положения и ориентации цели обозначаются подстрочным индексом «ц», а индексом «м» обозначаются текущие положения и ориентации манипулятора; 00 -

штра фно й ко эффицие нт

О < ш <1

, отражающий влияние расстояния до цели на значение

Комбинированный поисковой метод представляет собой генетический алгоритм в сочетании с симплексным поиском (СП). На каждом шаге генетического алгоритма создается популяция особей, каждая особь представляет собой точку в пространстве

л р Р"

поиска. Так как решением ОЗК для манипулятора сп степенями является вектор 4 ,

то каждая особь КПМ4'' является вектором ^ . Здесь ■/-1---^' номер вершины, Б -число особей в данной популяции. Аналогичное представление имеют вершины симплекса в КПМ.

Ч]

<71! Я\г <713 ... Я и,

т Я22 <723 ... ... Яъ,

...

Я,л ЧР1 ЧР1 ... ... Яр»

н

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

Рис. 2 - Представление особи(вершины) в КПМ при решении ОЗК Поиск происходит по следующему алгоритму:

1) создается к -я популяция генетического алгоритма * объемом Б ;

2) вычисляется целевая функция

п

^ 3/, для каждой вершины ^ из

3) особи в популяции сортируются по увеличению (поиск минимума) целевой функции

4) первые ? особей назначаются центрами для ? симплексов;

5) производится симплексный поиск из всех-? центров. Результаты каждого

симплексного поиска записывают в матрицу H размерности

р хм

(рис.2);

б) ^-строка Н, ^ ^-- Р сравнивается с лучшей особью популяции, и если

^пчк _

8) проверка условий останова: " ' "тш, где "тш - максимальное число шагов алгоритма: если условия не выполнены переход к п.1, иначе переход в п.9;

9) вывод результата.

В данной работе движение цели это изменение во времени координат ^, а

значения , р2Ц остаются постоянными. Делается допущение, что измерение нового положения цели происходит без задержек времени и учитывается только время, затраченное на вычисления КПМ. В каждый момент времени известно только текущее положение и ориентация цели.

Задачу(5) запишем в виде:

, (10)

где

р{*)=

О, ^ <ЯЖШ, I =1...л оо, в обратном случае

, (11)

ф(ч) = г 2

п !-1 ^Зтахг ^т

, (12)

.

Здесь

Ъ = (<?т

которых влияет на точность и гладкость решения. Штраф приближении к позиционным ограничениям [26].

весовые коэффициенты штрафов, изменение

ф(ч)

увеличивается при

Целевая функция (10) отражает вертикальный дрейф экстремума функции, обусловленный изменением во времени ограничения (6). Идентификацию параметров дрейфа реализуем за счет дополнительного (повторного) эксперимента в каждой

текущей вершине КПМ. Для этого аппроксимируем функциональное ограничение

на интервале ^ выражением вида

где

евклидова норма,

вектор оценок дрейфа цели вдоль осей ОХ,

ОУ, 02 в ] -и вершине; 3 3

3 - интервал времени между повторными измерениями положения цели в j -й вершине КПМ; <2, 1> - номер эксперимента.

Для поиска лучшей вершины КПМ рассчитаем компенсированное (с учетом дрейфа цели) значение целевой функции

, (14)

для ГА, и 3 ' 3 ,

где ^- время вычисления вj -й вершине; ^ ^ 3 ^ У-1...Л + 1 для сп. Компенсация влияния дрейфа для ГА проводится после проведения экспериментов во всех Б вершинах, а в СП на каждом шаге поиска для п +1 вершин текущего симплекса относительно s -ой вершины. Временная диаграмма оценки и компенсации представлена на рис.3.

_ А», ■ _

----1 р- —р-

Рис. 3 - Интервалы времени при оценке и компенсации дрейфа

Вектор оценок 3 (13), рассчитывается на основе вектора текущих положений звеньев и вектора расстояний от рабочего органа до цели по осям ОХ, OY и OZ соответственно

„ ДЛ, =Гд4 д4 д4Т I-

ний 3 I ^ 3? 3Ч ■

время

Обозначим вектор оценок изменения расстояни

а

повторного измерения вектора 3 в вершине,/ . Тогда оценка скорости дрейфа в момент времени Ц равна:

Г. Д1

ь, =ь,, +---Гда, - дй,1

(15)

(17)

(18)

Здесь Г - матрица весовых коэффициентов, - единичная матрица размерности Выражения (15)-(18) рассчитываются для каждой вершины КПМ. Для расчета (13) в ГА

3x3

используется оценка полученная в последней вершине Б, в СП используется оценка

Ъ г1

полученная в отраженной вершине. Матрица весов 1 имеет постоянные большие

значения на главной диагонали исходя из предположения, что скорость дрейфа может

меняться в широком диапазоне значений на протяжении всего времени оценки.

Алгоритм решения обратной задачи кинематики многозвенного манипулятора комбинированным поисковым методом:

1) создается популяция размером Б :

■ выбор родителей;

■ скрещивание;

■ мутации;

2) для

рассчитываем:

значение целевой функции

(10);

изменение расстояния (16) по каждой оси:

Дг

время

(17);

вектор параметров -1' (15);

3) для

] 1.. Дт^

вычисляется ^ и целевая функция КПМ

Р*

(14);

4) особи популяции * сортируются в порядке возрастания

5) из выбираются первые ? особей, которые становятся центрами симплексных

поисков;

к, = 0 к,

счетчик шагов I -го СП,

;

6) для / -го ' 1---Р симплекса производятся процедуры:

■ отражение;

■ растяжение;

■ сжатие;

7) для s -й вершины I - го симплекса, где s - индекс отраженной вершины симплекса:

■ значение целевой функции (Ю);

■ изменение расстояния (16) по каждой оси: (^'О ^ >Ча) ^ Л^зЛ^-О .

■ измерение времени ^ (17) и

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

обновляется вектор параметров 5 (15);

8) для

к, = к, +1

9)

j = \...n + \

вычисляется значение целевой функции КПМ

(14);

10) проверка условий останова ^ > ^^ , - максимальное число шагов / -го СП: ■ если условия не выполнены переход к п.6;

заполняем матрицу

, где ^ - результат / -го СП;

11) результаты работы симплексных поисков: матрица Н размером РХп г обновленный Ъ,

вектор

12) каждая строка 1 изН,

^ ^ Р ГПЯт-|М[?ЯРТГ51 г луишрй пгпбшл СО

сравнивается с лучшей особью - ! из популяции:

вычисляется

если

, то

13)

40=^0). * = * + !.

14) проверка условий останова ГА ^ > : если условия не выполнены переход к п.1;

15) вывод результата.

Экспериментальные исследования

Эксперименты проводились на моделях манипулятора в среде МА^АВ. Эксперимент 1 : Рассмотрим трехзвенный манипулятор, работающий в плоскости декартовой системы координат и имеющий число степеней свободы ~ 2 и тр ~ 1 (рис.4).

Рис. 4 - Кинематика трехзвенного плоского манипулятора

Данный манипулятор не является избыточным т = поэтому ОЗК имеет малое (и2) число решений. Параметры Денавита-Хартенберга для манипулятора представлены в таблице 2

Таблица 2 - Параметры трехзвенного плоского манипулятора

Звено Звено 1 Звено 2 Звено 3

Параметр

Ч 0 0 0

% рад. 0 0 0

я-, м. 0.500 0.670 0.200

4, м. 0 0 0

[ 'Зшт ^тчк ] град -170, 170 -170, 170 -170, 170

В таблице 3 представлены параметры КПМ, обеспечивающие максимальное быстродействие и точность поиска. Поскольку для плоского манипулятора трёх вращательных степеней свободы достаточно для обеспечения положения и ориентации рабочего органа, то вес ш установлен соответствующим образом. Выбор значений весов

из (10) обусловлен необходимостью уменьшения (б) до нуля, поэтому ^

намного больше остальных. Вес 3 имеет наименьшее значение поскольку (12) должно иметь значительное влияние на целевую функцию только вблизи позиционных

ограничений. Вес 1 получается из условия равенства суммы весов единице.

Таблица 3 - Параметры поиска для эксперимента 1

П а ра ме тр Размер Вес Количество Веса

популяции ш симплексов

s р

Значение 10 0.5 4 [0.8 0.15 0.05]

Движение цели происходило по траекториям, представленным в таблице 4. Траектория 1

- прямая в плоскости с фиксированной координатой х и рабочим органом,

ориентированным в сторону положительного направления оси х0. Траектория 2 -

лемниската Бернулли в плоскости с рабочим органом, ориентированным в сторону положительного направления оси х0.

Таблица 4-Траектории для испытания плоского манипулятора

Траектория 1 Траектория 2

Ч м

Л, м

Ед "1 0 0" 0 1 0 0 0 1 "1 0 о" 0 1 0 0 0 1

ь, м/с 0.5 1

Построенные траектории движения рабочего органа представлены на рис. 5 и рис. 6.

а)

150

О 5 щ 15

к

в)

0.Т4

О' ....... . ........ I

О 5 Ю

к

г)

Рис. 5- Результаты решения ОЗК для траектории 1: а) заданная и пройденная траектории; б) ошибки положения; в) траектории обобщенных координат; г) ошибки

ориентации

.1 Л! О И 1 И

X м

а)

б)

150 !—■—ч»

1« \ ч? ■

И у /

Л V /

/ \ А /

\ ? \ / 1 /

9

\ Г V /

■50 | \ А \ / Ач Ч/ А |

1« 150 / \

в)

г)

Рис. 6- Результаты решения ОЗК для траектории 2: а) заданная и пройденная траектории; б) ошибки положения; в) траектории обобщенных координат; г) ошибки

ориентации

Из рис. 5а и рис. 6а видно, что траектория рабочего органа проходит достаточно близко к траектории цели. Как показывают рис. 5б и рис. 6б ошибки положения в рабочем пространстве находится в диапазоне 10-3 метра. По рисункам 5в и 6в видно, что простроенные траектории не имеют скачкообразных изменений обобщенных координат и пригодны для дальнейшего использования в качестве задающего воздействия регулятора привода манипулятора.

Эксперимент 2 : Рассмотрим трехзвенный манипулятор, работающий в пространстве

хоУого (рис. 7). Поскольку число степеней свободы манипулятора (л = 3) меньше числа

степеней свободы рабочего пространства проведем задачу оптимизации по

положению, игнорируя ориентацию рабочего органа. В таблице 5 приведены параметры кинематики манипулятора.

Таблица 5 - Параметры трехзвенного манипулятора

Звено Звено 1 Звено 2 Звено 3

Параметр

а* 0 0 0

рад. -п!2 0 0

% м. 0 0.500 0.650

м. 0.700 0 0

[ ^шш ^тга ] град -170, 170 -90, 0 0, 90

Поскольку размерность пространства поиска не изменилась, то использовались параметры поиска из эксперимента 1, за исключением параметра 00. Параметры поиска для трехзвенного пространственного манипулятора представлены в таблице 6.

Таблица 6 - Параметры поиска для эксперимента 2

Пар а ме тр Размер Вес Количество Веса

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

популяции ш симплексов

s Р*

Значение 10 1 4 [0.8 0.15 0.05]

Рис. 7- Кинематика трехзвенного пространственного манипулятора

Траектории для испытания схожи с траекториями для эксперимента 1. Траектория 1 -прямая в плоскости параллельной , траектория 2 - лемниската Бернулли,

расположенная в плоскости параллельной У°г<) .

Таблица 7-Траектории для испытания пространственного манипулятора

Траектория 1 Траектория 2

Ч м ^<0 = 0 8 ^(0 = 0.85

>ц, м

\ м М0-.

" 0 0 1" 0 1 0 -1 0 0_ " 0 0 1" 0 1 0 -1 0 0_

ъ, м/с 0.5 1

Результаты эксперимента на рис. 8 и рис. 9.

а)

б)

11 12 13 14

в)

Рис. 8- Результаты решения ОЗК для траектории 1: а) заданная и пройденная траектории; б) ошибки положения; в) траектории обобщенных координат

а)

б)

в)

Рис. 9- Результаты решения ОЗК для траектории 2: а) заданная и пройденная траектории; б) ошибки по осям координат; в) траектории обобщенных координат

По результатам можно убедиться, что алгоритм способен строить плавные траектории для не избыточных пространственных манипуляторов, а так же отклоняться от траектории без скачков обобщенных координат, когда их значения приближаются к граничным. На (рис.9б) видны значительные изменения ошибки по одной из координат. Они связанны с

выбором параметров функции (10), при увеличении параметра ^ уменьшится

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

Эксперимент 3 : Рассмотрим семизвенный манипулятор, представленный на рис.10. Такая конструкция является избыточной в кинематическом смысле (п > т ). Это значит, что он способен обеспечить произвольную ориентацию рабочего органа в рабочей области. Такие манипуляторы имеют большое число решений ОЗК.

Рис. 10 - Кинематическая схема семизвенного манипулятора

Кинематические параметры указаны в таблице 8.

Таблица 8 - Параметры семизвенного манипулятора

Звено Звено 1 Звено 2 Звено 3 Звено 4 Звено 5 Звено Звено 7

Параметр 6

Ol 0 0 0 0 0 0 0

\ рад. я/2 -я/2 я/2 -я/2 я/2 -я/2 0

д', м. 0 0 0.650 0 0 0 0

м. 0.700 0 0.500 0 0.600 0 0.200

[^rnm ^шак ] -180, -110, -180, -110, -170, -90, 90 -180,

град 180 110 180 110 170 180

Поскольку размерность пространства и число экстремумов возросло по сравнению с экспериментами 1 и 2, то эксперимент 3 проводился с большим объемом популяции и количеством симплексов на популяцию. Поскольку конструкция позволяет отслеживать ориентацию рабочего органа, то вес m установлен в 0.5. Параметры поиска представлены в таблице 9.

Таблица 9 - Параметры поиска для эксперимента 3

Пар а ме тр Размер П рио рите т Количество Веса

популяции поиска симплексов h M

s ш Рп

Значение 30 0.5 3 [0.8 0.15 0.05]

Для этого эксперимента были использованы траектории из эксперимента 2. Результаты эксперимента на рис. 11 и рис. 12.

1,1 1

-0.5.0.1 -0-й 0 « (U M û.S t и >:, m

а)

90Î5

О 5 10 1S

h

б)

в)

г)

Рис. 11- Результаты решения ОЗК для траектории 1: а) заданная и пройденная траектории; б) ошибки положения; в) траектории обобщенных координат; г) ошибки

ориентации

а)

б)

в)

г)

Рис. 12- Результаты решения ОЗК для траектории 2: а) заданная и пройденная траектории; б) ошибки положения; в) траектории обобщенных координат; г) ошибки

ориентации

Несмотря на большое число потенциальных решений ОЗК, алгоритм строит траекторию рабочего органа с ошибкой менее 0.01 м и плавными траекториями обобщенных координат.

По результатам экспериментов наблюдается успешное решение ОЗК для не избыточных и избыточных манипуляторов. Видно, что решение получается с ошибкой, не превышающей 0.01м, кроме случаев, когда обобщенные координаты приближаются к граничным значениям. Такая точность достигается за одну итерацию КПМ благодаря глобальным свойствам ГА и эффективности СП.

Заключение

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

Рассчитанные траектории плавные и не выходят за допустимые границы. Плавность траектории в пространстве обобщенных координат связана с использованием целевой функции (5) , которая позволяет КПМ выбрать из множества решений ОЗК только те, которые требуют минимальных перемещений.

Возможность выбора из набора вариантов дает КПМ преимущество по сравнению с классическими итерационными алгоритмами решения ОЗК и другими алгоритмами, основанных на одном критерии поиска. Это преимущество выражается в возможности получения глобального решения основанного на сумме критериев (10) за несколько

итераций поиска. Данный алгоритм прост для реализации и пригоден для параллельного вычисления.

Библиография

1. Orin D. E., Schrader W. W. Efficient computation of the Jacobian for robot manipulators // The International Journal of Robotics Research. - 1984. - Vol. 3. - No. 4. - P. 66-75.

2. Whitney D. E. Resolved motion rate control of manipulators and human prostheses //I EEE Transactions on man-machine systems. - 1969. - Vol. 10. - No. 2. - P. 47-53.

3. Yoshida K., Umetani Y. Control of space free-flying robot // Decision and Control, 1990., Proceedings of the 29th IEEE Conference on. - IEEE, 1990. - P. 97-102.

4. Piepmeier J. A., McMurray G. V., Lipkin H. Tracking a moving target with model independent visual servoing: A predictive estimation approach // Robotics and Automation, 1998. Proceedings. 1998 IEEE International Conference on. - IEEE, 1998.

- Vol. 3. - P. 2652-2657.

5. Sanchez-Sanchez P., Reyes-Cortes F. A new cartesian controller for robot manipulators // Intelligent Robots and Systems, 2005.(IR0S 2005). 2005 IEEE/RSJ International Conference on. - IEEE, 2005. - P. 3733-3739.

6. Gamarra D. F. T., Cuadros M. A. S. L. Forward models for following a moving target with the puma 560 robot manipulator // Inteligencia Artificial. - 2015. - Vol. 18. - No. 56. - P. 31-42.

7. Kim M. S. et al. Robot visual servo through trajectory estimation of a moving object using Kalman filter // Emerging Intelligent Computing Technology and Applications. -2009. - P. 1122-1130.

8. Wang C., Lin C. Y., Tomizuka M. Design of kinematic controller for real-time vision guided robot manipulators // Robotics and Automation (ICRA), 2014 IEEE International Conference on. - IEEE, 2014. - P. 4141-4146.

9. Houshangi N. Control of a robotic manipulator to grasp a moving target using vision // Robotics and Automation, 1990. Proceedings., 1990 IEEE International Conference on.

- IEEE, 1990. - P. 604-609.

10. Liu Y. et al. Tracking of a moving target by combination of force/velocity control based on vision for a hydraulic manipulator // Mechatronics and Automation, 2007. ICMA 2007. International Conference on. - IEEE, 2007. - P. 3226-3231.

11. LaValle S. M. Planning algorithms. - Cambridge university press, 2006. - P. 1007.

12. Hirano Y., Kitahama K., Yoshizawa S. Image-based object recognition and dexterous hand/arm motion planning using rrts for grasping in cluttered scene // Intelligent Robots and Systems, 2005.(IR0S 2005). 2005 IEEE/RSJ International Conference on. -IEEE, 2005. - P. 2041-2046.

13. Stilman M. et al. Manipulation planning among movable obstacles // Robotics and Automation, 2007 IEEE International Conference on. - IEEE, 2007. - P. 3327-3332.

14. Bertram D. et al. An integrated approach to inverse kinematics and path planning for redundant manipulators // Robotics and Automation, 2006. ICRA 2006. Proceedings 2006 IEEE International Conference on. - IEEE, 2006. - P. 1874-1879.

15. Drumwright E., Ng-Thow-Hing V. Toward interactive reaching in static environments for humanoid robots // Intelligent Robots and Systems, 2006 IEEE/RSJ International Conference on. - IEEE, 2006. - P. 846-851.

16. Chaabaani A., Bellamine M. S., Gasmi M. Controlling a Humanoid Robot Arm for Grasping and Manipulating a Moving Object without Cameras // International Journal of Information and Electronics Engineering. - 2015. - Vol. 5. - No. 4. - P. 286.

10.25136/2306-4196.2018.2.25478

Kw6epHeTMKa u nporpaMMiupoBaHiue, 2018 -

2

17. Bingul Z., Ertunc H. M., Oysu C. Applying neural network to inverse kinematic problem for 6R robot manipulator with offset wrist // Adaptive and Natural Computing Algorithms. - Springer, Vienna, 2005. - P. 112-115.

18. Koker R., Qakar T., Sari Y. A neural-network committee machine approach to the inverse kinematics problem solution of robotic manipulators // Engineering with Computers. - 2014. - Vol. 30. - No. 4. - P. 641-649.

19. Karlik B., Aydin S. An improved approach to the solution of inverse kinematics problems for robot manipulators // Engineering applications of artificial intelligence. -2000. - Vol. 13. - No. 2. - P. 159-164.

20. Feng Y., Yao-nan W., Yi-min Y. Inverse kinematics solution for robot manipulator based on neural network under joint subspace // International Journal of Computers Communications & Control. - 2014. - Vol. 7. - No. 3. - P. 459-472.

21. Birbil §. i., Fang S. C. An electromagnetism-like mechanism for global optimization // Journal of global optimization. - 2003. - Vol. 25. - No. 3. - P. 263-282.

22. Parker J. K., Khoogar A. R., Goldberg D. E. Inverse kinematics of redundant robots using genetic algorithms //Robotics and Automation, 1989. Proceedings., 1989 IEEE International Conference on. - IEEE, 1989. - P. 271-276.

23. Momani S., Abo-Hammour Z. S., Alsmadi O. M. K. Solution of inverse kinematics problem using genetic algorithms // Applied Mathematics & Information Sciences. -2016. - T. 10. - No. 1. - P. 225.

24. da Graca Marcos M., Machado J. A. T., Azevedo-Perdicoulis T. P. Trajectory planning of redundant manipulators using genetic algorithms // Communications in nonlinear science and numerical simulation. - 2009. - Vol. 14. - No. 7. - P. 2858-2869.

25. Peng Y., Wei W. A new trajectory planning method of redundant manipulator based on adaptive simulated annealing genetic algorithm (ASAGA) // Computational Intelligence and Security, 2006 International Conference on. - IEEE, 2006. - Vol. 1. - P. 262-265.

iНе можете найти то, что вам нужно? Попробуйте сервис подбора литературы.

26. Wang J., Li Y., Zhao X. Inverse kinematics and control of a 7-DOF redundant manipulator based on the closed-loop algorithm // International Journal of Advanced Robotic Systems. - 2010. - Vol. 7. - No. 4. - P. 1-9.

i Надоели баннеры? Вы всегда можете отключить рекламу.