You are on page 1of 9

Journal of

Mechanical
Science and
Technology
Journal of Mechanical Science and Technology 22 (2008) 905~913
www.springerlink.com/content/1738-494x

Estimability measures and their application to GPS/INS


Jeong Hyun Moon1, Sinpyo Hong2,*, Ho-Hwan Chun3 and Man Hyung Lee4
1
Department of Mechanical and Intelligent Systems Engineering, Pusan National University
2
General Marine Business Inc, Ulsan 680-819, Korea
3
Department of Naval Architecture and Ocean Engineering, Pusan National University
4
School of Mechanical Engineering, Pusan National University, Busan 609-735, Korea

(Manuscript Received July 20, 2007; Revised February 11, 2008; Accepted February 11, 2008)
--------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
Abstract

In this paper, estimability measures and their properties are introduced for a discrete linear system. The degrees of
estimability of both a system and its subspaces can be examined with these measures for multi-input/multi-output time-
varying systems. The relations among estimability, error covariance, and information matrix are presented. The effects
of the initial error covariance, system model perturbation, and the transformation of state variable on the measures are
also given. The estimability measures are applied to GPS/INS to confirm the estimability analysis results.

Keywords: Estimability measure; Observability measure; Singular value decomposition (SVD); The global positioning system (GPS);
Inertial navigation system (INS)
--------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------

the initial error covariance. The direction of unesti-


1. Introduction
mable subspace can be different from that of unob-
In estimation applications, the performance of es- servable subspace. In this paper, properties of error
timators is usually examined with covariance analysis. covariance are investigated with estimability meas-
Error covariance provides statistical information on ures. The degree of estimability and the effects of
the behavior of state estimators [1]. To characterize both system model perturbation and transformation of
the properties of error covariance, the concept of es- state variable on error covariance are studied with the
timability was introduced by Baram and Kailath [2]. measures.
For systems free from plant noise, Goshen-Meskin Two types of estimability measures are considered
and Bar-Itzhack [3] showed that the conditions for for a discrete linear system. The measures are defined
estimability and observability are the same. Error as the ratio of error covariance change to the initial
covariance can be used to test the degree of ob- error covariance. One measure is concerned with the
servability [4]. Especially, covariance analysis has estimability of a subspace in the state-space. This
widely been applied in the observability study of the measure describes the relative error covariance
inertial navigation systems (INS) [5-10]. change in a specific direction. The other measure is
Even though estimability has close relationships defined with the minimum of the subspace estimabil-
with observability, it has its own characteristics [11, ity measure over the whole state-space. Thus, it is the
12]. Both the decrease and decrease rate of error co- estimability measure of a system. These measures are
variance can be greatly influenced by the choice of applicable to multi-input/multi-output time-varying
*
systems.
Corresponding author. Tel.: +82 52 270 3559, Fax.: +82 52 256 8053
E-mail address: sinpyo59@paran.com A physical system and its mathematical model are
DOI 10.1007/s12206-008-0206-2 usually not the same. Uncertainties in the systems
906 J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913

may cause modeling errors. For complicated systems, a random variable x; x  N x , P denotes x is a
simple models are often preferred to make analysis of normal random variable with the mean x and co-
the system uncomplicated. For real-time estimation, variance P. \ denotes the set of real numbers, \ n
simple models are also convenient in order to save denotes the vector space of real n-vectors, \ mu n
T
computational loads. In these cases, system designers denotes the set of m u n real numbers, < denotes
1
may be interested in the influence of system model the transpose of a matrix or vector, < denotes the
perturbation on the estimation. The influence of inverse of a square matrix. Note that for a matrix M,
1 T
model perturbation on the estimability measures is M T M 1 . diag d1,", dn denotes a matrix
inspected with the singular value decomposition with zero off-diagonal elements; diagonal elements
(SVD) techniques in this paper. are d1 , " , d n from left to right. I n denotes
There can be several mathematical models for a n u n identity matrix, 0 denotes a zero matrix with an
given physical system. The choice of the mathemati- appropriate dimension, < 2 denotes the 2-norm of a
cal model may depend on the application area of the matrix or vector.
model. For INS, there are several linearized models For a matrix M  \ mu n , the SVD, M UDV T ,
for navigation error propagation [13-17]. The exists such that U  \ mu m and V  \ nu n are or-
selection of the INS error propagation model depends thogonal, D diag(V 1 ,V 2 ,",V p )  \ mu n with p
on both the reference frames of the navigation min ^m, n` and V 1 t V 2 t " t V p t 0 . The V i are
mechanization equations and attitude error model. the singular values of M. Columns ui in U are called
Thus, navigation system designers might be often the left singular vectors of M and columns vi in V
interested in the influence of the navigation error are called the right singular vectors of M. It can be
p
propagation models on the error covariance. For the shown that M ¦ i 1V i ui viT . If M is symmetric and
error models that describe the same navigation error non-negative, then U V and the left and right sin-
states with different coordinate systems, there exists a gular vectors are the same and simply called singular
one-to-one linear transformation between each pair of vectors. V < denotes the largest singular value of a
the error propagation models. In this paper, the effect matrix. Note that < 2 V < . V < denotes the
of constant linear transformations of the navigation smallest singular value of a matrix.
error state on the error covariance is studied with the Consider the following system:
estimability measures.
xi ) i ,0 x0 ½
The proposed estimability measures are applied to ¾ (1)
yi H i xi  vi ¿
GPS/INS. Numerical tests are carried out to verify the
estimability analysis results for a constant speed hori- where xi  \ n is the state vector at the time step i,
zontal motion. The effects of model perturbation, x0  \ n is the initial state vector, ) i ,0  \ nu n is the
reference coordinate system, and initial error covari- state transition matrix from the time step 0 to the time
ance on the error covariance are examined with the step i, yi  \ m is the measurement vector at the time
measures. step i, vi  \ m is the measurement noise vector at
the time step i, and H i  \ mu n is the measurement
2. Estimability measures matrix at the time step i. Assume that
x0  N x0 , P0 with P0 ! 0 , vi  N 0, Ri with
In this section, estimability measures and their Ri ! 0 , E ª¬vi vTj º¼ 0 for i z j , and E ª¬vi x0T º¼ 0 .
properties are introduced for a discrete linear system. The conditional expected-value estimate that is also
The relations among estimability, error covariance, the minimum variance or maximum-likelihood esti-
and information matrix are examined with the SVD. mate of the above system with a set of measurements
Both the effects of the perturbation of the system ^ y0 , y1 ,", yk ` , xˆ0, k , is given as [18, 19]
model and the transformation of the state vector on
1
measures are also presented. xˆ0, k P 0
1
 L0, k K k  P01 x0 (2)
Before the main results are given, notations for es-
timation applications and matrix analysis are intro- with
duced. x̂ denotes the estimate of a random variable
k k
x; x denotes the estimation error, x̂  x ; both T
H iT Ri1H i ) i ,0 ,䎃K k T
H iT Ri1 yi (3)
E > x @ and x indicate the expected value or mean of
L0, k ¦)
i 0
i ,0 ¦)
i 0
i ,0
J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913 907

where L0,k is the observability gramian or informa- concerned with the error covariance rather than the
tion matrix. Note that if the measurements do not initial error covariance.
have noise, then the system is deterministic and the In the following, new properties of estimability are
corresponding observability gramian is examined in detail. The measures of estimability are
k closely related to the SVD of P0 L0, k P0 . Let the
T
$0, k ¦) i ,0 H iT H i ) i ,0 (4) SVD of P0 L0, k P0 be U p 6 pU Tp where 6 p is
diag V p,1,V p,2 ,",V p,n  \nun and U p ª¬u p,1u p,2 "u p,n º¼ .
i 0
1
The above system is observable on [0,k] if and only Then P0,k PU º T
0 p ¬In  6 p ¼ U p P0
ª . Let d p,i
if L0, k ! 0 [20]. If the system is unobservable, then V p ,i 1  V p ,i . Then, d p ,1 t d p ,2 t " t d p , n t 0 . Let
the null space of L0,k is called the unobservable Dp diag d p,1, d p,2 ,", d p, n  \nun . Then, P0  P0,k
subspace of the system. Let x0, k x0  xˆ0, k . The error P0 U p D pU Tp P0 . Thus,
covariance matrix is defined as
u T P0U p D pU Tp P0 u
T Q L0, k , P0 , u (10)
P0, k  E ª¬ x x º¼
0, k 0, k (5) u T P0u

Then, we have Let z P0 u P0 u . Then, z 2


1 and
2
1
P
0, k P01  L0, k (6) Q L0, k , P0 , u z TU p D pU Tp z (11)

Hence, Thus, we have

P  P P
0 0, k 0
1
P0, k L0, k (7)
Q L0, k , P0 , P01 u p ,i d p ,i (12)

In estimation applications, the behavior of the error d p , n d Q L0, k , P0 , u d d p ,1 (13)


covariance is one of the main concerns of estimator
designers. To characterize estimator performance, When u P01 u p , n , Q L0, k , P0 , u takes its mini-
estimability and its measures were introduced in [12]. mum value such that
The following is a brief summary of the estimability
Q L0, k , P0 d p , n (14)
properties given in [12]. A system is called estimable
if P0  P0, k ! 0 . The null space of P0  P0,k is an Therefore, we have the following theorem:
unestimable subspace. A system is observable if and
only if the system is estimable. If the span of a vector Theorem 1:
u is unobservable, then the span of P01u is unesti-
mable. Thus, the unestimable subspace may not be Q L0, k , P0
V P0 L0, k P0 (15)
the same as the unobservable subspace for a given 1V P0 L0, k P0
system. A measure of estimability for a subspace is From Eq. (13) we have the following theorem:
defined with the ratio of the decrease in the error co-
variance of a vector in the subspace to the initial error Theorem 2: Let u  \ n . Then,
covariance of the vector:
V P0 V L0, k V P0 V L0, k
u T P0  P0, k u d Q L0, k , P0 , u d
Q L0, k , P0 , u (8) 1  V L0, k V P0 1  V L0, k V P0
u T P0u

where u  \ n . Thus, the measure indicates relative Proof: Since


decrease of error covariance in the direction of the V i L0, k V P0 d V i
P0 L0, k P0 d V i L0, k V P0
subspace. Then, the measure of estimability for the
system can be defined with [21, 22], we have

Q L0, k , P0  minQ L0, k , P0 , u (9) V P0 V L0, k


u\ n d d p , n and
1  V L0, k V P0
Therefore, the system is unestimable if and only if
V P0 V L0, k
Q L0, k , P0 0 . The concept of the estimability is d p ,1 d ⶯
similar to that in [2]. However, estimability in [2] is 1  V L0, k V P0
908 J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913

Theorem 2 shows that the upper and lower bounds V


P0 ' P0 d V P0 V ' ⶯
of the relative covariance decrease are proportional to
the smallest and the largest singular values of the The theorems also show that the relative error co-
initial error covariance matrix, respectively. The fol- variance decrease can be sensitive to a perturbation in
lowing theorems show the sensitivity of the estimabil- the information matrix if the initial error covariance
ity measures to a perturbation in the information ma- has a large norm.
trix: Several models are used to describe error propaga-
tion in the INS. For each pair of the models, an
Theorem 3: equivalent transformation can be obtained. In the
Let '  \ nu n , r  1  V L0, k V P0 ! V ' , and following the effect of equivalent transformation on
u  \ n . Then, the estimability measures of linear systems is exam-
ined. Let xic Txi and yic Syi be the transformed
V ' V P0
Q L0, k  ', P0 , u  Q L0, k , P0 , u d (16) state variable and measurement in the equivalent sys-
r r  V '
tem model where T  \ nu n and S  \ mu m are con-
stant non-singular matrices. Then, from Eq. (1) we
Proof: Let z P0 u P0 u . Then, z 2 1 . Let have a new equivalent system
2 1
Lp P0 L0, k P0 , ' p P0 ' P0 , and M I n  Lp
1
 In  Lp 'p . Then, Q L0, k  ', P0 , u Q L0, k , P0 , u xic )ci ,0
x0c ½
¾ (19)
z T Mz d M 2 . From Theorem 2.3.4 of [22], we yic H icxic  vic ¿
1 2 § 1  I  L 1 ' · .
have M 2
d 'p
2
I n  Lp
2
¨
©
n p 2 ¸¹ where )ci ,0 T ) i ,0T 1 , H ic SH iT 1 , x0c ~N x0c , P0c

The proof of the theorem follows from the relations N Tx0 , TP0T T , vic ~ N 0, Ric N 0, SRi S T . Then, the
1
'p d P0 2 ' 2 , I n  Lp
d 1 1  V L0,k V P0 optimal estimate of x0c with the set of measurements
2 2
1
^ y0c , y1c,", yck ` , xˆ0,c k , becomes
1 r , and I n  Lp ' d '
2
2 1  V L V P
0, k 0
1
' 2
r 1. ⶯ xˆ0,c k Pc0
1
 L0,c k K c  Pc xc
k 0
1
0 (20)

k
1 T
Theorem 4: with P0c TPT
0
T
, L0,c k ¦ )c T
i ,0 H icT Ric1H ic)ci ,0 T
i 0
'  \ nu n is symmetric and L0, k  ' t 0 . Then, k
1 T

Q L0, k  ', P0  Q L0, k , P0 d V ' V P0 (17)


L0, kT 1 , K kc ¦ )c T
i ,0 H icT Ric1 yic T K k . Thus, xˆ0,c k
i 0

Txˆ0, k . Let x0,c k x0c  xˆ0,c k . Then the corresponding


Proof: From Eq. (15), error covariance matrix can be defined as
Q L0,k ', P0 Q L0,k , P0 T
P0,c k  E ª« x0,c k x0,c k º» (21)
¬ ¼

V P0 L0,k ' P0 V P0 L0,k P0
Then,

1V P0 L0,k P0 V P0 L0,k ' P0 1V P0 L0,k P0
1
(18) P0,ck1 P0c1  L0,c k T T
P0,k1T 1 (22)
Since the denominator of the right-hand side of
(18) is greater than one, we have Hence,
Q L0, k  ', P0  Q L0, k , P0 d P0,c k TP0, kT T (23)
V P0 L0, k  ' P0  V P0 L0, k P0 The estimability measure of the transformed sys-
tem for the subspace spanned by a vector uc  \ n is
dV P0 ' P0
ucT P0c  P0,c k uc ucTT P0  P0,k T Tuc
The proof of the theorem follows from the relation Q c L0,c k , P0c,uc (24)
ucT Pu
0
cc ucTTPT
0
T
uc
J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913 909

Thus, we have the following theorem. ward, right, down), respectively. For simplicity of
notation, exponentiation with 10 as a base is ex-
Theorem 5: If T  \ nu n is a constant non-singular pressed with E such that 2.0E-05 means 2.0 u 105 in
matrix and u  \ n , then this section.
In the following estimability analysis of strap-down

Q c L0,c k , P0c, T T u
1
Q L0, k , P0 , u (25) INS, the navigation system error is the difference
between the computed estimate and true value. The
1 relatively exact state space model for error dynamics
Since Q c §¨ L0,c k , P0c, u p , n ·¸ Q c L0,c k , P0c
P0 T T
© ¹ in the strap-down INS mechanization equation in the
d p,n Q L0, k , P0 , we have the theorem: ECEF frame can be [16, 17, 23]

xe Fe xe  we ,G ye H e xe  ve (27)
Theorem 6: If T  \ nu n is a constant non-singular
matrix, then with
T
xe ª G Pe T e T
G V J b T
H gT H aT G l T º» (28)
Q c L0,c k , P0c Q L0, k , P0 (26) «¬ ¼
ª0 I3 0 0 0 0º
The above two theorems show that estimability «Ge 2:e C e b 0 C e
0»»
measures are unchanged during an equivalent trans- « ie b b
«0 0 :bib I3 0 0»
formation. Many transformations in INS are combina- Fe « » (29)
tions of symmetric scale transformations and or- «0 0 0 I3 W g 0 0»
«0 0 0 0 I3 W a 0»
thogonal rotation transformations. For example, the « »
transformation from the navigation frame to the earth- «¬ 0 0 0 0 0 0»¼
centered earth-fixed (ECEF) frame can be represented He ª¬ I 3 0 C L e b
0 0 C º¼ .e
(30)
b b
with T TrTs where Tr is a rotation transformation
and Ts is a scale transformation. Thus, for this case where xe is the error state; we is the plant noise;
1 1
T T in Theorem 5 is such that TsT TrT TrTs1 . ye is the measurement estimation error; ve is the
Therefore, the order of transformations is unchanged measurement noise; G P e and G V e are the position
and only scaling is inverted in the transformation and velocity errors; J b is the attitude error such that
1
T T . Cˆ be Cbe I 3  ª¬J b uº¼ ; H g and H a are bias errors for

the gyro and accelerometer, respectively; G l is the
error in the computed estimate of l b , the lever arm
3. An application to GPS/INS
vector between the inertial sensors and GPS antenna;
In this section, an application of the estimability G e wg e wP e where g e is the gravity;  b and
measures to GPS/INS is demonstrated. The influences Lb are the cross product matrices of the specific
of both the system model perturbation and the trans- force f b and l b , respectively; W g and W a are the
formation of navigation error state on the measures correlation times of noises in the gyro and acceler-
for a simple vehicle motion are presented. The effect ometer, respectively.
of the initial error covariance on the measures is also A linearized error dynamics model of strap-down
given. INS in the navigation frame can be
Notations for INS in this section follow those in [13,
x g Fg xg  wg , y g H g xg  vg (31)
17]. For a vector P , P a is the vector decomposed
in a coordinate frame a. Cab denotes the rotation with
matrix from a frame a to a frame b. Zabc denotes the ª G P n T n T b T
T
xg G V J H gT H aT G l T º» (32)
column vector of the angular velocity of a frame b ¬« ¼
relative to a frame a, decomposed in a frame c. :cab ª p n 0 0 0 0º
«G  V n u 0»»
denotes the cross product matrix of Zabc . i, e, n, and b « n
n n n
wp V u wv  :en  2:ie Cbn b 0 Cbn (33)
« Cnb wp 2 Cnb wv :bib I3 0 0»
used for coordinate frames denote the earth-centered Fg «
« 0 0 0  I3 W g 0 0»
»

inertial (ECI) frame, ECEF frame, body-fixed naviga- «


«
0 0 0 0  I3 W a 0»
»
tion frame (north, east, down), and body frame (for- «¬ 0 0 0 0 0 0»¼
910 J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913

Hg ª¬ I 3  l 0  n Cbn Lb 0 0 n Cbn º¼ (34) G P n and G V n are position and velocity error, respec-
tively; GO is the latitude error, G) is the longitude
where error; G h is the altitude error; O is the latitude; )
is the longitude; RO is the sum of the radius of cur-
ª1 º
«R 0 0» vature in a meridian and the altitude; R) is the sum
ªGO º ªG vN º « O » of the transverse radius curvature and the altitude;
«G)» , GV n «G v » , « 1 »
GP n
«0 0 », J b in Eq. (32) is the same as that in Eq. (28) such
« » « E» n
R) cos O
«¬G h »¼ «¬G vD »¼ « » that Cˆ bn Cbn I  ª¬J b uº¼ . If we define the attitude

«0 0 1» error in the navigation frame such that
« »
«¬ »¼ Cˆ bn
I 3  ª¬J n uº¼ Cbn , J n is the equivalent tilt angle
ª vN º of ) model in the strap-down INS [24]. If non-
« 0 0
RO2 » linear error terms are neglected, we have J b  RnbJ n .
« »
« vE sin O vE » vN , vE , and vD are the earth-relative velocity in the
p « 2
0 2 » north, east, and downward directions, respectively;
« R) cos O R) cos O »
Zie is the earth rotation rate.
« 0 0 0 »
« » For a simplified model of the system Fg , H g , the
«¬ »¼
following system will be considered to study the ef-
ª 1 º fect of a system model perturbation on the estimabil-
«0 0»
« R) » ity measures:
« 1 »
wv « 0 0» , xs Fs xs  ws , ys H s x s  vs (35)
« RO »
« » where xs has the same form of xg and
 sin O
«0 0»
¬« R) cos O ¼» ª0 n 0 0 0 0º
«0 2:n Cbn  b 0 Cbn 0»»
ª  vE º « ie
« 2Zie sin O 0 »
R)2 «0 0 :bib I3 0 0»
« » Fs « »,
« vN » «0 0 0  I3 W g 0 0» (36)
« 0 0 », «0
wp
« RO2 » 0 0 0 I3 W a 0»
« »
« vE vE sin O » ¬« 0 0 0 0 0 0¼»
« 2Zie cos O  2
0 »
¬« R) cos O R)2 cos O ¼» Hs ª¬ I 3 0  n Cbn Lb 0 0 n Cbn º¼
wg n
Gn The linearized error propagation models Fe , H e
wP n
and Fg , H g are not equivalent to each other in
ª  vE º general. However, if relatively small terms in the
« Zie sin O 0 »
« R)2 » error propagation equations such as p , wp , wv ,
« vN » n
,
0 0 :en wp 2 , and are neglected, these error
wp 2 « », l

« RO2 » propagation models can be considered equivalent.


« vE vE sin O » The relations among xe , xg , ye , and y g can be
« Zie cos O  0 »
¬« R) cos 2
O R)2 cos O ¼» stated as
ª lN º xe Teg xg , ye Seg y g (37)
« 0 0 »
RO2
« » where
« lE sin O l E »
l « 0 »,
« R) cos O
2
R)2 cos O » ªCne n1 0 0 0 0 0 º
« »
« 0 0 0 » « 0 Cne 0 0 0 0 »
« » « 0
¬ ¼ 0 I3 0 0 0 »
Teg « » , Seg Cne 1
n (38)
ªl N º « 0 0 0 I3 0 0 »
n b
Cb l «l » , « 0 0 0 0 I3 0 »
« E» « »
«¬lD »¼ «¬ 0 0 0 0 0 I3 »¼
J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913 911

Thus, xg Tge xe with Tge Teg1 . Note that if the Thus, all of the three navigation error propagation
vehicle velocity is not exceptionally high, both Cne models can be considered to have seven dimensional
and n can be considered time-invariant. Thus, unestimable subspaces with both the tactical and very
both Tge and Tge can be considered time-invariant. low-grade MEMS IMUs. The dimension of unesti-
Comparisons are made on the estimability meas- mable subspace is the same as that of unobservable
ures of the above three error dynamics models for a subspace of a simplified error propagation model in
vehicle that moves at 100 m/s to the north during 17 ECEF frame in [17]. Estimability measures with the
seconds. Measurement sampling period is one second, initial error covariance matrices corresponding to the
and the standard deviation (STD) of GPS position tactical grade IMU for the vertical component of gyro
measurement error vector in the navigation frame bias error, Q Ls , P0Tg , e12 , Q Lg , P0Tg , e12 , and
(North, East, Down) is (0.03, 0.03, 0.06) in meter, and Q Le , P0Te , TgeT e12 , are on the order of 1.0E-8. Thus,
the lever arm between the GPS antenna and inertial the gyro bias component is almost unestimable with
measurement unit (IMU) in the body frame is (1, 1, 1) the tactical grade IMU. However, for a very low-
in meter. W g and W a are 100 and 60 in seconds, grade IMU, the estimability measures are in the order
respectively. Two initial error covariance matrices for of 1.0E-4. Thus, the vertical component of gyro bias
the system Fg , H g , P0Tg and P0Mg , are consid- can be considered weakly estimable in this case. Es-
ered for estimability study. P0Tg corresponds to a timability measures for yaw error, the 9th column of
tactical grade IMU and P0Mg to a very low-grade the last six rows in Table I, are in the order of 1.0E-3.
micro electromechanical system (MEMS) IMU. Both Thus, yaw error is weakly estimable with both the
of them are diagonal matrices with the following tactical grade and low-grade MEMS IMUs. The ta-
forms: bles show that estimability measures with the initial
error covariance corresponding to the tactical grade
P0Tg 2

diag 1 RO2 ,1 R) cos O ,1 , 0.012 1,1,1 , IMU are smaller than those to the very low-grade
MEMS IMU for standard bases except for position
5.0E-5 , 5.0E-5 , 0.5S /180 ,
2 2 2

(39) and lever arm errors. The tables also show that there
1.0E-4 S /180 1,1,1 ,2
are very small differences in the measures for Ls
and Lg with the same initial error covariance and
5.0E  4 1,1,1 , 1,1,1
2
subspace directions. Thus, a small change in the navi-
gation error model with the tactical and very low-
2

P0Mg diag 1 RO2 ,1 R) cos O ,1 , 0.12 1,1,1 , grade MEMS IMUs causes small changes in es-
timability measures. Estimability measures with both
2.5E-3 , 2.5E-3 , 5S /180 ,
2 2 2
(40)
the navigation and ECEF frames for equivalent stan-
0.1S /180 1,1,1 , 0.0252 1,1,1 , 1,1,1 dard bases are the same. Thus, the tables demonstrate
2

that estimability measures are unchanged during the


The corresponding initial error covariance matrices coordinate transformation between the navigation and
for the system Fe , H e , P0Te and P0Me , can be ECEF frames.
written as P0Te Teg P0TgTegT and P0 Me Teg P0 MgTegT .
Estimability measures of the systems Fe , H e ,
4. Conclusion
g , H g , and Fs , H s with the two initial error
F
covariance matrices are shown in Tables 1 and 2. In In this paper, error covariance properties are inves-
the tables, Le , Lg and Ls are the information tigated with estimability measures. Estimability
matrices corresponding to the system Fe , H e , analysis results show that the SVD of the product of
Fg , H g and Fs , H s , respectively. usT ,i , ugT ,i , the initial error covariance matrix and information
ueT ,i , usM ,i , u gM ,i , and ueM ,i are the ith singular matrix determines the characteristics of error covari-
vectors of P0Tg Ls P0Tg , P0Tg Lg P0Tg , P0Te Le ance. It is proved that the estimability measures and
P0Te , P0Mg Ls P0Mg , P0Mg Lg P0Mg , and P0Me Le P0Me , their perturbation can be sensitive to the magnitude of
respectively. ei denotes the ith standard basis of a the norm of the initial error covariance matrix. This
vector space such that e2 [0 1 0" 0]T . indicates that estimability of a system can be influ-
On the last seven columns of the first six rows in enced by the initial error covariance that is independ-
Table 2, the estimability measures are less than 0.01%. ent of system model. However, the measures are un-
912 J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913

Table 1. Estimability measures.

Index i 1 2 3 4 5 6 7 8 9


Q Ls , P0Tg , P0Tg1 usT ,i 1.00E+00 1.00E+00 1.00E+00 9.90E-01 9.90E-01 9.55E-01 5.90E-01 5.90E-01 1.66E-01


Q Lg , P0Tg , P0Tg1 u gT ,i 1.00E+00 1.00E+00 1.00E+00 9.89E-01 9.89E-01 9.54E-01 5.64E-01 5.63E-01 1.35E-01
Q L , P e 0Te
1
, P ueT ,i
0Te 1.00E+00 1.00E+00 1.00E+00 9.89E-01 9.89E-01 9.54E-01 5.64E-01 5.63E-01 1.35E-01
Q L , P
s
1
0 Mg , P0 Mg u sM ,i 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 9.91E-01
Q L , P
g 0 Mg , P 1
0 Mg u gM ,i 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 9.90E-01
Q L , P
e 0 Me , P 1
0 Me ueM ,i 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 1.00E+00 9.90E-01
Q Ls , P0Tg , ei 5.00E-01 5.00E-01 5.00E-01 8.91E-01 8.92E-01 8.47E-01 3.24E-01 3.24E-01 2.52E-03
Q Lg , P0Tg , ei 5.00E-01 5.00E-01 5.00E-01 8.91E-01 8.91E-01 8.57E-01 3.52E-01 3.51E-01 2.67E-03
Q Le , P0Te , T e T
ge i 5.00E-01 5.00E-01 5.00E-01 8.91E-01 8.91E-01 8.57E-01 3.52E-01 3.51E-01 2.67E-03
Q Ls , P0 Mg , ei 4.98E-01 4.98E-01 5.00E-01 9.89E-01 9.90E-01 9.93E-01 4.86E-01 4.86E-01 8.03E-03
Q Lg , P0 Mg , ei 4.98E-01 4.98E-01 5.00E-01 9.89E-01 9.89E-01 9.92E-01 4.87E-01 4.87E-01 8.05E-03
Q Le , P0 Me , T e T
ge i 4.98E-01 4.98E-01 5.00E-01 9.89E-01 9.89E-01 9.92E-01 4.87E-01 4.87E-01 8.05E-03

Table 2. Estimability measures.

Index i 10 11 12 13 14 15 16 17 18


Q Ls , P0Tg , P usT ,i 1
0Tg 2.28E-03 2.07E-03 1.82E-08 9.51E-12 1.78E-12 9.98E-16 6.01E-16 1.72E-15 2.02E-15


Q Lg , P0Tg , P0Tg1 u gT ,i 2.38E-03 2.19E-03 3.44E-08 2.15E-08 3.36E-09 2.43E-09 1.37E-12 1.05E-12 6.05E-16
Q L , P e 0Te
1
, P ueT ,i
0Te 2.38E-03 2.19E-03 3.31E-08 8.28E-09 2.43E-09 7.02E-17 1.29E-15 9.19E-13 5.57E-16
Q L , P
s 0 Mg , P 1
0 Mg usM ,i 9.82E-01 9.82E-01 8.51E-06 1.77E-08 2.85E-13 1.40E-12 1.10E-13 5.00E-14 1.08E-13
Q L , P
g 0 Mg , P 1
0 Mg u gM ,i 9.81E-01 9.81E-01 3.38E-05 2.29E-05 9.12E-09 2.43E-09 1.30E-09 8.64E-13 1.21E-17
Q L , P
e
1
0 Me , P0 Me ueM ,i 9.81E-01 9.81E-01 3.38E-05 2.29E-05 2.43E-09 1.35E-09 1.56E-14 3.82E-14 2.71E-15
Q Ls , P0Tg , ei 2.74E-02 2.73E-02 6.35E-08 3.37E-01 3.38E-01 2.74E-01 5.00E-01 5.00E-01 5.00E-01
Q Lg , P0Tg , ei 2.68E-02 2.68E-02 6.36E-08 2.84E-01 2.84E-01 2.31E-01 5.00E-01 5.00E-01 5.00E-01
Q Le , P0Te , TgeT ei 2.68E-02 2.68E-02 6.36E-08 2.84E-01 2.84E-01 2.31E-01 5.00E-01 5.00E-01 5.00E-01
Q Ls , P0 Mg , ei 1.00E+00 1.00E+00 6.34E-04 5.06E-01 5.06E-01 9.98E-01 4.98E-01 4.98E-01 5.00E-01
Q Lg , P0 Mg , ei 9.99E-01 9.99E-01 6.35E-04 5.04E-01 5.05E-01 9.98E-01 4.98E-01 4.98E-01 5.00E-01
Q Le , P0 Me , TgeT ei 9.99E-01 9.99E-01 6.35E-04 5.04E-01 5.05E-01 9.98E-01 4.98E-01 4.98E-01 5.00E-01

changed with a constant equivalent transformation of Estimability test results show that there is a seven-
the system model. dimensional unestimable subspace with two initial
An example on the application of estimability error covariance matrices corresponding to the two
analysis to GPS/INS is given for a constant speed IMUs. It is confirmed that error covariance changes
horizontal motion. It is confirmed that the estimability are sensitive to the initial error covariance. With the
measures are less sensitive to system model perturba- initial error covariance for the tactical grade IMU, the
tion with the tactical grade and very low-grade vertical component of gyro bias can be considered
MEMS IMUs. It is also shown that the same meas- unestimable. However, for the very low-grade MEMS
ures are obtained for the navigation error propagation IMU, it can be considered weakly estimable. In both
models with both the navigation reference frame and cases, yaw error is weakly estimable.
ECEF reference frame.
J. H. Moon et al. / Journal of Mechanical Science and Technology 22 (2008) 905~913 913

Acknowledgments Jason L. Speyer, Experimental Study on the Estima-


tion of Lever Arm in GPS/INS, IEEE Transactions
This work was supported by the Korea Science and
on Vehicular Technology, 55 (2) (2006) 431-448.
Engineering Foundation (KOSEF) through the Ad-
[11] S. Hong, Observability and Estimability Measures
vanced Ship Engineering Research Center at Pusan
and Their Application To GPS/INS, Proc. of Con-
Nation University.
trol, Automation, and Systems Symposium (CASS
2007), Pusan, Korea, (2007) 236-241.
Reference [12] S. Hong, H. H. Chun, S. H. Kwon and M. H. Lee,
[1] P. S. Maybeck, Stochastic Models, Estimation, and Observability Measures and Their Application to
Control, Vol. I . New York, Academic Press, (1979). GPS/INS, IEEE Transactions on Vehicular Tech-
[2] Y. Baram and T. Kailath, Estimability and Regula- nology, 57 (1) (2008) 97-106.
bility of Linear Systems, IEEE Transactions on [13] K. R. Britting, Inertial Navigation System Analysis,
Automatic Control, 33 (12) (1988) 1116-1121. Wiley-Interscience, New York, (1971).
[3] D. Goshen-Meskin and I. Y. Bar-Itzhack, On the [14] D. Goshen-Meskin and I. Y. Bar-Itzhack, Unified
connection between estimability and observability, Approach to Inertial Navigation System Error
IEEE Transactions on Automatic Control, 37 (8) Modeling, Journal of Guidance, Control and Dy-
(1992) 1225-1226. namics, 15 (3) (1992) 648-653.
[4] F. M. Ham and R. G. Brown, Observability, Eigen- [15] M. Wei and K. P. Schwarz, A Strapdown Inertial
values, and Kalman Filtering, IEEE Transactions Algorithm Using an Earth-Fixed Cartesian Frame,
on Aerospace and Electronic Systems, 19 (2) (1983) Navigation, Journal of The Institute of Navigation,
269-273. 37 (2) (1990) 153-167.
[5] D. Goshen-Meskin and I. Y. Bar-Itzhack, Ob- [16] J. A. Farrell and M. Barth, The Global positioning
servability analysis of piece-wise constant systems- system & inertial navigation, The McGraw-Hill
Part II: Application to inertial navigation In-Flight Companies, Inc., New York, (1999).
Alignment, IEEE Transactions on Aerospace and [17] S. Hong, M. H. Lee, H. H. Chun, S. H. Kwon and J.
Electronic Systems, 28 (4) (1992) 1068-1075. L. Speyer, Observability of Error States in GPS/INS
[6] Y. F. Jiang and Y. P. Lin, Error Estimation of INS Integration, IEEE Transactions on Vehicular Tech-
Ground Alignment Through Observability Analysis, nology, 54 (2) (2005) 731-743.
IEEE Transactions on Aerospace and Electronic [18] A. H. Jazwinski, Stochastic Process and Filtering
Systems, 28 (1) (1992) 92-97. Theory, Academic Press, New York, (1970).
[7] S. Hong, M. H. Lee, J. A. Rios and J. L. Speyer, [19] A. E. Bryson, Jr., and Y.-C. Ho, Applied Optimal
Observability Analysis of INS with a GPS Multi- Control, Hemisphere Publishing Co., Washington,
Antenna System, International Journal of the Ko- (1975).
rean Society of Mechanical Engineers (KSME), 16 [20] F. M. Callier and C. A. Desoer, Linear System
(11) (2002) 1367-1378. Theory, Springer-Verlag, New York, (1991).
[8] M. K. Lee, S. Hong, M. H. Lee, S. H. Kwon and H. [21] G. W. Stewart and J.-G. Sun, Matrix Perturbation
H. Chun, Observability Analysis of Alignment Er- Theory, Academic Press, Boston, (1990).
rors in GPS/INS, Journal of Mechanical Science [22] G. H. Golub and C. F. Van Loan, Matrix Computa-
and Technology (KSME international Journal), 19 tions, 3rd Ed., The Johns Hopkins University Press,
(6) (2005) 1253-1267. Baltimore and London, (1996).
[9] S. Hong, M. H. Lee, S. H. Kwon and H. H. Chun, A [23] A. Gelb, Applied Optimal Estimation, Cambridge,
Car Tests for the Estimation of GPS/INS Alignment MA, MIT Press, (1974).
Errors, IEEE Transactions on Intelligent Transpor- [24] M. Shibata, Error Analysis Strapdown Inertial
tation Systems, 5 (3) (2004) 208-218. Navigation Using Quaternions, Journal of Guid-
[10] S. Hong, M. H. Lee, H. H. Chun, S. H. Kwon and ance, Control and Dynamics, 9 (3) (1986) 379-381.

View publication stats

You might also like