Professional Documents
Culture Documents
Qxu Qu u
xˆ (k 1 k ) xˆ (k k 1) u (k ) K (k ) y (k ) Cxˆ (k k 1)
I K (k ) P(k )
C C R12 R2 K (k )T
P(k )T R1 P(k )C T R12 I
I K (k ) T
CP ( k ) T
R12 CP ( k )C T
R 2 K ( k )
K (k ) P (k )C R12 CP(k )C R2
T T 1
Inserting that to the previous formula gives
P(0) R0
xˆ (k 1 k ) xˆ (k k 1) u (k ) K (k ) y (k ) Cxˆ (k k 1)
K (k ) P (k )C R12 CP(k )C R2
T T 1
x(k 1) x(k )
y ( k ) x ( k ) e( k )
where the measurement is corrupted by noise (zero mean
white noise with standard deviation ; x(0) is assumed to
have variance 0.5. The Kalman filter is given by
xˆ (k 1 k ) xˆ (k k 1) K (k ) y (k ) Cxˆ (k k 1)
P(k ) 2 P(k )
K (k ) 2 , P(k 1) 2
P(k ) P(k )
K = 0.01
K = 0.05
Kalman
LQG control
Consider the system
x(k 1) x(k ) u (k ) v(k )
y (k ) Cx(k ) e(k )
and the criterion to be minimized
N 1
J E x(k )T Q1 x(k ) u (k )T Q2u (k ) x( N )T Q0 c x( N )
k 0
N 1 x(k )
E x(k )T u (k )T Q x ( N )T
Q0c x ( N )
k 0 u ( k )
where Q 0 (Q1, Q0c pos. semidefinite, Q2 pos. definite)
Q 1
0 Q2
LQG control is given by the separation theorem (not proved
here):
u *(k ) L(k ) xˆ (k k 1)
The end