случайного процесса, который он фильтрует.
2) Фильтр Калмана оптимален для реального процесса только
в том случае, если реальный процесс близок к модели,
которую мы используем.
Многомерный фильтр Калмана
(1) , где
- текущее время, -
- вектор (столбики)
A - матрица k´k, H - матрица m´k.
- вектор,
- шум наблюдения
;
- шум динамической системы.
Запишем (1) в скалярной форме. covx=Q, covh=P.
Многомерный фильтр Калмана для модели (1) :
,
где - вес,
- невязка.
; где
- единичная матрица
=
Г
; Начальные условия задаются из аппри-
Г ; орных условий
.
- транспони-
рованная матрица (сопряженная).
Траекторные изменения
Часто требуется получить оценку траектории летательного
аппарата. Летательный аппарат может быть зафиксирован с
помощью радиолокатора, либо некоторой навигационной сис-
темой.
Летательный аппарат рассматривается в некоторой сис-
теме координат :
Если известны точно все 9 коор-
Z динат (см.ниже), то можно точ-
л.а. но навести ракету. Для определе-
ния всех координат существуют
р X траекторные фильтры, которые
строятся на базе фильтра Калмана.
Y
Траекторный фильтр 2-го порядка
(1) ; a<1
Первые две строки (1) - это модель, последняя строка -
- наблюдение.
Составим многомерный фильтр Калмана , для этого по мо-
дели (1) составим многомерную модель.
;
(2) ;
;
; H=[1,0]
Из формулы (2) имеем :
;
;
;
;
Траекторный фильтр 3-го порядка
(4) , первые две строки - модель,
последняя строка - наблюдения
;
;
;
;
H = [1,0,0] ;
;
;
Теория нелинейной фильтрации
Здесь нелинейные модели записываются в виде :
(1) ; здесь : верхняя функция - нелиней-
ная регрессия, нижняя - уравнение наблюдений.
Функция генерирует на любом интервале неко-
торый случайный процесс . Это есть модель неко-
торого случайного процесса, более богатая, чем все преды-
дущие модели.
Уравнение наблюдений : наблюдается не сама , а не-
которая функция j();наблюдения ведутся на фоне шумов
- шум нелинейной динамической системы (шум модели)
1) Требуется найти оценку , такую, чтобы :
(2)
Формула (2) - критерий минимума среднеквадратической
ошибки.
2) Требуется получить реккурентную оценку, такую же как в
фильтре Калмана.
В чистом виде получить оптимальную оценку нельзя, есть
лишь приближенные решения, когда функции f(x) и j(x) -
- линеаризуются.
Тейлоровская линеаризация - используется ряд Тейлора,
линейная часть (1-я, 2-го
члена). ( j(x) и f(x) - имеют непрерывные первые про-
изводные).
Разложение в ряд Тейлора в точке
где - оценка, которую мы еще не знаем, но собираем-
ся находить.
Эти линеаризованные функции подставим в (1) и получим
линейную систему :