Open AccessArticle

In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty

Jin Sun

^1,2,3,*

Qianqi Ye

¹ and

Yue Lei

College of Internet of Things, Nanjing University of Posts and Telecommunication, Nanjing 210003, China

State Key Laboratory of Ocean Engineering, Shanghai Jiao Tong University, Shanghai 200240, China

Jiangsu Huaerwei Science and Technology Group Co., Ltd., Huaian 211600, China

Author to whom correspondence should be addressed.

Remote Sens. 2022, 14(11), 2581; https://doi.org/10.3390/rs14112581

Submission received: 18 April 2022 / Revised: 26 May 2022 / Accepted: 26 May 2022 / Published: 27 May 2022

(This article belongs to the Topic Multi-Sensor Integrated Navigation Systems)

Download

Browse Figures

Graphical abstract
"> Figure 1
Geometric relationship diagram for the latitude estimation. "> Figure 2
Integral dynamic window algorithm diagram. "> Figure 3
Curves of latitude estimation error. "> Figure 4
Attitude error of in-motion alignment of uniform linear motion. "> Figure 5
Estimation values of IMU constant error (uniform linear motion). "> Figure 6
Circular maneuver path. "> Figure 7
Attitude error of in-motion alignment of circular maneuver. "> Figure 8
Estimation values of IMU constant error (circular maneuver). "> Figure 9
Trapezoidal maneuver path. "> Figure 10
Attitude error of in-motion alignment of trapezoidal maneuver. "> Figure 11
Estimation values of IMU constant error (trapezoidal maneuver). "> Figure 12
S-shaped maneuver path. "> Figure 13
Attitude error of in-motion alignment of s-shaped maneuver. "> Figure 14
Estimation values of IMU constant error (s-shaped maneuver). ">

Versions Notes

Abstract

To realize the in-motion alignment of the strapdown inertial navigation system (SINS) under the geographic latitude uncertainty, we propose a latitude estimation and in-motion alignment method based on the integral dynamic window and polynomial fitting (IDW-PF) and improved Kalman filter (IKF). First, the integral dynamic window (IDW) is designed to smooth out the high-frequency line motion interference and accelerometer noise. Second, the specific force integral is performed for a cubic polynomial fitting (PF) with time as an independent variable to further suppress the line motion interference. Simultaneously, the latitude is estimated according to the geometric relationship between the angle of the gravitational acceleration vectors at different moments and the latitude. Finally, the IKF based on the multi-fading factor is designed for the in-motion alignment of SINS. A simulation experiment is conducted to verify the proposed latitude estimation and in-motion alignment method. The results indicate that the latitude can be estimated well by the method based on the IDW-PF; the mean and standard deviation of the estimated latitude can achieve −0.016° and 0.013° within 300 s. The trapezoidal maneuvering path is optimal when IKF is used, the pitch error is 0.0002°, the roll error is 0.0009° and the heading error is −0.0047° after the alignment ends at 900 s.

Keywords:

in-motion alignment; strapdown inertial navigation system (SINS); multi-fading factor; improved Kalman filter (IKF); latitude estimation; integral dynamic window (IDW); polynomial fitting (PF)

Graphical Abstract

1. Introduction

The initial alignment is one of the key technologies for the strapdown inertial navigation system (SINS), and its accuracy and rapidity directly affect the performance of the navigation system [1]. As reported in [2], some of the challenges associated with the stationary base alignment of SINS may have been resolved. However, this alignment has high requirements on the environment, which greatly reduces its agility and its anti-strike feature. Because the in-motion alignment method can effectively improve the carrier’s maneuverability under the premise of ensuring the alignment accuracy, this technology has received more attention recently [3,4,5,6,7,8]. The traditional initial alignment method of the SINS is generally carried out under the condition that the geographical location (mainly refers to latitude) is accurately known. However, in some environments, such as underwater, deep mountains and forests, deep tunnels, or when the carrier is parked in the hangar and cannot receive satellite positioning signals, there is also the need for initial alignment. Based on the above application scenarios, researching the initial alignment under latitude uncertainty has great theoretical significance and practical application value.·

In recent years, G. Yan et al. [9] took the lead in proposing a latitude calculation method based on the output of inertial measurement components under the stationary base. The authors concluded that the initial alignment can be completed by using the estimation latitude information. Y. Wang et al. [10] used the gravitational acceleration vectors at two different moments to estimate the latitude value. It was shown that the initial alignment under dynamic conditions can be completed by effectively isolating the sloshing angular motion interference. The accelerometer will also be disturbed by the line vibration in addition to its instrument errors under the in-motion condition. As a result, the output error of the accelerometer is larger, which will have a greater impact on the latitude estimation. However, the above latitude estimation methods are applied to stationary bases and swaying bases. When the carrier is in motion, the above methods are not applicable.

For an in-motion environment, many researchers have studied the initial alignment with the latitude certainty. Unlike the stationary base alignment, external equipment is usually required to provide auxiliary information (such as the position or the velocity) to the in-motion alignment. The most popular aiding information for SINS is the global positioning system (GPS) [11,12,13,14,15,16,17]. However, its availability and reliability are seriously affected by jamming, blocking and spoofing of the GPS signals. In response to this problem, odometers [18] or Doppler velocity log (DVL) [19,20,21,22,23] aided the in-motion alignment was proposed by many scholars. For these velocity-aided in-motion alignment conditions, if the geographic latitude is not available, the attitude cannot be determined. Hence, relying on the inertial component output of the SINS for the latitude self-estimation is very meaningful. It is of great significance to study how to conduct the in-motion alignment of SINS under geographic latitude uncertainty. It can improve the maneuverability and adaptability to the environment of the carrier.

The main contributions of this paper are summarized as follows: (1) In the latitude estimation, a method based on the integral dynamic window and polynomial fitting (IDW-PF) for SINS is proposed. The measurement value of the accelerometer is with integral transformation, and it is projected to the inertial system. Polynomial fitting (PF) is performed on the result of the specific force integration to achieve the second smoothing of the interference acceleration. The latitude can be estimated in real-time and accurately because of making full use of the inertial instrument data. (2) In the in-motion alignment, the improved Kalman filter (IKF) based on the multi-fading factor is designed to calculate the in-motion misalignment angles. Simulation experiments are performed to verify the performances of the proposed in-motion alignment method under latitude uncertainty. The results show that the trapezoidal path is with the best alignment effect based on the IKF.

The rest of this paper is organized as follows. The latitude estimation algorithm based on IDW-PF under the in-motion condition is proposed in Section 2. In Section 3, the IKF based on the multi-fading factor is designed. The in-motion alignment model is established in Section 4. The simulation results are given in Section 5. Finally, the conclusions are drawn in Section 6.

2. Latitude Estimation Based on IDW-PF under the In-Motion Condition

As shown in Figure 1, Point

O^{'}

is the center of the latitude circle where the SINS is located. Point A and B are the positions in the inertial coordinate system at time

t_{1}

and

t_{2}

during the initial alignment, respectively. Point O is the intersection point of the vertical line of gravitational acceleration and the Earth’s axis [9].

g^{i_{b 0}} (t_{1})

and

g^{i_{b 0}} (t_{2})

represent the gravitational acceleration vectors at

t_{1}

and

t_{2}

, respectively. θ denotes the angle between the vector

g^{i_{b 0}} (t_{1})

and

g^{i_{b 0}} (t_{2})

α

indicates the angle of the Earth turning around from

t_{1}

t_{2}

. The angle between the latitude circle of point O and the vertical line of gravity is the latitude L.

The relationship between the lengths of the geometric line segments can be obtained as:

| A B | = 2 | A O | \cos L \sin \frac{α}{2}

(1)

| A B | = 2 | A O | \sin \frac{θ}{2}

(2)

The latitude value can be estimated by (1) and (2):

L = \arccos (\frac{\sin \frac{θ}{2}}{\sin \frac{α}{2}})

(3)

The angular velocity

ω_{i e}

of the Earth’s rotation is known; hence, the angle

α

of rotation can be expressed as follows:

α = ω_{i e} (t_{2} - t_{1})

(4)

To reduce the influence of the actual inertial navigation specific force measurement noise and the interference movement of the base, the angle is generally calculated after smoothing with the specific force integral over a period of time. Then, it can be obtained as:

θ = a \cos [\frac{{(v_{1}^{i_{b 0}})}^{T} v_{2}^{i_{b 0}}}{\sqrt{{(v_{1}^{i_{b 0}})}^{T} v_{1}^{i_{b 0}} {(v_{2}^{i_{b 0}})}^{T} v_{2}^{i_{b 0}}}}]

(5)

where

v_{1}^{i_{b 0}} = \int_{t_{1}}^{t_{1} + Δ t} g^{i_{b 0}} (t) d t

v_{2}^{i_{b 0}} = \int_{t_{2}}^{t_{2} + Δ t} g^{i_{b 0}} (t) d t

Δ t

indicates the integration time.

g^{i_{b 0}} (t)

is calculated as:

g^{i_{b 0}} (t) = C_{b}^{i_{b 0}} g^{b} (t) = - C_{b}^{i_{b 0}} f^{b} (t)

(6)

where

g^{b} (t)

is the gravitational acceleration vector in b coordinate system at time t.

f^{b} (t)

is the measurement value of

g^{b} (t)

C_{b}^{i_{b 0}}

can be updated by measuring the gyroscope information in real-time:

{\dot{C}}_{b}^{i_{b 0}} = C_{b}^{i_{b 0}} (ω_{i b}^{b} \times)

(7)

where

ω_{i b}^{b}

is the output value of gyroscope and

(ω_{i b}^{b} \times)

denotes the antisymmetric matrix of

ω_{i b}^{b}

Hence, the key to latitude estimation is to extract more accurate

g^{i_{b 0}}

in real-time. However, under the in-motion condition, besides its instrument error, the accelerometer is also disturbed by the line vibration. This leads to a large output error of the accelerometer, which has a large impact on the latitude estimation. In this paper, a method of latitude estimation based on IDW-PF under the in-motion condition is proposed. The algorithm diagram is shown in Figure 2 [24].

In Figure 2,

- f^{i_{b 0}} (t_{N})

indicates the calculated gravitational acceleration projected on the inertial coordinate system at time

t_{N}

. It can be calculated by updating the accelerometer output

{\tilde{f}}^{i_{b}}

and the gyroscope output

{\tilde{ω}}_{i b}^{b}

at the current time. According to (3)–(7), take

{\tilde{f}}^{i_{b 0}} (t_{1})

obtained from the calculation value at time

t_{1}

as a reference. The real-time latitude estimation value at time

t_{N}

can be obtained from the calculation value

{\tilde{f}}^{i_{b 0}} (t_{i})

t_{i} (i = N, N + 1, \dots, m)

and

{\tilde{f}}^{i_{b 0}} (t_{1})

at time

t_{1}

. That is, as long as there is the output of inertial instrument data, the current latitude estimation value can be obtained. The principle of integral dynamic window (IDW) is similar to that of dynamic window (DW).

In summary, the latitude estimation algorithm based on IDW-PF under the in-motion condition can be summarized as follows:

(1): The integral value $v_{0}^{i_{b_{0}}}$ of time period $t_{1} \sim t_{M^{'}}$ is calculated according to $v_{0}^{i_{b_{0}}} = \int_{t_{1}}^{t_{M^{'}}} g^{i_{b_{0}}} (t) d t$ , which is used as the reference of the IDW.
(2): Calculate the integral value of $v_{0}^{i_{b_{0}}} = \int_{t_{M^{'} + i}}^{t_{2 M^{'} + i}} g^{i_{b_{0}}} (t) d t$ time period $t_{M^{'} + i} \sim t_{2 M^{'} + i} (i = 0, 1, \dots, m - 2 M^{'} + 1)$ .
(3): Perform polynomial fitting with time t as the independent variable to the calculation result of $v_{0}^{i_{b_{0}}}$ and $v_{i}^{i_{b_{0}}}$ , namely $v_{i}^{i_{b_{0}}} = a_{0} + a_{1} t + a_{2} t^{2} + a_{3} t^{3}$ .
(4): The angle θ at time $t_{2 M^{'}}$ can be obtained from the integral value $v_{i}^{i_{b_{0}}}$ of time period $t_{M^{'} + i} \sim t_{2 M^{'} + i} (i = 0, 1, \dots, m - 2 M^{'} + 1)$ and $v_{0}^{i_{b_{0}}}$ of time period $t_{1} \sim t_{M^{'}}$ by using (5).
(5): Calculate the angle α at time $t_{2 M^{'}}$ by using (4).
(6): The real-time latitude estimation value at time $t_{2 M^{'}}$ can be obtained by using (3).

3. The Improved Kalman Filtering Algorithm

The state equation and observation equation of the stochastic linear discrete system are given as [25]:

{\begin{array}{l} X_{k} = Φ_{k, k - 1} X_{k - 1} + Γ_{k, k - 1} W_{k - 1} \\ Z_{k} = H_{k} X_{k} + V_{k} \end{array}

(8)

where

X_{k}

is the state matrix at

t_{k}

Φ_{k, k - 1}

is the one-step transition matrix from

t_{k - 1}

t_{k}

Γ_{k, k - 1}

is the system noise driving matrix,

Z_{k}

is the system measurement sequence,

H_{k}

is the measurement matrix,

V_{k}

is the measurement noise sequence and

W_{k}

is the system incentive noise sequence.

The standard KF recursive equations are as follows [26]:

(1): State one-step prediction

${\hat{X}}_{k, k - 1} = Φ_{k, k - 1} {\hat{X}}_{k - 1}$

(9)
(2): State estimation

${\hat{X}}_{k} = {\hat{X}}_{k, k - 1} + K_{k} (Z_{k} - H_{k} {\hat{X}}_{k, k - 1})$

(10)
(3): Filter gain

$K_{k} = P_{k, k - 1} H_{k}^{T} {(H_{k} P_{k, k - 1} H_{k}^{T} + R_{k})}^{- 1}$

(11)
(4): One-step prediction mean square error

$P_{k, k - 1} = Φ_{k, k - 1} P_{k - 1} Φ_{k, k - 1}^{T} + Γ_{k - 1} Q_{k - 1} Γ_{k - 1}^{T}$

(12)
(5): Estimated mean square error

$P_{k} = (I - K_{k} H_{k}) P_{k, k - 1}$

(13)

where ${\hat{X}}_{k, k - 1}$ is the state one-step prediction matrix, ${\hat{X}}_{k - 1}$ is the estimated state matrix at $t_{k - 1}$ , ${\hat{X}}_{k}$ is the estimated state matrix at $t_{k}$ , $K_{k}$ is the filter gain matrix, $P_{k, k - 1}$ is the one-step prediction mean square error matrix, $R_{k}$ is the measurement noise variance matrix, $P_{k - 1}$ is the error covariance matrix of the optimal filter value at $t_{k - 1}$ , $Q_{k - 1}$ is system noise variance matrix at $t_{k - 1}$ , $P_{k}$ is the estimated mean square error matrix and $I$ is the unit matrix.

During the calculation process of KF, filtering anomalies or even divergences often occur. The main reasons are the inaccurate system models, the inaccurate noise statistical models, the accumulation of the rounding errors, etc. They cause the current measurement value to reduce the correction effect of the estimation value and the old measurement value to increase the correction effect of the estimation value [27]. The proposed IKF introduces a diagonal matrix fading factor into (12) so that the residual sequences at different times remain orthogonal everywhere, namely

P_{k, k - 1} = D_{k + 1} Φ_{k, k - 1} P_{k - 1} Φ_{k, k - 1}^{T} I_{k + 1}^{T} + Γ_{k - 1} Q_{k - 1} Γ_{k - 1}^{T}

(14)

where

D_{k + 1}

is the diagonal matrix with multiple fading factors, and it can be determined by the following method [27]:

D_{k + 1} = d i a g [\begin{matrix} λ_{1} (k + 1) & λ_{2} (k + 1) & \dots & λ_{n} (k + 1) \end{matrix}]

(15)

λ_{n} (k + 1) = {\begin{matrix} α_{k} \cdot C_{k} & α_{k} \cdot C_{k} \geq 1 \\ 1 & α_{k} \cdot C_{k} < 1 \end{matrix}

(16)

where

α_{k} \geq 1 (k = 1, 2, \dots, n)

are the coefficients predetermined by the prior knowledge. It can increase the corresponding

α_{k}

of the components that are prone to sudden changes. If the system has no prior knowledge, take

α_{k} = 1

. In (16),

C_{k}

can be expressed as

C_{k} = \frac{t r [N_{k}]}{\sum_{i = 1}^{n} α_{i} M_{k}}

(17)

where

t r [\cdot]

denotes the trace of the matrix “

\cdot

”.

N_{k} = V_{0, k} - H_{k} Q_{k} H_{k}^{T} - l_{k} R_{k}

l_{k} \geq 1

, and it is the weakening factor.

V_{0, k}

is the mean square error.

M_{K} = H_{k} Φ_{k, k - 1} P_{k - 1} Φ_{k, k - 1}^{T} H_{k}^{T}

. The multi-fading factor KF is used to fade each data channel at different rates. It can better adjust the gain matrix. Even when the system reaches a steady state, the gain matrix can be adjusted adaptively to enhance the robustness of the model mismatch and the system destabilization. More accurate and stable estimation results will be obtained.

4. The Proposed In-Motion Alignment Method

The IKF-based alignment technology for SINS requires auxiliary navigation equipment to complete the alignment. Considering that the external velocity of the vehicle is easy to obtain, this paper focuses on the use of external reference velocity-aided alignment methods. The difference between the velocity output by SINS and the velocity provided by the auxiliary navigation equipment is used as the observation. Attitude misalignment angle and inertial device error are estimated by IKF so as to complete the initial alignment.

The instability of the vertical channel is considered; the upward velocity and the z-axis accelerometer constant bias are not regarded as the state variables in this paper. Hence, the state vectors selected in the study are as follows:

X (t) = {[δ V_{E}, δ V_{N}, ϕ_{E}, ϕ_{N}, ϕ_{U}, δ L, δ λ, \nabla_{x}, \nabla_{y}, ε_{x}, ε_{y}, ε_{z}]}^{T}

(18)

where

δ V_{E}

is the eastward velocity error,

δ V_{N}

is the northward velocity error,

ϕ_{E}

is the eastward misalignment angle,

ϕ_{N}

is the northward misalignment angle,

ϕ_{U}

is the upward misalignment angle,

δ L

is the latitude error,

δ λ

is the longitude error,

\nabla_{x}

is the x-axis accelerometer bias,

\nabla_{y}

is the y-axis accelerometer bias,

ε_{x}

is the x-axis gyroscope constant drift,

ε_{y}

is the y-axis gyroscope constant drift and

ε_{z}

is the z-axis gyroscope constant drift.

The state equation of the system is expressed as [28,29]:

\dot{X} (t) = F (t) X (t) + G (t) w (t)

(19)

where

X (t)

is the system state vector,

F (t)

is the system matrix,

G (t)

is the system noise matrix and

w (t)

is the system noise vector. The system matrix

F (t)

is expressed as:

F (t) = [\begin{matrix} T (t) & M (t) \\ 0_{5 \times 9} & 0_{5 \times 3} \end{matrix}]

(20)

where

M (t) = {[0_{3 \times 2} C_{n}^{b} 0_{3 \times 2}]}^{T}

T (t) = [\begin{matrix} T_{11} & T_{12} & 0 & - f_{U} & f_{N} & T_{16} & 0 & C_{b}^{n} (1, 1) & C_{b}^{n} (1, 2) \\ T_{21} & - \frac{V_{U}}{R_{n}} & f_{U} & 0 & - f_{E} & T_{26} & 0 & C_{b}^{n} (2, 1) & C_{b}^{n} (2, 2) \\ 0 & - \frac{1}{R_{n}} & 0 & T_{34} & Τ_{35} & 0 & 0 & 0 & 0 \\ \frac{1}{R_{e}} & 0 & T_{43} & 0 & - \frac{V_{N}}{R_{n}} & - ω_{i e} \sin L & 0 & 0 & 0 \\ \frac{\tan L}{R_{e}} & 0 & T_{53} & 0 & \frac{V_{U}}{R_{n}} & T_{56} & 0 & 0 & 0 \\ 0 & \frac{1}{R_{n}} & 0 & 0 & 0 & 0 & 0 & 0 & 0 \\ \frac{1}{R_{e} \cos L} & 0 & 0 & 0 & 0 & \frac{V_{E} \tan L}{R_{e} \cos L} & 0 & 0 & 0 \end{matrix}]

(21)

where

L

is the latitude,

f_{E}

f_{N}

and

f_{U}

are the eastward acceleration, northward acceleration and upward acceleration, respectively.

V_{E}

V_{N}

and

V_{U}

are the eastward velocity, northward velocity and upward velocity, respectively.

ω_{i e}

is the angular velocity of the Earth’s rotation.

R_{e}

is the Earth’s semi-major axis, and

R_{n}

is the radius of principal curvature.

C_{b}^{n}

is the attitude matrix, and all nonzero elements of the matrix T(t) are expressed as:

T_{11} = \frac{V_{N} \tan L - V_{U}}{R_{e}}

T_{12} = 2 (ω_{i e} \sin L + \frac{V_{E} \tan L}{R_{e}})

T_{16} = 2 ω_{i e} (V_{U} \sin L + V_{N} \cos L) + \frac{V_{E} V_{N}}{R_{e} {(\cos L)}^{2}}

T_{21} = - 2 (ω_{i e} \sin L + \frac{V_{E} \tan L}{R_{e}})

T_{26} = - (2 ω_{i e} \cos L + \frac{V_{E}}{R_{e} {(\cos L)}^{2}}) V_{E}

T_{34} = ω_{i e} \sin L + \frac{V_{E} t a n L}{R_{e}}

Τ_{35} = - (ω_{i e} \cos L + \frac{V_{E}}{R_{e}})

T_{43} = - (ω_{i e} \sin L + \frac{V_{E} \tan L}{R_{e}})

T_{53} = ω_{i e} \cos L + \frac{V_{E}}{R_{e}}

T_{56} = ω_{i e} \cos L + \frac{V_{E}}{R_{e} {(c o s L)}^{2}}

The horizontal velocity of the SINS is assumed to be expressed as [30]:

{\begin{cases} V_{E S} = V_{E T} + δ V_{E S} \\ V_{N S} = V_{N T} + δ V_{N S} \end{cases}

(22)

where

V_{E S}

and

V_{N S}

are the eastward velocity and the northward velocity of the SINS, respectively.

V_{E T}

and

V_{N T}

are the true eastward velocity and northward velocity of the carrier, respectively.

δ V_{E S}

and

δ V_{N S}

are the eastward velocity error and the northward velocity error of the SINS, respectively.

The external reference velocity is assumed to be expressed as [30]:

{\begin{cases} V_{E D} = V_{E T} + δ V_{E D} \\ V_{N D} = V_{N T} + δ V_{N D} \end{cases}

(23)

where

V_{E D}

and

V_{N D}

are the eastward velocity and the northward velocity of the external equipment, respectively.

δ V_{E D}

and

δ V_{N D}

are the eastward velocity error and the northward velocity error of the external equipment, respectively.

Hence, the measurement equation of the system can be expressed as:

Z_{k} = [\begin{array}{l} V_{E S} - V_{E D} \\ V_{N S} - V_{N D} \end{array}] = [\begin{array}{l} δ V_{E S} - δ V_{E D} \\ δ V_{N S} - δ V_{N D} \end{array}] = H_{k} X_{k} + V_{k}

(24)

where

H_{k} = [\begin{matrix} 1 & 0 \\ 0 & 1 \end{matrix} 0_{2 \times 10}]

So far, the model of velocity-aided in-motion alignment has been established. Then, the IKF can be used for filtering, and the process is introduced as follows:

(1): State prediction

$r_{k} = Z_{k} - {\hat{Z}}_{k} = Z_{k} - H_{k} {\hat{X}}_{k}$

(25)
(2): Calculate the diagonal matrix with multiple suboptimal fading factors, where

$V_{0, k} = E [r (k + 1) r^{T} (k + 1)] = {\begin{matrix} r (1) r^{T} (1) & k = 0 \\ \frac{ρ V_{0, k - 1} + r_{k} r_{k}^{T}}{1 + ρ} & k \geq 1 \end{matrix}$

(26)

where $0 \leq ρ \leq 1$ , and it is the forgetting factor.
(3): Calculate the prediction state covariance matrix using (14).
(4): Calculate the gain matrix using (11).
(5): Calculate the state estimation and its covariance matrix at t.

{\begin{matrix} P_{k} = (I - K_{k} H_{k}) P_{k, k - 1} \\ {\hat{X}}_{k} = {\hat{X}}_{k, k - 1} + K_{k} r_{k} \end{matrix}

(27)

At this point, the in-motion alignment method based on IKF under geographic latitude uncertainty has been implemented. Then the initial attitude can be obtained.

5. Simulation Results and Discussions

In order to verify the latitude estimation and in-motion alignment method proposed in this paper, firstly, the simulation experiments of the latitude estimation based on the IDW-PF are carried out. Then, the simulation experiments of in-motion alignment based on the IKF are performed for various motion paths. The external reference velocity error is not considered when studying the influence of different maneuver tracks on the in-motion alignment; here, the external reference velocity error is set to zero. The latitude used in the simulation experiment is the latitude estimation value based on the IDW-PF.

The specifications of the inertial measurement unit (IMU) are listed in Table 1. The instrument output frequency is 200 Hz. At the time of the experiment, the system has completed the coarse alignment, and the pitch, roll and heading attitude errors at the beginning of fine alignment are

{0.1}^{°}

{0.1}^{°}

and

1^{°}

, respectively. The linear velocity of the carrier is 2 m/s; the turn angle rate is

{0.9}^{°} / s

. The simulation time of latitude estimation and in-motion are set as 300 s and 900 s, respectively. The time parameters are set as:

t_{N} = 8 s

and

t_{M^{'}} = 4 s

5.1. Simulation Experiment of the Latitude Estimation Based on the IDW-PF

In this subsection, three kinds of latitude estimation algorithms are performed, which are based on the DW, IDW and IDW-PF, respectively. Figure 3 shows the curves of the latitude estimation error,

δ L

denotes the latitude error, and the statistical results of the latitude estimation error are listed in Table 2.

It can be seen from Figure 3 and Table 2 that all three methods can realize self-estimation of latitude. However, due to the influence of accelerometer noise, the standard deviation (SD) of the DW method is relatively large. The IDW method effectively suppresses the influence of the accelerometer noise on the estimation accuracy through the integral effect. The IDW-PF method achieves the second smoothing of the interference acceleration by performing the PF on the result of the specific force integration. Hence, the IDW-PF method has the best performance with the fastest convergence speed and the highest estimation accuracy.

5.2. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Uniform Linear Motion

The initial attitude angles are assumed to be as follows: the pitch angle is

0^{°}

, the roll angle is

0^{°}

, the heading angle is

0^{°}

90^{°}

180^{°}

and

270^{°}

. Figure 4 shows the attitude error of the in-motion alignment of uniform linear motion when the heading angle is

90^{°}

. Figure 5 shows the estimation values of the gyroscope and accelerometer constant error when the heading angle is

90^{°}

δ θ

δ γ

and

δ ϕ

are pitch error, roll error and heading error, respectively.

Δ_{x}

and

Δ_{y}

are accelerometer bias of x-axis and y-axis, respectively.

ε_{x}

and

ε_{y}

are gyroscope drift of x-axis and y-axis, respectively. The system is open-loop during the alignment process, the alignment ends at 900 s, and then the attitude is compensated. Table 3 shows the statistical results of the attitude error, the estimation values of the gyroscope and accelerometer constant error when the heading angle is

0^{°}

90^{°}

180^{°}

and

270^{°}

It can be seen from Figure 4 and Figure 5 and Table 3 that when the initial heading angle is 90°, the pitch, roll and heading errors measured at 900 s are sufficiently low and are 0.0011°, −0.0022° and 0.0345°, respectively. The bias of the x-axis and y-axis accelerometer is 1.036 µg and −1.550 µg, respectively. The constant drift of x-axis and y-axis gyroscopes is 0.073°/h and 0.011°/h, respectively. Although the alignment accuracy can meet the alignment requirements, there are large errors in estimating the accelerometer constant bias and gyroscope constant drift. It can be seen from Table 3 that the above conclusions are true for multiple heading angles. Moreover, the estimation accuracy of the misalignment angle is stable under the condition of uniform linear motion maneuvering.

5.3. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (Circular Path)

The initial attitude angles are assumed to be as follows: the pitch angle is 0°, the roll angle is 0° and the heading angle is 0°. When the influence of the circular maneuver mode on the in-motion alignment is considered, the maneuvering trajectory is shown in Figure 6. The results of the attitude error and the constant error estimation for the gyroscope and accelerometer are shown in Figure 7 and Figure 8, respectively.

When the alignment ends at 900 s, the attitude error, accelerometer bias and gyroscope drift are measured. The pitch error is 0.0002°, the roll error is −0.0010° and the heading error is 0.0016°. The misalignment angle is estimated well in the maneuvering mode. The bias of the x-axis and y-axis accelerometer is 45.19 µg and 43.84 µg, respectively. Moreover, they are close to the bias value of 50 µg set by the simulation, which is explained that the accelerometer bias has been effectively estimated. The estimated constant drift of the x-axis and y-axis gyroscope is 0.043°/h and 0.061°/h, respectively. There is a certain gap between the constant drift of 0.006°/h set by the simulation, which is explained that the gyroscope constant drift is not well estimated.

5.4. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (Trapezoidal Path)

The initial attitude angles are assumed to be as follows: the pitch angle is 0°, the roll angle is 0° and the heading angle is 0°. When the influence of the trapezoidal maneuvering mode on the in-motion alignment is considered, the maneuvering trajectory is shown in Figure 9. The results of the attitude error and the constant error estimation for the gyroscope and accelerometer are shown in Figure 10 and Figure 11, respectively.

The attitude error, accelerometer bias and gyroscope drift were measured at 900 s. The pitch error is 0.0002°, the roll error is 0.0009° and the heading error is −0.0047°. The misalignment angle is estimated well in the maneuvering mode. The bias of the x-axis and y-axis accelerometer is 51.09 µg and 48.51 µg, respectively. Moreover, they are close to the bias value 50 µg set by the simulation, which is explained that the accelerometer bias was effectively estimated. The estimated constant drift of x-axis and y-axis gyroscopes is 0.0095°/h and 0.0096°/h, respectively. There is a certain gap between the constant drift of 0.006°/h set by the simulation, which shows that there is a certain error in the constant drift of the gyroscope estimated in the maneuvering mode.

5.5. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (S-Shaped Path)

The initial attitude angles are assumed to be as follows: the pitch angle is 0°, the roll angle is 0° and the heading angle is 0°. When the influence of the s-shaped maneuvering mode on the in-motion alignment is considered, the maneuvering trajectory is shown in Figure 12. The results of attitude error and constant error estimation for the gyroscope and accelerometer are shown in Figure 13 and Figure 14, respectively.

The pitch error is 0.0003°, the roll error is 0.0011° and the heading error is 0.0039° when the alignment ends at 900 s. The misalignment angle is estimated well in the maneuvering mode. The bias of the x-axis and y-axis accelerometer is 49.02 µg and 46.68 µg, respectively. Moreover, they are close to the bias value of 50 µg set by the simulation, which is explained that the accelerometer bias has been effectively estimated. The estimated constant drift of the x-axis and y-axis gyroscope is 0.0088°/h and 0.0022°/h, respectively. There is a certain gap between the constant drift of 0.006°/h set by the simulation, which shows that there is a certain error in the constant drift of the gyroscope estimated in the maneuvering mode.

The results of the alignment experiments between the three types of turning maneuvers are compared; it can be seen that, although the turning maneuver can have a positive effect on the estimation of the attitude misalignment angle and the IMU error, there are some differences in the effects of the motion path of the carrier, so the in-motion alignment effect is not only affected by the maneuver of the carrier but also by the path selection. Among the above three kinds of paths, the trapezoidal path has the best alignment effect, and the effect of the s-shaped path is better than that of the circular path. Hence, it is better to choose a trapezoidal path or an s-shaped path when practical conditions permit.

6. Conclusions

In-motion alignment method of SINS under geographic latitude uncertainty was proposed. The proposed method contains a method of latitude estimation and in-motion alignment method. Firstly, the latitude estimation algorithm based on the IDW-PT was designed. This IDW-PT can suppress and compensate for the interference of the carrier’s line vibration. Secondly, the in-motion alignment method based on the IKF was devised. The multi-fading factor is introduced into the KF to fade each data channel at different rates. The gain matrix can be adjusted adaptively to enhance the robustness of the model mismatch and system destabilization and accordingly achieve more accurate and stable estimation results. Finally, the simulation experiment was shown to prove that the proposed method can estimate the geographic latitude accurately and applies to the in-motion initial alignment. The mean and standard deviation of the estimated latitude can achieve −0.016° and 0.013° within 300 s. Under the turning maneuver conditions, the convergence accuracy and speed of the attitude misalignment angle and the inertial device error can be improved. Moreover, the trapezoidal path was shown to be the optimal maneuvering path. The pitch error is 0.0002°, the roll error is 0.0009° and the heading error is −0.0047° after the alignment ends at 900 s. Based on the simulation performance of the proposed method, it is expected to be applied in real-time application. The method can enhance the navigation performance and the dynamic performance of the carrier. In the future, further investigations should be developed for the more serious situation such as the large misalignment angle, non-horizontal path and multi-path combination.

Author Contributions

Conceptualization, J.S.; methodology, J.S.; software, Q.Y. and Y.L.; validation, J.S., Q.Y. and Y.L.; formal analysis, Q.Y.; investigation, Y.L.; writing—original draft preparation, J.S.; writing—review and editing, J.S.; funding acquisition, J.S. All authors have read and agreed to the published version of the manuscript.

Funding

This work was partially supported by the National Science Foundation of Jiangsu Province under Grant BK20200763, the Open Fund of State Key Laboratory of Ocean Engineering under Grant GKZD010084, the China Postdoctoral Science Foundation under Grant 2020M681685, the Postdoctoral Research Funding Project of Jiangsu Province under Grant 2021K161B and the Natural Science Research Project of Jiangsu Higher Education Institutions under Grant 19KJB510052.

Conflicts of Interest

The authors declare no conflict of interest.

References

Fang, J.C.; Wan, D.J. A fast initial alignment method for strapdown inertial navigation system on stationary base. IEEE Trans. Aerosp. Electron. Syst. 1996, 32, 1501–1504. [Google Scholar] [CrossRef]
Li, J.C.; Gao, W.; Zhang, Y.; Wang, Z.C. Gradient descent optimization-based self-alignment method for stationary SINS. IEEE Trans. Instrum. Meas. 2019, 68, 3278–3286. [Google Scholar] [CrossRef]
Sun, J.L.; Ma, S.H.; Wang, J.; Yang, J.; Liu, M. Reconciliation problem in polar integrated navigation considering coordinate frame transformation. IEEE Trans. Veh. Technol. 2020, 69, 10375–10379. [Google Scholar] [CrossRef]
Sun, Y.D.; Wang, L.H.; Cai, Q.Z.; Yang, G.L.; Wen, Z.Y. In-motion attitude and position alignment for odometer-aided SINS based on backtracking scheme. IEEE Access 2019, 7, 20211–20224. [Google Scholar] [CrossRef]
Pei, F.J.; Yang, S.; Yin, S. In-motion initial alignment using state-dependent extended kalman filter for strapdown inertial navigation system. IEEE Trans. Instrum. Meas. 2020, 70, 8500812. [Google Scholar] [CrossRef]
Zhang, T.; Zhu, Y.Y.; Xu, X.; Wang, J.; Li, Y. In-motion coarse alignment based on the vector observation for SINS. IEEE Trans. Instrum. Meas. 2019, 68, 3740–3750. [Google Scholar] [CrossRef]
Huang, Y.L.; Zhang, Y.G.; Chang, L.B. A new fast in-motion coarse alignment method for GPS-aided low-cost SINS. IEEE ASME Trans. Mechatron. 2018, 23, 1303–1313. [Google Scholar] [CrossRef]
Zhou, X.R.; Xu, X.; Yao, Y.Q.; Zhao, H.M. A robust quaternion kalman filter method for MIMU/GPS in-motion alignment. IEEE Trans. Instrum. Meas. 2021, 70, 8503109. [Google Scholar] [CrossRef]
Yan, G.M.; Yan, W.S.; Xu, D.M.; Jiang, H. SINS initial alignment analysis under geographic latitude uncertainty. Aerosp. Control 2008, 26, 31–34. [Google Scholar]
Wang, Y.G.; Yang, J.S.; Yang, B. SINS initial alignment of swaying base under geographic latitude uncertainty. J. Aviation. 2012, 33, 2322–2329. [Google Scholar]
Xu, X.; Xu, D.C.; Zhang, T.; Zhao, H.M. In-motion coarse alignment method for SINS/GPS using position loci. IEEE Sens. J. 2019, 19, 3930–3938. [Google Scholar] [CrossRef]
Lin, Y.S.; Miao, L.G.; Zhou, Z.Q. An improved MCMC-based particle filter for GPS-aided SINS in-motion initial alignment. IEEE Trans. Instrum. Meas. 2020, 69, 7895–7905. [Google Scholar] [CrossRef]
Luo, L.; Huang, Y.L.; Zhang, Z.; Zhang, Y.G. A position loci-based in-motion initial alignment method for low-cost attitude and heading reference system. IEEE Trans. Instrum. Meas. 2021, 70, 7500618. [Google Scholar] [CrossRef]
Xu, X.; Sun, Y.F.; Yao, Y.Q.; Zhang, T. A robust in-motion optimization-based alignment for SINS/GPS integration. IEEE Trans. Intell. Transp. Syst. 2021, 23, 4362–4372. [Google Scholar] [CrossRef]
Yan, Z.Y.; Zhang, C.X.; Yang, Y.Q.; Liang, J. A novel in-motion alignment method based on trajectory matching for autonomous vehicles. IEEE Trans. Veh. Technol. 2021, 70, 2231–2238. [Google Scholar] [CrossRef]
Sun, J.L.; Wu, Z.L.; Yin, Z.D.; Ma, B. A simplified GNSS tropospheric delay model based on the nonlinear hypothesis. GPS Solut. 2017, 21, 17351745. [Google Scholar] [CrossRef]
Saga, M.; Bulej, V.; Cubonova, N.; Kuric, I.; Virgala, I.; Eberth, M. Case study: Performance analysis and development of robotized screwing application with integrated vision sensing system for automotive industry. Int. J. Adv. Rob. Syst. 2020, 17, 303–310. [Google Scholar] [CrossRef]
Huang, Y.L.; Zhang, Y.G.; Wang, X.D. Kalman-filtering-based in-motion coarse alignment for odometer-aided SINS. IEEE Trans. Instrum. Meas. 2017, 66, 3364–3377. [Google Scholar] [CrossRef]
Tan, C.M.; Wei, G.; Gao, C.F.; Gao, X. In-motion alignment for Doppler velocity log-aided SINS based on initial velocity error estimation. IEEE Trans. Instrum. Meas. 2020, 69, 7877–7886. [Google Scholar] [CrossRef]
Xu, X.; Sun, Y.F.; Gui, J.; Yao, Y.Q.; Zhang, T. A fast robust in-motion alignment method for SINS with DVL aided. IEEE Trans. Veh. Technol. 2020, 69, 3816–3827. [Google Scholar] [CrossRef]
Xu, X.; Gui, J.; Sun, Y.F.; Yao, Y.Q.; Zhang, T. A robust in-motion alignment method with inertial sensors and Doppler velocity log. IEEE Trans. Instrum. Meas. 2021, 70, 8500413. [Google Scholar] [CrossRef]
Fu, Q.W.; Wu, F.; Li, S.H.; Liu, Y. In-motion alignment for a velocity-aided SINS with latitude uncertainty. IEEE ASME Trans. Mechatron. 2020, 25, 2893–2903. [Google Scholar] [CrossRef]
Luo, L.; Huang, Y.G.; Zhang, Z.; Zhang, Y.G. A new kalman filter-based in-motion initial alignment method for DVL-aided low-cost SINS. IEEE Trans. Veh. Technol. 2021, 70, 331–343. [Google Scholar] [CrossRef]
Wang, J.; Zhang, T.; Tong, J.W.; Li, Y. A fast SINS self-alignment method under geographic latitude uncertainty. IEEE Sens. J. 2020, 20, 2885–2894. [Google Scholar] [CrossRef]
Grewal, M.S.; Andrews, A.P. Kalman Filtering: Theory and Practice with MATLAB; John Wiley & Sons: Hoboken, NJ, USA, 2014. [Google Scholar]
Feng, D.Q.; Wang, C.Q.; He, C.L.; Zhuang, Y.; Xia, X.G. Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation. IEEE Internet Things J. 2020, 7, 3133–3146. [Google Scholar] [CrossRef]
Jiang, C.C.; Zhang, S.H.; Zhang, Q.Z. Adaptive estimation of multiple fading factors for GPS/INS integrated navigation systems. Sensors 2017, 17, 1254. [Google Scholar] [CrossRef] [Green Version]
Cui, B.B.; Wei, X.H.; Chen, X.Y.; Li, J.Y.; Li, L. On sigma-point update of cubature kalman filter for GNSS/INS under GNSS-challenged environment. IEEE Trans. Veh. Technol. 2019, 68, 8671–8682. [Google Scholar] [CrossRef]
Yi, J.X.; Wan, X.R.; Li, D.S. Exactly decoupled kalman filtering for multitarget state estimation with sensor bias. IEEE Trans. Aero. Elec. Sys. 2020, 56, 2256–2271. [Google Scholar] [CrossRef] [Green Version]
Yao, Y.Q.; Zhong, M.; Xu, X.S. DVL aided SINS coarse alignment solution with high dynamics. IEEE Access 2020, 8, 169922–169929. [Google Scholar] [CrossRef]

Figure 1. Geometric relationship diagram for the latitude estimation.

Figure 2. Integral dynamic window algorithm diagram.

Figure 3. Curves of latitude estimation error.

Figure 4. Attitude error of in-motion alignment of uniform linear motion.

Figure 5. Estimation values of IMU constant error (uniform linear motion).

Figure 6. Circular maneuver path.

Figure 7. Attitude error of in-motion alignment of circular maneuver.

Figure 8. Estimation values of IMU constant error (circular maneuver).

Figure 9. Trapezoidal maneuver path.

Figure 10. Attitude error of in-motion alignment of trapezoidal maneuver.

Figure 11. Estimation values of IMU constant error (trapezoidal maneuver).

Figure 12. S-shaped maneuver path.

Figure 13. Attitude error of in-motion alignment of s-shaped maneuver.

Figure 14. Estimation values of IMU constant error (s-shaped maneuver).

Table 1. Parameters settings of IMU.

Coordinate Axis	Gyroscope		Accelerometer
Coordinate Axis	$Constant Drift (° / h)$	$Random Drift (° / \sqrt{h})$	$Constant Bias (μ g)$	$Random Walk (μ g)$
x-axis	0.02	0.02	50	50
y-axis	0.02	0.02	50	50
z-axis	0.02	0.02	50	50

Table 2. Statistical results of latitude estimation errors.

Latitude Estimation Algorithm	0~100 (s)		100~200 (s)		200~300 (s)
Latitude Estimation Algorithm	Mean (°)	SD (°)	Mean (°)	SD (°)	Mean (°)	SD (°)
DW	3.638	9.286	0.175	0.772	−0.152	0.608
IDW	−3.424	8.853	−0.167	0.098	−0.099	0.062
IDW-PF	0.622	2.974	−0.031	0.016	−0.016	0.013

Table 3. Statistical results of uniform linear motion.

Parameters	Initial Heading Angle (°)				Mean	SD
Parameters	0	90	180	270	Mean	SD
$δ θ (°)$	0.0020	0.0011	0.0016	0.0028	0.0019	0.00072
$δ γ (°)$	−0.0026	−0.0022	−0.0004	−0.0020	−0.0018	0.00097
$δ Ψ (°)$	0.0698	0.0345	−0.0576	0.0569	0.0259	0.0572
$Δ_{x} (μ g)$	1.556	1.036	1.353	0.8352	1.195	0.3215
$Δ_{y} (μ g)$	−1.512	−1.550	−1.967	−1.306	−1.584	0.2771
$ε_{x} (° / h)$	−0.010	0.073	0.013	0.066	0.0355	0.0405
$ε_{y} (° / h)$	0.010	0.011	0.036	−0.010	0.0117	0.0188

Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

© 2022 by the authors. Licensee MDPI, Basel, Switzerland. This article is an open access article distributed under the terms and conditions of the Creative Commons Attribution (CC BY) license (https://creativecommons.org/licenses/by/4.0/).

Share and Cite

MDPI and ACS Style

Sun, J.; Ye, Q.; Lei, Y. In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty. Remote Sens. 2022, 14, 2581. https://doi.org/10.3390/rs14112581

AMA Style

Sun J, Ye Q, Lei Y. In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty. Remote Sensing. 2022; 14(11):2581. https://doi.org/10.3390/rs14112581

Chicago/Turabian Style

Sun, Jin, Qianqi Ye, and Yue Lei. 2022. "In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty" Remote Sensing 14, no. 11: 2581. https://doi.org/10.3390/rs14112581

APA Style

Sun, J., Ye, Q., & Lei, Y. (2022). In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty. Remote Sensing, 14(11), 2581. https://doi.org/10.3390/rs14112581

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

Article Menu

In-Motion Alignment Method of SINS Based on Improved Kalman Filter under Geographic Latitude Uncertainty

Abstract

1. Introduction

2. Latitude Estimation Based on IDW-PF under the In-Motion Condition

3. The Improved Kalman Filtering Algorithm

4. The Proposed In-Motion Alignment Method

5. Simulation Results and Discussions

5.1. Simulation Experiment of the Latitude Estimation Based on the IDW-PF

5.2. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Uniform Linear Motion

5.3. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (Circular Path)

5.4. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (Trapezoidal Path)

5.5. Simulation Experiment of Alignment Based on IKF When the Carrier Performs Turning Maneuver (S-Shaped Path)

6. Conclusions

Author Contributions

Funding

Conflicts of Interest

References

Share and Cite

Article Metrics

Article Access Statistics

Further Information

Guidelines

MDPI Initiatives

Follow MDPI