Научная статья на тему 'Оценка эффективности сильного следящего ансцентного фильтра Калмана с применением нечеткой модели'

Оценка эффективности сильного следящего ансцентного фильтра Калмана с применением нечеткой модели Текст научной статьи по специальности «Компьютерные и информационные науки»

CC BY
199
38
i Надоели баннеры? Вы всегда можете отключить рекламу.
Ключевые слова
СИЛЬНЫЙ СЛЕДЯЩИЙ АНСЦЕНТНЫЙ ФИЛЬТР КАЛМАНА / СУБОПТИМАЛЬНЫЙ КОЭФФИЦИЕНТ ЗАТУХАНИЯ / КОЭФФИЦИЕНТ СМЯГЧЕНИЯ / НЕЧЕТКИЙ ФИЛЬТР / T S-МОДЕЛЬ / STRONG TRACKING UNSCENTED KALMAN FILTER / SUBOPTIMAL FADING FACTOR / SOFTENING COEFFICIENT / FUZZY FILTER / T S-MODEL

Аннотация научной статьи по компьютерным и информационным наукам, автор научной работы — Деменков Николай Петрович, Чан Динь Минь

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

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

Похожие темы научных работ по компьютерным и информационным наукам , автор научной работы — Деменков Николай Петрович, Чан Динь Минь

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

Estimate of strong tracking unscented Kalman Filter efficiency using a fuzzy model

Unscented Kalman Filter (UKF) using a set of sigma points by means of deterministic sampling, makes it possible to avoid errors caused by linearization, as in the traditional Extended Kalman filter (EKF). However, like the EFK filter, the UKF filter is sensitive to the uncertainty of the system model. In the presence of model uncertainty, the input data cannot reflect the real model and filtering will deteriorate or even diverge. In a Strong Tracking Kalman Filter (STKF), in order to provide better smoothness of state estimation, a suboptimal fading factor is introduced, in which the softening coefficient is used. In Strong Tracking Unscented Kalman Filter (STUKF), developed based on the combination of the UKF and STKF, to increase the stability of the UKF, the softening factor used in the STKF on the UKF is directly added to the uncertainty of the process model. The key parameter in the STUKF is the matrix of the suboptimal fading factor, which depends on three parameters: a priori coefficient; forgetting coefficient and softening factor. The softening factor is used to improve the smoothness of the state assessment. The larger it is, the better the accuracy of the estimate, and the lower the value, the higher the tracking ability. In the traditional STUKF, the softening coefficient is determined empirically and is included in the entire filtering process, which leads to a loss of accuracy in the time segments in which the process model is defined. In this paper, we consider the option of applying the Takagi Sugeno fuzzy model (T S-model) to adjust the online softening coefficient when the object dynamics changes. As a result of a comparative analysis of the accuracy of the studied filters to the nonlinear model, it was found that the STUKF using a fuzzy logical adaptive system has a good smoothness of evaluation and the greatest accuracy.

Текст научной работы на тему «Оценка эффективности сильного следящего ансцентного фильтра Калмана с применением нечеткой модели»

ISSN 2542-1468, Лесной вестник /Forestry Bulletin, 2019. Т. 23. № 4. С. 88-97. © МГТУ им. Н.Э. Баумана, 2019

Вычислительная техника. Математическое моделирование. Технологии Оценка эффективности сильного...

УДК 681.5:681.3 DOI: 10.18698/2542-1468-2019-4-88-97

ОЦЕНКА ЭФФЕКТИВНОСТИ СИЛЬНОГО СЛЕДЯЩЕГО АНСЦЕНТНОГО ФИЛЬТРА КАЛМАНА С ПРИМЕНЕНИЕМ НЕЧЕТКОЙ МОДЕЛИ

Н.П. Деменков, Чан Динь Минь

МГТУ им. Н.Э. Баумана, 107005, Москва, ул. 2-я Бауманская, д. 5, стр. 1 dnp@bmstu.ru

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

Ссылка для цитирования: Деменков Н.П., Чан Минь Динь. Оценка эффективности сильного следящего ансцентного фильтра Калмана с применением нечеткой модели // Лесной вестник / Forestry Bulletin, 2019. Т. 23. № 4. С. 88-97. DOI: 10.18698/2542-1468-2019-4-88-97

Одним из наиболее распространенных подходов к оценке состояния в нелинейных динамических системах является фильтр Калмана (анг. Kalman Filter) и его разновидности (далее по тексту — ФК). К слаболинейным системам применяется расширенный ФК (Extended) через линеаризацию, однако имеющий два недостатка: 1) необходимость вычисления якобиевых матриц; 2) крайне неточную линеаризированную аппроксимацию, — которые могут приводить к нестабильности фильтра [1-5].

Для исключения недостатков предложен ансцентный ФК (Unscented) [6-8]. Он использует набор сигма-точек посредством детерминированной выборки, что позволяет избежать ошибок, вызванных линеаризацией, как в традиционном расширенном ФК. Однако ансцентный как и расширенный ФК, чувствителен к неопределенности модели системы. При наличии неопределенности модели входные данные не могут отражать реальную модель, и фильтрующее решение ансцентно-го ФК будет ухудшаться или даже расходиться [6].

Сильный следящий ФК (Strong Tracking) представляет собой, по существу, нелинейный более плавный алгоритм, который использует субоптимальные множители затухания, в которых задействован коэффициент смягчения [9-11]. Он имеет несколько достоинств, в частности сильную устойчивость к неопределенности модели и хорошую способность отслеживания состояния

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

Сильный следящий ансцентный ФК (Strong Tracking Unscented) разработан на основе комбинации ансцентного и сильного следящего ФК, ключевым параметром которого стала матрица субоптимального коэффициента затухания, зависящая от коэффициентов: априорного, затухания и смягчения. Коэффициент смягчения в используется для улучшения гладкости оценки состояния. Чем больше в, тем лучше точность оценки. Меньшее значение в обеспечивает более высокую способность отслеживания [12, 13].

Традиционный подход сильного следящего ансцентного ФК для определения факторов смягчения в значительной степени зависит от личного опыта или компьютерного моделирования с использованием схемы эвристического поиска. Субоптимальный коэффициент затухания включен в весь процесс фильтрации, что приводит к потере точности во временных сегментах определения модели процесса.

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

в процессе фильтрации. Увеличение размерности вектора состояния и связанных с ним матриц приводит к большой вычислительной нагрузке.

Цель работы

Цель настоящих исследований — применение нечеткой модели для настройки в режиме реального времени коэффициента смягчения при изменении динамики объекта и сравнительном анализе точности исследуемых фильтров для нелинейной модели.

Алгоритмы исследуемых фильтров

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

= А*ь 0 + Ъ = Мхь 0 + vh (1)

где х — вектор состояния размерностью (пх1); ^ — шум процесса (пх1); г — вектор измерения (тх1); V — шум измерения (тх1); м> и V имеют нулевое математическое ожидание и соответственно ковариационные матрицы Qk и Лк.

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

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

Алгоритм ансцентного фильтра Калмана. В ансцентном ФК распределение состояний аппроксимируется гауссовой случайной величиной (ГСВ), которая затем распространяется аналитически через линеаризацию первого порядка нелинейной системы. Исследования показали, что это приведет к большим ошибкам в истинном среднем значении и ковариации трансформированной ГСВ, к неоптимальной производительности, а иногда и к расхождению. Эта проблема решается с помощью ансцентного ФК, при использовании детерминистического подхода к выборке для получения средних значений и ковариационных оценок с минимальным набором точек выборки. Распределение состояний также аппроксимируется ГСВ, но представлено с использованием минимального набора точек выборки, которые тщательно выбирают так, чтобы полностью охватить истинное среднее значение и ковариацию ГСВ. Когда точки выборки распространяются через истинную нелинейную систему, последующие среднее значение и кова-риация могут быть точно зафиксированы до 3-го порядка разложения в ряд Тейлора для любой нелинейной системы.

В реализации ансцентного ФК вектор состояния обычно определяется как комбинация состояния и шумовых переменных системы, т. е. Хк = [хк, wк, vk]г Первым шагом в алгоритме ан-сцентного ФК является выборка предыдущего распределения состояний, т. е. генерирование сигма-точек посредством ансцентного преобразования (иТ-преобразования). Набор взвешенных выборок, или сигма-точек, детерминированно выбирается таким образом, чтобы они полностью отражали истинное среднее значение и ковариа-цию случайной величины. Выборки распространяются через истинные нелинейные уравнения, и нет необходимости в линеаризации модели. Для расчета статистики нужны 2п + 1 сигма-точек, где п — размерность состояния.

Опишем алгоритм ансцентного ФК для нелинейной системы, заданной формулой (1) [7].

Шаг 1. Определение сигма-точек с помощью оценки состояния хк_ъ ковариационной матрицы ошибок Рк-1 и взвешенных коэффициентов.

Воспользуемся следующими выражениями:

'з/, к-1 = ^к-1' г =0;

1 = + + ). > * =!»2> •••> я;

Яик-1 = -+ ). > 1 = п + 1,п + 2,..., 2п;

п + Х п + Х

X

(1-а2+б);

w<">=w<e> =

2 (п + X)

, г = 1,2,...,2л,

где .^(п + Х)Рк_1 — 1-я строка матрицы квадратного корня, полученной из нижнетреугольной матрицы факторизации Cholesky; 1 = а2(п + к) — п-параметр масштабирования; а — распространение сигма-точек вокруг х (обычно устанавливается на небольшое положительное значение, например, 10-3); к — вторичный параметр масштабирования (обычно равен 0); 5 — предварительное знание распределения х (для гауссов-ских распределений 5 = 2 является оптимальным).

Шаг 2. Предсказание с помощью иТ-преобразования.

Сигма-векторы распространяются через нелинейную функцию для получения набора преобразованных сигма-точек с,к/к-1 = ./(9^1).

Вычислим среднее значение и прогноз кова-риации преобразованных сигма-точек

л- -V2" лл,{т\ ■

К =Е?>'С) -Ъ^ш-г-К)Т+вк-(2)

Набор сигма-точек для измерения определяется из равенства ук/к_1 = И(^к/к-1).

Среднее значение и ковариация предсказанных

измерений вычисляются как

,2л „(и),

\a.tck, а^к>\, . .

<л (5)

а¡ск s 1

1,

где

¿п ^^

гк = 2-а=0№1 У ¡,к!к-1'

Рч = (3)

Шаг 3. Обновление.

Определим кросс-ковариацию РХ2 между предсказанными состояниями и измерениями

=Е?Г0 - ** )(у#.*/*-1 - К )г. (4)

и коэффициент усиления

Оценка состояния хк и ковариационнная матрица ошибок Р' обновляются таким образом:

хк = х- + Кк (гк - );

tr[ Nk ] ;

tr[aMk ];

Nk =Vk -вRk -HkQkHT ;

M = HkAkPkATkHTk;

Vk =

vovo>

[p^-1

1+p

Jfc=l,

k>2

P = P— — KP Kk

Реализация ансцентного ФК часто существенно проще: линеаризация не нужна, нет необходимости в вычислении аналитических якобиевых матриц. К тому же ансцентный ФК — превосходный стандартный расширенный ФК для оценок нелинейного состояния и параметров (идентификации) системы. Ансцентный ФК достигает точности оценки до второго порядка, в то время как расширенный ФК является только приближением первого порядка. Однако, как и расширенный ФК, ансцентный ФК чувствителен к неопределенности модели системы, при наличии которой входные данные не могут отражать реальную модель и фильтрация будет ухудшаться или даже расходиться.

Алгоритм сильного следящего ансцентного фильтра. Нелинейным более гладким алгоритмом, по существу, является сильный следящий ФК. В нем для обеспечения лучшей гладкости оценки состояния вводится субоптимальный коэффициент затухания (Suboptimal Fading Factor), в котором задействован коэффициент смягчения р.

Сильный следящий ансцентный ФК разработан, как было указано выше, на основе комбинации ансцентного ФК и сильного следящего ФК. Для повышения устойчивости ансцентного ФК к неопределенности модели процесса в ансцент-ный ФК непосредственно добавлен коэффициент смягчения, используемый в сильном следящем ФК [10-13].

Матрица субоптимального коэффициента затухания 1к определяется следующим образом

Здесь аг- — априорный коэффициент (aj > 1), р — коэффициент затухания (0 < р < 1), в — коэффициент смягчения (1 < р < 5).

Алгоритм сильного следящего ансцентного ФК аналогичен алгоритму ансцентного ФК со следующими изменениями. Ковариационную матрицу необходимо обновить, т. е. новые значения Р~, Р2 , Р. нуждаются в модификации, а получить их можно путем умножения соотношений (2), (3) и (4) на коэффициент 1к (5):

Р- ={X"(° Ь к -.- хгк )(?,„, к-, - Х- )'*ак}; (6)

р., ='■, {х;;; »•;" ь„ - - к)'^,}; т

К =х

(е*' ^

■)(т

)k}. (8)

В традиционном сильном следящем ансцент-ном ФК априорный коэффициент а, коэффициент затухания р и коэффициент смягчения в, входящие в матрицу субоптимального коэффициента затухания 1к, выбираются эмпирически. Субоптимальный коэффициент затухания включен в весь процесс фильтрации, что приводит к потере точности во временных сегментах определения модели процесса. При изменении динамики объекта необходимо получить коэффициент смягчения в режиме реального времени для обеспечения эффективности фильтрации к вариациям параметров системы. Рациональным подходом видится применение нечеткой модели.

Применение нечеткой логической адаптивной системы (НЛАС) с нечеткими правилами позволяет в режиме реального времени настраивать коэффициент смягчения при изменении динамики объекта. Такая схема может адаптировать коэффициент затухания и, следовательно, повышает производительность оценки. Алгоритм сильного следящего ансцентного ФК с применением нечеткой модели дает многообещающие результаты как в отношении точности, так и возможности отслеживания.

ck =

База нечетких правил (Fuzzy rule base)

Фаззификация Нечеткое рассуждение Дефаззификация

(Fuzzification) ► (Fuzzy inference) ► (Defuzzifîcation)

j ь î

Функции принадлежности (Membership functions)

Рис. 1. Типичная нечеткая система Fig. 1. Typical fuzzy system

Алгоритм сильного следящего ансцентного фильтра с применением нечеткой модели. Типичная нечеткая система состоит из таких компонентов [14, 21], как фаззификация, нечеткое рассуждение (нечеткий вывод) и дефаззификация (рис. 1).

Процесс фаззификации преобразует четкое входное значение в нечеткое значение, нечеткий вывод отвечает за изъятие вычислений из базы правил, а нечеткий процесс дефаззификации превращает нечеткие действия в четкие.

В настоящей статье используется нечеткая система Такаги — Сугено (т — ^-модель), типичное правило которой имеет вид [15-20]:

ЕСЛИ вход Х-1 — /1 и вход Х2 — и ... и вход

Хп =

ТО выход Уk = Мх1, х2, хп) = ck0 + скхх +

+ С^х2 + . + Cknxn,

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

где /г1,..., / — нечеткие множества, ck0 + Скх\ + СкХ2 + . + СК — константы. Коэффициент смягчения Р в сильном следящем ансцентном ФК имеет постоянное значение и не изменяется несмотря на изменение динамики системы. В нечетком сильном следящем ансцентном ФК Р определяется с помощью нечеткой логической адаптивной системы (рис. 2), входами которой являются степень расхождения т и следы ковариационной матрицы обновления X

T

vt vt

m m

it.

s- 1 ' m I

где ук = [уху2 ... уГ1]1; т — количество измерительных устройств.

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

Контролируя параметры т, нечеткая логическая адаптивная система может оперативно настраивать коэффициент смягчения в в соответствии с нечеткими правилами. Впоследствии эта схема может адаптивно корректировать коэффициент затухания 1к, причем повышается эффективность оценки. При уменьшении коэффи-

Рис. 2. Структура нечеткой логической адаптивной системы Fig. 2. The structure of the fuzzy logical adaptive system

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

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

Шаг 1. Инициализация Х0 и Р^.

Шаг 2. Определение сигма-точек с помощью оценки состояния Хк-1, ковариационной матрицы ошибок Рк-1 и взвешенных коэффициентов.

Шаг 3. Вычисление среднего значения оценки и среднего значения измерений с помощью Ш-преобразования.

Шаг 4. Определение коэффициента смягчения в с помощью НЛАС.

Шаг 5. Определение субоптимального коэффициента масштабирования 1к.

Шаг 6. Определение ковариационных матриц

Р-, Р, Р (6)-(8).

Шаг 7. Корректировка матрицы усиления, текущей оценки и матрицы ковариации ошибок.

20 и Р0

%к~ 1 = + (VC" + X)Pk-r)T.,$k-t - У(п + \)Рк-х)Т.

U Tl+A и T14-J ч

n+A

Cm) = (с) = 1 1 2(n+A)

Чк/к-1 = f(4k-i>> 9- „ y2n ,..(«) xk — Z-i=0 wi Si,fc/fc-l

Ук/к-i = Ц$к/к-1]

I

2|r _ Zb

1

V = 1 ym m.A'i = 11%1

KVk

m

НЛАС

Nk = Vk- ßRk - HkQkH\

Mk = Нк^кР к^к^к Г vQvl, к = 1

L 1 + p

tr[Wfc] jpijfc( > 1

i,k — tr[MJ 11. A^ < 1

Xk = d\ag(X1,X2,...,Xm)

Pzk~ ^k {s^o wiC\Yi,k/k-1 ~~ ^fe)C^t^/fe-i — + ^k}

Kk P XZ^ Zfc

xk = xk + Kk(zk ~

Pxk — Pxk ~ К к f*z К к

Рис. 3. Алгоритм сильного следящего ансцентного фильтра Калмана с применением нечеткой модели Fig. 3. Algorithm of a strong tracking Kalman filter with the use of a fuzzy model

Сравнительный анализ точности оценки различными фильтрами

Реализация нечеткой логической адаптивной системы. Для реализации применяется пакет прикладных программ MATLAB с FUZZY TOOLBOX для построения функции нечеткой логики.

Основная идея определения базы нечетких правил системы нечеткой логической адаптивной системы заключается в следующем:

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

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

Т — ^-модель первого порядка для нечеткой логической адаптивной системы имеет два входа (m и X), один выход (Р) со следующими правилами:

ЕСЛИ m — нуль (zero) и X — нуль (zero),

ТО Р = 3m + 3X + 5 (9);

ЕСЛИ m — нуль (zero) и X — маленький (small), ТО р = 3 m + 2X + 4;

ЕСЛИ m — нуль (zero) и X — большой (large),

то р = m + X + 3;

ЕСЛИ m — маленький (small) и X — zero, ТО Р = m + 3X + 2;

ЕСЛИ m — маленький (small) и X — маленький (small), ТО р = m + 2X + 2;

ЕСЛИ m — маленький (small) и X — большой (large), ТО Р = m + X + 2;

ЕСЛИ m — большой (large) и X — нуль (zero), ТО р = X + 1;

ЕСЛИ m — большой (large) и X — маленький (small), ТО р = 1;

ЕСЛИ m — большой (large) и X — большой (large), ТО р = 1.

В процессе фаззификации входных данных использовались имеющиеся в библиотеке пакета MATLAB гауссовские функции принадлежности (рис. 4). По оси абсцисс отложены значения параметра расхождения m, а по оси ординат — их степень принадлежности, за которую принимается значение от 0.. .1.

Известны различные методы дефаззификации: метод центра тяжести (Center of gravity — COG); метод последнего максимума (Last of Maxima Method — LOM); метод медианы (Bisector of Area Method — BOA); метод среднего значения максимума (Mean of Maxima Method—MOM) [21]. B настоящей работе используется метод центра тяжести.

На рис. 5 представлена зависимость коэффициента смягчения р^, X) от динамики системы на основе вышеуказанных нечетких правил (9) с методом дефаззификации COG.

0 ОД 0,2 0,3 0,4 0,5 0,6 0,7 0,8 0,9 1,0 Степень расхождения |и

Рис. 4. Функции принадлежности параметра расхождения ц Fig. 4. Membership functions of the divergence parameter ц

Рис. 5. Моделирование нечеткой логической адаптивной системы

Fig. 5. Modeling a fuzzy logical adaptive system

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

Сравнительный анализ точности оценки различными фильтрами. В качестве примера рассмотрим следующую нелинейную систему

" x1" _X2 "

Х2 = f (x) = X3 + w(t),

_ Х3 _ 0,03 x1 (x2 + x3)

* = Лх) = Х1 + Уф.

Начальные условия: х0 = [0; 0; 1], Р0 = diag[1, 1, 1], время моделирования / = [0,100] с. Заданы ковариационные матрицы Qk и Як шумов процесса и измерения: Q1 = diag[0,01, 0,01, 0,01], Я1 = 0,01.

3,5

Я я 2,5 В

1 I 2,0

1 s. i,5

R Л 1 №

■её 1,0 ■е g

S о â °'5

д Л-1 л »» А,.

л V uW ' vyl J Y 1 -Л-/1 г vyj "Vv

Li

У

/ V

Л V чЛл J л /i V-ч

0 10 20 30 40 50 60 70 80 90 100 Время, с

--р - Ц

Рис. 6. Изменение коэффициента смягчения и степени расхождения во времени Fig. 6. Change in mitigation coefficient and degree of discrepancy in time

S 6 S e

I 5 ■e 4

■e

m

a 3 s ,

Коэффициент смягчения ß Среднеквадратическое отклонение s

х1 х2 х3

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

2 0,0781 0,0768 0,0903

5 0,0610 0,0602 0,0695

Определяемый с помощью НЛАС 0,0636 0,0629 0,0716

при изменении степени расхождения по нечетким правилам, т. е. он регулируется по динамике системы. Это позволяет настроить матрицу субоптимального коэффициента затухания в режиме реального времени (рис. 7).

На рис. 7 представлено изменение коэффициента смягчения в и параметра расхождения т во времени: в меняется с изменением т по нечетким правилам.

Для сравнения точности оценки указанных фильтров используется параметр среднеквадра-тического отклонения с (таблица):

Ù 0 10 20 30 40 50 60 70 80 90 100 Время, с

Рис. 7. Изменение субоптимального коэффициента затухания во времени Fig. 7. Change in suboptimal attenuation coefficient over time

Среднеквадратическое отклонение точности оценки фильтров

Standard deviation of filter estimation accuracy

Моделирование проводилось с различными коэффициентами смягчения: р1 = 2, р2 = 5 и рз, определяемым с помощью нечеткой логической адаптивной системы.

На рис. 6 представлено изменение коэффициента смягчения и степени расхождения во времени. Видно, что коэффициент смягчения меняется

где xi — оценка состояния; x— его фактическое значение; N — количество наблюдений.

Сильный следящий ансцентный ФК с большим значением коэффициента смягчения в = 5 обеспечивает хорошую точность, с меньшим значением коэффициента смягчения в = 2 — лучшую отсле-живаемость, а с применением нечеткой логической адаптивной системы обладает хорошими свойствами для этих обоих случаев, т. е. как для возможности отслеживания, так и для точности оценки.

Выводы

1. В ходе проведенных исследований предложен алгоритм сильного следящего ансцентного ФК с применением нечеткой модели Такаги — Сугено (T — ^-модель) для настройки в режиме реального времени коэффициента смягчения при изменении динамики объекта.

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

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

[1] Куликов Р.С. Сравнение точностей нелинейной фильтрации в расширенном фильтре Калмана и в ансцент-ном фильтре // Радиотехника, 2016. № 9. С. 135-140.

[2] Кудрявцева И.А. Анализ эффективности расширенного фильтра Калмана, сигма-точечного фильтра Калмана и сигма-точечного фильтра частиц // Научный вестник Московского государственного технического университета гражданской авиации, 2016. №№ 224 (2). С. 43-51.

[3] Дмитриев С.П., Степанов О.А., Шепель С.В. Применение методов нелинейной фильтрации в калибровке ИНС // IEEE Труды. Аэрокосмические и электронные системы, 1997. Вып. 33 (1). С. 260-271.

[4] Дегтярев А.А., Тайль Ш. Элементы теории адаптивного фильтра Калмана. М. : Институт прикладной математики им. М.В. Келдыша РАН, 2003. 35 с.

[5] Sage A.P., Melse J.L. Estimation theory with application to communication and control. N.Y : McGraw-Hill, 1972. 496 p.

[6] Merwe R.V.D. Sigma-point Kalman filters for probabilistic inference in dynamic state-space models. Ph.D thesis, OGI school of science & engineering at Oregon Health & Science Uni, 2004.

[7] Julier S.J., Uhlmann J.K. Unscented filtering and nonlinear estimation // Proc. of IEEE, 2004, v. 3, pp. 401-422.

[8] Sudheesh P., Jayakumar M. Nonlinear tracking using unscented // Advances in Intelligent Systems and Computing, 2018, v. 678, pp. 38-46.

[9] Zhang Z., Zhang J. A strong tracking nonlinear robust filter for eye tracking // J. Control Theory Appl, 2010, v. 8(4), pp. 503-508.

[10] Zhou H., Frank P. M. Strong tracking filtering of nonlinear time-varying stochastic systems with coloured noise // Application to parameter estimation and empirical robustness analysis, International Journal of Control, 1996, v. 65 (2), pp. 295-307.

[11] Feng Y., Li X., Zhang X. An Adaptive Compensation Algorithm for Temperature Drift of Micro-Electro-Mechanical Systems Gyroscopes Using a Strong Tracking Kalman Filter // Sensors, 2015, v. 15, pp. 11222-11238.

[12] Narasimhappa1 M., Sabat S.L., Nayak J. Adaptive sampling strong tracking scaled unscented Kalman filter for de-noising the fibre optic gyroscope drift signal // IET Science, Measurement & Technology, 2015, v. 9, iss. 3, pp. 241-249.

[13] Jwo D.J., Lai S.Y. Navigation integration using the fuzzy strong tracking unscented Kalman // Journal of Navigation, 2009, v. 62, pp. 303-322.

[14] Деменков Н.П. Нечеткое управление в технических системах. М.: МГТУ им. Н.Э. Баумана, 2005. 200 с.

[15] Takagi T., Sugeno M. Fuzzy identification of systems and its applications to modeling and control // IEEE Transactions on Systems, Man, and Cybernetics, 1985, v. 15(1), pp. 116-132.

[16] Barragán, A.J., Al-Hadithi, B.M., Jiménez, A., Andújar, J.M. A general methodology for online TS fuzzy modeling by the extended Kalman filter // Applied Soft Computing, 2014, v. 18, pp. 277-289.

[17] Jwo D.J., Wang S.H. Adaptive fuzzy strong tracking extended Kalman filtering for GPS navigation // IEEE Sensors, 2007, v. 7(5-6), pp. 778-789.

[18] Arghavani N., Almobaied M., Guzelkaya M., Eksin I. Online rule weighting for PID-type fuzzy logic controllers using extended Kalman filter // IFAC-Papers OnLine, 2017, v. 50, iss. 1, pp. 6946-6951.

[19] Sasiadek J.Z., Wang Q., Zeremba M.B. Fuzzy adaptive Kalman filtering for INS/GPS data fusion // Proc. 15th IEEE Int. Symp. on Intelligent Control, Rio, Patras, Greece, 2000, pp. 181-186.

[20] Chien-Hao Tseng, Chih-Wen Chang and Dah-Jing Jwo. Fuzzy adaptive interacting multiple model nonlinear filter for integrated navigation sensor fusion // Sensors, 2011, v. 11, pp. 2090-2111.

[21] Пигат А. Нечеткое моделирование и управление. М.: БИНОМ. Лаборатория знаний, 2013. 798 с.

Сведения об авторах

Деменков Николай Петрович — канд. техн. наук, доцент кафедры систем автоматического управления МГТУ им. Н.Э. Баумана, dnp@bmstu.ru.

Чан Динь Минь — аспирант кафедры систем автоматического управления МГТУ им. Н.Э. Баумана, ruxi.tran@gmail.com.

Поступила в редакцию 19.04.2019. Принята к публикации 15.07.2019.

ESTIMATE OF STRONG TRACKING UNSCENTED KALMAN FILTER EFFICIENCY USING A FUZZY MODEL

N.P. Demenkov, Chan Din' Min'

BMSTU, 5, 2nd Baumanskaya st., 107005, Moscow, Russia dnp@bmstu.ru

Unscented Kalman Filter (UKF) using a set of sigma points by means of deterministic sampling, makes it possible to avoid errors caused by linearization, as in the traditional Extended Kalman filter (EKF). However, like the EFK filter, the UKF filter is sensitive to the uncertainty of the system model. In the presence of model uncertainty, the input data cannot reflect the real model and filtering will deteriorate or even diverge. In a Strong Tracking Kalman Filter (STKF), in order to provide better smoothness of state estimation, a suboptimal fading factor is introduced, in which the softening coefficient is used. In Strong Tracking Unscented Kalman Filter (STUKF), developed based on the combination of the UKF and STKF, to increase the stability of the UKF, the softening factor used in the STKF on the UKF is directly added to the uncertainty of the process model. The key parameter in the STUKF is the matrix of the suboptimal fading factor, which depends on three parameters: a priori coefficient; forgetting coefficient and softening factor. The softening factor is used to improve the smoothness of the state assessment. The larger it is, the better the accuracy of the estimate, and the lower the value, the higher the tracking ability. In the traditional STUKF, the softening coefficient is determined empirically and is included in the entire filtering process, which leads to a loss of accuracy in the time segments in which the process model is defined. In this paper, we consider the option of applying the Takagi — Sugeno fuzzy model (T — S-model) to adjust the online softening coefficient when the object dynamics changes. As a result of a comparative analysis of the accuracy of the studied filters to the nonlinear model, it was found that the STUKF using a fuzzy logical adaptive system has a good smoothness of evaluation and the greatest accuracy.

Keywords: strong tracking unscented Kalman filter, suboptimal fading factor, softening coefficient, fuzzy filter, T — S-model

Suggested citation: Demenkov N.P., Chan Din' Min' Otsenka effektivnosti sil'nogo sledyashchego anstsentnogo fil 'tra Kalmana s primeneniem nechetkoy modeli [Estimate of strong tracking unscented Kalman Filter efficiency using a fuzzy model]. Lesnoy vestnik / Forestry Bulletin, 2019, vol. 23, no. 4, pp. 88-97. DOI: 10.18698/2542-1468-2019-4-88-97

References

[1] Kulikov R.S. Sravnenie tochnostey nelineynoyfil'tratsii v rasshirennom filtre Kalmana i v anstsentnom filtre [Comparison of the accuracy of nonlinear filtering in the expanded Kalman filter and in the extension filter] Radiotekhnika, 2016, no. 9, pp. 135-140.

[2] Kudryavtseva I.A. Analiz effektivnosti rasshirennogofil 'tra Kalmana, sigma-tochechnogofil 'tra Kalmana i sigma-tochechno-go fil 'tra chastits [Analysis of the effectiveness of the extended Kalman filter, Kalman sigma point filter and sigma point particle filter] Nauchnyy vestnik Moskovskogo gosudarstvennogo tekhnicheskogo universiteta grazhdanskoy aviatsii [Scientific Herald of the Moscow State Technical University of Civil Aviation], 2016, no. 224 (2), pp. 43-51.

[3] Dmitriev S.P., Stepanov O.A., Shepel' S.V. Primenenie metodov nelineynoyfil'tratsii v kalibrovke INS [Application of nonlinear filtering methods in INS calibration] IEEE Proc. Aerospace and electronic systems, 1997, v. 33 (1), pp. 260-271.

[4] Degtyarev A.A., Tayl S. Elements of the theory of the adaptive Kalman filter. M .: Institute of Applied Mathematics. Mv Keldysh RAS, 2003. 35 p.

[5] Sage A.P., Melse J.L. Estimation theory with application to communication and control. N.Y.: McGraw-Hill, 1972. 496 p.

[6] Merwe R.V.D. Sigma-point Kalman filters for probabilistic inference in dynamic state-space models. Ph.D thesis, OGI school of science & engineering at Oregon Health & Science Uni, 2004.

[7] Julier S.J., Uhlmann J.K. Unscented filtering and nonlinear estimation // Proc. of IEEE, 2004, v. 3, pp. 401-422.

[8] Sudheesh P., Jayakumar M. Nonlinear tracking using unscented // Advances in Intelligent Systems and Computing, 2018, v. 678, pp. 38-46.

[9] Zhang Z., Zhang J. A strong tracking nonlinear robust filter for eye tracking // J. Control Theory Appl, 2010, v. 8(4), pp. 503-508.

[10] Zhou H., Frank P. M. Strong tracking filtering of nonlinear time-varying stochastic systems with coloured noise //Application to parameter estimation and empirical robustness analysis, International Journal of Control, 1996, v. 65 (2), pp. 295-307.

[11] Feng Y., Li X., Zhang X. An Adaptive Compensation Algorithm for Temperature Drift of Micro-Electro-Mechanical Systems Gyroscopes Using a Strong Tracking Kalman Filter // Sensors, 2015, v. 15, pp. 11222-11238.

[12] Narasimhappa1 M., Sabat S.L., Nayak J. Adaptive sampling strong tracking scaled unscented Kalman filter for denoising the fibre optic gyroscope drift signal // IET Science, Measurement & Technology, 2015, v. 9, iss. 3, pp. 241-249.

[13] Jwo D.J., Lai S.Y. Navigation integration using the fuzzy strong tracking unscented Kalman // Journal of Navigation, 2009, v. 62, pp. 303-322.

[14] Degtyarev A.A., Tayl' Sh. Elementy teorii adaptivnogo fil'tra Kalmana [Fuzzy control in technical systems]. Moscow: BMSTU, 2005, 200 p.

[15] Takagi T., Sugeno M. Fuzzy identification of systems and its applications to modeling and control // IEEE Transactions on Systems, Man, and Cybernetics, 1985, v. 15(1), pp. 116-132.

[16] Barragán, A.J., Al-Hadithi, B.M., Jiménez, A., Andújar, J.M. A general methodology for online TS fuzzy modeling by the extended Kalman filter // Applied Soft Computing, 2014, v. 18, pp. 277-289.

[17] Jwo D.J., Wang S.H. Adaptive fuzzy strong tracking extended Kalman filtering for GPS navigation // IEEE Sensors, 2007, v. 7(5-6), pp. 778-789.

[18] Arghavani N., Almobaied M., Guzelkaya M., Eksin I. On-line rule weighting for PID-type fuzzy logic controllers using extended Kalman filter // IFAC-Papers OnLine, 2017, v. 50, iss. 1, pp. 6946-6951.

[19] Sasiadek J.Z., Wang Q., Zeremba M.B. Fuzzy adaptive Kalman filtering for INS/GPS data fusion // Proc. 15th IEEE Int. Symp. on Intelligent Control, Rio, Patras, Greece, 2000, pp. 181-186.

[20] Chien-Hao Tseng, Chih-Wen Chang and Dah-Jing Jwo. Fuzzy adaptive interacting multiple model nonlinear filter for integrated navigation sensor fusion // Sensors, 2011, v. 11, pp. 2090-2111.

[21] Pigat A. Nechetkoemodelirovanie i upravlenie [Fuzzy modeling and control]. Moscow: BINOM. Laboratoriya znaniy, 2013, 798 p.

Authors' information

Demenkov Nikolay Petrovich — Cand. Sci. (Tech.), Associated Professor of the Department of Control

System BMSTU, dnp@bmstu.ru

Chan Din' Min' — Pg., Department of Control System BMSTU, ruxi.tran@gmail.com.

Received 19.04.2019.

Accepted for publication 15.07.2019.

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