Научная статья на тему 'Управление плоским движением квадрокоптера'

Управление плоским движением квадрокоптера Текст научной статьи по специальности «Физика»

CC BY
1010
234
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
ПЛОСКОЕ ДВИЖЕНИЕ / УПРАВЛЕНИЕ / СТАБИЛИЗАЦИЯ / УПРАВЛЯЕМОСТЬ / КВАДРОКОПТЕР

Аннотация научной статьи по физике, автор научной работы — Канатников А.Н., Акопян К.Р.

В множестве современных летательных аппаратов квадрокоптер относится к беспилотным летательным аппаратам (БПЛА), относительно дешевым и простым для проектирования. Квадрокоптеры способны летать в плохую погоду, зависать в воздухе на достаточно длительное время, вести наблюдение за объектами и выполнять много других задач. Они нашли свое применение в спасательных операциях, в сельском хозяйстве, в военном деле и в многих других областях. Для квадрокоптеров актуальны задачи планирования маршрутов и управления. Эти задачи имеют много разных вариантов, в которых учитываются и ограниченные ресурсы современных БПЛА, и необходимость учета возможных препятствий, например, при организации полетов в пересеченной местности или в городской среде, и учет погодных условий (в частности, ветровой обстановки). Этим задачам посвящено много исследований, отраженных в целом ряде публикаций (отметим интересный обзор [1] по теме и ссылки в нем). Для синтеза управления этими аппаратами использовались самые разные подходы и методы: линейные аппроксимации [2], метод скользящих режимов [3], метод накрытий [4] и др. В данной статье квадрокоптер рассматривается как твердое тело. Анализируются кинематические и динамические уравнения движения. Выделяются два случая движения: в вертикальной и в горизонтальной плоскостях. Управление строится с помощью приведения управляемой аффинной системы к каноническому виду [5] и использования метода нелинейной стабилизации [6]. DOI: 10.7463/mathm.0215.0789477

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

Похожие темы научных работ по физике , автор научной работы — Канатников А.Н., Акопян К.Р.

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

Текст научной работы на тему «Управление плоским движением квадрокоптера»

Математика к Математическое

моделирование

Сетевое научное издание

Ссылка на статью:

// Математика и математическое моделирование. МГТУ им. Н.Э. Баумана. Электрон. журн. 2015. №2. С. 23-36.

Б01: 10.7463/шаШш.0215.0789477

Представлена в редакцию: 12.04.2015 © МГТУ им. Н.Э. Баумана

УДК 517.977

Управление плоским движением квадрокоптера

Канатников А. Н1, Акопян К. Р.1'* Vathmod@bmstu.ru

1МГТУ им. Н.Э. Баумана, Москва, Россия

Исследуется движение квадрокоптера. Летательный аппарат квадрокоптер рассматривается как твердое тело. Для него построена математическая модель движения и определены упрощенные модели движения в горизонтальной и вертикальной плоскости. Модели движения квадрокоптера в вертикальной и горизонтальной плоскостях исследованы на управляемость. Методом линеаризации обратной связью построено соответствующее программное управление для модели движения в горизонтальной плоскости. Методом нелинейной стабилизации разработано стабилизирующее управление для стабилизации программной траектории, построенной в горизонтальной плоскости.

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

Введение

Квадрокоптер — летательный аппарат с четырьмя несущими винтами (рис. 1). Две пары винтов имеют противоположные направления вращения, что позволяет в штатном режиме гасить динамические моменты, создаваемые винтами.

В множестве современных летательных аппаратов квадрокоптер относится к беспилотным летательным аппаратам (БПЛА), относительно дешевым и простым для проектирова-

Рис. 1. Квадрокоптер

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

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

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

Статья организована следующим образом. В разделе 1 проанализированы кинематическая и динамическая модель движения твердого тела, на основе которых моделируется движение квадрокоптера, в разделе 2 получена математическая модель движения квадрокоптера, в разделе 3 и 4 получены математические модели движения квадрокоптера в вертикальной и горизонтальной плоскостях. В разделе 5 исследована управляемость моделей. В разделе 6 построено программное управление. В разделе 7 построено стабилизирующее управление.

1. Движение твердого тела

Состояние твердого тела в пространстве можно определить, описав положение системы координат, связанной с квадрокоптером (подвижной системы координат), относительно системы координат, связанной с Землей (неподвижной системы координат.

Пусть Охуг — неподвижная система координат (ось г направлена по местной вертикали), О'х'у'г' — подвижная система координат. Рассмотрим также промежуточную систему координат О'хуг, центр которой совмещен с центром подвижной системы координат (центром масс твердого тела), а оси направлены по осям неподвижной системы координат. Переход от промежуточной системы координат к подвижной можно выполнить путем трех поворотов (рис. 2):

- вокруг оси г на угол ф против часовой стрелки (ф — угол рыскания);

- вокруг нового положения у\ оси у на угол $ по часовой стрелке ($ — угол тангажа);

- вокруг нового положения XI оси х на угол 7 против часовой стрелки (7 — угол крена).

Рис. 2. Преобразование неподвижной системы координат в подвижную

Углы <ф, ё, 7 называют углами Крылова. Кинематические уравнения в углах Крылова выглядят следующим образом [7]:

ё =

0

БШ 7

соб 7

\

СОБ $ СОБ $

0 — ео8 7 8ш 7

У 1 — вт 7 tg ё — ео8 7 tg ё у

и.

(1)

Уравнения динамики вращения твердого тела в углах Крылова имеют следующий вид [7]:

Iш + ш х 1и = М, (2)

где I — матрица инерции; ш — вектор угловой скорости; М — суммарный момент сил. Все данные записаны в подвижной системе координат. Вид матрицы инерции зависит от того, как направлены оси подвижной системы координат. Наиболее просто эта матрица записывается, если оси подвижной системы координат направлены по главным осям инерции. В этом случае

11Х 0 0 ^

I =

0 1у 0

0 0 I,

Уравнение (2) является векторным. Из них легко получить уравнения динамики в координатной записи:

и х =

^у =

и я =

Мх иу и, (I, — 1у )

IX IX

Му и, их ^х — I,)

^ IУ

М, их иу (1у — !х)

I,

I,

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

¥

г = д + —, т

где д — вектор ускорения свободного падения; ¥ — сумма все сил, действующих на твердое тело за вычетом силы тяжести; т — масса твердого тела. Выделение силы тяжести в

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

В подвижной системе координат уравнения движения центра масс можно записать следующим образом:

Гь

F

-Rgkz +---,

m

где гь и ^ь — радиус-вектор центра масс и вектор сил, записанные в подвижной системе координат, К — матрица перехода из промежуточной системы координат в подвижную, а к — базисный орт неподвижной системы координат, направленный вдоль оси О г. В углах Крылова матрица перехода имеет следующий вид:

R

^ сф c) вф cy сф S) sy вф c) сф cy вф S) sy

У S) С) Sj

вф sy 0ф s) 0y 0ф sy вф S) OY

o) oy

где Оф, c), cY — косинусы соответствующих углов, а вф, s), sy — синусы этих углов. Запишем уравнения движения центра масс в координатной форме:

F

X = —(— cos y cos ф sin $ + sin y sin ф); m

F

y = —(— cos ф sin y — cos y sin ф sin $); m

F

i = —g +--cos y cos $.

m

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

F

X = —(— cos y cos ф sin $ + sin y sin ф); m

F

У = —(— cos ф sin y — cos y sin ф sin $); m

F

i = —g +--cos y cos $;

m

ф

sin y

Uy +

cos y

a""V 1 o Uz;

cos V cos V $ = — uy cos y + uz sin y ;

Y = ux — иy sin y tg $ — uz cos y tg $;

(3)

Mx

Ux =

U y

U z =

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

UyUz (Iz — ly)

Ix Ix

My Uz Ux(Ix — Iz )

Iy Iy

Mz UxUy (Iy - Ix)

I

z

z

2. Математическая модель квадрокоптера

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

Схематично квадрокоптер представлен на рис. 3. Подвижная система координат выбрана так, что оси х' и у' направлены на пары противоположных роторов, а ось г' перепендикулярна плоскости, в которой расположены роторы. Двигатели квадрокоптера формируют силы тяги /1, /2, /з, /4, направленные вдоль оси г' подвижной системы координат. Силы тяги винтов создают крутящие моменты М1, М2, М3, М4, направленные по осям х' и у', а сами винты — динамические моменты Ма1, Ма2, Маз, Ма4, направленные по оси г'.

Рис. 3. Схема квадрокоптера

Сила каждого ¿-го ротора и соответствующий динамический момент определяются скоростью и вращения ротора. Мы используем следующую модель [8]:

/ = кЧ2, М^ = ЬЧ2,

где к, Ь — коэффициенты пропорциональности, отражающие особенности роторов. Из этих соотношений вытекает, что динамические моменты роторов пропорциональны силам тяги: Ма,% = (Ь/к)/. Поэтому удобно взамен скоростей и в качестве управлений рассматривать силы / тяги роторов.

Суммарный крутящий момент М$ всех четырех роторов можно записать формулой

М$ = 1(/2 - /4Ж + 1(/з - /1 )к'у, (4)

где I — расстояние от центра масс до центра ротора; к'х и к'у — орты связанной системы координат, направленные по соответствующим осям. Динамические моменты роторов дают вектор М а, направленный вдоль оси О г' связанной системы координат, который с учетом направлений вращения роторов можно записать в виде

Ма = к (/1 - /2 + /з - /4Ж. (5)

Наконец, суммарная сила четырех роторов записывается в виде

F = (/ + / + /з + /4)*;. (6)

Таким образом, в общей модели (3) движения твердого тела в случае квадрокоптера имеем

F = /1 + /2 + /а + /4, Mx = (/2 - /4)/, My = (/3 - Л)/, Mz = b(/i - /2 + /3 - /4). (7)

Система (3) с выражениями (7) представляет собой аффинную систему с четырьмя управлениями /1, /2, /3, /4.

3. Движение квадрокоптера в вертикальной плоскости

В случае движения квадрокоптера в вертикальной плоскости выберем неподвижную систему координат так, что движение будет происходить в плосоксти Oxz, т.е. при таком движении имеем y = 0. Дополнительно будем считать, что выполняется условие ф = 0.

Учитывая условия y = 0 и ф = 0, из второго уравнения системы (3) заключаем, что Y = 0, а с помощью условия ф = 0 из четвертого уравнения находим, что uz = 0. Из шестого уравнения системы уже с учетом y = 0 и uz = 0 получаем ux = 0. Наконец, из 7-го и 9-го уравнений делаем вывод, что Mx = Mz = 0.

Перечисленные соотношения позволяют упростить базовую систему (3), сократив количество уравнений до четырех:

F

x =--sin

m

F

z = -g +--cos

m (8)

г? = -Uy;

My

U y = j . Jy

В упрощенную модель управления входят через переменные F и My согласно формулам (7). При этом условия Mx = Mz = 0 накладывают на управления следующие связи:

/2 - /4 = 0, /1 - /2 + /3 - /4 = 0.

Эти связи означают, что в системе (8) фактически двумерное управление. Для удобства выполним замену управлений, полагая

u1 = /2, u2 = /3 - /ъ

Тогда F = 4u1, My = u2. Отметим, что по значениям u1, u2 с учетом связей управления /1, /2, /3, /4 восстанавливаются однозначно.

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

4u1 sin $;

x = --

m

—g + 4u1

Z = -cos

m

г$ = —Uy;

lu¡2

ájy = ^y .

(9)

4. Движение квадрокоптера в горизонтальной плоскости

Движение квадрокоптера в горизонтальной плоскости означает, что координата z его положения в процессе движения не меняется, т.е. z = c = const. Дополнительно наложим ограничение на ориентацию квадрокоптера в виде $ = 0.

Из третьего уравнения системы (3) заключаем, что

F cos y = mg. (10)

Из пятого уравнения этой системы с учетом, что $ = 0, находим

uy cos y — ^z sin y = 0. (11)

Уравнение (11) связывает три фазовых переменных. Удобно левую часть уравнения рассмотреть как новую фазовую переменную. В связи с этим фазовые переменные ux, uz заменим новыми переменными /, v согласно формулам

/ \ I cos y — sin y \ I v J y sin y cos y )

С учетом преобразований и подстановок получим производные новых фазовых переменных в силу системы:

. My Mz . f Ix — Iz 2 Iy — Ix .2 , Л /i = —— cos y--sin y — I —j-cos y--;-sin y + 1 vwx;

Iy Iz Iy Iz

. My , Mz f Ix — Iz Iy — Ix \ vi= -y- sin y + -T- cos y ^-1---1-jv^x.

Iy Iz Iy Iz

Ограничение (11) после замены переменных примет вид / = 0. Из этого ограничения вытекает, что /i = 0, т.е.

My Mz Ix - Iz 2 Iy - Ix 2

Ix - Iz 2 Iy - Ix 2

--sin y — i —--cos y--j-sin y + 1 vwx = 0. (12)

Iy Iz

cos y--sin Y

Iy Iz Iy Iz

Уравнения (10) и (12) представляют собой ограничения на управления. Таким образом, в рассматриваемом случае управление двумерно. Выполним замену управлений:

Mx My Mz

Ui = —, U2 = —т~ sin Y + ~Y~ cos Y.

Ix Iy Iz

Получим следующую аффинную систему:

X = g tg y sin

y = -g tg Y cos 0 = v;

Y = Wx;

Iz - I

WWx = ui -

f = U2

jx

У 2

-v cos y sin y ;

jx ly j-x

+--;-) v wx sin y cos y.

Iy

Iz

5. Управляемость аффинных систем, описывающих движение квадрокоптера

Один из методов построения управления для аффинной системы — приведение ее к каноническому виду. Необходимым условием существования у аффинной системы регулярного канонического вида. В этом разделе мы проверим системы (9) и (13) на управляемость. Рассмотрим аффинную систему

Х = А(х) + В(х)и, (14)

т

где х Е П С Ега и и Е — векторы состояния и управления; А(х) = (а^х), ..., ап(х)) — гладкая векторная функция; В(х) = (В^х), ..., Вт(х)) = (ж)) — гладкая функциональная матрица. Этой системе соответствуют гладкие векторные поля

д

д

A = Е ai(xt' Bj = Z bij(x)7ÜT

j

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

1, m.

д'X i л_-| д'X i

Введем обозначения adA B = B, adA B = [A, adA-1 B], где [■, ■ ] — коммутатор векторных полей A и B.

Рассмотрим распределения

Uk = span (adA Bi, i = 1, m, j = 1, k), k = 0, 1, ...

Чтобы аффинная система (14) приводилась к каноническому виду, необходимо и достаточно, чтобы распределения Uk были инволютивны. Проверим эти условия для систем (9) и (13).

Движение в горизонтальной плоскости. Для аффинной системы (13)

A

х

g tg y sin —

—g tg y cos — v

Wx

2

—k1v2 cos y sin y y — k2vwx cos y sin y J

Bi

f°) 0

0 0

0 0

0 , B2 = 0

0 0

1 0

V0) 1

Kl

Iz_Iy

K2

ly

Iy

Iz

Ясно, что распределение U0 = span (B1, B2) инволютивно. Далее

adA B1

0 0 0 0 0 1 0

у —k2v cos y sin y

ad a B

0 0 0 0 1 0

—2k1v cos y sin y у — x2wx cos y sin y )

Непосредственный подсчет показывает, что распределение

U1 = span (B1, B2, adA B1, adA B1)

00 00 00 00 00 00 10

0 0 0 0 0 1 0

^0 1 —k2v cos y sin y

0 0 0 0 1 0

-k1v cos y sin y -x2wx cos y sin y J

является инволютивным. Аналогично можно убедиться в том, что распределение [/3, и4 также инволютивно. Из анализа этих распределений вытекает, что система (13) приводится к каноническому виду с индексами приводимости (4, 4).

Движение в вертикальной плоскости. Для аффинной системы (9) координаты дрейфа А и управляющих векторных полей В, В2 имеют вид

/

A

\

x 0

Z

—g 0

(

B1

0

— (4/m) sin $ 0

(4/m) cos $ 0 0

\

B2

0 0 0 0 0

\ 1/Ly )

Непосредственным вычислением убеждаемся, что U0 = span (B1, B2) инволютивно.

Вычислим первые коммутаторы:

adA B1

^ sin § ^

uy cos § — cos § Uy sin §

V

0 0

adA B2

/

0 0 0 0

1 0

Непосредственным вычислением убеждаемся, что распределение

U = span (Bb B2, adA Bb adA Bi)

инволютивным не является. Таким образом, система (9) не приводится к каноническому виду.

6. Синтез управления для горизонтального движения квадрокоптера

Метод построения программного или стабилизирующего управления для аффинных систем канонического вида известен [6]. Воспользуемся этим методом для построения управления движением квадрокоптера в горизонтальной плоскости.

Как показано выше, система (13) приводится к каноническому виду с индексами приводимости (4, 4). В качестве базисных функций канонического вида можно взять координатные функции x и y. Трехкратное дифференцирование этих функций в силу системы дает соотношения

sin ф

x = gv cosф tg y + gux —2—

y = gv sin ф tg y — gU

cos2 y cos ф

' 2 *

cos2 y

Продифференцировав эти выражения в силу системы еще раз, получим представление системы (13) в каноническом виде:

xIV = —gv 2 A sin ф + 2gvuxB cos ф + gu^C sin ф + gu1

sin ф cos2 y

+ gU2 cos ф tg y,

где

yIV = gv 2 A cos ф + 2gvux B sin ф — gu^C cos ф — gu1 A =(1 + Jx) tg y, B

cos ф

-2--+ gU2 sin ф tg Y.

cos2 y

(15)

1

Jy + J

cos2 y

2

z • 2

- sin y

C

2 sin y

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

cos3 y

В этом представлении переменные —, Y, V отражают исходные координаты как функции новых координат х, ж, X, X', у, //, у, 'у/'.

Представление (15) можно записать в векторной форме:

x

y

= P + Qu,

(16)

IV

/sin ф \

— v2 A sin ф + 2vwxB cos ф + C sin ф

P = g ( I, Q = g

v 2A cos ф + 2vwxB sin ф — w^C cos ф

cos2 y

cos ф tg y

cos ф

—^ sin ф tg y \ cos2 y /

T

Предположим, что задана пространственная траектория движения г* (t) = (x*(t), y*(t)) . Тогда в соотношении (16) в каждый момент времени t известны значения P* и Q* матриц P и Q, которые выражаются через значения функций x* и y* и их производных:

i x* ¡У*

sin ф* = .--, cos ф* = —

(x* )2 + (y*)2 V(x*)2 + (У*):

V(x*)2 + (У*)2 x* cos ф* + y'* sin ф* tg Y* = --, v*-

g g tg Y*

Ж* sinф* - y * cos ф* 2

=-cos y •

g

Также известны значения четвертых производных rIV и yIV. Это позволяет из уравнения (16) определить управление и*, которое оказывается программным:

u * — Q- (г * р*) •

Для построения стабилизирующего управления в виде обратной связи рассмотрим отклонение z — г — г * вектора состояния г от предписанной траектории г * (t). В каноническом виде известны значения вектора z и первых трех его производных по времени. Четвертая производная zIV определяется соотношением

zIV — tiv — г *V — P + Qu — г *V • (17)

Потребуем, чтобы вектор z удовлетворял линейному дифференциальному уравнению

zIV + Ki z + K2z + Ks;¿ + K4z — 0, (18)

у которого нулевое положение равновесия асимптотически устойчиво. Здесь K1, K2, K3, K4 — некоторые матрицы. Эти матрицы можно выбрать диагональными, и тогда векторное уравнение (18) на четыре скалярных не связанных друг с другом уравнения. Асимптотическую устойчивость нулевого положения равновесия можно обеспечить, если диагональные элементы матриц K1, K2, K3, K4 выбрать так, что соответствующие характеристические многочлены линейных дифференциальных уравнений будут иметь только действительные отрицательные корни, причем дополнительно предполагаем, что эти корни разные. Из уравнений (17) и (18) находим управление

Ust — Q-1(zIV + г *V — P) — Q"1^ — Kiz — K2z — K3z — K4z — P),

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

Заключение

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

Список литературы

1. Chovancová A., Fico T., Chovanec L., Hubinsky P. Mathematical Modelling and Parameter Identification of Quadrotor (a survey) //Procedia Engineering. 2014. Vol. 96. P. 172-181. DOI: 10.1016/j.proeng.2014.12.139

2. Rinaldi F., Chiesa S., Quagliotti F. Linear Quadratic Control for Quadrotors UAVs Dynamics and Formation Flight // Journal of Intelligent & Robotic Systems. 2013. Vol.70, no. 1-4. P. 203-220. DOI: 10.1007/s10846-012-9708-3

3. Bouadi H., Simoes Cunha S., Drouin A., Mora-Camino F. Adaptive sliding mode control for quadrotor attitude stabilization and altitude tracking // Proc. 12th IEEE international symposium on computational intelligence and informatics (CINTI2011). Budapest: Hungary, 2011. P. 449-455. DOI: 10.1109/CINTI.2011.6108547

4. Белинская Ю.С., Четвериков В.Н. Управление четырехвинтовым вертолетом // Наука и образование. МГТУ им. Н.Э. Баумана. Электрон. журн. 2012. №5. С. 157-171. DOI: 10.7463/0512.0397373

5. Крищенко А.П. Преобразование многомерных аффинных управляемых систем // Управляемые нелинейные системы. М.: ВНИИСИ. 1991. №2. С. 5-14.

6. Крищенко А.П. Стабилизация программных движений нелинейных систем // Изв. АН СССР. Сер. Техническая кибернетика. 1985. №6. С. 108-112.

7. Канатников А.Н. Моделирование вращения твердого тела // Нелинейная динамика и управление: Сб. статей. Вып. 7. Под ред. С.В. Емельянова, С.К. Коровина. М.: ФИЗМА-ТЛИТ, 2010. С. 335-348.

8. Tayebi A., McGilvray S. Attitude stabilization of a four-rotor aerial robot // Proc. 43rd IEEE Conf. on Decision and Control. 2004. Vol. 2. P. 1216-1221. DOI: 10.1109/CDC.2004.1430207

Mathematics i Mathematical Modelling

Electronic journal of the Bauman MSTU

Mathematics and Mathematical Modelling of the Bauman MSTU, 2015, no. 2, pp. 23-36.

DOI: 10.7463/mathm.0215.0789477

Received: 12.04.2015

© Bauman Moscow State Technical University

http://mathmjournal.ru

The plane motion control of the quadrocopter

Kanatnikov A. N. , Akopyan K. R.1' Vathmod@bmstu.ru

1 Bauman Moscow State Technical University, Russia

Keywords: plane motion, control, stabilization, controllability, quadrocopter

Among a large number of modem flying vehicles, the quadrocopter relates to unmanned aerial vehicles (UAV) which are relatively cheap and easy to design. Quadrocopters are able to fly in bad weather, hang in the air for quite a long time, observe the objects and perform many other tasks. They have been applied in rescue operations, in agriculture, in the military and many other fields.

For quadrocopters, the problems of path planning and control are relevant. These problems have many variants in which limited resources of modern UAV, possible obstacles, for instance, for flying in a cross-country terrain or in a city environment and weather conditions (particularly, wind conditions) are taken into account. Many research studies are concerned with these problems and reflected in series of publications (note the interesting survey [1] and references therein). Various methods were used for the control synthesis for these vehicles: linear approximations [2], sliding mode control [3], the covering method [4] and so on.

In the paper, a quadrocopter is considered as a rigid body. The kinematic and dynamic equations of the motion are analyzed. Two cases of motion are emphasized: a motion in a vertical plane and in a horizontal plane. The control is based on transferring of the affine system to the canonical form [5] and the nonlinear stabilization method [6].

References

1. Chovancova A., Fico T., Chovanec L., Hubinsky P. Mathematical Modelling and Parameter Identification of Quadrotor (a survey). Procedia Engineering, 2014, vol.96, pp. 172-181. DOI: 10.1016/j.proeng.2014.12.139

2. Rinaldi F., Chiesa S., Quagliotti F. Linear Quadratic Control for Quadrotors UAVs Dynamics and Formation Flight. Journal of Intelligent & Robotic Systems, 2013, vol. 70, no. 1-4, pp. 203220. DOI: 10.1007/s10846-012-9708-3

3. Bouadi H., Simoes Cunha S., Drouin A., Mora-Camino F. Adaptive sliding mode control for quadrotor attitude stabilization and altitude tracking. Proc. 12th IEEE international symposium on computational intelligence and informatics (CINTI2011), Budapest, Hungary, 2011, pp. 449-455. DOI: 10.1109/CINTI.2011.6108547

4. Belinskaya Yu.S., Chetverikov V.N. Control of four-propeller rotorcraft. Nauka i obrazovanie MGTUim. N.E. Baumana = Science and Education ofthe BaumanMSTU, 2012, no. 5, pp. 157171. DOI: 10.7463/0512.0397373 (in Russian).

5. Krishchenko A.P. Transformation of multidimensional affine control systems. Upravljaemye nelinejnye sistemy [Nonlinear control systems], VNIISI, Moscow, 1991, no. 2, pp. 5-14. (in Russian).

6. Krishchenko A.P. Stabilization of program motions of nonlinear-systems. Izvestiya AN SSSR Tekhnicheskaya kibernetika, 1985, no. 6, pp. 108-112. (English version of journal: Soviet Journal of Computer and Systems Sciences, 1986, vol. 24, no. 2, pp. 65-69).

7. Kanatnikov A.N. Modeling Control of Rigid Body Rotation. Nelineinaiadinamika i upravlenie: sb. st. Vyp. 7 [Nonlinear dynamics and control: collected articles. Iss. 7], Moscow, Phismatlit Publ., 2010, pp. 79-94. (English translation: Computational Mathematics andModeling, 2013, vol. 24, no. 3, pp. 404-417. DOI: 10.1007/s10598-013-9186-x).

8. Tayebi A., McGilvray S. Attitude stabilization of a four-rotor aerial robot. Proc. 43rd IEEE Conf. on Decision and Control, 2004, vol. 2, pp. 1216-1221. DOI: 10.1109/CDC.2004.1430207

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