Научная статья на тему 'Синергетическое управление группой мобильных роботов'

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

CC BY
840
216
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ГРУППОВОЕ УПРАВЛЕНИЕ / КВАДРОКОПТЕР / МАТЕМАТИЧЕСКАЯ МОДЕЛЬ / СИНЕРГЕТИЧЕСКАЯ ТЕОРИЯ УПРАВЛЕНИЯ / GROUP CONTROL / QUADROCOPTER / MATHEMATICAL MODEL / SYNERGETIC CONTROL THEORY

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

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

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

Похожие темы научных работ по электротехнике, электронной технике, информационным технологиям , автор научной работы — Скляров Сергей Анатольевич

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

SYNERGISTIC CONTROL OF A GROUP OF MOBILE ROBOTS

This paper explores the problem of synthesis of synergetic control of a group of mobile robots. To solve this problem in article presents new approach to control of a group of mobile robot based on principals and methods of synergetic control theory. The task of the synergistic synthesis of control of a group of quadrocopters is considered with the analysis of mathematic model and specifics of the specified aim. In the theory of synergetic control the set of criteria for the control system is usually expressed in the form of an appropriate system of invariants. Invariants play the role of control objectives, they enforced a given technological problem, and the synergetic synthesis procedure reduces to process of finding control laws, which these given invariants are satisfied. At this paper as imposed condition on synthesized control law, serve an asymptotically stable movement of a group of mobile robots with specified type of formation.

Текст научной работы на тему «Синергетическое управление группой мобильных роботов»

10. Mesbahi M. and Hadaegh F.Y. Formation flying control of multiple spacecraft via graphs, matrix inequalities, and switching, AIAA J. Guidance, Control, Dynam, Mar.-Apr. 2000, Vol. 24, No. 2, pp. 369-377.

11. Wang P.K.C. and Hadaegh, F.Y. Coordination and control of multiple microspacecraft moving in formation, J. Astronaut. Sci, 1996, No. 44, (3), pp. 315-355.

12. Desai J., Ostrowski J., and Kumar V. Control of Formations for Multiple Robots, Proceedings of the IEEE International Conference on Robotics and Automation, Leuven, Belgium, 1998.

13. Lewis M.A. and Tan K.-H. High precision formation control of mobile robots using virtual structures, Auton. Robot, 1997, No. 4, pp. 387-403.

14. Erdogan M.E., Innocenti M., Pollini L. Obstacle Avoidance for a Game Theoretically Controlled Formation of Unmanned Vehicles, 18th IFAC. 2011.

15. Flying Machine Arena. Available at: www.flyingmachinearena.org (accessed 30 July 2014).

Статью рекомендовал к опубликованию д.ф.-м.н., профессор А.А. Илюхин.

Иванов Донат Яковлевич - НИИ Многопроцессорных вычислительных систем им. академика А.В. Каляева Южного федерального университета; e-mail: [email protected];

г. Таганрог, ГСП-284, ул. Чехова 2; тел.: +79185191869; м.н.с.

Ivanov Donat Yakovlevich - Scientific research institute of multiprocessor computer systems of

Southern Federal University; e-mail: [email protected]; 2, Chehova street, Taganrog,

GSP-284, Russia; phone: +79185191869; junior researcher.

УДК 681.51

С.А. Скляров

СИНЕРГЕТИЧЕСКОЕ УПРАВЛЕНИЕ ГРУППОЙ МОБИЛЬНЫХ

РОБОТОВ*

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

Групповое управление; квадрокоптер; математическая модель; синергетическая теория управления.

S.A. Sklyarov

SYNERGISTIC CONTROL OF A GROUP OF MOBILE ROBOTS

This paper explores the problem of synthesis of synergetic control of a group of mobile robots. To solve this problem in article presents new approach to control of a group of mobile robot based on principals and methods of synergetic control theory. The task of the synergistic synthesis of control of a group of quadrocopters is considered with the analysis of mathematic model and

*

Работа выполнена при финансовой поддержке РФФИ (грант № 13-08-00794A).

specifics of the specified aim. In the theory of synergetic control the set of criteria for the control system is usually expressed in the form of an appropriate system of invariants. Invariants play the role of control objectives, they enforced a given technological problem, and the synergetic synthesis procedure reduces to process of finding control laws, which these given invariants are satisfied. At this paper as imposed condition on synthesized control law, serve an asymptotically stable movement of a group of mobile robots with specified type offormation.

Group control; quadrocopter; mathematical model; synergetic control theory.

Введение. В настоящее время мощностей одного, отдельно взятого мобильного робота, не достаточно для решения таких технологических задач, как зондирование и исследование больших по площади поверхностей, сборка нетривиальных конструкций в экстремальных условиях космоса или под водой, выполнение тушения пожара или других масштабных действий [1]. Очевидно, что для решения подобных задач необходимо задействовать большое количество однотипных [1, 2] или разнотипных [3, 4] (в зависимости от решаемой задачи) автономных мобильных роботов. При этом задача управления такой группой роботов по достижению глобальной цели называется "групповое управление".

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

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

♦ определение состава группы, необходимого и достаточного для эффективного решения технологической задачи;

♦ распределение функций между роботами группы для достижения конечной цели за минимальное время и при минимальных затратах;

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

Для решения данных задач применяется централизованный подход к групповому управлению [6, 7]. При таком подходе формирование тактических стратегий для группы роботов возлагается на одного, ведущего робота, в то время как поведение остальных, ведомых, мобильных роботов группы (МРГ) определяется поведени-

ем ведущего. При централизованном подходе к групповому управлению мощным комплексом технических средств достаточно оснастить только ведущего мобильного робота [6], ведомые комплектуются минимальным набором оборудования, которое необходимо для выполнения задач, сформированных ведущим МРГ.

Цель управления. В качестве мобильных роботов группы в данной работе рассматриваются четырехмоторные летательные аппараты с вертикальным вектором тяги или квадрокоптеры. В настоящее время данный вид беспилотных летательных аппаратов применяются во многих сферах жизнедеятельности человека, в частности: в геодезии при построении карт высот местности [7], в полиции для фиксации нарушений и отслеживания преступников. Так как квадрокоптеры являются достаточно неустойчивыми объектами управления [8], то основной проблемой, возникающей при создании групповой стратегии управления, является осуществление устойчивого передвижения группы роботов в заданную точку пространства. Данная задача является многомерной, так как включается в себя множество поведений мобильных роботов, а если учесть, что квадрокоптер является нелинейным объектом управления [8], то общая модель поведения группы роботов дополняется нелинейными составляющими динамики как самих МРГ, так и функциональных отношений между ними.

В настоящее время в связи с необходимостью решения многомерных нелинейных задач формируется новая интегральная наука - синергетика. Данная наука изучает процессы самоорганизации и охватывает современные знания о косной и живой природе, экономические и в особенности технические науки. Базируясь на новых знаниях о природе происходящих процессов в сложных нелинейных системах, была сформирована новая прикладная синергетическая теория управления [9-11], основанная на принципе направленной самоорганизации. В рамках данной теории был разработан метод аналитического конструирования агрегированных регуляторов (АКАР) [9], позволяющий синтезировать законы управления для расширенных математических моделей объектов управления без линеаризации или других упрощений. В данном методе цели задачи управления выступают в виде инвариантных многообразий, а учет нелинейной динамики системы достигается путем применения асимптотического перехода от одного инвариантного многообразия к другому с последовательным понижением размерности многообразий. При таком подходе к задаче управления нет необходимости строгого соответствия параметров реального объекта параметрам заложенной в регулятор модели, нужно лишь обеспечить попадание замкнутой системы в область притяжения инвариантных многообразий, на которых, в свою очередь, поддерживается желаемое конечное состояние объекта управления. Поэтому для реализации группового управления мобильными роботами в данной работе предлагается использовать принципы и методы синергетической теории управления [9-14].

Математическая модель группы квадрокоптеров. Для определения математической модели группы квадрокоптеров необходимо определить динамику поведения одного МРГ. Квадрокоптер (рис. 1) является разновидностью летательного аппарата с вертикальным вектором тяги [15, 16], приводящимся в движение четырьмя роторами со скоростью вращения Оь 02, 03, 04, закреплённых в центре масс робота M на двух пересекающихся крест-накрест металлических балках, вращающихся диагонально в противоположных направлениях (рис. 2).

Рис. 1. Внешний вид квадрокоптера Рис. 2. Схема перемещения

квадрокоптера в пространстве

Для синтеза стратегий управления верхнего уровня необходимо построить математическую модель кавдрокоптера, рассматриваемого как твердое тело. Движение квадрокоптера можно считать суммой поступательного движения центра масс и сферического движения тела относительно центра масс [15, 16]. Предположим, что квад-рокоптеры, входящие в состав группы, имеют одинаковую конструкции и массоинер-ционные характеристики, при этом центр масс каждого робота находится на пересечении балок, на которых закреплены винты. Режим движения группы квадрокоптеров будет описываться следующей системой дифференциальных уравнений:

xk = Vk; yk = Vk; zk = Vk;

x > s y > z >

Vk = (sinу" sin(pk + cos yk sinek cos (pkUk /m;

Vk = (- cos ш" sinpk + sinу" sinek cos pk U /m;

Uk

V" = —cose" cospk -g; zm

ek = а"; pk = а" ; = а" ; t (i -1 )юк,ак - Jф"Qk + U"

^ k _ \ yy zz / e у TP e 2

(1)

p

I

xx

t (I -1 )akak + Jak Qk + U"

♦ k \ zz xx / p ш IP p 3

ав =-

e I

yy

(i -1 )aka" + U"

\ xx yy / рв 4

где xk, У, ^ - координаты центра масс к-го квадрокопера группы; VJC, Vyk, Vzk, -проекции вектора линейной скорости к-го робота; & - угол тангажа, угол

крена и угол рыскания к-го робота соответственно, ю/ - угловая скорость тангажа к-го робота; ю^ - угловая скорость крена к-го робота; ю/ - угловая скорость рыскания к-го робота; Ulk, U2k, Uзk, и/ - каналы управления к-ым МРГ; О k - общая скорость четырех винтов к-го робота; m - масса квадрокоптера; Тхх, 1УУ, - моменты инерции вокруг оси X, У и 2 соответственно; Зтр - общий вращательный момент инерции вокруг оси винта. Уравнения связи каналов управления иД и/, и/, и/ со скоростями вращения винтов ОД ОД ОД, О/ имеют вид:

а" =

п: =,— и--Щ — ик

АЬ 1 2Ы Аа 4

п: = ,— и--и к +—и:

АЬ 1 26/ 2 Аа 4

п: = , — и: +—и 3: — и к

АЬ 1 26/ Аа 4

п: = , — ик +-и2: + — ик;

АЬ 1 26/ Аа 4

п:=-п1:+п:-п:+п:,

где l - расстояние между центром квадрокоптера и центром пропеллера, Ь и d - аэродинамические составляющие тяги и коэффициента сопротивления соответственно.

В качестве основной задачи управления выберем асимптотически устойчивое передвижение группы квадрокоптеров в заданную позицию с удержанием заданного угла рыскания. Синтезированные стратегии управления являются задающими воздействиями для подсистем управления микродвигателями квадрокоптеров [15, 16]. Однако в рамках данной статьи синтез локальных законов управления подсистемами исполнительных механизмов квадрокоптера не рассматривается.

Управление группой квадрокоптеров является не тривиальной задачей, требующей, при использовании классических методов теории управления, применения процедуры линеаризации нелинейных составляющих, что неизбежно приводит к проблемам устойчивости всей системы. Поэтому для синтеза законов группового управления в данной работе предлагается использовать методы и подходы синер-гетической теории управления (СТУ).

Процедура синтеза. В СТУ совокупность критериев управления системы принято выражать в виде соответствующей системы инвариантов, которые выступают в роли цели управления, на них обеспечивается выполнение заданной технологической задачи, а процедура синергетического синтеза сводится к поиску законов управления, при которых эти заданные инварианты выполняются. Следуя централизованному подходу группового управления [6], в качестве первых инвариантов системы необходимо выбрать перемещение центра масс первого (к. = 1) или ведущего МРГ в точку с заданными координатами х , у , г , а также задать удержание угла ориентации щ1 в заданном направлении ц . Таким образом, подмножество целей для ведущего МРГ будет иметь вид:

■^1(1* 1 * 1 * 1 *) 2 = |х = х , у = у , г= г, ц = ц }. (2)

В свою очередь ведомые МРГ (к. = 2, 3, ..., п, где п - количество МРГ) должны выполнять задачу следящей системы, поэтому подмножества целей управления ведомых МРГ будут иметь следующий вид:

2* = {х: = х1 + А X, у1 = у1 +Лу, г1 = г1 + А^, Ц = Ц + А*}, (3)

где А*, А*, Л2, А - коэффициенты смещения ведомых МРГ относительно ведущего, k - номер ведомого МРГ.

Для осуществления синтеза методом АКАР [9] выразим определенные подмножества целей управления ведущего МРГ (2) через совокупности макропеременных:

Т1 = V Т1 = К, Т = V

3 z

Т =©,

Т =а

- V] 1апЬ(х* - х1);

- у' - у1);

- V^апЬ(г * - г1);

-ВД*-в1); (4)

где =\Vг 'V1 'V ] - вектор максимально допустимой скорости движения ведущего МРГ, к\,к\,к\ - положительные константы, в[ и р( - желаемые значения углов тангажа и крена платформы ведущего квадрокоптера. При задании совокупности макропеременных (4) был применен иерархический подход [13, 14] к построению синер-гических законов управления. Согласно данному подходу исходная задача разбивается на несколько иерархически связанных подзадач, в данном случае на задачу перемещения робота в пространстве и задачу стабилизации углов поворота платформы, от которой зависит выполнение первой. Система макропеременных (4) при этом должна удовлетворять решению У,1 = 0 (/ = 1,2, ..6) системы функциональных уравнений:

ф) =о, при /=Т7б, (5)

где ЯЯ, г = 1,6 - положительные константы.

Из первых трех уравнений системы (5) определяется «внешний» закон управления ведущего МРГ и/ и углы в1 и р, которые выступают в качестве целей для системы стабилизации платформы ведущего квадрокопетера = 0 и

^ = 0:

в1 =в*;

1 . (6) (р =(.

Из оставшихся уравнений системы (5) с учетом уравнений связи (6) и заданных макропеременных ^ и ^61 определяются «внешние» законы управления иг1, из1, и4\ отвечающие за повороты платформы ведущего МРГ при передвижении к заданной точке.

Далее, для осуществления слежения за ведущим МРГ, выразим подмножество целей управления ведомых МРГ (3) через следующие совокупности макропеременных:

^1к = V/ - VI - VI 1апИ(х' + Дкх - хк);

^ = V;; - VI - Vykax 1апИ(у' + Дку - ук)

^Зк = V/ - V1 - V/ 1апИ(г1 + Д* - гк);

к- V1 - Vк 1апИ( у1 +Дк ■

у у у„ у

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

к = V* - VI - Г 1апИ( г1 + Д У4к =фкв- к; (в*-вк); (7)

У5к = <- к* (р*-рк);

^к=<-< - К +д;-^к ),

где = [^ У* , V* ] - вектор максимально допустимой скорости движения ведомых МРГ, к*, к12, ккъ - положительные константы, в* и р( - желаемые значения

углов порота платформы к-го ведомого квадрокоптера. Согласно СТУ система макропеременных (7) должны удовлетворять решению = 0 (/ = 1, 2,...,6) систе-

мы функциональных уравнений:

Ч +ЛЧЧк — 0, при г — 1,6. (8)

Решением системы функциональных уравнений (12) с учетом уравнений связи

вк — в*;

9 =9^

являются «внешние» законы управления ведомых МРГ и1к, и2 к, и3к, и4к, которые обеспечивают перевод изображающей точки замкнутой системы в окрестность пересечения многообразий = 0 (/ = 1, 2,...,6), в результате которого происходит динамическая декомпозиция исходной системы (1). В итоге поведение группы мобильных роботов на пересечении инвариантных многообразий = 0 и = 0 (/ = 1, 2,.,6) будет описываться следующей системой:

х1 = VI х* - х1); у1 = КМаиИ(у* - у1); 2 = VI гаиЬ(7* - г1); в1 = к\(в* -в1); 9 = К(ф1 -91);

р = к\р* -у1);

хк = VI + У^ гаиЬ(х1 + А* - хк); Ук = V + УМапКу1 + Аку - ук); хк = У + У^ гаиЬ(х1 + А* - хк);

вк = кК (в; -вк); 9к = К (9* -9);

р — < + кК р + Ак-рк).

(9)

Для того чтобы замкнутая система (9) была асимптотически устойчива, необходимо чтобы к > 0, к > 0, к\ > 0, кк > 0, к2к > 0, к3к > 0 и проекции вектора максимально допустимой скорости движения для ведущего и ведомых МРГ вычислялись следующим образом:

У _ * 1.

X1 — х — х ;

У. 1 1 — у - у;

2, — х - X1;

«1 — VX12 + + 22; у1 .

X, — х1 +Ак -х'

х

, — у +Аку -к

2 — г1 +Ак - хк; к 2 >

7к — у1 + А - ук

Ук —

— 4XI + + 2]; ^п^)XV ,

(10)

V1 —

утах

sign(Yl)}Уo1 .

Vk —

утах

^п(7к те

V1 —

sign{2l)2lVo1.

ук = sign{2k )2kVok

где V1 и V'' - желаемая скорость перемещения ведущего и ведомого МРГ соответственно.

Таким образом, с учетом математической модели мобильного робота (1) и «внешних» управлений ведущего МРГ и!1, и2!, и3!, и4! и ведомых МРГ и1к, и2 к, ик, и4к, можно получить стратегии группового управления реализующие централизованное поведение, слаженное движение ведомых МРГ относительно главного ведущего МРГ, перемещающегося в заданную точку рабочего пространства.

Компьютерное моделирование. Проведем компьютерное исследование синтезированной замкнутой системы группового управления квадрокоптерами. Предположим, что задачу группового построения в пространстве выполняют один ведущий и два ведомых (к = 3) квадрокоптера. В качестве общих параметров квадро-коптеров возьмем значения, представленные в табл. 1.

п

к

п

п

к

п

п

к

п

п

к

Примем в качестве внутренних параметров регулятора ведущего МРГ значения, представленные в табл. 2. Ограничим скорость перемещения ведущего МРГ порогом в К0! = 3 м/с. Зададим целевые координаты ведущего МРГ следующим образом: х = 150 м, у = 0 м, г = 100 м и угол рыскания ц = 0 рад.

Таблица 1

Параметры квадрокоптеров группы

Параметр Обозначение Ед. изм. Значение

Масса квадрокоптера m кг 0,5

Расстояние между центром масс МР и l м 0,3

центром пропеллера

Аэродинамическая составляющая тяги b Не2 12,5 х 10"6

каждого ротора МР

Аэродинамическая составляющая d Нмс2 0,27 х 10-6

сопротивления среды

Момент инерции вокруг оси X ^xx Нмс2 0,05

Момент инерции вокруг оси У 1yy Нмс2 0,05

Момент инерции вокруг оси 2 Нмс2 0,05

Общий вращательный момент инерции JTP Нмс2 0,002

вокруг оси каждого винта

Таблица 2

Параметры регулятора ведущего МРГ

Параметр Обозн. Знач.

Параметр 1-го функционального уравнения ведущего МРГ (5) V 2

Параметр 2-го функционального уравнения ведущего МРГ (5) V 2

Параметр 3-го функционального уравнения ведущего МРГ (5) Аз1 2

Параметр 4-го функционального уравнения ведущего МРГ (5) A4 20

Параметр 5-го функционального уравнения ведущего МРГ (5) V 20

Параметр 6-го функционального уравнения ведущего МРГ (5) Аб 20

Параметр макропеременной ¥4! (4) ki1 35

Параметр макропеременной ¥5! (4) k21 35

Параметр макропеременной (4) кз1 35

Примем в качестве внутренних параметров регуляторов ведомых МРГ значения, представленные в табл. 3. Ограничим скорость перемещения ведомых МРГ порогом в ¥0к = 8 м/с.

Таблица 3

Параметры регуляторов ведомых МРГ

Параметр Обозн. Знач.

Параметр 1-го функционального уравнения ведомых МРГ (8) а/ 2

Параметр 2-го функционального уравнения ведомых МРГ (8) А2к 2

Параметр 3-го функционального уравнения ведомых МРГ (8) А3к 2

Параметр 4-го функционального уравнения ведомых МРГ (8) A4 20

Параметр 5-го функционального уравнения ведомых МРГ (8) А/ 20

Параметр 6-го функционального уравнения ведомых МРГ (8) Аб 20

Параметр макропеременной ¥4к (7) к1к 35

Параметр макропеременной ¥5к (7) к2к 35

Параметр макропеременной ¥6к (7) к3к 35

Примем в качестве параметров смещения ведомых МРГ относительно ведущего значения, представленные в табл. 4.

Таблица 4

Параметры смещения ведомых МРГ относительно ведущего

Параметр Обозначение Значение

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

Смещение 1-го ведомого МРГ по оси X -20

Смещение 1-го ведомого МРГ по оси У А2 У 20

Смещение 1-го ведомого МРГ по оси 2 А2 г 0

Смещение 1-го ведомого МРГ по углу рыскания А2 V 0,3

Смещение 2-го ведомого МРГ по оси X А3 X -20

Смещение 2-го ведомого МРГ по оси У АУ -20

Смещение 2-го ведомого МРГ по оси 2 А3г 0

Смещение 2-го ведомого МРГ по углу рыскания а; - 0,3

Примем в качестве начальных условий ведущего и ведомых МРГ нулевые значения проекций вектора линейной (Ухк(0) = Уук (0) = V/(0) = 0) и угловой скоростей (ю/(0) = юДО) = юДО) = 0) квадрокоптера, а также нулевые значения углов тангажа, крена и рыскания (в1с(0) =фк(0) = ^(0) = 0). В качестве начального расположения квадрокоптеров в рабочем пространстве примем следующие значения:

х1(0) = 0, У(0) = 0, Д0) = 0;

х2(0) = -100, у2(0) = 100, ¿2(0) = 0; х3(0) = -30, у3(0) = -100, ¿3(0) = 0.

На рис. 3-9 представлены переходные процессы изменения координат полученной замкнутой системы. Обозначения на рисунках: 1 - ведущий МРГ; 2, 3 - ведомые МРГ.

Рис. 3. Изменение проекции вектора Рис. 4. Изменение проекции вектора перемещения роботов группы на ось Х перемещения роботов группы на ось У

Рис. 5. Изменение проекции вектора перемещения роботов группы на ось 2

Рис. 6. Изменение угла тангажа роботов группы

Рис. 7. Изменение угла крена роботов группы

Рис. 8. Изменение угла рыскания роботов группы

Рис. 9. Изменение вектора линейной скорости полета мобильных роботов группы

Представленные результаты моделирования подтверждают, что в синтезированной замкнутой системе управления группой роботов (4)-(10), с учетом (1) обеспечивается выполнение введенной системы инвариантов: передвижение ведущего МРГ к заданной точке в трехмерном пространстве (рис. 3-5), выдерживание ведомыми МРГ заданного смещения относительно ведущего МРГ (рис. 4, 5), а также выполнения всеми МРГ ограничения по максимальной скорости перемещения (рис. 9).

Заключение. Таким образом, в статье представлен важный научный результат -разработана процедура аналитического синтеза стратегии группового управления мобильными роботами с использованием полных нелинейных моделей движения. Указанная стратегия управления обеспечивает асимптотическую устойчивость замкнутых систем, и четкое исполнение заданных инвариантов. Использование нелинейных составляющих при синтезе законов группового управления позволяет точно выдерживать требуемое смещение ведомых квадрокоптеров относительно положения ведущего. Вариация смещений ведомых МРГ позволяет формировать различные типы строя группы роботов. В рамках данной работы предложены базовые законы управления механическими подсистемами мобильных роботов группы. Для построения полной системы управления в дальнейшем предполагается включение в модель системы динамики исполнительных приводов, а также динамики связей между роботами группы для повышения энергоэффективности и общей устойчивости системы.

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

1. Avanzini P., Royer E., ThuilotB., and Durutin J.-P. Using monocular visual SLAM to manually convoy a fleet of automatic urban vehicles // in Proc. IEEE Int. Conf. Robotics Automation.

- Karlsruhe, Germany, 2013. - P. 3219-3224.

2. Petrov P. A mathematical model for control of an autonomous vehicle convoy // Trans. syst. Control. - 2008. - Vol. 3, no. 9. - P. 835-848.

3. Antonelli G., Arrichiello F., Caccavale F. and Marino A. Decentralized centroid and formation control for multi-robot systems // in IEEE Int. Conf. Robotics Automation, Karlsruhe, Germany, 2013. - P. 3511-3516.

4. Kitts C.A. and I. Mas. Cluster space specification and control of mobile multirobot systems // IEEE/ASME Trans. Mechatronics. - 2009. - Vol. 14, no. 2, Apr. - P. 207-218.

5. Liu T. and Jiang Z. Distributed formation control of nonholonomic mobile robots without global position measurements // Automatica. - 2013. - Vol. 49, no. 2. - P. 592-600.

6. Mariottini G. et al. Vision-based localization for leader-follower formation control // IEEE Trans. Robot. - Dec. 2009. - Vol. 25, no. 6. - P. 1431-1438.

7. Agnew, M.S., Dal Canto, P., Kitts, C.A., Li, S., Cluster space control of aerial robots // Advanced Intelligent Mechatronics (AIM), 2010 IEEE/ASME International Conference on, 2010.

- P. 1305-1310.

8. Tommaso Bresciani. Modeling, identification and control of a quadrotor helicopter. - Lund: Master thesis, 2008. - 170 p.

9. Колесников А.А. Синергетическая теория управления. - М.: Энергоатомиздат, 1994.

- 344 с.

10. Колесников А.А. Синергетическая теория управления: концепции, методы, тенденции развития // Известия ТРТУ. - 2001. - № 5 (23). - С. 7-27.

11. Колесников А.А. Синергетическая концепция системного синтеза: единство процессов самоорганизации и управления // Известия ТРТУ. - 2006. - № 6 (61). - С. 10-38.

12. Колесников А.А., Веселое Г.Е., Попов А.Н., Мушенко А.С. и др. Синергетические методы управления сложными системами: механические и электромеханические системы. - М.: КомКнига, 2006. - 304 с.

13. Веселов Г.Е. Синергетический подход к синтезу иерархических систем управления // Известия ТРТУ. - 2006. - № 6 (61). - С. 73-84.

14. Веселов Г.Е. Проблема синтеза иерархических стратегий группового управления робо-тотехническими системами // Известия ЮФУ. Технические науки. - 2011. - № 6 (119).

- С. 41-49.

15. Веселов Г.Е., Скляров А.А., Скляров С.А. Синергетический подход к управлению беспилотным летательным аппаратом // Известия ЮФУ. Технические науки. - 2013. - № 5 (142). - С. 65-70.

16. Веселов Г.Е., Скляров А.А., Скляров С.А. Синергетическая стратегия обхода недетерминированных препятствий беспилотным летательным аппаратом // Материалы Всероссийской научной конференции «Вузовская наука Северо-Кавказскому федеральному округу». - Пятигорск: Изд-во ФГАОУ ВПО «СФУ» (филиал) в г. Пятигорске, 2013.

- Т. 2. - С. 64-73.

REFERENCES

1. Avanzini P., Royer E., ThuilotB., and Durutin J.-P. Using monocular visual SLAM to manually convoy a fleet of automatic urban vehicles, in Proc. IEEE Int. Conf. Robotics Automation. Karlsruhe, Germany, 2013, pp. 3219-3224.

2. Petrov P. A mathematical model for control of an autonomous vehicle convoy, Trans. syst. Control, 2008, Vol. 3, No. 9, pp. 835-848.

3. Antonelli G., Arrichiello F., Caccavale F. and Marino A. Decentralized centroid and formation control for multi-robot systems, in IEEE Int. Conf. Robotics Automation, Karlsruhe, Germany, 2013, pp. 3511-3516.

4. Kitts C.A. and I. Mas. Cluster space specification and control of mobile multirobot systems, IEEE/ASME Trans. Mechatronics, 2009, Vol. 14, No. 2, Apr., pp. 207-218.

5. Liu T. and Jiang Z. Distributed formation control of nonholonomic mobile robots without global position measurements, Automatica, 2013, Vol. 49, No. 2, pp. 592-600.

6. Mariottini G. et al. Vision-based localization for leader-follower formation control, IEEE Trans. Robot, Dec. 2009, Vol. 25, No. 6, pp. 1431-1438.

7. Agnew, M.S., Dal Canto, P., Kitts, C.A., Li, S., Cluster space control of aerial robots, Advanced Intelligent Mechatronics (AIM), 2010 IEEE/ASME International Conference on, 2010, pp. 1305-1310.

8. Tommaso Bresciani. Modeling, identification and control of a quadrotor helicopter. Lund: Master thesis, 2008, 170 p.

9. Kolesnikov A.A. Sinergeticheskaya teoriya upravleniya [Synergetic control theory]. Moscow: Energoatomizdat, 1994, 344 p.

10. Kolesnikov A.A. Sinergeticheskaya teoriya upravleniya: kontseptsii, metody, tendentsii razvitiya [Synergetic control theory: concepts, methods, trends], Izvestiya TRTU [Izvestiya TSURE], 2001. No. 5 (23), pp. 7-27.

11. Kolesnikov A.A. Sinergeticheskaya kontseptsiya sistemnogo sinteza: edinstvo protsessov samoorganizatsii i upravleniya [Synergetic concept of system synthesis: the unity of the processes of self-organization and management], Izvestiya TRTU [Izvestiya TSURE], 2006, No. 6 (61), pp. 10-38.

12. Kolesnikov A.A., Veselov G.E., Popov A.N., Mushenko A.S. i dr. Sinergeticheskie metody upravleniya slozhnymi sistemami: mekhanicheskie i elektromekhanicheskie sistemy [Synergistic methods of control of complex systems: mechanical and Electromechanical systems]. Moscow: KomKniga, 2006, 304 p.

13. Veselov G.E. Sinergeticheskiy podkhod k sintezu ierarkhicheskikh sistem upravleniya [A syn-ergistic approach to the synthesis of hierarchical control systems], Izvestiya TRTU [Izvestiya TSURE], 2006, No. 6 (61), pp. 73-84.

14. Veselov G.E. Problema sinteza ierarkhicheskikh strategiy gruppovogo upravleniya robo-totekhnicheskimi sistemami [The problem of synthesis of hierarchical strategies group control of robotic systems], Izvestiya YuFU. Tekhnicheskie nauki [Izvestiya SFedU. Engineering Sciences], 2011, No. 6 (119), pp. 41-49.

15. Veselov G.E., Sklyarov A.A., Sklyarov S.A. Sinergeticheskiy podkhod k upravleniyu bes-pilotnym letatel'nym apparatom [Синергетический подход к управлению беспилотным летательным аппаратом], Izvestiya YuFU. Tekhnicheskie nauki [Izvestiya SFedU. Engineering Sciences], 2013, No 5 (142), pp. 65-70.

16. Veselov G.E., Sklyarov A.A., Sklyarov S.A. Sinergeticheskaya strategiya obkhoda nedeter-minirovannykh prepyatstviy bespilotnym letatel'nym apparatom [Synergistic strategy crawl nondeterministic obstacles unmanned aerial vehicle], Materialy vserossiyskoy nauchnoy konferentsii «Vuzovskaya nauka Severo-Kavkazskomu federal'nomu okrugu» [Materials of all-Russian scientific conference "science of the North-Caucasian Federal district"]. Pyatigorsk: Izd-vo FGAOU VPO «SFU» (filial) v g. Pyatigorske, 2013. - Vol. 2, pp. 64-73.

Статью рекомендовал к опубликованию д.т.н., профессор И.М. Першин.

Скляров Сергей Анатольевич - Южный федеральный университет; e-mail: [email protected];

347900, г. Таганрог, ул. Чехова, 2, к. 403; тел.: +79034026114; кафедра СиПУ; зав. лаб.

Sklyarov Sergey Anatolevich - Southern Federal University; e-mail: [email protected];

2, Chehov street, ap. 403, Taganrog, 347900, Russia; phone: +79034026114; head of laboratory of

SCP department.

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