ПРИБОРЫ И СИСТЕМЫ АВТОМАТИЧЕСКОГО УПРАВЛЕНИЯ
УДК 681.51
DOI: 10.17586/0021-3454-2018-61-1-32-40
РОБАСТНОЕ УПРАВЛЕНИЕ ПО ВЫХОДУ ДВУХРОТОРНЫМ НЕЛИНЕЙНЫМ МНОГОКАНАЛЬНЫМ ОБЪЕКТОМ
С. А. Вражевский, А. А. Маргун, Д. Н. Базылев, К. А. Зименко, А. С. Кремлев
Университет ИТМО, 197101, Санкт-Петербург, Россия E-mail: Vrazhevskij. S@gmail. com
Обсуждается проблема робастного управления нелинейными многомерными системами. Рассматривается класс нелинейных объектов управления с параметрическими неопределенностями при наличии внешних неизвестных ограниченных возмущений. Предложен метод управления, основанный на методе последовательного компенсатора. Работоспособность алгоритма управления экспериментально исследована с помощью лабораторного стенда „Twin Rotor MIMO System". На основе результатов эксперимента показано, что метод последовательного компенсатора обеспечивает более высокое качество переходных процессов и точность в установившемся режиме по сравнению с управлением методом пропорционально-интегрально-дифференциального регулирования.
Ключевые слова: нелинейные многоканальные объекты, робастное управление, управление по выходу, последовательный компенсатор, ПИД-регулятор
Введение. Развитие современных технологий приводит к созданию все более сложных мехатронных и роботизированных технических объектов, при математическом описании которых используются модели нелинейной динамики и параметрические неопределенности, а также учитываются внешние и внутренние возмущающие воздействия. Распространенные методы управления (ПИД-регуляторы, модальное управление и т.п.) зачастую оказываются неприменимы либо не способны обеспечить требуемые показатели качества для такого рода систем.
В настоящей статье рассматривается проблема управления двухроторной многоканальной системой на примере специализированного лабораторного стенда „Twin Rotor MIMO System" (TRMS) [1]. Тематике управления нелинейными многоканальными объектами посвящено достаточно много исследований. Так, в работе [2] проведен анализ линейных и нелинейных модификаций ПИД-регулятора для TRMS. Метод оптимального управления на основе линейного квадратичного регулятора рассмотрен в работе [3], а его модификация на основе метода адаптивного управления со скользящим режимом — в работе [4]. Субоптимальное управление с использованием метода итеративной линеаризации предложено в работе [5]
Для исследований в данной области применяются также методы нечеткой логики. Например, ПИД-регулятор с использованием генетических алгоритмов представлен в работе [6], в [7] предложена модификация регулятора, основанная на нечеткой логике с применением теории оптимального управления. Алгоритм, совмещающий в себе нечеткую логику и управление со скользящим режимом, рассмотрен в работе [8]. Адаптивное нечеткое управление
многоканальными объектами в условиях неизвестных по знаку коэффициентов матрицы входных воздействий использовано в работе [9].
В работе [10] предложено использовать адаптивный регулятор на основе алгоритма бэкстеппинга (Ьаскв1еррт§) для управления квадрокоптером, который рассматривается как нелинейная многоканальная система. Алгоритм робастного управления для линеаризуемых нелинейных многоканальных объектов на основе методов линеаризации обратной связью представлен в работе [11].
Большинство предложенных решений имеют высокую сложность реализации и часто опираются на известную математическую модель объекта.
В настоящей статье для решения задач управления нелинейными многоканальными объектами используется метод робастного управления по выходу. Алгоритм управления базируется на методе последовательного компенсатора. Высокое качество алгоритма достигается его способностью компенсировать широкий класс внешних возмущений и обеспечивать устойчивость в условиях параметрической неопределенности. Достоинством предлагаемого метода является простота инженерной реализации и низкая вычислительная сложность.
Объект управления. Лабораторный стенд ТЯМБ представляет собой модель винтокрылого летательного аппарата с двумя степенями свободы и двухканальным входом. Общий вид установки показан на рис. 1.
Объект управления содержит два двигателя постоянного тока, по одному на каждую из степеней свободы. Входными сигналами объекта является подаваемое на двигатели напряжение, ограниченное интервалом [-2,5 В; +2,5 В]. Выходом объекта управления являются углы поворота в горизонтальной (рысканье) и вертикальной (тангаж) плоскостях. Детальное описание конструкции лабораторного стенда приведено в документации [1].
Математическая модель. Динамика объекта управления в каждой плоскости может быть описана уравнением моментов. Также на объект действуют сила тяжести, гироскопический момент, сила трения. Объект управления может быть представлен как два одноканаль-ных объекта с перекрестными связями. Динамика объекта в вертикальной плоскости описывается выражением
где у — угол тангажа, ¡1 — момент инерции, М1 — момент, создаваемый главным двигателем, — момент силы тяжести, Мв^ — момент сил трения, Мс — гироскопический момент. Силы, действующие в вертикальной плоскости, описываются уравнениями
Рис. 1
¡1У = М1 - Мро - МВу - М0,
(1)
Мрс = М 1 Бт у-М2 соб у; Мс = к^М^ соб у;
Мву = В1уу+В2у8§пу;
2
М1 = а1х1 + Ь1х1,
где 2 — моменты гравитационных сил; ф — угол рыскания; к^, В^, В2у, а1, Ь —
постоянные коэффициенты, указанные в документации [1].
Динамика двигателей постоянного тока аппроксимирована передаточными функциями первого порядка:
•1 =
•2 =
Тц* + Т1
-щ
10
Т21* + Т2
"«2,
20
• к
• =— «1 Т11
Т
10
Т
•1;
11
•2 =
Т2
-щ --
20
21
•2,
21
(3)
где • и Т2 — моменты сил на валах главного и хвостового двигателей; и1 и и2 — входные
напряжения на клеммах двигателей; кь к2, Т^, ¡, ] = 1, 2, — известные константы [1].
С учетом выражений (2) и (3) система уравнений, описывающая динамику объекта в вертикальной плоскости, принимает следующий вид:
у = юу;
М
Юу = - I
М
Sin у+-
8 2
11
cos у-
- В1уЮу - В2у^Юу + Т1 + ^Т12 + к^уМ 1ф ^ у;
Т
10
к
•1 =-^~т1 + ul, Т11 Т11
где Юу — угловая скорость объекта в вертикальной плоскости.
Система уравнений (4) может быть переписана в следующем виде:
у + В1уу = 01у к1и1 +7у;
(4)
/у = 92у к1т1 -
М
2у'1
81
М
11
cos у-
8 2
11
sin у + к8уМ 1Ф cos у + £1у sgnю
(5)
у
'1 Ч
где 01у, 9 2у — постоянные коэффициенты, зависящие от параметров системы (4); /у — ограниченная функция, содержащая все нелинейные компоненты уравнения динамики объекта в вертикальной плоскости.
В векторно-матричной форме система (4) может быть представлена следующим образом:
х = Ду х + £у«1 + ру;
У = су x,
(6)
где
0 1 0 " 0 "
Ду = 0 - В1у V11 , Ву = 0
0 0 Тю/ Т11 _ М Т11 _
Су=[1 0 0],
(7)
Ру — вектор-функция, содержащая все нелинейные компоненты уравнения динамики объекта в вертикальной плоскости:
ру =
" 0 " " 0 "
М81 sin у + М8 2
11 11
0 0
" 0 " 0 " 0
cos у + -В2у sgn Юу + а1 11 0 •2 + к8У
0 0
M1фcos у.
(8)
Аналогичные вычисления и преобразования справедливы для уравнений динамики объекта в горизонтальной плоскости:
/2ф = М2 -Мв^-ык, (9)
где ¡2 — момент инерции, М2 — момент, создаваемый хвостовым двигателем, Мвф — момент сил трения, Мк — момент, создаваемый перекрестными связями.
Силы, действующие в горизонтальной плоскости, описываются уравнениями
Мк =(к (5 + 1)/(т> + 1))ть Мвф= в1ф®+ В2ф®ёП®ф;
M2 = a2 т2 + b2
(10)
где kc, 70, Tp, , , а2, b2 — известные константы [1].
С учетом выражений (3) и (10) система уравнений, описывающая динамику объекта в горизонтальной плоскости, принимает следующий вид:
ф = шф ;
т2 = -
20
^2 +
к2
Юф = -В1фЮ - B29s§n Юф + bf Ъ + ^ т22;
12
21
T2
-u
2
Mr = к-
TP
f
T0
21
\
1 —0
V
T
1
p J
- —MR, TP
(11)
(12)
где юф — угловая скорость объекта в горизонтальной плоскости.
Система уравнений (11) может быть переписана в следующем виде:
ф+в1фф = 01ф k2u2 +/Ф; Л = 02фк2+ в2ф (sgn ® ф ) - TpMR + kc (1 - То/Tp )т1,
где 01ф, 02ф — постоянные коэффициенты, зависящие от параметров системы (11); f —
функция, содержащая все нелинейные компоненты и перекрестные связи в описании динамики объекта в горизонтальной плоскости.
В векторно-матричной форме система (11) может быть представлена следующим образом:
х = Аф х + вфи2 + Тф;]
У = Сф x,
где
0 1 0 " 0 "
Аф = 0 - В1ф Ьг/12 , Вф = 0
0 0 T2()/ T21 _ Л/T21 _
Сф=[1 0 0],
^ — вектор-функция, содержащая все нелинейные компоненты и перекрестные связи в описании динамики объекта в горизонтальной плоскости:
РФ =
- В
2ф
sgn Юф +
" 0 " 0
a2 2 kcT0
12 ^2 +
T p
0 0
Т1 + Mr .
В результате математическая модель лабораторного стенда ТЯМБ может быть представлена как две независимые динамические подсистемы (5) и (12), перекрестные связи которых рассматриваются как неизвестные ограниченные функции возмущений.
Робастный алгоритм управления. Синтез алгоритма управления для объекта, динамика которого описывается моделью (5), (12), основан на методе последовательно компенсатора [12]. Модель (5), (12) в общем виде описывается уравнениями
0,1 (Р ) У (г) = Я- (Р) Щ (г) + / (г, У, и) + (г) + 2 2 + Е СУ (p)УJ (г)+ Е У] (РЬ (г), - = 1,2, (13)
где , Я, — линейные дифференциальные операторы с динамическими порядками п, и т1 соответственно; у1 (г) — выходные сигналы; и{ — сигналы управления; / (г, у, и) — функции нелинейных воздействий, соответствующие /у и /ф; — функции неизвестных ограниченных внешних возмущений; С] и угу — линейные дифференциальные операторы входных и выходных воздействий перекрестных связей соответственно; р = ёр/& — оператор дифференцирования.
Относительные динамические степени р,- уравнений (13) известны. Эталонная модель описывается следующим образом:
(р)Ут (г) = Ят- (Р)ит1 (г), - = 1 2, (14)
где 0т1, Ят- — линейные дифференциальные операторы, ут (г) е Я — выходные сигналы эталонной модели, ит, (г)е Я — кусочно-непрерывные ограниченные сигналы управления эталонной моделью.
Сформируем законы робастного управления на основе информации об ошибках слежения ё1 (г) = у{ (г) - Ут (г) для выхода реального объекта по отношению к выходу эталонной
модели. Децентрализованный закон управления может быть сформирован следующим образом [13]:
и (г) = -а,К (X) ё- (г), (15)
где а,- — положительная константа, К, (X) — гурвицев полином с относительной степенью р,- -1, X — комплексная переменная, ё, (г) — оценка ошибки слежения. Для получения оценки ошибки слежения используется наблюдатель
4,- = о гу 4 +о В,ё,-;, » ^ ^ (16)
где
Г =
0 1РН
-к1 -кр
1 р--1
В- = [0 0...к]Т, Ц = [10.0]
Ъ е Яр-1 — вектор состояния наблюдателя, Г, — гурвицева матрица в силу выбора коэффициентов, о,- — достаточно большое число.
Как доказано в работе [13], закон управления (15) с наблюдателем (16) обеспечивают сходимость выхода объекта управления к выходу эталонной модели (14) с требуемой точностью при условии, что функция £ (^, у, и) липшицева. Кроме того, предложенный алгоритм
управления обеспечивает робастность замкнутой системы по отношению к отклонениям параметров объекта от номинальных значений.
Отдельного рассмотрения требуют нелинейные нелипшицевы компоненты вида (•)
в описаниях динамики объекта (5), (12). Функцию (•) можно полагать липшицевой во
всех точках за исключением нуля. В работах [14, 15] доказано, что алгоритм управления (15), (16) обеспечивает сходимость ошибки слежения многоканальной системы в ограниченной области в условиях квантования измерений выходного сигнала объекта. В рассматриваемом случае замкнутая система экспоненциально устойчива в окрестности при определенных значениях шага квантования и возмущения. Динамикой функции квантования можно описать динамику системы, в которой присутствует компонент (•), что позволяет распространить
полученный в работах [14, 15] результат на рассматриваемый случай.
Эксперимент. В процессе экспериментальной апробации алгоритма управления (15) с использованием лабораторного стенда ТЯМБ выбраны следующие параметры регулятора и наблюдателя:
а, = 0,5, К1 = 5р2 + 20р + 50, о, = 1, г = 1, 2;
Г =
0 1 -0,01 -100
, В, =[01]Т , Ц =[10]Т , г- = 1, 2.
Линейная часть уравнения динамики ТЯМБ с учетом параметров, указанных в [1], имеет следующий вид:
=
1
-6-10" 0
0
1,51 -0,91
ву =
Су=[1 0 0],
"0 1 0 " " 0 "
А = 0 -6 -10-3 4,5 , вф = 0 , Сф 1 1 0
0 0 -1 0,8
Был проведен сравнительный анализ предложенного децентрализованного алгоритма управления и работы ПИД-регулятора (в тех же условиях). Настройки ПИД-регулятора предоставлены разработчиками лабораторного стенда.
Результаты работы системы управления показаны на рис. 2, 3. Для каждой из подсистем лабораторного стенда задачи стабилизации в заданном положении (рис. 2, а—г) и слежения за эталонным сигналом фгеу, уге£ (рис. 3, а—г) были решены с использованием метода последовательного компенсатора (МПК) и пропорционально-интегрально-дифференциального регулятора. Графики, представленные на рис. 2, а, б, демонстрируют сравнительно одинаковое качество регулирования; анализ рис. 2, в, г и 3, в, г показывает, что переходные процессы в замкнутой системе при управлении методом последовательного компенсатора заметно лучше, чем при работе ПИД-регулятора, а рис. 3, а, б — что последовательный компенсатор обеспечивает более точное слежение объекта за эталонным сигналом по углу рысканья, чем ПИД-регулятор.
а)
ф, рад 1,2 1
0,8 0,6 0,4 0,2
0
б)
ф, рад 1,2 1
0,8 0,6 0,4 0,2
0
а)
ф, рад 0,5 0 -0,5 -1 -1,5
б) ф, рад
0,5 0 -0,5 -1 -1,5
МПК
фге^)
р ф(0
]
7
/
5 10 15 20 ПИД-регулятор
25 /, с
фге^)
ф(0
•
в) у, рад
0,5
0,4
0,3
0,2
0,1
0
г)
у, рад 0,5 0,4 0,3 0,2 0,1
МПК
Уге^) у(0
-
1
10
15
20
25 /, с
ПИД-регулято
Г\ - УтеКО
1 \ У(Г)
г
1
10
15
20
25
МПК
с
Рис. 2
в)
0
10
15
20
25 /, с
МПК
Л Л фге^О ф0)
Л / * ................ / \
/ \ 1 \ 1 \ / 1 1
У V
V
у, рад
0,7 0,6 0,5 0,4 0,3 0,2 0,1
Уге^) у(0
/ ГХУ ....................... .................... А
1
1
1
0 5 10 15 20 25 ПИД-регулятор
30 35 /, с
0
г)
Г\ /Л фгеКО ф(П у, рад 0,7 0,6 0,5 0,4 0,3 0,2 0,1
А \ \И \
\ / {\ \ 1 ' \
\ X..........¡1 \\ и
\7
10 20 30 40 ПИД-регулятор
50 /, с
........................ ........................ - Ч>гМ
II ч
II V У Г\\ 1
\И
...................\......................
1 ........................ ...................
0
10
20
30
40
50 /, с
0 5 10 15 20 25 30 35 /, с
Рис. 3
Результаты эксперимента демонстрируют работоспособность робастного управления методом последовательного компенсатора применительно к многоканальным нелинейным техническим объектам, и качество управления превосходит качество, обеспечиваемое ПИД-регулятором.
Заключение. Рассмотрен алгоритм робастного управления по выходу нелинейным многоканальным объектом с параметрическими неопределенностями в условиях внешних ограниченных возмущений. Ключевое предположение о применимости предложенного закона управления состоит в том, что математическая модель объекта управления может быть представлена в виде суммы линейной и нелинейной частей. Для синтеза регулятора необходимо знать только относительную степень линейной части модели объекта управления.
5
1
5
5
Рассмотренный метод применен для управления лабораторным стендом „Twin Rotor MIMO System". Параметрические неопределенности и нелинейная динамика объекта управления, включая перекрестные связи, рассмотрены как ограниченные или липшицевы возмущения.
По сравнению с ПИД-регулятором предложенный метод управления обеспечивает более высокое качество переходных процессов и точность стабилизации.
Исследование выполнено при поддержке Российского научного фонда (проект №17-1901422).
список литературы
1. Feedback Instruments Ltd. Twin Rotor MIMO System Control Experiments 33-949S. East Sussex, UK. 2006.
2. Cajo R., Agila W. Evaluation of algorithms for linear and nonlinear PID control for Twin Rotor MIMO System // Asia-Pacific Conf. on Computer Aided System Engineering (APCASE), IEEE. 2015. P. 214—219.
3. Pandey S. K., Laxmi V. Optimal control of Twin Rotor MIMO System using LQR Technique // Computational Intelligence in Data Mining. 2015. Vol. 1. P. 11—21.
4. Phillips A. E. A Study of Advanced Modern Control Techniques Applied to a Twin Rotor MIMO System / Rochester Inst. of Technology, N.Y., USA. 2014.
5. Vrazhevsky S., Kremlev A. Suboptimal control algorithm for nonlinear MIMO System // Proc. of the 7th Intern. Congress on Ultra Modern Telecommunications and Control Systems and Workshops (ICUMT), IEEE. 2015. P. 20—25.
6. Juang J. G., Liu W. K., Lin R. W. A hybrid intelligent controller for a twin rotor MIMO system and its hardware implementation // ISA Transact. 2011. Vol. 50(4). Р. 609—619.
7. Allouani F., Boukhetala D., Boudjema F. Particle swarm optimization based fuzzy sliding mode controller for the twin rotor MIMO system // Proc. of the 16th IEEE Mediterranean Electrotechnical Conf. (MELECON), 2012. P. 1063—1066.
8. Tao C. W., Taur J. S., Chang Y. H., Chang C. W. A novel fuzzy-sliding and fuzzy-integral-sliding controller for the twin-rotor multi-input-multi-output system // IEEE Transact. on Fuzzy Systems. 2010. Vol. 18(5). Р. 893—905.
9. Shi W. Adaptive fuzzy control for MIMO nonlinear systems with nonsymmetric control gain matrix and unknown control direction // IEEE Transact. on Fuzzy Systems. 2014. Vol. 22(5). Р. 1288—1300.
10. Basri M. A. M., Husain A. R., Danapalasingam K. A. Intelligent adaptive backstepping control for MIMO uncertain non-linear quadrotor helicopter systems // Transact. of the Institute of Measurement and Control. 2014.
11. Liu Y., Soffker D. Robust control approach for input-output linearizable nonlinear systems using high-gain disturbance observer // Intern. Journal of Robust and Nonlinear Control. 2014. Vol. 24(2). Р. 326—339.
12. Bobtsov A. A. Robust output-control for a linear system with uncertain coefficients // Automation and Remote Control. 2002. N 63(11). Р. 1794—1802.
13. Pyrkin A. A., Bobtsov A. A., Kolyubin S. A. et al. Simple robust and adaptive tracking control for mobile robots // IFAC-PapersOnLine. 2015. N 48(11). P. 143—149.
14. Margun A., Furtat I., Robust control of linear MIMO systems in conditions of parametric uncertainties, external disturbances and signal quantization // 20th Intern. Conf. on Methods and Models in Automation and Robotics (MMAR), IEEE. 2015. P. 341—346.
15. Margun A., Furtat I., Robust control of uncertain linear systems in conditions of output quantization // IFAC-PapersOnLine. 2015. N 48(11). P. 843—847.
Сведения об авторах
Сергей Александрович Вражевский — аспирант; Университет ИТМО, кафедра систем управления и
информатики; E-mail: [email protected] Алексей Анатольевич Маргун — аспирант; Университет ИТМО, кафедра систем управления и
информатики; E-mail: [email protected] Дмитрий Николаевич Базылев — аспирант; Университет ИТМО, кафедра систем управления и
информатики; E-mail: [email protected]
Константин Александрович Зименко — аспирант; Университет ИТМО, кафедра систем управления и
информатики; E-mail: [email protected] Артем Сергеевич Кремлев — канд. техн. наук; Университет ИТМО, кафедра систем управле-
ния и информатики; E-mail: [email protected]
Поступила в редакцию 21.03.17 г.
Ссылка для цитирования: Вражевский С. А., Маргун А. А., Базылев Д. Н., Зименко К. А., Кремлев А. С. Роба-стное управление по выходу двухроторным нелинейным многоканальным объектом // Изв. вузов. Приборостроение. 2018. Т. 61, № 1. С. 32—40.
ROBUST OUTPUT CONTROL OF TWIN ROTOR NONLINEAR MULTICHANNEL OBJECT
S. A. Vrazhevsky, A. A. Margun, D. N. Bazylev, K. A. Zimenko, A. S. Kremlev
ITMO University, 197101, St. Petersburg, Russia E-mail: [email protected]
The problem of robust control over multi-dimensional onlinear systems is addressed. The class of nonlinear control objects with parametric uncertainties is considered in the presence of external unknowns of bounded perturbations. An approach to the control problem based on the method of sequential compensator is proposed. Results of experimental study carried out with the use of the laboratory bench "Twin Rotor MIMO System" confirme the developed control algorithm efficiency. Based on the results of the experiment, it is shown that the method of a sequential compensator provides a higher quality of transient processes and accuracy in the steady-state regime in comparison with the control of the proportionalintegral-differential control.
Keywords: non-linear MIMO system, robust control, output control, consecutive compensator, PID-regulator
Data on authors
Sergey A. Vrazhevsky — Post-Graduate Student; ITMO University, Department of Control Sys-
tems and Informatics; E-mail: [email protected] Alexey A. Margun — Post-Graduate Student; ITMO University, Department of Control Sys-
tems and Informatics; E-mail: [email protected] Dmitry N. Bazylev — Post-Graduate Student; ITMO University, Department of Control Sys-
tems and Informatics; E-mail: [email protected] Konstantin A. Zimenko — Post-Graduate Student; ITMO University, Department of Control Systems and Informatics; E-mail: [email protected] Artem S. Kremlev — PhD, Associate Professor; ITMO University, Department of Control
Systems and Informatics; E-mail: [email protected]
For citation: Vrazhevsky S. A., Margun А. А., Bazylev D. N., Zimenko K. A., Kremlev А. S. Robust output control of twin rotor nonlinear multichannel object. Journal of Instrument Engineering. 2018. Vol. 61, N 1. P. 32—40 (in Russian).
DOI: 10.17586/0021-3454-2018-61-1-32-40