Professional Documents
Culture Documents
Mechanical
Science and
Technology
Journal of Mechanical Science and Technology 22 (2008) 905~913
www.springerlink.com/content/1738-494x
(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)
--------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------------
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
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)
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
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»
»
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
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-4S /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
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
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