Open AccessArticle

An Improved Coarse Alignment Algorithm for Odometer-Aided SINS Based on the Optimization Design Method

Yonggang Zhang

Li Luo

^*,

Tao Fang

Ning Li

and

Guoqing Wang

College of Automation, Harbin Engineering University, Harbin 150001, China

Author to whom correspondence should be addressed.

Sensors 2018, 18(1), 195; https://doi.org/10.3390/s18010195

Submission received: 2 November 2017 / Revised: 24 December 2017 / Accepted: 10 January 2018 / Published: 11 January 2018

(This article belongs to the Special Issue Inertial Sensors for Positioning and Navigation)

Download

Browse Figures

Versions Notes

Abstract

An improved coarse alignment (ICA) algorithm is proposed in this paper with a focus on improving alignment accuracy of odometer-aided strapdown inertial navigation system (SINS) under variable velocity and variable acceleration condition. In the proposed algorithm, the outputs of inertial sensors and odometer in a sampling interval are linearized rather than assumed to be a constant, which improves the accuracy of the vector observations and the precision of coarse alignment. Simulation and field test results illustrate that, under variable velocity and variable acceleration condition, the proposed algorithm can obtain a better alignment performance than conventional coarse alignment method.

Keywords:

odometer-aided SINS; linear approximation; coarse alignment; optimized alignment

1. Introduction

[-15]Strapdown inertial navigation system (SINS) can autonomously, continuously and comprehensively provide the position, velocity, and attitude of the carrier [1,2,3,4]. The performance of SINS depends on the accuracy and rapidity of the initial alignment process, which can be divided into coarse alignment and fine alignment [5,6]. Coarse alignment is important since it provides a rapidly alignment result for the fine alignment. The existing algorithms of the coarse alignment mainly include: analytic coarse alignment [7,8,9], inertial frame coarse alignment (IFCA) [10,11], and coarse alignment based on Davenport’s q method [12,13,14,15,16]. The analytic coarse alignment can only be used on static base. In order to solve moving base coarse alignment problem, some IFCA algorithms have been proposed. In [13], Li et al. proposes a fast SINS initial alignment method based on IFCA with the aid of external reference velocity. However, this algorithm has the problem of large random errors. In [15,17,18], the optimization-based alignment (OBA) method with the aid of external reference information provided by Global Navigation Satellite System (GNSS) is proposed. The OBA algorithm obtains optimal attitude matrix through the q method to reduce random errors of attitude angles, however, these algorithms in [15,17] are not suitable for odometer-aided SINS, since the odometer can only provide the velocity in body frame. To solve this problem, the OBA algorithm with the aid of external velocity provided by odometer is reported in [19,20,21]. However, the outputs of inertial sensors and odometer in one sampling interval are assumed to be a constant, which may result in errors of coarse alignment when the velocity and acceleration change.

In order to improve the alignment performance under changeable velocity and acceleration, an improved coarse alignment (ICA) algorithm for SINS aided by odometer is proposed in this paper. The main contribution is that the outputs of inertial sensors and odometer that are assumed to be a constant in a sampling interval in [15,17,19] are replaced by their linear approximations to improve the accuracy of the integral formulae of vector observations. Experimental results show that the proposed ICA algorithm has better accuracy than the OBA algorithm and the traditional IFCA algorithm especially when the velocity and acceleration change, which is more suitable for coarse alignment of odometer-aided SINS.

This paper is organized as follows. Section 2 introduces the OBA algorithm for odometer-aided SINS. Section 3 derives the proposed ICA algorithm with linear approximation of inertial sensors and odometer. Simulation results and field test results are reported in Section 4. Finally, conclusions are drawn in Section 5.

2. OBA Algorithm for Odometer-Aided SINS

The coarse alignment aims at determining a coordinate transformation matrix

C_{b}^{n} (t)

in a short time, where n denotes the local level navigation frame and b denotes the body frame, respectively. In this paper, we denote by i the inertial frame and e the earth frame. The kinematic equations of navigation are known as [1,15,19]

{\dot{C}}_{b}^{n} = C_{b}^{n} ω_{n b}^{b} \times

(1)

{\dot{v}}^{n} = C_{b}^{n} f^{b} - (2 ω_{i e}^{n} + ω_{e n}^{n}) \times v^{n} + g^{n}

(2)

where

v^{n}

denotes the ground velocity in the navigation frame,

ω_{i e}^{n}

is the earth rotation angular velocity,

ω_{e n}^{n}

denotes the angular rate of the navigation fame with respect to the earth frame, and

f^{b}

is the specific force measured by accelerometers.

ω_{i b}^{b}

is the body angular rate measured by gyroscope, and

ω_{n b}^{b} = ω_{i b}^{b} - C_{n}^{b} (ω_{i e}^{n} + ω_{e n}^{n})

represents the angular rate of the body frame with respect to the navigation frame. Moreover,

g^{n}

denotes the local gravity acceleration, and

(\cdot \times)

denotes the cross product matrix. According to the chain rule, the attitude transformation matrix can be decomposed as

C_{b}^{n} (τ) = C_{n (0)}^{n (τ)} C_{b}^{n} (0) C_{b (τ)}^{b (0)}

(3)

where

C_{b (τ)}^{b (0)}

and

C_{n (τ)}^{n (0)}

denote the change of body frame and navigation frame from time 0 to

τ

, respectively. They are calculated by the following differential equations

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

(4)

{\dot{C}}_{n (τ)}^{n (0)} = C_{n (τ)}^{n (0)} ω_{i n}^{n} \times

(5)

where

ω_{i n}^{n} = ω_{i e}^{n} + ω_{e n}^{n}

denotes the angular rate of the navigation frame with respect to the inertial frame.

After obtaining the attitude matrixes

C_{b (τ)}^{b (0)}

and

C_{n (τ)}^{n (0)}

by Equations (4) and (5), the key problem to determine

C_{b}^{n} (τ)

is to obtain the constant matrix

C_{b}^{n} (0)

. The specific force Equation (2) is used as the measurement equation in the OBA algorithm with the aid of velocity in navigation frame, such as GNSS, and it can be rewritten as follows if the velocity is provided in body frame, such as the odometer

\begin{matrix} C_{b}^{n} (τ) [{\dot{v}}^{b} (τ) - f^{b} (τ) + (ω_{i b}^{b} (τ) + ω_{i e}^{b} (τ)) \times v^{b} (τ)] = g^{n} \end{matrix}

(6)

Substituting (3) into (6) and integrating the specific force equation from time interval 0 to t, we have

\begin{matrix} C_{b}^{n} (0) [C_{b (t)}^{b (0)} v^{b} (t) - v^{b} (0) - \int_{0}^{t} C_{b (τ)}^{b (0)} (f^{b} (τ) - ω_{i e}^{b} (τ) \times v^{b} (τ)) d τ] = \int_{0}^{t} C_{n (τ)}^{n (0)} g^{n} d τ \end{matrix}

(7)

Equation (7) can also be rewritten in a compact form as

C_{b}^{n} (0) α_{Δ v} (t) = β_{Δ v} (t)

(8)

where

\begin{matrix} α_{Δ v} (t) & ≜ & C_{b (t)}^{b (0)} v^{b} (t) - v^{b} (0) - \int_{0}^{t} C_{b (τ)}^{b (0)} f^{b} (τ) d τ + \int_{0}^{t} C_{b (τ)}^{b (0)} (ω_{i e}^{b} (τ) \times v^{b} (τ)) d τ \end{matrix}

(9)

\begin{matrix} β_{Δ v} (t) & ≜ & \int_{0}^{t} C_{n (τ)}^{n (0)} g^{n} d τ \end{matrix}

(10)

The next step is to calculate the vector observations

α_{Δ v} (t)

and

β_{Δ v} (t)

. In [15,17,19], the output of accelerometer

f^{b}

, the output of gyroscope

ω_{i b}^{b}

and the output of odometer

v^{b}

are all assumed to be constants in a sampling interval, which may result in errors in

α_{Δ v} (t)

when velocity and acceleration are changing. Next we will propose an ICA algorithm by linearizing these outputs in sampling intervals.

3. ICA Algorithm for Odometer-Aided SINS

In the following, T represents the time period of the update interval

[t_{k}, t_{k + 1}]

k = 1, . . ., M - 1

, and the current time is

t = t_{M} = M T

, where M is the sampling number. Ignoring the change of gravity acceleration

g^{n}

, the vector observation

β_{Δ v} (t)

is written as

β_{Δ v} (t) = \int_{0}^{t} C_{n (τ)}^{n (0)} g^{n} d τ = \sum_{k = 1}^{M - 1} C_{n (t_{k})}^{n (0)} \int_{t_{k}}^{t_{k + 1}} C_{n (τ)}^{n (t_{k})} g^{n} d τ

(11)

Since the angular rate of navigation frame with respect to inertial frame changes slowly,

C_{n (τ)}^{n (t_{k})}

can be approximated as [15]

C_{n (τ)}^{n (t_{k})} = I_{3 \times 3} + \frac{sin (∥ φ_{n} ∥)}{∥ φ_{n} ∥} (φ_{n} \times) + \frac{1 - cos (∥ φ_{n} ∥)}{∥ φ_{n} ∥^{2}} {(φ_{n} \times)}^{2} \approx I_{3 \times 3} + φ_{n} \times

(12)

where

φ_{n}

denotes the navigation frame rotation vector from

t_{k}

τ

, and

φ_{n}

is approximated as

φ_{n} \approx \int_{t_{k}}^{τ} ω_{i n}^{n} (t) d t \approx (τ - t_{k}) ω_{i n}^{n} (t_{k})

(13)

Substituting Equations (12) and (13) into Equation (11) yields

β_{Δ v} (t_{M}) = \sum_{k = 1}^{M - 1} C_{n (t_{k})}^{n (0)} (T I_{3 \times 3} + \frac{T^{2}}{2} ω_{i n}^{n} (t_{k}) \times) g^{n}

(14)

The first integral term in Equation (9) can be written as

\begin{matrix} α_{Δ v 1} (t_{M}) & = & \int_{0}^{t} C_{b (τ)}^{b (0)} f^{b} (τ) d τ \\ = & \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} \int_{t_{k}}^{t_{k + 1}} C_{b (τ)}^{b (t_{k})} f^{b} (τ) d τ \\ \approx & \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} \int_{t_{k}}^{t_{k + 1}} (I_{3 \times 3} + (\int_{t_{k}}^{τ} ω_{i b}^{b} (t) d t) \times) f^{b} (τ) d τ \end{matrix}

(15)

In order to improve the accuracy of the vector observations, we make a linear approximation for the outputs

f^{b}

and

ω_{i b}^{b}

of SINS. Suppose that

f^{b}

changes linearly during the period of

[t_{k}, t_{k + 1}]

and can be approximated as

f^{b} (t) = a_{f} \cdot t + b_{f}

(16)

Then

a_{f}

and

b_{f}

can be calculated by using Equations (17) and (18)

\begin{matrix} a_{f} & = & \frac{f^{b} (t_{k + 1}) - f^{b} (t_{k})}{T} \end{matrix}

(17)

\begin{matrix} b_{f} & = & f^{b} (t_{k}) - \frac{f^{b} (t_{k + 1}) - f^{b} (t_{k})}{T} t_{k} \end{matrix}

(18)

Similarly,

ω_{i b}^{b}

can be approximated as a linear form

ω_{i b}^{b} (t) = a_{ω} \cdot t + b_{ω}

(19)

where

\begin{matrix} a_{ω} & = & \frac{ω_{i b}^{b} (t_{k + 1}) - ω_{i b}^{b} (t_{k})}{T} \end{matrix}

(20)

\begin{matrix} b_{ω} & = & ω_{i b}^{b} (t_{k}) - \frac{ω_{i b}^{b} (t_{k + 1}) - ω_{i b}^{b} (t_{k})}{T} t_{k} \end{matrix}

(21)

Substituting Equations (16) and (19) into Equation (15), we obtain

\begin{matrix} α_{Δ v 1} (t_{M}) & = \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} \int_{t_{k}}^{t_{k + 1}} [I_{3 \times 3} + (\int_{t_{k}}^{τ} a_{ω} t + b_{ω} d t) \times] (a_{f} τ + b_{f}) d τ \\ = \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} [\frac{T}{2} (f^{b} (t_{k + 1}) + f^{b} (t_{k})) + (\frac{T^{2}}{24} ω_{i b}^{b} (t_{k + 1}) + \frac{T^{2}}{8} ω_{i b}^{b} (t_{k})) \times f^{b} (t_{k}) \\ + (\frac{T^{2}}{8} ω_{i b}^{b} (t_{k + 1}) + \frac{5}{24} T^{2} ω_{i b}^{b} (t_{k})) \times f^{b} (t_{k + 1})] \end{matrix}

(22)

The output

v^{b}

of the odometer contained in the second integral in (9) can also be approximated as

v^{b} (t) = a_{v} \cdot t + b_{v}

(23)

Then

a_{v}

and

b_{v}

can be calculated through Equations (24) and (25)

\begin{matrix} a_{v} & = & \frac{v^{b} (t_{k + 1}) - v^{b} (t_{k})}{T} \end{matrix}

(24)

\begin{matrix} b_{v} & = & v^{b} (t_{k}) - \frac{v^{b} (t_{k + 1}) - v^{b} (t_{k})}{T} t_{k} \end{matrix}

(25)

The term

ω_{i e}^{b}

is calculated as follows

ω_{i e}^{b} (t_{k + 1}) = C_{n}^{b} (t_{k}) ω_{i e}^{n} (t_{k + 1})

(26)

Substituting Equations (19), (23) and (26) into Equation (9), the second integral term in (9) can be approximated as

\begin{matrix} α_{Δ v 2} (t_{M}) & = \int_{0}^{t} C_{b (τ)}^{b (0)} (ω_{i e}^{b} (τ) \times v^{b} (τ)) d τ \\ \approx \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} \int_{t_{k}}^{t_{k + 1}} [I_{3 \times 3} + (\int_{t_{k}}^{τ} a_{ω} t + b_{ω} d t) \times] (ω_{i e}^{b} (t_{k + 1}) \times (a_{v} τ + b_{v})) d τ \\ = \sum_{k = 1}^{M - 1} C_{b (t_{k})}^{b (0)} [\frac{T}{2} (C_{n}^{b} (t_{k}) ω_{i e}^{n} (t_{k + 1})) \times (v^{b} (t_{k + 1}) + v^{b} (t_{k})) \\ + (\frac{T^{2}}{24} ω_{i b}^{b} (t_{k + 1}) + \frac{T^{2}}{8} ω_{i b}^{b} (t_{k})) \times ((C_{n}^{b} (t_{k}) ω_{i e}^{n} (t_{k + 1})) \times v^{b} (t_{k})) \\ + (\frac{T^{2}}{8} ω_{i b}^{b} (t_{k + 1}) + \frac{5}{24} T^{2} ω_{i b}^{b} (t_{k})) \times ((C_{n}^{b} (t_{k}) ω_{i e}^{n} (t_{k + 1})) \times v^{b} (t_{k + 1}))] \end{matrix}

(27)

The vector observation

α_{Δ v} (t_{M})

is abbreviated as

α_{Δ v} (t_{M}) = C_{b (t_{M})}^{b (0)} v^{b} (t_{M}) - v^{b} (0) - α_{Δ v 1} (t_{M}) + α_{Δ v 2} (t_{M})

(28)

Then the discrete measurement equation can be rewritten in a compact form

C_{b}^{n} (0) α_{Δ v} (t_{M}) = β_{Δ v} (t_{M}), (M = 1, 2, 3, \dots)

(29)

After obtaining the vector observations, the measurement Equation (29) can be solved by the

q

method. The constant matrix

C_{b}^{n} (0)

can be formulated by its corresponding quaternion

q_{b}^{n} = q = {[\begin{matrix} s & η^{T} \end{matrix}]}^{T}

, subject to

q^{T} q = 1

C_{b}^{n} (0) = (s^{2} - η^{T} η) I_{3 \times 3} + 2 η η^{T} - 2 s (η \times)

(30)

where s is scalar part and

η

is the vector part. The vector observations can be written in the form of quaternion

\begin{matrix} α_{Δ V} (t_{M}) & = & {[\begin{matrix} 0 & α_{Δ v} {(t_{M})}^{T} \end{matrix}]}^{T} \end{matrix}

(31)

\begin{matrix} β_{Δ V} (t_{M}) & = & {[\begin{matrix} 0 & β_{Δ v} {(t_{M})}^{T} \end{matrix}]}^{T} \end{matrix}

(32)

It is convenient to make Equation (29) equivalent to

β_{Δ V} (t_{M}) = q \circ α_{Δ V} (t_{M}) \circ q *

, where ∘ denotes the quaternion multiplication and

q *

is the conjugate quaternion of

q

. The quaternion multiplication matrix is defined as

\overset{+}{q} ≜ [\begin{matrix} s & - η^{T} \\ η & s I_{3 \times 3} + (η \times) \end{matrix}], \bar{q} ≜ [\begin{matrix} s & - η^{T} \\ η & s I_{3 \times 3} - (η \times) \end{matrix}]

(33)

Then we have the equivalent measurement equation [12,15]

[[\overset{+}{β_{Δ V} (t_{M})}] - [\bar{α_{Δ V} (t_{M})}]] q = 0 .

(34)

Thus, the attitude quaternion can be determined by solving the following optimization problem

J ≜ min_{q} q^{T} K q

(35)

where

K ≜ \sum_{M} {[[\overset{+}{β_{Δ V} (t_{M})}] - [\bar{α_{Δ V} (t_{M})}]]}^{T} [[\overset{+}{β_{Δ V} (t_{M})}] - [\bar{α_{Δ V} (t_{M})}]]

(36)

It can be proved that J in Equation (35) will be minimized if

q

is chosen to be the eigenvector corresponding to the smallest eigenvalue of

K

, which is the optimal quaternion related to

C_{b}^{n} (0)

[15,18]. The block diagram of the ICA algorithm is shown in Figure 1. In Figure 1, LA denotes the process of linear approximation for the outputs of inertial sensors and odometer, AUb and AUn denote update processes of attitude matrix

C_{b (t_{k + 1})}^{b (0)}

and attitude matrix

C_{n (t_{k + 1})}^{n (0)}

, respectively, and the q method is used to calculate the attitude matrix

C_{b}^{n} (0)

. According to the chain rule, the attitude matrix

C_{b}^{n} (t_{k + 1})

can be updated in real time by Equation (3). In conclusion, the attitude matrix

C_{b}^{n} (t_{M})

can be calculated through the ICA algorithm in real time by Equations (3)–(5) and (29).

4. Simulation and Test

4.1. Simulation Results

We first give simulation results under variable velocity and acceleration condition for coarse alignment of odometer-aided SINS using the proposed ICA algorithm. In order to verify the performance of the ICA algorithm, the in-motion model with severe maneuvering was built. The swing motion are set as sine functions

\begin{matrix} θ & = & A_{θ} sin (2 π t / T_{θ} + P h_{θ}) + θ_{p} \\ γ & = & A_{γ} sin (2 π t / T_{γ} + P h_{γ}) + γ_{r} \\ φ & = & A_{φ} sin (2 π t / T_{φ} + P h_{φ}) + φ_{h} \end{matrix}

(37)

where

A_{θ}

A_{γ}

and

A_{φ}

are the amplitudes and set as

10^{\circ}

11^{\circ}

, and

12^{\circ}

, respectively.

T_{θ}

T_{γ}

and

T_{φ}

are swing periods, which are set as

10 s

9 s

and

8 s

, respectively.

P h_{θ}

P h_{γ}

and

P h_{φ}

are initial phases and they are random values in the range from 0 radian to

2 π

radian,

θ_{p}

γ_{r}

and

γ_{h}

are initial attitude angles and they are random values in the range from

0^{\circ}

50^{\circ}

. The initial parameters of the simulation are shown in Table 1. As is shown in Table 1, the random error of the gyroscope and accelerometer are set as Gaussian white noise, and the standard deviation of the gyroscope noise and accelerometer noise are

0 . 05^{\circ} / h / \sqrt{HZ}

and

10^{- 4} g / \sqrt{Hz}

, respectively.

In order to simulate the condition of variable velocity and variable acceleration, the velocity of the vehicle is set as a sine-cosine function in the navigation frame, and the velocity of the vehicle is shown in Figure 2.

The first simulation lasts about 150 s under the condition of variable velocity and variable acceleration, and the simulation results of the OBA algorithm and the proposed ICA algorithm are shown in Figure 3. Figure 3 shows that the errors of the roll angle and pitch angle are all less than

0 . 1^{\circ}

after 10 s, and the heading error obtained by the proposed ICA algorithm is less than

2^{\circ}

after 80 s. Compared with the OBA algorithm, the heading angle calculated by the ICA algorithm can obtain more accurate results with faster convergence speed.

To further show the advantage of the proposed algorithm, 50 coarse alignment trials are performed. Each coarse alignment lasts 100 s, and the final attitude angles are chosen as the alignment results. Figure 4 gives the results of the three kinds of typical coarse alignment algorithms. The black line denotes the results of the proposed ICA algorithm, the green line denotes the results of the OBA algorithm aided by odometer [19], and the red line denotes the results of the traditional IFCA method (TIFCA) aided by odometer [13]. The statistics of the attitude angle errors through three algorithms are shown in Table 2.

Figure 4 and Table 2 show that the errors of the level attitude angle, pitch angle and roll angle, are all less than

0 . 05^{\circ}

. However, the TIFCA algorithm and the OBA algorithm have a poor performance on heading alignment, and we can see from Table 2 that the heading error of the two algorithms are more than

4^{\circ}

and standard deviation is greater than

2^{\circ}

. The heading error of the proposed ICA algorithm is less than

1 . 67^{\circ}

at 100 s, and the standard deviation reduces to

0 . 622^{\circ}

. The standard deviation of the heading angel error adopting ICA algorithm is obviously smaller than the other two algorithms. Both pitch and roll angles can be accurate and quickly obtained by all algorithms, and there is no big difference in the results. The difficulty of coarse alignment is the estimation of the heading angle, especially on variable velocity and variable acceleration condition. As is shown in simulation results, compared with the TIFCA algorithm and OBA algorithm, the proposed algorithm has a better alignment performance under the condition of variable velocity and variable acceleration.

4.2. Test Results

In order to verify the validity of the proposed ICA algorithm in practice, we carried out a field test to verify the performance of the ICA algorithm. As is shown in Figure 5, the self-made fiber-optic-SINS (FSINS) and photonics inertial navigation system (PHINS) are installed together on a reference platform inside the car, and the GPS antenna is installed outside on the top of the car. The position of the experiment is

126 . 67^{\circ} E

and

45 . 78^{\circ} N

. The initial position for each coarse alignment is provided by GPS, and the ground velocity

v^{b}

in the body frame is provided by the odometer. The specific force

f^{b}

and the body angler rate

ω_{i b}^{b}

are provided by FSINS, and the FSINS is equipped with gyroscopes (drift

0 . 01^{\circ} / h

, noise

0 . 03^{\circ} / h / \sqrt{Hz}

) and accelerometers (bias

10^{- 4} g

, noise

10^{- 5} g / \sqrt{Hz}

). The attitude angles provided by the GPS/PHINS integrated navigation system are used as the attitude reference, and the specifications of GPS/PHINS integrated navigation system are listed in Table 3. The car was moving severely with the change of velocity and acceleration. We carried out four coarse alignments, and each alignment data segment lasts 100 s with the feature of variable velocity and variable acceleration. Figure 6 shows the velocity changes of four segments.

The coarse alignment results of three algorithms are listed in Table 4, Table 5 and Table 6, in which final attitude angle errors of four coarse alignments are defined as the differences between final attitude angles of three algorithms and the outputs of the reference. As is shown in Table 4 and Table 5, the level attitude errors of three algorithms all reduce to values less than

0 . 05^{\circ}

100 s

, which fulfill the accuracy requirement of coarse alignment. Table 6 shows the final heading angle errors of four segments. As is shown in Table 6, the heading angle errors of the four segments obtained by the proposed ICA algorithm are all smaller than the other two algorithms. In conclusion, under the variable velocity and variable acceleration condition, the ICA algorithm has a better performance in coarse alignment of odometer-aided SINS, and the test results coincide with the simulation results.

5. Conclusions

To overcome the performance degradation of the existing TIFCA and OBA algorithms under variable velocity and variable acceleration conditions, a novel improved coarse alignment algorithm for odometer-aided SINS is proposed in this paper. By constructing the vector observations with a linear approximation of sensors’ outputs, the proposed algorithm is able to obtain better accuracy than existing TIFCA and OBA algorithms. Simulation results and field tests verified the performance that the proposed algorithm can obtain smaller heading angle errors, which is more suitable for odometer-aided SINS coarse alignment.

Acknowledgments

This work was supported by the National Natural Science Foundation of China under Grant Nos. 61773133 and 61633008 and the Natural Science Foundation of Heilongjiang Province Grant No. F2016008. The authors would like to thank all the editors and anonymous reviewers for improving this article.

Author Contributions

Yonggang Zhang and Li Luo conceived and designed the experiments; Li Luo performed the experiment; Yonggang Zhang contributed experiment tools and analyzed the data; Li Luo, Tao Fang, Ning Li and Guoqing Wang wrote the paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

Tang, Y.; Wu, Y.; Wu, M.; Wu, W.; Hu, X.; Shen, L. INS/GPS Integration: Global Observability Analysis. IEEE. Trans. Veh. Technol. 2009, 58, 1129–1142. [Google Scholar] [CrossRef]
Huang, W.; Fang, T.; Luo, L.; Zhao, L.; Che, F. A Damping Grid Strapdown Inertial Navigation System Based on a Kalman Filter for Ships in Polar Regions. Sensors 2017, 17, 1551. [Google Scholar]
Zhang, Y.; Huang, Y.; Wu, Z.; Li, N. Moving State Marine SINS Initial Alignment Based on High Degree CKF. Math. Probl. Eng. 2014, 2014, 546107. [Google Scholar] [CrossRef]
Huang, Y.; Zhang, Y. A New Process Uncertainty Robust Student’s t based Kalman Filter for SINS/GPS Integration. IEEE Access 2017, 5, 14391–14404. [Google Scholar] [CrossRef]
Lu, J.; Lei, C.; Li, B.; Wen, T. Improved calibration of IMU biases in analytic coarse alignment for AHRS. Meas. Sci. Technol. 2016, 27, 075105. [Google Scholar] [CrossRef]
Huang, Y.; Zhang, Y.; Wang, X. Kalman-Filtering-Based In-Motion Coarse Alignment for Odometer-Aided SINS. IEEE Trans. Instrum. Meas. 2017, PP, 1–14. [Google Scholar] [CrossRef]
Shuster, M.D.; Oh, S.D. Three-axis attitude determination from vector observations. J. Guid. Control Dyn. 1981, 4, 70–77. [Google Scholar] [CrossRef]
Jiang, Y.F. Error analysis of analytic coarse alignment methods. IEEE. Trans. Aerosp. Electron. Syst. 1998, 34, 334–337. [Google Scholar] [CrossRef]
Tan, C.; Zhu, X.; Su, Y.; Wang, Y.; Wu, Z.; Gu, D. A New Analytic Alignment Method for a SINS. Sensors 2015, 15, 27930–27953. [Google Scholar] [CrossRef] [PubMed]
Li, J.; Fang, J.; Du, M. Error Analysis and Gyro-Bias Calibration of Analytic Coarse Alignment for Airborne POS. IEEE Trans. Instrum. Meas. 2012, 61, 3058–3064. [Google Scholar]
Zhou, W.D.; Ma, H.; Ji, Y.R.; Song, J.L. Coarse Alignment for SINS Using Gravity in the Inertial Frame Based on Attitude Quaternion. Appl. Mech. Mater. 2013, 244, 413–417. [Google Scholar] [CrossRef]
Zhang, T.; Zhu, Y.; Zhou, F.; Yan, Y.; Tong, J. Coarse Alignment Technology on Moving Base for SINS Based on the Improved Quaternion Filter Algorithm. Sensors 2017, 17, 1424. [Google Scholar] [CrossRef] [PubMed]
Li, W.; Wu, W.; Lu, J.W.L. A Fast SINS Initial Alignment Scheme for Underwater Vehicle Applications. J. Navig. 2013, 66, 181–198. [Google Scholar] [CrossRef]
Wu, M.; Wu, Y.; Hu, X.; Hu, D. Optimization-based alignment for inertial navigation systems: Theory and algorithm. Aerosp. Sci. Technol. 2011, 15, 1–17. [Google Scholar] [CrossRef]
Wu, Y.; Pan, X. Velocity/Position Integration Formula Part I: Application to In-Flight Coarse Alignment. IEEE Trans. Aerosp. Electron. Syst. 2013, 49, 1006–1023. [Google Scholar] [CrossRef]
Chang, L.; Li, J.; Chen, S. Initial Alignment by Attitude Estimation for Strapdown Inertial Navigation Systems. IEEE Trans. Instrum. Meas. 2015, 64, 784–794. [Google Scholar] [CrossRef]
Chang, L.; Li, J.; Li, K. Optimization-based alignment for strapdown inertial navigation system: Comparison and extension. IEEE Trans. Aerosp. Electron. Syst. 2016, 52, 1697–1713. [Google Scholar] [CrossRef]
Chang, L.; Qin, F.; Li, A. A Novel Backtracking Scheme for Attitude Determination-Based Initial Alignment. IEEE Trans. Autom. Sci. Eng. 2015, 12, 384–390. [Google Scholar] [CrossRef]
Kang, L.; Ye, L.; Song, K. A fast in-motion alignment algorithm for DVL aided SINS. Math. Probl. Eng. 2014, 2014, 593692. [Google Scholar] [CrossRef]
Chang, L.; He, H.; Qin, F. In-motion Initial Alignment for Odometer Aided Strapdown Inertial Navigation System based on Attitude Estimation. IEEE Sens. J. 2017, 17, 766–773. [Google Scholar] [CrossRef]
Chang, L.; Li, Y.; Xue, B. Initial Alignment for Doppler Velocity Log aided Strapdown Inertial Navigation System with Limited Information. IEEE ASME Trans. Mechatron. 2017, 22, 329–338. [Google Scholar] [CrossRef]

Figure 1. The block diagram of the proposed ICA algorithm.

Figure 2. The true velocity profile of the simulation test.

Figure 3. The attitude angle error of the simulation.

Figure 4. The attitude angle errors of 50 coarse alignments. The abscissa denotes the order

N

of the alignments, and the ordinate denotes the errors of the pitch angle, roll angle and heading angle, respectively.

Figure 4. The attitude angle errors of 50 coarse alignments. The abscissa denotes the order

N

of the alignments, and the ordinate denotes the errors of the pitch angle, roll angle and heading angle, respectively.

Figure 5. The FSINS and PHINS for the experiment.

Figure 6. Velocity profile for four segments.

Table 1. Initial parameters.

Parameter Name	Parameter Value
Initial longitude $λ$	$120^{\circ} E$
Initial latitude L	$30^{\circ} N$
Fiber-optic gyroscope drift	$0 . 005^{\circ} / h$
Fiber-optic gyroscope noise	$0 . 05^{\circ} / h / \sqrt{HZ}$
Accelerometer bias	$10^{- 4} g$
Accelerometer noise	$10^{- 4} g / \sqrt{Hz}$
odometer noise	$0.02 m / s$

Table 2. The simulation result of 50 coarse alignments.

Attitude Angle	Method	Maximum Error	Mean Error	Standard Deviation
Pitch	TIFCA	$0 . 0157^{\circ}$	$0 . 0002^{\circ}$	$0 . 0066^{\circ}$
	OBA	$- 0 . 0145^{\circ}$	$- 0 . 0021^{\circ}$	$0 . 0068^{\circ}$
	ICA	$0 . 0103^{\circ}$	$- 0 . 00006^{\circ}$	$0 . 0055^{\circ}$
Roll	TIFCA	$- 0 . 0333^{\circ}$	$0 . 0018^{\circ}$	$0 . 0161^{\circ}$
	OBA	$0 . 0156^{\circ}$	$- 0 . 0015^{\circ}$	$0 . 0087^{\circ}$
	ICA	$0 . 0140^{\circ}$	$0 . 0016^{\circ}$	$0 . 0067^{\circ}$
Heading	TIFCA	$- 5 . 391^{\circ}$	$0 . 2396^{\circ}$	$2 . 3105^{\circ}$
	OBA	$4 . 984^{\circ}$	$0 . 5555^{\circ}$	$2 . 8391^{\circ}$
	ICA	$- 1 . 67^{\circ}$	$- 0 . 1393^{\circ}$	$0 . 6220^{\circ}$

Table 3. Specifications of the GPS/PHINS integrated navigation system.

Index	Accuracy
Heading, Roll, Pitch resolution	$0 . 001^{\circ}$
Heading, Roll, Pitch dynamic accuracy	$0 . 01^{\circ}$
Saturation of the speed	$41.66 m / s$
Speed accuracy	$0.1 m / s$
The position error of GPS receiver	≤10 m

Table 4. The final pitch angle error of four segments.

Data	TIFCA	OBA	ICA
Segment 1	$0 . 008^{\circ}$	$- 0 . 006^{\circ}$	$- 0 . 006^{\circ}$
Segment 2	$0 . 009^{\circ}$	$- 0 . 007^{\circ}$	$- 0 . 003^{\circ}$
Segment 3	$- 0 . 004^{\circ}$	$0 . 004^{\circ}$	$0 . 003^{\circ}$
Segment 4	$0 . 013^{\circ}$	$0 . 013^{\circ}$	$0 . 011^{\circ}$

Table 5. The final roll angle error of four segments.

Data	TIFCA	OBA	ICA
Segment 1	$- 0 . 035^{\circ}$	$- 0 . 033^{\circ}$	$- 0 . 035^{\circ}$
Segment 2	$- 0 . 012^{\circ}$	$- 0 . 011^{\circ}$	$- 0 . 014^{\circ}$
Segment 3	$- 0 . 015^{\circ}$	$- 0 . 008^{\circ}$	$- 0 . 009^{\circ}$
Segment 4	$0 . 036^{\circ}$	$0 . 038^{\circ}$	$0 . 038^{\circ}$

Table 6. The final heading angle error of four segments.

Data	TIFCA	OBA	ICA
Segment 1	$- 1 . 117^{\circ}$	$- 0 . 677^{\circ}$	$- 0 . 065^{\circ}$
Segment 2	$1 . 376^{\circ}$	$1 . 024^{\circ}$	$0 . 210^{\circ}$
Segment 3	$- 2 . 029^{\circ}$	$- 1 . 698^{\circ}$	$- 0 . 685^{\circ}$
Segment 4	$- 1 . 498^{\circ}$	$- 2 . 354^{\circ}$	$0 . 944^{\circ}$

© 2018 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 (http://creativecommons.org/licenses/by/4.0/).

Share and Cite

MDPI and ACS Style

Zhang, Y.; Luo, L.; Fang, T.; Li, N.; Wang, G. An Improved Coarse Alignment Algorithm for Odometer-Aided SINS Based on the Optimization Design Method. Sensors 2018, 18, 195. https://doi.org/10.3390/s18010195

AMA Style

Zhang Y, Luo L, Fang T, Li N, Wang G. An Improved Coarse Alignment Algorithm for Odometer-Aided SINS Based on the Optimization Design Method. Sensors. 2018; 18(1):195. https://doi.org/10.3390/s18010195

Chicago/Turabian Style

Zhang, Yonggang, Li Luo, Tao Fang, Ning Li, and Guoqing Wang. 2018. "An Improved Coarse Alignment Algorithm for Odometer-Aided SINS Based on the Optimization Design Method" Sensors 18, no. 1: 195. https://doi.org/10.3390/s18010195

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

Article Menu

An Improved Coarse Alignment Algorithm for Odometer-Aided SINS Based on the Optimization Design Method

Abstract

1. Introduction

2. OBA Algorithm for Odometer-Aided SINS

3. ICA Algorithm for Odometer-Aided SINS

4. Simulation and Test

4.1. Simulation Results

4.2. Test Results

5. Conclusions

Acknowledgments

Author Contributions

Conflicts of Interest

References

Share and Cite

Article Metrics

Article Access Statistics

Further Information

Guidelines

MDPI Initiatives

Follow MDPI