CC BY
203
УПРАВЛЕНИЕ ТРАЕКТОРНЫМ ДВИЖЕНИЕМ АВТОНОМНЫХ РОБОТОВ
И.В. Мирошник, А.Н. Шалаев
Рассматривается траекторная задача управления плоским движением автономных роботов, т.е. задача перемещения робота в рабочем пространстве по предписанной траектории, заданной в аналитическом виде. Основные результаты представлены задачно-ориентированной моделью пространственного движения и соответствующими нелинейными алгоритмами управления.
Подвижными роботами называются технические системы, приспособленные к самостоятельному перемещению в рабочем пространстве и предназначенные для автоматической транспортировки разнообразных предметов и механизмов [3-4, 6-7]. К данному классу можно отнести рельсовые транспортные средства, безрельсовые платформы и манипуляторы на подвижной основе, автоматические летательные, надводные и подводные аппараты, шагающие механизмы и проч.
Конструкция подвижного робота включает основание (корпус) и двигательную систему, обеспечивающую требуемое направление и скорость перемещения корпуса в рабочем пространстве. Важнейшее место в ряду подвижных роботов занимают автономные роботы, движение которых происходит в воздушной или водной среде, т.е. без контакта с опорной поверхностью. Как объект управления автономный робот является многоканальной существенно нелинейной динамической системой. Его математическое описание (модель движения) может быть получено с использованием уравнений Лагранжа или Ньютона-Эйлера, в которых силомоментные воздействия производятся двигательной системой. Особенности двигательной системы и взаимодействие с вязкой средой определяют основные отличия моделей движения автономных роботов от моделей твёрдого тела и роботов колесного типа.
Динамические модели роботов устанавливают связи выходных переменных системы, к которым относятся декартовы координаты платформы у}- и углы её ориентации а}, и входных (управляющих) переменных, в качестве которых выступают продольная движущая сила ¥ и вращающий момент / (рис.1). Задача, решаемая системой управления подвижного робота, заключается в создании управляющих воздействий, обеспечивающих перемещение центра масс в рабочем пространстве с учётом сил сопротивления внешней среды и ограничивающих условий,
Введение
(уО
о
Рис. 1. Автономный робот и траектория движения Э
представленных в виде функциональных соотношений различных переменных системы. В траекторных задачах такие соотношения даются аналитическим описанием заданной траектории движения (трассы), и задача системы управления сводится к парированию отклонений от трассы (стабилизация объекта относительно заданной траектории) и обеспечению желаемого режима продольного перемещения. При этом полагается, что робот оснащён адекватной измерительной системой, позволяющей определить текущее положение и/или значение отклонения от заданной траектории.
В работе рассматривается наиболее распространённая траекторная задача управления плоским движением автономных роботов - задача перемещения в рабочем пространстве (плоскости R2) по предписанной траектории (трассе) S, заданной в аналитическом виде. Используемый подход предусматривает нелинейное преобразование модели робота к системе задачно-ориентированных координат. Это даёт возможность свести сложную многоканальную задачу управления к ряду простых задач компенсации линейных и угловых отклонений, а затем с помощью стандартных приёмов нелинейной стабилизации [1,8] найти адекватные законы управления. Основные результаты представлены задачно-ориентированной моделью пространственного движения и соответствующими нелинейными алгоритмами управления. Результаты являются развитием известных решений задач управления пространственным движением, предложенных в [1, 3, 5].
2. Модель движения и основная задача управления
Положение корпуса робота как твёрдого тела в плоскости Y=R2 характеризуется парой
У, а,
где y=(yi, у2) - вектор декартовых координат центра масс С, а- угловая ориентация. С углом а связана ортогональная матрица (матрица вращения)
cosa sin а
T(а) = е SO(2), T(0) = I,
- sin а cos а
соответствующая базису с началом в точке С.
Поступательное движение робота описывается моделью
y = V, mV = TT (а)( F + Fc), (1)
а вращательное -
а = ш, Jé = д + д c (2)
где VeR и ш - линейная и угловая скорости движения,
F =
(3)
и FcGR2 - заданные в относительной системе координат ZGR2 управляющие и возмущающие силовые воздействия, д и - управляющий и возмущающие моменты, т и J - массо-инерционные характеристики. Отметим, что в относительной системе координат робота Z вектор линейных скоростей Уг= (Уг\ Уъ2) находится как
V = Т (а)У. (4)
Возмущающие воздействия рассматриваемого класса подвижных роботов определяются выражениями
Рс =-Ку (V V . (5)
Д с =~ка (ю)ю . (6)
где
КУ =
ка = к3 М
(7)
к К\ 0
0 к 2 V 2|
к - коэффициенты вязкого трения.
Уравнения (1)-(6) описывают 3-канальную динамическую систему 6-го порядка с выходами у], у2,а и входами (управлениями) /, /..
В рассматриваемых здесь траекторных задачах требуемое поведение робота предписывается кривой, заданной в системе координат У. Будем рассматривать движение относительно гладкого отрезка плоской кривой £, неявное описание которого имеет вид
Ф( У) = 0, (8)
а соответствующая локальная координата * (путь) определяется выражением
* = У(У), (9)
где ф(у), у(У) - гладкие функции. Воспользуемся ортогональными представлениями кривых [1,3], для которых функции ф и у таковы, что на линии £ матрица Якоби
ду / ду
Ф( У) =
дф / дУ
Уе£
можно записать
ортогональна. Тогда, обозначив ф*(У ) = ф( у)| ,
ф*(У) = Т(а*) е £0(2), где а - угол наклона касательной. Определённая таким образом матрица Т(а) соответствует подвижному базису (базису Френе), который удовлетворяет следующему уравнению типа Френе [1-2]: Т (а *) = *£ (£)Т (а *).
Введённые в рассмотрение ортогональные матрицы (и, следовательно, подвижные базисы) подчинены следующим дифференциальным соотношениям:
Т (а) = шЕТ (а), (10)
Т (а*) = ад ЕТ (а*), (11)
01
е *о(2), Е, - кривизна. Свойство (10) может быть записано в явной
где Е =
-1 0
(12)
форме
а = ш,
а уравнение (11) - как
а * = *£,. (13)
Задача управления траекторным движением автономного робота ставится как задача поддержания голономных соотношений между выходами системы У, заданных в форме (8). Она дополняется описанием желаемого режима продольного движения основной точки обычно устанавливаемого с помощью эталонной переменной * (¿) или эталонной скорости продольного движения V* = ).
В установившемся режиме относительная ориентация подвижного объекта (по отношению к £) определяется следующим соотношением
Т(а) = Т(Да)Т(а ), где Аа- угол разворота, Т(Да) е £0(2), или в скалярной форме а = Аа + а *.
Значение Аа определяется выражением
(14)
(15)
Да = arctg (— £V *)
(16)
Введём в рассмотрение ошибки тракторного движения. Нарушение условий (8) характеризуется ортогональным отклонением
е = ф(У), (17)
принимающем на множестве S нулевые значения. Текущие нарушения угловых соотношений (15) определяются угловой ошибкой
5 = а - а * - Да (18)
или ортогональной матрицей
Т (5) = Т (а)Тт (а*)ТТ (Да). (19)
Требуемая ориентация механизма соответствует нулевому значению 5 или, соответственно, тождеству Т (5) = I.
Таким образом, задача траекторного управления автономным роботом заключается в определении (в замкнутой форме) входов f и ц, которые обеспечивают:
(а) стабилизацию движения робота относительно кривой S, что подразумевает обнуление вектора пространственных отклонений е;
(б) поддержание требуемого режима продольного движения механизма s = s * (t), часто задаваемого с помощью простейшей эталонной модели
s * = V* = const, (20)
или обнуления скоростной ошибки
ДVs = V* - s . (21)
3. Синтез алгоритма управления
Для построения системы управления траекторным движением прежде всего получим необходимые скоростные соотношения. Продифференцировав уравнения (9), (17) и (18) по времени и принимая во внимание (1), (14) и (15), найдём, что для достаточно малых отклонений е выполняется s
е
= т (а)У,
(22)
5 + = и . (23)
Теперь требуемая задачно-ориентированная модель пространственного движения системы может быть получена дифференцированием уравнений (22) и (23) по времени. После необходимых подстановок при малых е и 5 получаем
s s
+ £&ЕТ
е е
1 т
= — Тт (5 + Да)( F + Fc) m
1
5 + + £, 5 = J (|Д + |Д с ).
Учитывая выражения (5)-(6), последние уравнения можно переписать в виде
(24)
(25)
+ (— Тт (5 + Да)K Т(5 + Да) + £sET) m
1 Т
= — Т (5 +Да) m
5 + £s-+^ 5 + (^ £ + £) s = - ц.
J yj J J
(26) (27)
Уравнения (26)-(27) полностью описывают поступательное движение механизма и его вращение относительно кривой S. Эти выражения используются для построения алгоритмов управления.
Перепишем уравнение (26) в виде скалярных выражений
s-gé s + — (k1 cos2(5 + Aa) + k2 sin2(5 + Aa)) s + m
+ —(k1 - k2) sin(5 + Aa) cos(5 + Aa) é = — f cos(5 + Aa), (28)
2m m
k - k
é + gs2 + —-Lsin(2(5 + A a) s +
2m
1 2 2 1
+—(k1 sin2 (5 + Aa) + k2 cos2(5 + Aa)) é = — f sin(5 + Aa). (29)
m m
При малых é,5 выражение (28) принимает вид
ms + k2 sin2(Aa)s = f cos(Aa) (30)
где Aa определяется выражением (16).
Зададим требуемый режим движения вдоль кривой S с помощью эталонной модели (20). Тогда алгоритм управления продольным движением находится как
f = ks(V*) AVS + mgV*2 sin(Aa). (31)
Соответствующий выбор коэффициента ks>0 гарантирует асимптотическое устранение скоростной ошибки AVs = V* - s и требуемое качество системы по переменной Vs = s .
Полагая s = Vs и учитывая малость é и 5, перепишем уравнения (29), (27) в виде mé + a(V*) é + V>(V;) 5 = fe (g, V*), (32)
J5 + k3 5 = ц-ц5 , (33)
где a(Vs*) = k1 sin2(5 + Aa) + k2 cos2(5 + Aa), b(V*) = (k1 - k2)cos(2Aa) -mgV* sin(2Aa),
fe = -gVs*2 cosAa--1-V^ -k2)sin(2Aa), Ц5 = + J=)V;. 2m
Алгоритм управления поперечным движением выбирается как
^ = 1^5 + V*(ké1é + ké2é) + k515 + k525 , (34)
s
где kél, ké2, k5j и k52 - коэффициенты обратных связей, которые назначаются из
условия получения требуемой асимптотической устойчивости моделей (32)-(33) и желаемых качественных показателей системы по é, что обеспечивает асимптотическое выполнение соотношения (8).
Таким образом, алгоритм управления траекторным движением автономного робота представлен локальными регуляторами (31) и (34). Его реализация предусматривает использование измерений относительного положения и ориентации системы (отклонений é, 5, и AVs).
4. Пример
Рассмотрим задачи управления движением автономного робота по прямолинейной трассе.
Для нормализованного представления прямой запишем
Ф(У, У 2) = - sin a * y + cos a * y 2, , y2) = cos a * y + sin a * y2 и, следовательно
ф(y) « T(a *) =
* . *
cos a sin a
**
- sin a cos a
Здесь а * = 0, £ = 0 и Да = 0.
Результаты моделирования системы управления автономным роботом в режиме прямолинейного движения представлены на рис. 2. Здесь: а*=п/4, У*=2, а коэффициенты обратной связи выбраны так: к'=-0.5, ке1 =-0.3, ке2 =-2, к51 =-3,
к52 = -15 . Траектории движения из различных начальных положений робота и графики переходных процессов е^) и V,, (^), соответствующие начальному положению у1=5; у2=16, демонстрируют устойчивость системы и хорошие качественные показатели траекторного движения робота.
40
35 30 25 1 20 15 10 5 0
о
10
£ : 1___ ___ __
20
30
40
У,
2.5 2 1.5 1
0.5
О
-0.5 -1
7\vs(t)
j
e(t)
10
20
Рис. 2. Движение по прямолинейной трассе
Работа выполнена при поддержке Российского фонда фундаментальных исследований (Грант 99-01-00761) и Комплексной программы 19 Президиума РАН (2001, раздел 1.4).
Литература
1. Мирошник И.В., Фрадков А.Л., Никифоров В.О. Нелинейное и адаптивное управление сложными динамическими системами. СПб.: Наука, 2000.
2. Корн Г., Корн Т. Справочник по математике для научных работников и инженеров. М.: Наука, 1984.
3. Бурдаков С.Ф., Мирошник И.В., Стельмаков Р.Э. Системы управления движением колёсных роботов. СПб: Наука, 2001. 232 с.
4. Canudas de Wit, C., B. Siciliano and G.Bastin (1996). Theory of robot control. SpringerVerlag, London.
5. Miroshnik, I.V. and V.O. Nikiforov (1996). Trajectory motion control and coordination of multilink robots. // Prepr. 13th IFAC World Congress. San-Francisco. Vol.A. PP.361366.
6. Murray, R.M., I.L.Zexiang and S.S. Sastry (1993) A Mathematical Introduction to Robotic Manipulation. Boca Raton: CRS Press.
7. Dixon, W., D.M.Dawson, E.Zargeloglu, A.Behal. (2001) Nonlinear control of wheled mobile robot. Springer-Verlag, London.
8. Isidori, A. (1995) Nonlinear control systems. 3nd edition. Springer-Verlag, Berlin.
