Например, Бобцов

ЗАДАЧА УПРАВЛЕНИЯ МНОГОКАНАЛЬНОЙ ДИНАМИЧЕСКОЙ СИСТЕМОЙ ПО КУСОЧНО-ГЛАДКОЙ ТРАЕКТОРИИ

УДК 62.50
Ю. А. КАПИТАНЮК, С. А. ЧЕПИНСКИЙ
ЗАДАЧА УПРАВЛЕНИЯ МНОГОКАНАЛЬНОЙ ДИНАМИЧЕСКОЙ СИСТЕМОЙ
ПО КУСОЧНО-ГЛАДКОЙ ТРАЕКТОРИИ*
Решается задача управления движением многоканальной динамической системы вдоль заданной кусочно-гладкой траектории, представленной совокупностью прямолинейных и круговых участков. Синтез закона управления осуществляется с помощью дифференциально-геометрического метода. Основные результаты представлены задачно-ориентированной моделью пространственного движения и соответствующими нелинейными алгоритмами управления. Ключевые слова: многоканальный объект, движение по траектории, метод преобразования координат, синтез алгоритма управления.
Введение. В настоящей работе рассматривается задача перемещения мобильного робота в рабочем пространстве по предписанной траектории, заданной реперными точками. Особую актуальность данная задача приобрела в связи с бурным развитием беспилотных устройств, для которых движение вдоль заданной траектории является одним из основных режимов работы.
Существует два основных подхода к построению такого рода систем [1, 2]: 1) разработка следящей системы, управляемой некоторой эталонной моделью [3, 4]. Как правило, в такой системе траектория параметризуется некоторой функцией времени. Это приводит к отставанию или опережению движения объекта, вызванному параметрическими неопределенностями или внешним возмущениями, от заданной программы; 2) стабилизация инвариантных многообразий в пространстве состояний [2], т.е. для исходной системы выбирается преобразование, образующее в пространстве состояния некоторый аттрактор. Для траекторных задач в качестве аттрактора выбирается желаемая траектория, заданная в терминах выходных координат. Стабилизация данного решения — гораздо менее трудоемкая задача, чем построение следящей системы в рамках первого подхода [1]. Как объект управления автономный робот является многоканальной нелинейной динамической системой. Задача системы управления подвижного робота заключается в создании
* Статья написана при поддержке гранта Президента Российской Федерации МК-5488.2012.8.
ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4

66 Ю. А. Капитанюк, С. А. Чепинский

управляющих воздействий, обеспечивающих заданное перемещение центра масс в рабочем

пространстве.

В работе используется нелинейное преобразование модели робота к системе задачно-

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

управления. Полученные в работе результаты развивают известные решения задач управле-

ния пространственным движением, предложенные в [5, 7—9].

С использованием дифференциально-геометрических методов нелинейной теории управления [1, 5, 10] синтезированы алгоритмы, обеспечивающие решение задачи стабилиза-

ции движения по типовым участкам траекторий, таких как прямая и окружность.

Модель движения подвижного робота и постановка задачи управления. Положение

корпуса робота характеризуется вектором декартовых координат у = ( у1, у2 ) и углом поворо-
та α связанной с центром масс C робота системы координат относительно системы координат Y20Y1 [2].
С углом α связана ортогональная матрица (матрица вращения):

T (α)

=

τ1T τT2

(α) (α)

=

cos α − sin α

sin α cos α

,

T (0) = I .

Кинематическая модель движения робота может быть представлена в виде:

y = T T (α)υ, υ = Byuy , T(α) = ωET (α), ω = Bαuα ,

где υ и ω — линейная и угловая скорости движения, uy и uα — управляющие воздействия,

By

и



— обратимые матрицы,

E

=

0 −1

1 0

.

Траектория робота представляет собой отрезок кривой S (рис. 1), неявное описание ко-

торого имеет вид

ϕ( y) = 0,

(1)

а значение соответствующей локальной координаты s определяется выражением

s = ψ( y).

(2)

Y2 τ2(α)

τ1(α)

S

C

y τ2(α*) α

τ1(α*)

α* e y*

s

0
0 Y1 Рис. 1
Предполагается, что функции ϕ и ψ выбраны таким образом, что при y ∈ S матрица Якоби

ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4

Задача управления многоканальной динамической системой по кусочно-гладкой траектории 67

M (y) =

∂ψ / ∂y ∂ϕ / ∂y

ортогональна.

Матрица M ( y) определяет связанный с траекторией подвижный базис Френе, который

для y ∈ S удовлетворяет уравнению T *(α*) = sξ(s)ET *(α*),

(3)

где ξ(s) — кривизна траектории, α * — угол наклона касательной к кривой S. Матричное

уравнение (3) может быть записано в простой форме: α * = sξ(s).

Значение α определим как α = α * +∆α или, в матричном виде, T (α) = T (∆α)T (α*), где

∆α — желаемое угловое положение относительно траектории движения. Задача управления траекторным движением автономного робота ставится как задача

поддержания голономных соотношений между выходами системы yi (1). Она дополняется
описанием желаемого режима продольного (вдоль траектории) движения. Рассмотрим ошибки траекторного движения [8, 10]. Положение робота (1) характеризу-

ется ортогональным отклонением e = ϕ( y) , на множестве S е=0. Рассогласование текущего

углового положения от заданного определяется угловой ошибкой δ = α − α * +∆α или, в мат-

ричном виде, T (δ) = T (αx )T T (∆α)T T (α*). Таким образом, задача управления движения мобильного робота заключается в опреде-

лении (в замкнутой форме) входных сигналов uy и uα , которые обеспечивают:

— стабилизацию движения робота относительно кривой S при е=0;

— стабилизацию заданной угловой ориентации робота относительно кривой S при δ=0; — поддержание требуемого режима продольного движения мобильного робота, зада-

ваемого с помощью эталонной модели Vs* = const , где Vs* — скорость движения вдоль траектории.

Синтез алгоритмов управления движением. Приведем алгоритм синтеза управления

траекторным движением при использовании предложенного метода.

1) Переход от декартовых координат к задачно-ориентированной модели, выраженной с

помощью траекторных координат; введение в рассмотрение новых задачно-ориентированных

входных переменных ( e , s , σ ) и преобразование управления;

s e

= T (α*x )T T

(α)υ,

(4)

δ = −sξ(s) + ω.

(5)

2) Введение локальных законов управления

us ue

= TT

(∆α) υ,

(6)

uδ = −sξ(s) + ω , или в упрощенном виде:
s = us , e = ue , δ = uδ. 3) Синтез локальных регуляторов:

(7)

us = VS∗, ue = −Kee, uδ = −Kδδ, коэффициенты Ke, Kδ выбираются в соответствии с желаемой динамикой.
4) Окончательный синтез регулятора, решающего указанную траекторную задачу:

ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4

68 Ю. А. Капитанюк, С. А. Чепинский

υ

=

T

( ∆α )

us ue

,

ω

=



+ ξ(s)s

=



+ ξ(s)us

.

Синтез алгоритмов управления для типовых траекторий. Рассмотрим конкретные

реализации для типовых траекторий (рис. 2).

а) б)

Y2 e

Y2 S

s

S

s y02
0

e 0

0 Y1 0 y01 Y1
Рис. 2
Пусть траектория движения робота представлена отрезком прямой. Нормализованное описание прямой дается с помощь уравнений
ϕ( y) = − sin α∗ y1 + cos α∗ y2 = 0, s( y) = cos α∗ y1 + sin α∗ y2 . Ортогональная матрица Якоби принимает вид
M ( y) = T (α∗) = cos α∗ sin α∗ ∈ SO(2) . − sin α∗ cos α∗
Очевидно, что в этом случае ξ=0. Результат моделирования движения робота вдоль прямой линии представлен на рис. 3, а.
а) б)
Y2 Y2
S
88

66

44

2S 0

2 0

–2 –2

–2 0 2

468

Y1

–2 0 2

468

Y1

Рис. 3
Теперь рассмотрим случай, когда участок траектории представлен дугой окружности

радиуса R с центром в точке y0 = ( y01, y02 ) . Запишем уравнение окружности в виде

( )ϕ(y)

=

1 2R

R2 − ∆y12 − ∆y22

= 0,

где ∆y1 = y1 − y01, ∆y2 = y2 − y02 . Длина пути определяется как

ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4

Задача управления многоканальной динамической системой по кусочно-гладкой траектории 69

S ( y)

=

R arctg

∆y2 ∆y1

.

Ортогональная матрица Якоби принимает вид

M

( y)

=

1 R

−∆y2 −∆y1

∆y1 −∆y2

∈ SO(2)

,

ξ(s)

=

1 R

.

Результат моделирования движения робота вдоль окружности представлен на рис. 3, б.

Управление вдоль кусочно-гладкой траектории. Управление для движения вдоль

сложной, составной траектории реализуется в виде гибридного регулятора, включающего в

себя алгоритм движения вдоль прямой, алгоритм движения, вдоль окружности и алгоритм

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

параметризовать заданную траекторию, чтобы улучшить качество работы системы.

На рис. 4 представлен результат моделирования движения вдоль составной траектории.

В качестве исходных данных для задания траектории использовались реперные точки, кото-

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

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

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

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

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

из области перехода оказаться как можно ближе к следующему прямолинейному участку. Та-

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

тему управления движением мобильных роботов вдоль траектории.

Y2

10

8

6

4 2

0

–2

–2 0 2 4 6

8 10 Y1

Рис. 4

Заключение. Разработанные структура и алгоритмы системы управления подвижными

объектами (автономными роботами) могут быть полезны для разработчиков систем управле-

ния мобильными аппаратами (колесными, подводными, летательными). Дальнейшим разви-

тием полученных результатов является переход к более сложным и достоверным динамиче-

ским моделям роботов, расширение класса базовых кривых, используемых при параметриза-

ции сложных траекторий, а также расширение данного метода на случай трехмерного про-

странства.

ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4

70 Ю. А. Капитанюк, С. А. Чепинский

СПИСОК ЛИТЕРАТУРЫ

1. Aguiar A. P., Hespanha J. P., Kokotovic P. V. Path-following for nonminimum phase systems removes performance limitations // IEEE Transactions on Automatic Control. 2005. Vol. 50. P. 234—239.

2. Nielsen C., Fulford C., Maggiore M. Path following using transverse feedback linearization: Application to a maglev positioning system // American Control Conf. ACC '09. 2009. P. 3045—3050.

3. Breivik M., Fossen T. I. Principles of Guidance-Based Path Following in 2D and 3D // Proc. of the IEEE Conf. on Decision and Control. 2005. P. 627—634.

4. Lee T., Leok M., McClamroch N. H. Geometric tracking control of a quadrotor UAV on SE(3) // Proc. of the IEEE Conf. on Decision and Control. 2010. P. 5420—5425.

5. Бурдаков С. Ф., Мирошник И. В., Стельмаков Р. Э. Системы управления движением колесных роботов. СПб: Наука, 2001. 232 с.

6. Мирошник И. В. Согласованное управление многоканальными системами. Л.: Энергоатомиздат, 1990. 128 с.

7. Мирошник И. В., Фрадков А. Л., Никифоров В. О. Нелинейное и адаптивное управление сложными динамическими системами. СПб: Наука, 2000. 549 с.

8. Мирошник И. В., Чепинский С. А. Управление многозвенными кинематическими механизмами // Науч.-техн. вестн. СПбГУ ИТМО. 2002. № 3. С. 144—149.

9. Мирошник И. В., Чепинский С. А. Траекторное управление кинематическими механизмами нетривиальной конструкции // Науч.-техн. вестн. СПбГУ ИТМО. 2004. № 14. C. 5—10.

10. Бушуев А. Б., Исаева Е. Г., Морозов С. Н., Чепинский С. А. Управление траекторным движением многоканальных динамических систем // Изв. вузов. Приборостроение, 2009. Т. 52, № 11. С. 50—56.

Юрий Андреевич Капитанюк Сергей Алексеевич Чепинский

Сведения об авторах — аспирант; Санкт-Петербургский национальный исследовательский
университет информационных технологий, механики и оптики, кафедра систем управления и информатики; E-mail: yura.kapitanyuk@gmail.com — канд. техн. наук, доцент; Санкт-Петербургский национальный исследовательский университет информационных технологий, механики и оптики, кафедра систем управления и информатики; старший научный сотрудник; E-mail: Chepinsky_S@hotmail.com

Рекомендована кафедрой систем управления и информатики

Поступила в редакцию 13.12.12 г.

ИЗВ. ВУЗОВ. ПРИБОРОСТРОЕНИЕ. 2013. Т. 56, № 4