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

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

УПРАВЛЕНИЕ И ОБРАБОТКА ИНФОРМАЦИИ В РОБОТОТЕХНИЧЕСКИХ СИСТЕМАХ

УДК 681.5.03

А. А. ПЫРКИН, Т. А. МАЛЬЦЕВА, Д. В. ЛАБАДИН, М. О. СУРОВ, А. А. БОБЦОВ
СИНТЕЗ СИСТЕМЫ УПРАВЛЕНИЯ КВАДРОКОПТЕРОМ С ИСПОЛЬЗОВАНИЕМ УПРОЩЕННОЙ МАТЕМАТИЧЕСКОЙ МОДЕЛИ*

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

Введение. В статье представлен алгоритм синтеза системы управления мультироторного летательного аппарата на примере квадрокоптера — вертолета с четырьмя симметрично расположеными роторами. Он управляется путем изменения скорости вращения роторов и, таким образом, изменения подъемной силы. Квадрокоптер является самым маневренным вертикально взлетающим летательным аппаратом [1] и относится к классу автономных роботов, движение которых происходит без контакта с опорной поверхностью. Как объект управления квадрокоптер является многоканальной существенно нелинейной динамической системой [2].
Постановка задачи. Рассматривается задача синтеза алгоритма управления летательным аппаратом типа „квадрокоптер“ в режиме слежения. Заданы три линейные координаты и угол рысканья. Необходимо разработать алгоритм синтеза законов управления многоканальной робототехнической системой, обеспечивающий стабилизацию квадрокоптера в заданной точке пространства с заданной ориентацией.
Положение летательного аппарата относительно неподвижной системы координат может быть задано вектором смещения с компонентами (x, y, z) и углами Эйлера (θ,ψ,ϕ) ,
представляющими собой тангаж, крен и рыскание [3—5]. Поворот тела вокруг декартовых осей координат в трехмерном пространстве может быть представлен в виде ZYX-преобразования:

⎛ cos ϕ cos θ

R

=

⎜ ⎝⎜⎜

sin ϕ cos −sin ϕ

θ

cos ϕ sin θ sin ψ − sin ϕ cos ψ sin ϕ sin θ sin ψ + cos ϕ cos ψ
cos θ sin ψ

cos ϕ sin θ cos ψ + sin ϕ sin ψ ⎞

sin

ϕ

sin

θ cos cos θ

ψ− cos

cos ψ

ϕ

sin

ψ

⎟ ⎠⎟⎟

.

(1)

Трехмерная схема квадрокоптера (x0, y0, z0) представлена на рис. 1, где Fi — z -

* Работа выполнена при поддержке федеральной целевой программы „Научные и научно-педагогические кадры инновационной России“ на 2009—2013 гг. (соглашение 14.B37.21.0406).

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

48 А. А. Пыркин, Т. А. Мальцева, Д. В. Лабадин, М. О. Суров, А. А. Бобцов

компонент вектора подъемной силы i -го ротора (остальные компоненты, согласно выбран-

ным модельным приближениям, равны нулю), Ti — скорость вращения роторов. Полагаем, что 1-й и 3-й роторы вращаются в направлении по часовой стрелки, 2-й и 4-й — против. Вве-

дем следующие обозначения физических параметров квадракоптера: m — масса; J1, J2, J3 — главные моменты инерции. Предполагаем, что все роторы вращаются в одной плоскости, оси

вращения перпендикулярны плоскости xb0, yb0 и пересекают её в точках (l, −l, 0) , (l,l, 0) , (−l, l, 0) , (−l, −l, 0) . Воспользуемся упрощенной динамической моделью движения квадро-

коптера [4]:

xm = (∑ Fi ) (cos ϕ sin θ cos ψ + sin ϕ sin ψ) ,

ym = (∑ Fi ) (sin ϕ sin θ cos ψ − cos ϕ sin ψ) ,

(2)

( )∑zm = Fi (cos θ cos ψ) − mg , θ J1 = l (−F1 − F2 + F3 + F4 ) ,

(3)

ψ J2 = l (−F1 + F2 + F3 − F4 ) , ϕ J3 = C (F1 − F2 + F3 − F4 ) .
F2

(4)

T2

F3 zb0
T3 yb0 xb0
10 F4 T4

F1 T1
z yx

mg 0

Рис. 1

Значение линейного коэффициента может быть получено экспериментально [5].

Упрощение модели. Рассмотрим методику декомпозиции сложной динамической

модели на независимые линейные модели и статические нелинейные соотношения. Такое

разложение системы на независимые составляющие крайне необходимо на этапе синтеза ре-

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

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

системы.

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

ные комбинации Fi :

U1 = F1 + F2 + F3 + F4 , U2 = −F1 − F2 + F3 + F4 ,

(5)

U3 = −F1 + F2 + F3 − F4 , U4 = F1 − F2 + F3 − F4 .

(6)

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

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

ной системы уравнений (5), (6).

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

Синтез системы управления квадрокоптером

49

Подставив уравнения (5), (6) в систему (2)—(4), получим первую упрощенную модель:

m x = U1 (cos ϕ sin θ cos ψ + sin ϕ sin ψ) , m y = U1 (sin ϕ sin θ cos ψ − cos ϕ sin ψ) , mz = U1 (cos ϕcos ψ) − m g , θ J1 = l U2 , ψ J2 = lU3 , ϕ J3 = CU4 .

(7) (8)

Рассмотрим отдельно уравнения (7), переписав их в матричном виде:

⎡m ⎢⎣m

x⎤ y⎥⎦

=

⎡cos ϕ ⎢⎣sin ϕ

sin ϕ ⎤ − cos ϕ⎥⎦

⎡U1 sin θ cos ψ⎤

⎢ ⎣

U1 sin ψ

⎥ ⎦

.

(9)

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

управлений:

U5 = U1 sin θ cos ψ , U6 = U1 sin ψ .

(10)

Перепишем (8) следующим образом:

⎡mx⎤ ⎢⎣my⎥⎦

=

⎡cos ⎢⎣ sin

ϕ ϕ

sin ϕ ⎤ − cos ϕ⎦⎥

⎡U5 ⎢⎣U6

⎤ ⎥ ⎦

.

(11)

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

y x
y*

ϕ y y
y(t) 0 x

0 x(t)

x* x

Рис. 2
Введем в рассмотрение координаты перемещения в продольном x и поперечном y на-

правлениях. В самом деле, переход в заданную точку квадрокоптер можно представить в виде

не зависящих друг от друга перемещений вдоль координат x и y . Запишем уравнения связи

координат:

⎡ ⎢ ⎣

x y

⎤ ⎥ ⎦

=

⎡cos ϕ

⎢ ⎣

sin

ϕ

sin ϕ ⎤ − cos ϕ⎥⎦

⎡x⎤

⎢ ⎣

y

⎥ ⎦

=

T (ϕ)

⎡x⎤

⎢ ⎣

y

⎥ ⎦

.

(12)

В уравнении (12) матрица H (ϕ) является кососимметрической и обладает известным

свойством: H (ϕ)−1 = H (ϕ) , отсюда

⎡ ⎣⎢

x y

⎤ ⎥⎦

=

⎡cos ϕ ⎣⎢sin ϕ

sin ϕ ⎤ − cos ϕ⎥⎦

⎡ ⎢⎣

x⎤ y ⎥⎦

.

Модель перемещения в координатах x и y получим из (12) и (13):

(13)

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

50 А. А. Пыркин, Т. А. Мальцева, Д. В. Лабадин, М. О. Суров, А. А. Бобцов

⎡m ⎢⎣m

x y

⎤ ⎥ ⎦

=

⎡U5 ⎣⎢U6

⎤ ⎥ ⎦

.

(14)

Основная цель квадрокоптера — перемещение в пространстве из точки с координатами

( x1, y1, z1 , ϕ1 ) в точку ( x2 , y2 , z2 , ϕ2 ). Понятно, что изменение крена или тангажа — это

вспомогательный процесс для перемещения в координатах x и y . Изменение этих величин

должно быть разрешено в очень малом диапазоне, например [−π / 6; π / 6]. В этом случае мо-

жно воспользоваться приближенными уравнениями: sin α ≈ α, cos α ≈ 1 , если α ≤ π / 6 . Да-

лее имеем:

m z = U1 − mg , U5 = U1 θ , U6 = U1 ψ .

(15)

Теперь представим алгоритм синтеза регулятора квадрокоптером в задаче стабилизации

заданной точки в пространстве.

Алгоритм синтеза системы управления

1. Измерить текущие координаты квадрокоптера: x , y , z , ϕ , θ , ψ .

2. Получить координаты заданной точки: x *, y *, z * , ϕ*.

3. По рассогласованию z = z − z * синтезировать закон управления U1 на основе первого
уравнения (15). Например, ПД-регулятор или последовательный компенсатор [6—8]. В обоих случаях следует ввести интегральную составляющую для парирования постоянных ветровых

возмущений. 4. По рассогласованию ϕ = ϕ − ϕ* синтезировать закон управления U4 на основе чет-
вертого уравнения (8). 5. По рассогласованию x и y рассчитать координаты перемещений в системе коорди-

нат квадрокоптера x и y с использованием уравнения (13). Заметим, что для угла рысканья

ϕ получено заданное значение благодаря более быстрому регулятору U4 . 6. По рассогласованию x и y синтезировать законы управления U5 и U6 соответст-
венно с помощью модели (14).

7. На основе рассчитанных значений U1 , U5 и U6 определить желаемые значения тангажа θ* и крена ψ * на основе второго и третьего уравнений (15).

8. По рассогласованию θ и ψ синтезировать законы управления U2 и U3 с использованием второго и третьего уравнений (8).

9. По рассчитанным значениям U1 , U2 , U3 , U4 вычислить значения реальных управ-

ляющих воздействий F1, F2 , F3 , F4 с использованием системы линейных уравнений (5), (6).
Заключение. В статье предложен новый алгоритм синтеза системы управления многороторным летательным аппаратом на примере квадрокоптера. Достоинством представленного алгоритма является обеспечение желаемого перемещения с более простой структурой реализации.

СПИСОК ЛИТЕРАТУРЫ
1. Андриевский Б. Р. Теоретические основы автоматизированного управления. Конспект леций. СПб: БГТУ „Военмех“, 2008.
2. Мирошник И. В., Шалаев А. Н. Управление траекторным движением автономных роботов // Науч.-техн. вестн. СПбГИТМО (ТУ). 2002. Вып. 6.
3. Bouabdallah S. Design and control of quadrotors with application to autonomous flying. PhD thesis. EPFL, 2007.
4. Altug E., Ostrowski J. P., Mahony R. Control of a Quadrotor Helicopter Using Visual Feedback // IEEE. Intern. Conf. on Robotics & Automation. Washington, 2002.

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

Синтез системы управления квадрокоптером

51

5. Siiric V. Control of Quadrocopter. Master of Science Thesis. Stockholm, Sweden, 2008.

6. Бобцов А. А., Николаев Н. А. Управление по выходу линейными системами с неучтенной паразитной динамикой // АиТ. 2009. № 6. С. 115—122.

7. Бобцов А. А., Фаронов М. В. Управление по выходу нелинейными системами с запаздыванием в условиях неучтенной динамики // Изв. РАН. Теория и системы управления. 2011. № 3. С. 79—87.

8. Bobtsov A. A., Pyrkin A. A., Faronov M. V. Output control for time-delay nonlinear system providing exponential stability // Proc. of 19th Mediterranean Conference on Control & Automation (MED). 2011. P. 515—520.

Антон Александрович Пыркин
Татьяна Алексеевна Мальцева Дмитрий Владимирович Лабадин Максим Олегович Суров Алексей Алексеевич Бобцов

Сведения об авторах — канд. техн. наук; Санкт-Петербургский национальный исследова-
тельский университет информационных технологий, механики и оптики, кафедра систем управления и информатики; доцент; E-mail: a.pyrkin@gmail.com — студентка; Санкт-Петербургский национальный исследовательский университет информационных технологий, механики и оптики, кафедра систем управления и информатики — студент; Санкт-Петербургский национальный исследовательский университет информационных технологи, механики и оптики, кафедра систем управления и информатики — аспирант; Санкт-Петербургский национальный исследовательский университет информационных технологий, механики и оптики, кафедра систем управления и информатики — д-р техн. наук, профессор; Санкт-Петербургский национальный исследовательский университет информационных технологий, механики и оптики, кафедра систем управления и информатики; заведующий кафедрой; декан факультета компьютерных технологий и управления; E-mail: bobtsov@mail.ifmo.ru

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

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

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