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

Раздел I. Технологии управления и моделирования

УДК 681.5.013

В.Х. Пшихопов, М.Ю. Медведев

ПЛАНИРОВАНИЕ ДВИЖЕНИЯ ГРУППЫ ПОДВИЖНЫХ ОБЪЕКТОВ В ДВУМЕРНОЙ СРЕДЕ С ПРЕПЯТСТВИЯМИ*

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

Групповое управление; подвижный объект; децентрализованное управление; репеллер; неустойчивый режим; функция Ляпунова.

V.Kh. Pshikhopov, M.Yu. Medvedev

PATH PLANNING FOR A GROUP OF VEHICLES IN THE 2-D ENVIRONMENT WITH OBSTACLES

The problem of distributed control of heterogeneous group of vehicles in the environment with obstacles is considered. The control algorithms are based on kinematics equations of vehicles in a two dimensional environment. The proposed algorithms are based on the principle of allowing all neighboring robot objects as repeller. The proposed method of decentralized group control is based on the simple local control algorithms. A new approach for forming repellers is discussed. In contrast to the known methods for forming repeller, repulsive forces are generated at the output of dynamic system that allows the synthesis in the state space, and not in geometrical space. Re-

*

Работа поддержана грантом Российского научного фонда 14-19-01533, выполняемого Южным федеральным университетом.

sults of the proposed algorithms are velocities and heading angles of the controlled vehicles. By means of a method offunctions of Lyapunov the analysis of the received movement trajectories on stability is carried out. Existence and asymptotic stability of the steady state of the movement of vehicles group is shown. The modification of algorithms ofplanning which isn't demanding a preliminary references is offered. The developed algorithms are realized within the decentralized structure of a control system. Numerical modeling of the group consisting of five robots in the environment with motionless obstacles is carried out. On the basis of the carried-out analysis and results of modeling conclusions about applicability of the offered method in practice are drawn. The development of the offered trajectories planning method of the movement assuming use as the kinematics equations, and dynamics equations that will allow to consider speeds of rapprochement with obstacles is discussed. Also possibility of use of the offered method in three-dimensional environments and Wednesdays is discussed with mobile obstacles.

Group control; vehicle; decentralized control; repeller; unstable mode; function of Lyapunov.

Введение. Идея использования отталкивающих и притягивающих множеств в системах управления подвижными объектами впервые реализована в работах А.К. Платонова в 1970 году [1, 2], в которых представлен метод потенциалов (потенциальных полей) в задаче выбора пути для мобильного робота. За рубежом основные ссылки делаются на работы Брукса и Хатиба, которые вышли в свет в 1985 и 1896 году [3-5]. Вместе с тем работа фирмы Хитачи по управлению МР, в которой использованы идеи «силового поля», выпущена в 1984 году [6]. В настоящее время метод потенциальных полей получил широкое распространение. Обзор и анализ методов, использующих потенциальные поля, можно найти в работе [7]. В работах [8, 9] изложена идея преобразования точечных препятствий в репеллеры, используя теорему Ляпунова о неустойчивости. Такой подход позволяет реализовать движение в средах с препятствиями без картографирования. В [10] этот подход распространен на трехмерное пространство, а в [7] рассматривается задача движения в среде с препятствиями, которые могут образовывать различные конфигурации.

Идея представления препятствий репеллерами также может быть востребована при решении задач группового управления [11]. При этом могут рассматриваться однотипные или разнотипные группы [12, 13]. Группы зачастую состоят из интеллектуальных роботов, к которым принято относить либо системы, снабженные мощным вычислительным комплексом, либо системы, построенные на основе интеллектуальных методов, таких как аппарат нечеткой логики Л. Заде, искусственные нейронные сети и экспертные системы [14, 15].

Когда для решения конкретной задачи не требуются все роботы группы или, когда перед группой ставится несколько задач, формируются кластеры (подгруппы) [16, 17].

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

Более перспективной представляется децентрализованная стратегия управления, которая приводит к распределенным системам группового управления. В этой связи в данной статье рассматривается задача распределенного управления неоднородной группой подвижных объектов в двумерной среде с препятствиями с использованием идеологии репеллеров.

Алгоритм с предварительным заданием траектории. Рассмотрим подвижные объекты, уравнения кинематики которых имеют вид (рис. 1)

>>, ^СОБф,, у21=1) втф,., (1)

где у1г, у2г - координаты подвижного объекта; Vi - скорость подвижного объекта; ф; - угол курса подвижного объекта; i = 1, п.

Положение подвижного объекта характеризуется координатами уь, у21 во

внешней системе Оу1 у2. Скорость Vi и курсовой угол фi являются управлениями. Каждый подвижный объект измеряет координаты соседних объектов и имеет информацию о координатах уь, ук области Ь , в которой функционирует группа. Число п подвижных объектов в группе неизвестно. Ставится задача перемещения группы в направлении Оу2 оси с равномерным распределением объектов вдоль оси Оу1.

Jl L

1 1 1 1 1 1 L/^

У1

Рис. 1. Переменные состояния подвижных объектов и система координат

Пусть у2 = 0, а Ф у1 , Vi Ф i, i, ^ = 1, п. Пронумеруем подвижные объекты таким образом, чтобы индекс i = 1, п возрастал с увеличением координаты у1г-.

В этом случае локальный алгоритм управления для i -го подвижного объекта можно синтезировать следующим образом.

Представим для i -го подвижного объекта соседние объекты в виде репеллеров. При этом, соседний слева объект должен формировать силу, выталкивающую i -й подвижного объекта вправо, а соседний справа объект - вправо. Функции, на основе которых формируются репеллеры для i -го подвижного объекта, представлены на рис. 2.

К,

Рис. 2. Формирование репеллеров

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

Пусть функции, представленные на рис. 2, являются степенными функциями. Тогда указанная идея реализуется путем расширения системы (2) следующими уравнениями:

1 1

---> (2)

Уи-Уи-1 Уъ+1-Уъ

где Ую = УL ; У1п+1 = Ул .

Как следует из уравнения (2), переменные zi зависят от величин, обратных

расстояниям между роботами Я, 1, Л и Я,+1.

Пусть исходная требования к траектории движения , -го подвижного объекта представлены в виде вектора

ГУи~Уг О

где у{0, Vk - произвольные числа, не равные нулю.

Чтобы учесть влияние репеллеров сформируем цель системы управления , -го подвижного объекта в виде

у =\уь-уЛ1+г,) У У ъ-К

Таким образом, при появлении репеллера слева от , -го подвижного объекта переменная zi увеличивается, следовательно, составляющая у.0 (1 + ^ ) также увеличивается. При появлении репеллера справа, как следует из (2) переменная уменьшается, следовательно, выражение у.0 (1 + ) также уменьшается.

Производная по времени от первого элемента вектора (3) в силу уравнений (1), (2) описывается выражением

=

(3)

[1] = ^С08ф!~ую

(

1

1

Л

_ _ (4)

„ Ум ~ Ум-\ Ум+\ ~ Ум ) Потребуем, чтобы замкнутая система управления , -го подвижного объекта удовлетворяла следующим дифференциальным уравнениям

у|/,[2] = 0.

где Т0, - постоянные положительные числа.

Подставив в уравнение (5) выражения (3), (4), получим

(л \

(5)

У,-С

1

1

Ум - Ум-1 Ум+1 - Ум V

"Т0, (Уи - У,0 I1 + Ъ ))

(6)

4

2 2 и. + и.

ix iy

и

Uiy

arctan

и

V ix j

(7)

Проведем анализ поведения замкнутой системы управления, которая имеет следующий вид:

Уи

Уг,

Z:

(

Уи

1

1

Л

Уи - Уи-1 Уи+1 - Уи.

Vk

1

- T0i (У11 - Ую + zi ))

1

У11- У11-1 У11+1- У11

(8)

Из (8) следует, что замкнутая система управления декомпозирована на две независимые подсистемы, первая из которых описывается вторым уравнением, а вторая - первым и третьим.

Проведем анализ замкнутой системы управления относительно переменных уь и zi, используя уравнения

У\г

(

Ун

1

1

Л

V Ум Ум-\ Уи+\ Ум J 1

~Т0г (Уи - Уо (1 + Zi )) 1

(9)

Ум " Уи-1 Уи+1 " Ум Полагая в уравнениях (9) производные по времени равными нулю, найдем уравнения установившегося режима

1 1

0 = -

У11 - У11-1 У11+1 - У11

f

1

1

Л

(10)

0 = Ун

V yli - Ун -1 -Уц+1 Ун / Выразим из (10) переменные уь и

Уи-1 + У1;+1

- То (У11 - У01 (1 + Zi)).

Ум =

Z. =

2

Ум-1 + Ум+1 2 У01

(11)

-1.

Выразим рекуррентные соотношения (11) через параметры Уь, Ук . Запишем первое уравнение из (11) для i = 1:

Уь + У12

У11 =■

2

(12)

Аналогично для i = 2 имеем

УL + У12 + у

У У11 + У13 2 13 ^ У Уь + У12 . У13

= -~Г~ =-2-^ У12 = Т +Т +Т' ^ (13)

^ - У12 = + Уз ^ У12 = У + 2У'3 .

4 4 2 12 3 Для г = 3 получаем:

Уь + 2 У13 у

„ У12 + У14 2 14 ^ „ Уь ^ 2 У13, У14

У13 = -~Г~ =-2-^ У13 = Т +Т' ^ (14)

^ 2 У = ^ + 2к ^ у = уь + 3 у14

^ 3У13 6 + 2 ^У13 4 . Анализируя последовательность (12)-(14) приходим к выражению

У1, = . (15)

, + 1

Теперь запишем выражение (15) для г = п:

Ут + ПУЛ

Уп = ь , . (16)

п +1

Далее для , = п — 1 из (15) с учетом (16) получаем

У Ут +(п — 1) У1п У +(п —1) УтП+У

У1п—1=—п—=-п-- . (17)

_ (п +!) Уь + (п —!) Уь + (п —!) пУл _ 2Уь + (п —!) Ул

п (п +1) п + 1

Аналогично, для г = п — 2 из (15) с учетом (17) получаем

=3 Уь+(п)Ул. (18)

п + 1

Проводя анализ последовательности (16)-(18), с учетом второго уравнения (11), получаем следующие выражения для уравнений установившего режима замкнутой системы управления

(п — г +1) Уь + У

Уи =■

1 '

п +1 (19)

Я: =

(п +1) Ус '

Выражения (19) определяют значения переменных Уъ и , г = 1, п, в установившемся режиме движения. Из (19) видно, что установившиеся значения координат У1г зависят только от числа роботов п и границ области функционирования

Уь, Ул.

Проанализируем устойчивость замкнутой системы (1), (2), (6), (7) относительно установившегося режима (19).

Для этого запишем следующую квадратичную форму в качестве функции Ляпунова

1 Г.

v=2 а

Ун

+ ( (n -1 +1) Уь + У 1

и +1

(n + 1) У01

(20)

Как видно из выражения (20) в качестве функции Ляпунова выбрана сумма квадратичных функций отклонений от установившегося режима, описываемого соотношениями (19).

Производная по времени от функции (20) с учетом уравнений замкнутой системы (1), (2), (6), (7) равна

(п-1 + \)уь+1ун

V =

а

Уи

n +1

\(Уог^-То(У1г-Уог{1 + 2г))) +

+

Z --

{n-i+н)yь+iy^ +1

. {П+1)У0г , ^

Преобразуем выражение (21) к виду

(21)

L {"-i + l)yL+iyR

i=1

n +1

УоЛ

( (n - i + 1) Уь + Y ^ f (n -1 +1) Уь + 1Уя , /, ^ 0V

+1 У11 ""-гт;-II -Т01 У11 ""-гт;-+ "-гт;--У01 (1 + zi) I 1+ (22)

+1 Z. -

n+1

(n - i +1) Уь + У ( n +1) У01

n +1

n +1

+ 1 i,

- I VJI (и-'+1)л+г>/, г' = 2j Iл"——-\y«Zi

n+l

(n - i +1) Уь + ¿УЕ

(zi +1)--n+1-1 +

1"+1)Уо(

Выделим полные квадраты в выражении (22), используя его второе и третье

f (n - i +1) Уь + У ^ f ( n -T0| УИ--n+1- l+l УИ ~ n +1

J (n-j+l)yL+iyR +

слагаемые:

'=1

i=1

-T

-L A

^ (й-/ + 1)уь+1у^_У01 f z + ^ (n -1 +1) Уь + У

n + 1 2 V i (n + 1) У01

УН

У2f

Z +1 -

(n -1 + 1) Уь + У

(n + 1) У0i

Z +1 -

(n -i + 1) Уь + У (n + 1) У01

Z +

(23)

Уи

(n -1 + 1) Уь + У

\

n+1

Уо,г, >■

Снова выделим полные квадраты, используя второе и третье слагаемые выражения (23):

( <~ ■ 1\-. . ( („ V , Л,, , V,, ЛУ

F = v J-г V >4-11

¿-И 0 „+1 ? ' f„+lW

n +1

( n + 1) У01

(24)

( ( У01

2

V V

л_ ( n -1 +1) Уь + 1Уя

( n +1) У01

Л ■ ^ z.

У01

Уо,- I « + 1 1 1

1=1

4

i=1

Применяя еще раз операцию выделения полных квадратов, из выражения (24), с учетом уравнения (2), получаем

¥ =

-Я":

■Т

1 л

Ун

(п — ' +1) Уь + -Ул

п +1

г, +1 —

1

(п — ' +1) Уь + гУл ЛЛ

(п +1) У0,

(25)

У* ( г +1 — |— У1,— Ун—1 Уи+1 — Ун

2 [ ' (п +1) У0 г ) Ут

( 1

1

У1'— Ун—1 У1'+1— Ун — Уш_ ( У — (пЛ-ЩУх+Ул. У0' 2 Г1' п +1

У' („ (п—' +1) Уь + гул '

Ун

п +1

Таким образом, из (25) следует, что положение равновесия (19) является асимптотически устойчивым в замкнутой системе (1), (2), (6), (7). При этом полагается, что

Ун * Ун^ у' =1, п.

Алгоритм с обеспечением строя. Алгоритм управления (6), (7) требует предварительного задания траектории движения. Кроме того, подвижные объекты не с алгоритмом управления (6), (7) движутся с постоянными скоростями, поэтому не придерживаются одной линии. В условиях препятствий длины траекторий различных подвижных объектов могут сильно отличаться, поэтому требуется модифицировать алгоритмы управления. Для этого введем в рассмотрение следующий вектор ошибок управления

Г Ун—1 + Уи+1 —

V, =

У1г

' = 1, п

(26)

(27)

Уг\-ук,Уц-Уи-\,* = 2,п Потребуем, чтобы ошибки (26) удовлетворяли следующей системе дифференциальных уравнений

м/,[1]+/;,м/,[1] = о./ = ь;.

^ [2] = 0, V, [2] + Т2л\г1 [2] = 0, /' = где Ти, Т2, - постоянные параметры.

Продифференцировав вектор (26) по времени и подставив его в (27), получим систему алгебраических уравнений, разрешив которую относительно скоростей и углов ориентации подвижных объектов, получим:

1 1

Ям + Уи+1 - -—.. + ..-.. ,

и... = ■

и1у = К ,

Уи-Уи-1 Угм-Уг

■ —Т..

Ун'

Ун—1 + Ун+1 — г'

г = 1, п,

(28)

= Уъ-1-Тъ(У21-Уи-1), 1=2, п.

Тогда уравнения замкнутой системы управления имеют вид:

п

'=1

и

1 1

Уи-1+Уи+1--+--/ , л

__Уи-Уи-1 Ум-Уи т л,-1 +Л,+1 | .7-

Уи 2 2 J, г

у*=Ук, _ ^

У2, = Уъ-1 - т2< (у2, - У21-г )• ' = 2, П,

1 1

г. =---

Уи-Уи-1 Угм-Уи

Замкнутая система (29), как и ранее, декомпозируется на две независимые подсистемы. Первая подсистема состоит из второго и третьего уравнения системы (29), а вторая - из первого и четвертого уравнений.

Рассмотрим первую подсистему, состоящую из второго и третьего уравнения системы (29). Запишем ее в следующем виде:

Уг1=Ук>

У22 = У21 - Т2 {у22 -Угх) = Ук- Т2 (>22 " У21) ,

>23 = ¿22 " Т2 (>23 " >22 ) = Ук ~ Т2 (>22 " >21 ) " Т2 (>23 " >22 ) = Ук ~ Т2 (>23 " >21 ), (30)

Уъ=К~Т2(Уъ-У21),

Проинтегрируем первое уравнение (30)

y2,+T2y2i=Vk+T2(yll+Vkt). (32)

У21 = У 21 + Укг. (31)

Тогда, с учетом (31), последнее уравнение из (30) принимает вид

и

Решая уравнение (32), получаем

У21 (^) = (у20г-у2°1) ^ + У 21 + Укг. (33)

Из выгражения (33) следует, что

Й У2* (<) = Й ((У0 У01 ) ^ + У201 + ^) = У201 + Ч •

Таким образом, с течением времени положения всех подвижных объектов вдоль оси Оу2 стремятся к положению самого левого объекта, т.е. группа поддерживает строй.

Рассмотрим теперь вторую подсистему, состоящую из первого и четвертого уравнений системы (29). Установившийся режим данной подсистемы описывается уравнениями

1 1

---1--

г

q _ Уи Уи~ 1 Уи+1 Уи J - 2 н

о = ---

У yii-1 + yii+1

2 J' (34)

Уи-Уи-1 У и+1- Ун

Решая систему (34), получаем вьгражения

или

Ун = У1'-1 + У"+1 , = 0, (35)

(п - - +1) Ут + -У„

(-^^^ , - 0. (36)

п +1

Для исследования устойчивости замкнутой систем управления рассмотрим следующую функцию

Производная функции (37) по времени в силу уравнений замкнутой системы (29) равна

I 2 2 'Л 2 2 '

(38)

=-т +и г, "

С учетом того, что у0 = уЬ, уп+1 = ук первое уравнение из (35) можно переписать в следующем виде

Уп = ™■ У- = + Н - = п-1,1. (39)

п + 1 - + 1 - +1

Поместим начало координат в точку уь , тогда из выражения (39) приходим

к соотношениям вида

п п-1 1

Уп =—7Ук, Уп-1 =—7Ук, - Ун =—7Ук. (40)

п +1 п +1 п +1

Из (40) находим расстояние между соседними роботами:

1 Ь

Ун- - Уи-н = —7 Ук = —7. (41)

п +1 п + 1

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

/■ Ь

Гр <-7 . (42)

п + п + 1

р

где гр - радиус препятствия.

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

У11-1 + У11+1 , ЬТ11 ,

У11

2 2 к 1

(43)

е1 =

e =

у1i-1 + Уи+1 , щ, yii 2 + 2k i

i = 2, n .

(44)

У2* - У2/-1

Потребуем, чтобы ошибки (43), (44) удовлетворяли следующим дифференциальным уравнениям

¿1[1] + (Т21-^)е1[1] = 0, (45)

T2i~Zi О

0

Т

= 0, i = 2,n .

(46)

Вычислим производные от ошибок (43), (44) и, подставив их вместе с (43), (130) в (45), (46), получим алгебраические уравнения, решив которые найдем выражения для изменения скоростей и углов движения роботов:

1y

2 2к 1 У 21 2 2£ J

2 2к ■ {ъ -Yh 2 2к

2 к ' у " ' \ " 2

Уъ-1-Тъ(Уъ-Уъ-г) Тогда уравнения замкнутой системы принимают вид

(47)

(48)

Уп Уг 1

Уи.+У12 LTn ■

2к

Zl~(T2l -Z) Jll

У1Ь + У12 , ьТ11

2к

К

ь (2 У11- Уи.- У12)

(49)

Ум

у*

z..

Уу-г+Ушг , Л,- __2\f . LTy Л

2 2к ' 1' ' V" 2 2к ■)

т(2Уу -Ум-1 -Л+i)

i = 2, n . (50)

Проведем анализ первого и третьего уравнений (49), (50) на устойчивость, полагая, что отталкивающие силы формируются уравнением

=к{2У1г-У1г-1-У1г+1)1(51) Полагая в (49), (50) сигналы У1г 1, Уь+1 равными нулю получаем следующую систему для анализа устойчивости

Ум z,.

2 к

Уч~(т- z;)(y,+f f I

2k

"Ун

(52)

Выберем в качестве функции Ляпунова квадратичную функцию следующего

вида:

Vi 2 yn + 2 ( У + Z ) * Производная по времени от выражения (53) в силу системы (52) равна

Vi=-2{j\i+T2i-zf)y;

2к + (T + Т L 1 (T2i Zi) 2k

Введем следующие обозначения:

4k'

TL

R = t2i — z2, a =

LTl , = 2k

2k ' L

(53)

(54)

(55)

(56)

и перепишем выражение (54) с учетом (55)

V. =-2(1!. +RЛ v.2 -[(1 + fli.W +Т -26.1 v.z. -i?az2.

г V" г J S и L4 I' I и г JS 1г г г г г

Предположим, что вектор [y z]T подвергнут некоторому неособенному преобразованию [18], т.е.

"У LP" С12Ь1 (57)

_ Z J _С21 С22 __Т2 _

где т т2 - компоненты нового вектора* При этом матрица преобразования в (57)

такова, что в новых переменных функция — V. равна сумме квадратов новых переменных* Тогда с учетом преобразования (57) и принятого допущения выражение (56) запишется так

— _(! + a ) R + T1i — 2bi J (c11^1 + c12^2 )(c21^1 + c22^2 )— Riai (c21^1 + C22^2 )2 = ^ — 4

Примем c12 = 0, и из (58) получим

V,; = -2(TU +R1)c^21 -[(1 + а,)Д, +Т11-2Ь1](спц1)(с21ц1 +с22ц2)~

(С21Л1 + С22П2)2 = _—2 ft + R)c2 — ((1+a.)R + Tu — 2b.)c^ — Rac\x ] — (59)

—Ri«iC222^2 —[((1+ a,.)R,. + Tb. — 2b.)cnc22 + 2RAC21C22 ]Т2 = —Т2 — Т2* Приравнивая в левой и правой частях (59) коэффициенты при одинаковых степенях т1з Т2, получаем систему уравнений, решая которую находим

(58)

1

Ra

—2Ra

c2 =-

(1 + a,) R + Tu — 2b 1

(60) (61) (62)

2 (T + Rt)

- Ra

-°Kiai

.(н+оИ+Т^,

Таким образом, преобразование (57), (60)-(62) приводит выражение (56) к канонической отрицательно определенной форме, поэтому условия неособенности преобразования (57) являются условиями асимптотической устойчивости замкнутой системы (49), (50).

2

Из выражения (60), с учетом обозначений (55), следует, что

T2l > zf.

(63)

(64)

Аналогично из (61) и (62) получаем

(1 + а )Я, + Ти - 2Ь, > 0

8ЯЛ(71,. + Я) > [(1 + aiЩ + Ти -2Й,]2. (65)

Не снижая общности, можно предположить, что выполняется условие Ь = k. В этом случае неравенство (65) принимает вид

47" + |I) 12 +(4712 -2[1 +1](Т, -4))Я, -(7 -4)2 >0. (66)

Таким образом, поиск условий устойчивости сводится к решению квадратичного неравенства (66) при ограничениях (63), (64).

На рис. 3 приведено графическое решение указанных неравенств.

4г

3.5 3 2.5 2 1.5 1

0.5 0

-R (97)

1 1 1 ---R (96)

1 1 1

1 1 1 I 1

I \ \ \ \ \

\ \ \ \ \ \

\ \ \

Оч

V T11

0 2 4 6 8 10

Рис. 3. Графическое решение неравенств (64), (66)

■4.

Из рис. 3 находим:

0 < Т < 4,

Результаты численного моделирования. Пусть модель робота описывается уравнениями (1), а закон управления выражением (28).

< T2l < zf-

(67)

200 180 160 140 120 100 80 60 40 20 0

y2i -У21 — y22 """"'y23 — У24 ■ У25

j i

j

j

>

!

il i

1__ - J

1 1 »

_ '.V

0

50 100 150 200

Рис. 4. Результаты моделирования

Параметры системы управления следующие: ширина рабочей зоны ь = 200 м, уь = 0 м, yR = 200 м; - число роботов n = 5; уставки по скорости V0i = 1 м/с; постоянные времени Ти = 1 с-1; начальные условия y2i = 0, y11 = 10,y12 = 20, y13 = 30, y14 = 40, y15 = 50м; координаты центра и радиус препятствия (80, 80) и 20 м.

В целях обеспечения безопасности маневры роботов начинаются за 10 метров до достижения препятствия. Первым маневр начинает робот, наиболее близкий к обнаруженному препятствию. На рис. 4 приведены результаты моделирования. Из рис. 4 следует, что система управления осуществляет равномерное размещение роботов вдоль оси йу}, и обеспечивает обход препяствий.

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

Предлагаемые алгоритмы могут использоваться в системах планирования движения различных объектов [19-24]. Метод планирования обеспечивает устойчивость движения на уровне уравнений кинематики объекта.

БИБЛИОГРАФИЧЕСКИЙ СПИСОК

1. Платонов А.К., Карпов И.И., Кирильченко А.А. Метод потенциалов в задаче прокладки трассы. Препринт Института прикладной математики АН СССР. - М., 1974.- 27 с.

2. Платонов А.К., Кирильченко А.А., Колганов М.А. Метод потенциалов в задаче выбора пути: история и перспективы. - М.: ИПМ им. М.В. Келдыша РАН, 2001.

3. Khatib O. Real-time obstacle avoidance for manipulators and mobile robots // IEEE Int. Conf. Robotics and Automation, 1985. - Р. 500-505.

4. Khatib O. Real-Time Obstacles Avoidance for Manipulators and Mobile Robots // Int. Journal of Robotics Research. - 1986. - Vol. 5, No. 1. - Р. 90-98.

5. Brooks R.A. Self calibration of motion and stereo vision for mobile robots // IEEE Int. Robotics and Automation, 1986.

6. Ichikawa Y., Fujie M., Ozaki N. On mobility and autonomous properties of mobile robots // Robot. - 1984. - № 44. - Р. 31-36.

7. Белоглазов Д.А., Гузик В.Ф., Косенко Е.Ю., Крухмалев В.А., Медведев М.Ю., Переверзев В.А., Пшихопов ВХ., Пьявченко А.О., Сапрыкин Р.В., Соловьев В.В., Финаев В.И., Черну-хин Ю.В., Шиповалов И.О. Интеллектуальное планирование траекторий подвижных объектов в средах с препятствиями / Под ред. В.Х. Пшихопова. - М.: Физматлит, 2014. - 300 с. - ISBN 978-5-9221-1595-7.

8. Пшихопов ВХ. Аттракторы и репеллеры в конструировании систем управления подвижными объектами // Известия ТРТУ. - 2006. - № 3 (58). - С. 117-123.

9. Пшихопов ВХ. Организация репеллеров при движении мобильных роботов в среде с препятствиями // Мехатроника, автоматизация, управление. - 2008. - № 2. - С. 34-41.

10. Пшихопов В.Х., Медведев М.Ю., Крухмалев В.А. Позиционно-траекторное управление подвижными объектами в трехмерной среде с точечными препятствиями // Известия ЮФУ. Технические науки. - 2015. - № 1 (162). - С. 238-250.

11. Юревич Е.И. и др. Интеллектуальные роботы. - М.: Машиностроение, 2007. - 360 с.

12. Юревич Е.И. О проблеме группового управления роботами // Мехатроника, автоматизация, управление. - 2004. - № 2. - С. 9-13.

13. Каляев И.А., Гайдук А.Р., Капустян С.Г. Модели и алгоритмы коллективного управления в группах роботов. - М.: Физматлит, 2009. - 278 с.

14. Васильев С.Н. От классических задач регулирования к интеллектуальному управлению. I, II // Известия РАН. Теория и системы управления. - 2001. - № 1. - С. 5-21; - № 2. - С. 5-22.

15. Пшихопов В.Х., Медведев М.Ю. Управление подвижными объектами в определенных и неопределенных средах. - М.: Наука, 2011. - 350 с. ISBN 978-5-02-037509-3.

16. Каляев И.А., Гайдук А.Р., Капустян С.Г. Распределенные системы планирования действий коллективов роботов. - М.: Янус-К, 2002. - 292 с.

17. Ивченко В.Д., Корнеев А.А. Анализ методов распределения заданий в задаче управления коллективом роботов // Мехатроника, автоматизация, управление. - 2009. - № 7. - С. 36-42.

18. Шнейдер В.Е. и др. Краткий курс высшей математики: Учеб. пособие для втузов. - М.: Высш. школа, 1972. - 640 с.

19. Pshikhopov V.Kh., Krukhmalev VA., MedvedevM.Yu., FedorenkoR.V., KopylovS.A., BudkoA.Yu., Chufistov V.M. Adaptive control system design for robotic aircrafts // Proceedings - 2013 IEEE Latin American Robotics Symposium, LARS 2013. - P. 67-70. Doi: 10.1109/LARS.2013.59.

20. Pshikhopov V.Kh., Medvedev M.Yu., Gaiduk A.R., Gurenko B.V. Control system design for autonomous underwater vehicle // Proceedings - 2013 IEEE Latin American Robotics Symposium, LARS 2013. - P. 77-82. Doi: 10.1109/LARS.2013.61.

21. Пшихопов В.Х., Медведев М.Ю., Гайдук А.Р., Нейдорф Р.А., Беляев В.Е., Федоренко Р.В., Костюков В.А., Крухмалев В.А. Система позиционно-траекторного управления роботизированной воздухоплавательной платформой: алгоритмы управления // Мехатроника, автоматизация и управление. - 2013. - № 7. - С. 13-20.

22. Пшихопов В.Х., Медведев М.Ю., Гайдук А.Р., Шевченко В.Е. Энергосберегающее управление электропоездом ы условиях неоднородности профиля пути // Известия ЮФУ. Технические науки. - 2013. - № 3 (140). - С. 162-168.

23. Пшихопов В.Х. Дирижабли: перспективы использования в робототехнике // Мехатроника, автоматизация, управление. - 2004. - № 5. - С. 15-20.

REFERENCES

1. Platonov A.K., Karpov I.I., Kiril'chenko A.A. Metod potentsialov v zadache prokladki trassy. Preprint Instituta prikladnoy matematiki AN SSSR [Potentials method in the problem of routing. Preprint of Institute of applied mathematics, USSR Academy of Sciences]. Moscow, 1974, 27 p.

2. Platonov A.K., Kiril'chenko A.A., Kolganov M.A. Metod potentsialov v zadache vybora puti: istoriya i perspektivy [Potentials method in the problem of path selection: history and prospects]. Moscow: IPM im. M.V. Keldysha RAN, 2001.

3. Khatib O. Real-time obstacle avoidance for manipulators and mobile robots, IEEE Int. Conf. Robotics and Automation, 1985, pp. 500-505.

4. Khatib O. Real-Time Obstacles Avoidance for Manipulators and Mobile Robots, Int. Journal of Robotics Research, 1986, Vol. 5, No. 1, pp. 90-98.

5. Brooks R.A. Self calibration of motion and stereo vision for mobile robots // IEEE Int. Robotics and Automation, 1986.

6. Ichikawa Y., Fujie M., Ozaki N. On mobility and autonomous properties of mobile robots, Robot, 1984, No. 44, pp. 31-36.

7. Beloglazov D.A., Guzik V.F., Kosenko E.Yu., Krukhmalev V.A., Medvedev M.Yu., Pereverzev V.A., Pshikhopov V.Kh., P'yavchenko A.O., Saprykin R.V., Solov'ev V.V., Finaev V.I., Chernukhin Yu.V., Shipovalov I.O. Intellektual'noe planirovanie traektoriy podvizhnykh ob"ektov v sredakh s prepyatstviyami [Intelligent planning of the trajectories of moving objects in environments with obstacles], Ed. by V.Kh. Pshikhopova. Moscow: Fizmatlit, 2014, 300 p. ISBN 978-5-9221-1595-7.

8. Pshikhopov V.Kh. Attraktory i repellery v konstruirovanii sistem upravleniya podvizhnymi ob"ektami [Attractors and repeller in the design of control systems rolling stock-sizes of object], Izvestiya TRTU [Izvestiya TSURe], 2006, No. 3 (58), pp. 117-123.

9. Pshikhopov V.Kh. Organizatsiya repellerov pri dvizhenii mobil'nykh robotov v srede s prepyatstviyami [The organization of repellere during the motion of mobile robots in environment with obstacles], Mekhatronika, avtomatizatsiya, upravlenie [mechatronics, automation, control], 2008, No. 2, pp. 34-41.

10. Pshikhopov V.Kh., Medvedev M.Yu., Krukhmalev V.A. Pozitsionno-traektornoe upravlenie podvizhnymi ob"ektami v trekhmernoy srede s tochechnymi prepyatstviyami [Position-trajectory control of vehicle in 3d with point obstacles], Izvestiya YuFU. Tekhnicheskie nauki [Izvestiya SFedU. Engineering Sciences], 2015, No. 1 (162), pp. 238-250.

11. Yurevich E.I. i dr. Intellektual'nye roboty [Intelligent robots]. Moscow: Mashinostroenie, 2007, 360 p.

12. Yurevich E.I. O probleme gruppovogo upravleniya robotami [The problem of group control of robots], Mekhatronika, avtomatizatsiya, upravlenie [Mechatronics, Automation, Control], 2004, No. 2, pp. 9-13.

13. Kalyaev I.A., Gayduk A.R., Kapustyan S.G. Modeli i algoritmy kollektivnogo upravleniya v gruppakh robotov [Models and algorithms of collective control in groups of robots]. Moscow: Fizmatlit, 2009, 278 p.

14. Vasil'ev S.N. Ot klassicheskikh zadach regulirovaniya k intellektual'nomu upravleniyu. I, II [From classical regulation to intellectual property management. I, II], Izvestiya RAN. Teoriya i sistemy upravleniya [Journal of Computer and Systems Sciences International], 2001, No. 1, pp. 5-21; No. 2, pp. 5-22.

15. Pshikhopov V.Kh., Medvedev M.Yu. Upravlenie podvizhnymi ob"ektami v opredelennykh i neopredelennykh sredakh [Management of mobile objects in certain and uncertain environments]. Moscow: Nauka, 2011, 350 p. ISBN 978-5-02-037509-3.

16. Kalyaev I.A., Gayduk A.R., Kapustyan S.G. Raspredelennye sistemy planirovaniya deystviy kollektivov robotov [Distributed systems planning teams of robots]. Moscow: Yanus-K, 2002, 292 p.

17. Ivchenko V.D., Korneev A.A. Analiz metodov raspredeleniya zadaniy v zadache upravleniya kollektivom robotov [The analysis methods of task distribution in the task of managing a group of robots], Mekhatronika, avtomatizatsiya, upravlenie [Mechatronics, Automation, Control], 2009, No. 7, pp. 36-42.

18. Shneyder V.E. i dr. Kratkiy kurs vysshey matematiki: Ucheb. posobie dlya vtuzov [A brief course of higher mathematics: textbook for technical colleges]. Moscow: Vyssh. shkola, 1972, 640 p.

19. Pshikhopov V.Kh., Krukhmalev V.A., Medvedev M.Yu., Fedorenko R. V., Kopylov S.A., Budko A.Yu., Chufistov V.M. Adaptive control system design for robotic aircrafts, Proceedings - 2013 IEEE Latin American Robotics Symposium, LARS 2013, pp. 67-70. Doi: 10.1109/LARS.2013.59.

20. Pshikhopov V.Kh., Medvedev M.Yu., Gaiduk A.R., Gurenko B.V. Control system design for autonomous underwater vehicle, Proceedings - 2013 IEEE Latin American Robotics Symposium, LARS 2013, pp. 77-82. Doi: 10.1109/LARS.2013.61.

21. Pshikhopov V.Kh., Medvedev M.Yu., Gayduk A.R., Neydorf R.A., Belyaev V.E., Fedorenko R.V., Kostyukov V.A., Krukhmalev V.A. Sistema pozitsionno-traektornogo upravleniya robotizirovannoy vozdukhoplavatel'noy platformoy: algoritmy upravleniya [The system of position-trajectory control of a robotic aircraft platform: control algorithms], Mekhatronika, avtomatizatsiya, upravlenie [Mechatronics, Automation, Control], 2013, No. 7, pp. 13-20.

22. Pshikhopov V.Kh., Medvedev M.Yu., Gayduk A.R., Shevchenko V.E. Energosberegayushchee uprav-lenie elektropoezdom y usloviyakh neodnorodnosti profilya puti [Power saving control of an electric train in the conditions of heterogeneity of a track profile], Izvestiya YuFU. Tekhnicheskie nauki [Izvestiya SFedU. Engineering Sciences], 2013, No. 3 (140), pp. 162-168.

23. Pshikhopov V.Kh. Dirizhabli: perspektivy ispol'zovaniya v robototekhnike [Airships: prospects of use in robotics], Mekhatronika, avtomatizatsiya, upravlenie [Mechatronics, Automation, Control], 2004, No. 5, pp. 15-20.

Статью рекомендовал к опубликованию д.т.н. С.Г. Капустян.

Пшихопов Вячеслав Хасанович - Южный федеральный университет; e-mail: [email protected]; 347928, г. Таганрог, пер. Некрасовский, 44; тел./факс: 88634371694; д.т.н.; профессор; проректор-директор Инженерно-Технологической академии Южного федерального университета в г. Таганроге.

Медведев Михаил Юрьевич - e-mail: [email protected]; кафедра электротехники и ме-хатроники; зав. кафедрой; д.т.н.; профессор.

Pshikhopov Vyacheslav Khasanovich - Southern Federal University; e-mail: [email protected]; 44, Nekrasovsky, Taganrog, 347928, Russia; phone/fax: +78634371694; dr. of eng. sc.; professor; Vice-rector of Southern Federal University.

Medvedev Mikhaik Yur'evich - e-mail: [email protected]; the department of electrical engineering and mechatronics; head of department; dr. of eng. sc.; professor.

УДК 004.82+007.52

О.О. Варламов, В.М. Лазарев, В.Г. Осипов СТАТЬЯ ОТОЗВАНА ПО РЕШЕНИЮ РЕДАКЦИОННОГО СОВЕТА