Файл: Медич Д. Статистически оптимальные линейные оценки и управление.pdf
ВУЗ: Не указан
Категория: Не указан
Дисциплина: Не указана
Добавлен: 11.04.2024
Просмотров: 266
Скачиваний: 1
Калмана также является фильтром с минимальной дис персией.
При выводе соотношения (5-51) для корреляционной матрицы ошибки фильтрации вначале было получено уравнение (5-62):
P(k+l\k+l)=[I—K(k+l)H(k |
+ l)]X |
XP(k + l\A)lI—K(k+l)H(k+l)Y |
+ |
+K(k+l)R(k+l)K'(k+l).
Это равенство справедливо для любой матрицы переда чи K(k+l). Однако оно приводит к уравнению (5-51) только в том случае, если использовать оптимальную ма трицу передачи из уравнения (5-49). Следовательно, уравнение (5-62) является общим выражением для кор реляционной матрицы ошибки фильтрации произвольно го линейного фильтра, имеющего структуру рис. 5-5.
Пример 5-2. Рассмотрим случайный процесс, описываемый ска лярным соотношением
|
|
|
х(А+1) = |
(—l)«+'x(fe) |
|
|
|
|
|
|
|||
для k=0, |
1, ..., где х(0) |
— гауссовская |
случайная величина |
с |
нуле |
||||||||
вым математическим ожиданием |
и дисперсией Р(0). |
Процесс в каж- |
|||||||||||
|
|
|
|
|
|
|
|
|
|
' |
и(к+П |
||
, |
I |
,1 |
|
|
ï |
,* |
Н И ) ZK*' |
|
|
|
|
||
і |
" |
|
I * |
|
5 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||
х(к) |
|
|
|
|
|
|
БЗ |
|
|
|
|
|
|
о |
I / |
гТ |
|
|
|
|
Рис. 5-7. Структурная схе |
||||||
|
|
|
|
ма системы из примера 5-2. |
|||||||||
Рис. 5-6. Выборочные функции |
слу |
дыи |
момент |
отсчета |
имеет |
||||||||
одну |
и ту |
же |
абсолютную |
||||||||||
чайного процесса |
с дискретным |
вре |
величину |
и |
меняющийся |
||||||||
менем. |
|
|
|
|
|
знак. Две выборочные функ |
|||||||
|
|
|
|
|
|
|
ции процесса изображены на |
||||||
|
|
|
|
|
|
|
рис. |
5-6. |
|
|
|
|
|
Предположим, |
что процесс |
наблюдается |
в присутствии |
аддитив |
|||||||||
ной |
гауссовской |
белой |
последовательности |
{v(k+l)y |
|
ft=0, |
1 |
. . . } |
|||||
е..нулевым |
математическим ожиданием |
и дисперсией |
R(k+l). |
|
Тогда |
||||||||
уравнение |
измерения имеет вид z(k+ |
1) — x(k + 1) +v |
(k+1) |
; k=0, |
1 .-.. |
и модель динамической и измерительной системы может быть пред
ставлена в виде рис: 5-7.'Отсюда |
Ф(й + 1, к) *= ( — l ) 2 ^ 1 , a H(k+1) = 1. |
14* |
211 |
Из уравнения (5-48) получаем уравнение фильтра
x(k*f |
l|fe-f ,!) = |
(— l ) 2 h + , . x > | Ä ) + |
+ K(k+ |
l ) [ z ( * + |
1 ) - ( - 1 ) ^ + ' х ( О Д ] |
с начальным условием х(0|0) = 0. Структурная схема фильтра изо бражена на рис. 5-8.
х(к+1/к+1)
г(н+і)—ін»
f - r ) 2 * + ' |
S3 |
Рис. 5-8. Структурная схема оптимального фильтра из при мера 5-2.
Так как внешние возмущения динамической системы отсутствуют, то Q(k)=0 для всех k=0, 1 .. . и уравнение (5-50) для рассматри ваемого примера принимает вид:
|
P(k+\\k) |
= (— 1)2 *+Ф(/г|/г)(— \)mi |
= P(k\k). |
|
(5-66) |
|||||||
Коэффициент |
передачи |
оптимального |
фильтра |
|
составляет |
|||||||
|
|
|
|
|
|
|
|
|
|
Р (k\k) |
||
K{k+l) |
= P (k\k) [Р (k\k) + |
R(k + |
l)]-« = p |
m |
+ |
R |
\ k + [ y |
|||||
|
|
|
|
|
|
|
|
|
|
|
|
(5-67) |
Подставляя |
эти два |
результата |
в |
уравнение |
(5-51), получаем |
|||||||
уравнение |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
1 — |
Р (k\k) + |
R(k+l)\и |
|
( R ] R |
) |
~ |
||
|
|
|
|
R(k+\)P(k\k) |
|
|
|
|
|
|||
|
|
|
|
" />(*/*) + |
/?(*+!)• |
|
|
|
V~W> |
|||
для 6=0, |
1 |
с начальным условием Р(0 JO) = Р ( 0 ) . |
|
|
|
|||||||
Вычисления в этом случае чрезвычайно просты. Рассмотрим вна |
||||||||||||
чале дисперсию |
P(k\k), |
равную |
Р(0) |
при k—0. Дисперсия ошибки |
||||||||
предсказания согласно уравнению (5-66) равна P(k\k). |
Коэффициент |
|||||||||||
передачи легко определить с использованием уравнения |
(5-67). Из |
|||||||||||
уравнений |
(5-67) и (5-68) |
имеем: |
|
|
|
|
|
|
|
|||
|
|
|
P(k+l\k+[)=R(k+\)K(k+\). |
|
|
|
(5-69) |
|||||
Очевидно, |
для |
вычислений |
можно |
ограничиться |
уравнениями |
|||||||
(5-67) и (5-69). |
|
|
|
|
|
|
|
|
|
|
|
|
Дисперсия |
ошибки |
фильтрации, |
удовлетворяющая |
уравнению |
||||||||
(5-68), имеет следующее |
свойство: |
|
|
|
|
|
|
|||||
|
|
P(k+l\k+l)^mm[P(k\k), |
|
R(k+\)]. |
|
|
|
212
Этот |
результат |
следует |
из правой части уравнения (5-68) |
и того, |
|||||||
что величины R(k+l) |
и P(k\k) |
представляют собой дисперсии и по |
|||||||||
этому неотрицательны |
для всех |
й=0,1 . |
. . |
Приведенное здесь |
нера |
||||||
венство |
означает, |
|
что |
P(k-\-\\k+\)—монотонно |
невозрастающая |
||||||
функция |
k. Если |
дисперсия |
Р(010) |
строго |
положительна, a |
R(k+l) |
|||||
положительна и конечна для всех k, то |
|
|
|
|
|||||||
|
P{k+ 1 |
1) < m ï n [P(ft|Ä), |
R(k+\)] |
|
|||||||
и поэтому P(k+\\k |
|
+ \)—монотонно |
убывающая |
функция k. |
|
||||||
Если |
величина R(k-\-\) |
бесконечно |
велика |
для некоторого зна |
|||||||
чения k, |
то P(k+ |
l\k+ |
\) = |
P(k\k), |
K(k |
+ |
1) = |
0 и |
|
||
|
x(k |
+ |
l\k+ |
1) = (— |
\y*+lx{k\k). |
|
Этот результат согласуется с разумными физическими соображе ниями, поскольку если дисперсия ошибки измерения бесконечна, то соответствующее измерение, очевидно, бесполезно. С другой стороны, если дисперсия R(k+\) равна нулю для некоторого k, то из уравне ния (5-67) следует, что K{k+l) = \ и уравнение фильтра принимает вид
x{k + l\k+ l)=z(k + 1).
Этот результат также не является неожиданным, поскольку если дисперсия ошибки измерения равна нулю, то измерение само по себе достаточно «хорошо» и дает точное значение x(k+\). Уравнение (5-68) в этом случае превращается в Р(к+1 \k+1) =0 и дальнейшая фильтрация становится точной. Более того, замечая, что
x(k+ |
1) = (_1)<Ä + I >'x(0), |
k = |
0, 1..., |
|||
получаем, что если |
значение |
x(k+l) |
известно |
точно |
для некоторого |
|
k, то значение х(0) |
также |
может |
быть |
определено |
точно, и, таким |
образом, состояние системы становится точно известным для всех fe=0, 1 .. .
В заключение рассмотрим равновесное или «установившееся» ре шение уравнения (5-68) при больших значениях k. В предположении, что P{k+\\k+1) =P(k\k) = Р, уравнение (5-68) принимает вид
, |
R(k+\)P |
|
|
|
F - |
P + R(k+\) |
• |
|
|
Очевидное решение этого |
уравнения Р=--0. |
Так как |
P(k+\\k+\) |
|
монотонно невозрастающая функция k, то Р=0 |
в этом примере явля |
ется точкой устойчивого равновесия и «установившимся» решением уравнения для дисперсии.
Пример 5-3. Рассмотрим скалярную систему вида |
|
|
|
x(k+l)=<ùx(k)+w{k); |
|
|
z(k+\)=x{k+\)-\-v(k+l) |
|
для &=0, 1 |
где {w(k), k = 0, 1 ...} —гауссовская белая |
последо |
вательность с нулевым средним и постоянной дисперсией Q, |
{v{k+l), |
|
k=0, 1 . ..} гауссовская белая последовательность с нулевым |
средним |
213
и постоянной дисперсией R, х(0)—гауссодская |
|
случайная |
величина |
||||
с нулевым средним и дисперсией |
Р(0), a <D=const. Предполагается, |
||||||
что обе белые гауссовские последовательности |
и х(0) независимы. |
||||||
Уравнение оптимального фильтра имеет вид: |
|
|
|||||
x(k + \\k+ 1) = |
Фх (k\k) + К {k + |
1) [z(k+ |
\)—tôc(k\k)]. |
(5-70) |
|||
Из уравнений (5-50) и (5-49) получаем: |
|
|
|
|
|||
|
Р(Ь+Цк) |
= |
Ф*Р(Щ |
+ |
Я; |
(5-71) |
|
K(k+l) |
= [ф»р (Щ |
+ Q] [Ф*Р (k\k) + Q + R] - • |
= |
|
|||
|
- |
VP№ + Q |
|
|
( 5 |
m |
|
|
Ф2Р(Щ |
+ <2 + Я |
|
V-IZ> |
соответственно. Тогда уравнение для дисперсии ошибки фильтрации
принимает вид: |
|
|
Ф 2 Р (k\k) + |
Q |
|
|
|
||
P(k+l\k+l) |
|
1 — |
X |
|
|
||||
|
Ф 2 Р (k\k) + Q + R |
|
|
||||||
|
X [Ф*Р №) |
|
R [Ф2Р (klk) + Q] |
|
(5-73) |
||||
|
+ Q] = ф ^ ^ У о ^ к |
|
|||||||
при начальном условии |
Р ( 0 | 0 ) = Р ( 0 ) . |
|
|
|
|
|
|||
Из уравнения (5-71) |
ясно, что P(k+1 |
\k) 5sQ, так как |
P(k\k)^0. |
||||||
Это означает, что предельная точность |
предсказания |
определяется |
|||||||
дисперсией возмущения. |
|
|
|
|
|
|
|
|
|
Из уравнения (5-72) следует, что коэффициент передачи фильтра |
|||||||||
изменяется в пределах 0^K(k+1) |
^ 1, если не учитывать |
тривиаль |
|||||||
ный случай P(k\k)=Q=R |
|
= Q. Если объединить |
уравнения |
(5-72) и |
|||||
(5-73): |
P(k+l\k+\)=RK(k+l), |
|
|
|
|
|
|||
|
|
|
|
|
|
||||
то становится |
очевидным, |
что 0^.Р(к+1 |
\k+1) |
для k=0, |
1 . . . |
||||
В результате |
получим, что если Р ( 0 ) » р , |
то первое измерение |
приве |
дет к значительному уменьшению дисперсии ошибки фильтрации от Р(0) до Р(1|1)== £ Р<Р(0) .
В |
частном |
случае, когда |
Q » P , из |
уравнений |
(5-72) и (5-73) |
можно |
видеть, |
что К(к+\)л1 |
и P(k+1|£ + 1) « Р |
для всех k— |
|
=0, 1 .. . В этом случае, предел точности |
фильтрации, очевидно, опре |
||||
деляется дисперсией ошибки измерения. |
|
|
Взаключение исследуем установившееся решение уравнения
(5-73) |
в предположении Q=0. Полагая Р(/г+1 \k+1) =P(k\k) =Р и |
||
Q=0, |
получаем уравнение |
|
|
|
- |
_ |
#Ф2 іР |
|
Р |
~ |
Ф 2 Р + R ' |
которое имеет два решения:
Так как Р — дисперсия, при Ф г < ! имеет смысл только первое решение. Однако при Ф 2 > 1 следует рассмотреть оба решения. Так как Ф —действительная величина, то Ф2 5г0.
214
|
Обозначая |
àP(k |
+ |
1 \k + 1) = |
P(k |
+ |
1 \k + |
1) — P и t>P(k\k) = |
|||||||
= Я(£|й) -P, получаем: |
|
|
|
|
|
|
|
|
|
|
|||||
|
Ol |
(R-f- |
i|« - f |
i ) - |
ф г р ( О Д + |
А |
|
Ф2 Р |
+ |
# |
|
|
|||
|
= |
ДФ2 Я (k\k) (Ф2 Р + /?) — № |
f |
[Ф^Р (fe|fe) -f /?] |
_ |
|
|||||||||
|
|
|
|
[ф"-Р |
(fe|fe) + |
flj ( ф 2 р + |
^ |
|
|
|
|
||||
|
|
|
ф 2 р + |
£ |
ф2Р |
(Щ -\- |
R |
Ô P |
№>' |
|
|
|
|||
|
При Ф 2 < 1 коэффициент при àP{k\k) |
|
в правой части |
полученно |
|||||||||||
го соотношения |
меньше единицы для всех «, так что всегда справед |
||||||||||||||
ливо |
неравенство |
ÔP(k + |
1 \k + |
1) < |
6P(k\k). |
В |
случае |
Р = О, |
|||||||
Р ( £ + 1 \k+ 1) <Я(й|&), |
так что Р=0 |
— точка |
устойчивого |
равновесия |
|||||||||||
дисперсии ошибки фильтрации при любом_Ф2 <1. |
|
_ |
|
|
|||||||||||
|
При Ф 2 > 1 следует |
рассмотреть как Р—0, так и |
Р=(Ф2—1)І?/Ф2. |
||||||||||||
Для |
Р=0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Полагая |
P(k\k)=0 |
для некоторого |
k, |
получаем |
öP(k+ |
1 \k+ 1) = |
|||||||||
=Ф2 оР(&|/г). Так как Ф 2 > 1 , то даже если дисперсия ошибки |
филь |
трации станет равной нулю, ошибка не останется равной нулю, т. е.
Р=0 — точка неустойчивого равновесия |
решения уравнения (5-73). |
|||||||
Для второго решения |
|
|
|
|
|
|
|
|
|
àP (k + l\k + |
1) = |
ф , р щ к ) |
+ ц |
SP (k\k). |
|
|
|
а это означает, что 6P{k+11k+1)<öP{k\k), |
|
так как Ф 2 > 1 . Следова |
||||||
тельно, Р=(Ф2—1)/?/Ф2— |
точка устойчивого равновесия |
при Ф 2 > 1 . |
||||||
Итак, |
дисперсия ошибки |
фильтрации |
стремится |
к |
нулю, |
если |
||
Ф 2 < 1 и к |
(Ф2 —1)І?/Ф2 , |
если |
Ф 2 > 1 . Следовательно, |
в случае |
Q=0 |
при достаточно большом времени фильтрации состояние системы можно определить точно, если — 1 < Ф < 1 , но при 'Ф>1 или Ф< — 1 оно может быть определено только с ошибкой, имеющей минимально возможную дисперсию (Ф2 —1)/?/Ф2 .
Пример 5-4. Рассмотрим частный численный вариант системы из предыдущего примера. Пусть Ф = 1 , Р(0) = 100, Q = 25 и /? = 15. Тогда
уравнения (5-71) — (5-73) |
принимают вид: |
|
P(k+ |
l\k) = P {k\k) + |
25; |
irtk+n |
- P ( f e l f e ) + 2 5 - |
|
P(k+l\k+l) |
15 [P (k\k) + 25] |
-•1БК (k+l). |
: P(k\k) + 40 |
Начиная с P(0|0) =P(0) = 100, сравнительно просто вычислить
P(k+i\k), K(k+l) и P(k+l\k+l) для k=0, 1 . . . Результаты не скольких первых вычислительных циклов сведены в табл. 5-1.
215