stability analysis of kalman filter by orthonormalized …nisl.kau.ac.kr/kiee02-hyknlee.pdf ·...

30
Stability Analysis of Kalman Filter by Orthonormalized Compressed Measurement Hyung Keun Lee and Jang Gyu Lee School of Electrical Engineering and Computer Science and Automatic Control Research Center, Seoul National University Abstract: In this paper, we propose the concept of orthonormalized compressed measurement for the stability analysis of discrete linear time-varying Kalman filters. Compared with the previous studies that deals with the homogeneous portion of Kalman filters, the proposed Lyapunov method directly deals with the stochastically-driven system. The orthonormalized compressed measurement provides information on the a priori state estimate of the Kalman filter at the k -th step that is propagated from the a posteriori state estimate at the previous block of time. Since the complex multiple-step propagations of a candidate Lyapunov function by process and measurement noises can be simplified to a one-step Lyapunov propagation by the orthonormalized compressed measurement, a stochastic radius of attraction can be derived that would be practically difficult to obtain by the conventional multiple-step Lyapunov method. Keywords: Kalman filter, stability, Lyapunov, orthonormalized compressed measurement

Upload: others

Post on 20-Aug-2021

3 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

Stability Analysis of Kalman Filter

by Orthonormalized Compressed Measurement

Hyung Keun Lee and Jang Gyu Lee School of Electrical Engineering and Computer Science and Automatic Control Research Center, Seoul National University

Abstract: In this paper, we propose the concept of orthonormalized compressed measurement for the

stability analysis of discrete linear time-varying Kalman filters. Compared with the previous studies that

deals with the homogeneous portion of Kalman filters, the proposed Lyapunov method directly deals with

the stochastically-driven system. The orthonormalized compressed measurement provides information on the

a priori state estimate of the Kalman filter at the k -th step that is propagated from the a posteriori state

estimate at the previous block of time. Since the complex multiple-step propagations of a candidate

Lyapunov function by process and measurement noises can be simplified to a one-step Lyapunov

propagation by the orthonormalized compressed measurement, a stochastic radius of attraction can be

derived that would be practically difficult to obtain by the conventional multiple-step Lyapunov method.

Keywords: Kalman filter, stability, Lyapunov, orthonormalized compressed measurement

Page 2: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

2

I. Introduction

As an optimal estimator of stochastic Linear Time-Varying (LTV) systems in least mean square sense,

the Kalman filter (KF) provides the best estimate of system states for the system where the measurement and

process noises are wide sense stationary white Gaussian. Because of its simplicity for digital implementation

and guaranteed optimality, the KF has been widely applied to various engineering problems. However,

engineers who work with the KF frequently experience that its stability is not always guaranteed in spite of

its optimality. The stability of the LTV KF has been a subject of active research. Earlier researches on the

subject were concerned with the Lyapunov stability theory applied to the homogeneous portion of the filter

to establish zero-input stability criteria [1-4]. Additionally, remarks on Bounded-Input Bounde-Output

(BIBO) stability are provided for the stability of stochastically-driven system.

Since the stability of stochastically-driven systems is difficult to analyze, a detailed and practical

Lyapunov analysis result has not been appeared in the literature. The non-singularity of the observability

grammians for a time-varying system plays a central role in showing a strict decrease of a candidate

Lyapunov function. It is obtained only by summing the multiple information matrices where each

information matrix of a measurement is usually singular. Thus, the selected Lyapunov function should be

propagated in multiple steps. In our experience, any attempt to treat input noise terms directly in the

multiple-step propagation of a candidate Lyapunov function is intractably complex. To extend the previous

works on the KF stability analysis avoiding complex intermediate propagations of a stochastically-driven

Lyapunov function, we present the concept of Orthonormalized Compressed Measurement (OCM) which is

a special form of stacking measurements.

The procedure to obtain the OCM is summarized in Fig. 1. In Fig. 1, the single stacked measurement

vector sNkkZ 1/ +− is obtained if we merely stack all the measurement }{ jz in a specified time interval where

kNkNkj ,,2,1 L+−+−= . The de-correlated stacked measurement ⊥+− 1/ NkkZ is formed to eliminate

the correlation between the stacked measurement sNkkZ 1/ +− and the estimation error of KF. To reduce the

Page 3: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

3

large dimension of ⊥+− 1/ NkkZ , a pseudo-inverse is pre-multiplied to ⊥

+− 1/ NkkZ resulting in the OCM to obtain

nNkkZ 1/ +− .

The OCM provides information on the a priori state estimate at the k -th step that is propagated from a

posteriori state estimate at the ( Nk − )-th step. The proposed OCM is advantageous in analysis because (i)

the measurement coefficient matrix is a simple identity matrix, (ii) the noise term is uncorrelated with the a

priori state estimate at the k -th step that is propagated from a posteriori state estimate at the ( Nk − )-th

step, (iii) the dimension is equal to the system dimension, and (iv) it is closely related with the observability

grammian so as to be utilized for proving the stability of stochastically-driven systems.

This paper is organized as follows. In Section II, we will describe the system model, the filter model,

and the error model. Five Lemmas will be introduced. The five Lemmas provide us an idea on how to handle

the measurements without any information loss. In Section III, three concepts of equivalent measurements,

i.e., the stacked measurement, the de-correlated measurement, and the OCM, are introduced and formulated.

In Section IV, several Lemmas are introduced to clarify useful inequalities between several important error

covariance matrices. The main theorem regarding the stability condition and the stochastic radius of

attraction for LTV KF is sought. In Section V, a concluding remark is given.

Fig. 1 Equivalent measurements for stability analysis

Page 4: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

4

II. Preservation of Information

We consider the following discrete LTV system driven by white Gaussian noises,

kkkkkk wGxFx −= ++ /11 , ( )qIOwk ,~ , 0>q , (1)

and the direct measurement,

ky kkk vxh −= , ( )rIOvk ,~ , 0>r , (2)

where

kx nR∈ : system state vector at the k -th step

kkF /1+nn×∈R : state transition matrix from the k -th step to the ( 1+k )-th step

kG ln×∈R : coefficient matrix for the process noise at the k -th step

kw lR∈ : process noise at the k -th step q R∈ : strength of each process noise

I : identity matrix of appropriate dimension O : zero matrix of appropriate dimension

ky mR∈ : direct measurement vector at the k -th step

kh nm×∈R : measurement coefficient matrix at the k -th step

kv mR∈ : measurement noise at the k -th step r R∈ : strength of each measurement noise

We assume that kv and kw are zero-mean and white sequences such that,

OvvE kj =)]([ , ,kj ≠∀ L,3,2,1, =kj

OwwE kj =)]([ , ,kj ≠∀ L,3,2,1, =kj

OvwE kj =)]([ , L,3,2,1, =kj . (3)

For the discrete-time system model given by Eqs. (1)-(3), the well-known KF performs the

following steps.

Time Propagation :

kkkkk xFx ˆˆ /1/1 ++ =

kkkkkkk wGeFe += ++ /1/1

kkP /1+T

kkT

kkkkk qGGFPF += ++ /1/1 (4)

Measurement Update :

Page 5: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

5

( ) 11/1/

−− += kTkkkk

Tkkkk rhPhhPK

*1/ˆˆ kkkkk zKxx −= −

( ) kkkkkkk vKehKIe −−= −1/

( ) ( ) Tkkk

Tkkkkkkk KrKhKIPhKIP +−−= −1/ (5)

where

kkx /1ˆ + : optimal estimation of 1+kx using measurements upto the k -th step ( a priori estimation)

kkk xx /ˆˆ = : optimal estimation of kx using measurements upto the k -th step (a posteriori

estimation)

1/1/1 ˆ +++ −= kkkkk xxe : a priori estimation error

kkk xxe −= ˆ : a posteriori estimation error

kkP /1+ : error covariance matrix of kke /1+

kkk PP /= : error covariance matrix of ke

kkkkkkkkk vehyxhz +=−= −− 1/1/* ˆ : indirect measurement vector

With the description of models and KF, we introduce five Lemmas that are utilized to prove the main

theorem of stability. Given a priori estimation and a measurement of a Gaussian random variable, Lemma 2-

1 states that any pre-multiplication of a non-singular square matrix with the original measurement will not

alter the a posteriori estimation. Lemma 2-2 states that any measurement vector whose noise is correlated

with the a priori estimation error can be represented by an equivalent measurement that is uncorrelated with

the a priori estimation error. Lemma 2-3 states that the pre-multiplication of the Kalman gain with the

original measurement does not alter the a posteriori estimation and makes the measurement coefficient

matrix as the identity matrix when the dimension of the original measurement vector is larger than the

system dimension. Lemma 2-4 states that even though the system states change by time-propagation, the

measurement information with respect to the system states can be maintained by considering the exact

effects of time-propagation. Proofs of most Lemmas are obvious. Only Lemma 2-5 will be proven.

Throughout the Lemmas, the symbol ][xEst is used to denote an estimation of x where the optimality is

Page 6: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

6

not guaranteed and the symbol ( )xE is used to denote the probabilistic expectation of x .

Lemma 2-1: Equivalence of Measurements [5]

Suppose that we are given a priori estimation 1ˆ ×− ∈ nx R of a Gaussian random variable 1×∈ nx R

with 1×− ∈ ne R , nnM ×∈R , 1×∈ mz R , nmH ×∈R , mmR ×∈R , and nmS ×∈R such that

][ˆ xEstx =−

]))([( TeeEM −−= (6)

where

xxe −= −− ˆ:

vHez += − , ( )ROv m ,~ 1×

])([ TevES −= . (7)

Then, no information is lost in obtaining the a posteriori estimation +x̂ of x by applying a non-singular

transformation mmR ×∈C to z if we properly consider the changes in H , R , and S , i.e., z is

equivalent to z where

veHCzz +== −: , ( )ROv m ,~ 1×

CHH =:

TT CRCvvER == ][:

CSevES T == − ])([: . (8)

Lemma 2-2: De-Correlation of a Measurement [2, 5]

Suppose that we are given a priori estimation 1ˆ ×− ∈ nx R of a Gaussian random variable 1×∈ nx R

with 1×− ∈ ne R , nnM ×∈R , 1×∈ mz R , nmH ×∈R , mmR ×∈R , and nmS ×∈R satisfying Eqs. (6) and

(7). In addition, the following condition is satisfied.

OSSMR T >− −1 . (9)

Then, no information is lost in obtaining the a posteriori estimation +x̂ of x by removing cross-

correlation between v of z from −e if we properly consider the changes in H and R , i.e., z is

Page 7: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

7

equivalent to z where

veHz += −: , ( )ROv n ,~ 1×

1: −+= SMHH

TSSMRR 1: −−=

nmT OevE ×=][ . (10)

Lemma 2-3: Preservation of Information in Dimension Reduction [2, 5]

Suppose that we are given a priori estimation 1ˆ ×− ∈ nx R of a Gaussian random variable 1×∈ nx R

with 1×− ∈ ne R , nnM ×∈R , 1×∈ mz R , nmH ×∈R , mmR ×∈R , and nmS ×∈R satisfying Eqs. (6) and

(7). In addition, the following conditions are satisfied.

nm ≥ , OHH T > , OS = (11)

Then, no information is lost in obtaining the a posteriori estimation +x̂ of x by applying the unique

transformation mnC ×∈R* to z if we properly consider the changes in H , R , and S , i.e., z is

equivalent to z where

veHzCz +== −*: , ( )ROv n ,~ 1×

111* )(: −−−= RHHRHC TT ,

nnIH ×=:

11 )(][: −−== HRHvvER TT . (12)

Lemma 2-4: Time-Propagated Measurement [2, 5]

Suppose that we are given a priori estimation −kx̂ of a Gaussian random variable kx with an

estimation error −ke at the k -th step with kM , kz , kR , and kS such that

][ˆ kk xEstx =−

kkkk veHz += − , ( )kk ROv ,~

Page 8: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

8

kkk xxe −= −− ˆ:

])([ Tkkk evES −= (13)

where

OSMSR Tkkkk >− −1

])([: Tkkk eeEM −−= . (14)

In addition, suppose that the system states are propagated in time by Eq. (1) and its estimation is changed by

the following equation.

−+

−+ = kkkk xFx ˆˆ /11 (15)

where

( )kk qOw ,~ , OvwE Tkk =][ , OewE kk =− ][ (16)

Then, no information is lost in using kz to estimate 1+kx by the following interpretation.

1111 : +−+++ +== kkkkk veHzz (17)

where

111 ˆ: +−+

−+ −= kkk xxe

1/11 )(: −

++ = kkkk FHH

Tk

Tkkkkk

Tkkk HGqGHRvvER )(])([: 11111 +++++ +==

Tkkkk

Tkkk

Tkkk GqGHFSevES 1/1111 )(])([: ++−+++ −== . (18)

<Proof>

By Eqs. (1) and (15), the time-propagation of estimation error from −ke to −

+1ke is derived as

kkkkkk wGeFe += −+

−+ /11 . (19)

According to Eqs. (13) and (19), the given kz satisfies the following relationship with −+1ke .

kkkkkkkkkkk wGFHveFHz 1/11

1/1 )()( −

+−+

−+ −+= (20)

Page 9: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

9

By defining 1+kv as

kkkkkkk wGFHvv 1/11 )(: −

++ −= , (21)

we obtain the result. In addition to the interpretation of kz by 1+kz in Eqs. (17) and (18), various

equivalent interpretations can be obtained by applying Lemmas 2-1, 2-2, and 2-3.

III. Equivalent Batch Measurements

Given Nkx −ˆ , NkP − , kjNkjw <≤−}{ , kjNkjz ≤<−}{ , and kjNkjv ≤<+− 1}{ for a discrete-time system model

represented by Eqs. (1)-(3), the most common method for obtaining the optimal a posteriori estimate kx̂ of

kx is to implement, step by step, the recursive KF algorithm by Eqs. (4) and (5). Given the Lemmas

regarding the preservation of information, it is possible to obtain the same optimal a posteriori estimate kx̂

of kx in a different way given NkNkx −− /ˆ , NkNkP −− / , kjNkjw <≤−}{ , kjNkjz ≤<−}{ , and kjNkjv ≤<+− 1}{ .

Suppose that the a priori estimation of kjNkjx ≤<−}{ was performed by only the following multiple-step

time-propagations, without utilizing the measurements kjNkjz ≤<−}{ .

Nkkx −/ˆ NkNkNkk xF −−−= // ˆ

Nkke −/ NkkNkNkNkk WeF −−−−− += /1//

oNkk

ToNkkNkNkNkk wGeF −−−−−−− += /1/1// )(

kM NkkT

NkkNkNkk FPF −−−−− Ξ+= /1// (23)

where

oNkk

ToNkk

k

NkjjjjkNkk wGwGFW −−−−

−=+−− == ∑ /1/1

1

1//1 )(:

( )NkkNkk OW −−−− Ξ /1/1 ,~

ToNkk

oNkk

oNkkNkk GQG )(: /1/1/1/1 −−−−−−−− =Ξ

[ ]NkNkkkkkkkkko

Nkk GFGFGFGG −+−−−−−−−− = 1/32/21/1/1 : L

Page 10: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

10

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

−−

Nk

k

k

k

oNkk

w

www

wM

3

2

1

/1 : ,

( )oNkk

oNkk QOw −−−− /1/1 ,~

0/1 >=−− qIQoNkk . (24)

Note that Nkk −−Ξ /1 in Eq. (24) is a controllability grammian matrix by the process noise from the ( Nk − )-

th step to the ( 1−k )-th step. Suppose that we are also given the measurements from the ( 1+− Nk )-th step

to the k -th step expressed by a stacked measurement vector sNkkZ 1/ +− in addition to the a priori estimation

Nkkx −/ˆ of Nkx − .

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

+−

+−

1

2

1

1/ :

Nk

k

k

k

sNkk

z

zzz

ZM

jNkjjjNkjjj vehyxhz +=−= +−+− 1/1/ˆ: (25)

By the first three theorems given in Section II, it is possible to find an Nmn × optimal transformation

matrix *1/ +−NkkC from an 1×Nm stacked measurement vector s

NkkZ 1/ +− to an 1×n single equivalent

measurement vector nNkkZ 1/ +− without any information loss,

*1/1/ +−+− = Nkk

nNkk CZ s

NkkZ 1/ +− . (26)

If we exactly trace the changes of the measurement coefficient matrix, error covariance matrix, and cross-

correlation matrix of nNkkZ 1/ +− , it is possible to obtain the optimal a posteriori estimate kx̂ of kx by a

batch form as

sNkkNkk

nNkkNkk

nNkk

nNkkNkkk ZCKxZKxx 1/

*1/1//1/1// ˆˆˆ +−+−+−−+−+−− −=−= (27)

where nNkkK 1/ +− denotes the optimal gain related with n

NkkZ 1/ +− . For this purpose, three kinds of equivalent

Page 11: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

11

batch measurements are presented. They are classified as stacked measurement, de-correlated measurement,

and OCM according to their corresponding characteristics. By combining any one of the presented

equivalent measurements with the a priori estimation Nkkx −/ˆ , we can obtain the optimal a posteriori

estimation kx̂ of kx periodically at intermittent times L,3,2,1,0, == jjNk according to the Lemmas

in Section II.

To notationally discriminate between various vectors and matrices that are related with several concepts

of equivalent measurement, the superscript s will be used for a stacked measurement, the superscript ⊥

will be used for a de-correlated stacked measurement, and the superscript n will be used for an OCM. To

align all the measurements obtained from the ( 1+− Nk )-th step to the k -th step with respect to Nkje −/ ,

the following relationship will be used,

jz j

k

jaaaajjNkkkjj vwGFheFh +−= ∑

=+−

1

1/// . (28)

3.1 Stacked Measurement

A single stacked measurement vector sNkkZ 1/ +− is obtained if we merely stack each measurement

obtained from the ( 1+− Nk )-th step to the k -th step. In this case, the stacked measurement sNkkZ 1/ +− can

be represented by the following single vector equation,

sNkkZ 1/ +−

oNkk

oNkk

oNkkNkk

sNkk wHveH −−−−+−−+− −+= /1/11//1/

sNkkNkk

sNkk veH 1//1/ +−−+− += (29)

where

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

+−

+−

1

2

1

1/ :

Nk

k

k

k

sNkk

z

zzz

ZM

,

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

+−+−

−−

−−

+−

kNkNk

kkk

kkk

k

sNkk

Fh

FhFhh

H

/11

/22

/11

1/ :M

Page 12: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

12

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

+−

+−

1

2

1

1/ :

Nk

k

k

k

oNkk

v

vvv

vM

, ( )oNkk

oNkk ROv 1/1/ ,~ +−+−

mNmN

mm

mm

mm

oNkk rI

rIOO

OrIOOOrI

R ×

×

×

×

+− =

⎥⎥⎥⎥

⎢⎢⎢⎢

=

L

MOM

L

1/

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=

+−+−+−+−−−+−+−−+−+−

−−+−+−−+−+−

−−−

+−

OGFhGFhGFhOOGFhGFh

OOOGFhOOOO

H

NkNkNkNkkkNkNkkkNkNk

kkNkNkkkNkNk

kkkko

Nkk

12/1121/111/11

21/221/22

1/11

1/ :

L

L

MMOMM

L

L

oNkk

oNkk

oNkk

sNkk wHvv −−−−+−+− −= /1/11/1/ :

( )sNkk

sNkk ROv 1/1/ ,~ +−+−

( )( )[ ]To

Nkko

Nkko

Nkko

Nkk

TsNkk

sNkk

sNkk

HQHR

vvER

)(

:

/1/1/11/

1/1/1/

−−−−−−+−

+−+−+−

+=

=

( )( )[ ].)(

:

/1/1/1

/1/1/To

Nkko

Nkko

Nkk

TNkk

sNkk

sNkk

GQH

evES

−−−−−−

−+−+−

−=

= (30)

As shown in Eqs. (29) and (30), the measurement noise sNkkv 1/ +− of the stacked measurement s

NkkZ 1/ +−

is composed of two terms, i.e., the noise term oNkkv 1/ +− , which is uncorrelated with the a priori estimation

error Nkke −/ , and the noise term oNkk

oNkk wH −−−− /1/1 , which is correlated with the a priori estimation error

Nkke −/ . Since a sequence of process noise kjNkjw <≤−}{ generates a correlation between the stacked

measurement noise sNkkv 1/ +− and the a priori estimation error Nkke −/ of [ ]NkkNkk yyyxEx −− = ,,,|:ˆ 21/ L

as shown in Eq. (30), the optimal a posteriori estimation [ ]kkk yyyxEx ,,,|:ˆ 21 L= of kx using all the

measurement up to the k -th step can be obtained by a somewhat complicated computation:

Page 13: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

13

[ ]1

1/1/1/

1/1/

1/1/1/

)()()(

)()(

)()(−

+−+−+−

+−+−

+−+−+−

⎥⎥⎦

⎢⎢⎣

+++

⋅+=

sNkk

TsNkk

sNkk

TsNkkk

sNkk

TsNkk

TsNkkk

sNkk

RSS

HMH

SHMK

[ ])()( 1/1/1/s

Nkkks

Nkks

Nkkkk SMHKMP +−+−+− +−=

sNkk

sNkkNkkk ZKxx 1/1//ˆˆ +−+−− −= . (31)

By performing above computation, the a posteriori estimation error ke of kx̂ satisfies

[ ] sNkk

sNkkNkk

sNkk

sNkkk vKeHKIe 1/1//1/1/ +−+−−+−+− −−= . (32)

3.2 De-Correlated Stacked Measurement

As shown in Eqs. (29) and (30), the correlation between the stacked measurement noise sNkkv 1/ +− and

the a priori estimation error Nkke −/ makes the optimal measurement update somewhat complicated. To

circumvent this complication, an equivalent measurement whose error is uncorrelated with Nkke −/ is

desirable. The de-correlated stacked measurement ⊥+− 1/ NkkZ is formed as

sNkkNkk ZZ 1/1/ +−

⊥+− = ⊥

+−−⊥

+− += 1//1/ NkkNkkNkk veH (33)

where

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

=+=

⊥+−−

⊥−−

⊥−−

−+−+−

⊥+−

kNkNk

kkk

kkk

k

ks

Nkks

NkkNkk

Fh

FhFhh

MSHH

/1

/22

/111

1/1/1/ )(:M

sNkkNkkk

sNkkNkk veMSv 1//

11/1/ )( +−−

−+−

⊥+− +−=

( )( )[ ]OSS

evESs

Nkks

Nkk

TNkkNkkNkk

=+−=

=

+−+−

−⊥

+−⊥

+−

1/1/

/1/1/ :

( )( )⎟⎠⎞⎜

⎝⎛−=

⎥⎦⎤

⎢⎣⎡=

+−−

+−+−

⊥+−

⊥+−

⊥+−

TsNkkk

sNkk

sNkk

TNkkNkkNkk

SMSR

vvER

1/1

1/1/

1/1/1/ :

klMIFF klkklkl <Ξ−= −−

⊥ ],)([: 1/1//

Page 14: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

14

( )jjk

k

ljjjjklk GFqGF 1/11/1/ : ++

=++∑=Ξ . (34)

Since the measurement noise ⊥+− 1/ Nkkv of the de-correlated measurement ⊥

+− 1/ NkkZ is uncorrelated with

Nkke −/ as shown in Eq. (34), it will simplify the form of measurement update equations of Eqs. (31) and

(32) as follows.

[ ] 11/1/1/1/1/ )()()()(

−⊥+−

⊥+−

⊥+−

⊥+−

⊥+− += Nkk

TNkkkNkk

TNkkkNkk RHMHHMK

kNkkNkkkk MHKMP ⊥+−

⊥+−−= 1/1/

⊥+−

⊥+−− −= 1/1//ˆˆ NkkNkkNkkk ZKxx . (35)

By performing the computation of Eq. (35), the a posteriori estimation error ke of kx̂ satisfies

[ ] ⊥+−

⊥+−−

⊥+−

⊥+− −−= 1/1//1/1// NkkNkkNkkNkkNkkkk vKeHKIe . (36)

3.3 Orthonormalized Compressed Measurement

Though the de-correlated stacked measurement ⊥+− 1/ NkkZ obtained in Subsection 3.2 simplifies the

optimal measurement update, its dimension Nm is rather large and the corresponding measurement

coefficient matrix ⊥+− 1/ NkkH in Eq. (34) is still complicated. Under the assumption that the modified

observability grammian ⊥+−

⊥+− 1/1/ )( Nkk

TNkk HH is non-singular, a pseudo-inverse can be pre-multiplied to

⊥+− 1/ NkkZ for further simplification. Then, by Lemma 2-3, this pre-multiplication generates no information

loss in estimating kx using Nkkx −/ˆ and ⊥+− 1/ NkkZ . As a result, an OCM and its error statistics are obtained

as follows.

nNkkZ 1/ +− ⊥

+−+⊥

+−= 1/1/ )(: NkkNkk ZH

nNkkNkk ve 1// +−− += (37)

where

[ ] 11/1/

11/

11/1/1/ )()()()()(:)( −⊥

+−⊥

+−

−⊥+−

−⊥+−

⊥+−

+⊥+− = Nkk

TNkkNkkNkk

TNkkNkk RHHRHH

⊥+−

+⊥+−+− = 1/1/1/ )(: NkkNkk

nNkk vHv

( )nNkk

nNkk ROv 1/1/ ,~ +−+−

Page 15: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

15

[ ][ ] 1

1/1

1/1/

1/1/1/1/

)()()(

)(−⊥

+−−⊥

+−⊥

+−

⊥+−

⊥+−

+⊥+−+−

=

=

NkkNkkT

Nkk

TNkkNkkNkk

nNkk

HRH

HRHR

( )( )[ ] OevES TNkk

nNkk

nNkk == −+−+− /1/1/ : . (38)

The resulting OCM nNkkZ 1/ +− has the following analytic advantages:

i) the measurement coefficient matrix is a simple identity matrix;

ii) the measurement noise is not correlated with Nkke −/ ;

iii) the dimension is minimal, i.e., equal to the system dimension;

iv) it is closely related with the observability grammian.

By the OCM nNkkZ 1/ +− , the computation of the optimal estimate kkx /ˆ of kx using Nkkx −/ˆ and

{ }kjNkjz

≤<− can be performed as follows.

[ ] 11/1/

−+−+− += n

Nkkkkn

Nkk RMMK

kn

Nkkkk MKMP 1/ +−−=

nNkk

nNkkNkkkk ZKxx 1/1/// ˆˆ +−+−− −= . (39)

By performing Eq. (39), the a posteriori estimation error ke of kx̂ satisfies

[ ] nNkk

nNkkNkk

nNkkkk vKeKIe 1/1//1// +−+−−+− −−= . (40)

IV. Analysis by a Stochastically Driven Lyapunov function An analysis of LTV KF by a stochastically-driven Lyapunov function is now given. For analysis, we

introduce two observability grammian concepts: the scaled observability grammian and the orthogonalized

observability grammian. The scaled observability grammian 1/ +−Θ Nkk is defined by

)()(: 1/1/1/s

NkkTs

NkkNkk HH +−+−+− =Θ . (41)

Since we assumed for brevity that the error covariance matrix of each measurement is constant, the

conventional-sense observability grammian can be obtained by scaling 1/ +−Θ Nkk . The orthogonalized

observability grammian ⊥+−Θ 1/ Nkk is defined as

Page 16: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

16

)()()(: 1/1

1/1/1/⊥

+−−⊥

+−⊥

+−⊥

+− =Θ NkkNkkT

NkkNkk HRH . (42)

As shown, the orthogonalized observability grammian ⊥+−Θ 1/ Nkk is closely related with the OCM since its

inverse, if it exists, is the error covariance matrix of the OCM. Compared with the degree of observability,

the degree of controllability is represented only by the conventional-sense controllability grammian

Nkk −−Ξ /1 defined in Eq. (24).

For simplicity of analysis, we consider only the system that is uniformly controllable and uniformly

observable. Thus, there exists a positive integer N and positive constants θ , θ , ξ , and ξ such that

IIO Nkk θθ ≤Θ≤< +− 1/ , Nk ≥∀ ,

IIO Nkk ξξ ≤Ξ≤< −− /1 , Nk ≥∀ . (43)

In addition, we assume that, once N is fixed, the system matrices are bounded. Thus, there exist positive

real constants f , f , g , and h that satisfy the following inequalities.

IfFIfO jk ≤≤< / , Nk ≥ , 1,,1, −+−−= kNkNkj L

gGk ≤∞

, hhk ≤∞

, L,3,2,1=k (44)

Lemma 4-1: Boundedness of Error Covariance Matrices [2-4]

Assuming that OP >0 , the given system is uniformly completely controllable and observable satisfying

Eq. (43), and the system matrices are bounded satisfying Eq. (44). Then, the solutions of the discrete Riccatti

recursion satisfying

kM NkkT

NkkNkNkk FPF −−−−− Ξ+= /1//

11/

11/1/

11 )()()( −⊥+−

−⊥+−

⊥+−

−− += NkkNkkT

Nkkkk HRHMP (45)

are bounded by the following inequalities.

IpPIpO k ≤≤< , L,3,2, NNNk =∀

ImMImO k ≤≤< , L,3,2 NNk =∀ (46)

Page 17: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

17

where

0: >+

=ξθ

ξr

rp , ξ

θ+=

rp :

[ ]

0)1(

:2

2 >+

++=+=

ξθξξθ

ξr

rfpfm

θξθξ )1(:

222 frfpfm ++

=+= , (47)

which means that the solutions of the discrete Riccatti recursion kM and kP remain bounded.

Remark: Lemma 4-1 is the modification of previous study results [2-4] regarding the boundedness of the

discrete Riccatti recursion that utilizes the optimality of kP . By this lemma, various coefficient matrices that

will be used in the later Lyapunov analysis are shown to be bounded.

Lemma 4-2:

If the system matrices are bounded satisfying Eq. (44), then ( ) o

oNkk hH ≤+− 1/σ , (48)

where gfhNho 7.0:= . (49)

<Proof>

gfhNgfh

GhFGhFGhFGhFGhF

GFhH

NkNkNkkkNkkkNk

kkNkkkNk

kkkko

Nkk

7.0

01110011

00010000

000

0000000

12/121/11/1

21/21/2

1/11

1/

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

⎥⎥⎥⎥⎥⎥

⎢⎢⎢⎢⎢⎢

∞∞+−+−+−∞−−+−∞−+−

∞−−+−∞−+−

∞−−−

∞+−

L

L

MMOMM

L

L

L

L

MMOMM

L

L

(50)

Remark: oNkkH 1/ +− used in Eq. (50) represents the correlation between the stacked measurement

sNkkZ 1/ +− and the a priori estimation error Nkke −/ . Lemma 4-2 shows that the maximum singular value of

Page 18: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

18

oNkkH 1/ +− is bounded by a finite positive number although it increases with the block size N of the

stacked measurement.

Lemma 4-3: Inequality between Error Covariance of Equivalent Measurements

If OP Nk >− , (51)

then,

sNkk

TsNkkk

sNkk

sNkkNkk

oNkk RSMSRRR 1/1/

11/1/1/1/ )()( +−+−

−+−+−

⊥+−+− ≤−=< . (52)

<Proof>

i) By definition, it is obvious that

sNkk

TsNkkk

sNkk

sNkkNkk RSMSRR 1/1/

11/1/1/ )()( +−+−

−+−+−

⊥+− ≤−= . (53)

ii) If OP Nk >− , since OQoNkk >−− /1 by definition, we have

⇒ kM ToNkk

oNkk

oNkk

ToNkk

oNkk

oNkk

TNkkNkNkk GQGGQGFPF )()( /1/1/1/1/1/1// −−−−−−−−−−−−−−− >+=

⇒ [ ] OQGGQGMGQQ oNkk

oNkk

ToNkk

oNkk

oNkkk

ToNkk

oNkk

oNkk >−+ −−−−

−−−−−−−−−−−− /1/11

/1/1/1/1/1/1 )()(

⇒ ( )[ ] OGMGQ oNkkk

ToNkk

oNkk >−

−−−

−−

−−

1

/11

/11

/1 )()(

⇒ ( ) OGMGQ oNkkk

ToNkk

oNkk >− −−

−−−

−− )()( /11

/11

/1

⇒ OQGMGQQ oNkk

oNkkk

ToNkk

oNkk

oNkk >− −−−−

−−−−−−− /1/1

1/1/1/1 )()(

⇒o

NkkTo

Nkko

Nkko

NkkkTo

Nkko

Nkko

Nkk

ToNkk

oNkk

oNkk

oNkk

RHQGMGQH

HQHR

1//1/1/11

/1/1/1

/1/1/11/

})()(

)({

+−−−−−−−−

−−−−−−

−−−−−−+−

>−

+

⇒ oNkk

ToNkk

oNkk

oNkkk

ToNkk

oNkk

oNkk

sNkk RHQGMGQHR 1//1/1/1

1/1/1/11/ )()( +−−−−−−−

−−−−−−−+− >−

⇒ oNkk

TsNkkk

sNkk

sNkk RSMSR 1/1/

11/1/ )()( +−+−

−+−+− >−

⇒ oNkkNkk RR 1/1/ +−

⊥+− > . (54)

Remark: Lemma 4-3 shows that the error covariance matrix ⊥+− 1/ NkkR of the de-correlated stacked

Page 19: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

19

measurement is bounded above and below regardless of largeness of process noise kjNkjw <≤−}{ .

Lemma 4-4: Error Covariance Inequality of Two Dependent Gaussian Random Variables

Suppose we are given two Gaussian random vectors W and )( HeZ − with the following co-

distribution.

⎟⎟⎠

⎞⎜⎜⎝

⎛⎥⎦

⎤⎢⎣

⎡Ξ⎥⎦

⎤⎢⎣

⎡− RS

SO

HeZW T

,~ (55)

Then, the following inequalities hold.

OSSR T >Ξ− −1

OSRS T >−Ξ −1 (56)

<Proof>

By definition of error covariance matrices, it is obvious that

ORS

S T

>⎥⎦

⎤⎢⎣

⎡Ξ. (57)

Since

O>Ξ , OR > , (58)

the joint error covariance matrix appearing in Eq. (55) can be decomposed as

.1

11

1

11

⎥⎦

⎤⎢⎣

⎡⎥⎦

⎤⎢⎣

⎡ −Ξ⎥⎦

⎤⎢⎣

⎡=

⎥⎦

⎤⎢⎣

⎡ Ξ⎥⎦

⎤⎢⎣

⎡Ξ−

Ξ⎥⎦

⎤⎢⎣

⎡Ξ

=⎥⎦

⎤⎢⎣

⎡Ξ

−−

−−

ISROI

ROOSRS

RORSI

IOSI

SSROO

ISOI

RSS

TT

T

T

T

(59)

Thus, if the inequalities of Eq. (56) do not hold, Eq. (57) does not hold, which results in a contradiction.

Remark: W in Lemma 4-4 represents the accumulated process noise, Ξ represents the controllability

grammian, )( HeZ − represents the measurement error, and R represents the error covariance matrix of

an equivalent measurement that is gathered within a fixed time-interval.

Page 20: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

20

Lemma 4-5: Lower Bound for Intermediate Observability Grammian

Assume that the following matrix inequality holds.

MSRS T <−1 (60)

where OMM T >= and ORR T >= . Then, for any non-negative constant ε , the following matrix

inequality holds.

11111

1)()( −−−−− −

+≥++ MHRHSMHRSMH TT ε

εε

(61)

where all the matrix-dimensions are assumed appropriate.

<Proof>

Since R is positive definite and symmetric, it can be decomposed as follows.

21

21

RRR = , OR >21

(62)

Define X as

121

21

111: −−−

+++

= SMRHRX εε

. (63)

By the definition of error covariance matrix, it is obvious that

.

)()1(1

1

1111

1111

HRSMSMRH

MSRSMHRHXX

TT

TTT

−−−−

−−−−

++

+++

= εε (64)

Since OXX T > , we have

.)(

11

)(

1111

1111111

−−−−

−−−−−−−

−+

−≥

++

MSRSMHRH

HRSMSMRHMSRSM

TT

TTT

εε

(65)

Utilizing Eqs. (60) and (65), we finally have the result.

Remark: )()( 111 −−− ++ SMHRSMH T in Lemma 4-5 represents an intermediate observability

grammian that is necessary to seek the lower bound of the orthogonalized observability grammian.

HRH T 1− represents the observability grammian by the original concept. Thus, Lemma 4-5 provides us

with information on how the orthogonalized observability grammian can be positive definite.

Lemma 4-6: Lower Bound for Orthogonalized Observability Grammian

Page 21: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

21

Assume that Eq. (43), which means uniform complete controllability and observability, is satisfied. If

there exists an integer N and a positive constant a that satisfies the following condition

aIHRH Nkks

Nkks

NkkTs

Nkk +Ξ≥ −−−+−

−+−+−

1/11/

11/1/ )()()()( , (66)

the orthogonalized observability grammian ⊥+−Θ 1/ Nkk is bounded below by the following inequality.

IHRH NkkNkkT

Nkk γ1)()()( 1/

11/1/ ≥⊥

+−−⊥

+−⊥

+−

0)(

)2(2: 2 >

+=

ξξ

γa

a (67)

where ξ is a constant bound for the controllability grammian shown in Eq. (43).

<Proof>

Since

NkkkM −−Ξ> /1 , (68)

the following inequality holds by adopting the result of Lemma 4-5.

Ia

Ia

HRH

HRH

Nkk

Nkks

Nkks

NkkTs

Nkk

Nkks

NkkT

Nkk

εξεε

εε

εε

εε

ε

+

−≥

Ξ+

−+

Ξ−+

−−−

−−−+−

−+−+−

⊥+−

−+−

⊥+−

1)/(

)(11

)()()()(1

)()()(

1/1

2

1/11/

11/1/

1/1

1/1/

(69)

Thus, if we select ε as

εa

= , (70)

the following inequality results.

OIa

aHRH Nkk

sNkk

TNkk >

+≥⊥

+−−

+−⊥

+− )2(2)(

)()()(2

1/1

1/1/ ξξ

(71)

Since ⊥+−+− ≥ 1/1/ Nkk

sNkk RR , as shown by Lemma 4-3, the result is obtained.

Remark: The OCM introduced in Section III becomes full column-rank if )()( 1/1/⊥

+−⊥

+− NkkT

Nkk HH is

Page 22: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

22

non-singular. Lemma 4-6 means that a full column-rank OCM exists if Eq. (66) is satisfied. The physical

meaning of Eq. (66) is that the information gathered by the measurements, excluding the a priori estimate, is

greater than the information gathered by propagating the initially-perfect estimate with process noises.

Lemma 4-7: Upper Bound for Orthogonalized Observability Grammian

Assume that the given system is uniformly completely controllable and uniformly completely observable

satisfying Eq. (43) and that the system matrices are bounded satisfying Eq. (44). Then, the orthogonalized

observability grammian ⊥+−Θ 1/ Nkk is upper-bounded by

IHRH NkkNkkT

Nkk γ1)()()( 1/

11/1/ ≤⊥

+−−⊥

+−⊥

+−

0)(121:

1

22

>⎥⎥⎦

⎢⎢⎣

⎡+⎟⎟

⎞⎜⎜⎝

⎛+=

oqhrm

mrθγ . (72)

<Proof>

By Eq. (30), Lemma 4-2, and Lemma 4-3, the following inequality holds.

IqhrR os

Nkk )( 21/ +≤+− (73)

Due to Eq. (73) and Lemma 4-4, the following inequality also holds.

ks

Nkks

NkkTs

Nkks

NkkTs

Nkko

MSRSSSqhr

≤≤+ +−

−+−+−+−+− )()()()()(1

1/1

1/1/1/1/2 (74)

By Eqs. (52) and Lemma 4-1, we obtain

IqhrmSS os

NkkTs

Nkk )()()( 21/1/ +≤+−+− . (75)

Since ⊥+−+− < 1/1/ Nkk

oNkk RR , as shown in Lemma 4-3, it can be shown that

Page 23: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

23

.)()1(

)()()1()()(

)()()(

)()(

)()()(

)()()(

11/1/

1

1/1/

11/1/

111/1/

1/1/1

1/1/

11/1/

11/1/

1/1

1/1/

1/1

1/1/

−+−+−

+−+−

−+−+−

−−+−+−

+−+−−

+−+−

−+−+−

−+−+−

⊥+−

−+−

⊥+−

⊥+−

−⊥+−

⊥+−

++

+≤

⎥⎥⎦

⎢⎢⎣

++

+=

++=

ks

NkkTs

Nkkk

sNkk

TsNkk

ks

NkkTs

Nkkkks

NkkTs

Nkk

sNkk

TsNkkk

sNkk

TsNkk

ks

Nkks

NkkT

ks

Nkks

Nkk

Nkko

NkkT

Nkk

NkkNkkT

Nkk

MSSMr

HHrMSSMMSH

HSMHHr

MSHMSHr

HRH

HRH

εεε

(76)

Letting 1=ε , we have

.)(12

)()()(

22

1/1

1/1/

⎥⎥⎦

⎢⎢⎣

⎡+⎟⎟

⎞⎜⎜⎝

⎛+≤

⊥+−

−⊥+−

⊥+−

o

NkkNkkT

Nkk

qhrm

mr

HRH

θ (77)

Lemma 4-8: Bounds for Orthogonalized Observability Grammian

Assume that the given system is uniformly completely controllable and uniformly completely observable

satisfying Eq. (43). If there exists an integer N and a positive constant a that satisfies

aIHRH Nkks

Nkks

NkkTs

Nkk +Ξ≥ −−−+−

−+−+−

1/11/

11/1/ )()()()( , (78)

then the error covariance matrix of the OCM is bounded by

IRI nNkk γγ ≤≤ +− 1/ (79)

where the positive bounding constants γ and γ are defined in Lemma 4-6 and Lemma 4-7, respectively.

For the stability analysis of the stochastic Lyapunov method, we make use of the following two

definitions and one lemma for the boundedness of stochastic process.

Definition 4-1: Exponential Boundedness in Mean Square [6-8]

The stochastic process nζ is said to be exponentially bounded in mean square, if there are real numbers

η , 0>v , and 10 <<ϑ , such that

Page 24: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

24

{ } vE nn +≤ ϑζηζ 0

2 (80)

holds for every 0≥n .

Definition 4-2: Boundedness with Probability One [6-8]

The stochastic process nζ is said to be bounded with probability one, if

∞<≥

nn

ζ0

sup (81)

holds with probability one.

For later use, we recall some standard results about the boundedness of stochastic processes.

Lemma 4-8 [8]

Assume there is a stochastic process )( nn eV as well as real numbers 0,, >µvv and 10 ≤<α such

that

22 )( nnnn eveVev ≤≤ (82)

and

( ){ } ( ) ( )nnnnnnn eVeVeeVE αµ −≤−++ |11 (83)

are fulfilled for every solution ne of Eqs. (4) and (5). Then the stochastic process is exponentially bounded

in mean square, i.e., we have

{ } { }( ) ( )∑−

=

−+−≤1

1

20

2 11n

i

inn v

eEvveE αµα (84)

for every 0≥n . Moreover, the stochastic process is bounded with probability one.

Since all the preliminaries are completed prepared, we can now state the main result of this paper.

Theorem: Stochastic Radius of Attraction of LTV KF

Consider the discrete LTV system of Eqs. (1)-(3) which is uniformly completely controllable and

uniformly completely observable satisfying Eq. (43), and the system matrices are bounded satisfying Eq.

Page 25: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

25

(44). Given conditions i) and ii),

i) there exists an integer N and positive constants γ and γ by which

IRIO nNkk γγ ≤≤< +− 1/ holds for all Nk ≥ , (85)

and

ii) there exists an integer N and a positive constant a that satisfies Eq. (66),

then if condition i) or ii) holds, the estimation error of the KF by Eqs. (4) and (5) is exponentially bounded in

mean square and bounded with probability one with the radius of contraction π as

⎟⎟⎠

⎞⎜⎜⎝

⎛+=

γξγπ pm

pp 2 (86)

where the positive constants p , p , m , ξ , γ , and γ are defined in Eqs. (43), (47), (67), and (72).

<Proof>

The following matrices

Nkkk PM −= /:

11/

11/1/ )()(: −

+−−

+−+− =+= nNkkk

nNkkkk

nNkk RPRMMK

[ ] [ ] nNkk

nNkkkNkk

nNkkk

nNkk

nNkkNkk

nNkkk

vRPeRP

vKeKU

1/1

1//1

1/

1/1//1/

)()(

:

+−−

+−−−

+−

+−+−−+−

−−=

−−=

1// : −−− =Γ NkkNkk F

( ) 1

/1

/:−

−−

−= NkkkT

Nkkk FMFN (87)

satisfy the relationships

11/

11 )( −+−

−− += nNkkkk RMP

nNkk

nNkkkkk KIRPIMP 1/

11/

1 )( +−−

+−− −=−=

( ) nNkkNkkNkkkkNkk

nNkkNkkNkkkkk

vKeIMPe

vKeMPe

1/1//1

/

1/1//1

+−+−−−

+−+−−−

−−+=

−=

Page 26: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

26

nNkk

nNkkkkkkNkk vRMePMe 1/

11/

1/ )( +−

−+−

−− +=

NkkkT

Nkkk FMFN −−

−− = /

1/

1 . (88)

We also have

( ) nNkk

nNkkNkk

nNkkkNkkk vKeKIUee 1/1//1// +−+−−+−− −−=+= . (89)

Defining a Lyapunov candidate )( kk eV as

kkT

kkk ePeeV 1:)( −= , (90)

then, by the properties of Eqs. (87)−(89), )( kk eV satisfies

NkkkT

NkkkkT

k

kkT

kkn

NkkT

kNkkkT

Nkkkk

eMeeMe

ePeeReeMeeV

−−

−−

−−+−−

−−

−−

+−=

/1

/1

111//

1/ 2)()(

Nkkk

TNkkkk

Tk

nNkk

nNkkk

Tk

NkkkT

kkn

NkkT

kNkkkT

Nkk

eMeeMevKPe

eMeeReeMe

−−

−−

+−+−−

−−−

+−−−

−−−

+−=

/1

/1

1/1/1

/11

1//1

/

2

2)(

( ) ( ) n

Nkkn

NkkT

kNkkkkT

Nkkk

kn

NkkT

kNkkkT

Nkk

vReeeMee

eReeMe

1/1

1//1

/

11//

1/

)(2

)(

+−−

+−−−

−+−−

−−

−−−−

−=

( ) ( ) n

Nkkn

NkkT

kNkkkkT

Nkkk

kn

NkkT

kNkkkT

Nkk

vReeeMee

eReeMe

1/1

1//1

/

11//

1/

)(2

)(

+−−

+−−−

−+−−

−−

−−−−

−=

( )n

Nkkn

Nkkkn

NkkTn

Nkk

nNkk

nNkk

TnNkk

TNkk

kkT

kkn

NkkT

kNkkkT

Nkk

vRPRv

vRKIe

UMUeReeMe

1/1

1/1

1/1/

1/1

1/1//

111//

1/

)()()(2

)(2

)(

+−−

+−−

+−+−

+−−

+−+−−

−−+−−

−−

+

−−

−−=

( ) ( )

( )n

Nkkn

Nkkkn

NkkTn

Nkk

nNkk

nNkk

TnNkk

TNkkNkNkk

kkT

kkn

NkkT

k

NkkNkNkkkT

NkkNkNkk

vRPRv

vRKIWeF

UMUeRe

WeFMWeF

1/1

1/1

1/1/

1/1

1/1//1/

111/

/1/1

/1/

)()()(2

)()(2

)(

+−−

+−−

+−+−

+−−

+−+−−−−−

−−+−

−−−−−

−−−−

+

−+−

−−

++=

( )( )

NkkkT

Nkk

nNkk

nNkkk

nNkk

TnNkk

nNkk

nNkk

TnNkk

TNkk

nNkk

nNkk

TnNkk

TNkk

TNk

NkkkT

NkkT

Nk

kkT

kkn

NkkT

k

NkNkT

Nk

WMW

vRPRv

vRKIW

vRKIFe

WMFe

UMUeRe

ePe

−−−

−−

+−−

+−−

+−+−

+−−

+−+−−−

+−−

+−+−−−

−−−

−−

−−+−

−−

−−

+

+

−−

−−

+

−−

/11

/1

1/1

1/1

1/1/

1/1

1/1//1

1/1

1/1//

/11

/

111/

1

)()()(2

)(2

)(2

2

)(

Page 27: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

27

( )( ) n

Nkkn

NkkTn

NkkT

Nkk

nNkk

nNkk

TnNkk

TNkk

TNk

NkkkT

NkkT

Nk

nNkk

nNkkk

nNkk

TnNkk

NkkkT

Nkk

kkT

k

kn

NkkT

k

NkNk

vRKIW

vRKIFe

WMFe

vRPRv

WMW

UMU

eRe

eV

1/1

1/1//1

1/1

1/1//

/11

/

1/1

1/1

1/1/

/11

/1

1

11/

)(2

)(2

2

)()()(2

)(

)(

+−−

+−+−−−

+−−

+−+−−−

−−−

−−

+−−

+−−

+−+−

−−−

−−

−+−

−−

−−

−−

+

+

+

)()()()(2

)(

)(

1/1

1/1

1/1/

/11

/1

11/

kCvRPRv

WMW

eRe

eV

nNkk

nNkkk

nNkk

TnNkk

NkkkT

Nkk

kn

NkkT

k

NkNk

++

+

+−−

+−−

+−+−

−−−

−−

−+−

−−

(91)

where )(kC in Eq. (91) is defined as

( )( ) n

Nkkn

NkkTn

NkkT

Nkk

nNkk

nNkk

TnNkk

TNkk

TNk

NkkkT

NkkT

Nk

vRKIW

vRKIFe

WMFekC

.1/1

1/1//1

1/1

1/1//

/11

/

)(2

)(2

2:)(

+−−

+−+−−−

+−−

+−+−−−

−−−

−−

−−

−−

=

(92)

By Lemma 4-1 and Lemma 4-8, it can be shown that

)(111)( 1211/ kkkk

Tkkk

nNkk

Tk eV

pePe

peeRe

γγγ=≥≥ −−

+− . (93)

Substituting Eq. (93) for Eq. (91), we have

).()()()(2

)(1)()(

1/1

1/1

1/1/

/11

/1

kCvRPRv

WMW

eVp

eVeV

nNkk

nNkkk

nNkk

TnNkk

NkkkT

Nkk

kk

NkNkkk

++

+

+−−

+−−

+−+−

−−−

−−

−−

γ

(94)

Rearranging and scaling the above equation, we obtain

Page 28: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

28

).(1

)()()(1

2

1

)(1

)(

1/1

1/1

1/1/

/11

/1

kCp

p

vRPRvp

p

WMWp

p

eVp

peV

nNkk

nNkkk

nNkk

TnNkk

NkkkT

Nkk

NkNkkk

γγ

γγ

γγ

γγ

++

++

++

+≤

+−−

+−−

+−+−

−−−

−−

−−

(95)

Taking the conditional expectation [ ]Nkkk eeVE −)( and removing the products of uncorrelated terms by

expectation, we have

[ ]

.1

2

1

)(1

1)()(

γγγ

ξγ

γ

γ

pp

p

mpp

eVp

eVeeVE NkNkNkNkNkkk

⋅+

+

⋅+

+

+−≤− −−−−−

(96)

To summarize, we have the inequality

[ ] βα +−≤− −−−−− )()()( NkNkNkNkNkkk eVeVeeVE (97)

where

01

1: >+

=pγ

α , ⎟⎟⎠

⎞⎜⎜⎝

⎛+

+=

γξ

γγ

β pmp

p2

1: . (98)

In addition, from

)(2

22

NkNkNk eVepp −−− ≤≤< ααπαβ (99)

we find that the radius of attraction is

⎟⎟⎠

⎞⎜⎜⎝

⎛+==

γξγ

αβπ p

mppp 2 (100)

Page 29: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

29

V. Conclusion

In order to simplify the stability analysis of the discrete linear time-varying Kalman filter, we presented a

stochastic Laypunov method by an orthonormalized compressed measurement. As a result, a stochastic

radius of attraction was derived. For the derivation of the stochastic radius of attraction, five Lemmas were

introduced to explain preservation of information. Utilizing five Lemmas, three concepts of equivalent

measurements were introduced. All the measurements in a specified time interval were stacked to a vector

form a stacked measurement. A de-correlation process is applied to the stacked measurement to generate a

de-correlated measurement. Finally, the large dimension of the de-correlated measurement is reduced by a

weighted pseudo-inverse resulting in an orthonormalized compressed measurement. Afterwards, various

matrix inequalities were explained to show the boundness of error covariance matrices and grammians.

Finally, a stochastically-driven Lyapunov method is applied to derive the radius of attraction. During the

derivation, it was shown that the complex multiple-step propagations a stochastic Lyapunov function

candidate driven by measurement and process noises can be simplified to a one-step Lyapunov propagation

by the orthonormalized compressed measurement. Since the unique analysis procedure in this study

considers the effects of the noise terms correctly, it will also help to understand the physical meanings of

grammians and the stability of linear time-varying Kalman filters more better.

Acknowdegements This work has been supported by the Automatic Control Research Center (ACRC) and Automation Systems Research Institute (ASRI) of Seoul National University and by the Agency for Defence Development (ADD).

Reference

[1] R. E. Kalman, "A New Approach to Linear Filtering and Prediction Problems", ASME J. Basic

Eng. Vol. 82, pp. 35-45, March, 1960

Page 30: Stability Analysis of Kalman Filter by Orthonormalized …nisl.kau.ac.kr/KIEE02-hyknlee.pdf · 2012. 1. 12. · Zk / k−N+1. The OCM provides information on the a priori state estimate

30

[2] A. H. Jazwinski, Stochastic Processes and Filtering Theory, New York : Academic Press, 1970 [3] B. D. O. Anderson and J. B. Moore, Optimal Filtering, Eaglewood Cliffs, NJ: Prentice-Hall,

1979 [4] T. P. McGarty, Stochastic Systems and State Estimation, New York : Wiley, 1973 [5] P. S. Maybeck, Stochastic Models, Estimation and Control, Vol. 1, Academic Press, 1979 [6] R. G. Agniel and E. I. Jury, “Almost sure boundedness of randomly sampled systems”, SIAM J.

Contr., vol. 9, pp. 372-384, 1971 [7] T. J. Tarn and Y. Rasis, “Observers for nonlinear stochastic systems”, IEEE Trans. Automat.

Contr., vol. AC-21, pp. 441-448, 1976 [8] K. Reif, S. Günthe, E. Yaz, R. Unbehauen, “Stochastic Stability of the Discrete-Time Extended

Kalman Filter”, IEEE Trans. Automat. Contr., Vol. 44, No. 4, pp. 714-728, April, 1999