Next Article in Journal
Adaptive Transcutaneous Power Transfer to Implantable Devices: A State of the Art Review
Previous Article in Journal
Employing an Incentive Spirometer to Calibrate Tidal Volumes Estimated from a Smartphone Camera
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Novel Robust H Filter Based on Krein Space Theory in the SINS/CNS Attitude Reference System

1
College of Automation, Harbin Engineering University, Harbin 150001, China
2
College of Information and Communication Engineering, Harbin Engineering University, Harbin 150001, China
*
Author to whom correspondence should be addressed.
These authors contributed equally to this work.
Sensors 2016, 16(3), 396; https://doi.org/10.3390/s16030396
Submission received: 8 December 2015 / Revised: 27 February 2016 / Accepted: 15 March 2016 / Published: 18 March 2016
(This article belongs to the Section Remote Sensors)

Abstract

:
Owing to their numerous merits, such as compact, autonomous and independence, the strapdown inertial navigation system (SINS) and celestial navigation system (CNS) can be used in marine applications. What is more, due to the complementary navigation information obtained from two different kinds of sensors, the accuracy of the SINS/CNS integrated navigation system can be enhanced availably. Thus, the SINS/CNS system is widely used in the marine navigation field. However, the CNS is easily interfered with by the surroundings, which will lead to the output being discontinuous. Thus, the uncertainty problem caused by the lost measurement will reduce the system accuracy. In this paper, a robust H filter based on the Krein space theory is proposed. The Krein space theory is introduced firstly, and then, the linear state and observation models of the SINS/CNS integrated navigation system are established reasonably. By taking the uncertainty problem into account, in this paper, a new robust H filter is proposed to improve the robustness of the integrated system. At last, this new robust filter based on the Krein space theory is estimated by numerical simulations and actual experiments. Additionally, the simulation and experiment results and analysis show that the attitude errors can be reduced by utilizing the proposed robust filter effectively when the measurements are missing discontinuous. Compared to the traditional Kalman filter (KF) method, the accuracy of the SINS/CNS integrated system is improved, verifying the robustness and the availability of the proposed robust H filter.

1. Introduction

In modern marine navigation, the strapdown inertial navigation system (SINS) is widely used due to its advantages of being more compact and autonomous, which can provide vehicle’s navigation information, including attitude, velocity and position [1,2,3]. However, in SINS systems, there are accumulated navigation errors caused by the inertial components inevitably. Additionally, this is a serious problem in long-term marine navigation. Thus, some other navigation systems, e.g., the Global Position System (GPS), the Doppler velocity log (DVL), the celestial navigation system (CNS), etc., are often integrated with it to improve the navigation accuracy of the whole system availably making use of the complementary navigation information obtained from different sensors [4,5,6,7,8].
In CNS, the accurate attitude is calculated based on the azimuth of a celestial body measured by the celestial sensor. Since the celestial body is used as the navigation information source, the CNS has numerous merits, such as high positioning and orienting accuracy, good stealthiness and independence. What is more, the navigation error is not accumulated over time. Therefore, the CNS is widely used to aid the SINS in astronautics, marine navigation and surveying fields, utilizing the SINS/CNS integrated navigation system. In [9], Xu and Fang proposed INS/CNS integration, using the INS error model and Kalman filter (KF) based on neural networks. Integrating INS with GPS and a star tracker was performed by [10] using a decentralized multisensor integration structure, in which the error compensation rate of integration was studied. Because of that traditional ground-based initial alignment methods cannot work well on the lunar surface, [8] proposed a new autonomous INS initial alignment method, which used star observations to help the INS estimate its attitude, gyroscopes drifts and accelerometer biases. Additionally, simulations proved the superiority of the new method.
However, the CNS easily interfered with by the surroundings, such as clouds, since stars are used as the beacon of the star sensor. For example, the number of stars, which is used for calculating the navigation information of the star sensor, is reduce under cloudy weather. Hence, the occluded star sensor will lead to the output being discontinuous [6,11,12]. Then, the system model will not be accurate under this condition. Furthermore, the uncertainty problem will be introduced into the integrated system, reducing the system accuracy significantly. Although the KF is the most commonly-used optimal estimation, it is hard to get the expected results when the system model is not accurate. Therefore, many methods are used to describe and compensate the uncertainty of the system [13,14,15,16]. In [14], a new robust Kalman filter was proposed that detects and bounds the influence of outliers in a discrete linear system, including those generated by thick-tailed noise distributions, such as impulsive noise. Taking the robust state estimation for uncertain descriptor systems into account, a robust filtering framework (RFF) was proposed to facilitate the robust filter design [16]. Hamza and Nebylov proposed a robust design of an INS/GNSS navigation system to solve the problem of state space models with non-Gaussian measurement noise based on parallel nonlinear filtering [13].
Although the robust Kalman filter based on the H 2 norm has a simple design form, it requests that the statistical characteristics of the system noise be already known, which is difficult to meet in practical applications. The robust H filter has high stability, but its design form is complex, which is not suitable for actual applications, as well [15,17].
In recent years, due to its simple design, flexible structure and wide application, the Krein space theory has become a hot issue gradually [18,19,20]. Therefore, a robust H filter for the SINS/CNS integrated navigation system is presented in this manuscript based on the Krein space theory. Taking the uncertainty problem into account, a robust H filter in the Krein space frame is presented and derived. Even better, the novel filter not only achieves robustness against missing measurements using robust H filtering, but also improves the system accuracy effectively due to the Krein space theory. Additionally, the results from simulations and experiments show that the presented robust filter is superior to the normal Kalman filter. The rest of this manuscript is organized as follows. The fundamentals of the Krein space theory and the linear error equations of the SINS/CNS integrated navigation system are introduced in Section 2. Additionally, the new robust filter is proposed in Section 3. Numerical simulations and experiments along with specific analysis are given in Section 4. Section 5 concludes this manuscript.

2. Linear Filter Based on the Krein Space Theory

In this section, some basic knowledge of the Krein space theory will be introduced in order to understand the theoretical derivation below easily. The system model of the SINS/CNS integrated system is established, as well, here.

2.1. Fundamentals of the Krein Space Theory

The Krein space is a non-classical functional space, which has attracted extensive attention. The kernel of the Krein space estimation theory is that the minimization of the quadratic cost function is translated into the Kalman filter problem just in the Krein space, rather than the random Hilbert space [19,20,21].
Now, consider the following Krein space state-space formal system:
x j + 1 = A j x j + B j u j y j + 1 = C j + 1 x j + 1 + D j + 1 v j + 1
with covariance matrix:
x 0 u j v j + 1 , x 0 u j v j + 1 = P 0 0 0 0 Q j S j 0 S j R j + 1
wherein x j + 1 and y j + 1 are the state vector and the measurement vector at time j + 1 , respectively; A j and C j + 1 are specific known linear functions, the state-transition matrix and the measurement matrix; B j and D j + 1 are the coefficient matrices of the state noises; u j and v j + 1 are the state noise vector and observation noise vector with their autocorrelation and cross-correlation matrix of variance matrices Q j , R j + 1 and S j , respectively; P 0 is the initial state covariance matrix.
Thus, the quadratic cost function is chose as follows:
J = x 0 T P 0 - 1 x 0 + j = 0 N u j T Q j - 1 u j + j = 0 N v j T R j - 1 v j
We define the state transition matrix as:
ϕ j , k = Δ A j - 1 A k , j > k , ϕ j , j = I
and the response matrix as:
h j , k = Δ C j A j - 1 A k + 1 B k
Then, using:
y ¯ = Δ c o l y 0 , y ¯ N y ¯ = Δ c o l y 0 , y ¯ N v ¯ = Δ c o l v 0 , , v N
the Krein space state-space as Equation (1) satisfies this:
y ¯ = Θ ¯ x 0 + Υ ¯ u ¯ + Ω ¯ v ¯ = Θ ¯ Υ ¯ Ω ¯ x 0 u ¯ v ¯
wherein:
Ξ = Δ x 0 u ¯ y ¯ , x 0 u ¯ y ¯ = I 0 0 0 I 0 Θ ¯ Υ ¯ Ω ¯ P 0 0 0 0 Q ¯ S ¯ 0 S ¯ T R ¯ I 0 0 0 I 0 Θ ¯ Υ ¯ Ω ¯ T
and the symbols are defined as follows:
Q ¯ = Q 0 Q N R ¯ = R 0 R N S ¯ = S 0 S N Ω ¯ = D 0 D N
Θ ¯ = C 0 C 1 ϕ 1 , 0 C N ϕ N , 0 , Υ ¯ = 0 h 1 , 0 0 h 2 , 0 h 2 , 1 0
The projection error in Krein space to study is the following Gramian:
æ - k y ¯ , æ - k y ¯ = I - k Ξ I - k T
where we suppose æ = col x 0 , u ¯ .
Unfortunately, the partial equivalence between Equations (3) and (11) cannot be found as easily as in [22,23]; thus, some more matrix algebra has to be used to translate Equation (3) into our desired format.
In [20], zero-valued polynomials were introduce to proof that the deterministic quadratic form as Equation (3) has the same stationary point to the error Gramian as Equation (11) in Krein space. On the basis of Theorem 1 and Lemma 2, it can be deduced easily. Therefore, it will not be elaborated any more in this paper.
As we all know, the KF method has a recursive form, which is simply and easily achieved. Therefore, the classical recursion form of KF is used in filters of the Krein space. Consider the discrete-time linear state-space model and its a priori knowledge, shown as Equations (1) and (2); the Riccati recursive steps are summarized as follows:
The estimated state vector:
x ^ j + 1 = A j x ^ j + K j y j - B j x ^ j
The filtering gain:
K j = A j P j C j T + B j S j R e , j - 1
wherein:
R e , j = C j P j C j T + R j
The estimated covariance matrix:
P j + 1 = A j P j A j T + B j Q j B j T - K j R e , j K j T

2.2. SINS/CNS Integrated System Model

Although SINS has numerous advantages, the accumulated error caused by its inertial components limits its applications. The CNS can provide accurate attitude information based on the azimuth of the celestial body. Therefore, the SINS/CNS integrated navigation system is widely applied, since the navigation accuracy of the whole system can be enhanced significantly by using the complementary navigation information obtained from two different kinds of sensors. In the SINS/CNS integrated navigation system, the loosely-coupled scheme is used due to its simpleness and convenience. As we all know, the CNS is easy to interfere by the surroundings, and then, the CNS information will be invalid discontinuously. Taking this situation into account, the schematic diagram of the SINS/CNS integrated system is shown in Figure 1.
In this paper, we focus on marine navigation. As we all know, the vertical information (vertical acceleration, vertical velocity and vertical altitude) can be ignored for simplification reasonably and acceptably in surface navigation systems. Thus, only horizontal information is taken into account. Therefore, we choose the error equation of SINS as the state model, including horizontal velocity error equations, longitude and latitude error equations and attitude error equations.
(1) Velocity error equation:
δ V ˙ E = V N R n tan L δ V E + 2 ω i e sin L + V E R n tan L δ V N + φ U f N + E + 2 ω i e cos L V N + V E V N R n sec 2 L δ L
δ V ˙ N = - 2 ω i e sin L + 2 V E R n tan L δ V E - φ U f E + N - 2 ω i e cos L V E + V E 2 R n sec 2 L δ L
(2) Position error equation:
δ L ˙ = δ V N R m
δ λ ˙ = δ V E R n sec L + V E R n tan L sec L δ L
(3) Attitude error equation
φ ˙ E = - δ V N R m + ω i e sin L + V E tan L R n φ N - ω i e cos L + V E R n φ U + ε E
φ ˙ N = - ω i e sin L δ L + δ V E R n - ω i e sin L + V E tan L R n φ E - V N R m φ U + ε N
φ ˙ U = ω i e cos L + V E R n sec 2 L δ L + tan L δ V E R n + ω i e cos L + V E R n φ E + V N R m φ N + ε U
wherein V E and V N are the east and north velocities and δ V E and δ V N are corresponding velocity errors; L and λ are the local latitude and longitude; while R m and R n are the Earth’s radii of the meridian circle and the prime vertical circle; f E and f N are the measured specific force by the east and north accelerometers; φ E , φ N , φ U are the attitude angle errors; ε x , ε y and ε z are the gyro drifts of the x-, y- and z-axes; x and y are the accelerator biases of the x- and y-axes. Additionally, we also know this:
ε E ε N ε U = C b n ε x ε y ε z
wherein C b n is the transformation matrix from the vehicle’s body coordinate system (b) to the navigation coordinate system (n), the size of which is 3 × 3 . A similar transform exists between E , N and x , y .
From the above, the state vector x of the SINS/CNS integrated system is defined as:
x ( t ) = δ L δ λ δ V E δ V N φ E φ N φ U ε x ε y ε z x y T
The measurement is the attitude error between the calculated attitude of the SINS and the CNS. Therefore, the observation equation can be described as:
z ( t ) = φ E φ N φ U = H ( t ) x ( t ) + v ( t )
where z ( t ) denotes the measurement, while v ( t ) is the measurement noise. The measurement matrix:
H ( t ) = 0 3 × 4 I 3 × 3 0 3 × 5

3. Robust H Filter Based on Krein Space Theory

In this section, we formulate the Krein space filter recursions for the H filter problem. Taking the missing measurements into account, a novel robust H filter based on the Krein space theory is proposed.
Considered the following discrete-time linear state-space system:
x j + 1 = A j + Δ A j x j + B j u j y j + 1 = C j + 1 + Δ C j + 1 x j + 1 + v j + 1
wherein x j and y j + 1 are the state vector and measurement vector, u j and v j are unknown system noises and Δ A j and C j are uncertainty parameters. Generally, we assume that:
Δ A j Δ C j = F j D j Δ j E j
wherein A j , B j , C j , D j , E j and F j are already known matrices and Δ j is a unknown matrix with:
Δ j T Δ j I
Given ξ j = Δ j E j x j , s j = E j x j , the system uncertainty can be indicated by the following constraint condition:
ξ j 2 s j 2 , j = 0 , 1 , , N
where · denotes the standard H 2 norm.
In a general way, the estimated vector is the linear combination of the state vector. That means:
z j = L j x j
wherein L j is a known coefficient matrix.
Defining that z ^ j is the estimation of z j on the basis of the given observations y j , the estimation error is:
e j = z j - z ^ j
Thus, the estimation problem of the H filter under the level parameter γ can be translated into solving the optimal solution of Equation (27):
J = T 2 = sup x 0 , u j , v j j = 0 N e j T e j x 0 T P 0 - 1 x 0 + j = 0 N u j T Q j - 1 u j + j = 0 N v j T v j γ 2
From the above, we can see that the H filter should be designed to ensure that the energy of estimation error e k is γ times less than the one of system noises. If Equation (33) can be guaranteed, the estimation error will be very small authentically. Substituting, the constraint of uncertain parameters shown as Equation (30) into Equation (33), we will obtain the robust H filter problem:
x 0 T P 0 - 1 x 0 + j = 0 N u j T Q j - 1 u j + j = 0 N v j T v j + j = 0 N ξ j 2 - j = 0 N s j 2 - 1 γ 2 j = 0 N e j T e j J x 0 , u , v ε
wherein x 0 and P 0 are the initial state vector and the initial state covariance matrix and ε is a constant.
As was mentioned in [20], Equation (34) generate an ellipsoid set of the estimated state, whose boundary is restrained by ε. Therefore, the estimation of the robust H filter is under this constraint, as well. However, with uncertain parameters, the quadratic function is irreversible directly with the Gramian matrix of the noise error in the Krein space.
Therefore, based on Theorem 1 in [20], vectors in the Hilbert space are indicated by the vectors that have the same meanings in the Krein space. Then, the objective quadratic Equation (34) can be rewritten as:
J x 0 , u , v = x 0 T P 0 - 1 x 0 + j = 0 N u j T Q j - 1 u j + v j T v j + ξ j T ξ j - s j T s j - 1 γ 2 e j T e j
Since that zero vector will not change the quadratic value, the following zero polynomial is introduced:
0 = j = 0 N 2 ξ j T D j T R j - 1 D j ξ j + v j T R j - 1 D j ξ j + ξ j T D j T R j - 1 v j - ξ j T D j T R j - 1 v j + D j ξ j - v j + D j ξ j T R j - 1 D j ξ j
Substituting the above equation into Equation (35), we can get:
J x 0 , u , v = x 0 T P 0 - 1 x 0 + j = 0 N u j T Q j - 1 u j - s j T s j - 1 γ 2 e j T e j   + ξ j v j + D j ξ j T I + D j T R j - 1 D j - D j T R j - 1 - R j - 1 D j R j - 1 ξ j v j + D j ξ j
After matrix inversion, Equation (37) is equivalent to:
J x 0 , u , v = x 0 T P 0 - 1 x 0 + j = 0 N u j D j v j T Q j S j D j T D j S j T D j R j D j T u j D j v j
Based on the Equation (7) in the Krein space, the coordinate transformation is as follows:
x 0 u Ω v = I 0 0 0 I 0 - Θ - Υ I x 0 u y
Then, the vector form of Equation (38) is:
J x 0 , u , v = x 0 u Ω v T P 0 0 0 0 Q S Ω T 0 Ω S T Ω R Ω T - 1 x 0 u Ω v
Therefore, the quadratic function can be transformed as the following equation:
J x 0 , u , y = x 0 u y T I 0 0 0 I 0 Θ Υ I P 0 0 0 0 Q S Ω T 0 Ω S T Ω R Ω T I 0 0 0 I 0 Θ Υ I T - 1 x 0 u y
Obviously, the weighted matrix of the quadratic function and the one of the error covariance matrix in the Krein space are just inverse. Therefore, we can design recursive steps of the H filter in the Krein space.
Considering a state model in the Krein space represented as Equation (1), the recursive steps of the H filter are summarized as follows:
x j j - 1 = A j - 1 x j - 1 j - 1
P j j = A j - 1 P j - 1 j - 1 A j - 1 T + B j - 1 B j - 1 T - A j - 1 P j - 1 j - 1 C j T L j T R e - 1 C j L j P j - 1 j - 1 A j - 1 T
R e - 1 = I 0 0 - γ 2 I + C j L j P j - 1 j - 1 C j T L j T
K j = P j j C j T I + C j P j j C j T - 1
x j j = x j j - 1 + K j y j - C j x j j - 1
Compared to the KF, the proposed filter is much more robust. Actually, when γ , the H filter is just the KF exactly. Additionally, the less γ is, the stronger the robustness of the system. Using the above H filter, the uncertainty of the system noise can be eliminated availably. Hence, taking void measurement into account, we introduce a new parameter α into the presented robust H filter. Assume that the coefficient of the void measurement is indicated as α 1 α 0 :
when α = 1 , the CNS measurement is constantly available;
when α < 1 , the CNS measurement is lost.
That means, the smaller α is, the more the measurement is invalid. Therefore, the proposed novel robust H filter in the Krein space can be rewritten as the following reliability:
The predicted state is still as Equation (42), while the predicted measurement is:
y ^ j = α C j x j j - 1
To derive the filtering steps conveniently, we define some intermediate variables:
C j = α C j L k
R e - 1 = C j P j - 1 j - 1 C j T + α 1 - α C j C j T 0 0 - γ 2 I
K e = P j - 1 j - 1 C j R e - 1
P j = I - K e C j P j - 1 j - 1
Therefore, the estimated covariance matrix:
P j j = A j - 1 P j A j - 1 T + A j - 1 A j - 1 T
The filtering gain is:
K j = P j C j T I + α 1 - α I C j C j T
The estimated state:
x j j = x j j - 1 + K j y j - y ^ j
In the SINS/CNS integrated system, the measurement of the CNS is invalid occasionally for the environmental disturbance. To solve various uncertainty problems, the robust H filter introduces the H norm, which is the robust design parameter. In this filter, the noise and the uncertainty are regarded as the limited energy random signal. Then, the filter can be designed based on the objective quadratic that the H norm of the transfer function from the system interference to the estimated error is less than a given positive threshold.

4. Simulations and Experiments

To verify and estimate the performance of the proposed robust filter, simulations and experiments are performed in this section.

4.1. Simulations and Analysis

First of all, numerical simulations have been done. Suppose that the initial parameters of a marine vehicle are given and shown as Table 1:
According to Section 2.2, the state vector is composed of the position errors δ L and δ λ , the velocity errors δ V E , δ V N , the misalignment angle errors ϕ E , ϕ N , ϕ U , the gyroscope constant drifts ε x , ε y , ε z and the accelerometer constant biases x , y . The measurement vector is the attitude error between the SINS and CNS. On the basis of Equations (16)–(26), the model of the SINS/CNS integrated system can be expressed clearly.
In order to estimate the performance of the proposed filter, the normal KF is used as the reference filter. The initial state vector is:
x 0 = 0 m 0 m 0 m/s 0 m/s 20 20 20 0 . 01 / h 0 . 01 / h 0 . 01 / h 10 - 4 g 0 10 - 4 g 0 T
Additionally, the corresponding covariance matrix is:
P 0 = d i a g 10 10 Re Re 2 , 10 10 Re Re 2 , 0 . 1 2 , 0 . 1 2 , 20 2 , 20 2 , 20 2 , 0 . 01 / h 2 , 0 . 01 / h 2 , 0 . 01 / h 2 , 10 - 4 g 0 2 , 10 - 4 g 0 2
wherein R e indicates the Earth’s radius, R e = 6,378,393.0 m.
Under the same simulation conditions, the proposed robust H filter and the normal KF were applied to estimate the states of the SINS/CNS integrated navigation system. We compared the errors of misalignment angles in different conditions when α = 0 . 75 and α = 0 . 5 , respectively. The estimated results are shown in Figure 2 and Figure 3, respectively. To compare the running times of these two filters, Monte Carlo simulations are carried out 20-times on the same computer equipped with an Intel Core 2 T6570, 2.1-GHz processor and 3 GB RAM under Windows XP. Additionally, the means of the running times are compared in Table 2.
From Figure 2 and Figure 3, it is obvious that when α = 0 . 75 , the heading errors with the KF and proposed robust H filter are 4’ and −0.3’, respectively; when α = 0 . 5 , the heading error with the robust H filter is merely 0.4’, while the one with KF is about 7’. The average running times of normal Kalman filter are 0.7146 s and 0.6972 s, while the average times of the proposed robust filter are 0.9691 s and 0.9457 s when α = 0 . 75 and α = 0 . 5 , respectively. Therefore, we can know that obviously when the CNS measurement is lost occasionally, the estimated accuracy of the normal KF is decreased severely from 4’ to 7’. In addition, the more measurements are lost, the worse the estimated results are. However, under these two conditions, utilizing the proposed robust H filter, the misalignment angles not only can be estimated availably, but also have better convergence rates and stability than the KF method at a cost of few computations. Therefore, the robustness and superiority of the proposed H filter can be verified.

4.2. Experiments and Analysis

To further validate the performance of the proposed robust H filter based on the Krein space theory, some experiments are carried out, as well. In these experiments, the SINS and star sensor are fixed on the ship’s deck together. The schematic of experimental setup and sensors are shown in Figure 4 and Figure 5, respectively. In the SINS, the inertial measurement unit (IMU) is composed of the accelerometer and the gyroscope, which was developed by our lab and shown as the left picture in Figure 5. The performance parameters of the SINS and the star sensor are detailed in Table 3.
During the experiment, the lens of the star sensor is covered discontinuously to simulate the invalid state of the star Sensor from about 22 h to 24 h. In addition, the GPS is also used as the reference information, shown as the right picture in Figure 5. Therefore, in the experiments, the SINS/GPS integrated system can be used as the standard to estimate the accuracy of the SINS/CNS integrated system.
Figure 6 and Figure 7 give the experiment results of the SINS/CNS integrated system with the normal KF and robust H filter based on the Krein space theory, respectively.
From the experiment results, we can see that the angle errors are vibrational when the star sensor is covered from about 22 h to 24 h. For the pitch error, the amplitude values are about 0 . 14 and 0 . 11 with the normal KF and with the proposed robust filter, respectively, while the values of the roll error are 0 . 44 and 0 . 21 . Compared to the normal KF method, the horizontal and azimuth angle errors of the SINS/CNS integrated system are a bit smaller with the new robust filter based on the H filter and the Krein space theory. Regarding the yaw error, the maximal errors of the normal KF and the proposed robust filter have an extremely great distance. With the traditional KF method, the maximal are 38 . 76 , as the one with the proposed robust filter algorithm is nearly 0 . 69 . Therefore, with the proposed robust filter, the attitude errors can be decreased dramatically when the measurements of the integrated system are uncertain or lost. Furthermore, the robustness of this novel robust filter is also verified.

5. Conclusions

In order to solve the uncertainty problem of the SINS/CNS integrated navigation system caused by the missing measurements, a novel robust H filter based on the Krein space theory was proposed in this manuscript. Firstly, the system model of the SINS/CNS integrated navigation system was established, and then, a novel robust filter taking the uncertainty problem into account was proposed. Then, the superiority of the Krein space was described in principle, and the derivational process of the novel robust H filter was presented in detail. Numerical simulations and experiments were carried out to verify the new robust H filter. The results proved the advantages of the presented robust H filter on the basis of the Krein space theory, which can improve the navigation accuracy of the integrated navigation system availably when the CNS measurements are lost. Therefore, the feasibility and the superiority of this new robust filter were verified. However, the system model of the SINS/CNS integrated system was assumed as a linear model, which is clearly unrealistic in practical applications. Therefore, our future work will focus on the nonlinear robust filter, which is suitable for practical systems.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China (51379042, 51379047).

Author Contributions

Chongyang Lv wrote this paper and analyzed the results of the experiments. Fei Yu proposed the initial idea and conceived of the experiments. Qianhui Dong carried out the simulations and revised this manuscript.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Sun, J.; Xu, X.S.; Liu, Y.T.; Zhang, T.; Li, Y. Initial Alignment of Large Azimuth Misalignment Angles in SINS Based on Adaptive UPF. Sensors 2015, 15, 21807–21823. [Google Scholar] [CrossRef] [PubMed]
  2. Paull, L.; Saeedi, S.; Seto, M.; Li, H. AUV navigation and localization: A review. IEEE J. Ocean. Eng. 2014, 39, 131–149. [Google Scholar] [CrossRef]
  3. Gao, W.; Zhang, Y.; Wang, J. A strapdown interial navigation system/beidou/doppler velocity log integrated navigation algorithm based on a cubature Kalman filter. Sensors 2014, 14, 1511–1527. [Google Scholar] [CrossRef] [PubMed]
  4. Vasconcelos, J.; Silvestre, C.; Oliveira, P. INS/GPS aided by frequency contents of vector observations with application to autonomous surface crafts. IEEE J. Ocean. Eng. 2011, 36, 347–363. [Google Scholar] [CrossRef]
  5. Gao, Y.; Liu, S.; Atia, M.M.; Noureldin, A. INS/GPS/LiDAR Integrated Navigation System for Urban and Indoor Environments Using Hybrid Scan Matching Algorithm. Sensors 2015, 15, 23286–23302. [Google Scholar] [CrossRef] [PubMed]
  6. Wang, Q.; Li, Y.; Diao, M.; Gao, W.; Yu, F. Coarse alignment of a shipborne strapdown inertial navigation system using star sensor. IET Sci. Meas. Technol. 2015, 9, 852–860. [Google Scholar] [CrossRef]
  7. Jaradat, M.A.K.; Abdel-Hafez, M.F. Enhanced, delay dependent, intelligent fusion for INS/GPS navigation system. IEEE Sens. J. 2014, 14, 1545–1554. [Google Scholar] [CrossRef]
  8. Ning, X.; Wang, L.; Wu, W.; Fang, J. A celestial assisted INS initialization method for lunar explorers. Sensors 2011, 11, 6991–7003. [Google Scholar] [CrossRef] [PubMed]
  9. Xu, F.; Fang, J. Velocity and position error compensation using strapdown inertial navigation system/celestial navigation system integration based on ensemble neural network. Aerosp. Sci. Technol. 2008, 12, 302–307. [Google Scholar] [CrossRef]
  10. Gao, S.; Zhong, Y.; Zhang, X.; Shirinzadeh, B. Multi-sensor optimal data fusion for INS/GPS/SAR integrated navigation system. Aerosp. Sci. Technol. 2009, 13, 232–237. [Google Scholar] [CrossRef]
  11. Nobahari, H.; Asl, H.G.; Abtahi, S.F. A back-propagation approach to compensate velocity and position errors in an integrated inertial/celestial navigation system using unscented Kalman filter. Proc. Inst. Mech. Eng. Part G: J. Aerosp. Eng. 2014, 228, 1702–1712. [Google Scholar] [CrossRef]
  12. Rad, A.M.; Nobari, J.H.; Nikkhah, A.A. Optimal attitude and position determination by integration of INS, star tracker, and horizon sensor. IEEE Aeros. Electron. Syst. Mag. 2014, 29, 20–33. [Google Scholar] [CrossRef]
  13. Hamza, B.; Nebylov, A. Robust nonlinear filtering applied to integrated navigation system INS/GNSS under non Gaussian measurement noise effect. In Proceedings of the 2012 IEEE Aerospace Conference, Big Sky, MT, USA, 3–10 March 2012; pp. 202–207.
  14. Gandhi, M.; Mili, L. Robust Kalman filter based on a generalized maximum-likelihood-type estimator. IEEE Trans. Signal Process. 2010, 58, 2509–2520. [Google Scholar] [CrossRef]
  15. Chen, B.S.; Wu, C.F. H robust filter design for a class of nonlinear stochastic poisson jump systems. In Proceedings of the 2015 IEEE International Conference on Automation Science and Engineering (CASE), Gothenburg, Sweden, 24–28 August 2015; pp. 1557–1561.
  16. Hsieh, C.S. Robust state estimation via the descriptor Kalman filtering method. In Proceedings of the IEEE 2013 9th Asian Control Conference (ASCC), Istanbul, Turkey, 23–26 June 2013; pp. 1–6.
  17. De Souza, C.E.; Palhares, R.M.; Peres, P.L.D. Robust H filter design for uncertain linear systems with multiple time-varying state delays. IEEE Trans. Signal Process. 2001, 49, 569–576. [Google Scholar] [CrossRef]
  18. Lee, T.; Ra, W.S.; Yoon, T.; Park, J. Robust Kalman filtering via Krein space estimation. IEE Proc. Control Theory Appl. 2004, 151, 59–63. [Google Scholar] [CrossRef]
  19. Zhong, M.; Guo, D.; Guo, J. PMI-Based Nonlinear Estimation of Unknown Sensor Error for INS/GPS Integrated System. IEEE Sens. J. 2015, 15, 2785–2794. [Google Scholar] [CrossRef]
  20. Feng, J.; Yu, F.; Zhang, P.; Zou, M. On initial alignment of large azimuth misalignment for SINS on the static base in Krein space. In Proceedings of the IEEE 2012 10th World Congress on Intelligent Control and Automation (WCICA), Beijing, China, 6–8 July 2012; pp. 1964–1968.
  21. Song, X.; Yan, X. Finite-horizon H fault estimation for linear time-delay systems. In Proceedings of the IEEE 2014 33rd Chinese Control Conference (CCC), Nanjing, China, 28–30 July 2014; pp. 3255–3258.
  22. Hassibi, B.; Kailath, T.; Sayed, A.H. Array algorithms for H estimation. IEEE Trans. Autom. Control 2000, 45, 702–706. [Google Scholar] [CrossRef]
  23. Ra, W.; Jin, S.; Park, J. Set-valued estimation approach to recursive robust H filtering. IEE Proc. Control Theory Appl 2004, 151, 773–782. [Google Scholar] [CrossRef]
Figure 1. Schematic diagram of the SINS/CNS integrated system.
Figure 1. Schematic diagram of the SINS/CNS integrated system.
Sensors 16 00396 g001
Figure 2. The estimated errors of the misalignment angles when α = 0 . 75 .
Figure 2. The estimated errors of the misalignment angles when α = 0 . 75 .
Sensors 16 00396 g002
Figure 3. The estimated errors of the misalignment angles when α = 0 . 5 .
Figure 3. The estimated errors of the misalignment angles when α = 0 . 5 .
Sensors 16 00396 g003
Figure 4. Schematic of the experimental setup.
Figure 4. Schematic of the experimental setup.
Sensors 16 00396 g004
Figure 5. The IMU (left) and GPS (right) used in the experiments.
Figure 5. The IMU (left) and GPS (right) used in the experiments.
Sensors 16 00396 g005
Figure 6. The horizontal angle errors with the normal Kalman filter method and the proposed robust H filter. The blue dash line indicates the horizontal errors by utilizing the normal Kalman filter method; The green solid line indicates the horizontal errors by utilizing the novel method proposed in this article.
Figure 6. The horizontal angle errors with the normal Kalman filter method and the proposed robust H filter. The blue dash line indicates the horizontal errors by utilizing the normal Kalman filter method; The green solid line indicates the horizontal errors by utilizing the novel method proposed in this article.
Sensors 16 00396 g006
Figure 7. The azimuth angle errors with the normal Kalman filter method and the proposed robust H filter. The blue dash line indicates the azimuth errors by utilizing the normal Kalman filter method; The green solid line indicates the azimuth errors by utilizing the novel method proposed in this article.
Figure 7. The azimuth angle errors with the normal Kalman filter method and the proposed robust H filter. The blue dash line indicates the azimuth errors by utilizing the normal Kalman filter method; The green solid line indicates the azimuth errors by utilizing the novel method proposed in this article.
Sensors 16 00396 g007
Table 1. Simulation parameters.
Table 1. Simulation parameters.
ParametersValues
initial latitude L = 40 . 2631049
initial longitude λ = 120 . 886482
initial velocity v x = v y = 0
gravity acceleration g 0 = 9 . 7805 m/s 2
initial misalignment angles ϕ x = ϕ y = ϕ z = 20
constant drifts of the gyroscopes ε x = ε y = ε z = 0 . 01 /h
random noise of the gyroscopes W g x = W g y = W g z = 0 . 05 /h
constant biases of the accelerometers x = y = 10 - 4 g 0
random noise of the accelerometer W a x = W a y = 5 * 10 - 5 g 0
sampling frequency98 Hz
Table 2. Comparisons of the running times.
Table 2. Comparisons of the running times.
Running Time (s)
Kalman FilterProposed Filter
α = 0 . 5 0 . 6972 0 . 9457
α = 0 . 75 0 . 7146 0 . 9691
Table 3. Main parameters of the SINS and star sensor.
Table 3. Main parameters of the SINS and star sensor.
SensorsParametersValues
GyroDynamic range ± 100 /s
Bias stability 0 . 01 /h
Random walk 0 . 005 / h
Scale factor stability 20 ppm
AccelerometerDynamic range ± 4 g
Bias stability 10 - 4 g
Random walk 5 * 10 - 5 g
Scale factor stability 20 ppm
Star SensorField of view 24
Attitude accuracy 5
Data update frequency20 Hz

Share and Cite

MDPI and ACS Style

Yu, F.; Lv, C.; Dong, Q. A Novel Robust H Filter Based on Krein Space Theory in the SINS/CNS Attitude Reference System. Sensors 2016, 16, 396. https://doi.org/10.3390/s16030396

AMA Style

Yu F, Lv C, Dong Q. A Novel Robust H Filter Based on Krein Space Theory in the SINS/CNS Attitude Reference System. Sensors. 2016; 16(3):396. https://doi.org/10.3390/s16030396

Chicago/Turabian Style

Yu, Fei, Chongyang Lv, and Qianhui Dong. 2016. "A Novel Robust H Filter Based on Krein Space Theory in the SINS/CNS Attitude Reference System" Sensors 16, no. 3: 396. https://doi.org/10.3390/s16030396

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop