Gaiduk Anatoly Romanovich - Federal State-Owned Autonomy Educational Establishment of Higher Vocational Education «Southern Federal University»; e-mail: gaiduk_2003@mail.ru; 26, app. 2, Slesarnaya street, Taganrog, 347904, Russia; phone: +78634626287; the department of automatic control systems; professor.
Besklubova Ksenia Valeryevna - e-mail: besklubova@rambler.ru; 8/1, app. 33, Yablochkina street, Taganrog, 347904, Russia; phone: +78634387349; the department of automatic control systems; assistant.
Melnichenko Alexandra Sergeevna - e-mail: melnichenkolexx@gmail.com; 44, Nekrasovsky, Taganrog, 347928, Russia; phone: +78634387349; the department of automatic control systems; student.
УДК 681.58:621.865.8
И.О. Шаповалов, Е.Ю. Косенко
РАСПРЕДЕЛЕННОЕ НЕЛИНЕЙНОЕ УПРАВЛЕНИЕ ГРУППОЙ РОБОТОВ НА ОСНОВЕ КВАЗИЛИНЕЙНОЙ ФОРМЫ УРАВНЕНИЙ*
В настоящее время во многих странах активно разрабатываются системы группового управления автономными мобильными роботами. Связано это с осознанием преимуществ, присущих этим системам. Управление группой роботов, перемещающей по плоскости крупногабаритные объекты, является сложной задачей, решаемой с помощью распределенной системы группового управления роботами. Разработана и приведена используемая при управлении квазилинейная динамическая модель подвижного объекта. Синтезированы законы управления движением группы объектов на основе функции Ляпунова, виртуальных агентов и концепции "ведущий—ведомые" с учетом ограничений, накладываемых на движение объектов и тяговые усилия роботов. Функция Ляпунова представляет собой комбинацию квазиполей притяжения и отталкивания. Предложенная схема распределенного управления позволяет группе роботов перемещать группу объектов по заданной траектории, сохраняя строй. При этом объекты не сталкиваются друг с другом. Сходимость процессов управления в синтезированной распределенной системе доказана аналитически. Кроме того, работоспособность предложенной системы группового управления роботами подтверждается результатами моделирования.
Группа объектов; распределенная система; управление движением; квазиполя; функция Ляпунова; квазилинейная форма.
I.O. Shapovalov, E.Yu. Kosenko
DISTRIBUTED MOTION CONTROL SYSTEM FOR GROUP OF LARGE-SIZE
OBJECTS
Currently, many countries actively develop autonomous mobile group robot control systems. This is due to the realization of such system advantages. Group robot control to move large objects through the plane is a challenging problem solved with the help of the distributed group robot control system. Used by the control system, the quasi-linear dynamic model of the mobile object was developed and presented here. The object group motion control laws were developed on the basis of the Lyapunov function, virtual agents and the "leader—follower" conception with respect to the restrictions imposed on the object motions and the driving forces of robots. Lyapunov function is a combination the quasi attraction and repulsion fields. The proposed distributed con-
* Работа выполнена при поддержке гранта РФФИ № 13-08-00249-а.
trol scheme allows flock motion a robot group with a group of objects along a given trajectory. Wherein the objects don't collide with each other. Convergence of control processes in the synthesized distributed system proved analytically. In addition, the performance of the proposed group robot control system confirmed by the simulation results.
Object group; distributed system; motion control; quasi fields; Lyapunov function; quasilinear form.
Введение. Роботы в настоящее время находят применение практически во всех сферах жизни. При этом используются самые различные виды роботов, начиная от простейших бытовых роботов и заканчивая сложными промышленными комплексами. Примечательно, что все меньше используются одиночные роботы. Для разработчиков и исследователей становится все более очевидным, что группы взаимосвязанных роботов имеют значительные преимущества перед одиночными. Разработка специальных систем управления для групп роботов является предметом исследований множества исследовательских коллективов, использующих самые разные подходы [1, 2]. Однако общая методика для синтеза систем группового управления роботами (СГУР) еще не разработана [3].
Связано это с тем, что к таким системам предъявляются особые требования. СГУР должны обеспечивать решение поставленных задач при изменении структуры и состава системы, при неизвестных условиях окружающей среды и даже при противодействии.
По своим характеристикам группы роботов относятся к классу сложных нелинейных динамических систем и для управления ими применяются методы из области теории больших систем, например многоагентные системы [4] или экономические модели [5]. Применение многоагентного подхода дает удобный инструментарий для моделирования взаимодействия роботов группы. Однако часто разработка правил и протоколов взаимодействия агентов требует творческого подхода и нестандартных решений, это значительно затрудняет процесс разработки. Разработка СГУР на основе экономических моделей характеризуется схожими трудностями.
Любая разрабатываемая СГУР по умолчанию должна решать широкий спектр задач: начиная от управления движителями отдельных роботов и заканчивая распределением целей между роботами группы. Поэтому наиболее предпочтительной представляется иерархическая структура управления, состоящая из стратегического, тактического и оперативного уровней управления. В данной статье описываются законы управления, применяемые на тактическом уровне СГУР, решающие задачи перемещения по заданной траектории, обхода препятствий и движения в строю.
С точки зрения распределения управляющих функций между роботами группы принято выделять централизованные и распределенные СГУР. Несмотря на некоторые сложности реализации, распределенные системы, по сравнению с централизованными, придают системе большую гибкость, надежность и обеспечивают максимальную вероятность решения поставленной задачи в условиях агрессивной среды функционирования. В [3] наиболее перспективным представляется подход на основе децентрализованного коллективного управления, когда каждый робот самостоятельно решает, какие действия ему предпринимать для достижения общегрупповой цели на основе информации, поступающей от окружающей среды и остальных роботов. Однако следует отметить, что значительное влияние на качество распределенного коллективного управления оказывают коммуникационные ограничения [6].
Одной из задач, при решении которой могут быть реализованы преимущества, присущие группам роботов, является транспортировка грузов, в особенности крупногабаритных грузов [7]. В данной работе описывается задача перемещения нескольких крупногабаритных объектов группой автономных мобильных роботов по заданной траектории.
Постановка задачи. Пусть в начальный момент времени на горизонтальной поверхности произвольным образом расположены N объектов. Объекты неподвижны. Для упрощения динамической модели предполагается, что любой объект
0г, г = 1, N представляет собой идеально круглое тело, расположенное на плоскости, с которой связана система координат x0y. К каждому объекту случайным образом присоединен кластер (подгруппа) из k автономных мобильных транспортных роботов Яу, г = 1, N,у = 1,к, как показано на рис. 1. Процесс присоединения
роботов к объектам в данной работе не рассматривается. Требуется, чтобы роботы переместили строй объектов к целевой области по заданной траектории, обходя встречающиеся по пути подвижные и неподвижные препятствия.
У
К
х
Рис. 1. Система "объект-роботы" на плоскости
Для успешного перемещения объекта роботы должны объединить свои усилия и сформировать общую силу тяги р, создающую вращающий момент М,..
Формирование общей силы тяги кластера роботов, присоединенных к объекту 0 1, производится путем выбора активных роботов, комбинация сил тяги которых дает желаемые величину, направление и вращающий момент тягового усилия [3, 8]. Если масса и размеры роботов по сравнению с размерами перемещаемого объекта пренебрежимо малы, то после выделения активных роботов объект с присоединенными к нему роботами можно представить в виде макрообъекта круглой формы, имеющего радиус г, г = 1, N и массу тг, г = 1, N.
Модель движения объекта в виде квазилинейной системы дифференциальных уравнений для поступательного и вращательного движения записывается следующим образом:
х = со^Фи, )Ц,
У г = 81п(фи г )Ц,
Ф, = Ю,, (1)
Ц = а,,
со, = е,.
где ц , фш. - величина и направление линейной скорости объекта /'; ф - угол
ориентации объекта; ю, - угловая скорость объекта; а,., е - линейное и угловое ускорения объекта.
Подходы, используемые при построении системы управления. Согласно постановке задачи, СГУР должна изменить координаты группы объектов таким образом, чтобы они не только оказались в целевом положении, но в процессе пе-
ремещения сохраняли нужную ориентацию относительно друг друга в внешних объектах. То есть возникает задача минимизации отклонения текущих координат каждого объекта от вычисленных определенным образом желаемых координат. В теории нелинейных динамических систем одним из наиболее часто применяемых методов управления по отклонению является аппарат функций Ляпунова.
Управление на основе функции Ляпунова используется для реализации группой роботов движения в строю. Группа из N объектов, к каждому из которых присоединена группа роботов, ведется лидером группы. То есть для управления группой используется стратегия "ведущий-ведомые". Когда группа приближается к препятствию, объекты разделяются, огибают препятствие, а затем снова восстанавливают строй.
Построение системы управления движением группы мобильных роботов на основе стратегии управления «ведущий - ведомые» подробно описано, например, в [9].
В рамках данной стратегии из всей совокупности роботов выделяется один робот, который начинает исполнять обязанности лидера, заключающиеся в выборе общей траектории движения группы. Движение всех роботов группы вдоль задаваемой лидером траектории обеспечивается тем, что каждый робот стремится сохранять неизменным свое положение относительно лидера. Для этого используются различные механизмы. Например, в [9] вводится понятие виртуального транспортного средства. По аналогии с [9] можно ввести понятие виртуального робота. С каждым реальным ведомым роботом связан один виртуальный робот, как показано на рис. 2. При этом виртуальный робот всегда сохраняет заданное положение относительно робота-лидера. На протяжении всего движения каждый ведомый робот стремится, чтобы у него была такая же ориентация и положение, как и у виртуального робота, связанного с ним. То есть координаты и ориентация виртуального робота являются желаемыми для ведомого робота. Получается, что в процессе движения группы виртуальные роботы движутся за роботом-лидером, а ведомые роботы движутся за связанными с ними виртуальными роботами. Желаемыми координатами для ведущего робота являются либо координаты целевой области, если он перемещается к цели по кратчайшему пути, либо координаты какой-либо точки на заданной траектории движения.
На рис. 2 изображен робот Л с координатами (х1, у ) центра тяжести и соответствующий ему виртуальный робот с координатами (хи , уи.). Робот Л движется со скоростью V , направленной под углом 0; к оси X. Расстояние между реальным и виртуальным роботом характеризуется координатной парой (хл , Уаг).
Поскольку в нашем случае осуществляется управление движением группы объектов с прикрепленными к ним роботами, то будем использовать понятие виртуального, ведущего и ведомого объекта.
В работе [10] задача управления строем роботов решается на основе функции Ляпунова в квадратичной форме, являющейся объединением функций, аналитически описывающих так называемые искусственные потенциальные поля притяжения и отталкивания (квазиполя притяжения и отталкивания). Предложенная в [10] функция Ляпунова не гарантирует сходимость решения к желаемой конфигурации группы, так как производная функции Ляпунова является отрицательно полуопределенной. В данной работе предлагаются законы управления движением роботов на основе функции Ляпунова, гарантирующие сходимость решения к желаемой конфигурации группы. Законы управления получены путем модификации предложенных в [10] функций и регуляторов.
У
УV
У
X X.,,
X
Рис. 2. Реальный робот с соответствующим виртуальным
Структура системы управления на основе функций Ляпунова требует конструирования функций стремления к цели и отталкивания от препятствия. С одной стороны, квазиполе притяжения формируется на основе комбинации функций стремления к целям. Это позволяет объектам двигаться к цели, сохраняя строй. С другой стороны, квазиполе отталкивания формируется на основе комбинации функций отталкивания от препятствий. Это позволяет объектам огибать все препятствия.
Регуляторы на основе функции Ляпунова. Одним из главных преимуществ использования управления с помощью функций Ляпунова является возможность доказательства устойчивости предлагаемого управления. Закон управления должен надлежащим образом комбинировать функции, описывающие квазиполя притяжения и отталкивания.
Если рассматривать группу объектов, динамика каждого из которых описывается уравнениями (1), то в соответствии с целями управления для придания устойчивости системе введены следующие законы управления i-м объектом:
+ /1 осз е, + /а + .,3 • ^^+к,5 -
(2)
, , (в - ^ )2 к.,ю +1. + к., -'—
,2 , 3 , ,4
ю.
I
(3)
где , = 2, N; XV1, , е^ - координаты и угол поворота /'-го виртуального объекта; к^ , ] = 1,5 - настроечные коэффициенты; /^ , / = 1,5 - части производной от
функции Ляпунова.
Рассмотрим в качестве кандидата на функцию Ляпунова системы (1) функцию
т=£ Ь ©+Qi © - £
ХЛ У^- УЩ
,к - + + ——— + ——— +
в„
к=1 Я^(4) иу1 (4) ищ (4) ^Яти(4)
(4)
а = —
/
N
,=1
где , уУг, ущ , в - положительные коэффициенты, выполняющие роль настроечных параметров закона управления; А1 (£), Q¡ (£), (£), (£), и<юг- (£), Яму (£) - функции, описывающие квазиполя притяжения и отталкивания; £ = (х, у, 0, и, ю) - обобщенный вектор координат.
Введенному в рассмотрение функции кандидату соответствует производная по времени вдоль траектории системы (1):
Ш) = Z [(Ai cos в, + ]2, sin в, + 14,а, )v, + (/3, + /5,е, ].
(5)
Подставляя в выражение (5) уравнения законов управления (2), (3) и уравнения модели (1), получим отрицательно определенную функцию:
N
Щ) = -Е^яЧ2 +к,з(х, -XV,)2 +Ш-Ь>,)2 +kl5(V, - VV,)2) < 0 (6)
1=2
при i = 2, N, V4 е Q(L), 4 ф 4*.
Так как функция (4) отвечает всем требованиям, предъявляемым к кандидатам в функции Ляпунова, то она является функцией Ляпунова для системы (1), а
4* = (xVj, yv 1,9vj,0,0,..., xvN, yvN, 0vN ,0,0) является устойчивым положением равновесия в силу известной теоремы Ляпунова.
Предложенные подходы к управлению группой крупногабаритных объектов были исследованы путем численного моделирования в среде MatLab. Результаты моделирования показаны на рис. 3. Требовалось переместить 3 произвольным образом ориентированных неподвижных объекта по кратчайшему пути в целевое положение. Объект, выполняющий функции лидера, имел первоначальные координаты (20 м, 25 м); ведомые объекты имели координаты (22 м, 15 м) и (32 м, 35 м). Объект-лидер должен был остановиться в точке с координатами (135 м, 55 м). При этом ведомые объекты должны были остановиться на расстоянии 5 м от ведущего.
60 55 50 45 40 ^ 35 30 25 20 15 10
К
object2
object3
Рис. 3. Фазовые траектории движения трех объектов
Как видно из рис. 3, после некоторого переходного процесса, связанного с поворотом для ориентации максимального вектора тяги перемещающего кластера на цель, объект-лидер (object 1) перемещается к целевой точке практически по прямолинейной траектории. Траектория не прямолинейна потому, что роботы начинают перемещать объект до того, как направление максимального вектора тяги
i=i
x, м
точно совпадет с направлением на цель. Переходные процессы в траекториях ведомых объектов (object 2 и object 3) намного более заметны и продолжительны, поскольку ведомые объекты должны ориентировать направления максимальных тяговых векторов на цель и при этом соблюдать заданное расстояние друг от друга и от объекта-лидера.
Заключение. В данной работе предложена реализация системы группового управления роботами на основе принципа распределенного управления. Представлена квазилинейная динамическая модель объекта. Поставлена задача перемещения группы объектов автономными мобильными роботами. Предложена реализация распределенного управления на основе функции Ляпунова. При этом доказана сходимость процесса управления на основе предложенного подхода.
БИБЛИОГРАФИЧЕСКИЙ СПИСОК
1. Arai T., Pagello E., Parker L.E. Editorial: advances in multi-robot systems // IEEE Transactions on Robotics and Automation. - 2002. - Vol. 18, № 5. - P. 655-661.
2. Bayindir l., Sahin E. A Review of Studies in Swarm Robotics // Turkish Journal Electrical Engineering and Computer Sciences. - 2007. - Vol. 15. - P. 115-147.
3. Каляев И.А., Гайдук А.Р., Капустян С.Г. Модели и алгоритмы коллективного управления в группах роботов. - М.: Физматлит, 2009. - 280 с.
4. Duman H., Hu H. Fuzzy Logic for Behaviour Co-ordination and Multi-Agent Formation in RoboCup // Developments in Soft Computing, Advances in Soft Computing. - 2001. - Vol. 9.
- P. 191-198.
5. Dias M.B., ZlotR., Kalra N., Stentz A. Market-Based Multirobot Coordination: A Survey and Analysis // Proceedings of the IEEE. - 2006. - Vol. 94, № 7. - P. 1257-1270.
6. Meng Z., You Z., Li G., Fan C. Cooperative attitude control of multiple rigid bodies with multiple time-varying delays and dynamically changing topologies // Mathematical problems in engineering. - 2010. Article id 621594. - 19 p.
7. Rus D., Donald B., Jennings J. Moving Furniture with Teams of Autonomous Robots // Proceedings of The IEEE/RSJ International Conference on Intelligent Robots and Systems 95. 'Human Robot Interaction and Cooperative Robots', 1995. - P. 235-242.
8. Титов А.Е., Шаповалов И.О. Применение прецизионных аналоговых интерфейсов в задачах экстремальной робототехники // Известия ЮФУ. Технические науки. - 2013.
- № 2 (139). - С. 82-88.
9. Yoshioka C., Namerikawa T. Formation control of nonholonomic multi-vehicle systems based on virtual structure // Proceedings of the 17th World congress of The International Federation of Automatic control, 2008.
10. Sharma B., Vanualailai J. Flocking of Multi-agents in Constrained Environments // European journal of pure and applied mathematics. - 2009. - Vol. 2, № 3. - P. 401-425.
Статью рекомендовал к опубликованию д.т.н., проф. Р.А. Нейдорф.
Шаповалов Игорь Олегович - Федеральное государственное автономное образовательное учреждение высшего профессионального образования «Южный федеральный университет»; e-mail: shapovalovio@gmail.com; 347928, г. Таганрог, пер. Некрасовский, 44; тел.: 89508473455; кафедра систем автоматического управления; ассистент.
Косенко Евгений Юрьевич - e-mail: ekosenko@sfedu.ru; 347928, г. Таганрог, пер. Некрасовский, 44; тел.: +79045071963; кафедра систем автоматического управления; доцент.
Shapovalov Igor Olegovich - Federal State-Owned Autonomy Educational Establishment of Higher Vocational Education "Southern Federal University"; e-mail: shapovalovio@gmail.com; 44, Nekrasovsky, Taganrog, 347928, Russia; phone: +79508473455; the department of automatic control systems; assistant.
Kosenko Evgeny Yurievich - e-mail: ekosenko@sfedu.ru; 44, Nekrasovsky, Taganrog, 347928, Russia; phone: +79045071963; the department of automatic control systems; associate professor.