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

Дегтярёв Оптимальное управление

.pdf
Скачиваний:
63
Добавлен:
22.03.2016
Размер:
1.68 Mб
Скачать

 

 

 

 

 

61

 

 

 

 

 

 

d (t, )

A (t, )

 

 

 

d t

 

 

 

 

 

 

 

 

 

 

 

 

с начальными условиями

 

 

 

 

 

 

 

 

 

 

 

,

 

0

 

.

 

 

 

 

 

 

1

 

 

 

 

 

 

 

 

 

0

 

 

1

 

 

 

 

 

 

 

Отсюда следует, что матрица (t, ) имеет вид:

 

 

 

t

 

.

 

 

(t, )

1

 

 

 

(5.41)

 

0

1

 

 

 

 

 

Этот же результат получается, если искать матрицу (t, )

в виде ряда:

(t, ) E A(t ) A2

(t )

...

 

 

 

 

 

 

 

 

2!

 

 

Рассмотрим поведение системы (5.40) через равные промежутки времени T в моменты tk , т.е. tk T k .

На основании соотношений (5.3I) - (5.33), полагая, что W (t) постоянно на шаге дискретности, получим следующую эквивалентную дискретную систему:

 

 

 

 

 

tk 1 tk

 

1

T

 

A(k 1, k) (t

k 1

,t

k

)

1

 

;

 

 

 

0

1

 

0

1

 

 

 

 

 

 

 

 

 

 

 

 

tk 1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

tk 1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

1

C(k 1, k)

(tk 1, )C( ) d

0

 

 

 

 

tk

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

tk

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

(k 1) T

 

(k 1)T

 

 

 

 

 

 

1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

J

 

 

J

 

 

 

 

(k 1)T

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

...

 

 

...

 

d

 

 

 

 

 

 

1

 

 

 

 

 

 

 

 

 

 

kT

 

 

1

 

 

 

 

 

 

 

 

J

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

J

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T 2

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

1

 

T

 

 

 

 

 

 

 

 

 

 

 

 

Y

1

 

 

Y

 

2J

W ,

 

 

 

 

 

 

k

 

0

 

1

k

 

T

 

k

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

J

 

 

 

tk 1

 

 

0

d

 

 

 

1

 

 

 

 

1

 

 

 

 

 

 

 

 

 

 

 

 

 

J

 

 

 

 

 

 

2

(k 1) T

 

 

 

1

 

 

 

 

 

 

0

 

2

 

 

 

 

 

 

kT

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

k 0,1, 2,...

(5.42)

T 2

 

(5.43)

2J

 

;

T

 

 

 

J

 

 

 

(5.44)

В дальнейшем необходимо получить зависимость Yk 1 не только от Yk и Wk , но от Y0 и всех предшествующих W0 , ..., Wk . Используя соотношения (5.33), для различных k можно записать:

62

 

 

Y1 A(1,0)Y0 C(1,0)W0 ;

 

 

Y2 A(2,1)Y1 C(2,1)W1 A(2,1)[ A(1,0)Y0 C(1,0)W0 ]

 

C(2,1)W1 A(2,1) A(1,0)Y0 A(2,1)C(1,0)W0 C(2,1)W1 ;

 

Y3 A(3, 2)Y2 C(3, 2)W2 A(3, 2)[ A(2,1)

A(1,0)Y0

 

A(2,1)C(1,0)W0 C(2,1) W1 ] C(3, 2)W2

 

 

A(3, 2) A(2,1) A(1,0)Y0 A(3, 2) A(2,1)C(1,0)W0

 

A(3, 2)C(2,1)W1 C (3, 2)W2 .

 

 

Продолжая соответствующие выкладки, можно получить соотношение

 

n 1

 

 

Yn A(n,0)Y0 A(n, j 1)C( j 1, j)W j ,

(5.45)

j 0

 

 

где матрица A(n, j) определяется следующим образом:

 

 

n

 

A(n, j) A(n,n 1) A(n 1, n 2)... A( j 1, j) A(r, r 1) ,

(5.46)

r j 1

причем A(n, j) E при j n 1.

Полученные соотношения (5.45), (5.46) будут использованы при статистическом анализе дискретных систем.

5.3. Уравнения моментов для линейных систем

Сначала рассмотрим непрерывные системы. Пусть уравнения движения

имеют вид;

d Y

A(t)Y (t) C(t)W (t), Y (t

 

) Y .

(5.47)

 

0

d t

0

 

 

 

 

Относительно возмущающих воздействий W (t) и начального состояния Y0

будем предполагать, что они удовлетворяют условиям (5.28).

При получении соотношений для математического ожидания состояния

системы Y(t) , усредним уравнение (5.47):

 

 

 

 

 

 

 

 

 

 

d

 

d Y

 

 

M

d Y

 

 

M[Y (t)]

 

M[ A(t)Y (t) C(t)W (t)

 

 

 

 

d t

 

 

d t

 

d t

 

 

A(t) M[Y (t)] C(t) M[W (t)].

63

Учитывая (5.28), получим:

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

d Y

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

A(t)Y

(t), Y (t

0

) Y .

 

 

 

 

 

(5.48)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

d t

 

 

 

 

 

 

 

 

 

 

 

0

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

На основании (5.47), (5.48) уравнение для центрированной составляющей

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Y (t) Y (t) Y

(t) имеет вид:

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Y (t0 ) Y

0 .

 

 

(5.49)

 

 

 

 

 

 

 

 

 

d Y A(t)Y (t) C(t)W (t),

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

d t

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Теперь

 

найдем

 

 

 

 

 

уравнение

 

 

 

 

для

 

дисперсионной

 

матрицы

 

 

 

 

 

 

 

 

(t))]T . Дифференцируя

 

 

 

P (t) M[(Y (t) Y

(t))(Y (t) Y

по t

матрицу

P (t) и

y

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

y

учитывая, что матрицы A(t) и C(t)

 

не случайные, получим:

 

 

 

 

 

d Py (t)

 

 

 

d

 

 

 

T

 

 

 

d

 

T

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

M Y (t)Y (t)

M

 

(Y (t)Y (t))

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

d t

 

 

 

 

 

d t

 

 

 

 

 

 

 

 

 

d t

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

0 T

 

 

 

 

 

T

 

 

 

 

 

 

T

 

 

 

 

 

 

 

d Y

 

 

 

 

 

 

d Y

 

 

 

 

 

 

 

 

 

 

 

M

 

 

 

 

Y (t) Y (t)

 

 

 

 

A(t) M Y (t)Y (t)

 

 

 

 

d t

 

d t

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

 

 

 

M Y (t)Y

(t) AT (t) C(t) M W (t)Y

(t)

 

 

(5.50)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

M Y (t)W T (t) CT (t) A(t) p y (t) Py (t) AT (t)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

C(t) M W (t)Y (t) M

Y (t)W T (t) CT (t).

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

(t)

 

 

Для вычисления

 

математического

 

 

ожидания

M Y (t)W T

используем

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

формулу Коши (5.27):

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

t

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Y (t) (t, t0 )Y 0

(t, )C( )W ( ) d .

 

 

(5.51)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

t0

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Умножив выражение (5.51)

справа на W T (t) ,

осреднив и

учитывая (5.28),

получим:

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

64

 

 

 

 

 

 

 

 

 

 

M Y (t)W T (t)

(t, t0 ) M Y 0 W T (t)

 

 

 

 

 

 

 

 

t

(t, )C( ) M [W ( )W T (t)]d

t0

(5.52)

 

t

(t, )C( )Q( ) ( t) d

t0

12 (t, t)C(t)Q(t) 12 C(t)Q(t).

С учетом того, что

 

 

T

 

 

 

 

T

 

 

 

M W (t)Y

(t) M Y (t)W T (t)

 

1

Q(t)CT (t) ,

(5.53)

 

 

 

 

 

 

 

 

2

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

уравнение (5.50) примет вид;

 

 

 

 

 

 

 

 

d Py (t)

A(t) P (t)

P (t) AT (t) C(t)Q(t)CT (t)

(5.54)

 

 

 

 

 

d t

 

y

 

 

y

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

с начальным условием P (t

0

) P .

 

 

 

 

 

 

 

 

Y

 

0

 

 

 

 

 

Теперь пусть поведение системы описывается дискретным уравнением

 

Yk 1 A(k 1, k)Yk C(k 1, k)Wk ,

k 0,1,2,... .

(5.55)

Будем полагать, что начальное условие Y0 и возмущающие воздействия Wk

удовлетворяют соотношениям (5.37). Найдем уравнения для математического

ожидания и дисперсионной матрицы.

 

 

 

 

 

Осредняя (5.55) и учитывая (5.37), получим:

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Yk 1 A(k 1, k)Yk ,

k 0,1,2,...

 

 

 

(5.56)

 

 

 

 

 

 

 

 

 

 

Уравнение для центрированной составляющей Y k

Yk Yk

имеет вид:

 

 

 

 

 

 

 

 

 

 

Y k 1 A(k 1, k)Y k C(k 1, k)Wk .

(5.57)

Используя (5.57) и (5.37), найдем уравнение для дисперсионной матрицы

 

T

Pyk M Y k Y k :

 

 

 

 

65

 

 

T

 

 

Py k 1

M Y k 1

Y k 1

 

M [( A(k 1, k)Y k C(k 1, k)Wk

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

( A(k 1, k)Y k C(k 1, k)T ] A(k 1, k) M

Y k Y T

 

 

 

k

 

 

 

 

 

 

 

T

 

 

T

 

C

T

(k 1, k)

 

 

 

A (k 1, k) A(k 1, k) M Y k Wk

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

 

 

 

 

 

C(k 1, k) M W Y k AT (k 1, k)

 

 

 

 

 

 

 

k

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

C(k 1, k) M W W T CT (k 1, k)

 

 

 

 

 

 

 

k

k

 

 

 

 

 

 

 

 

A(k 1, k) P

AT (k 1, k) C(k 1, k)Q CT (k 1, k)

 

yk

 

 

 

 

 

 

k

 

 

 

 

 

W T CT (k 1, k)

 

 

 

 

 

 

A(k 1, k) M Y k

 

 

 

 

 

 

 

 

k

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

 

 

 

 

 

C(k 1, k) M W Y k AT (k 1, k).

 

 

 

 

 

 

 

 

k

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

Определим математическое

ожидание M Y k Wk

,

 

 

 

 

 

 

 

 

 

 

 

(5.58)

используя

соотношение (5.45) и свойства (5.37):

 

 

 

 

 

 

 

 

 

 

 

T

 

 

 

k 1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

A(k, j) C( j 1, j)W

 

W

T

 

 

M Y k W

k

M A(k, 0)Y 0

j

 

 

 

 

 

 

 

 

 

 

 

k

 

 

 

 

 

 

 

 

 

j 0

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

(5.59)

 

 

 

 

 

k 1

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

A(k, 0) M Y0 WkT A(k, j) C( j 1, j) M W j WkT 0.

 

 

 

 

 

 

 

 

 

j 0

 

 

 

 

 

 

 

 

 

Аналогично

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

T

 

W T 0 .

 

 

 

 

 

 

 

 

 

 

M W Y k M Y k

 

 

 

 

 

 

 

 

 

 

 

k

 

 

 

k

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Таким образом, уравнение для определения матрицы Pyk имеет вид:

P

 

A(k 1, k) P

 

AT (k 1, k)

 

 

 

 

 

 

 

y k 1

 

 

y k

 

 

 

 

 

 

 

 

 

(5.60)

 

C(k 1, k)Q CT (k 1, k),

 

k 0,1, 2,... P

 

P .

 

 

 

 

 

 

 

 

k

 

 

 

 

 

y0

 

 

0

 

5.4. Задача оптимальной фильтрации и ее решение методом Калмана

66

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

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

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

dY (t)

A(t)Y (t) CW (t),

Y (0) Y

,

(5.61)

 

dt

0

 

 

 

 

 

где Y(t) - n -мерный вектор состояния, W (t) - q -мерный вектор возмущающих воздействий, A(t) и C(t) матрицы соответствующих размерностей.

Пусть измерению поддается m -мерный вектор некоторых комбинаций

функций состояния (5.25)

 

Z(t) N(t)Y (t) V (t) ,

(5.62)

где V (t) - погрешность измерения.

Относительно свойств случайных процессов W (t),V (t) и начального состояния Y (0) будет предполагать, что они удовлетворяют условиям (5.28),

т.е. будет предполагать, что это случайные процессы типа белого шума, не

коррелированные друг с другом и начальным состоянием системы.

Математически задача оптимальной фильтрации

ставится как задача

ˆ

на основе имеющейся

отыскания оценки Y (t) состояния системы (5.61) Y(t)

информации Z(t) .

Калман предложил искать уравнение фильтра в виде линейной системы на вход которой подается наблюдаемый сигнал Z(t) . Тогда уравнения движения такой системы можно описать совокупностью уравнений

ˆ

 

dY

ˆ

dt

F (t)Y (t) K (t) Z (t),

ˆ

ˆ

(5.63)

Y (0)

Y0

67

где матрицы F (t) и K(t) подлежат определению, т.е. структура фильтра задается, а параметры структуры и начальное состояние определяются из

дополнительных условий.

ˆ

 

Так как Y (t) Y (t) , то всегда будет ошибка оценки

 

ˆ

 

E(t) Y (t) Y (t) .

 

Тогда для определения искомых матриц F (t) и G(t) можно использовать

условие несмещенности оценки

 

M E(t) 0

(5.64)

и условие ее оптимальности

 

J (t) M ET (t) (t) E(t) min ,

(5.65)

F (t ) K (t )

 

где (t) - симметричная положительно определенная матрица.

Для того, чтобы использовать условия (5.64) и (5.65) найдем уравнение

для ошибки оценивания. Вычитая (5.63) из (5.61) с учетом (5.62), получим

 

d Y

 

 

ˆ

 

 

 

 

 

 

 

 

 

d Y

 

 

 

 

ˆ

 

 

dt

 

 

dt

A(t)Y (t) C(t)W (t) F (t)Y (t) K (t) N (t)Y (t) K (t)V (t)

 

или

 

 

 

 

 

 

 

 

 

 

 

 

 

d E(t)

 

 

 

 

ˆ

 

 

 

 

 

dt

( A(t) K (t) N (t) )Y (t) F (t)Y (t) C(t)W (t) K (t)V (t) .

 

 

 

 

 

 

 

 

 

 

 

Если теперь положить, что

 

 

 

 

 

 

 

 

 

F(t) A(t) K(t) N(t) ,

(5.66)

то уравнение для ошибки оценки E(t) примет вид:

 

 

 

 

 

 

 

 

d E(t)

F (t) E(t) C(t)W (t) K (t)V (t)

(5.67)

 

 

 

 

 

 

 

dt

 

 

 

 

 

 

 

 

 

 

 

с начальным условием

 

 

 

 

 

 

 

 

 

 

 

 

 

 

ˆ

(5.68)

 

 

 

 

 

 

 

 

E(0) Y0 Y0 .

Из (5.67), (5.68) следует, что условие несмещенности оценки (5.64) будет

выполнено, если положить

 

 

 

 

 

 

 

 

 

ˆ

 

 

(5.69)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

Y0 Y0 .

68

Чтобы убедиться в этом, достаточно взять математическое ожидание от выражений (5.67), (5.68)

dM[ E(t)]

F (t) M [E(t)],

M [E(0)] 0 .

dt

 

 

 

т.е. получили однородное линейное уравнение с нулевыми начальными условиями, откуда непосредственно следует, что M[E(t)] 0 для любого t .

Остается определить матрицу K(t) из условия минимума критерия (5.65).

Примем для простоты выкладок, что (t) - постоянная единичная матрица,

тогда

 

n

 

J M ET (t) E(t) SpM E(t) ET (t) M Ei2 (t) .

(5.70)

Здесь M E(t) ET (t)

1

 

- корреляционная матрица ошибки оценивания (матрица

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

 

 

 

 

 

dJ (t)

Sp

dP(t)

.

 

 

 

 

 

(5.71)

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

dt

 

 

dt

 

 

 

 

 

 

Нетрудно показать, что минимизация производной критерия

обеспечивает минимум и для самого критерия [6]

 

 

Запишем выражение

dP(t)

, опуская для простоты время t :

 

 

 

 

 

 

 

 

 

 

dt

 

 

 

 

 

 

 

 

 

 

 

 

 

 

dP

 

dM EET

 

 

dE

ET E

dET

 

 

 

 

 

 

 

 

 

 

M

 

 

 

.

(5.72)

 

 

 

 

 

 

 

 

 

 

 

 

dt

 

 

dt

 

 

dt

 

 

 

dt

 

 

Подставив в (5.72) выражение для

 

dE

из (5.67) и соответствующее

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

dt

 

 

 

выражение для

dET

, получим:

 

 

 

 

 

 

 

 

 

 

 

 

dt

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

 

69

dP

( A KN ) M E ET CM WET RM VET

dt

(5.73)

M EET ( A KN )T M EW T CT M EV T K T .

Найдем M EW T , для чего запишем уравнение Коши для (5.67):

t

E(t) (t,t0 ) E(t0 ) (t, ) C ( )W ( ) K ( )V ( ) d ,

t0

где (t, ) - весовая матричная функция. Тогда

M E(t)W T (t) t (t, )C( )M W ( )W T (t) d t (t, )C( )Q( ) (t )d .

t0 t0

Используем свойство дельта-функции:

 

 

b

 

 

 

f (t 0) f (t 0)

 

 

 

 

f ( ) (t )d

 

,

 

 

 

 

 

 

 

 

 

 

a

 

 

 

 

 

 

2

 

 

 

 

 

 

 

 

 

 

 

 

 

если f имеет разрыв в точке t .

 

 

 

 

 

I ,

t 0

,

 

 

Поскольку (t, )

t 0

 

 

 

 

0,

 

 

 

то

 

 

 

 

 

 

 

 

 

 

 

 

M E(t)W T (t)

1

C(t)Q(t) .

 

(5.74)

 

 

 

 

 

 

 

 

2

 

 

 

 

Аналогично можно найти M E(t)V T (t) :

 

 

 

 

M E(t)V T (t)

1

K (t) R(t) .

 

(5.75)

 

 

 

 

 

 

 

2

 

 

 

M EW T , M EV T и

Подставив

полученные

выражения для

соответственно транспонированные выражения для M WET , M VET в (5.73)

получим:

 

 

 

 

 

 

 

 

 

 

 

dP

( A KN ) P P( A KN )T CQC T KRK T .

(5.76)

 

dt

 

 

 

 

 

 

 

 

 

 

 

Следующее тождество легко проверить, раскрыв в правой части скобки и использовав симметрию матрицы P(t) :

70

KRK T KNP PN T K T (K PN T R 1) R(K PN T R 1)T PN T R 1NP .

(5.77)

С учетом тождества приведем уравнение (5.76) к виду:

dPdt AP PAT CQCT PN T R 1NP (K PN T R 1) R(K PN T R 1)T . (5.78)

В правой части (5.78) от коэффициента K(t) будет зависеть лишь

последнее слагаемое, причем оно представляет собой положительно определенную матрицу. Очевидно, что для минимизации критерия (5.71)

нужно выбрать K(t) в следующем виде:

 

 

K0 (t) P(t) N T (t) R 1 (t)

(5.79)

 

 

При этом последний член в уравнении (5.78) обращается в нуль и

уравнение приобретает вид

 

 

dP(t)

A(t)P(t) P(t) AT (t) C(t)Q(t)CT (t) P(t)N T (t)R 1

(t)N (t)P(t). (5.80)

 

dt

 

 

 

с начальным значением P(t0 ) P0 .

Итак, можем записать уравнение фильтра

 

ˆ

 

 

 

 

 

 

 

 

dY (t)

 

ˆ

ˆ

ˆ

 

 

 

 

 

 

 

 

dt

A(t)Y (t) K0 (t) Z (t) N (t)Y (t) ,

Y (t0 ) Y .

(5.81)

 

 

 

 

 

 

 

 

Уравнения (5.79),

(5.80),

(5.81) представляют собой уравнения фильтра

Калмана-Бьюси.

Система оценивания (фильтр) схематически представлена на рис. 16.

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

Для стационарной системы (A(t) A,C(t) C, N(t) N) при стационарном возмущающем воздействии M W (t)W T (t') Q (t t') и стационарном шуме измерителя M V (t)V T (t') R (t t') после окончания переходных процессов матричный коэффициент усиления в фильтре Калмана становится постоянным (K (t) K T const) , а уравнение Риккати (5.80) вырождается в