# Study on a Twice Transfer Alignment Based on Dual Model

Authors: Shuai Chen; Runwu Zhong; Xiaohui Liu; Ahmed Alsaedi
Journal: Discrete Dynamics in Nature and Society
 (2015)

---

## Abstract

This paper proposes a twice rapid transfer alignment algorithm based on dual models in order to solve the problems such as long convergence time, poor accuracy, and heavy computation burden resulting from the traditional nonlinear error models. The quaternion matching method based on quaternion error model along with the extended Kalman filter (EKF) is applied to deal with the large misalignment in the first phase. Then in the second transfer alignment phase, velocity plus attitude matching method as well as classical Kalman filter is adopted. The simulation and the results of vehicle tests demonstrate that this method combines the advantages of  both nonlinear and linear error models with the guarantee of accuracy and fastness.


---

## Body

## 1. Introduction

The technology of rapid transfer alignment for inertial navigation system with small attitude errors has been adequately studied in theoretical research and widely applied in engineering practice, satisfying the requirements of rapidity and high degree of accuracy [1]. However, the model is highly dependent on the small misalignment angles assumption and therefore is not applicable under the situation when the attitude errors become large. In this case, the traditional linear error model cannot accurately describe the error propagation characteristics of the inertial navigation system, which will inevitably degrade the performance of the filter, and sometimes even lead to instability and divergence. Consequently, some researchers studied the nonlinear error models [2–6] and proposed various kinds of nonlinear Kalman filters [7–11]. However, the state estimation of nonlinear error model has poor performance and a huge computing burden which requires a long time to converge. Hence, it cannot meet the requirements of stability and fastness.Obviously both of the two models have their own shortcomings. In this paper, we aim to find a transfer alignment algorithm appropriate for arbitrary misalignment angles, which has the advantages of fast convergent rate and high accuracy. A twice transfer alignment algorithm based on dual models is proposed in this paper, which combines the advantages of both nonlinear and linear error models.(A) Model Based on Additive Quaternion. The models are composed of the velocity error and the quaternion error propagation model, where the state variables can be presented as(1)
x
=
δ
q
δ
v
ε
∇
,where δ
q
=
δ
q
1
δ
q
2
δ
q
3
δ
q
4 is the quaternion error vector; δ
v
=
δ
v
e
δ
v
n
δ
v
u indicates velocity vector with respect to Earth in the navigation frame; ε
=
ε
x
ε
y
ε
z and ∇
=
∇
x
∇
y
∇
z are equivalent gyrodrift vector and equivalent accelerometer bias vector, respectively, in the body frame.The quaternion is widely used as an effective method to compute the attitude of INS (inertial navigation system). According to the relationship between quaternion errors and tilt angle, quaternion errors can be used to describe the attitude error. The quaternion and velocity error differential equation can be given as follows:(2)
δ
_
Q
˙
=
1
2
M
δ
_
Q
+
1
2
U
ε
b
+
W
g
b
-
1
2
Y
δ
ω
i
n
n
,
δ
v
˙
n
=
-
2
C
⌢
s
n
f
⌢
b
×
Y
T
δ
_
Q
+
2
C
⌢
s
n
f
⌢
b
Q
T
δ
_
Q
-
Y
T
U
f
⌢
b
+
C
⌢
s
n
∇
b
-
2
ω
i
e
n
+
ω
e
n
n
×
δ
v
n
-
2
ω
i
e
n
+
ω
e
n
n
×
v
n
,where δ
_
Q is the quaternion error vector; ω
i
n
n
=
ω
E
ω
N
ω
U is the rotation rate of the navigation frame with respect to the inertial frame defined in the navigation frame; ω
i
b
b
=
ω
x
ω
y
ω
z represents the rotational angular velocity of SINS (Slave Inertial Navigation System) with respect to the inertial frame defined in the SINS body frame; the matrices U, Y, and M can be presented as follows: (3)
U
=
-
q
1
-
q
2
-
q
3
q
0
-
q
3
q
2
q
3
q
0
-
q
1
-
q
2
q
1
q
0
,
Y
=
-
q
1
-
q
2
-
q
3
q
0
q
3
-
q
2
-
q
3
q
0
q
1
q
2
-
q
1
q
0
,
M
=
0
ω
E
-
ω
x
ω
N
-
ω
y
ω
U
-
ω
z
ω
x
-
ω
E
0
ω
z
+
ω
U
-
ω
y
-
ω
N
ω
y
-
ω
N
-
ω
z
-
ω
U
0
ω
x
+
ω
E
ω
z
-
ω
U
ω
y
+
ω
N
-
ω
x
-
ω
E
0
.
C
⌢
s
n is the indicated transformation matrix of SINS from the body frame to the navigation frame; f
⌢
b indicates specific force of SINS in its body frame; ω
i
e
n is the rotation rate of the Earth with respect to the inertial frame defined in the navigation frame; ω
e
n
n is the turn rotational angular velocity of the navigation frame with respect to the Earth; v
n
=
v
e
v
n
v
u indicates velocity vector of SINS with respect to Earth in the navigation frame; Y
T
U
f
⌢
b is the nonlinear term in the equation of velocity error.(B) Model of Rapid Transfer Alignment. This model was presented by Kain and Cloutier in [1]. The state variables are presented as(4)
x
=
φ
n
δ
V
n
ε
i
∇
i
λ
i
,where φ
=
φ
x
φ
y
φ
z is defined as the rotation vector error between the true navigation frame n and the indicated navigation frame n
′. If φ is sufficiently small, the state equation can be expressed as follows:(5)
δ
V
˙
n
=
f
n
×
φ
n
-
(
2
δ
ω
i
e
n
+
δ
ω
e
n
n
)
×
V
n
-
(
2
ω
i
e
n
+
ω
e
n
n
)
×
δ
V
n
+
C
b
n
∇
i
,
φ
˙
n
=
-
ω
i
n
n
×
φ
n
+
δ
ω
i
n
n
+
C
b
n
ε
i
,
ε
˙
i
=
0
,
∇
˙
i
=
0
,
ζ
˙
i
=
0
,where φ
n and δ
V
n are the attitude error and velocity error vectors, respectively; V
n indicates velocity vector in the navigation frame; f
n indicates specific force in the navigation frame; ω
i
e
n is the Earth rate vector; ω
e
n
n is the turn rate of the navigation frame with respect to the Earth; C
b
n is the direction cosine matrix of SINS; ε
i and ∇
i (i
=
x
,
y
,
z) are equivalent gyrodrift vector and equivalent accelerometer bias vector, respectively, in the body frame; ζ
i (i
=
x
,
y
,
z) is 3-axis component of INS installation error angle vector in the body frame.(C) Transfer Alignment Based on Dual Model. By a large amount of simulation tests, we find out that attitude error can quickly converge to small angles when the error model based on quaternion is used under the condition of large misalignment angle. However, it still takes a long time to converge to a satisfactory accuracy. In this case, we intend to switch to the linear model to obtain faster convergence speed and higher accuracy. This approach is called a twice transfer alignment based on dual model. This method uses nonlinear model in first phase. Then after the estimation of attitude error converging to small angles, the linear error model is adopted to complete the twice transfer alignment.


## 2. Experimental Results

### 2.1. Simulation and Results

The simulation is performed in two different cases. In Case A, model based quaternion and EKF which is easily realized in engineering project are adopted in the first phase. Through analyzing the performance of the nonlinear system by simulation experiments, the time point to switch to linear error model and classical Kalman filter in the next stage is decided at the 10th second. In Case B, model based additive quaternion and EKF are utilized. The initial attitude errors in roll, pitch, and heading are all assumed to be 20°. The total time of the simulation is 60 s; the initial position is set at 32.5 degrees north latitude, 135 degrees east longitude, 500 meters height; the initial attitudes are all set at 0°; the initial north velocity is 50 m/s; east and vertical velocities are 0 m/s. The constant gyrodrifts and accelerometer biases are set at 10°/h, 5 mg, respectively. The simulation results are shown in Figures1-2 and Table 1.Table 1
Alignment accuracy comparison.
Estimated error of attitude (°)
Pitch
Roll
Yaw
Case A
0.002
0.001
0.005
Case B
0.12
0.22
0.18Figure 1
The attitude estimation error of first phase.
(a)
(b)
(c)Figure 2
The attitude estimation error of second phase.
(a)
(b)
(c)Figure1 shows the alignment results in the first phase. The figures indicate that the attitude estimation error gets well into the range of the ideal accuracy during the first 10 s. After the calibration is done, the conventional transfer alignment process will work well in the following 50 s.Figure2 and Table 1 compare the attitude estimation error in Case A with that in Case B. It is clear that the red curves not only have higher rate of convergence, but also are smoother than blue curves. In particular, the red curves all converge within 0.005°. Instead, the blue curves fluctuate within a range of 0.22°. The results show that the dual model has obviously a faster convergent speed and higher accuracy than that in Case B.


### 2.2. Vehicle Test and Results

In order to verify the performance of the proposed algorithm, vehicle tests are conducted [12–14]. The test configuration is illustrated in Figure 3. A slab and four steel dowels are machined which could be used to artificially misalign the SINS from the MINS (Master Inertial Navigation System) in pitch, roll, and yaw. In practical engineering, the model based additive quaternion is difficult to establish. However, if the rough misalignment is known, the attitude of SINS can be calibrated directly and the first phase can be skipped, which means a twice transfer alignment can be directly conducted with the rough misalignment. The performance of transfer alignment is assessed with different assumed misalignments. Figure 4 illustrates the alignment results.Figure 3
SINS and MINS of the vehicle test.Figure 4
Curve of the vehicle results.
(a)
(b)
(c)In Figure3, the SINS and MINS are bolted to the slab in the test. The steel dowels are used to establish misalignments in three axes intentionally. In the test, the misalignments in pitch, roll, and yaw are set at about 10°, 0°, and 33°, respectively. The positive roll and return-to-level maneuver is adopted in tests, which can be called wing-rock maneuver. Once transfer alignment begins, one end of the slab is manually tilted up and set back down in the vehicle.Figure4 compares the estimated attitude misalignments in three axes, when the assumed misalignments used to calibrate attitude of SINS are different. In the figure, attitude misalignments are accurately estimated in spite of the fact that the assumed misalignments are different. The deviation of the estimated value is less than 0.1°.


## 2.1. Simulation and Results

The simulation is performed in two different cases. In Case A, model based quaternion and EKF which is easily realized in engineering project are adopted in the first phase. Through analyzing the performance of the nonlinear system by simulation experiments, the time point to switch to linear error model and classical Kalman filter in the next stage is decided at the 10th second. In Case B, model based additive quaternion and EKF are utilized. The initial attitude errors in roll, pitch, and heading are all assumed to be 20°. The total time of the simulation is 60 s; the initial position is set at 32.5 degrees north latitude, 135 degrees east longitude, 500 meters height; the initial attitudes are all set at 0°; the initial north velocity is 50 m/s; east and vertical velocities are 0 m/s. The constant gyrodrifts and accelerometer biases are set at 10°/h, 5 mg, respectively. The simulation results are shown in Figures1-2 and Table 1.Table 1
Alignment accuracy comparison.
Estimated error of attitude (°)
Pitch
Roll
Yaw
Case A
0.002
0.001
0.005
Case B
0.12
0.22
0.18Figure 1
The attitude estimation error of first phase.
(a)
(b)
(c)Figure 2
The attitude estimation error of second phase.
(a)
(b)
(c)Figure1 shows the alignment results in the first phase. The figures indicate that the attitude estimation error gets well into the range of the ideal accuracy during the first 10 s. After the calibration is done, the conventional transfer alignment process will work well in the following 50 s.Figure2 and Table 1 compare the attitude estimation error in Case A with that in Case B. It is clear that the red curves not only have higher rate of convergence, but also are smoother than blue curves. In particular, the red curves all converge within 0.005°. Instead, the blue curves fluctuate within a range of 0.22°. The results show that the dual model has obviously a faster convergent speed and higher accuracy than that in Case B.


## 2.2. Vehicle Test and Results

In order to verify the performance of the proposed algorithm, vehicle tests are conducted [12–14]. The test configuration is illustrated in Figure 3. A slab and four steel dowels are machined which could be used to artificially misalign the SINS from the MINS (Master Inertial Navigation System) in pitch, roll, and yaw. In practical engineering, the model based additive quaternion is difficult to establish. However, if the rough misalignment is known, the attitude of SINS can be calibrated directly and the first phase can be skipped, which means a twice transfer alignment can be directly conducted with the rough misalignment. The performance of transfer alignment is assessed with different assumed misalignments. Figure 4 illustrates the alignment results.Figure 3
SINS and MINS of the vehicle test.Figure 4
Curve of the vehicle results.
(a)
(b)
(c)In Figure3, the SINS and MINS are bolted to the slab in the test. The steel dowels are used to establish misalignments in three axes intentionally. In the test, the misalignments in pitch, roll, and yaw are set at about 10°, 0°, and 33°, respectively. The positive roll and return-to-level maneuver is adopted in tests, which can be called wing-rock maneuver. Once transfer alignment begins, one end of the slab is manually tilted up and set back down in the vehicle.Figure4 compares the estimated attitude misalignments in three axes, when the assumed misalignments used to calibrate attitude of SINS are different. In the figure, attitude misalignments are accurately estimated in spite of the fact that the assumed misalignments are different. The deviation of the estimated value is less than 0.1°.


## 3. Conclusion

In order to satisfy the requirements of rapidity and high accuracy in transfer alignment with large uncertainty, a transfer alignment algorithm based on dual model is presented. The simulation and vehicle test results demonstrate that this method could combine the advantages of nonlinear and linear error models which not only can be used in inertial navigation system with large uncertainty but also has the same high accuracy as the linear system.



---

*Source: 943065-2015-10-04.xml*