Next Article in Journal
Comprehensive Detection of Gas Plumes from Multibeam Water Column Images with Minimisation of Noise Interferences
Next Article in Special Issue
Location Accuracy of INS/Gravity-Integrated Navigation System on the Basis of Ocean Experiment and Simulation
Previous Article in Journal
ECG Signal De-noising and Baseline Wander Correction Based on CEEMDAN and Wavelet Threshold
Previous Article in Special Issue
Stochastic Integration H Filter for Rapid Transfer Alignment of INS
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Novel Adaptive H∞ Filtering Method with Delay Compensation for the Transfer Alignment of Strapdown Inertial Navigation Systems

1
School of Instrument Science & Engineering, Southeast University, Nanjing 210096, China
2
Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Southeast University, Nanjing 210096, China
*
Author to whom correspondence should be addressed.
Sensors 2017, 17(12), 2753; https://doi.org/10.3390/s17122753
Submission received: 9 September 2017 / Revised: 8 November 2017 / Accepted: 23 November 2017 / Published: 28 November 2017
(This article belongs to the Special Issue Inertial Sensors for Positioning and Navigation)

Abstract

:
Transfer alignment is always a key technology in a strapdown inertial navigation system (SINS) because of its rapidity and accuracy. In this paper a transfer alignment model is established, which contains the SINS error model and the measurement model. The time delay in the process of transfer alignment is analyzed, and an H∞ filtering method with delay compensation is presented. Then the H∞ filtering theory and the robust mechanism of H∞ filter are deduced and analyzed in detail. In order to improve the transfer alignment accuracy in SINS with time delay, an adaptive H∞ filtering method with delay compensation is proposed. Since the robustness factor plays an important role in the filtering process and has effect on the filtering accuracy, the adaptive H∞ filter with delay compensation can adjust the value of robustness factor adaptively according to the dynamic external environment. The vehicle transfer alignment experiment indicates that by using the adaptive H∞ filtering method with delay compensation, the transfer alignment accuracy and the pure inertial navigation accuracy can be dramatically improved, which demonstrates the superiority of the proposed filtering method.

1. Introduction

A strapdown inertial navigation system (SINS) needs to complete initial alignment before it begins to work [1]. The purpose of the initial alignment is to make the SINS’s mathematical platform be consistent with the selected navigation coordinate system [2], and consequently a suitable initial navigation coordinate system can be established. In the process of initial alignment, high alignment accuracy and fast alignment speed are two important factors that directly affect the practical performance of the SINS [3].
As an important method of initial alignment, transfer alignment has been widely used in various applications such as aircraft, ships and vehicles, because of its speed and high accuracy [4]. In [5,6] an innovative transfer alignment method based on parameter identification UKF and an innovative transfer alignment method based on federated filter were respectively designed for an airborne distributed Position and Orientation System (POS). Shortelle and Graham [7] conducted a series of rapid transfer alignment experiments on F-16 fighters. In [4] a method based on iterative calculation for fast and high-accuracy transfer alignment between master SINS (M-SINS) and slave SINS (S-SINS) for ships was proposed. Lim and Lyou [8] designed an error compensation method based on state augmentation and robust state estimation to reduce the transfer alignment errors on ships. The S-SINS makes full use of accurate attitude, velocity and position information of M-SINS to set its initial parameters, and it can complete the alignment in a short period of time. In the whole navigation system, M-SINS and S-SINS are in different spatial positions. When M-SINS transmits the baseline information to S-SINS, there inevitably exists a time delay. The time delay between M-SINS and S-SINS can lead to large alignment errors during the period of transfer alignment [9]. Liu et al. [10] analyzed the effect of time delay on velocity matching transfer alignment under different maneuvering conditions. In [11] the delay time was extended to the system state model and it could be estimated through the Kalman filter, but this method increases the filtering computation and the estimation accuracy is limited, so it is necessary to develop a new method to accurately estimate and compensate the time delay.
Transfer alignment needs to use filtering technology to estimate online the S-SINS’s misalignment angles, and the attitude matrix can be effectively corrected at the end of alignment [12,13,14,15,16,17,18]. When the base is moving, there exist interference factors such as external noises or motion disturbances, which can decrease the accuracy of a S-SINS’s transfer alignment [19,20].
The traditional Kalman filter requires an accurate system mathematical model and detailed information on the statistical properties of the signal [19,20,21,22,23], but in practical applications, the statistical characteristics of signals are not accurate, and the system model itself also has some indetermination, so there is uncertainty in the system [20,21,22,24,25,26,27]. When the uncertainty reaches a certain extent, the estimation accuracy of the Kalman filter will be reduced, and Kalman filter may even have divergence problems in serious cases [20]. Comparatively, the H∞ filter is not based on any assumption about the frequency spectrum characteristics of the signal, and it has better robustness than the Kalman filter [20,22,23,24,25,26,27,28,29,30,31,32]. In the H∞ filter, the H∞ norm is introduced to the filtering problem, and a filter is designed to ensure the minimum norm from disturbance input to filter error output [20,23]. The estimation errors of states can be minimized in the worst cases of disturbance. The H∞ filter can be considered as the optimal filter when the system sustains serious disturbances, and filtering robustness is its most prominent characteristic [30,31,32]. Due to the above advantages, the H∞ filter is more suitable than the Kalman filter for transfer alignment on a moving base. Lim and Lyou [13] designed a transfer alignment error compensation method based on H∞ filter to reduce the alignment errors caused by time delay and ship body flexure. In [20] an H∞ optimization method was used to conduct transfer alignment, which estimated the misalignment angle and improved the standard Kalman filter performance when the system noises were not fully known. Gao et al. [19] devised a robust adaptive filter, which lowered the requirement for precise kinematic and observation models for transfer alignment compared with a traditional Kalman filter. By adding robust elements in the filtering process, the influence caused by systematic model errors and the disturbances of dynamic external environment can be effectively reduced [20,22,23,24,25,26,27,28,29,30,31,32].
In this paper, the transfer alignment system model is established in detail and the measurement of velocity matching is adopted. Then the time delay is analyzed and an H∞ filtering method with delay compensation is presented. In order to improve the transfer alignment accuracy of H∞ filtering method with delay compensation, an adaptive H∞ filtering method with delay compensation is devised. The new filtering method can adaptively adjust the robustness factor according to the dynamic external environment. Vehicle transfer alignment experiments verified the effectiveness of the proposed method and the alignment accuracy is dramatically improved.
The rest of this paper is organized as follows: the transfer alignment model containing SINS error dynamics model and measurement model is established in Section 2. In Section 3, an adaptive H∞ filter method with delay compensation for SINS’s transfer alignment is designed and analyzed in detail. In Section 4, vehicle transfer alignment experiment is carried out to verify the effectiveness of the proposed method. Finally, conclusions are drawn in Section 5.

2. Transfer Alignment Model

2.1. SINS Error Dynamics Model

In this paper, “East-North-Up (ENU)” is defined as the navigation frame, and “Right-Forward-Up” is defined as the body frame. The SINS processes the output of inertial components based on the mathematical equations to obtain the navigation data [2]. Although the various types of system mathematical equations are not identical, they all come from the same equation, the specific force equation. Specific force equation describes the analytical relationship between the accelerometer output and the carrier’s velocity [13,16], it can be expressed in the navigation frame n as follows:
V ˙ n = f n ( 2 ω i e n + ω e n n ) × V n + g n
where V n is the carrier’s velocity; V ˙ n is the derivative of carrier’s velocity; f n is the specific force, which can be measured by the accelerometer; ω i e n is the Earth’s rotation rate; ω e n n is the angular rate of the earth frame relative to the navigation frame; ( 2 ω i e n + ω e n n ) × V n is the harmful acceleration caused by the Earth rotation and the rotation caused by the carrier’s translational movement; g n is the acceleration of gravity.
The attitude angle error of SINS is influenced by instruction angular velocity and gyro bias. Besides, gyro bias causes the growth of attitude angle error in the opposite direction. The attitude error equation in the navigation frame n can be expressed as follows [3,13]:
ϕ ˙ = ϕ × ω i n n + δ ω i n n ε n
where ϕ is attitude angle error; ϕ ˙ is the derivative of attitude angle error; ω i n n is the angular rate of the inertial frame relative to the navigation frame; δ ω i n n is the derivative of ω i n n ; ε n is the gyro bias.
In system equations, the accelerometer bias and the gyro bias are assumed not to change over time, thus:
˙ n = 0
ε ˙ n = 0
The model used in Equations (3) and (4) is a model of a random constant which corresponds to a model of an exponentially correlated process when time goes to be endless. In the model of transfer alignment, 10 dimensions’ states are selected to establish the equation of states. The system’s states can be expressed as follows:
X ( t ) = [ δ V e , δ V n , ϕ e , ϕ n , ϕ u , x , y , ε x , ε y , ε z ] T
where δVe and δVn are the east velocity error and north velocity error respectively in the navigation frame; φe, φn, φu are the east misalignment angle, north misalignment angle, azimuth misalignment angle respectively in the navigation frame; ∇x, ∇y are the right-axis and forward-axis accelerometer bias respectively in the body frame; εx, εy, εz are the right-axis, forward-axis, up-axis gyro bias respectively in the body frame.
Thus, the system’s state equation can be expressed as follows:
X ˙ ( t ) = F ( t ) X ( t ) + W ( t )
where X ( t ) is (n × 1) state estimate, X ˙ ( t ) is (n × 1) one step predicted state, variable W ( t ) is zero mean Gaussian white noise. F ( t ) is (n × n) state transition matrix, it can be expressed in concrete formulas as:
F ( t ) = [ V n R M t g L 2 ω i e sin L + V e R N t g L 0 f u f n T 11 T 12 0 0 0 2 ( ω i e sin L + V e R N t g L ) 0 f u 0 f e T 21 T 22 0 0 0 0 1 R M 0 ω i e sin L + V e R N t g L ( ω i e cos L + V e R N ) 0 0 T 11 T 12 T 13 1 R N 0 ω i e sin L V e R N t g L 0 V n R M 0 0 T 21 T 22 T 23 t g L R N 0 ω i e cos L + V e R N V n R M 0 0 0 T 31 T 32 T 33 0 5 × 10 ]
where fe, fn and fu are east component, north component and up component of the specific force respectively; Ve and Vn are the east velocity and north velocity respectively; RM is radius of curvature in meridian and RN is radius of curvature in prime vertical; L is the latitude; ωie is the earth rotation rate. The S-SINS attitude matrix is defined as C b n = [ T i j ] 3 × 3 .

2.2. Measurement Model

In the model of transfer alignment, velocity differences between M-SINS and S-SINS are adopted as measurement [15]. Therefore, the measurement of velocity matching can be calculated as follows:
Y ( t ) = [ Y E Y N ] = [ V ˜ E s V E m V ˜ N s V N m ]
where Y ( t ) is velocity measurement at time k; Y E is east velocity measurement component and Y N is north velocity measurement component; V ˜ E s and V E m are the S-SINS’s east velocity and M-SINS’s east velocity respectively; V ˜ N s and V N m are the S-SINS’s north velocity and M-SINS’s north velocity respectively.
The system’s measurement equation can be expressed as follows:
Y ( t ) = H ( t ) X ( t ) + V ( t )
where V(t) is measurement noise, H(t) is measurement matrix and
H ( t ) = [ 1 0 0 0 0 0 0 0 0 0 0 1 0 0 0 0 0 0 0 0 ] .

3. Adaptive H∞ Filtering Method with Delay Compensation

3.1. Analysis of Time Delay

M-SINS transfers the relevant baseline information to S-SINS during the period of transfer alignment [11]. As shown in Figure 1, tf is the moment when M-SINS begins to send the baseline information, tc is the moment when S-SINS receives the baseline information from M-SINS, and tdelay is equal to tctf, which represents the delay time. S-SINS has time delay problem when receiving the baseline information from M-SINS. The time delay can be caused by the inconsistency of startup time, the existence of transmission delays or the reaction time during the sensors’ processing. The error resulted from time delay reduces the accuracy of baseline information [9]. If we use the unmatched measurement information between M-SINS and S-SINS to conduct filtering, the accuracy of filtering estimation will be affected, which further affects the performance of transfer alignment [10,14]. Therefore, it is necessary to estimate and compensate the delay time to implement the time synchronization between M-SINS and S-SINS.
In this paper, a time delay estimation method based on attitude characteristics is proposed. The time delay will result in attitude error between M-SINS and S-SINS [14]. For a short period of time after the M-SINS and S-SINS begin to work, the impact factors of sensor errors and flexure deformation are small. Therefore, the attitude error is mainly caused by time delay. In the time delay estimation method based on attitude characteristics, the initial attitude data of M-SINS and S-SINS in the period t0 are recorded. The length of initial attitude data is represented as N. Then the range of time delay should be defined according to the condition of the actual system. After that the attitude data of S-SINS should be shifted point by point within the range of time delay. At each of the shift point, the sum of attitude error squares between M-SINS and S-SINS is calculated, it can be expressed as follows:
S u m ( n ) = i = n + 1 N { [ H M ( i ) H S ( i n ) ] 2 + [ P M ( i ) P S ( i n ) ] 2 + [ R M ( i ) R S ( i n ) ] 2 }
where n is shift point; HM, PM, RM are heading angle, pitch angle and roll angle of M-SINS respectively; HS, PS, RS are heading angle, pitch angle and roll angle of S-SINS, respectively.
After calculating the sum of attitude errors’ squares at each of the shift point, the minimum values of the sum of attitude errors’ squares can be determined as follows:
S u m ( n min ) = min S u m ( n )
where nmin is the minimum shift point.
And the delay time τ of S-SINS can be expressed as follows:
τ = T S I N S n min
where TSINS is the attitude updating cycle of S-SINS.

3.2. H∞ Filtering Method with Delay Compensation

3.2.1. H∞ Filtering Theory with Delay Compensation

As shown in Section 2, we consider the following random linear discrete-time system in Krein space [29]:
X k = Φ k , k 1 X k 1 + W k 1
Y k = H k X k + V k
In general, we need to estimate some arbitrary linear combination of the state, it can be shown as [25]:
Z k = L k X k
where Lk is (n × n) matrix, Zk is (n × 1) measurement matrix. We can use Zk to expand observed state of Yk and the equations below are obtained:
X k = Φ k , k 1 X k 1 + W k 1
[ Y k Z k ] = [ H k L k ] X k + V k
In the above equations Wk−1 and V k are noise with bounded energy, and we do not make assumptions about their statistical properties. Then X0, Wk−1 and V k satisfy the following relationships:
[ X 0 W j 1 V j ] , [ X 0 W k 1 V k ] = [ P 0 0 0 0 I δ j k 0 0 0 R k δ j k ]
where:
R k = [ I 0 0 ξ 2 I ] δ j k
In Equation (19), δjk is Kronecker function, i.e., δ j k = { 0 ( k j ) 1 ( k = j ) ; ξ is robust factor of H∞ filter.
As an indefinite covariance matrix in H∞ filter, matrix R k is a diagonal matrix. When ξ tends to infinity (ξ→∞), H∞ filter degenerates to standard Kalman filter. This means that H∞ norm is very big in Kalman filter and the robustness of Kalman filter is bad compared with H∞ filter.
Define:
Z ^ k = F f ( Y 0 , Y 1 , , Y k )
It means the estimation of Zk in the condition of given observation value Yk, the filtering error can be defined as follows:
e k = Z ^ k L k X k
Define Tk(Ff) as the transfer function from unknown disturbance { ( X 0 X ^ 0 ) , W k , V k , k [ 0 , ) } to filtering error { e k , k [ 0 , ) } , then the H∞ filter problem can be described as follows:
Definition 1 (Optimal H∞ filter problem).
Find the optimal estimation of H∞ filter to minimize ‖Tk(Ff)‖, that is [26]:
ξ 2 = inf F f T k ( F f ) 2 = inf F f sup X 0 , W h 2 , V h 2 e k 2 2 X 0 X ^ 0 P 0 1 2 + W k 2 2 + V k 2 2
In the above equation, P0 is a positive definite matrix. Symbol “inf” is the infimum of function and symbol “sup” is the supremum of function. Optimal H∞ filter ensures the minimized energy gain of estimation error for all possible input with certain energy. However, the result is too conservative, and the definition of suboptimal H∞ filter problem is given below.
Definition 2 (Suboptimal H∞ filter problem).
When given a positive number ξ > 0, find suboptimal H∞ estimation to satisfy ‖Tk(Ff)‖ < ξ, that is [25,29]:
inf F f T k ( F f ) 2 = inf F f sup X 0 , W h 2 , V h 2 e k 2 2 X 0 X ^ 0 P 0 1 2 + W k 2 2 + V k 2 2 ξ 2
Theorem 1 (Suboptimal H∞ filter problem).
When given a positive number ξ > 0, if [Φk,k−1 Γk,k−1] is full rank, then the condition that there is a filter satisfying ‖Tk(Ff)‖ < ξ is if and only if [23]
P k 1 + H k T H k ξ 2 L k T L k > 0
In the above equation, Pk satisfies the recurrent Riccati equation:
P k = Φ k , k 1 P k 1 Φ k , k 1 T + Γ k , k 1 Γ k , k 1 T Φ k , k 1 P k 1 [ H k T L k T ] R e , k 1 [ H k L k ] P k 1 Φ k , k 1 T
In Equation (25):
R e , k = [ I 0 0 ξ 2 I ] + [ H k L k ] P k 1 [ H k T L k T ]
Taking into account the effect of time delay, the recursive equations of H∞ filter can be expressed as follows:
X ^ k τ , k τ 1 = Φ k τ , k τ 1 X ^ k τ 1
R e , k τ 1 = [ I 0 0 ξ 2 I ] + [ H k τ 1 L k τ 1 ] P k τ 1 [ H k τ 1 T L k τ 1 T ]
P k τ = Φ k τ , k τ 1 P k τ 1 Φ k τ , k τ 1 T Φ k τ , k τ 1 P k τ 1 [ H k τ 1 T L k τ 1 T ] R e , k τ 1 1 [ H k τ 1 L k τ 1 ] P k τ 1 Φ k τ , k τ 1 T + Γ k τ 1 Γ k τ 1 T
K k τ = P k τ H k τ T ( I + H k τ P k τ H k τ T ) 1
X ^ k τ = X ^ k τ , k τ 1 + K k τ ( Y k τ H k τ X ^ k τ , k τ 1 )
According to the above recursive equations, the estimation result is the system error state X ^ T P τ at the moment TP−τ, where TP is the current moment, τ is the delay time of the system. So when the filtering estimation process is completed, the system error state should be converted to the current moment TP. Define THF-D as the update cycle of H∞ Filter with delay compensation, the system error state at the current moment can be expressed as follows:
X ^ T P = e F ( T P [ τ / T SIN S ] T SIN S ) T H F - D X ^ T P τ

3.2.2. Robust Mechanism Analysis of H∞ Filtering Theory

Next the detailed analysis on the robust mechanism of H∞ filtering theory is presented. By organizing Pk−τ in Equation (28), the following equation can be obtained:
P k = Φ k , k 1 ( I P k 1 [ H k T L k T ] ( [ I 0 0 ξ 2 I ] + [ H k L k ] P k 1 [ H k T L k T ] ) 1 [ H k L k ] ) P k 1 Φ k , k 1 T + Γ k , k 1 Γ k , k 1 T
Define:
J , k = P k 1 [ H k T L k T ] ( [ I 0 0 ξ 2 I ] + [ H k L k ] P k 1 [ H k T L k T ] ) 1
Then:
P k = Φ k , k 1 ( I J , k [ H k L k ] ) P k 1 Φ k , k 1 T + Γ k , k 1 Γ k , k 1 T
Next J , k in Equation (34) is simplified as follows:
J , k = P k 1 [ H k T L k T ] ( [ H k L k ] P k 1 [ H k T L k T ] + [ I 0 0 ξ 2 I ] ) 1 = [ P k 1 H k T P k 1 L k T ] [ I + H k P k 1 H k T H k P k 1 L k T L k P k 1 H k T ξ 2 I + L k P k 1 L k T ] 1
According to the inverse theorem of partitioned matrix, we define:
α 11 = I + H k P k 1 H k T α 12 = H k P k 1 L k T α 21 = L k P k 1 H k T α 22 = ξ 2 I + L k P k 1 L k T
Let:
α 1 = [ β 11 β 12 β 21 β 22 ]
where β 22 = ( α 22 α 21 α 11 1 α 12 ) 1 , β 12 = α 11 1 α 12 β 22 , β 21 = β 22 α 21 α 11 1 , β 11 = α 11 1 β 12 α 21 α 11 1 .
Then:
J , k = [ P k 1 H k T P k 1 L k T ] [ β 11 β 12 β 21 β 22 ] = [ P k 1 H k T β 11 + P k 1 L k T β 21 P k 1 H k T β 12 + P k 1 L k T β 22 ]
Here we define J∞,k = [JP JQ] and bring α 11 , α 12 , α 21 and α 22 into Equation (39). Firstly, JP can be simplified as follows:
J P = P k 1 H k T β 11 + P k 1 L k T β 21 = P k 1 H k T ( α 11 1 β 12 α 21 α 11 1 ) + P k 1 L k T ( β 22 α 21 α 11 1 ) = P k 1 H k T ( I + H k P k 1 H k T ) 1 + P k 1 ( H k T α 11 1 α 12 L k T ) ( α 22 α 21 α 11 1 α 12 ) 1 L k P k 1 H k T ( I + H k P k 1 H k T ) 1 .
Define J S , k = P k 1 H k T ( I + H k P k 1 H k T ) 1 , then Equation (40) can be simplified as:
J P = J S , k + P k 1 ( H k T α 11 1 α 12 L k T ) ( α 22 α 21 α 11 1 α 12 ) 1 L k J S , k = [ I + P k 1 ( H k T α 11 1 α 12 L k T ) ( α 22 α 21 α 11 1 α 12 ) 1 L k ] J S , k = { I + ( J S , k H k I ) P k 1 L k T [ ξ 2 I + L k ( I J S , k H k ) P k 1 L k T ] 1 L k } J S , k
Define ϒ k = ( I J S , k H k ) P k 1 , then Equation (41) can be described as:
J P = [ I ϒ k L k T ( ξ 2 I + L k ϒ k L k T ) 1 L k ] J S , k
and we define G k = ϒ k L k T ( ξ 2 I + L k ϒ k L k T ) 1 L k , thus Equation (42) can be described as:
J P = ( I G k ) J S , k
Secondly, we can simplify JQ in the similar way as follows:
J Q = P k 1 H k T β 12 + P k 1 L k T β 22 = [ I P k 1 H k T ( I + H k P k 1 H k T ) 1 H k ] P k 1 L k T [ ξ 2 I + L k ( I P k 1 H k T ( I + H k P k 1 H k T ) 1 H k ) P k 1 L k T ] 1 = ϒ k L k T ( ξ 2 I + L k ϒ k L k T ) 1
After carrying out the simplification operation above, Equations (43) and (44) are brought into J∞,k = [JP JQ], then Equation (35) can be represented as follows:
P k = Φ k , k 1 ( I [ ( I G k ) J S , k ϒ k L k T ( ξ 2 I + L k ϒ k L k T ) 1 ] [ H k L k ] ) P k 1 Φ k , k 1 T + Γ k , k 1 Γ k , k 1 T = Φ k , k 1 P k 1 Φ k , k 1 T Φ k , k 1 [ ( I G k ) J S , k H k + G k ] P k 1 Φ k , k 1 T + Γ k , k 1 Γ k , k 1 T
Taking the effect of time delay into consideration, the H∞ filter recurrence equations which are simplified by decomposition of matrix can be expressed as follows:
X ^ k τ , k τ 1 = Φ k τ , k τ 1 X ^ k τ 1
J S , k τ = P k τ 1 H k τ T ( I + H k τ P k τ 1 H k τ T ) 1
ϒ k τ = ( I J S , k τ H k τ ) P k τ 1
G k τ = ϒ k τ L k τ T ( ξ 2 I + L k τ ϒ k τ L k τ T ) 1 L k τ
P k τ = Φ k τ , k τ 1 P k τ 1 Φ k τ , k τ 1 T Φ k τ , k τ 1 [ ( I G k τ ) J S , k τ H k τ + G k τ ] P k τ 1 Φ k τ , k τ 1 T + Γ k τ , k τ 1 Γ k τ , k τ 1 T
J k τ = P k τ H k τ T ( H k τ P k τ H k τ T + I ) 1
X ^ k τ = X ^ k τ , k τ 1 + J k τ ( Y k τ H k τ X ^ k τ , k τ 1 )
As the estimation result of the above recursive equations is the system error state X ^ T P τ at the moment TP−τ. The system error state should be converted to the current moment TP when the filtering estimation process is completed, and it can be expressed as follows:
X ^ T P = e F ( T P [ τ / T SIN S ] T SIN S ) T H F D X ^ T P τ

3.3. Adaptive H∞ Filtering Method with Delay Compensation

In the H∞ filter with delay compensation, the robustness factor ξ plays an important role in filtering accuracy, robustness and stability [24]. When the value of the robustness factor ξ is too small, the system has better robustness but the filtering accuracy of the system is too low. When the value of the robustness factor ξ is too big, the system has worse stability and even leads to divergence. Therefore, the value of the robustness factor ξ has a direct effect on the performance of H∞ filter with delay compensation. In most cases, the value of the robustness factor ξ needs to be debugged over and over again before using H∞ filter with delay compensation, and eventually the robustness factor ξ of the H∞ filter with delay compensation is often determined according to actual engineering experience. This takes a lot of time and the selected value of ξ is always not optimal. Moreover, it cannot be guaranteed that when the filtering estimation error is small, the system also has good robustness at the same time. If there exist large disturbances in the transfer alignment system for some moment, the filter may be unable to improve the robustness because of the fixed robustness factor ξ, so the filtering estimation error will increase under the uncertain external environment. To solve the problem, an adaptive optimization method of the robustness factor ξ is proposed in this paper to improve the performance of H∞ filter with delay compensation.
During the period of transfer alignment, when the H∞ filter with delay compensation diverges, the error covariance matrix is unbounded and the real estimation error is bigger than the theoretical estimation error [19]. Therefore, we can evaluate the performance of H∞ filter with delay compensation by using filter innovation η k τ . It is well known that filter innovation η k τ can be expressed as follows:
η k τ = Y k τ H k τ X ^ k τ / k τ 1
Based on Equation (54), the quadratic sum of innovation sequence can be expressed as η k τ T η k τ , which reflects the real estimation error of filtering [21]. The theoretical prediction error can be described by the innovation sequence’s variance E [ η k τ T η k τ ] . Under ideal conditions, the filter innovation is zero mean Gaussian white noise sequence, but in real systems, both the changes of system model and the anomaly of observed values can cause the change on statistical properties of innovation sequence [24]. When the value of η k τ T η k τ is too big, it means that the performance of the filter degrades, even with the possibility of divergence [21]. Thus the robustness of the adaptive H∞ filter with delay compensation is of great importance at the moment, and the value of the robustness factor ξ should be reduced to compensate the large error which is generated by η k τ T η k τ . When the value of η k τ T η k τ is too small, it means that the transfer alignment system suffers fewer external disturbances, so the value of the robustness factor ξ can be increased to improve the filtering accuracy, and the robustness of the filter should be reduced properly at that moment. During the whole process of transfer alignment, the robustness factor ξ of the adaptive H∞ filter with delay compensation varies inversely with respect to η k τ T η k τ .
Theorem 2.
Assume that P and Q are two n-order Hermite matrices, P > 0, Q ≥ 0, then P > Q is equal to λ max ( Q P 1 ) < 1 [33]. Here λmax(P) represents the maximum eigenvalue of matrix P.
According to the Theorem 2, we can transform the conditional Equation (24) of H∞ filter with delay compensation to the following form:
ξ 2 > λ max ( L k τ T L k τ ( P k τ 1 + H k τ T H k τ ) 1 )
and the value of ξ can be expressed as follows:
ξ = ( 1 + υ ) [ λ max ( L k τ T L k τ ( P k τ 1 + H k τ T H k τ ) 1 ) ] 1 / 2
In the above equation, coefficient υ > 0. Because the value of ξ is inversely proportional to η k τ T η k τ , we can make υ and η k τ T η k τ satisfy the following relationship:
υ = κ η k τ T η k τ N
where κ is correlation coefficient and κ > 0, the value of κ can be determined by the experiment of the real system. N is the dimension of the filtering states. For a specific real system, once the values of κ and N are determined, respectively, they will not change any more. In this case, the value of coefficient υ is only related to filter innovation during the process of transfer alignment. When filter innovation increases, the value of coefficient υ decreases, so the robust factor ξ of adaptive H∞ filter with delay compensation will be decreased to improve the robustness of the transfer alignment system. On the contrary, when filter innovation decreases, the value of coefficient ν increases, so the robustness factor ξ of the adaptive H∞ filter with delay compensation will be increased to improve the estimation accuracy of transfer alignment system. Therefore, the relationship between the robustness factor ξ of the adaptive H∞ filter with delay compensation and η k τ T η k τ can be established, and the value of the robustness factor ξ will change dynamically as the filter innovation η k τ changes.
By comparing the adaptive H∞ filter with delay compensation and the H∞ filter with delay compensation, it can be seen that both methods are able to satisfy Equation (24). However, the robustness factor ξ of the adaptive H∞ filter with delay compensation is dynamically adjusted according to the value of filter innovation η k τ . Compared with the H∞ filter with delay compensation, the adaptive H∞ filter with delay compensation can adjust the robustness factor ξ adaptively with the change of the real system environment. As a result, the filtering estimation accuracy and robustness of the transfer alignment system can be optimized by using the proposed filtering method.

4. Experimental Results and Discussions

4.1. Experimental Settings

In order to verify the adaptive H∞ filtering method with delay compensation, a vehicle transfer alignment experiment in a real system is conducted. The real vehicle experiment is carried out in Beijing in a wide-open area. The specific location of this experiment is determined as east longitude 116° and north latitude 39°. The transfer alignment system contains M-SINS, S-SINS and navigation computer, which are connected by communication lines. The position of both M-SINS and S-SINS is kept strictly fixed in the experimental vehicle. The update frequencies for M-SINS and S-SINS are all set as 200 Hz. The strapdown algorithm update cycle is 5 ms. The three-axis gyro biases of S-SINS are 0.6 °/h, and the three-axis accelerometer biases of S-SINS are 0.2 mg. The reference baseline information is provided by M-SINS in the process of transfer alignment, and the sensor parameters of M-SINS are far better than those of S-SINS. The flow chart of transfer alignment based on adaptive H∞ filtering method with delay compensation is presented is shown in Figure 2.
Firstly, the transfer alignment system takes 6 s to estimate the time delay. After the time delay estimation, the system takes 234 s to conduct the transfer alignment on a moving base. Then the S-SINS of transfer alignment system begins 600 s’ pure inertial navigation. In the whole process, the navigation computer records the output data of M-SINS and S-SINS which is transmitted through the communication lines in real time. The movement trajectory of the vehicle transfer alignment experiment is presented in Figure 3. During the period of time delay estimation, transfer alignment and pure inertial navigation, the M-SINS’s attitude curves of heading, pitch and roll are as shown in Figure 4.
Due to the existence of the time delay between M-SINS and S-SINS, it takes a time delay τ to transmit the M-SINS’s baseline information to the S-SINS. Thus at the same moment the S-SINS’s attitudes of heading, pitch and roll are ahead of M-SINS’s attitudes in the navigation computer. The attitude curves of M-SINS and S-SINS from 60 s to 65 s in the period of transfer alignment experiment are presented in Figure 5, Figure 6 and Figure 7. Because the S-SINS just starts to work, the influence of S-SINS’s gyro bias and S-SINS’s accelerometer bias is not very big. The attitudes calculated by the S-SINS look similar to the M-SINS’s attitudes. As time goes on, however, the influence of S-SINS’s sensor parameters become more and more significant.
It can be seen from the figures that during the transfer alignment experiment, the S-SINS’s attitudes of heading, pitch and roll are approximately 0.24 s ahead of M-SINS’s attitudes, which have a negative effect on the transfer alignment accuracy. Therefore, the time delay needs to be effectively estimated and compensated during the transfer alignment process.

4.2. Experimental Results and Discussions

In the vehicle transfer alignment experiment, the robustness factor ξ of H∞ filter is largely related to the transfer alignment accuracy. The different values of the robustness factor ξ can produce different alignment results. It is known that the more accurate the transfer alignment is, the higher the navigation accuracy is, so the different values of the robustness factor ξ can result in different navigation accuracy of the S-SINS.
Figure 8 shows the influence of the robustness factors ξ on the navigation accuracy of the vehicle experiment. It can be seen that when the robustness factor ξ is 1.5, the position error is about 461 m. But when the robustness factor ξ is 29.5, the position error is about 905 m. Different robustness factor ξ values can lead to big differences of the position errors in the process of vehicle experiment. Therefore, the selected value of the robustness factor ξ is important for the H∞ filter performance.
If the value of the robustness factor ξ is adjusted dynamically in the filtering process according to the filter innovation, the transfer alignment accuracy can be improved dramatically. Thus an adaptive H∞ filtering method with delay compensation is proposed in this paper, the value of the robustness factor ξ in the adaptive H∞ filter can be adjusted dynamically according to the external environment. Figure 9 shows the value of ξ in the adaptive H∞ filtering method with delay compensation in the vehicle transfer alignment experiment.
The curve in Figure 9 indicates that during the process of transfer alignment, the robustness factor ξ changes adaptively with the real system environment. When the real system environment changes dramatically, the filter innovation increases, and the robustness factor ξ will be decreased to improve the robustness of the real system. When the real system environment changes slowly, the filter innovation decreases, and the robustness factor ξ will be increased to improve the estimation accuracy of the real system. Therefore, the robustness factor ξ is adjusted dynamically with the change of real system environment, which can provide the optimal estimation for the transfer alignment experiment.
With the purpose of comparing the performance of different filtering methods, the H∞ filter without delay compensation, the H∞ filter with delay compensation and the adaptive H∞ filter with delay compensation are respectively used in the process of transfer alignment experiment. The robust factor ξ of H∞ filter is set as 4.36, which is the optimal robust factor of H∞ filter in this vehicle transfer alignment experiment. The estimation curves of east misalignment angle, north misalignment angle and azimuth misalignment angle using the mentioned filtering algorithms are presented in Figure 8, Figure 9 and Figure 10.
In the figures, the blue lines represent the estimation curves of the H∞ filter without delay compensation (“w/” denotes “with”, “w/o” denotes “without”, ”CP” denotes “compensation”), the green lines represent the estimation curves of the H∞ filter with delay compensation, and the red lines represent the estimation curves of the adaptive H∞ filter with delay compensation. In Figure 10, the estimation curves of φE converge to steady values after 175 s’ transfer alignment experiment. But it can be seen that by using the adaptive H∞ filtering method with delay compensation, the estimation value of φE is more steady after 175 s than using the H∞ filtering method without delay compensation and the H∞ filtering method with delay compensation.
It can be seen from Figure 11 that by using the H∞ filtering method without delay compensation, the estimation value of φN fluctuates dramatically before 50 s, and the estimation value of φN still has fluctuation from 50 s to 234 s. Comparatively, the estimation value of φN by using the H∞ filtering method with delay compensation is more steady than the method without delay compensation and the fluctuation is effectively reduced. Compared with the two filtering methods above, the estimation value of φN has less fluctuation when using adaptive H∞ filtering method with delay compensation. After 175 s, the estimation curve is more steady compared with the other two methods and it can provide more accurate north misalignment angle for S-SINS’s transfer alignment.
As shown in Figure 12, the estimation values of φU have a relatively large fluctuation during the process of transfer alignment when using the H∞ filtering method without delay compensation and the H∞ filtering method with delay compensation, and they have relatively slow convergence speed and fluctuate between −0.4° and −0.2° after 175 s. It indicates that it is difficult to accurately estimate the value of φU in the process of transfer alignment, so the estimation values of φU have some fluctuation ranges, but when using the adaptive H∞ filtering method with delay compensation, the estimation curve of φU converges quickly and eventually becomes steady at around −0.025°, so the adaptive H∞ filter with delay compensation has obvious advantage in the estimation of φU compared with the other two filtering methods.
In order to verify the transfer alignment accuracy for the three filtering methods, a 10 min’ pure inertial navigation experiment after transfer alignment is conducted. The S-SINS starts pure inertial navigation immediately after 234 s’ transfer alignment, so the navigation accuracy is related to the transfer alignment accuracy. The more accurate the transfer alignment is, the more accurate the pure inertial navigation will be. Figure 13 shows the curves of the velocity error by using the H∞ filtering method without delay compensation, H∞ filtering method with delay compensation, and adaptive H∞ filtering method with delay compensation during the period of S-SINS’s pure inertial navigation.
It can be seen from Figure 13 that the velocity error of the adaptive H∞ filter with delay compensation is the smallest compared with the other two filtering methods. After 10 min’ pure inertial navigation, the velocity errors of the H∞ filter without delay compensation, H∞ filter with delay compensation, and the adaptive H∞ filter with delay compensation are 1.89 m/s, 1.37 m/s and 0.69 m/s respectively.
The curves of position errors by using the three filtering methods during the period of S-SINS’s pure inertial navigation are shown in Figure 14. After 10 min’ pure inertial navigation, the position errors of the H∞ filter without delay compensation, H∞ filter with delay compensation and adaptive H∞ filter with delay compensation are 497.93 m, 364.45 m and 166.69 m respectively. The position error of H∞ filter with delay compensation is reduced by 26.82% compared with the position error of H∞ filter without delay compensation. The position error of the adaptive H∞ filter with delay compensation is reduced by 54.23% compared with the position error of the H∞ filter with delay compensation. Totally, the position error of the adaptive H∞ filter with delay compensation is reduced by 66.52% compared with the position error of the H∞ filter without delay compensation, which achieves a good result in the reduction of position error.
With the purpose of comparing the three mentioned filtering methods in the process of transfer alignment, a total of six groups of vehicle transfer alignment experiments have been conducted. The moving trajectories in the six groups of vehicle experiment are different from each other and the trajectories of the vehicle are random during the transfer alignment experiments. The delay time between M-SINS and S-SINS are different and unknown in all groups of vehicle experiment systems. The changes of vehicle speed and road conditions in the six groups of vehicle experiment are also different from each other. After 6 s’ estimation of time delay and 234 s’ transfer alignment, the vehicle starts 10 min’ pure inertial navigation in all groups of vehicle experiment. The histograms of position errors after 10 min’ pure inertial navigation in 6 groups of vehicle experiment are shown in Figure 15. The position errors in the six groups of vehicle experiments are listed in Table 1.
From Figure 15 and Table 1, the position errors by using the H∞ filter without delay compensation, H∞ filter with delay compensation and adaptive H∞ filter with delay compensation are compared to each other. It can be seen that the position errors by using the H∞ filter without delay compensation are the largest in the six groups of vehicle experiments. All the position errors by using the H∞ filter with delay compensation are smaller than the position errors by using the H∞ filter without delay compensation, but they are larger than the position errors by using the adaptive H∞ filter with delay compensation. In other words, all the position errors by using the adaptive H∞ filter with delay compensation are the smallest in the six groups of vehicle experiments. This indicates that the transfer alignment accuracy by using the adaptive H∞ filter with delay compensation method is higher than the other two methods, which fully demonstrates the advantages of the proposed method.

5. Conclusions

In this paper, an adaptive H∞ filtering method with delay compensation for SINS’s transfer alignment is designed, and a transfer alignment model containing a SINS error dynamics model and system measurement model is established. Based on the transfer alignment model, the time delay in the process of transfer alignment is analyzed, and a H∞ filtering method with delay compensation is presented. The H∞ filtering theory with time delay is discussed in detail, and the robust mechanism of H∞ filter is analyzed systematically. In order to improve the performance of H∞ filtering method with delay compensation, an adaptive H∞ filtering method with delay compensation is proposed. In this new method, the robustness factor ξ is adjusted adaptively according to the unknown external environment, and the transfer alignment accuracy can be effectively improved.
In order to verify the adaptive H∞ filtering method with delay compensation, a total of six groups of vehicle transfer alignment experiments on moving bases are conducted in real systems. The experimental results show that compared with the H∞ filtering method without delay compensation and H∞ filtering method with delay compensation, the proposed method has the highest transfer alignment accuracy. The research presented in this paper provides a new idea for SINS’s transfer alignment on a moving base.

Acknowledgments

The research described above was supported by the National Natural Science Foundation of China (No. 61374215), the Shanghai Aerospace Science and Technology Innovation Fund (SAST2016024), the Postgraduate Research & Practice Innovation Program of Jiangsu Province (KYCX17_0103).

Author Contributions

The idea of this work was proposed by Weiwei Lyu and Xianghong Cheng; Weiwei Lyu and Xianghong Cheng conceived and designed the experiments; Weiwei Lyu and Xianghong Cheng performed the experiments; Weiwei Lyu analyzed the data and wrote the paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Lu, J.Z.; Xie, L.L.; Li, B.G. Analytic Coarse Transfer Alignment Based on Inertial Measurement Vector Matching and Real-Time Precision Evaluation. IEEE Trans. Instrum. Meas. 2016, 65, 355–364. [Google Scholar] [CrossRef]
  2. Li, W.L.; Wu, W.Q.; Wang, J.L.; Lu, L.Q. A fast SINS initial alignment scheme for underwater vehicle applications. J. Navig. 2013, 66, 181–198. [Google Scholar] [CrossRef]
  3. Tarrant, D.; Roberts, C.; Jones, D. Rapid and robust transfer alignment. In Proceedings of the IEEE Regional Conference on Aerospace Control Systems, Westlake Village, CA, USA, 25–27 May 1993; pp. 758–762. [Google Scholar]
  4. Liu, X.X.; Xu, X.X.; Liu, Y.T.; Wang, L.H. A fast and high-accuracy transfer alignment method between M/S INS for ship based on iterative calculation. Measurement 2014, 51, 297–309. [Google Scholar] [CrossRef]
  5. Gong, X.X.; Fan, W.; Fang, J.C. An innovational transfer alignment method based on parameter identification UKF for airborne distributed POS. Measurement 2014, 58, 103–114. [Google Scholar] [CrossRef]
  6. Gong, X.X.; Zhang, J.X. An innovative transfer alignment method based on federated filter for airborne distributed POS. Measurement 2016, 86, 165–181. [Google Scholar] [CrossRef]
  7. Shortelle, K.J.; Graham, W.R.; Rabourn, C. F-16 flight tests of a rapid transfer alignment procedure. In Proceedings of the IEEE Position Location & Navigation Symposium, Palm Springs, CA, USA, 20–23 April 1996; pp. 379–386. [Google Scholar]
  8. Lyou, J.; Lim, Y.C. Transfer alignment error compensator design based on robust state estimation. Trans. Jpn. Soci. Aeronaut. Space Sci. 2005, 48, 143–151. [Google Scholar] [CrossRef]
  9. Xie, C.M.; Zhao, Y.; Yang, C.C. Influence and compensation of time-mark discrepancy in transfer alignment. J. Chin. Inert. Technol. 2010, 18, 414–420. [Google Scholar]
  10. Liu, H.G.; Chen, Z.G.; Chen, G. Time-delay’s effect on velocity matching transfer alignment. J. Chin. Inert. Technol. 2012, 20, 544–551. [Google Scholar]
  11. Lyou, J.; Lim, Y.C. Transfer alignment considering measurement time delay and ship body flexure. J. Mech. Sci. Technol. 2009, 23, 195–203. [Google Scholar]
  12. Lim, Y.C.; Lyou, J. An error compensation method for transfer alignment. In Proceedings of the Tencon IEEE Region 10 International Conference on Electrical and Electronic Technology, Singapore, 19–22 August 2001; pp. 850–855. [Google Scholar]
  13. Lim, Y.C.; Lyou, J. Transfer alignment error compensator design using H∞ filter. In Proceedings of the American Control Conference, Anchorage, AK, USA, 8–10 May 2002; pp. 1460–1465. [Google Scholar]
  14. Chen, G.; Zhou, C.; Liu, H.G. Influence of time delay for attitude angle matching transfer alignment. J. Chin. Inert. Technol. 2014, 22, 172–176. [Google Scholar]
  15. Ross, C.C.; Elbert, T.F. A transfer alignment algorithm study based on actual flight test data from a tactical air-to-ground weapon launch. In Proceedings of the IEEE Position Location & Navigation Symposium, Las Vegas, NV, USA, 11–15 April 1994; pp. 431–438. [Google Scholar]
  16. Wang, Y.F.; Sun, F.C.; Zhang, Y.A.; Liu, H.P.; Min, H.B. Central Difference Particle Filter Applied to Transfer Alignment for SINS on Missiles. IEEE Trans. Aerosp. Electron. Syst. 2012, 48, 375–387. [Google Scholar] [CrossRef]
  17. Kain, J.E.; Cloutier, J.R. Rapid transfer alignment for tactical weapon applications. In Proceedings of the Guidance, Navigation and Control Conference, Boston, MA, USA, 14–16 August 1989; pp. 1290–1300. [Google Scholar]
  18. Jones, D.; Roberts, C.; Tarrant, D.; Yang, C.; Lin, C.F. Transfer alignment design and evaluation environment. In Proceedings of the IEEE Regional Conference on Aerospace Control Systems, Westlake Village, CA, USA, 25–27 May 1993; pp. 753–757. [Google Scholar]
  19. Gao, Z.H.; Mu, D.J.; Gao, S.S.; Zhong, Y.M.; Gu, C.F. Robust adaptive filter allowing systematic model errors for transfer alignment. Aerosp. Sci. Technol. 2016, 59, 32–40. [Google Scholar] [CrossRef]
  20. Zhang, Y.H.; Cheng, J.B.; Huang, Z.Y. Robust filtering and its application to SINS alignment. Int. Symp. Underwater Technol. 1998, 78, 228–232. [Google Scholar]
  21. Cheng, J.H.; Wang, T.D.; Song, C.Y.; Yu, D.W. Modified adaptive filter algorithm for shipborne SINS transfer alignment. Syst. Eng. Electron. 2016, 38, 638–643. [Google Scholar]
  22. Zhang, H.; Yang, S.; Mehr, A.S. Robust weighted H∞ filtering for networked systems with intermittent measurements of multiple sensors. Int. J. Adapt. Control Signal Proc. 2011, 25, 313–330. [Google Scholar] [CrossRef]
  23. Yue, X.K.; Yuan, J.P. H∞ sub-optimal filter for low-cost integrated navigation system. Chin. J. Aeronaut. 2004, 17, 200–206. [Google Scholar] [CrossRef]
  24. Liu, X.G.; Hu, J.T.; Wang, H. Research on integrated navigation method based on adaptive H∞ filter. Chin. J. Sci. Instrum. 2014, 35, 1013–1021. [Google Scholar]
  25. LU, C.X.; Tan, Y.H.; Zhu, B.C.; Zhou, L.Z. Reduced-order H∞ filtering for navigation with carrier phase. Sci. China Inf. Sci. 2014, 57, 1–10. [Google Scholar] [CrossRef]
  26. Jia, B.; Xin, M. Sparse-Grid Quadrature H∞ Filter for Discrete-Time Systems with Uncertain Noise Statistics. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1626–1636. [Google Scholar] [CrossRef]
  27. Xie, L.H.; Lu, L.L.; Zhang, D.; Zhang, H.S. Improved robust H2 and H∞ filtering for uncertain discrete-time systems. Automatica 2004, 40, 873–880. [Google Scholar] [CrossRef]
  28. Zhu, X.L.; Wang, Y.Y.; Gan, Y. H∞ filtering for continuous-time singular systems with time-varying delay. Int. J. Adapt. Control Signal Proc. 2011, 25, 137–154. [Google Scholar] [CrossRef]
  29. Tamboli, P.K.; Duttagupta, S.P.; Roy, K. Adaptive Fading Memory H∞ Filter Design for Compensation of Delayed Components in Self Powered Flux Detectors. IEEE Trans. Nucl. Sci. 2016, 63, 371–373. [Google Scholar]
  30. Xu, S.Y.; Chen, T.W. Robust H∞ filtering for uncertain impulsive stochastic systems under sampled measurements. Automatica 2003, 39, 509–516. [Google Scholar] [CrossRef]
  31. Zhang, W.H.; Chen, B.S.; Tseng, C.S. Robust H-infinity filtering for nonlinear stochastic systems. IEEE Trans. Signal Proc. 2005, 53, 589–598. [Google Scholar] [CrossRef]
  32. Duan, Z.S.; Zhang, J.X.; Zhang, C.S.; Mosca, E. Robust H2 and H∞ filtering for uncertain linear systems. Automatica 2006, 42, 1919–1926. [Google Scholar] [CrossRef]
  33. Wang, S.G.; Wu, M.X.; Jia, Z.Z. Matrix Inequal; Science Press: Beijing, China, 2006; Volume 7, pp. 160–165. [Google Scholar]
Figure 1. Schematic diagram of time delay.
Figure 1. Schematic diagram of time delay.
Sensors 17 02753 g001
Figure 2. Flow chart of transfer alignment based on adaptive H∞ filtering method with delay compensation.
Figure 2. Flow chart of transfer alignment based on adaptive H∞ filtering method with delay compensation.
Sensors 17 02753 g002
Figure 3. The trajectory of vehicle experiment.
Figure 3. The trajectory of vehicle experiment.
Sensors 17 02753 g003
Figure 4. The attitude curve of M-SINS.
Figure 4. The attitude curve of M-SINS.
Sensors 17 02753 g004
Figure 5. The heading angles’ curves of M-SINS and S-SINS.
Figure 5. The heading angles’ curves of M-SINS and S-SINS.
Sensors 17 02753 g005
Figure 6. The pitching angles’ curves of M-SINS and S-SINS.
Figure 6. The pitching angles’ curves of M-SINS and S-SINS.
Sensors 17 02753 g006
Figure 7. The rolling angles’ curves of M-SINS and S-SINS.
Figure 7. The rolling angles’ curves of M-SINS and S-SINS.
Sensors 17 02753 g007
Figure 8. The influence of robustness factors ξ on navigation accuracy.
Figure 8. The influence of robustness factors ξ on navigation accuracy.
Sensors 17 02753 g008
Figure 9. The value of ξ in the adaptive H∞ filtering method.
Figure 9. The value of ξ in the adaptive H∞ filtering method.
Sensors 17 02753 g009
Figure 10. The estimation curves of east misalignment angle.
Figure 10. The estimation curves of east misalignment angle.
Sensors 17 02753 g010
Figure 11. The estimation curves of north misalignment angle.
Figure 11. The estimation curves of north misalignment angle.
Sensors 17 02753 g011
Figure 12. The estimation curves of azimuth misalignment angle.
Figure 12. The estimation curves of azimuth misalignment angle.
Sensors 17 02753 g012
Figure 13. The curves of velocity error in inertial navigation.
Figure 13. The curves of velocity error in inertial navigation.
Sensors 17 02753 g013
Figure 14. The curves of position error in inertial navigation.
Figure 14. The curves of position error in inertial navigation.
Sensors 17 02753 g014
Figure 15. The histograms of position errors in 6 groups of vehicle experiment.
Figure 15. The histograms of position errors in 6 groups of vehicle experiment.
Sensors 17 02753 g015
Table 1. The position errors (m) in 6 groups of vehicle experiment.
Table 1. The position errors (m) in 6 groups of vehicle experiment.
MethodGroup 1Group 2Group 3Group 4Group 5Group 6
H∞ Filter w/o Delay-CP497.931126.84452.311210.27703.42857.77
H∞ Filter w/Delay-CP364.45902.62323.98985.92522.06696.63
Adaptive H∞ Filter w/Delay-CP166.69614.55128.09486.46310.28302.34

Share and Cite

MDPI and ACS Style

Lyu, W.; Cheng, X. A Novel Adaptive H∞ Filtering Method with Delay Compensation for the Transfer Alignment of Strapdown Inertial Navigation Systems. Sensors 2017, 17, 2753. https://doi.org/10.3390/s17122753

AMA Style

Lyu W, Cheng X. A Novel Adaptive H∞ Filtering Method with Delay Compensation for the Transfer Alignment of Strapdown Inertial Navigation Systems. Sensors. 2017; 17(12):2753. https://doi.org/10.3390/s17122753

Chicago/Turabian Style

Lyu, Weiwei, and Xianghong Cheng. 2017. "A Novel Adaptive H∞ Filtering Method with Delay Compensation for the Transfer Alignment of Strapdown Inertial Navigation Systems" Sensors 17, no. 12: 2753. https://doi.org/10.3390/s17122753

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