Научная статья на тему 'Управление квадрокоптером с компенсацией ветровых возмущений'

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

CC BY
617
154
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
УПРАВЛЕНИЕ ПО ВЫХОДУ / РОБАСТНОЕ УПРАВЛЕНИЕ / НЕЛИНЕЙНЫЕ СИСТЕМЫ / НЕЛИНЕЙНЫЕ МНОГОКАНАЛЬНЫЕ СИСТЕМЫ / OUTPUT CONTROL / ROBUST CONTROL / NONLINEAR SYSTEMS / MIMO SYSTEMS

Аннотация научной статьи по математике, автор научной работы — Петраневский И. В., Борисов О. И., Громов В. С., Пыркин А. А.

Предмет исследования. В работе представлен алгоритм управления по выходу для нелинейных многоканальных систем. Модель квадрокоптера выбрана для наглядной демонстрации эффективности метода последовательного компенсатора для стабилизации объектов этого класса. Базовые положения исследования. Динамические свойства квадрокоптера могут быть описаны с помощью нелинейной многоканальной системы. Соответственно, первым этапом совершается ее декомпозиция, в результате чего модель делится на две части статическое преобразование и несколько динамических каналов с одним входом и выходом. После этого осуществляется вывод упрощенной математической модели квадрокоптера, вводится, помимо абсолютной системы координат, локальная система, жестко связанная с роботом. Принимается в расчет соответствующее преобразование координат. Промежуточные результаты. Декомпозиция математической модели позволяет осуществить построение системы управления в два шага. Во-первых, применяется закон, в соответствии с которым формируются так называемые виртуальные управляющие сигналы для каждого из каналов модели квадрокоптера. Здесь используется известный метод робастного управления «последовательный компенсатор», удачно зарекомендовавший себя как наиболее простой в реализации с инженерной точки зрения и позволяющий управлять по выходу объектом в условиях его параметрической неопределенности. Вовторых, осуществляется обратное преобразование, в результате чего получаются реальные управляющие сигналы, распределяемые между исполнительными приводами системы. В данной работе предполагается, что на каждый из каналов объекта действует ветровое возмущение, причем значения и направления этих возмущений меняются пренебрежимо медленно. Таким образом, мы можем рассматривать их как неизвестные константы, которые подлежат компенсации. Основной результат. В работе была осуществлена декомпозиция математической модели, осуществлены необходимые преобразования, получена упрощенная модель, синтезировано управление по выходу на основе метода последовательного компенсатора. Получившаяся замкнутая система была промоделирована, получены соответствующие результаты.

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

Похожие темы научных работ по математике , автор научной работы — Петраневский И. В., Борисов О. И., Громов В. С., Пыркин А. А.

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

Control for quadrocopter with compensation of wind disturbance

Subject of Research. The paper presents an output control approach for a class of nonlinear MIMO (Multiple Input Multiple Output) systems. Quadrocopter is chosen to illustrate proposed adaptive control approach based on the high-gain principle, the so-called, “consecutive compensator”. Basic Concepts. The dynamic properties of quadrocopter can be described by a non-linear multi-channel system. Accordingly, the first step is accomplished by its decomposition, whereby the model is divided into two parts: static conversion and several dynamical channels with one input and one output). After the decomposition, a derivation of the simplified mathematical model of the quadrocopter is carried out; and, in addition to the absolute coordinate system, the local system rigidly connected with the robot is introduced. The appropriate coordinate transformation is taken into account. Interim Results. Decomposition of the mathematical model gives the possibility to create control system in two steps. Firstly, the law is applied; in accordance with it the so-called virtual control actions for each model channel of the quadrocopter are generated. A well-known method of robust control, "consecutive compensator", is used here, successfully well-accepted as the most easily implemented one from an engineering point of view. This method gives the possibility to control an object output under its uncertainty quantification. Secondly, the inverse transformation is performed, resulting in real control actions distributed between the system actuators. We assume that wind disturbance affects each channel of the object. What is more, the values and directions of these disturbances are changed negligibly slow. Thus, we can treat them as unknown constants, subject to compensation. Main Result. We have developed a multi-channel control system for the quadrocopter by different methods (decomposition of the mathematical model and the output of its simplified analogue, coordinate transformation, "consecutive compensator"). The obtained closed-loop system has been successfully simulated and corresponding results have been received.

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

НАУЧНО-ТЕХНИЧЕСКИИ ВЕСТНИК ИНФОРМАЦИОННЫХ ТЕХНОЛОГИИ, МЕХАНИКИ И ОПТИКИ ноябрь-декабрь 2015 Том 15 № 6 ISSN 2226-1494 http://ntv.i1mo.ru/

SCIENTIFIC AND TECHNICAL JOURNAL OF INFORMATION TECHNOLOGIES, MECHANICS AND OPTICS November-December 2015 Vol. 15 No 6 ISSN 2226-1494 http://ntv.ifmo.ru/en

УДК 681.5.015

УПРАВЛЕНИЕ КВАДРОКОПТЕРОМ С КОМПЕНСАЦИЕЙ ВЕТР ОВЫХ ВОЗМУЩЕНИЙ И.В. Петраневскийа, О.И. Борисов3, В.С. Громов3, А.А. Пыркин3

a Университет ИТМО, Санкт-Петербург, 197101, Российская Федерация Адрес для переписки: igor.petranevsky@corp.ifmo.ru Информация о статье

Поступила в редакцию 15.06.15, принята к печати 29.07.15

doi:10.17586/2226-1494-2015-15-6-1045-1053

Язык статьи - русский

Ссылка для цитирования: Петраневский И.В., Борисов О.И., Громов В.С., Пыркин А.А. Управление квадрокоптером с компенсацией ветровых возмущений // Научно-технический вестник информационных технологий, механики и оптики. 2015. Том 15. № 6. С. 1045-1053.

Аннотация

Предмет исследования. В работе представлен алгоритм управления по выходу для нелинейных многоканальных систем. Модель квадрокоптера выбрана для наглядной демонстрации эффективности метода последовательного компенсатора для стабилизации объектов этого класса. Базовые положения исследования. Динамические свойства квадрокоптера могут быть описаны с помощью нелинейной многоканальной системы. Соответственно, первым этапом совершается ее декомпозиция, в результате чего модель делится на две части - статическое преобразование и несколько динамических каналов с одним входом и выходом. После этого осуществляется вывод упрощенной мате-магической модели квадрокоптера, вводится, помимо абсолютной системы координат, локальная система, жестко связанная с роботом. Принимается в расчет соответствующее преобразование координат. Промежуточные результаты. Декомпозиция математической модели позволяет осуществить построение системы управления в два шага. Во-первых, применяется закон, в соответствии с которым формируются так называемые виртуальные управляющие сигналы для каждого из каналов модели квадрокоптера. Здесь используется известный метод робастного управления «последовательный компенсатор», удачно зарекомендовавший себя как наиболее простой в реализации с инженерной точки зрения и позволяющий управлять по выходу объектом в условиях его параметрической неопределенности. Во-вторых, осуществляется обратное преобразование, в результате чего получаются реальные управляющие сигналы, распределяемые между исполнительными приводами системы. В данной работе предполагается, что на каждый из каналов объекта действует ветровое возмущение, причем значения и направления этих возмущений меняются пренебрежимо медленно. Таким образом, мы можем рассматривать их как неизвестные константы, которые подлежат компенсации. Основной результат. В работе была осуществлена декомпозиция математической модели, осуществлены необходимые преобразования, получена упрощенная модель, синтезировано управление по выходу на основе метода последовательного компенсатора. Получившаяся замкнутая система была промоделирована, получены соответствующие результаты. Ключевые слова

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

Работа выполнена при государственной финансовой поддержке ведущих университетов Российской Федерации (субсидия 074-U01, Госзадание 2014/190 (проект 2118)). Работа была поддержана Министерством образования и науки Российской Федерации (проект 14.Z50.31.0031)

^NTROL FOR QUADROCOPTER WITH COMPENSATION OF WIND DISTURBANCE I.V. Petranevsky3, O.I. Borisov3, V.S. Gromov3, A.A. Pyrkin3

3 ITMO University, Saint Petersburg, 197101, Russian Federation Corresponding author: igor.petranevsky@corp.ifmo.ru Article info

Received 15.06.15, accepted 29.07.15 doi:10.17586/2226-1494-2015-15-6-1045-1053 Article in Russian

For cit3tion: Petranevsky I.V., Borisov O.I., Gromov V.S., Pyrkin A.A. Control for quadrocopter with compensation of wind disturbance.

Scientific and Technical Journal of Information Technologies, Mechanics and Optics, 2015, vol. 15, no. 6, pp. 1045-1053.

Abstract

Subject of Rese3rch. The paper presents an output control approach for a class of nonlinear MIMO (Multiple Input Multiple Output) systems. Quadrocopter is chosen to illustrate proposed adaptive control approach based on the high-gain principle, the so-called, "consecutive compensator". B3sic Concepts. The dynamic properties of quadrocopter can be described by a

non-linear multi-channel system. Accordingly, the first step is accomplished by its decomposition, whereby the model is divided into two parts: static conversion and several dynamical channels with one input and one output). After the decomposition, a derivation of the simplified mathematical model of the quadrocopter is carried out; and, in addition to the absolute coordinate system, the local system rigidly connected with the robot is introduced. The appropriate coordinate transformation is taken into account. Interim Results. Decomposition of the mathematical model gives the possibility to create control system in two steps. Firstly, the law is applied; in accordance with it the so-called virtual control actions for each model channel of the quadrocopter are generated. A well-known method of robust control, "consecutive compensator", is used here, successfully well-accepted as the most easily implemented one from an engineering point of view. This method gives the possibility to control an object output under its uncertainty quantification. Secondly, the inverse transformation is performed, resulting in real control actions distributed between the system actuators. We assume that wind disturbance affects each channel of the object. What is more, the values and directions of these disturbances are changed negligibly slow. Thus, we can treat them as unknown constants, subject to compensation. Main Result. We have developed a multi-channel control system for the quadrocopter by different methods (decomposition of the mathematical model and the output of its simplified analogue, coordinate transformation, "consecutive compensator"). The obtained closed-loop system has been successfully simulated and corresponding results have been received. Keywords

output control, robust control, nonlinear systems, MIMO systems. Acknowledgements

This article is supported by Government of Russian Federation (GOSZADANIE 2014/190 (project 2118)) and the Ministry of Russian Federation (project 14.Z50.31.0031).

Введение

С практической точки зрения важно не только решить проблему самого управления, но и разработать легко реализуемый подход. Регуляторы с простой настройкой параметров регулирования привлекательны в реализации для инженеров различных областей, включая такие, как аэрокосмическое приборостроение, робототехника [1-6]. В частности, метод робастного управления по выходному сигналу находит применение во многих практических задачах, где измерение переменных вектора состояния не просто или даже невозможно реализовать.

Настоящая работа посвящена вопросам практического применения робастного метода управления по выходу «последовательного компенсатора», который подробно рассмотрен в работах [1, 7-9], для стабилизации многоканальных систем на примере модели квадрокоптера.

В работах [1, 7, 9] рассматриваются модели линейных систем с неизвестными параметрами и статическими нелинейными составляющими. В основе предполагаемого подхода лежит метод пассифика-ции [см. 9, 10]. Регулятор имеет простую структуру и может быть реализован как пропорциональная обратная связь, при условии строгой вещественной положительности системы с замкнутым контуром. В этом смысле разработанный алгоритм очень близок к результатам, представленным в работах [3, 11, 12], но с более низкими требованиями для объекта. Известно, что строгая вещественная положительность эквивалентна гипер-минимальной-фазности [13]. В свою очередь, числитель передаточной функции гур-вицев, что является достаточным условием для нашего алгоритма динамических одноканальных систем. Таким образом, мы расширили подход к неустойчивым разомкнутым системам с произвольной относительной степенью линейной части. Это стало допустимым вследствие разработки линейного фильтра специальной структуры.

Экспоненциальная устойчивость невозмущенной замкнутой системы с обратной связью и устойчивость для случая ограниченного возмущения соответственно были доказаны для «последовательного компенсатора» в [9, 14]. В работе [15] эти результаты были применены для распространяющейся во времени задержки. Предлагаемые алгоритмы управления продемонстрировали свою эффективность при наличии внешних возмущающих воздействий и неизвестном времени запаздывания.

В настоящей работе синтезирован регулятор для управления математической моделью квадрокоп-тера. Он имеет четыре симметрично расположенных исполнительных привода. Управляются они с помощью изменения скорости вращения двигателей и изменения подъемной силы соответственно. Квадро-коптеры - наиболее маневренные, вертикально взлетающие летательные аппараты. Они принадлежат к классу автономных роботов, движение которых происходит без соприкосновения с опорной поверхностью. Динамические свойства квадрокоптера могут быть описаны с помощью нелинейной многоканальной системы с несколькими входами и выходами. Первым этапом совершается ее декомпозиция, в результате чего модель делится на две части: статическое преобразование и несколько одноканальных систем (динамических систем с одним входом и одним выходом). После этого осуществляется вывод упрощенной математической модели квадрокоптера, вводится, помимо абсолютной системы координат, локальная система, жестко связанная с роботом. Принимается в расчет соответствующее преобразование координат. Декомпозиция математической модели позволяет осуществить построение системы управления в два шага. Во-первых, применяется закон, в соответствии с которым формируются так называемые виртуальные управляющие воздействия для каждого из каналов модели квадрокоптера. Здесь используется известный метод робастного управления «последовательный компенсатор», удачно зарекомендовав-

ший себя как наиболее простой в реализации с инженерной точки зрения и позволяющий управлять по выходу объектом в условиях его параметрической неопределенности. Во-вторых, осуществляется обратное преобразование, в результате чего получаются реальные управляющие воздействия, распределенные между исполнительными приводами системы. В данной работе предполагается, что на каждый из каналов объекта действует ветровое возмущение, причем значения и направления этих возмущений меняются пренебрежимо медленно. Таким образом, мы можем рассматривать их как неизвестные константы, кото -рые подлежат компенсации.

Постановка задачи

Зададим нелинейную динамическую систему следующим образом:

у() = Gi(u1,u2,...,ur,f) , (1)

где i=1...l, yi(t) - выходные переменные, и1,и2,.,иг — сигналы управления, Gt — нелинейный дифференциальный оператор в общем случае, f — неизвестные ветровые возмущения, изменяющиеся пренебрежимо медленно.

Регулятор для нелинейной многоканальной системы может быть построен в два шага. Сначала необходимо совершить декомпозицию модели в статическую функцию и независимые динамические однока-нальные системы (будем считать, что объект управления такой, что для него данный метод осуществим). Каждый канал соответствует выходной переменной yi,i = 1... I. Для каждого из каналов введем виртуальный сигнал управления U^i = 1...1, являющийся суперпозицией реальных управляющих сигналов.

После декомпозиции модель (1) примет вид

_ yi(t) = Gi(Ui,fi), Ui = Gi(u1,u2.....ur), _ (2)

где Git i = 1,...l - одноканальные динамические каналы, G^, i = 1,... I статическая многоканальная функция.

Если динамическая нелинейная многоканальная система может быть представлена как многоканальная статическая и несколько одноканальных динамических систем, как в выражении (2), то мы можем синтезировать закон управления для виртуальных входов Uit i = 1,... I каждого динамического линейного канала. Следующим шагом выразим закон управления для реальных приводов Uj,j = 1 ..г, основываясь на виртуальных управлениях для динамических одноканальных подсистем Uit i = 1,... I, полученных на первых шагах обратного преобразования статической нелинейности.

Представим нелинейную одноканальную систему как

a(j>)yi(t) = b(;p)Ui(t)+fi, (3)

где Р = ¿1 - дифференцальный оператор; yi(t) — выходная измеряемая величина, но ее производные не измеряемы; b(p) = Ьтрт + —+ b1p + Ь0, и а(р) =рп + —+ агр + а0 - нормированные взаимно

простые полиномы с неизвестными коэффициентами; г < п — 1; передаточная функция p) имеет отно-

а( p)

сительную степень р = п — т; полином Ь(р) - гурвицев, параметр Ът >0; fr — неизвестная константа, представленная пренебрежимо медленно изменяющимися ветровыми возмущениями для всех каналов.

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

Синтез регулятора для одноканальной линейной системы

В этом разделе индексирование i, которое соответствует определенной одноканальной системе (2), будет опущено для краткости.

После дифференцирования модели (3), мы получим:

[pa(p)]y(t) = [pb(p)]u(t) + pf, (4)

где pf = 0. Выразим u(t) = -U(t), и затем (4) примет следующий вид:

[pa(p)]y(t) = b(p)U(t). (5)

По результатам [15-17] выберем управление U(t)

u(t) = —Mp)9(t), (6)

f \ , M^(p)a(p) где число ^ и полином a(p) таковы, что передаточная функция----- строго вещественно

Ра( Р) + ^a( P)b( Р)

положительна и функция y(t) - оценка выходной y(t). Это вычисляется в соответствии со следующим алгоритмом:

= ?2 =

^¡р-1 = о (-/С1?1-----+ - У*))

(7)

У = (8)

где с > ц (доказательство теоремы 1, неравенство (41) в работе [16]) и параметр ^ рассчитываются из условия экспоненциальной устойчивости системы (7). Подобный закон управления известен как «последовательный компенсатор», описанный в работе [7, 9].

Подставляя (6) в уравнение (5), мы получим:

ра(р)у(0 = —Ь(р)^а(р)у(0- (9)

Представим ошибку, как е(£) = у(0 — у(£) и перепишем (9)

ра(р) + даЬ(р)МО = Ь(р)ца(р)е(0. (10)

После простых преобразований для модели (10) мы получим:

цЬ( p)a( p)

y(t) =-

8(t);

(11)

цЬ( p)a( p)

строго вещественно положительна.

pa( p) + ра( p)b( p) где передаточная функция W (p) =

pa( p) + ра( p)b( p)

Представим модель (11) в матричной форме х(0 = Ах (О + Вце(0, у(0 = Сгх(£:), где хеЯ" - вектор состояния системы (12); А, В и С ■ (11) к (12), (13).

Так как передаточная функция Ж(р) строго вещественно положительна, то существуют некоторые матрицы Р = Рг>0 и Q=Qг>0 такие, что АГР + РА = —Q, РВ = С. Перепишем модели (7), (8) в следующем виде: &) = ст(Г^(0 + бу(0), у(0 =

(12) (13)

соответствующие матрицы перехода от модели

0 1 0 ... 0 0

0 0 1 ... 0 0

где Г = 0 0 0 • 0 = 0 ,иЬг = [1 0 0 . . 0]

— ^2 —^з • —^р-1-

(14)

Примем во внимание вектор

л(0 = Ьу(0 — 5(0.

Далее, исходя из структуры вектора Ь, ошибка е(£) примет следующий вид:

е(0 = У(0 — КО = ЬтЬу(0 — = ^(Иу^) — КО) = Ьтл(0.

Для производной п(0 мы получим

П(0 = Ьу(0 — о (г(Иу(С) — г|(0) + ^у(О) = Ьу(0 + стГт|(С) — ст(й + ГИ)у(С).

Поскольку й = —ГЬ (можно проверить путем замены), получим

П(0 = ЬзР^(С) + оГг|(0, е(С) = Ьгг|(0,

где матрица Г гурвицева в силу рассчитанных параметров к1 системы (7), и

Г^ + МГ = —М, где N = ^ >0, М = Мг > 0.

Теорема 1. Рассмотрим нелинейные системы (12)-(14). Пусть р = п — т >1. Существуют такие параметры к0 и с0, зависящие от параметров объекта управления, что для всех к > ко>0 и с > с0 >0 нелинейная система (11)—(13) экспоненциально устойчива в смысле следующей нормы:

7(11*(0112 + 11л(0112).

Соответствующее доказательство этой теоремы можно найти в [15, 16] в качестве частного случая.

Применение регулятора для математической модели квадрокоптера

Теперь применим представленный подход к реальной многоканальной динамической системе, а именно к математической модели квадрокоптера. Его положение по отношению к фиксированной системе координат может быть задано с помощью преобразования векторов с компонентами (х,у, г), тангажа, крена, угла рысканья (9, у, ф). Вращение твердого тела вокруг декартовых осей в трехмерном пространстве в соответствии с вышеуказанными углами может быть представлено матрицей вращения Я в следующем виде:

R = 5фсе + сфсф _ Ор^ф ,

где = sin у, Су = cos y, Y = {9, у, ф)-

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

Рассмотрим трехмерную схему квадрокоптера, показанную на рис. 1, a, где Y¿, ¿ = {1,2,3,4) - это составляющая подъемной силы вектора /-го ротора (другими составляющими предполагается пренебречь), Ti - скорость ротора. Предположим, что первый и третий роторы вращаются по часовой стрелке, а второй и четвертый из них вращаются в направлении против часовой стрелки. Также примем, что вращение всех роторов происходит в одной плоскости, оси вращения которых перпендикулярны плоскости Xg, Yq и пересекают ее в точках (l, -l, 0), (l, l, 0), (-l, l, 0), (-l, -l, 0).

В соответствии с информацией, упомянутой ранее, выходные переменные данной многоканальной динамической системы представлены тремя линейными координатами в декартовом пространстве (x,y,z) и тремя углами (9, у, ф). Таким образом, соответствующая модель может быть представлена в виде системы из шести дифференциальных уравнений вида (1). Далее будем использовать следующую динамическую модель квадрокоптера:

rmx = (X y¿)(cos фsin 9cos у + sin фsin у) + fx, ^У = (X !¿)(sin фsin 9cos у - cos фsin у) + fy,

™ = (X >¿)(cos 9cos у) - + /z, 1

Д у^К-П + Ъ + Гз-ЪН/у, д ^ = С(У1-У2 + У3-К1)+/ф,

где m -масса; Д,Д,Д - основные моменты инерции масс; fx,fy,fz,f9и Уф - медленно изменяющиеся ветровые возмущения на каждом из каналов.

f

а б

Рис. 1. Схемы квадрокоптера: трехмерная схема (а); система координат (б)

Выполним разложение сложной динамической модели на независимые одноканальные линейные модели и соответствующие статические соотношения. Введем следующие виртуальные сигналы управления, которые находятся в суперпозиции с У^: и1= у1 + У2 + Г3 + Г4,

| и2 = -Y, - Y2 + Г3 + Г4,

(16)

I U3 = - + Y2 + К3 - У4, U4 = ^ - + ^з - К,.

Указанные выше виртуальные управления будут генерироваться в соответствии с заданными коор -динатами и ориентацией квадрокоптера в пространстве. Значения Y¿ рассчитываются по введенной системе линейных уравнений (16).

После подстановки (16) в (15) мы получим первую упрощенную модель: rmx = L^(cos фsin 9cos у + sin фsin у) + Д, my = ^(sin ф^п 9cos у - cos фsin у) + Д, rnz = [^(cos 9cos у) - mg + Д, Д 99 = Zí/2 +/9,

Д у = Ш3 +/у, /з ф = Cí/4 +/ф.

Рассмотрим первые два уравнения системы (17). Запишем их в матричной форме:

(17)

'тх cos ф

ту sin ф

— sin9 cos ф

][

+

(18)

где и5 и и6 - дополнительные входы виртуальных управлений, определяемые уравнениями

и5 = U1smeшsф, (19)

и6 = — У^тф.

В соответствии с особенностями задачи синтезирование регулятора для квадрокоптера должно быть выполнено с учетом привязки к фиксированной земной системе координат (0,Х,У). Тем не менее, воспользуемся для удобства вспомогательной системой координат (0,Х,7), жестко зафиксированной по отношению к квадрокоптеру (рис. 1, б).

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

(20)

тх

ту

(21)

(22)

тх

ту.

Гcosф —smф LyJ ' ^тф cosф _

где (х*,у*) и (х,у) - желаемые и текущие координаты квадрокоптера соответственно в абсолютной системе координат. Квадратная матрица в заданном уравнении является матрицей поворота для плоских систем координат.

Выразим координаты х и у из уравнения (20): XI _ гХ-1 Г cosф s^l Гх* — X У\ W |^1пф cosфJ [у* — у_ Умножим (21) на т. Затем, учитывая, что ф медленно изменяется и ф пренебрежимо мало, после двойного дифференцирования мы получим cosф sln^ \—тх —smф cosфJ [—ту_ Заменим (18) в (22) получим модель перехода к координатам х и у\

-и5+ц -u6 + fy\.

Понятно, что изменение крена или угла тангажа является вспомогательным процессом для обеспечения перехода к координатам х и у. Изменение этих значений должно быть разрешено в небольшом диапазоне, например, [—п/6, п/6]. В этом случае допустимо воспользоваться приближениями sin у « у, cos у « 1, при |yI < п/6. Затем перепишем третье выражение из (17) и равенства (19) в следующем виде:

mz = U1— тд + fz, U5 = U1Q , U6 _ —U^.

Теперь мы можем записать окончательную упрощенную модель для квадрокоптера: тх _ —U5 + fx, ту _ —U6 + fy, mz _ Ut— тд + fz, J1'6_lU2+fe,

М _iu3+ f^

/зф _ CU4 + ff,

где локальные координаты х и у могут быть рассчитаны в соответствии с желаемыми координатами по отношению к абсолютной системе координат с помощью выражения (21), в то время как желаемые значения 0 и ф могут быть получены из (23) и (24):

(23)

(24)

(25)

: = U5 щ* = — U6

(26)

Замечание 1. Уравнения (26) могут иметь нуль в знаменателе. Чтобы избежать этого, целесообразно изменить способ расчета искомых значений 9*и у*. Во-первых, если близко к нулю, значения 9*и у* должны быть равны нулю. Это означает, что движение вдоль координатной оси г предпочтительно управлять с помощью и1. Когда абсолютное значение больше или равно некоторым представленным константам, мы можем использовать (26). Во-вторых, если результат (26) является слишком большим, т.е. желаемый крен и угол тангажа больше, чем критическое значение п/6, имеет смысл связать желаемые значения 0*или ф* некоторой константой.

Система (25) содержит шесть динамических каналов. Воспользуемся законом управления по выходу (6)-(8) для математической модели, представленной виртуальными управлениями для и^Ь = 1... 6, при р = 2 и а(р) = 2р2 + р + 1:

^(1) = ^ (21 + ^ + 1*^), (27)

где е^ = [г* — г, 9* — 9, у* — у, ф* — ф, х, у} - ошибка соответствующего канала, х и у могут быть получены из (21), д., ©¿,1 = 1...6 - настраиваемые коэффициенты, которые могут быть выбраны без знания параметров объекта.

Замечание 2. Полином а(р) может быть произвольным, но обязательно гурвицев. Важен выбор ко -эффициентов полинома, чтобы гарантировать желаемое качество переходных процессов. Таким образом, мы решили усилить воздействие ^ во входном управлении (27), чтобы уменьшить завышения параметров.

В результате получили все виртуальные управляющие входы и^Ь = 1... 6. Напомним, что последние два входа, т.е. и5 и и6, были необходимы для расчета искомых значений углов крена и тангажа. Чтобы получить закон управления для двигателей в общем случае, мы должны сделать обратное преобразование статической нелинейности. Но в нашем случае достаточно заменить первые четыре управляющих входа, т.е. и1, и2, и3 и и4, в системе линейных уравнений (16). И тогда мы получим значения реальных управляющих сигналов Ух, У2,У3 и У4:

V, = (и, — и2 — из + и4)/4, У2 = (Ц1 — и2 + и3 — и4)/4, У1 = (и1 + и2 + и3 + и4)/4, П = № + и2 — и3 — и4)/4.

Компьютерное моделирование замкнутой системы

Результаты моделирования представлены на рис. 2, предложенный подход предполагает, что выходные переменные х, у, г, 9, у, ф измеряются без шумов. В данном случае мы рассматриваем математическую модель квадрокоптера с параметрами т = 1, I = 0,5, С = 1, ]1 = 1, ]2 = 1, ]3 = 1, д = 9,в. Начальное положение имеет координаты х0 = 0, у0 = 0, г0 = 0, и исходная ориентация ф0 = 0. Заданная точка имеет координаты х* = 10 [м],у* = 20 [м],г* = 30 [м], и желаемая ориентация ф* = 20 [град]. Значения ветрового возмущения для каждого канала следующие: /=10, /=10, /¿=10, /=0,1, /=0,1, /¡,=10. Полет квадрокоптера представлен с использованием заданного регулятора с коэффициентами ^1=10, ц2=2, ц3=2, ц4=10, Ц5=10, ц6=10, Ст!=30, ст2=30, ст3=30, ст4=30, ст5=30, ст6=30.

На рис. 2, а, представлены переходные процессы для линейных координат, рис. 2, б, демонстрирует переходные процессы для угловых координат.

л

й

к «

ч а

о §

Л

К

«

И «

40

30

60

20

10

-40

10 Время, с

■х .......у

а

20

30

10 20 Время, с

■9 9 ■- ф

б

30

Рис. 2. Графики переходных процессов в системе управления с обратной связью: линейных координат (а); угловых координат (б)

Заключение

В данной работе применен метод робастного управления «последовательный компенсатор». Получен алгоритм управления по выходу с помощью обратной связи для нелинейных многоканальных систем. Практическое применение полученных результатов моделирования в ходе экспериментов будет представлено в дальнейших работах. Наиболее интересна задача управления по выходному сигналу нелинейной системы с параметрическими и функциональными неопределенностями и временным запаздыванием. В работах [17, 18] задача управления рассматривается для линейных систем с запаздыванием по входу. Ре-

0

0

7

гулятор с обратной связью на основе подходов, представленных в [19-21], позволяет пренебречь неизвестными синусоидальными возмущениями для неустойчивых систем с запаздыванием по входу.

Литература

1. Бобцов А. А., Николаев Н.А. Синтез управления нелинейными системами с функциональными и параметрическими неопределенностями на основе теоремы Фрадкова // Автоматика и телемеханика. 2005. № 1. С. 118-129.

2. Fradkov A.L., Andrievsky B.R., Peaucelle D. Adaptive passification-based fault-tolerant flight control // Proc. 17th IFAC Symposium on Automatic Control in Aerospace (ACA'2007). Toulouse, France, 2007. V. 17. P. 715-720.

3. Kaufman H., Barkana I., Sobel K.S. Direct Adaptive Control Algorithms: Theory and Applications. 2nd ed. New York: Springer, 1998. 424 p.

4. Park B.S., Yoo S.J., Park J.B., Choi Y.H. A simple adaptive control approach for trajectory tracking of electrically driven nonholonomic mobile robots // IEEE Transactions on Control Systems Technology. 2010. V. 18. N 5. P. 1199-1206. doi: 10.1109/TCST.2009.2034639

5. Rusnak I., Barkana I., Weiss H.M. Improving the performance of existing missile autopilot using simple adaptive control // Proc. 18th IFAC World Congress. Milano, Italy, 2011. V. 18. N 1. P. 6567-6572. doi: 10.3182/20110828-6-IT-1002.01659

6. Zhang S., Luo F.L. An improved simple adaptive control applied to power system stabilizer // IEEE Transactions on Power Electronics. 2009. V. 24. N 2. P. 369-375. doi: 10.1109/TPEL.2008.2007490

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

7. Bobtsov A. A note to output feedback adaptive control for uncertain system with static nonlinearity // Automatica. 2005. V. 41. N 12. P. 2177-2180. doi: 10.1016/j.automatica.2005.08.006

8. Bobtsov A.A. A robust control algorithm for tracking the command signal with compensation for the parasitic effect of external unbounded disturbances // Automation and Remote Control. 2005. V. 66. N 8. P. 12871295. doi: 10.1007/s10513-005-0169-z

9. Фрадков А.Л. Синтез адаптивной системы стабилизации линейного динамического объекта // Автоматика и телемеханика. 1974. №12. С. 96-103.

10. Fradkov A.L. Passification of non-square linear systems and feedback Yakubovich-Kalman-Popov Lemma // European Journal of Control. 2003. V. 9. N 6. P. 577-586. doi: 10.3166/ejc.9.577-586

11. Barkana I. Parallel feedforward and simplified adaptive control // International Journal of Adaptive Control and Signal Processing. 1987. V. 1. N 2. P. 95-109. doi: 10.1002/acs.4480010202

12. Barkana I. Comments on "Design of strictly positive real systems using constant output feedback" // IEEE Transactions on Automatic Control. 2004. V. 49. N 11. P. 2091-2093. doi: 10.1109/TAC.2004.837565

13. Andrievsky B.R., Fradkov A.L., Kaufman H. Necessary and sufficient conditions for almost strict positive realness and their application to direct implicit adaptive control systems // Proc. American Control Conference. Baltimore, USA, 1994. V. 2. P. 1265-1266.

14. Bobtsov A.A., Pyrkin A.A., Faronov M.V. Output control for time-delay nonlinear system providing exponential stability // Proc. 19th Mediterranean Conference on Control and Automation (MED 2011). Corfu, Greece, 2011. P. 512-520. doi: 10.1109/MED.2011.5983020

15. Pyrkin A.A., Bobtsov A.A. Output control for nonlinear system with time-varying delay and stability analysis // Proc. 50th IEEE Conf. on Decision and Control and European Control Conference. Orlando, USA, 2011. P. 7392-7397. doi: 10.1109/CDC.2011.6160224

16. Pyrkin A.A., Bobtsov A.A., Kolyubin S.A., Faronov M.V., Shavetov S.V., Kapitanyuk Y.A., Kapitonov A.A. Output control approach "consecutive compensator" providing exponential and L®-stability for nonlinear systems with delay and disturbance // Proc. 20th Int. Conf. on Control Application. Denver, USA, 2011. P. 1499-1504. doi: 10.1109/CCA.2011.6044373

17. Pyrkin A., Smyshlyaev A., Bekiaris-Liberis N., Krstic M. Rejection of sinusoidal disturbance of unknown frequency for linear system with input delay // Proc. American Control Conference. Baltimore, USA, 2010. P. 5688-5693.

18. Pyrkin A., Smyshlyaev A., Bekiaris-Liberis N., Krstic M. Output control algorithm for unstable plant with input delay and cancellation of unknown biased harmonic disturbance // Proc. 9th IFAC Workshop on Time Delay System. Prague, Czech Republic, 2010. N 1. P. 39-44.

19. Krstic M. Delay Compensation for Nonlinear, Adaptive and PDE Systems. Birkhauser Boston, 2009. 466 p. doi: 10.1007/978-0-8176-4877-0

20. Krstic M., Smyshlyaev A. Backstepping boundary bontrol for first-order hyperbolic PDEs and application to systems with actuator and sensor delays // Proc. IEEE Conf. on Decision and Control. New Orleans, USA, 2007. P. 225-230. doi: 10.1109/CDC.2007.4434474

21. Pyrkin A. Adaptive algorithm to compensate parametrically uncertain biased disturbance of a linear plant with delay in the control channel // Automation and Remote Control. 2010. V. 71. N 8. P. 1562-1577. doi: 10.1134/S0005117910080060

Петраневский Игорь Владимирович Борисов Олег Игоревич Громов Владислав Сергеевич Пыркин Антон Александрович

Igor V. Petranevsky Oleg I. Borisov Vladislav S. Gromov Anton A. Pyrkin

студент, инженер, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, igor.petranevsky@corp.ifmo.ru

аспирант, инженер, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, borisov@corp.ifmo.ru

аспирант, инженер, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, gromov@corp.ifmo.ru

кандидат технических наук, доцент, доцент, ведущий научный

сотрудник, Университет ИТМО, Санкт-Петербург, 197101,

Российская Федерация, a.pyrkin@gmail.com

student, engineer, ITMO University, Saint Petersburg, 197101, Russian Federation, igor.petranevsky@corp.ifmo.ru

postgraduate, engineer, ITMO University, Saint Petersburg, 197101, Russian Federation, borisov@corp.ifmo.ru

postgraduate, engineer, ITMO University, Saint Petersburg, 197101, Russian Federation, gromov@corp.ifmo.ru

PhD, Associate professor, Associate professor, Leading Researcher, ITMO University, Saint Petersburg, 197101, Russian Federation, a.pyrkin@gmail.com

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