CC BY
82
УДК 681.513
В.Х. Пшихопов, Б.В. Гуренко, М.Ю. Медведев, А.М. Маевский, С.П. Голосов
ОЦЕНИВАНИЕ АДДИТИВНЫХ ВОЗМУЩЕНИЙ АНПА РОБАСТНЫМ
НАБЛЮДАТЕЛЕМ С НЕЛИНЕЙНЫМИ ОБРАТНЫМИ СВЯЗЯМИ*
Предлагаются алгоритмы оценивания аддитивных возмущений, действующих на АНПА в процессе его движения. Рассматриваемые алгоритмы отличаются нелинейным изменением коэффициентов усиления наблюдателя в зависимости от ошибки оценивания. В связи с тем, что ошибка не измеряется, предлагаются алгоритмы ее оценивания, основанные на асимптотическом вычислении производных. Разрабатываемый метод позволяет снизить интегральную погрешность оценивания возмущения при заданном качестве подавления случайного шума. Представлены результаты анализа работы наблюдателей возмущений в рамках непрямого адаптивного позиционно-траекторного управления. Показано, что наблюдатель возмущений обеспечивает асимптотическую сходимость оценки. Также показано, что постоянная интегрирования не влияет на свойства оценок, поэтому она может выбираться равной нулю. Приводятся результаты моделирования, подтверждающие улучшение критерия оценивания до 40 % по сравнению с наблюдателем, использующим постоянные коэффициенты усиления. Также приводятся результаты моделирования адаптивной системы АНПА при действии на него возмущения, обусловленного постоянным течением.
Управление; АНПА; оценивание возмущений; робастный наблюдатель.
V.Kh. Pshikhopov, B.V. Gurenko, М^ш Medvedev, A.M. Maevsky, S.P. Golosov
ESTIMATION OF ADDITIVE DISTURBANCES FOR AUTONOMOUS
UNDERWATER VEHICLES BY ROBUST ESTIMATOR WITH NONLINEAR
FEEDBACKS
The paper presents estimation algorithms of additive disturbances for autonomous underwater vehicles control systems. Peculiarity of the algorithms is nonlinear dependence of the estimator gains from estimation error. New algorithm of non-measurable error estimation is suggested. Developed method allows decrease integral error of disturbance estimation. In this paper computer experiment results are presented. Asymptotical stability of the suggested estimation method is proved. In addition it is proved that integrating constant may be equal to zero. Simulation results are presented for both estimation as well as adaptive closed-loop system of UAV. Nonlinear coefficients of the estimator increases performance of estimations. The profits is about 40 %. Simulation results for AUV with a constant underset is presented. The indirect adaptive control system avoids influence of the disturbance.
Control of airship; estimation of disturbances; estimation ofparameters.
Введение. Для управления АНПА успешно применяются системы позицион-но-траекторного управления, которые строятся в классе непрямых адаптивных систем [1-5]. В таких системах на качество замкнутой системы существенно влияют алгоритмы оценивания [6, 7]. В данной работе развивается метод робастного оценивания внешних, параметрических и структурных возмущений, представленных в аддитивной форме [8-22].
На рис.1 представлена структура позиционно-траекторной непрямого адаптивного системы управления АНПА с наблюдателем.
На рис. 1 используются следующие обозначения: РЕГ - регулятор; ОУ - объект управления; НАБЛ - наблюдатель; g - вектор задающих воздействий; и - вектор управляющих воздействий; у - вектор измеряемых координат; x - вектор оценок, получаемых наблюдателем; f - вектор внешних возмущений, действующих на объект.
*
Работа поддержана грантами Президента Российской Федерации № НШ-3437.2014.10, МД-1098.2103.10 и грантом РФФИ 13-08-00315а.
i2S
(2)
Рис. 1. Структура позиционно-траекторной системы непрямого адаптивного
управления
Достоинством такой адаптивной системы управления является независимость функционирования контура наблюдения от контура управления. Недостатком системы, показанной на рис. 1, является требование по выполнению теоремы разделения. Область устойчивости замкнутой системы в некоторых случаях может зависеть от скорости оценивания возмущений в наблюдателе.
Синтез наблюдателя возмущений. Рассмотрим уравнения динамики АНПА, в которых присутствуют наиболее существенные неопределенности:
' ' 1=АГ‘(^+^,). (1)
Согласно методу синтеза робастных наблюдателей возмущений [8, 12-14], введем в модель (1) возмущение
' х=М-1(^,+^+^)
где р^ - возмущение; g (р^) - функция, аппроксимирующая модель возмущения, действующего на объект.
Введем вектор ошибок оценивания:
= Ре* - Ре* , (3)
где р^ - оценка возмущения.
Согласно процедуре синтеза редуцированных наблюдателей, введем следующую замену переменных:
Ре* = 2 + * (х) , (4)
где 2 - вектор новых переменных; * (х) - функция, подлежащая определению в
ходе синтеза наблюдателя.
Тогда выражение (3) с учетом (4) принимает вид
е« = Ре* - 2 - * (х) • (5)
Потребуем, чтобы оценка возмущения подчинялась следующему уравнению, обеспечивающему экспоненциальную асимптотическую устойчивость:
ёп+Ь(х)еп = 0, (6)
где Ь (х) - матрица коэффициентов наблюдателя, определяющая время и характер переходных процессов.
Продифференцируем выражение (5) в силу уравнений объекта (2):
Подставим выражения (5) и (7) в уравнение (6):
ё(Р,М -+ Ра + ) + Ч*)-£-*(*)) = 0, (8)
Условие независимости уравнения (8) от возмущений Р ( имеют вид
g (Ре, ) - ^М^ + Ь (х) Рет, = 0.. (9)
Выберем функцию в g (Р^ ) виде
g ( Ре« ) = °еЛ« , (10)
где - матрица постоянных коэффициентов.
Тогда уравнение (9) с учетом (10) принимает вид
СР -^1 М-1РеЛ + Ь(х)Рвл = 0 . (11)
дх у ’
Из (11) находим
^ = (Ь(х)+0„)М. (12)
В общем случае решение уравнения (12) имеет вид
* (х) = ОеМх + ^ Ь ( х~)Мёх + /, (13)
где / - константа, независящая от вектора х.
Тогда уравнения наблюдателя возмущений (4), (8) принимают вид:
г = -Ь (х) £ - (Ь (х) + Ое!!1 ) (р + р ) - Ь (х) Ое!!Цх + (х)Мск + ]
(i4)
Fest = z + GeMx + L іx)Mdx + U (i5)
Рассмотрим пример реализации алгоритма оценивания возмущений (14), (15). Будем полагать матрицу Ь (х) = Ь постоянной. Выберем матрицу = 0 нулевой матрицей, что соответствует локальной аппроксимации аддитивных возмущений рядом Тейлора нулевого порядка. В этом случае уравнения (14), (15) принимают вид:
2 = ~Ьг — Ь (р + р ) — X {РМх + /о), (16)
= 2 + ЬМх + /о. (17)
С целью анализа уравнений (16), (17), продифференцируем выражение (17) с учетом уравнений объекта (2) и уравнений наблюдателя (16):
4, = 1 + ^х = -Х5-Х(р+^^-Х(ХМх + /0)+ХМ^-1(р+р+^)= (18)
= -Ь2-Ь(Шх + /0) + ЬР^.
Выразим из (17) переменную 2 подставим ее в (18):
К, = -/ (р, -Шх-Г0)-Ь(Шх + /0) + ЬРе,
= -Ь (Рех - Ре*, ) •
(19)
Из (19) следует, что алгоритм (16), (17) обладает экспоненциальной асимптотической устойчивостью в соответствии с уравнением (6). Кроме того, из (19) видно, что свойства наблюдателя возмущений не зависят от константы
Р^ = 2 + ЬМх + /, поэтому она может быть принята, равной нулю. В этом случае
уравнения наблюдателя возмущений (16), (17) принимают вид:
Повышение точности наблюдателя. Непрямое адаптивное управление широко распространено в системах управления подвижными объектами в силу того, что структура и параметры регулятора не зависят от структуры и параметров наблюдателя. Это позволяет использовать известные законы управления и адаптировать их за счет контура оценивания, который может строиться на произвольном базисе. При этом данная структура удобна в том случае, когда необходимо модернизировать или адаптировать существующую систему управления. В случае достаточно высокого быстродействия алгоритма оценивания качество адаптивной системы, как минимум, не уступает неадаптивной системе. Однако во время переходных процессов в наблюдателе качество замкнутой системы может ухудшаться вплоть до потери асимптотической устойчивости.
Непрямое адаптивное управление имеет существенный недостаток, заключающийся в том, что, в общем случае, в нелинейных системах не выполняется теорема разделения, что требует включать наблюдатель возмущений в контур управления. Этот недостаток может быть устранен путем повышения быстродействия алгоритмов оценивания в области больших отклонений.
Однако повышение быстродействия наблюдателя (20), (21) за счет увеличения матрицы коэффициентов усиления Ь приводит к увеличению влияния случайных шумов, действующих в канал измерения. В этой связи ставится задача повышения быстродействия наблюдателя (20), (21) в области больших отклонений без увеличения этих коэффициентов в установившемся режиме. Данная задача может быть решена за счет нелинейного изменения коэффициентов усиления наблюдателя, который может быть записан в виде:
Аналогичный подход использован в работах [10, 11, 15-17] для повышения быстродействия наблюдателя производных. Однако метод оценивания производных, представленный в [10, 11, 15-17], опирается на информацию об ошибке по величине, от которой вычисляются производные по времени. В данном случае нет возможности прямо вычислить ошибку (3), так как в нее входит вектор неизме-
ряемых возмущений
В этой связи в данной статье разрабатывается метод, основанный на изменении матрицы коэффициентов усиления наблюдателя в зависимости от результатов косвенных измерений.
Для решения поставленной задачи наряду с уравнениями АНПА (2) введем его модель вида
5 = -/£-£(р+р )-12Мх,
Ре.« = 2 + ЬМх .
(20)
(21)
2=-Ь(еп)2-Ь(еп)(К+^)-Ь(еп)Ь(еп)Мс^
(22)
(23)
x...=M-l{Fu+Fd+Fest). (24)
а
Вычтем из первого уравнения (2) уравнение (24), в результате чего приедем к выражению:
М(х-*п)=Ре«-Ре«=еп- (25)
Таким образом, ошибку оценивания возмущений наблюдателем (22), (23) можно вычислить, измеряя ускорения АНПА и его модели (24).
Для оценивания ускорений применим алгоритмы асимптотического оценивания, использованные в [10, 16, 22]. В матричном виде уравнения оценивания величин X и X имеют вид:
со* = со* +к* (х —со*),
СО2 = к1 (х-со*), (26)
х = СО2,
*хт . тхт (
®1 = 2 +к1 ),
сох2т =к™(хт-С0™), (27)
X = сохт
т 2 J
где их, ®х, И™, И™ - векторы переменных состояния наблюдателей производных; , кх™, кх,™ - матрицы коэффициентов усиления.
Тогда матрица коэффициентов усиления наблюдателя возмущений (22), (23) принимается в виде
............ (28)
ь(еп) = ь0+кь м{к-кт)
где Ь0 - матрица коэффициентов усиления в установившемся режиме; Кь - матрица постоянных коэффициентов; ||*|| - операция взятия нормы.
Моделирование алгоритмов оценивания. Рассмотрим пример оценивания возмущения, действующего на АНПА, динамика которого описывается уравнением (1). Выберем следующие параметры наблюдателя возмущений:
Ьо = diag ([2; 2; 2; 2; 2; 2]), Кь = diag ([ 2;2;2;2;2;2]), (29)
где diag (х) - оператор вычисления диагональной матрицы, на главной диагонали которой находятся элементы вектора х. В качестве нормы выбрана евклидова норма.
Коэффициенты усиления наблюдателей производных (26), (27) равны: к^ = diag([20; 20; 20; 20; 20; 20]), кх2 = diag ([100; 100; 100; 100; 100; 100]) , (30)
кГ = diag ([20; 20; 20;20;20;20]), к2х™ = diag ([100; 100; 100; 100; 100;100]). (31)
Результаты моделирования наблюдателя (22), (23) при постоянных и переменных коэффициентах усиления представлены на рис. 2 и 3.
РвБ!
..
1 ж \ \
* /
1# 1 *§
I
1,0
2 3 4 5 6 7
Рис. 2. Оценки возмущения
0 1
8 9
Рис. 3. Интегральная ошибка оценивания
На рис. 2 представлены: оцениваемое постоянное возмущение БеБ^ его оценка БезИ, полученная при постоянных коэффициентах усиления Ь (еи) = Ь0; его
оценка РеБ12, полученная при нелинейном изменении коэффициентов усиления в соответствии с (28). Также на рис. 2 представлена область установившегося режима. Из рис. 2 видно, что в области переходного режима оценка возмущения, полученная при переменных коэффициентах усиления, обеспечивает более высокое быстродействие. В области малых отклонений оценка при постоянных коэффициентах сходится быстрее. Однако в области малых отклонений применима теорема разделения, поэтому там существенна только асимптотическая сходимость процесса оценивания.
На рис. 3 представлены интегральные ошибки оценивания при постоянных Л
и переменных 12 коэффициентах усиления наблюдателя возмущений:
М(х- хт ) = ^ - Ре« = е„ . (32)
Видим, что области переходного режима нелинейного алгоритма оценивания дает выигрыш по интегральной ошибке около 40 %. На всем интервале оценивания выигрыш по интегральной ошибке (32) составляет около 12 %.
Отметим, что в обоих случаях в установившемся режиме коэффициенты усиления одинаковые, поэтому, с точки зрения соотношения «сигнал-шум», на выходе алгоритмы эквивалентны.
В силу того, что в области малых отклонений постоянные коэффициенты усиления обеспечивают большую сходимость оценок, можно использовать комбинированный алгоритм оценивания. При этом переход к постоянным коэффициентам усиления можно выполнять в соответствии с критерием:
ЬЫ <£ ,
т гр
Ь0
где 1гр - граничное значение коэффициента усиления.
На рис. 4 представлены результаты работы одного из каналов оценивания производных в соответствии с алгоритмами (26), (27). На рис. 4: X - оцениваемая производная; X - оценка производной.
Рис. 4. Оценка производной
В силу универсальности ряда Тейлора предложенный алгоритм может быть использован для приближенной оценки возмущений произвольной формы. Например, на рис. 5 и 6 представлены результаты работы наблюдателя возмущений (22), (23) при непостоянном возмущении.
На рис. 5 представлены: оцениваемое переменное возмущение Без!; его оценка БезИ, полученная при постоянных коэффициентах усиления Ь (еи ) = Ь0; его
оценка РеБ12, полученная при нелинейном изменении коэффициентов усиления в соответствии с (28).
На рис. 6 представлены интегральные ошибки оценивания для случая постоянных коэффициентов Л и при нелинейном изменении коэффициентов усиления J2. Из рис. 6 видно, что нелинейное изменение коэффициентов усиления позволяет устранить ошибку оценивания в установившемся режиме. В переходном режиме выигрыш по интегральной оценке качества (32) составляет около 30 %.
Результаты, представленные на рис. 4 и 5, получены при значении матрицы
К = diag ([20; 20; 20; 20; 20; 20]).
РвБІ
РвБІ 1
# ♦ # -І*
* * V Рєб1і2 *■
1
1,с
0 1 2 3 4 5 6 7
Рис. 5. Оценки переменного возмущения
Рис. 6. Интегральные ошибки оценивания переменного возмущения
На рис. 7 и 8 представлены результаты моделирования движения АНПА, на который, в промежутке времени от 50 с до 60 с, действует течение. Из результатов моделирования видно, что в случае отсутствия наблюдателя, возникает ошибка по скорости и координатам, а при его использовании возмущения эффективно парируются.
б
Рис. 7. Траектория движения АНПА: а - без наблюдателя; б - с наблюдателем
1.4
1.2
0.8
0.6
0.4
0.2
100
100
а
0 10 20 30 40 50 60 70 80 90 100 0 10 20 30 40 50 60 70 80 90 100
а б
Рис. 8. СКО по траектории АНПА: а - без наблюдателя; б - с наблюдателем
Заключение. В работе предложен метод оценивания аддитивных возмущений, действующих на АНПА при его движении. Метод позволяет строить адаптивные системы управления АНПА на основе непрямого адаптивного управления. Метод может приняться для других типов подвижных объектов - дирижаблей [18-21], вертолетов [22] и т.д.
1.
2.
3.
БИБЛИОГРАФИЧЕСКИМ СПИСОК
Пшuxonoв B.X., Медведев М.Ю. Управление подвижными объектами в определенных и неопределенных средах. - М.: Наука, 2011. - 350 с.
Пшuxonoв B.X. Позиционно-траекторное управление подвижными объектами. - Таганрог: Изд-во ТТИ ЮФУ, 2009. - 183 с.
Пшuxonoв B.X., Cукoнкuн C.Я., Нагучев Д.Ш., Cтpакoвuч В.В., Медведев М.Ю., Гурент Б.В., KocMютв В.А., Вoлoщенкo Ю.П. Автономный подводный аппарат «Скат» для решения задач поиска и обнаружения заиленных объектов // Известия ЮФУ. Технические науки. - 2010. - № 3 (104). - С. 153-162.
Пшuxonoв B.X., Медведев М.Ю. Синтез систем управления подводными аппаратами с нелинейными характеристиками исполнительных органов // Извести ЮФУ. Технические науки. - 2011. - № 3 (116). - С. 147-156.
Pshikhopov V.Kh., Medvedev M.Y., and Gurenko B. V. Homing and Docking Autopilot Design for Autonomous Underwater Vehicle // Applied Mechanics and Materials Vols. 490-491 (2014).
- P. 700-707. Trans Tech Publications, Switzerland. doi:10.4028/www.scientific.net/AMM.490-491.700.
Землятв C.Д., Руттвский В.Ю. О некоторых результатах развития теории и практики применения беспоисковых адаптивных систем // Автоматика и телемеханика. - 2001. - № 7. Гайдук А.Р. Алгебраические методы анализа и синтеза систем автоматического управления. - Ростов-на-Дону, 1988. - 208 с.
Медведев М.Ю. Алгоритмы адаптивного управления исполнительными приводами // Мехатроника, автоматизация и управление. - 2006. - № 6. - С. 17-22.
Медведев М.Ю., Пшuxonoв B.X., Cupoтенкo М.Ю. Алгоритмы адаптивного управления судном на воздушной подушке // Известия ЮФУ. Технические науки. - 2008. - № 1 (78). - С. 189-194.
10. Пшuxonoв B.X., Медведев М.Ю. Алгоритмическое обеспечение робастных асимптотических наблюдателей производных // Инженерный вестник Дона. - 2011. - № 6 (16).
- C. 169-175.
11. Медведев М.Ю. Структура и алгоритмическое обеспечение нелинейного наблюдателя производных в условиях действия случайных шумов // Известия ЮФУ. Технические науки. - 2008. - № 12 (89). - С. 20-25.
12. Медведев М.Ю. Синтез системы управления регулирующими органами // Известия ТРТУ. - 2003. - № 1 (30). - С. 44-48.
7
9.
30
25
5
10
13. Пшихопов ВХ., Медведев М.Ю. Структурный синтез автопилотов подвижных объектов с оцениванием возмущений // Информационно-измерительные и управляющие системы.
- 2006. - № 1. - С. 103-109.
14. Медведев М.Ю., Борзов В.И., Пшихопов В.Х., Вершинин Г.Ф. Автономные управляемые ветроэнергетические установки // Известия ТРТУ. - 2006. - № 3 (58). - С. 202-207.
15. Пшихопов В.Х., Медведев М.Ю. Синтез адаптивных систем управления летательными аппаратами // Известия ЮФУ. Технические науки. 2010. - № 3(104). - С. 187-196.
16. Пшихопов В.Х., Медведев М.Ю. Алгоритмы оценивания в системе управления автономного роботизированного дирижабля // Известия ЮФУ. Технические науки. - 2013.
- № 2 (139). - С. 200-207.
17. Медведев М.Ю., Шевченко В.А. Оценка возмущений в процессе автоматического регулирования синхронного генератора // Инженерный вестник Дона. - 2013. - № 4.
18. Пшихопов В.Х., Медведев М.Ю., Гайдук А.Р., Нейдорф Р.А., Беляев В.Е., Федоренко Р.В., Костюков В.А., Крухмалев В.А. Система позиционно-траекторного управления роботизированной воздухоплавательной платформой: математическая модель // Мехатроника, автоматизация и управление. - 2013. - № 6. - С. 14-21.
19. Пшихопов В.Х., Медведев М.Ю., Гайдук А.Р., Нейдорф Р.А., Беляев В.Е., Федоренко Р.В., Костюков В.А., Крухмалев В.А. Система позиционно-траекторного управления роботизированной воздухоплавательной платформой: алгоритмы управления // Мехатроника, автоматизация и управление. - 2013. - № 7. - С. 13-20.
20. Pshikhopov V.Kh., Medvedev M.Yu. Block Design of Robust Control Systems by Direct Lyapunov Method // IFAC Papers Online. - 2012.
21. Pshikhopov V., Medvedev M., Kostjukov V., Fedorenko R., Gurenko B., Krukhmalev V. Airship autopilot design // SAE Technical Paper. - 2011.
22. Pshichopov V.Kh., Sergeev N.E., Medvedev M.Y., Kulchenko A.E. Helicopter autopilot design // SAE Technical Paper. - 2012.
Статью рекомендовал к опубликованию д.т.н., профессор А.В. Павленко.
Пшихопов Вячеслав Хасанович - Южный федеральный университет; e-mail: [email protected]; 347928, г. Таганрог, пер. Некрасовский, 44; тел.: 88634371694; кафедра электротехники и мехатроники; зав. кафедрой; д.т.н.
Медведев Михаил Юрьевич - e-mail: [email protected]; кафедра электротехники и мехатроники; д.т.н.; профессор.
Гуренко Борис Викторович - e-mail: [email protected]; кафедра электротехники и мехатроники; ассистент.
Маевский Андрей Михайлович - e-mail: [email protected]; кафедра электротехники и мехатроники; ассистент.
Голосов Сергей Петрович - e-mail: [email protected]; кафедра физики; доцент.
Pshikhopov Vyacheslav Khasanovich - Southern Federal University; e-mail: [email protected]; 44, Nekrasovskiy, Taganrog, 347928, Russia; phone: +78634371694; the department of electrical engineering and mechatronics; head the department; dr. of eng. sc.
Medvedev Mixail Yur’evich - e-mail: [email protected]; the department of electrical engineering and mechatronics; dr. of eng. sc.; professor.
Gurenko Boris Viktorovich - e-mail: [email protected]; the department of electrical engineering and mechatronics; assistant.
Maevsky Andrey Mikhaylovich - e-mail: [email protected]; the department of electrical engineering and mechatronics; assistant.
Golosov Sergey Petrovich - e-mail: [email protected]; the department of physics; associate professor.
