Добавил:
Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:

книги из ГПНТБ / Свешников А.А. Вероятностные методы в прикладной теории гироскопов

.pdf
Скачиваний:
27
Добавлен:
27.10.2023
Размер:
18.8 Mб
Скачать

§ 9 . 6 ] СУЩНОСТЬ МЕТОДА ОПТИМАЛЬНОЙ ФИЛЬТРАЦИИ КАЛМАНА

4 8 7

§ 9.6. Сущность метода оптимальной фильтрации Калмана

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

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

Пусть имеется в общем случае нестационарная система,

характеризуемая

п случайными

функциями Х х (t), Х 2 (і), . . .

. . ., Х п (t), образующими н-мерный вектор X (t),

который будем

называть вектором состояний системы.

 

 

Предположим далее, что вектор состояний динамической си­

стемы удовлетворяет следующей системе уравнений:

 

^

= F (t) X(t) + G (t) U(t),

 

(9.54)

где F (t), G (t) — матрицы размерности [ßXn],

[nXH

соответ­

ственно; U (t)—r-мерный вектор,

компоненты которого

линейно

связаны со случайными функциями

типа белого

шума

и имеют

нулевые математические ожидания и корреляционные функции компонент, определяемые равенством *)

M[Uj(t)U,(T)] = qjl(t)b(t— :)

(/, 1 = і , 2 , ... , г).

'(9.55)

•Здесь

 

 

Q ( 0 =

IIQji (О II

(9-56)

— положительно определенная симметричная матрица размерности [гхН, а § {tО — дельта-функция.

Вектор V (t) является входным сигналом и характеризует собой помеху на входе системы.

*) В работах, в которых излагается метод Калмана, для обозначения корреляционной матрицы компонент вектора V (г) используют символ «соѵ», т. е. полагают

соѵ [17(0, 17(01 = М [17(0, V' (т)] = Q ( t ) b ( t ~ z ) ,

где штрих означает символ транспонирования. В § 9.6 приняты обозначе­ ния Калмана, отличающиеся от обозначений в главе 9 данной книги.

32 *

488 В Ы Б О Р О П Т И М А Л Ь Н Ы Х С Х Е М И П А Р А М Е Т Р О В Г У [ Г Л . 9

С вектором X (t) соотношением

Y ( t ) = H ( t ) X ( t ) ,

(9.57)

где Я (і) — матрица размерности [ тХв ],

связан вектор Y (t),

компоненты которого определяются с ошибками V (t).

Следовательно, вместо вектора Y (t) результаты измерения

дают компоненты вектора Z (t), связанного

с Y (t) выражением

Z( t ) = Y ( f ) + V(t ),

(9.58)

где ошибки измерения V (t) в теории Калмана предполагаются линейно связанными с белым шумом и имеют нулевые математи­ ческие ожидания, а корреляционные функции компонент вектора V (t) определяются формулой

м [Vj ѴІ (Т)] = ГЛ (t) 3 (t-z)

(/, I = 1, 2, ..., m),

(9.59)

где мат])ица

Л(0=ІІО«(01

(9.60)

— симметричная положительно определенная матрица размер­ ности \тХт]. Предполагается, что компоненты вектора U (t) некоррелированы с компонентами вектора V (t). Объединяя (54) с (58) и учитывая (57), получим систему уравнений, характеризую­ щую состояние рассматриваемой динамической системы

*xgL = F(t)X(t) + G(t) U{t),

(9.61)

Z(t) = H{t)X(t) + V{t).

Так как в общем случае матрицы F, G, Н могут изменяться со временем, то система уравнений (61) характеризует нестацио­ нарную динамическую систему, уравнения которой имеют пере­ менные коэффициенты.

Если все элементы матриц F, G, Н постоянны, то система (61) является стационарной. Если II (t)=0 (или G=0), то система называется свободной.

Пусть t0 — начальный момент времени, тогда вектор X (t{)) характеризует начальное состояние системы и является вектор­ ной случайной величиной с нормальным распределением.

При сделанных предположениях векторы X (t) и Y (t) также будут нормальными.

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

В соответствии со сказанным первое уравнение системы (61) является уравнением формирующего фильтра. Поэтому иногда говорят, что в методе Калмана используется задание случайного

§ 9 . 6 ] СУЩНОСТЬ МЕТОДА ОПТИМАЛЬНОЙ ФИЛЬТРАЦИИ КАЛМАНА

489

процесса с помощью формирующего фильтра. На рис. 9.2 приве­ дена матричная блок-схема, соответствующая системе уравне­ ний (61).

Здесь фактически используется п интеграторов; квадратик

собозначением F it) показывает, как осуществляется обратная связь в системе; так, например, / ._z (t) есть коэффициент передачи

свыхода Z-ro интегратора на вход j-то интегратора.

Из теории линейных дифференциальных уравнений известно, что все решения этих уравнений выражаются через так называе­ мую фундаментальную матрицу решений Ф (t, t0), являющуюся переходной матрицей для системы уравнений. Матрица Ф (t , tQ)

Рис. 9.2. Матричнаяблок-схема,

соответствующая системе уравнений (9.61).

являетсяневырожденной и

удовлетворяетдифференциальному

уравнению

 

 

 

 

 

 

 

 

 

 

 

=

g ,

(9.62)

при начальном условии

 

ф (д

*о) = і<

 

(9.63)

 

 

 

 

где I — единичная

матрица.

[см. (61)]

можно записать

в виде

Тогда решение

для

X

(t)

 

 

 

 

 

t

 

 

X (t) = Ф (t,

g

X (g

-j- (j Ф (t,

i) G (т) и (-) dr.

(9.64)

Если F = const,

 

 

 

 

to

 

 

t o

Ф(і, g = ef ('- 4

 

(9.65)

 

 

 

Рассмотрим систему дифференциальных уравнений, характе­

ризующих алгоритм фильтра

Калмана.

При этом будем иметь

в виду случай непрерывного

фильтра,

теория которого

развита

в статье Р. Калмана и Р. Бьюси *).

Случай дискретного фильтра был рассмотрен в более ранней статье Р. Калмана *) и используется нами в примере 9.5.

*) См. подстрочное примечание на стр. 475.

490

В Ы Б О Р О П Т И М А Л Ь Н Ы Х ! С Х Е М И П А Р А М Е Т Р О В Г У

[ Г Л . 9

 

Предположим, что

линейная

нестационарнаядинамическая

система описывается

векторным

дифференциальным

уравне­

нием (61).

 

 

 

 

В момент времени t0 начальное состояние системы характери­

зуется вектором X (t0), который представляет собой нормальную

векторную случайную величину,

не зависящую от U (t) и V (t),

с

заданным математическим ожиданием

 

 

М [X(t0)]=^x0

(9.66)

и

корреляционной матрицей Р (t0) = fl p . t (t0)||, где

 

 

Pit (t0) = м {[Xj (t0) -

x 0J \ rx, (g - x j)

 

 

(/, /=,-.1,

2, ... , n);

(9.67)

P (t0) — симметричная матрица компонент вектора X

(t0) размер­

ности \пХп].

 

 

 

Корреляционная матрица P(t0) часто представляет собой ди­

агональную матрицу, элементы которой равны дисперсии компо­

нент

вектора состояния.

 

Задачей оптимальной фильтрации является нахождение наи­

лучшей оценки X (t) выходных данных

системы, т. е. требуется

 

а

X (t) динамической сис­

определить оценку X (t) состояния

темы,

описываемой уравнениями (61),

на основании измерения

наблюдаемого сигнала Z ( t) на интервале^ времени U0, £]. Дина­ мическая система, определяющая вектор X (t), называется фильт­ ром. Оценка X (t) является действительным выходным сигналом фильтра. Требуемым выходным сигналом является вектор состоя­ ния X(t) . Разность Е (t) между требуемым^ выходным сигналом

X (t) и действительным выходным сигналом X

(t) называется ошиб­

кой оценки или ошибкой фильтра

 

E(t) = X (t) — X(t).

|(9.68)

В качестве критерия оптимальности принимают условие, при котором вектор X (t) должен представлять собой несмещенную *) оценку X (t) и минимизировать дисперсию ошибки Е (t).

Калманом было показано, что решением задачи оптимальной фильтрации является оценка X (t) — выходная величина динами­ ческой системы, описываемой уравнением

= F

( t ) -% ) + К

(t) [ Z(t) — Н (t) X (t)\,

(9.69)

причем

 

 

 

______________

£ ( g

= %

(9.70)

*) Условие несмещенности состоит в равенстве нулю ошибки воспроиздения или преобразования неслучайной (систематической) составляющей полезного сигнала.

§ 9 . 6 ] СУЩНОСТЬ МЕТОДА ОПТИМАЛЬНОЙ ФИЛЬТРАЦИИ КАЛМАНА

491

Выражение (69) называется дифференциальным уравнением оптимального фильтра, который «возмущается» наблюдаемым сигналом Z (t) и дает на выходе наилучшую линейную оценку X (і) состояния X (t) динамической системы. Входящая в (69) матрица К (t) представляет собой матричный коэффициент уси­ ления оптимального фильтра. На рис. 9.3 приведена блок-схема фильтра Калмана, из которой следует, что оптимальный фильтр содержит модель формирования полезного сигнала, на которую

Рис. 9.3. Блок-схема фильтра Калмана.

через переменные коэффициенты усиления ^поступает разность между наблюдаемым сигналом Z (t) и H(t)X (t).

Для оптимальной экстраполяции полезного сигнала Калманом получено выражение

 

Х ( і 1) = ф{і1,

t)X(t)

( f , > 0 ,

 

(9.71)

где Ф (П, t) — переходная матрица [см. (62)].

 

 

Ошибка оценки Е (t) [см.

(6 8 )]

характеризуется уравнением,

аналогичным (69), т. е.

 

 

 

 

 

 

Ц Р - — F{t)E (t) + G ( t ) U ( t ) - K ( t ) [ V {t) + H { t) E (t)l

(9.72)

Введем обозначение P (t) =

||p ., (t) ||,

где

 

 

 

Pj, (t) = M [E. (t) E, (0] = M {[X. (t) -

It, (0] [X, (t) -

X, (0]}

 

 

 

 

(i,

l =

\, 2,

n).

(9.73)

Здесь

P (t) является симметричной

матрицей размерности

IпХп] и

представляет собой

корреляционную матрицу

ошибки

оптимальной оценки. Начальное значение Р (^0) этой корреляцион­ ной матрицы характеризуется выражением (67) и предполагается известным.

492

ВЫ БОР ОПТИМАЛЬНЫХ СХЕМ И ПАРАМЕТРОВ ГУ

[ГЛ. 9

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

K{t) = P{t)H' (t)R~l {t),

(9.74)

где R~x (t) — обратная матрица по отношению к R (t) [см. (60)]. Для корреляционной матрицы Р (t) ошибки оценки Калманом

было получено уравнение

*EM=F{t)PQ) + P (t) F' (t) - P (t) H' (t) R -1 (t) H (t) P (t) +

 

+ G(t)Q(t)G'(t)

(9.75)

при начальном значении P (t0) корреляционной матрицы, опре­ деляемым выражением (67).

Нелинейное дифференциальное уравнение (75) для корреля­ ционной матрицы ошибки оценки называется корреляционным или дисперсионным уравнением. Корреляционное уравнение пред­ ставляет собой систему п (га+1 ) / 2 дифференциальных уравнений типа Риккати. Таким образом, решение задачи оптимальной фильтрации дается системой уравнений (69), (74), (75), образую­ щей алгоритм фильтра Калмана. При этом должны быть заданы

начальные условия в виде начальной

оценки X ( t 0) = x 0 состоя­

ния системы и начального значения

корреляционной матрицы

Р (t0) ошибки оценки. Следовательно, в методе Калмана опти­ мальный оператор представляет собой оператор линейного диффе­ ренциального уравнения, при этом непосредственно определяется дифференциальное уравнение (69) оптимального фильтра. Реше­ ние задачи оптимальной фильтрации сводится к нахождению реше­ ния матричного нелинейного дифференциального уравнения (75) относительно корреляционной матрицы Р (t) ошибок оценки и к последующему определению с помощью формулы (74) матрич­ ного коэффициента усиления К (t), входящего в дифференциаль­ ное уравнение (69) оптимального фильтра.

Для решения задачи оптимальной фильтрации должны быть известны модели формирования полезного сигнала (матрицы F (t) и G (t)) в первом уравнении (61)) и наблюдаемого сигнала (матрица Н (t) во втором уравнении (61)).

При решении задачи на ЦВМ дискретные аналоги дифферен­ циального уравнения (69) оптимального фильтра и дифференциаль­ ного уравнения (75) для корреляционной матрицы ошибок оценки являются рекуррентными выражениями, предполагающими при­

менение пошаговой

обработки данных наблюдений. При

этом

на

первом шаге

определение оценки

X (t) производится

на основании измерения Z(t0) и начальных значений х а, -Р(і0),

что

дает

возможность

вычислить значение

<корреляционной

мат­

§ 9 - 6 ] С У Щ Н О С Т Ь М Е Т О Д А О П Т И М А Л Ь Н О Й Ф И Л Ь Т Р А Ц И И К А Л М А Н А

493

рицы ошибок оценки Р (t), использование которой на последую­ щем шаге обработки дает возможность осуществить дальнейшее уточнение оценки X (t).

Применение пошаговой процедуры обработки информации

связано с тем, что, как видно

из алгоритма

фильтра

Калмана,

рассматриваемый метод оптимальной

фильтрации сводится

к об­

ращению матриц, ранг которых равен числу измерений.

Увеличе­

ние числа измерений приводит

к повышению

ранга

обращаемой

матрицы, а следовательно,

к

увеличению

объема

вычислений.

Поэтому в данном методе предусмотрена

пошаговая

обработка

данных наблюдений.

когда

матрицы

F (t),

G (t),

Н (t)

В стационарном случае,

не зависят от времени, корреляционная

матрица

Р (t)

оши­

бок оценки превращается в постоянную величину. Следовательно, в устойчивом состоянии системы коэффициент усиления К (t) также будет постоянным.

При указанных условиях оптимальный фильтр будет стацио­ нарным и его дифференциальное уравнение, согласно (69), при­

мет вид

 

^ l = [F — KH] ±{ t ) + KZ(t)l

(9.76)

и во временной области эквивалентно фильтру Винера, который

вчастотной области определяется из решения интегрального уравнения Винера—Хопфа.

Алгоритм фильтра Калмана, образуемый дифференциальными уравнениями (69), (74), (75), достаточно удобен для реализации его

вреальном масштабе времени с помощью цифровых вычислитель­ ных машин.

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

лого шума.

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

При реализации фильтра Калмана важным является обеспе­ чение его устойчивости.

4 9 4

ВЫ БОР ОПТИМАЛЬНЫХ СХЕМ И ПАРАМЕТРОВ ГУ

[ГЛ. 9

Вопросы существования, единственности и устойчивости реше­

ния

корреляционного уравнения рассматриваются в

статье

Р.

Калмана и Р. Быоси *).

 

Для того чтобы оптимальный фильтр был равномерно (экспо­ ненциально) асимптотически устойчивым, достаточно, чтобы мо­ дель формирования полезного сигнала (61) была равномерно полностью наблюдаемой и равномерно полностью управляемой **), а нормы матриц F(t), Q(t), R(t) удовлетворяли бы некоторым не­ равенствам. Показано, что оптимальный фильтр является равно­ мерно асимптотически устойчивой динамической системой.

При этом корреляционное уравнение представляет собой

устойчивый

вычислительный

процесс, который нечувствителен

к незначительным ошибкам.

обладающий равномерной асимпто­

Заметим,

что фильтр, не

тической устойчивостью, может иметь неограниченную реакцию на ограниченное возмущение и практическое применение подоб­ ного фильтра нецелесообразно.

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

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

а) отличие реальной модели процесса от принятой при рас­ чете;

б) ошибки машинного счета, вызванные ошибками округления

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

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

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

*) См. подстрочное примечание на стр. 475.

**) Понятия наблюдаемости и управляемости динамической системы подробно разъяснены, например, в книге Я. Н. Р о й т е н б е р г а , Авто­ матическое управление, «Наука», 1971.

5 9 . 6 ] С У Щ Н О С Т Ь М Е Т О Д А О П Т И М А Л Ь Н О Й Ф И Л Ь Т Р А Ц И И К Л Л М Л Н А 495

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

Практическая реализация метода оптимальной динамической фильтрации предъявляет значительные требования в отношении объема вычислений. Были рассмотрены различные возможности сокращения вычислений путем использования субоптимальных фильтров. Один из способов решения этой задачи состоит в ис­ ключении из корреляционной матрицы ошибок оценки P(t) тех элементов, которые незначительно влияют на работу системы.

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

Достоинствами рассматриваемого метода оптимальной фильт­ рации являются:

1)Он дает, как и другие методы оптимизации, наилучшие в смысле минимума погрешности возможные оценки, исходя из из­ вестных вероятностных характеристик как входных переменных, так и ошибок измерений.

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

3)Этот метод позволяет получить при решении оптимальной задачи непосредственно структуру оптимального фильтра, кото­ рая практически может быть осуществлена.

4)Оптимальный фильтр Калмана озволяет решать задачи синтеза многомерных динамических систем, что существенно рас­ ширяет область его применения.

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

для конечного и бесконечного времени наблюдения.

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

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

496

В Ы Б О Р О П Т И М А Л Ь Н Ы Х С Х Е М И П А Р А М Е Т Р О В ГУ

[ Г Л . 9

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

Здесь они применяются при решении различных задач, в част­ ности, при первоначальной выставке гиростабилизированных площадок, при осуществлении демпфирования ИНС по скорости и коррекции координат места, для улучшения динамических свойств различных устройств ИНС при отсутствии внешней инфор­ мации, для определения источников ошибок различных инерциаль­ ных приборов и осуществления их коррекции, при решении задач гирокомпасирования (определение курса объекта без использо­ вания гирокомпаса), при разделении действительных ускорений объекта от «ускорений», вызванных инструментальными ошиб­ ками инерциальных приборов с целью уменьшения их влияния на точность навигации и т. д.

§9.7. Примеры определения оптимальных схем

ипараметров ГУ

Рассмотрим несколько примеров определения оптимальных систем, поясняющих решение задач трех типов, указанных в § 9.1:

а) определение оптимальной динамической системы без ка­ ких-либо ограничений, наложенных на ее структуру;

б) нахождение параметров ГУ при заданной его структурной схеме;

в) определение корректирующего устройства при заданной неизменяемой части гироскопической системы (гироскоп и другие элементы).

Пример 9.1. Определить оптимальную передаточную функцию измерителя угловой скорости бортовой качки корабля (гиротахо­ метра), если память системы не ограничена, угол крена 6(t) — стационарная случайная функция, а на вход системы поступает сумма полезного сигнала £/(£)= Ѳ(2) и помехи V(t), возникающей вследствие различных возмущающих факторов. Дано, что й—г>=0,

а спектральная плотность

S u ( со)

определяется

формулой

(2.15)

SuИ =

2 о2р

Ъ1

 

 

( £ 2 =

Р2 + X2, а*=

\х\— \ 3).

(9.77)

0)4 -f- 2 а-со2

 

 

В целях упрощения задачи примем сперва, что V(t) можно

считать белым шумом, т.

е.

положим

 

 

 

 

 

5

»

=

- é r c ’

 

<9-78)

где С — интенсивность

белого

шума.

S v ( ш) является

Сделанное

предположение

о

постоянстве

приближением,

которое

тем

 

лучше соответствует действитель-

Соседние файлы в папке книги из ГПНТБ