Next Article in Journal
Spacecraft Staring Attitude Control for Ground Targets Using an Uncalibrated Camera
Next Article in Special Issue
Capture Dynamics and Control of a Flexible Net for Space Debris Removal
Previous Article in Journal
Optimal Aggressive Constrained Trajectory Synthesis and Control for Multi-Copters
Previous Article in Special Issue
Nonlinear Covariance Analysis-Based Robust Rendezvous Trajectory Design by Improved Differential Evolution Method
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System

Navigation Research Centre, College of Automation Engineering, Nanjing University of Aeronautics and Astronautics, 29 General Avenue, Jiangning District, Nanjing 211106, China
*
Author to whom correspondence should be addressed.
Aerospace 2022, 9(6), 282; https://doi.org/10.3390/aerospace9060282
Submission received: 18 March 2022 / Revised: 17 May 2022 / Accepted: 21 May 2022 / Published: 24 May 2022
(This article belongs to the Special Issue Recent Advances in Spacecraft Dynamics and Control)

Abstract

:
As to an aerospace vehicle, the flight span is large and the flight environment is complex. More than that, the existing navigation algorithms cannot meet the needs to provide accurate navigation parameters for aerospace vehicles, which results in the decline of navigation accuracy. This paper proposes a multi-layer, fault-tolerant robust filtering algorithm of aerospace vehicle in the launch inertial coordinate system to address this problem. Firstly, the launch inertial coordinate system is used as the reference coordinate system for navigation calculation, and the state equation and measurement equation of the navigation system are established in this coordinate system to improve the modeling accuracy of the navigation system. On this basis, a multi-layer, fault-tolerant robust filtering algorithm is designed to estimate and compensate the unknown input in the state equation in real time and adjust the noise variance matrix in the measurement equation adaptively. Simulation results show that the errors about the integrated navigation system output parameters are reduced, through this algorithm, which improves the attitude, velocity and position estimation accuracy of the integrated navigation system. In addition, the algorithm enhances the fault tolerance and robustness of the filtering algorithm.

1. Introduction

In recent years, the trend of air-space integration has been presented in the strategic layout of all military powers around the world. As a new type of aircraft with dual functions of aircraft and spacecraft, the aerospace vehicle (ASV) is gradually occupying an important strategic position in the future battlefield due to its characteristics of cross-airspace, multi-mission, multi-working mode and large-scale high-speed maneuvers [1]. The reusable lifted space vehicles represented by X-37B, IXV, X-33, etc., have attracted more and more attention, promoted the development of low-cost space technology and become a research hotspot in recent years [2,3]. However, their complex motion characteristics throughout the flight process are undoubtedly greatly challengeable to the existing navigation, guidance and control technologies. As an important part of navigation, guidance and control technology, navigation performance directly affects the accuracy of guidance and control loop. Therefore, the advanced navigation technology has become one of the key technologies to be broken through urgently, which is a prerequisite for the safe execution of missions of aerospace vehicles.
The inertial navigation system is completely autonomous and free from electromagnetic signal interference, so it can output complete navigation information. However, due to their own device zero bias and noise, the navigation error of pure inertial navigation systems will increase over time gradually. The satellite navigation system is a high-accuracy geometric positioning and navigation system, with no error accumulating over time [4], but it is difficult to work properly when subject to intentional or unintentional interference [5]. As a high-precision navigation means, celestial navigation systems have a wide range of applications and are completely autonomous, by using natural celestial bodies as navigation beacons. However, due to its complicated solving process and low data-update frequency [6,7], it is difficult to meet the aerospace vehicle on the demand for real-time navigation [8]. Therefore, the use of INS/GPS/CNS integrated navigation is a hot design to realize the complementary advantages between each navigation means and improve the accuracy of the navigation system. Some researchers have achieved fruitful results in this field, such as a resilient fusion navigation algorithm based on the failure influence level evaluation [9], the sigma-point based Kalman filters fusion methods [10], the SINS/GPS/SAR integrated navigation system that was developed to represent and analyze white noise errors [11], etc. However, most of the existing integrated navigation algorithms use the geographic coordinate system as a unified reference coordinate system to calculate navigation parameters subsequently. In this process, changes in the gravity field and radius of curvature are usually ignored or simplified. Aerospace vehicles may fly away from the earth’s surface, and if these factors are ignored directly, the accuracy of the navigation system will be reduced. Currently, aerospace vehicles are mainly launched on rockets; the launch inertial coordinate system is mainly used as the reference coordinate system for rockets’ navigation calculation. When the aerospace vehicle enters onto the orbit, its motion characteristics are close to that of the satellite, and the inertial coordinate system is usually used as the coordinate system for navigation solution. Therefore, using the launch inertial coordinate system as the aerospace vehicle navigation reference coordinate system can unify the description of the navigation information during the launch phase and the on-orbit phase, which can reduce the conversion of navigation parameters, and to avoid the loss of accuracy in the conversion process.
As we all know, the flight envelope of aerospace vehicles is wide, the flight environment is complex and the flight patterns are variable. All these uncertain factors in the flight environment will have unpredictable effects on the navigation system and make it difficult to establish an accurate error model for the navigation system. At the same time, the statistical characteristics of the noise sequence are also difficult to obtain [12]. In this case, the traditional Kalman filter cannot achieve the best working state, and even diverges [13]. As a result, nonlinear state estimation methods based on numerical integration approximation have been proposed [14,15,16], and representative methods include central difference Kalman filtering [17], etc. By simulating the noise statistical characteristic distribution of the navigation system to the greatest extent, the divergence of the filtering results can be suppressed. Obviously, this also makes the calculation process of the algorithm cumbersome and inefficient, and unable to fundamentally solve the problem of navigation accuracy degradation caused by inaccurate filtering model.
Therefore, researchers began to research the robust filtering algorithm. From the definition of robustness, the embodiment of robust strategy in filtering mainly focuses on three aspects: Firstly, from the perspective of filtering model, robustness is mainly reflected in dealing with the interference in the observation equation; secondly, from the point of view of observation, robust filtering generally does not solve the interference problem in the state quantity, and adaptive processing is generally used when the state quantity is disturbed; thirdly, from the perspective of noise-processing methods, the robust filter mostly adopts processing methods such as weighting for observation noise to reflect the anti-interference ability of filtering.
In order to improve the navigation accuracy of aerospace vehicles in the complex flight environment, there is not only a need to build an accurate system model, but it is also necessary to consider the accuracy of the measurement information of the navigation system. The changeable flight environment puts forward high requirements for the working performance of navigation sensors and requires the navigation system to have robustness. In recent years, relevant research has also been further developed [18,19,20]. Some researchers proposed a robust multiple model adaptive estimation (RMMAE) algorithm and analyzed its performance [21]. The available random probability information is taken into account in the developed state estimation algorithm that was proposed by Zheng [22]. Subsequently, by employing the stochastic analysis and matrix techniques, the exponential boundedness of the state estimation error is discussed from the theoretical aspects. Li has proposed a centralized robust Kalman filter that is designed by using variational Bayesian methods and a modified interacting multiple model method based on information theory (IT-IMM) [23]. A distributed robust Kalman filter based on the centralized filter and a hybrid consensus method called hybrid consensus on measurement and information (HCMCI) was designed. Pan has proposed a variational Bayesian (VB)-based robust adaptive Kalman filtering (VB-RAKF) [24]. This filter introduces a classification robust equivalent weight function to resist observation gross error and the inverse Wishart prior to model inaccurate process noise covariance matrix (PNCM).
The above method mainly estimates the variance of the measurement noise of the navigation system and then adjusts the gain matrix of the filter within a certain range to improve the robustness of navigation system. These studies can improve the filter estimation accuracy to a certain extent when the navigation sensor is fault, but the existing robust filtering algorithms present difficulties in solving the problem of accuracy degradation caused by inaccurate filtering model. Therefore, a multi-layer fault-tolerant robust filtering for integrated navigation in launch inertial coordinate system is proposed in this paper. The main innovations of this paper are as follows:
(a)
The aerospace vehicle flies far away from the earth’s surface, so using the launch inertial coordinate system for navigation solution can reduce the accuracy loss of measurement information caused by matrix conversion. At the same time, it can also reduce the error in the modeling stage of the system and provide higher precision state quantity and quantity measurement for the subsequent filtering algorithm.
(b)
In view of the high dynamic flight of aerospace vehicles, it will lead to the inaccuracy of the system state equation model and the decline of estimation accuracy. By taking the inconsistency information as the unknown input of the state equation, and identifying, compensating and correcting it, the accuracy of filter estimation is improved.
(c)
After improving the accuracy of system parameters, aiming at the situation that the navigation sensor may fail due to the bad flight environment during the flight of the aerospace vehicle, the mismatch degree of residual is used to detect the fault of measurement information, and the weighted exponential fading memory average method is further used to realize the adaptive adjustment of measurement noise variance, to improve the accuracy of integrated navigation system.
The algorithm proposed in this paper uses the launch inertial coordinate system for navigation calculation, which improves the accuracy of system-state quantity and measurement quantity. On this basis, a two-layer, fault-tolerant robust filtering structure is designed. This is different from the existing robust filtering algorithm, which is only designed from the perspective of measurement equation. In this paper, the robust filtering algorithm is designed from two aspects of the system-state equation and measurement equation, which improves the robustness of the aerospace vehicle navigation system in a large dynamic flight environment.

2. Algorithm Arrangement of Integrated Navigation System in Launch Inertial Coordinate System

Under the existing technology, the navigation system applied to aerospace vehicles is mainly an inertial navigation system, which is completely autonomous and can output complete navigation parameters. In addition, the aerospace vehicle has a broad flight envelope, and its flight phases mainly include: launch phase, on-orbit phase, re-entry phase and landing phase. It is necessary to select navigation sensors according to the flight characteristics of different flight stages, such as the satellite navigation system, celestial navigation system, etc.

2.1. Scheme Design of Integrated Navigation System in Launch Inertial Coordinate System

The characteristics of the different navigation sensors differ significantly in both spatial and temporal dimensions. For example, inertial navigation systems can output navigation parameters continuously, while satellite positioning systems, celestial navigation systems, etc., can only output navigation information discretely, and their sampling intervals and output information types are different from each other, depending on the flight phase and environment. Therefore, it is necessary to adopt advanced and effective information-processing methods to combine heterogeneous navigation information to meet the needs of autonomous and reliable navigation organically.
For this reason, the launch inertial coordinate system is used as the reference coordinate system for inertial navigation system calculation and subsequent filtering in this paper. The coordinate systems in this paper are defined as follows: i is the inertial coordinate system; e is the earth fixed coordinate system; l is the launch inertial coordinate system; b is the body coordinate system; g is the geographic coordinate system, which is the east-north-up direction.
The overall scheme of the SINS/GPS/CNS integrated navigation system in launch inertial coordinate system designed in this paper is shown in Figure 1:
As shown in Figure 1, the inertial navigation solution module obtains the attitude angle from the output of the gyroscope and calculates the attitude quaternion to obtain the attitude transfer matrix from the body coordinate system to the launch inertial coordinate system. According to the attitude transfer matrix and the outputs of the accelerometer, the velocity and position calculation are performed. The position and velocity output of GPS in the earth fixed coordinate system is converted to launch the inertial coordinate system through the conversion matrix. The attitude output of CNS in the inertial coordinate system is converted to launch the inertial coordinate system through the conversion matrix.
According to the existing public data, aerospace vehicles are generally carried on rockets for launch, and rockets generally use the launch inertial coordinate system as the reference coordinate system for navigation calculation. After flying out of the atmosphere, the motion characteristics of aerospace vehicles are like those of on-orbit satellites, while on-orbit satellites generally use the inertial coordinate system as the reference coordinate system for navigation calculation. Therefore, this paper uses the launch inertial coordinate system as the reference coordinate system of the aerospace vehicle navigation system, which can unify the description of navigation parameters in different flight stages and reduce the conversion of navigation parameters in the calculation process to avoid the loss of accuracy.

Inertial Navigation Solution Module in Launch Inertial Coordinate System

In the strapdown inertial navigation system, the inertial device is fixed on the carrier, the angular rate output of the gyroscope is ω i b b , ω l b b is the projection of the angular rate of the body coordinate system relative to the launch inertial coordinate system under the body coordinate system. Then ω l b b can be written as:
ω l b b = ω l i b + ω i b b
ω l i b is the projection of angular rate of inertial coordinate system relative to launch inertial coordinate system under the body coordinate system; ω i b b is the projection of the angular rate of the body coordinate system relative to the inertial coordinate system under the body coordinate system, where ω l i b = 0 , so:
ω l b b = ω i b b
For the attitude calculation module, a quaternion method can work in full attitude and a small amount of calculation is used to calculate the attitude. If the original three-dimensional output information of the gyroscope is expanded into a quaternion with the scalar part of 0 and the vector part of ω q i , it has the differential relationship with the quaternion q corresponding to the attitude matrix as follows:
q ˙ t = 0.5 q t ω q i
In Equation (3), represents the multiplication of quaternions.
q ˙ = 1 2 · q 0 q 1 q 2 q 3 q 1 q 0 q 3 q 2 q 2 q 3 q 0 q 1 q 3 q 2 q 1 q 0 · 0 ω b x ω b y ω b z
The quaternion q can be obtained by discretizing Equation (3) and calculating it by the Picard successive approximation method. After normalizing q , the conversion relationship C l b between quaternions and attitude matrix can be calculated:
C l b = q 0 2 + q 1 2 q 2 2 q 3 2 2 q 1 q 2 + q 0 q 3 2 q 1 q 3 q 0 q 2 2 q 1 q 2 q 0 q 3 q 0 2 q 1 2 + q 2 2 q 3 2 2 q 2 q 3 + q 0 q 1 2 q 1 q 3 + q 0 q 2 2 q 2 q 3 q 0 q 1 q 0 2 q 1 2 q 2 2 + q 3 2
From Equation (5), the expression for each attitude angle is:
γ = a r c t a n t 13 t 33 θ = a r c t a n t 23 ψ = a r c t a n t 21 t 22
In Equation (6), t is equal to C l b .
In the strapdown inertial navigation system, the inertial device is directly fixed to the carrier, the accelerometer output is f i b b , represents the vector formed by the acceleration of the body coordinate system relative to the inertial coordinate system in the axial component of the body coordinate system. Then the accelerometer value f i b l under launch inertial coordinate system can be obtained as:
f i b l = C b l f i b b
In Equation (7), C b l is the attitude conversion matrix of the launch inertial system relative to the body coordinate system;
From Equation (7), the specific force equation under the launch inertial system can be written as:
f i b l = v ˙ C i l G
In Equation (8), v is the velocity value in launch inertial coordinate system; G is the universal gravitation force of the Earth; C i l is the attitude transition matrix of the launch inertial system relative to the inertial system.
In the launch inertial coordinate system, the position under the launch inertial coordinate system can be calculated by integrating the navigation velocity:
p ˙ = v
In Equation (9), v is the velocity vector.
The navigation model in launch inertial coordinate system can be written as:
q ˙ = 0.5 q ω l b b v ˙ = C b l · f b + C i l · G i p ˙ = v
Among them, q is the quaternion; C b l is the transfer matrix from the body coordinate system to the launch inertial coordinate system; f b is the specific force of the accelerometer in the body coordinate system; C i l is the transfer matrix from the inertial coordinate system to the launch inertial coordinate system; G i is the gravitational force in the inertial coordinate system; p is the position vector.
According to Equation (10), the error equations of navigation information including attitude quaternion, velocity and position of the aerospace vehicle in launch inertial coordinate system can be derived. The differential equations are as follows:
δ q ˙ 13 = ω ^ i b b × δ q 13 + 0.5 δ W δ v ˙ = 2 C b l f ^ b × δ q 13 + C b l a + C b l δ G δ p ˙ = δ v
In Equation (11), δ q 13 is the vector part of δ q ; δ v is the velocity error vector; δ p is the position error vector; δ W is the gyro noise; a is the accelerometer error; δ G is the gravity error; ω ^ i b b × represent the symmetric matrix of ω ^ i b b ; f ^ b × represent the symmetric matrix of f i b b .

2.2. Matrix Transformation of Launch Inertial Coordinate System

Unlike aero-planes, the larger flight envelope of the aerospace vehicle means that the simplified model of the Earth used by traditional inertial navigation algorithms in the geographic coordinate system is no longer suitable for its navigation system. Therefore, this paper discusses navigation algorithms under launch inertial system with an accurate model of the Earth.
Among them, the origin of the launch inertial coordinate system is taken at the launch point of the aerospace vehicle, and its coordinate axis direction is defined by the aerospace vehicle at the launch time. The y-axis is the vertical line passing the launch point, and upward is positive. The x-axis is perpendicular to the y-axis at the launch time. The z-axis, the x-axis and the y-axis constitute a right-handed rectangular coordinate system. The conversion relationship between the launch inertial coordinate system and the J2000 inertial coordinate system is shown in the Figure 2:
In order to calculate the transfer matrix C i l from the launch inertial coordinate system to the inertial coordinate system, the first step is to calculate C n l (the transfer matrix from the geographic system (launch origin) to launch inertial coordinate system), C e n (the transfer matrix from the Earth Fixed coordinate system to geographic coordinate system (launch origin)), C i e (the transfer matrix from the inertial coordinate system to Earth Fixed coordinate system), where:
C l n = 1 0 0 0 c o s 90 s i n 90 0 s i n 90 c o s 90 · c o s 90 A 0 s i n 90 A 0 1 0 s i n 90 A 0 c o s 90 A
In Equation (12), A is the launch deflection angle.
C n e = c o s 90 + λ s i n 90 + λ 0 s i n 90 + λ c o s 90 + λ 0 0 0 1 · 1 0 0 0 c o s 90 φ s i n 90 φ 0 s i n 90 φ c o s 90 φ
The conversion from the Protocol geographic coordinate system to the WGS84 coordinate system needs to consider the influence of polar motion, then:
C 1 e = 1 0 x p 0 1 0 x p 0 1 · 1 0 0 0 1 y p 0 y p 1
In Equation (14), x p , y p is the coordinates of the pole.
When converting from an instantaneous ground-fixed coordinate system to an instantaneous true equatorial geocentric celestial coordinate system, the time angle of the vernal equinox needs to be considered, then:
C 2 1 = c o s θ s i n θ 0 s i n θ c o s θ 0 0 0 1
θ = θ - + Δ ϕ c o s ε ˜
θ ¯ is Greenwich Mean Sidereal Time.
Conversion from the instantaneous horizontal celestial coordinate system to the instantaneous true celestial coordinate system:
C 3 2 = 1 0 0 0 c o s ε ˜ s i n ε ˜ 0 s i n ε ˜ c o s ε ˜ c o s ϕ s i n ϕ 0 s i n ϕ c o s ϕ 0 0 0 1 1 0 0 0 c o s ε ¯ s i n ε ¯ 0 s i n ε ¯ c o s ε ¯
In Equation (17),
  • mean obliquity:
    ε ¯ = 84381 . 448 46 . 815 · T u 0 . 00059 · T u 2 + 0.001813 · T u 3
  • nutation in obliquity:
    Δ ε = 9 . 2025 c o s Ω + 0 . 5736 · c o s ( 2 L )
  • true ecliptic obliquity:
    ε ˜ = ε ¯ + Δ ε
  • nutation of longitude:
    Δ ϕ = 17 . 1996 s i n Ω 1 . 3187 · s i n ( 2 L )
  • right ascension of moon ascending node:
    Ω = 125.04 0.052954 · J D
  • mean longitude of the sun:
    L = 280.47 0.98565 · J D
The conversion from the J2000 coordinate system to the instantaneous horizontal celestial coordinate system needs to consider the effect of precession, then:
C i 3 = c o s Z A s i n Z A 0 s i n Z A c o s Z A 0 0 0 1 c o s θ A 0 s i n θ A 0 1 0 s i n θ A 0 c o s θ A c o s ς A s i n ς A 0 s i n ς A c o s ς A 0 0 0 1
In Equation (24): T u is Julian Day, and ς A , Z A , θ A are three Euler angles in the equatorial plane.
Then the matrix C i e established based on the accurate earth model from the inertial coordinate system to the ground-fixed coordinate system is:
C i e = C 1 e · C 2 1 · C 3 2 · C i 3
Since the orbital height of ASV is about 300 km, it can be roughly regarded as a low-earth orbit satellite, which means that the factor that has the greatest influence on the gravitational field is the ellipticity of the earth. Therefore, the gravity field model is as follows.
G = μ x r 3 1 J 2 R e r 2 7.5 z 2 r 2 1.5 μ y r 3 1 J 2 R e r 2 7.5 z 2 r 2 1.5 μ z r 3 1 J 2 R e r 2 7.5 z 2 r 2 4.5
In the above equation, x , y , z are the carrier position of aerospace vehicles in the geocentric inertial coordinate system; J 2 = 1.08263 × 10 3 , which is the second-order harmonic coefficient; μ = 3.986 × 10 14   m 3 s 2 , which is the gravitational constant; R e = 6,378,137 m, which is the equatorial radius; r is the distance from the carrier to the center of the Earth. The accurate gravity model derived from Equation (16) is brought into Equation (11) to improve the modeling accuracy of system state quantity.

2.3. Establishing the State Equation and Measurement Equation for Integrated Navigation System

After establishing the strapdown inertial navigation system model in the launch inertial coordinate system, this paper directly establishes the state model and observation model of the SINS/GPS/CNS integrated navigation system in the launch inertial system.
The system state equation is:
X ˙ t = A t X t + B t W t
In Equation (27), A t is the system matrix;
A t = 0 3 × 3 0 3 × 3 0 3 × 3 C b l 0 3 × 3 F a 0 3 × 3 F b 0 3 × 3 C b l 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3
In Equation (28), F a is an antisymmetric matrix composed of apparent acceleration; F b is determined by the partial derivative of gravitational acceleration to position. B t is the system noise matrix;
B t = C b l 0 3 × 3 0 3 × 3 C b l 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3
X t is the state vector; W t is the system noise vector; Combined Equation (10) and Equation (27), State quantity X is:
X = δ q 1 δ q 2 δ q 3 δ p x δ p y δ p z δ v x δ v y δ v z ω r x ω r y ω r z f r x f r y f r z
In the above equation, δ q 1 , δ q 2 , δ q 3 are three-dimensional vector error part of attitude quaternion; δ p x , δ p y , δ p z are position error; δ v x , δ v y , δ v z are velocity error; ω r x , ω r y , ω r z are gyro random walk error; f r x , f r y , f r z are accelerometer random walk error
The system noise vector W is:
W = ω ε x ω ε y ω ε z ω n x ω n y ω n z f n x f n y f n z
In the integrated navigation system observation equation, the position measurement information output from the GPS and the attitude measurement information output from the CNS are regarded as the observation vector. Then the observation vector of SINS/CNS subsystem can be written as:
Z C t = H a t X t + r η
In Equation (32), r η is the noise matrix measured by the star sensor.
H a t 3 × 15 = I 3 × 3 0 3 × 12 3 × 15
Similarly: the observation vector of the SINS/GPS subsystem can be written as:
Z G t = H p t X t + r ε
In Equation (34), r ε is the noise matrix measured by the GPS.
H p t 3 × 15 = 0 3 × 3   I 3 × 3   0 3 × 9 3 × 15
From Equations (33) and (35), the SINS/GPS/CNS integrated navigation system observation vector can be written as:
H t 3 × 15 = I 3 × 3   I 3 × 3   0 3 × 9 3 × 15

3. Multi-Layer Fault-Tolerant Robust Filtering Algorithm

After the model of the strapdown inertial navigation system and integrated navigation system in the launch inertial coordinate system have been established, the integrated navigation filtering algorithm needs to be further researched. The aerospace vehicle must perform cross-airspace, highly dynamic and wide-range missions, so its navigation system will be affected by many uncertainties, which makes it impossible to accurately model the navigation system errors, and the statistical characteristics of the navigation system noise are also difficult to be obtained. In this paper, the above situation can be regarded as the existence of unknown inputs in the state equation of the navigation system, which leads to the performance limitation of the traditional linear Kalman filter. In addition, the aerospace vehicle navigation system is equipped with many sensors and the complex flight environment may cause some measurement sensors to fail, such as satellite signals are interfered with, the star sensor cannot be effectively calculated due to stargazing conditions, etc., which leads to a decrease in the accuracy of the navigation system. Therefore, it is necessary to identify, estimate and compensate the unknown inputs of the navigation system state equation, as well as to perform real-time fault diagnosis, isolation and reconstruction of the measurement information to improve the accuracy and robustness of the navigation system at multiple levels.

3.1. Design of Robust Fault Tolerant Filtering Architecture

In order to improve the fault tolerance and robustness of the navigation system filter, it is necessary to compensate and correct errors caused by various unknown factors such as an inaccurate system model and measurement-sensor failures since the Kalman filter algorithm can only obtain optimal estimates of state quantities when both the structural parameters and the statistical properties of the noise of the dynamic system are accurate. When the relevant parameters are inaccurate, the Kalman filter accuracy decreases or even diverges. The model error of the system usually affects the output of the system. For this reason, A.P. Sage and G.W. Husa proposed the adaptive filtering algorithm, and its method currently is mainly used to estimate the variance of the measurement noise. Meanwhile, it cannot eliminate the influence of the unknown inputs in the state equation, which leads to a large filtering error.
Therefore, this section proposes a multi-layer robust fault-tolerant filter design method, as shown in Figure 3.
Firstly, we use the state equation unknown-inputs self-correction module to estimate and compensate the unknown input in the state equation automatically. Meanwhile, the measurement noise-variance matrix adaptive module is used to detect the failure of the measurement information, and to adapt the measurement noise-variance matrix. Combining the above two modules to construct a multi-layer, fault-tolerant robust filter structure can improve the robustness and accuracy of the aerospace vehicle navigation system in a large dynamic environment.

Self-Recognition Algorithm for Unknown Input of State Equation

When the integrated navigation system model is inconsistent with the filter model or the statistical characteristics of the system noise are unknown due to the large dynamic flight of aerospace vehicle, this is reflected in the existence of unknown inputs to the system state equation. Therefore, it needs to be identified, compensated and corrected to improve the navigation system accuracy.
From Equations (27) and (32), the system equation can be written as:
X k + 1 = f k X k + U k + W k
Z k = h k X k + V k
In Equations (37) and (38), The definitions of f k , h k , W k and V k are the same as in the previous chapter, and U k is the unknown input in the state equation.
Since the filter update time interval is small enough, the unknown input of the adjacent interval often changes little [25], so that the unknown input U k can be estimated and when the sampling period k 3 , the unknown input U k can be approximately expressed as:
U k U k 1
The initial estimate of the state unknown input U k is:
U ^ k 0 = X ^ k f k 1 X k 1
In Equation (40), it is necessary to distinguish U ^ k 0 due to unknown inputs or accidental errors. Therefore:
U ^ k , j = 0 ,   if   U ^ k , j 0 < c σ k , j U ^ k , j 0 ,   if   U ^ k , j 0 c σ k , j j = 1 , 2 , , l
In Equation (41), the U ^ k , j and U ^ k , j 0 are respectively the j th component of U ^ k and U ^ k 0 , σ k , j is written as:
σ k , j = Q k j , j   j = 1 , 2 , , l
At this point, the Kalman one-step prediction formula can be written as:
X ^ k | k 1 = F k 1 X ^ k 1 + U ^ k 1
The one-step prediction covariance matrix can be written as:
P k | k 1 = F k 1 P k 1 F k 1 T + Q k 1 + Θ k 1 + Θ k 1 T + Θ k 1 *
In Equation (44), Θ k 1 is written as:
Θ k 1 = F k 1 P k 1 S k 1 F k 2 T I K k 1 H k 1 Q k 2 T k 1
Θ k 1 * = T k 1 P k 1 + F k 2 P k 2 F k 2 T + Q k 2 S k 1 F k 2 T I K k 1 H k 1 Q k 2   F k 2 S k 1 T Q k 2 T I K k 1 H k 1 T T k 1
In above equation, the I is the unit matrix, T k 1 is the diagonal matrix where the elements in the l th row and the l th column are 1 when U ^ k 1 , j 0 , and the other non-diagonal elements are all 0. When U ^ k 1 , j = 0 , the element in the l th row and the l th column is 0, and the other non-diagonal elements are all 0 diagonal matrices. S k 1 is:
S k 1 = I K k 1 H k 1 F k 2 P k 2 + T k 2 P k 2 F k 3 S k 2 T   Q k 3 I K k 2 H k 2 T
S 1 = P 1
State estimation:
X ^ k = X ^ k | k 1 + K k Z k H k X ^ k | k 1
The covariance matrix for the state estimation is:
P k = I K k H k P k | k 1
The filtering gain is:
K k = P k | k 1 H k T H k P k | k 1 H k T + R k 1

3.2. Adaptive Algorithm for Measuring Noise Variance Matrix

During the actual flight of the aerospace vehicle, as it needs to go through the launch phases, in-orbit phases, and re-entry phases, it faces an extremely complex flight environment and the navigation sensors are prone to malfunction, such as the satellite navigation system being interfered with and unable to provide position and velocity information normally, or the star sensor cannot calculate the attitude of the aerospace vehicle properly. As a result, it is necessary to perform fault diagnosis, isolation and reconstruction of the measurement information obtained by the navigation sensors.

3.2.1. Residual Mismatch Degree Detection

From the analysis of the content in the previous section, the prediction error of the system measurement can be written as:
Z ˜ k | k 1 = H k X ˜ k | k 1 + V k
Taking the variances of both sides of Equation (52) simultaneously and shifting the terms gives the expression for the measurement noise variance matrix that can be obtained as:
R k = E Z ˜ k | k 1 Z ˜ k | k 1 T H k P k | k 1 H k T
In above equation, the E Z ˜ k | k 1 Z ˜ k | k 1 T is the lumped average of the random sequence. In practical applications, the traditional adaptive filtering adopts the equal weighted recursive estimation method [26], which will gradually lose the adaptive effect after long-time filtering. Therefore, this paper adopts the exponential fading memory weighted average method to ensure the robustness of the navigation system under long-time working conditions. The time average is used instead, and then the exponential fading memory weighted average of R k can be written as:
R ˜ k = 1 ϱ k R ˜ k 1 + ϱ k Z ˜ k | k 1 Z ˜ k | k 1 T H k P k | k 1 H k T
In above equation, ϱ k can be written as:
ϱ k = ϱ k 1 ϱ k 1 + τ
In Equation (55), ϱ 0 = 1 , τ is the fading factor.
When the system is modelled accurately, the E Z ˜ k | k 1 Z ˜ k | k 1 T can be written as:
E Z ˜ k | k 1 Z ˜ k | k 1 T = H k Φ k | k 1 P k 1 Φ k | k 1 T   + Γ k | k 1 Q k 1 Γ k | k 1 T H k T + R k
In Equation (56), Φ is the Jacobian matrix of f .
Combining Equations (55) and (56) can be written as:
B ^ k = 1 ϱ k B ˜ k 1 + ϱ k Z ˜ k | k 1 Z ˜ k | k 1 T
If the quantity measurement Z k has large fluctuations, let
E Z ˜ k | k 1 Z ˜ k | k 1 T = Λ ^ k
then:
t r Λ ^ k t r B ^ k
From Equation (59), it can be judged whether the quantity measurement Z k is faulty.

3.2.2. Adaptively Adjust Measurement Noise Variance

After detecting the failure of the measurement information, the P k | k 1 in the Kalman filter equation have been adjusted adaptively.
Adjust the mean square error matrix P k 1 by Equations (38) and (56), then:
B ^ k H k Γ k | k 1 Q k 1 Γ k | k 1 T H k T R k = H k Φ k | k 1 λ k P k 1 Φ k | k 1 T H k T
In Equation (60), λ k is the proportionality coefficient, which can be written as:
λ k = t r N k t r M k
In Equation (61), t r is the matrix tracing operation, N k can be written as:
N k = B ^ k H k Γ k | k 1 Q k 1 Γ k | k 1 T H k T R k
M k can be written as:
M k = H k Φ k | k 1 λ k P k 1 Φ k | k 1 T H k T
Since λ k should not be less than 1, it is necessary to judge λ k :
λ k = 1   λ k < 1 t r N k t r M k   λ k 1
At this point, P k | k 1 in the Kalman filter equation becomes:
P k | k 1 = Φ k | k 1 λ k P k 1 Φ k | k 1 T + Γ k 1 Q k 1 Γ k 1 T
Combining Equations (49)–(51) and (65), the multi-layer robust fault-tolerant filtering equation can be obtained.
The flow chart of the algorithm is shown in Figure 4:

4. Simulation and Verification

In this section, Monte Carlo simulation methods are used to simulate the KF algorithm, the UKF algorithm and the RF algorithm in this paper, and the root mean square error of RF algorithm, KF algorithm and UKF algorithm are respectively calculated. The simulation software is Matlab R2020b. Rotational angular velocity of the Earth is 7.292115 × 10 5   rad / s , Earth oblateness is 1 / 298.257 .

4.1. Simulation Condition Setting

The initial latitude and longitude for the aerospace vehicle launch point are: 118°, 32°, 100 m, the initial heading angle is 90°, the launch azimuth angle is 30°, the launch time is 13 April 2021 0 h 0 min 0 s, the flight time is 300 s; the solution period of strapdown inertial navigation system is 0.02 s, and the filter period is 1 s; the simulation parameters of the navigation sensor are set as shown in Table 1:
Filter parameters are set as follows:
System noise variance:
Q = d i a g 0.2 ° / h 0.2 ° / h 0.2 ° / h 0.2 ° / h 0.2 ° / h 0.2 ° / h 1 × 10 4   g 1 × 10 4   g 1 × 10 4   g 2
Measurement noise variance:
R 1 = d i a g 15 15 15 15   m 15   m 15   m 2
R 2 = d i a g 25 25 25 25   m 25   m 25   m 2 In the Table 2, the gyroscope random wander parameters in the actual system model are not consistent with the random wander parameters in the filter. This simulated situation can be considered an error in the filtering model for a duration of 30 s to 90 s. Meanwhile, the GPS and CNS fault information is injected during the simulation time of 100 s to 120 s to verify the effectiveness of the algorithm in different cases.

4.2. Simulation Analysis

Based on the above simulation conditions, the simulated aerospace vehicle launch trajectory is shown in Figure 5.
In order to verify the performance of the robust filtering algorithm of the integrated navigation system under the launch inertial coordinate system proposed in this paper, the above simulation condition is set as base; a simulation comparison of the algorithm in this paper with the KF algorithm and the UKF algorithm is carried out. The results are shown as follows.
Figure 6, Figure 7 and Figure 8 are the comparison diagram of the attitude, positioning and velocity error of the SINS/GPS/CNS integrated navigation system in the launch inertial coordinate system. The attitude of the aerospace vehicle is obtained by the inertial navigation system and celestial navigation system. The position and velocity of the aerospace vehicle are obtained by the inertial navigation system and satellite navigation system. Due to the inconsistency between the system model and the filter model in the 30–90 s, around 30 s, the three algorithms have certain fluctuations. Among them, the KF algorithm cannot make a self-adaptive adjustment according to the changes of the actual system model when the system model has been preset. The error-curve fluctuation of the UKF algorithm is less than that of the KF algorithm, because it restores the real-system model as much as possible by finding a Gaussian distribution close to the real distribution. However, with the inconsistency between the system model and the filter model, it is difficult to find a suitable Gaussian distribution to describe the system model, so the algorithm error increases. The RF algorithm proposed in this paper can identify and adaptively adjust the unknown input that causes the inaccuracy of the system model, so it can restore the accurate system model to the greatest extent.
At the same time, in the simulation conditions, the navigation sensor fails in 100 s–120 s. The error curve of the KF algorithm diverges rapidly after 100 s, indicating that it cannot work normally when the navigation sensor fails. The UKF algorithm determines the optimal gain matrix according to the covariance matrix of the filter and the covariance of the measured value, and then calculates the sampling points, which are determined by the state equation and the measurement equation. Therefore, it can adapt to the sudden change of the measurement information to a certain extent, but from the experimental results, it will still diverge in the case of continuous failure of the measurement information. The RF algorithm proposed in this paper can adaptively adjust the covariance matrix of the system measurement noise by detecting the fault measurement information, and finally ensure the accuracy of the navigation system when the navigation sensor fails.
It can also be seen from Table 3 and Table 4 that when the system model is inconsistent with the filter model and the navigation system measurement information is invalid, the root mean square error data of the attitude, position and velocity error of the Kalman algorithm are larger than those of the UKF algorithm. In the RF algorithm used in this paper, the root mean square error of the attitude, position and velocity are significantly lower than those of Kalman algorithm and UKF algorithm, mainly because the algorithm in this paper can independently identify, estimate and compensate the unknown inputs to the equation of state. At the same time, it can realize the adaptive estimation noise variance matrix of the measurement, which makes the system better in fault tolerance and stronger in robustness.

5. Conclusions

In this paper, we analyze and study the robustness filtering algorithm for the navigation system of the aerospace vehicle. As an aircraft that can fly across the dual fields of aviation and aerospace, the aerospace vehicle is gradually being valued by various countries. As an important part of its control loop, a high-precision and robust navigation system is indispensable. However, the main problem faced by navigation systems of the aerospace vehicle is difficulty in meeting the large dynamic and multi-task working mode of the aerospace vehicle. The existing navigation algorithms can only adapt to the situation in which the navigation system model and the filter model are consistent. When the models are inconsistent, the navigation accuracy drops faster. At the same time, complex working environments such as large dynamic flight may cause the star sensor to be unable to observe the stars, etc., effectively. The navigation system must be robust and fault-tolerant. Therefore, fault detection, isolation and reconstruction of measurement information are also required.
Aiming at the above problems, a multi-layer, fault-tolerant robust filtering algorithm for the aerospace vehicle navigation system in the launch inertial coordinate system is designed in this paper. Firstly, we find that the geographic coordinate system is obviously not suitable for the reference coordinate system of aerospace vehicle navigation calculation. Because the aerospace vehicle is different from the general aircraft flying near the ground—it needs to fly back and forth between space and ground—the flight has the characteristics of large dynamics. However, the existing algorithms using the geographic coordinate system as the reference coordinate system for navigation calculation usually use the simplified earth model, and the accuracy cannot meet the requirements of the aerospace vehicle navigation system. Therefore, we have established the navigation system model under the launch inertial coordinate system suitable for aerospace vehicles. On the one hand, we improved the accuracy of the navigation system by establishing an accurate earth model. On the other hand, we combined the characteristics of the navigation sensors configured by aerospace vehicles to reduce matrix conversion and improve the accuracy of the navigation system.
At the same time, most of the existing robust filtering algorithms consider the adaptive algorithm from the measurement equation of the system, but the inaccurate model in the system state equation will also reduce the robustness of the system. Therefore, we researched two parts: system state equation unknown input self-identification, self-compensation and measurement noise variance adaptation to design a multi-layer, fault-tolerant robust filter algorithm to improve the robustness of navigation system. Firstly, the inconsistency between the navigation system model and the filter model is regarded as an unknown input in the state equation and is calculated to be identified, compensated and corrected to meet the cross-airspace flight requirements of the aerospace vehicle and improve the accuracy of the navigation system. In addition, this paper solves the problem of maintaining the navigation accuracy of the navigation system in the case of a measurement-sensor failure by performing fault detection on the measurement information and adjusting adaptively the measurement noise variance matrix, which improves the fault tolerance and robustness of the navigation system. The experimental results verify the effectiveness of the algorithm in this paper. The algorithm proposed in this paper can adapt to the actual flight environment, improve the fault tolerance as well as the robustness of the aerospace vehicle navigation system, and provide a certain foundation for further research on the aerospace vehicle.
Combined with the actual navigation requirements of aerospace vehicles, this paper establishes the basic model of the integrated navigation system in launch inertial coordinate system, which solves the problem that the original simplified earth model in the geographic coordinate system is not suitable for the aerospace vehicle navigation system. In future research, we will combine the different flight characteristics of aerospace vehicles and carry out in-depth algorithm exploration around the engineering application of aerospace vehicles, so as to further improve the accuracy and reliability of its navigation system.

Author Contributions

Conceptualization, J.K.; methodology, J.K.; software, J.K. and Z.X.; validation, J.K. and Z.X.; data curation, J.K. and R.W.; writing—original draft preparation, J.K. and L.Z.; writing—review and editing, J.K. and Z.X.; All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by the National Natural Science Foundation of China (grant No. 61673208, 62073163, 61873125, 61533008, and 61533009), advanced research project of the equipment development (30102080101), Foundation Research Project of Jiangsu Province (The Natural Science Fund of Jiangsu Province, grant No. BK20181291, BK20170815, and BK20170767), the Fundamental Research Funds for the Central Universities (grant No. NZ2020004, NZ2019007), Foundation of Key Laboratory of Navigation, Guidance and Health-Management Technologies of Advanced Aerocraft (Nanjing University of Aeronautics and Astronautics), Ministry of Industry and Information Technology, Jiangsu Key Laboratory “Internet of Things and Control Technologies”, and the Priority Academic Program Development of Jiangsu Higher Education Institutions, Science and Technology on Avionics Integration Laboratory. Supported by the 111 Project (B20007). Supported by Shanghai Aerospace Science and Technology Innovation Fund (SAST2019-085, SAST2020-073), Introduction plan of high-end experts (G20200010142). The National Key Research and Development Program of China (Grant No. 2019YFA0706003). The author would like to thank the anonymous reviewers for helpful comments and valuable remarks.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Not applicable.

Conflicts of Interest

The authors declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.

References

  1. Succa, M.; Boscolo, I.; Drocco, A.; Malucchi, G.; Dussy, S. IXV avionics architecture: Design, qualification and mission results. Acta Astronaut. 2016, 124, 67–78. [Google Scholar] [CrossRef]
  2. Grantz, A. X-37B Orbital Test Vehicle and Derivatives. In Proceedings of the AIAA SPACE 2011 Conference & Exposition; AIAA SPACE Forum; American Institute of Aeronautics and Astronautics, Long Beach, CA, USA, 27–29 September 2011. [Google Scholar] [CrossRef] [Green Version]
  3. Gross, K.H.; Clark, M.A.; Hoffman, J.A.; Swenson, E.D.; Fifarek, A.W. Run-Time Assurance and Formal Methods Analysis Nonlinear System Applied to Nonlinear System Control. J. Aerosp. Inf. Syst. 2017, 14, 232–246. [Google Scholar] [CrossRef]
  4. Zhao, Y. Performance evaluation of Cubature Kalman filter in a GPS/IMU tightly-coupled navigation system. Signal Processing 2016, 119, 67–79. [Google Scholar] [CrossRef]
  5. Kuchynka, P.; Serrano, M.A.M.; Merz, K.; Siminski, J. Uncertainties in GPS-based operational orbit determination: A case study of the Sentinel-1 and Sentinel-2 satellites. Aeronaut. J. New Ser. 2020, 124, 888–901. [Google Scholar] [CrossRef]
  6. Gou, B.; Cheng, Y.M.; Ruiter, A. INS/CNS navigation system based on multi-star pseudo measurements. Aerosp. Sci. Technol. 2019, 95, 105506. [Google Scholar] [CrossRef]
  7. Wang, R.; Xiong, Z.; Liu, J.; Shi, L. A new tightly-coupled INS/CNS integrated navigation algorithm with weighted multi-stars observations. Proc. Inst. Mech. Eng. Part G J. Aerosp. Eng. 2015, 230, 698–712. [Google Scholar] [CrossRef]
  8. Xu, H.; Lian, B. Fault detection for multi source integrated navigation system using Fully Convolutional Neural Network. IET Radar Sonar Navig. 2018, 12, 774–782. [Google Scholar] [CrossRef]
  9. Wang, R.; Xiong, Z.; Liu, J.; Cao, Y. Resilient fusion navigation based on failure influence level evaluation. IET Radar Sonar Navig. 2019, 13, 721–729. [Google Scholar] [CrossRef]
  10. Cui, B.; Wei, X.; Chen, X.; Wang, A. Improved high-degree cubature Kalman filter based on resampling-free sigma-point update framework and its application for inertial navigation system-based integrated navigation. Aerosp. Sci. Technol. 2021, 117, 106905. [Google Scholar] [CrossRef]
  11. Gao, S.; Xue, L.; Zhong, Y.; Gu, C. Random weighting method for estimation of error characteristics in SINS/GPS/SAR integrated navigation system. Aerosp. Sci. Technol. 2015, 46, 22–29. [Google Scholar] [CrossRef]
  12. Bu, J.; Sun, R.; Bai, H.; Rui, X.; Fei, X.; Zhang, Y.; Ochieng, W.Y. A Novel Integrated Method for the UAV Navigation Sensor Anomaly Detection. IET Radar Sonar Navig. 2017, 11, 847–853. [Google Scholar] [CrossRef]
  13. Wang, L.; Cheng, X. Algorithm of gaussian sum filter based on high-order UKF for dynamic state estimation. Int. J. Control. Autom. Syst. 2015, 13, 652–661. [Google Scholar] [CrossRef]
  14. Urrea, C.; Rodrigo, M. Joints Position Estimation of a Redundant Scara Robot by Means of the Unscented Kalman Filter and Inertial Sensors. Asian J. Control. 2015, 18, 481–493. [Google Scholar] [CrossRef]
  15. Magree, D.; Johnson, E.N. Factored Extended Kalman Filter for Monocular Vision-Aided Inertial Navigation. J. Aerosp. Inf. Syst. 2016, 13, 475–490. [Google Scholar] [CrossRef]
  16. Wang, J.; Chen, Z. Variational Bayesian Iteration-Based Invariant Kalman Filter for Attitude Estimation on Matrix Lie Groups. Aerospace 2021, 8, 246. [Google Scholar] [CrossRef]
  17. Lim, J.; Shin, M.; Hwang, W. Variants of extended Kalman filtering approaches for Bayesian tracking. Int. J. Robust Nonlinear Control. 2017, 27, 319–346. [Google Scholar] [CrossRef]
  18. Chai, R.; Tsourdos, A.; Savvaris, A.; Chai, S.; Chen, C. Review of advanced guidance and control algorithms for space/aerospace vehicles. Prog. Aerosp. Sci. 2021, 122, 100696. [Google Scholar] [CrossRef]
  19. Madany, Y.M.; El-Badawy, E.; Ismail, N.; Soliman, A.M. Investigation and realisation of integrated navigation system using optimal pseudo sensor enhancement method. Radar Sonar Navig. IET 2019, 13, 839–849. [Google Scholar] [CrossRef]
  20. Colagrossi, A.; Lavagna, M. Fault Tolerant Attitude and Orbit Determination System for Small Satellite Platforms. Aerospace 2022, 9, 46. [Google Scholar] [CrossRef]
  21. Xiong, K.; Wei, C.L.; Liu, L.D. Robust multiple model adaptive estimation for spacecraft autonomous navigation. Aerosp. Sci. Technol. 2015, 42, 249–258. [Google Scholar] [CrossRef]
  22. Zheng, X.; Wu, H. Robust filtering algorithm against hybrid-attacks and randomly occurring nonlinearities: Application to a quadrotor UAV. Digit. Signal Processing 2021, 117, 103159. [Google Scholar] [CrossRef]
  23. Li, H.; Yan, L.; Xia, Y. Distributed Robust Kalman Filtering for Markov Jump Systems With Measurement Loss of Unknown Probabilities. IEEE Trans. Cybern. 2021. [Google Scholar] [CrossRef]
  24. Pan, C.; Li, Z.; Gao, J.; Li, F. A Variational Bayesian-Based Robust Adaptive Filtering for Precise Point Positioning Using Undifferenced and Uncombined Observations. Adv. Space Res. 2020, 67, 1859–1869. [Google Scholar] [CrossRef]
  25. Fu, H.; Yang, H.; Wen, X. Self-identification and self-calibration Kalman filtering method. J. Deep. Space Explor. 2019, 6, 5. [Google Scholar] [CrossRef]
  26. Teunissen, P.J.G. Batch and Recursive Model Validation. In Springer Handbook of Global Navigation Satellite Systems; Teunissen, P.J.G., Montenbruck, O., Eds.; Springer International Publishing: Cham, Switzerland, 2017; pp. 687–720. [Google Scholar] [CrossRef]
Figure 1. INS/CNS/GPS integrated navigation algorithm structure diagram in launch inertial coordinate system.
Figure 1. INS/CNS/GPS integrated navigation algorithm structure diagram in launch inertial coordinate system.
Aerospace 09 00282 g001
Figure 2. The conversion relationship between the launch inertial coordinate system and the J2000 inertial coordinate system.
Figure 2. The conversion relationship between the launch inertial coordinate system and the J2000 inertial coordinate system.
Aerospace 09 00282 g002
Figure 3. Multi-layer robust and fault-tolerant filter design structure.
Figure 3. Multi-layer robust and fault-tolerant filter design structure.
Aerospace 09 00282 g003
Figure 4. Flow chart of algorithm.
Figure 4. Flow chart of algorithm.
Aerospace 09 00282 g004
Figure 5. Simulation diagram of aerospace vehicle trajectory.
Figure 5. Simulation diagram of aerospace vehicle trajectory.
Aerospace 09 00282 g005
Figure 6. (a) Roll-angle error contrast curves; (b) Pitch-angle error contrast curves; (c) Yaw-angle error contrast curves. Angle-error contrast curves under the launch inertial coordinate system.
Figure 6. (a) Roll-angle error contrast curves; (b) Pitch-angle error contrast curves; (c) Yaw-angle error contrast curves. Angle-error contrast curves under the launch inertial coordinate system.
Aerospace 09 00282 g006
Figure 7. (a) X-axis position error contrast curves; (b) Y-axis position error contrast curves; (c) Z-axis position error contrast curves. Position error contrast curves under the launch inertial coordinate system.
Figure 7. (a) X-axis position error contrast curves; (b) Y-axis position error contrast curves; (c) Z-axis position error contrast curves. Position error contrast curves under the launch inertial coordinate system.
Aerospace 09 00282 g007
Figure 8. (a) X-axis velocity error contrast curves; (b) Y-axis velocity error contrast curves; (c) Z-axis velocity error contrast curves. Velocity error contrast curves under the launch inertial coordinate system.
Figure 8. (a) X-axis velocity error contrast curves; (b) Y-axis velocity error contrast curves; (c) Z-axis velocity error contrast curves. Velocity error contrast curves under the launch inertial coordinate system.
Aerospace 09 00282 g008
Table 1. Sensor simulation parameter setting.
Table 1. Sensor simulation parameter setting.
Noisy ObjectNoise TypeNoise ParametersUpdate Rate
GyroscopeRandom wanderDriven white noise mean square error 0.2°/h0.02 s
White Noise0.2°/h
AccelerometerSituation 1Driven white noise mean square error 1 × 10−4 g0.02 s
GPSWhite Noise5 m1 s
CNSWhite Noise5″1 s
Table 2. Fault parameters table.
Table 2. Fault parameters table.
ObjectFailure ParametersFailure Start TimeFailure End Time
Gyroscope Random wander4°/h30 s90 s
Accelerometer Random wander1 × 10−2 g30 s90 s
Condition AGPS15 m100 s120 s
CNS15″100 s120 s
Condition BGPS25 m100 s120 s
CNS25″100 s120 s
Table 3. Root mean square error data estimated by three algorithms (Condition A).
Table 3. Root mean square error data estimated by three algorithms (Condition A).
KFUKFRF
Roll (″)9.88478.74355.9599
Pitch (″)10.50088.18406.3841
Yaw (″)10.07259.03905.7409
X axis (m)17.02528.51084.4062
Y axis (m)12.63997.23462.4677
Z axis (m)9.14627.72292.5166
X axis (m/s)1.50300.78060.4771
Y axis (m/s)1.13770.70690.2559
Z axis (m/s)0.84020.78870.3756
Table 4. Root mean square error data estimated by three algorithms (Condition B).
Table 4. Root mean square error data estimated by three algorithms (Condition B).
KFUKFRF
Roll (″)9.89049.17616.8103
Pitch (″)19.02659.67346.3942
Yaw (″)10.33979.80927.1629
X axis (m)21.944912.01015.1014
Y axis (m)20.499510.23904.2343
Z axis (m)22.128311.38633.6555
X axis (m/s)1.60371.05800.7214
Y axis (m/s)1.48850.92940.4935
Z axis (m/s)1.51181.01290.4895
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Kang, J.; Xiong, Z.; Wang, R.; Zhang, L. Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System. Aerospace 2022, 9, 282. https://doi.org/10.3390/aerospace9060282

AMA Style

Kang J, Xiong Z, Wang R, Zhang L. Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System. Aerospace. 2022; 9(6):282. https://doi.org/10.3390/aerospace9060282

Chicago/Turabian Style

Kang, Jun, Zhi Xiong, Rong Wang, and Ling Zhang. 2022. "Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System" Aerospace 9, no. 6: 282. https://doi.org/10.3390/aerospace9060282

APA Style

Kang, J., Xiong, Z., Wang, R., & Zhang, L. (2022). Multi-Layer Fault-Tolerant Robust Filter for Integrated Navigation in Launch Inertial Coordinate System. Aerospace, 9(6), 282. https://doi.org/10.3390/aerospace9060282

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