In-flight alignment is an effective way to improve the accuracy and speed of initial alignment for strapdown inertial navigation system (INS). During the aircraft flight, strapdown INS alignment was disturbed by lineal and angular movements of the aircraft. To deal with the disturbances in dynamic initial alignment, a novel alignment method for SINS is investigated in this paper. In this method, an initial alignment error model of SINS in the inertial frame is established. The observability of the system is discussed by piece-wise constant system (PWCS) theory and observable degree is computed by the singular value decomposition (SVD) theory. It is demonstrated that the system is completely observable, and all the system state parameters can be estimated by optimal filter. Then a H∞ filter was designed to resolve the uncertainty of measurement noise. The simulation results demonstrate that the proposed algorithm can reach a better accuracy under the dynamic disturbance condition.
1. Introduction
The strapdown inertial navigation system (SINS) necessitates an alignment stage to determine the initial condition before the navigation operation [1]. Since the initial alignment process directly relates to the accuracy and rapidness of SINS, it is vitally important. In recent years, a lot of researches have been developed for SINS alignment. Among which many kinds of filters have been designed to estimate the state of the SINS, such as Kalman filter (KF), extended Kalman filter (EKF), unscented Kalman filter (UKF), and H∞ filter.
Recent decades have witnessed the prosperity and maturity of aircraft navigation, and the SINS alignment problem under the dynamic condition has received detailed attention. Due to engine vibration, wind gusts, loading, fuel injection, and uncertain human impact, the aircraft is not absolutely stationary, so the output of the inertial sensors has errors with such external disturbances [2]. Therefore, the method of ground alignment cannot be used to perform the aircraft SINS alignment.
Conventional alignment methods including coarse alignment and fine alignment are widely used for SINS alignment. In the coarse alignment, the system attitude can be determined directly by using the known gravity and Earth rate signals in the local level frame and the measurements obtained by using accelerometers and gyros [3]. Then the Kalman filter is used for fine alignment in the conventional alignment method. However, under the dynamic disturbance condition, traditional alignment techniques cannot be used, because the gyros’ measurements will include high rotational values (several orders of magnitude greater than the Earth’s rotation rate) resulting from the aircraft’s pitch and roll [4]. Therefore, in recent years a coarse alignment for SINS under dynamic interference condition has been investigated in [5, 6]. Referring to the coarse alignment method, the inertial frame alignment is adopted in [7] in the fine alignment process, and an adaptive Kalman filter is used. It can effectively depress the random disturbances in the velocity measurements caused by the ship rocking.
No matter what kind of filter is used, observability analysis of a dynamic system is needed before designing it to determine the efficiency of the filter. The observability of a linearized time-invariant system has extensively been studied in many early research works [8, 9]. The observability analysis of a linearized time-invariant system is straightforward by testing the rank of the observability matrix. While the observability analysis of a constant dynamic system is rather simple, the analysis of a time-varying system is quite cumbersome. A PWCS (piecewise constant system) theory was proposed in [10, 11] to simplify the analysis. In this method, the linear time-varying system was approximated by a piecewise constant model, and in each constant segment, a simplified null space test was performed to determine the observability properties [12]. At present, there are several ways for observability analysis of SINS. A state equation decoupling method is proposed in [13]. This method decomposes each state of the system equation into corresponding subspace to determine the observable state of the system. But it is only a qualitative analysis and it is strong subjective. Bar-Itzhack and Berman [14] evaluate the observability through eigenvalues of the covariance matrix. But this method cannot estimate the observability directly through state equation and measurement equation. It is performed after filtering, so there exists large amount of calculation and some other disadvantage.
In this paper, a novel alignment method is investigated and observability is analyzed by PWCS theory and SVD theory. Firstly, using the gravity in the inertial frame as a reference, the initial fine alignment error model of SINS is established. Then, on the one hand, the observability of SINS with 12 system state parameters is analyzed by PWCS theory. On the other hand, the observable degree of the system is computed by SVD theory. It can be seen that the system is completely observable; all the 12 system state parameters can be estimated. Finally, on the basis of observability, the filter can be designed to estimate the system state parameters. Due to the uncertainty of measurement noise characteristics, a fine alignment method based on H∞ filter is introduced. Simulation results show that this self-alignment scheme can effectively solve the alignment problem of SINS in dynamic interference environment.
This paper is organized as follows. A brief introduction to SINS error model in the inertial frame is presented in Section 2. The observability analysis of the SINS alignment based on the observability analysis of PWCS theory and SVD theory is analyzed in Section 3. In order to prove the analysis results, simulations are carried out in the Section 4. Conclusions are drawn in Section 5.
2. SINS Alignment Error Model in the Inertial Frame
Under the dynamic disturbance environment, the extra disturbed accelerations would invalidate the traditional alignment method. Therefore, a new alignment method for marine SINS using the gravity in the inertial frame as a reference has been discussed [15]. A fundamental aspect of inertial navigation is the precise definition of a number of Cartesian coordinate reference frames [16]. In this method, a special inertial frame, the initial time SINS body inertial frame (ib0 frame), is defined and is selected as transition reference frames in SINS alignment. The coarse alignment results are used as input for fine alignment; this section only gives a brief introduction to SINS error model in inertial frame.
In the fine alignment process, the initial attitude matrix Cnb(t) can be represented as
(1)Cnb(t)=CenCie(t)Cbi(t).
According to the calculation method of coarse alignment scheme,
(2)Cen=[010-sinL0cosLcosL0sinL],Cie(t)=[cosωie(t-t0)sinωie(t-t0)0-sinωie(t-t0)cosωie(t-t0)0001].
So, the key lies in the calculation of Cbi(t):
(3)Cbi(t)=[Cii′(t)]-1Cbi′(t),
where
(4)Cbi′(t)=Cbi′(0)ΔCbi.
The attitude matrix Cbi′(0), which relates the body frame to the computed inertial frame at the beginning of the fine alignment, is derived from the coarse alignment. And ΔCbi can be computed through the attitude quaternion algorithm.
Suppose the misalignment angles between inertial frame i and the computed frame i′ are
(5)φi(t)=[φxi(t)φyi(t)φzi(t)]T.
So, Cii′(t) in (3) can be described as
(6)Cii′(t)=I-[φi(t)×]=[1-φzi(t)φyi(t)φzi(t)1-φxi(t)-φyi(t)φxi(t)1].
Thus, the main problem of the fine alignment turns out to be the estimation of misalignment angles. In order to estimate the misalignment angles, next, the state equation and the measurement equation are established.
The accelerometer’s measured specific force projected in the frame i′ can be described as follows:
(7)Cbi′f^b=Cbi′[(I+δKA)(I+δA)(-gb+aLAb+aDb)+∇]≈-gi+φi×gi+Cbi∇+Cbi′aLAb+Cbi′aDb+Cbi′(δKA+δA)(-gb+aLAb+aDb).
In consideration of ∇b and ab,
(8)∇=∇b+ab.∇b and ab stand for accelerometer’s constant bias and observation white noise, respectively.
Equation (7) can be simplified as follows:
(9)Cbi′f^b+gi-Cbi′aLAb=φi×gi+Cbi∇b+Cbiab+δai.
Comparing (9) with (7),
(10)δai=Cbi′(δKA+δA)(-gb+aLAb+aDb).
Integrating (10) from t1 to t yields
(11)∫t1tCbi′f^b+∫t1tgi-∫t1tCbi′aLAbdτ=∫t1tφi×gidτ+∫t1tCbi∇bdτ+∫t1tCbiabdτ+∫t1tδaidτ.
The measurement vector is
(12)Z=V~i=Vfi-Vgi-VLAi=δVi+VW+δVDi,
where
(13)Vfi=∫t0tCbi′f^bdτ,Vgi=∫t0tgidτ,VLAi=∫t1tCbi′aLAbdτ=Cbi′(ωibb×rb),δVDi=∫t1tδaidτδVi=∫t1tφi×gidτ+∫t1tCbi∇bdτ+∫t1tCbiabdτ.
From (13), we can get the velocity-error equation in the inertial frame
(14)δV˙i(t)=-gi(t)×φi(t)+Cbi(t)∇b+Cbi(t)ab.
And the misalignment-angle equation can be obtained from the differential equations of Cbi(t) and Cbi′(t):
(15)φ˙i(t)=-Cbi(t)εb-Cbi(t)ωb,
where εb and ωb stand for gyro’s constant drift and observation white noise, respectively.
Then the state equation can be represented as
(16)X˙(t)=A(t)X(t)+B(t)W,
where the state vector and the white noises are
(17)X(t)=[δVxi(t),δVyi(t),δVzi(t),φxi(t),φyi(t),φzi(t),εxb,εyb,εzb,∇xb,∇yb,∇zbδVxi(t)]T,W=[axb,ayb,azb,wxb,wyb,wzb,0,0,0,0,0,0]T.
The state matrix and the system noise matrix in (16) are
(18)A(t)=[03×3-[gi(t)×]03×3Cbi(t)03×303×3-Cbi(t)03×303×303×303×303×303×303×303×303×3],B(t)=[Cbi(t)03×303×303×303×3-Cbi(t)03×303×303×303×303×303×303×303×303×303×3].
From (12), the measurement equation can be described as
(19)Z(t)=HX(t)+VW+δVDi,
where δVDi is uncertainty observation noise and VW is observation white noise.
The measurement matrix is
(20)H=[I3×303×9].
3. Observability Analyses
For the fine alignment model, the observability is an important issue and requires careful investigation, as it reveals the inherent estimability of the system. In this section, the observability analysis of the fine alignment model was discussed using PWCS theory and SVD theory before designing the filter.
3.1. Observability Analysis Using PWCS
What (16) and (19) describe is a time-varying system. The observability of the system can be analyzed by observability analysis of PWCS theory.
According to the PWCS theory, a time varying system can be replaced by piece-wise time invariant system. The period is divided to r segments, and each coefficient matrix is approximated to constant in each segment. Then the observability matrix of the PWCS model is
(21)Q(r)=[Q1Q2eA1Δ1Q3eA2Δ2eA1Δ1⋮QreAr-1Δr-1⋯eA1Δ1],
where Qi=[HT,(HAi)T,…,(HAin-1)T]T, Δi(i=1,2,…,r) is the time interval between ti and ti+1.
According to the following theorem, the observability analysis can be performed by a simplified matrix instead of Q(r).
Theorem 1.
If
Null
(Qi)⊂
Null
(Ai),1≤i≤r, then
(22)
Null
{Q(r)}=
Null
{Qs(r)}
Rank
{Q(r)}=
Rank
{Qs(r)},
where
(23)Qs(r)=[Q1Q2⋮Qr].
Equation (21) is called total observability matrix (TOM), and (23) is called stripped observability matrix (SOM). Theorem 1 shows that the observability of a continuous PWCS may be identified through SOM instead of TOM to greatly simplify the computation. If a TOM or SOM is a full-rank matrix, all the states are completely observable, otherwise linear transform can be used to find out the states which are not observable.
3.2. Observability Analysis Using SVD
The PWCS theory can only determine whether the system is completely observable or not, but it cannot determine the degree of observability [17]. The observable degree for every state can be computed by means of singular value decomposition method.
According to the SVD theorem, the observability matrix Q can be rewritten as follows:
(24)Q=UΣVT,
where U and V are unitary orthogonal matrices and Σ is a diagonal matrix:
(25)U=[u1,u2,…,um],V=[v1,v2,…,vm],Σ=[SO(m-r)×r]T,
where S=diag{σ1σ2⋯σr}, σ1≥σ2≥⋯≥σr≥0 and σi is the singular value of the Q as shown in Table 1.
Singular values of system observable matrix Q.
σ1=9.9628
σ2=9.9607
σ3=9.8922
σ4=9.8921
σ5=9.0525
σ6=1.1442
σ7=1.1442
σ8=1.1442
σ9=0.4379
σ10=0.3588
σ11=0.1517
σ12=0.0331
All the 12 state parameters’ observable degrees are large enough to be considered observable. But observable degrees of different states are not the same; it is impossible to confirm which states are more observable and which are less. To establish one-to-one correspondence between the states to the singular values, we will make an analysis below.
The measurement vector Y can be written as
(26)Y=QX0=∑i=1rσi(viTX0)ui.
The initial state X0 can be estimated by
(27)X0=(UΣVT)-1Y=∑i=1r(uiTyσi)vi.
According to (27), we can calculate the state corresponding to each singular value.
The degree of the observability of the kth state ηk is defined as
(28)ηk=σiσ0,i=1,2,…,n,σi~max[uiTyviσi],
where σ0 is the singular value of external observable state and σi is the singular value which let [uiTyvi/σi]k get a maximum.
4. Simulation Results 4.1. Foundation of H∞ Filter Equation
For the SINS error equation described as (19), the interference of acceleration is introduced. δVDi is uncertainty observation noises, consisting of disturbing velocity caused by the aircraft’s pitch and roll. When it comes to random disturbances, the Kalman filter becomes not so effective. Studies show that the advantage of the H∞ filter in comparison with the Kalman filter is that no statistical assumptions on the noises are required, and the filter is more robust when the noises are uncertainties in a system. So the H∞ robust filter is designed in the fine alignment procedure. The error model which we discussed above can be considered as the following state-space system:
(29)XK=ϕK-1XK-1+ΓK-1WK-1,YK=HKXK+VK,ZK=LKXK.LK makes the ratio of estimation error signal energy and disturbance energy less than the prespecified number γ [11]. And filtering error is defined as:
(30)ek=Z^K-LKXK.
For a fixed positive number γ>0, the job is to find H∞ suboptimal estimation Z^K=Ff(y0,y1,…,yk) to make ∥Tk(Ff)∥∞<γ. It can be shown as
(31)infFfsupX0,W∈h2,V∈h2∥ek∥22∥X0-X^0∥P0-12+∥Wk∥22+∥Vk∥22<γ2.
The mathematical equations of H∞ filtering are as follows:
(32)S^K∖K=LKX^K∖K,X^K+1∖K+1=ϕK+1∖KX^K∖K+KK+1(ZK+1-HK+1ϕK+1∖KX^K∖K),KK+1=PK+1HK+1T(HK+1PK+1HK+1T+RK+1)-1,PK+1=ϕK+1∖KPKϕK+1∖KT+ΓKΓKT-ϕK+1∖KPK[HKTLKT]Re,k-1[HKLK]PKϕK+1∖KT,Re,k=[RK00-λ2I]+[HKLK]PK[HKTLKT].
The framework of the proposed alignment method is shown in Figure 1.
System block diagram.
4.2. Simulate Conditions
The IMU errors are set as follows: the gyro constant drift: 0.01°/h, the gyro random noise: 0.001°/h, the accelerator bias: 1 × 10−4 g, and the accelerator measurement noise: 1 × 10−5 g. In the simulation, the plane is assumed to be rocked by the wind gusts, fuel injection, and uncertain human impact. The roll λ, pitch θ, and heading ψ, resulting from the plane’s rocking are described as follows:
(33)ψ=30°+5°cos(2π7t+π3),θ=7°cos(2π5t+π4),γ=10°cos(2π6t+π7).
The velocity caused by heave, surge, and sway is as follows:
(34)VDi=ADiωDicos(ωDit+φDi),
where i=x,y,z, ADx=0.02 m, ADy=0.03 m, ADz=0.3 m, ωDi=2π/TDi, TDx=7 s, TDy=6 s, and TDz=8 s. φDi obeys the uniform distribution on the interval [0, 2π].
4.3. The Result of Observability Analysis
The initial state X0 corresponding to each singular value can be calculated. Histogram of the state is shown in Figure 2.
Initial state X0.
σ1=9.9628
σ2=9.9607
σ3=9.8922
σ4=9.8921
σ5=9.0525
σ6=1.1442
σ7=1.1442
σ8=1.1442
σ9=0.4379
σ10=0.3588
σ11=0.1517
σ12=0.0331
Figure 2 shows that the first two singular values are 9.9628 and 9.9607, and the corresponded states are εxb and εyb. The third singular value is 9.8922, the corresponded state is φzi(t), and the fourth singular value which is 9.8921 corresponds to the state φyi(t). The singular value 9.0522 corresponds to the state ∇zb. The observability degree of δVxi(t), δVyi(t) and δVzi(t), is almost 1. Compared with the former eight states, the observability degree of εzb(0.4379), φxi(t)(0.3588), ∇yb(0.1517), and ∇xb(0.0331) are a little smaller, but they are large enough to be observable.
Thus the observable degree of the system is computed by SVD theory. It can be seen that the system is completely observable all the 12 system state parameters can be estimated. On the basis of observability, filter has been designed to estimate the system state parameters. In order to prove the analysis results, simulations are carried out as follows.
4.4. Simulation of SINS Alignment
The simulation results are shown in Figure 3. It is clear that all the states are observable; the result confirms the aforementioned analysis.
The simulation results of H∞ filtering.
Estimation of attitude errors
Estimation of velocity error
Estimation of gyro drifts
Estimation of accelerometer biases
According to Figure 3(a), convergence time of level misalignment angle is within 60 s, precision for 1′, while azimuth angle convergence time is within 100 s, precision about 4′. The three velocity errors as observed variables depicted in Figure 3(b) are certainly observable. As seen from Figure 3(c), gyro drifts converge not so rapidly, but a rather good filtering result can be obtained. Figure 3(d) shows that the horizontal accelerometers constant biases ∇x and ∇y converge to a constant value within a short time. The vertical converges soon afterwards with good estimation performance. The simulation proves the analysis results that all the system state parameters can be estimated by H∞ filter.
It can be seen that the alignment method can effectively deal with the random disturbances in the dynamic environment. Using H∞ filter can improve the system sensitivity to noise and the divergence speed of azimuth.
5. Conclusion
The aircraft SINS is prone to violent rocking, which makes the initial alignment difficult. In this paper the gravity in the inertial frame as a reference is used, so as to counteract the disturbed components. With the deduced SINS model on disturbances base, the relevant H∞ filter is designed. Before the filter is designed, observability is analyzed by PWCS theory and SVD theory; degree of observability for every state can be computed. The simulation shows that the alignment method can effectively deal with the random disturbances in the dynamic environment. And the system is completely observable; all the system state parameters can be estimated by H∞ filter.
Conflict of Interests
The authors declare that they have no conflict of interests related to this study.
Acknowledgments
This work was supported by the National Science Foundation of China, under Grant 60975065, and supported by the Program for the Top Young Innovative Talents of Beijing, J2002013201301.
WuY.ZhangH.WuM.HuX.HuD.Observability of strapdown INS alignment: a global perspective2012481781022-s2.0-8485615265510.1109/TAES.2012.6129622IlyasM.YangY. C.SINS initial alignment using wavelet de-noising method for aircraft navigationProceedings of the 10th World Congress on Intelligent Control and Automation201239213926SunF.SunW.WuL.Coarse alignment based on IMU rotational motion for surface shipProceedings of the IEEE/ION Position, Location and Navigation Symposium (PLANS '10)May 2010Indian Wells, Calif, USA1511562-s2.0-7795502052310.1109/PLANS.2010.5507297GuD.El-SheimyN.HassanT.SyedZ.Coarse alignment for marine SINS using gravity in the inertial frame as a referenceProceedings of the IEEE/ION Position, Location and Navigation Symposium (PLANS '08)May 2008Monterey, Calif, USA9619652-s2.0-5534910473910.1109/PLANS.2008.4570038QinY.YanG.GuD.ZhengJ.Clever way of SINS coarse alignment despite rocking ship20052356816842-s2.0-30044434827LianJ.-X.TangY.-G.WuM.-P.HuX.-P.Study on SINS alignment algorithm with inertial frame for swaying bases200729595992-s2.0-36549031655QinY. Y.ZhuX. Y.ZhaoC. S.BaiL.Design and simulation on SINS self-alignment for carrier bore aircraft20081612833WanD. J.FangJ. C.1998Southeast University PressJiangY. F.LinY. P.Error estimation of INS ground alignment through observability analysis199228192972-s2.0-002664192010.1109/7.135435Goshen-MeskinD.Bar-ItzhackI. Y.Observability analysis of piecewise constant systems-Part I: theory199228410561067Goshen-MeskinD.Bar-ItzhackI. Y.Observability analysis of piecewise constant systems-Part II: application to inertial navigation in-flight alignment199228410681075TangY.WuY.WuM.WuW.HuX.ShenL.INS/GPS integration: global observability analysis2009583112911422-s2.0-6404910231410.1109/TVT.2008.926213HamF.BrownR. G.Observability, eigenvalues, and kalman filtering19831922692732-s2.0-0020720034Bar-ItzhackI. Y.BermanN.Control theoretic approach to inertial navigation systems19881132372452-s2.0-0024001174GaoW.BenY.ZhangX.LiQ.YuF.Rapid fine strapdown ins alignment method under marine mooring condition2011474288728962-s2.0-8005398679110.1109/TAES.2011.6034671ZhangW.GhoghoM.YuanB.Mathematical model and matlab simulation of strapdown inertial navigation system20122012252-s2.0-8485649884910.1155/2012/264537264537CaoJ.TangJ.WangY.WeiG.Observability analysis of four-position alignment for laser gyroscope strap-down inertial navigation systemProceedings of the International Conference on Electronics and Optoelectronics (ICEOE '11)July 2011V3227V32302-s2.0-8005323195610.1109/ICEOE.2011.6013345