0% found this document useful (0 votes)
139 views11 pages

Advanced Kalman Filter Techniques

OKID stands for Observer Kalman Filter Identification. It augments the system input with the output to indirectly determine the steady-state Kalman filter gain. This is useful when the input and output noise characteristics needed for the Kalman filter are difficult to obtain directly. OKID works by introducing the output as part of the input, determining the impulse response function for the altered system, and obtaining the original system Markov parameters and Hankel matrix through a series of steps. This allows computation of the observer gain G, which turns out to be the steady-state Kalman filter gain under certain conditions. The data length must be sufficiently long and observer order high for the method to work accurately.

Uploaded by

sam
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
0% found this document useful (0 votes)
139 views11 pages

Advanced Kalman Filter Techniques

OKID stands for Observer Kalman Filter Identification. It augments the system input with the output to indirectly determine the steady-state Kalman filter gain. This is useful when the input and output noise characteristics needed for the Kalman filter are difficult to obtain directly. OKID works by introducing the output as part of the input, determining the impulse response function for the altered system, and obtaining the original system Markov parameters and Hankel matrix through a series of steps. This allows computation of the observer gain G, which turns out to be the steady-state Kalman filter gain under certain conditions. The data length must be sufficiently long and observer order high for the method to work accurately.

Uploaded by

sam
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
You are on page 1/ 11

.

Lecture 13

OBSERVER
KALMAN FILTER
IDENTIFICATION
(OKID)

13–1
Chapter13:OBSERVERKALMANFILTERIDENTIFICATION(OKID)13–2

Q1: What is OKID?

A1: Simply stated, it augments the input with the output data. And in the process the observer
gain G turns out to be the well-known steady-state Kalman filter gain K, if the output residual
error (to be discussed later on) is white, zero-mean and and Gaussian.

Q2: Why would anyone use OKID?

A2: The Kalman filter gain K can be computed from the input and output data if their noise
characteristics, namely, the input noise and output noise covariances are determnined. In
practice they may be difficult to obtain. Hence, OKID provides in an indirect way the steady-
state kalman filter gain.

Q3: What restrictions, if any, are imposed on the OKID-determined Kalman filter gain?

A3: The data length must be sufficiently long and the order of observer is sufficiently largeso
that the truncation error is negligible.

13–2
13–3

BASIC IDEA OF OKID

Step 1: Introduce the output as part of the input as follows!

x(k + 1) = Ax(k) + Bu(k) + G{y(k) − y(k)}, G is the observer gain to be determined


y(k) = C x(k) + Du(k)


x(k + 1) = Ax(k) + G{C x(k) + Du(k)} + {Bu(k) − Gy(k)}

x(k + 1) = Ax(k) + G{C x(k) + Du(k)} + {Bu(k) − Gy(k)}

! "
u(k)
x(k + 1) = (A + GC) x(k) + [ B + G D, G ]
y(k)

x(k + 1) = Ā x(k) + B̄ v(k)
! "
u(k)
Ā = (A + C G), B̄ = [ B + G D, G ], v(k) =
y(k)
(13.1)

13–3
Chapter13:OBSERVERKALMANFILTERIDENTIFICATION(OKID)13–4

BASIC IDEA OF OKID - Cont’d

Step 2: Determine the impulse response function for the altered model system, viz., for input v
and the same output y. This is done as follows by constructing the input-output matrix expressed
as
y(m, !) = Ȳ( m, (m + r ) p + r ) ∗ V( (m + r ) p + r, !)

y = [ y(0) y(1) y(2) ... y( p) ... y(! − 1) ]

Ȳ = [ D C B̄ C Ā B̄ ... C Ā p−1 B̄ ... C Ā!−2 B̄ ]


(Analogy with the standard form of Y!) (13.2)

 
u(0) u(1) u(2) ... u( p) ... u(! − 1)
 v(0) v(1) ... v( p − 1) ... v(! − 2) 
 
V= v(0) ... v( p − 2) ... v(! − 3) 
 
... . ... .
v(0) ... v(! − p − 1)
where it is assumed that C Āk B̄ ≈ 0 for k ≥ p.

13–4
13–5

BASIC IDEA OF OKID - Cont’d

Step 3: Obtain the modified impulse response function via a least-squares solver

Ȳ = yV+ = yVT [VVT ]−1 (21.3)

Observe that, when Ȳ is arranged as follows,

Ȳ = [ Ȳ0 Ȳ1 Ȳ2 ... Ȳ p ] (13.4)

Ȳk consists of
Ȳ0 = D
k−1
Ȳk = CĀ B̄ (13.5)
= [ C(A + GC)k−1 (B + G D) −C(A + GC)k−1 G ]
) (1) (2) *
= Ȳk − Ȳk , k = 1, 2, 3, ...

13–5
Chapter13:OBSERVERKALMANFILTERIDENTIFICATION(OKID) 13–6

BASIC IDEA OF OKID - Cont’d

Step 4: Obtain the original Markov parameters or the original Hankel matrix
Y1 = C B of the original system can be obtained from
(1) (2)
Y1 = C B = C(B + G D) − (C G)D = Ȳ1 − Ȳ1 D (13.6)

(1)
Ȳ2 = C(A + GC)(B + G D)
= C AB + C GC B + C(A + GC)G D
(2) (2)
= Y2 + Ȳ1 Y1 + Ȳ2 D (13.7)


(1) (2) (2)
Y2 = C AB = Ȳ2 − Ȳ1 Y1 − Ȳ2 D

By induction we obtain the following recurrence formulas:

D = Y0 = Ȳ0
+
k
(2)
Yk = Y(1)
k − Ȳi Yk−i , for k = 1, 2, ..., p
i=1
(13.8)
p
+ (2)
Yk = − Ȳi Yk−i , for k = ( p + 1), ..., ∞.
i=1

13–6
13–7

BASIC IDEA OF OKID - Cont’d

Step 4: Obtain the original Markov parameters or the original Hankel matrix - cont’d

Rearrange(13.8)intheformof

(2)
Ȳ H=Y
(2) ) (2) (2) (2) *
Ȳ = −Ȳ p −Ȳ p−1 ... −Ȳ1
 
Y2 Y3 Y4 ... Y N +1
(13.9)
 Y Y4 Y5 ... Y N +2 
H= 3 
. . . ... .
Y p+1 Y p+2 Y p+3 ... Y N + p
Y = [ Y p+2 Y p+3 Y p+4 ... Y N + p+1 ]

Note that the Hankel matrix H can be expressed as before


 
C
 CA 
 
 C A2 
 
H = V p A W N =  .  A [ B AB A2 B ... A N −1 B ] (13.10)
 
 . 
 
.
p−1
CA

13–7
Chapter13:OBSERVERKALMANFILTERIDENTIFICATION(OKID) 13–8

BASIC IDEA OF OKID - Cont’d

Step 4: Obtain the original Markov parameters or the original Hankel matrix - cont’d

Solution of the Hankel matrix from (21.9):


    Ȳ − Ȳ (2) D 
I Y1 1 1
(2)
 Ȳ1 I   Y2   Ȳ2 − Ȳ (2) D 
 (2)   2 
 Ȳ (2)
Ȳ1 I   Y3  =  Ȳ − Ȳ (2) D  (13.11)
 2    3 1 
 . . . .  .  . 
(2) (2) (2) (2)
Ȳ3 Ȳ2 Ȳ1 ... I Yk+1 Ȳk+1 − Ȳk+1 D

One must pivote for the solution of this equation.

13–8
13–9

BASIC IDEA OF OKID - Cont’d

Step 5: Compute the observer gain, G

Let us introduce the following definition

Yk0 = C Ak−1 G, k = 1, 2, 3, ... (21.12)

Then we find
Y10 = C G = Ȳ1(2)
Y20 = Ȳ1(2) − Ȳ1(2) Y10

Y10 = Ȳ1(2)
(13.13)
+
k−1
Yk0 = Ȳk(2) − Ȳi(2) Yk−i
0
for k = 2, 3, ..., p
i=1
p
+
Yk0 = − Ȳi(2) Yk−i
0
for k = p + 1, p + 2, ..., ∞
i=1

Hence, the observer gain G is obtained in an analoguous way to obtain B as follows:

G = (VT V)−1 VT Y0 (21.14)

13–9
Chapter13:OBSERVERKALMANFILTERIDENTIFICATION(OKID)

BASIC IDEA OF OKID - Cont’d

Step 5: Compute the observer gain, G - cont’d

where Y0 in (21.13) is obtained as follows


 
CG
 C AG 
 
0  C A2 G 
Y =  (13.15)
 . 
 
.
C Ak G
which is obtained from
    Ȳ (2) 
I
(2)
Y10 1
 Ȳ1 I   Y 0   Ȳ (2) 
 (2)   20   2 
 Ȳ (2)
Ȳ1 I   Y  =  Ȳ (2)  (13.16)
 2  3   3 
 . . . .  .  . 
(2) (2) (2) 0 (2)
Ȳ3 Ȳ2 Ȳ1 ... I Yk+1 Ȳk+1

13–10
13–11

BASIC IDEA OF OKID - Cont’d

Q: Can we obtain [A, B, C, G] in a single realization?


A: Yes, if you employ the following:

Pk = [ Y k Yk0 ] = [ C Ak−1 B C Ak−1 G ] = C Ak−1 [ B G]


+
k−1 (13.17)
= [ Ȳk(1) − Ȳk(1) D Ȳk(2) ]− Ȳi(2) [ Yk−i 0
Yk−i ] k = 1, 2, ..., !
i=1

We would not prove but state the following:


If the data elngth is sufficiently long and the order of the observer is sufficiently large so taht the
truncation error is negligible, then the observe gain is negative of the steady-state kalman filter gain.
In other words we have
G = −K steadt state (13.18)

13–11

You might also like