2.1. Coordinate Frame Definitions

To better understand SINS initial alignment, it is necessary to explain the navigation coordinate system. The coordinate frames used for the SINS initial alignment are defined as follows.

1. (i) The e frame is the Earth-fixed coordinate frame. The e _z axis is parallel to the Earth's rotation axis and the e _x axis is in the equatorial plane and points to the meridian of the body initial position. The e _y axis completes the right-handed coordinate system.

2. (ii) The i frame is the inertial coordinate frame. It is formed by fixing the e frame at the beginning of the coarse alignment in the inertial space.

3. (iii) The n frame is the true navigation coordinate frame which is the local level coordinate frame. The n _x axis points to the East, the n _y axis points to the North, and the n _z axis points to the zenith.

4. (iv) The n′ frame is the computed navigation coordinate frame. There is some error between the n frame and the n′ frame owing to the alignment error and the sensor error.

5. (v) The m frame is the vehicle body coordinate frame. The x _m axis is parallel to the body lateral axis and points to the right. The y _m axis is parallel to the body longitudinal axis and points forward. The z _m axis is parallel to the body vertical axis and points upward. In the general case, assume the OD body coordinate frame with the m frame overlap.

6. (vi) The b frame is the strapdown inertial sensor's body coordinate frame.

2.2. The Principle of the In-motion Coarse Alignment Algorithm Based on Attitude Optimisation

For SINS, the initial alignment is implemented to obtain the coordinate transformation matrix from the b frame to the n frame. The common navigation (attitude and velocity) update equations are written in the n frame as (Wang et al., Reference Wang, Yang, Yu and Lei2013; Wu et al., Reference Wu, Wu, Hu and Hu2011; Li et al., Reference Li, Xu, Chang and Zha2014)

(1) $$\dot{{\bi {C}}}_b^{\, n}={{\bi {C}}}^{\, n}_b{{\bi \omega}}_{nb}^b\times $$

(2) $$\dot{{\bi {V}}}^{\, n}_{en}={{\bi {C}}}^{\, n}_b {{\bi {f}}}^b-\lpar 2{{\bi \omega}}_{ie}^n+{{\bi \omega}}_{en}^n\rpar \times{{\bi {V}}}^{n}_{en}+{{\bi {g}}}^n $$

where ${{\bi {C}}}^{\, n}_{b}$ denotes the attitude matrix from the b frame to the n frame, ${\bi {V}}^{\, n}_{en}$ is the ground velocity, ${{\bi {f}}}^{b}$ is the special force measured by the accelerometers in the b frame, ${{\bi \omega}}^{n}_{ie}$ is the angular rate of the Earth's rotation in the n frame, ${{\bi \omega}}^{n}_{en}$ is the angular rate of the n frame with respect to the e frame, expressed in the n frame, ${{\bi {g}}}^{n}$ is gravity in the n frame, $\lpar \bullet\rpar \times$ is the matrix form of a cross-product which satisfies ${{\bi {a}}}\times {{\bi {b}}}=\lpar {{\bi {a}}}\times\rpar {{\bi {b}}}$ , ${{\bi \omega}}^{b}_{nb}$ is the angular rate of the b frame with respect to the n frame and can be described as

(3) $${{\bi \omega}}^b_{nb}={{\bi \omega}}^b_{ib}-{{\bi \omega}}^b_{in}= {\bi \omega}^b_{ib}-{\bi C}^b_{n}\lpar {\bi \omega}^n_{ie}+{\bi \omega}^n_{en}\rpar $$

where ${{\bi \omega}}^{b}_{ib}$ is the angular rate measured by the gyroscopes in the b frame.

Equation (1) is the traditional attitude update equation. By the chain rule, the attitude matrix can be decomposed into three parts at any time, that is

(4) $${{\bi {C}}}^{\, n}_b\lpar t\rpar ={{\bi {C}}}^{\, n\lpar t\rpar }_{n\lpar 0\rpar }{{\bi {C}}}^{\, n}_b\lpar 0\rpar {\bi {C}}^{b\lpar 0\rpar }_{b\lpar t\rpar } $$

where n(0) and b(0) denote the inertial non-rotating frame, which is formed by fixing the n frame and b frame at the start-up in the inertial space, respectively. ${{\bi {C}}}^{\, b\lpar t\rpar }_{b\lpar 0\rpar }$ and ${{\bi {C}}}^{\, n\lpar t\rpar }_{n\lpar 0\rpar }$ , respectively, encode the attitude changes of the b frame and n frame from time 0 to t and can be determined by

(5) $$\dot{{\bi {C}}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar }={{\bi {C}}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar } {{\bi \omega}}^{b}_{ib}\times $$

(6) $$\dot{{\bi {C}}}_{\, b\lpar t\rpar }^{\, n\lpar 0\rpar }={{\bi {C}}}_{\, n\lpar t\rpar }^{n\lpar 0\rpar } {{\bi \omega}}^{n}_{in}\times $$

where ${{\bi \omega}}^{n}_{in}$ is the angular rate of the n frame with respect to the i frame and ${{\bi \omega}}^{n}_{in}={{\bi \omega}}^{n}_{ie}+{{\bi \omega}}^{n}_{en}\approx {{\bi \omega}}^{n}_{ie}$ for the reason that ${{\bi \omega}}^{n}_{en}$ is unknown but can be omitted due to the fact that the vehicle does not move at a very high speed and it is the coarse alignment stage. In addition, it can be easily observed that the initial conditions for the differential equation in Equations (5) and (6) are both identity matrices. Therefore, ${{\bi {C}}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar }$ and ${{\bi {C}}}_{\, n\lpar t\rpar }^{\, n\lpar 0\rpar }$ can be easily obtained based on well-known attitude update methods. In this respect, the initial alignment has been transformed into determining the constant matrix ${{\bi {C}}}^{\, n}_{b}\lpar 0\rpar $ based on the decomposition of Equation (4).

As the output of OD is the velocity in the b frame, we must convert Equation (2) into the b frame. For this, Equation (2) can be rewritten as

(7) $$\dot{{\bi {V}}}_{en}^{\, n}=\displaystyle{{d\lpar {\bi {C}}_b^{\, n}{\bi {V}}_{en}^{\, b}\rpar }\over{dt}} = \dot{{\bi {C}}}_b^{\, n}{\bi {V}}_{en}^{\, b}+{\bi {C}}^{\, n}_b \dot{{\bi {V}}}_{en}^{\, b}={\bi {C}}_b^{\, n}{\bi {f}}^b -\lpar 2{\bi \omega}^{n}_{ie}+{\bi \omega}^{n}_{en}\rpar \times {\bi {V}}_{en}^{\, n}+ {\bi {g}}^n $$

Substituting Equations (1) and (4) into Equation (7) and multiplying both sides from left by ${\bi {C}}_{n\lpar t\rpar }^{\, n\lpar 0\rpar }$ yields

(8) $${\bi {C}}_b^{\, n}\lpar 0\rpar {\bi {C}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar } {\bi \omega}^{b}_{nb}\times {\bi {V}}^{\, b}_{en}\, {+}\, {\bi {C}}_b^{\, n}\lpar 0\rpar {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar } \dot{{\bi {V}}}^{b}_{en}={\bi {C}}_b^{\, n}\lpar 0\rpar {\bi {C}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi {f}}^b- {\bi {C}}_{\, n\lpar t\rpar }^{\, n\lpar 0\rpar }\lpar 2{\bi \omega}^{n}_{ie}\, {+}\, {\bi \omega}^{n}_{en}\rpar \times {\bi {V}}^{\, n}_{en}\, {+}\, {\bi {C}}_{\, n\lpar t\rpar }^{\, n\lpar 0\rpar }{\bi {g}}^n $$

Or equivalently

(9) $${\bi {C}}_b^{\, n}\lpar 0\rpar \lpar {\bi {C}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi \omega}^{n}_{nb}\times {\bi {V}}^{\, b}_{en}+ {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar } \dot{{\bi {V}}}_{en}^{b} - C_{b\lpar t\rpar }^{b\lpar 0\rpar } {\bi {f}}^b\rpar =-{\bi {C}}_{\, n\lpar t\rpar }^{\, n\lpar 0\rpar } \lpar 2{\bi \omega}^{n}_{ie}+{\bi \omega}^{n}_{en}\rpar \times {\bi {V}}^{\, n}_{en}+{\bi {C}}_{\, n\lpar t\rpar }^{\, n\lpar 0\rpar }{\bi {g}}^n $$

As is known, the output of OD is the incremental position in the b frame, the outputs of gyroscope and accelerometer are the incremental angle and incremental velocity, respectively. The integral forms are needed, integrating Equation (9) on both sides

(10) $${\bi {C}}_b^{\, n}\lpar 0\rpar {\bi \alpha}_v\lpar t\rpar ={\bi \beta}_v\lpar t\rpar $$

where

(11) $$\left\{\matrix{{\bi \alpha}_v\lpar t\rpar =\vint_0^t \lpar {\bi {C}}_{\, b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi \omega}_{nb}\times {\bi {V}}^{\, b}_{en}+ {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi {f}}^b\rpar dt \hfill \cr {\bi \beta}_v\lpar t\rpar =\vint_0^b \lpar -{\bi {C}}_{\, n\lpar t\rpar }^{n\lpar 0\rpar } \lpar 2{\bi \omega}^{n}_{ie}+{\bi \omega}^{n}_{en}\rpar \times {\bi {V}}^{\, n}_{en}+{\bi {C}}^{\, n\lpar t\rpar }_{n\lpar 0\rpar }{\bi {g}}^n\rpar dt \hfill \cr }\right.$$

In this respect, the initial attitude matrix ${\bi {C}}_{b}^{\, n}\lpar 0\rpar $ can be uniquely solved by the attitude optimisation method described in Wahba (Reference Wahba1965), Shuster and Oh (Reference Shuster and Oh1981) and Bar-Itzhack (Reference Bar-Itzhack1996) to minimise

(12) $$L\lpar {\bi {C}}_b^{\, n}\lpar 0\rpar \rpar =\sum\lpar {\bi {C}}_b^{\, n}\lpar 0\rpar {\bi \alpha}_v\lpar t\rpar -{\bi \beta}_v\lpar t\rpar \rpar ^2 $$

The key of initial alignment is how to calculate ${\bi \alpha}_{v}\lpar t\rpar $ and ${\bi \beta}_{v}\lpar t\rpar $ with different integral time.

2.3. The Calculation of α _v (t) and β _v (t).

For Equation (11), the first and second integral in ${\bi \alpha}_{v}\lpar t\rpar $ can be rewritten as

(13) $$\eqalign{&\vint_0^t \lpar {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar }{\bi \omega}^{b}_{nb}\times {\bi {V}}^{\, b}_{en}+ {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar } \dot{{\bi {V}}}_{en}^{\, b}\rpar dt= {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi {V}}_{en}^{\, b}\vert _{0}^{t}+ \vint_0^t\lpar {\bi {C}}^{\, b\lpar t\rpar }_{b\lpar 0\rpar }{\bi \omega}^{b}_{nb}\times {\bi {V}}^{\, b}_{en}+ \dot{{\bi {C}}}_{b\lpar t\rpar }^{b\lpar 0\rpar }\dot{{\bi {V}}}_{en}^{\, b}\rpar dt \cr & \quad = {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar } {\bi {V}}_{en}^{\, b}\vert _{0}^{t}+\vint_0^t\lpar {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar } \lpar {\bi \omega}^{b}_{ib}- {\bi \omega}^{b}_{in}\rpar \times {\bi {V}}_{en}^{\, b}-{\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar } {\bi \omega}^{n}_{ib}\times {\bi {V}}^{\, b}_{en}\rpar dt \cr & \quad = {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar }{\bi {V}}_{en}^{\, b}\vert _{0}^{t} + \vint_0^t \lpar {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar }\lpar {\bi \omega}^{b}_{ie}- {\bi \omega}^{b}_{en}\rpar \times {\bi {V}}_{en}^{\, b}\rpar dt} $$

Notice that before the initial alignment is finished ${\bi {C}}_{b}^{\, n}\lpar t\rpar $ is unknown and ${\bi \omega}^{b}_{ie}$ is unknown too. However, due to ω _ie being a very small value and the fact that the vehicle does not move at a very high speed (at about 100 Km/h), $\lpar {\bi \omega}^{b}_{ie}+ {\bi \omega}^{b}_{en}\rpar \times {\bi {V}}_{en}^{\, b}$ would be small too. e.g., when ${\bi {V}}_{en}^{\, b}=120\, \hbox{Km}/\hbox{h}$ , the highest values in ${\bi \omega}^{b}_{ie}\times {\bi {V}}^{\, b}_{en}$ and ${\bi \omega}^{b}_{en}\times {\bi {V}}^{\, b}_{en}$ are $2{\cdot}49 \times 10^{-4} \hbox{g}$ and $0{\cdot}89\times 10^{-4}\, \hbox{g}$ , respectively. This is the same as the bias of a medium accuracy accelerometer, so the second integral part in ${\bi \alpha}_{v}\lpar t\rpar $ can be omitted in the coarse alignment stage and we can approximate this part by

(14) $$\vint_0^t \lpar {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar }{\bi \omega}^{b}_{nb}\times {\bi {V}}^{\, b}_{en}+ {\bi {C}}_{b\lpar t\rpar }^{\, b\lpar 0\rpar } \dot{{\bi {V}}}_{en}^{\, b}\rpar dt\approx {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar }{\bi {V}}^{\, b}_{en}\lpar t\rpar - {\bi {V}}^{\, b}_{en} \lpar 0\rpar $$

The calculation methods for the third part of ${\bi \alpha}_{v}\lpar t\rpar $ had been already expressed in Wu and Pan (Reference Wu and Pan2013) as

(15) $$\eqalign{&\vint_0^t {\bi {C}}_{\, b\lpar t\rpar }^{b\lpar 0\rpar } {\bi {f}}^b dt=\sum_{k=0}^{N-1} {\bi {C}}_{b\lpar t_k\rpar }^{b\lpar 0\rpar }\vint_{t_k}^{t_{k+1}}{\bi {C}}^{b\lpar t_k\rpar }_{b\lpar t\rpar }{\bi {f}}^b dt\approx \sum_{k=0}^{N-1} {\bi {C}}^{b\lpar 0\rpar }_{b\lpar t_k\rpar }\vint^{t_{k+1}}_{t_k}\left({\bi {I}}+\left(\vint_{t_k}^t\lpar {\bi \omega}^{b}_{ib}\times\rpar d\tau\right)\right){\bi {f}}^b dt \cr & \quad =\sum_{k=0}^{N-1}{\bi {C}}_{b\lpar t_k\rpar }^{b\lpar 0\rpar }\left[\Delta {\bi {V}}_1+ \Delta {\bi {V}}_2+\displaystyle{{1} \over {2}}\lpar \Delta {\bi \theta}_1+\Delta {\bi \theta}_2\rpar \times \lpar \Delta {\bi {V}}_1+ \Delta {\bi {V}}_2\rpar \right. \cr & \qquad\qquad\qquad \left. +\displaystyle{{2}\over {3}}\lpar \Delta {\bi \theta}_1\times \Delta {\bi {V}}_2+\Delta {\bi {V}}_1\times \Delta {\bi \theta}_2\rpar \right]} $$

where $\Delta {\bi {V}}_{1}$ , $\Delta {\bi {V}}_{2}$ are the first and second samples of the accelerometer-measured incremental velocity and $\Delta {\bi \theta}_{1}$ , $\Delta {\bi \theta}_{2}$ are the first and second samples of the gyroscope-measured incremental angle, respectively. So ${\bi \alpha}_{v}\lpar t\rpar $ can be approximated as

(16) $$\eqalign{{\bi \alpha}_v\lpar {\bi {t}}_N\rpar & ={\bi {C}}^{b\lpar 0\rpar }_{b\lpar t_N\rpar }{\bi {V}}_{en}^{\, b} \lpar t_N\rpar -{\bi {V}}^{\, b}_{en} \lpar 0\rpar \cr & \quad -\sum_{k=0}^{N-1}{\bi {C}}_{b\lpar t_k\rpar }^{b\lpar 0\rpar }\left[\Delta {\bi {V}}_1+ \Delta {\bi {V}}_2+\displaystyle{{1}\over{2}}\lpar \Delta {\bi \theta}_1+\Delta {\bi \theta}_2\rpar \times \lpar \Delta {\bi {V}}_1+ \Delta {\bi {V}}_2\rpar \right. \cr & \qquad\qquad \qquad \left. +\displaystyle{{2}\over {3}}\lpar \Delta {\bi \theta}_1\times \Delta {\bi {V}}_2+\Delta {\bi {V}}_1\times \Delta {\bi \theta}_2\rpar \right]} $$

For the first integral part in ${\bi \beta}_{v}\lpar t\rpar $ , since the output velocity of the OD is in the b frame, not in the n frame, so ${\bi {V}}^{\, n}_{en}$ is unknown. However, ${\bi \omega}^{n}_{ie}\times {\bi {V}}^{\, n}_{en}$ and ${\bi \omega}^{n}_{ie}\times {\bi {V}}^{\, n}_{en}$ could also be omitted for the same reason as the vehicle would not move at a very high speed and ω _ie is a very small value. Therefore, ${\bi \beta}_{v}\lpar t\rpar $ can be approximated as

(17) $$\eqalign{{\bi \beta}_v\lpar t_N\rpar &\approx \vint_0^{t_N} {\bi {C}}_{\, n\lpar t\rpar }^{n\lpar 0\rpar } {\bi {g}}^n dt= \sum_{k=0}^{N-1} {\bi {C}}_{n\lpar t_k\rpar }^{n\lpar 0\rpar }\vint_{t_k}^{t_{k+1}}{\bi {C}}^{n\lpar t_k\rpar }_{n\lpar t\rpar }{\bi {g}}^n dt \cr & \quad \approx \sum_{k=0}^{N-1} {\bi {C}}_{n\lpar t_k\rpar }^{n\lpar 0\rpar }\vint_{t_k}^{t_{k+1}} \lpar {\bi {I}}+\lpar t-t_k\rpar {\bi \omega}^{b}_{ib}\times\rpar {\bi {g}}^n dt \cr & \quad =\sum_{k=0}^{N-1} {\bi {C}}_{n\lpar t_k\rpar }^{n\lpar 0\rpar }\vint_{t_k}^{t_{k+1}}\left(T{\bi {I}}+\displaystyle{{T^2}\over{2}} {\bi \omega}^{n}_{in}\times\right){\bi {g}}^n dt \approx \sum_{k=0}^{N-1} {\bi {C}}_{n\lpar t_k\rpar }^{n\lpar 0\rpar } \vint_{t_k}^{t_{k+1}}\left(T{\bi {I}}+\displaystyle{{T^2}\over{2}} {\bi \omega}^{n}_{ie}\times\right){\bi {g}}^n dt} $$

where I is the identity matrix. T is the time duration of the update interval $\lsqb t_{k}\quad t_{k+1}\rsqb $ , $k=0\comma \; 1\comma \; 2\comma \; \ldots\comma \; N-1$ and t _k  = kT.

3.1. SINS/OD Error Model

3.1.1. The effect of OD scale factor error and SINS installation angle error

In ideal conditions, while the vehicles travel close to the ground without skidding or jumping, the speed of vehicle in the x _m and z _m direction is zero (Dissanayake et al., Reference Dissanayake, Sukkarieh and Nebot2001; Fu et al., Reference Fu, Qin, Li and Wang2012), and the output of the OD is the position increment of the vehicle in the y _m direction, i.e.,

(18) $${\bi {S}}^m_{OD}=\lsqb \matrix{0 & S_{OD}& 0 \cr}\rsqb ^{\rm T} $$

where S _OD is the ideal output of the OD.

In practice, due to the influence of the OD scale factor error, the actual output position increment of the OD is formulated as

(19) $$\hat{{\bi {S}}}^m_{OD}=\lsqb \matrix{0 & \hat{S}_{OD} &0 \cr}\rsqb ^{\rm T}= \lsqb \matrix{0 &\lpar 1+\delta k\rpar S_{OD} & 0 \cr}\rsqb ^{\rm T}=\lpar 1+\delta k\rpar {\bi {S}}^m_{OD} $$

where the hat “∧” denotes the actual calculated value. δ k denotes the OD scale factor error and can be simply regarded as a random constant (selected once in a random manner and kept constant), i.e.,

(20) $$\delta \dot{k}=0 $$

In general, the b frame and m frame are not coincident because of the installation process quality limit and we add an assumption that the three installation angle errors are all small ones, so the transformation matrix from m frame to b frame can be formulated as

(21) $${\bi {C}}_m^b={\bi {I}}-\lpar {\bi {a}}\times\rpar =\left[\matrix{1& a_\psi&-a\gamma \cr -a_\psi & 1 & a_\theta \cr a_\gamma & -a_\theta & 1 \cr}\right]$$

where ${{\bi a}}=\left[\matrix{a_{\theta}&a_{\gamma}&a_{\psi}}\right]^{\rm T}$ is the installation angle error vector. a _θ, a _γ, a _ψ are the pitch, roll, and heading installation angle error respectively and can be also regarded as random constants, i.e.,

(22) $$\left[\matrix{\dot{a}_\theta &\dot{a}_\gamma &\dot{a}_\psi}\right]^{\rm T}= \left[\matrix{0&0&0}\right]^{\rm T} $$

Then the output of OD in the b frame can be formulated as

(23) $$\hat{{\bi {S}}}_{OD}^b={\bi {C}}_m^b \hat{{\bi {S}}}_{OD}^m= \left[\matrix{1& a_\psi &-a_\gamma \cr -a_\psi & 1 & a_\theta \cr a_\gamma &-a_\theta & 1 \cr}\right]\lpar 1+\delta k\rpar {\bi {S}}_{OD}^m =\lpar 1-\delta k\rpar \left[\matrix{a_\psi\ cr\ 1 \cr -a_\theta\cr}\right]{S}_{OD} $$

It is clear from Equation (23) that the output of the OD in the b frame is only affected by the pitch installation angle error and heading installation angle error, and has nothing to do with the roll installation angle error. Therefore it is unnecessary to consider the effect of roll installation angle error on the system accuracy in the process of alignment.

3.1.2. The system equation of SINS/OD

In the SINS/OD error model, we choose velocity errors, misalignment angles, position errors, gyro drift and accelerometer bias of SINS as the state variables, with the OD scale factor error and SINS installation angle errors added to the state vectors, and then the 18 state variables of the system can be constructed as

(24) $${\bi {X}}=\left[\matrix{\lpar \delta {\bi {V}}^{n}\rpar^{\rm T}& {\bi {\Phi}}^{\rm T}&\delta {\bi {P}}^{\rm T}& \lpar \Delta^{\rm b}\rpar^{\rm T}&\lpar \varepsilon^{\rm b}\rpar^{\rm T}& \delta k & a_{\theta}& a_{\psi}}\right]^{\rm T} $$

where $\delta {\bi {V}}^{n}=\left[\matrix{ \delta {\bi {V}}_{E}&\delta {\bi {V}}_{N}& \delta {\bi {V}}_{U}}\right]^{\rm T}$ , ${\bi \Phi}=\left[\matrix{\phi_{E}&\phi_{N}&\phi_{U}}\right]^{\rm T}$ and $\delta {\bi {P}}=\lsqb \matrix{\delta L&\delta\lambda&\delta_{h}}\rsqb ^{\rm T}$ are the velocity error vector, attitude error vector and position error vector, respectively. The subscript E, N, U indicate the east, north and vertical axes of the n frame respectively. δ L, $\delta \lambda$ and δ h are errors of latitude, longitude and altitude respectively. $\nabla^{b} = \lsqb \matrix{\nabla_{x}&\nabla_{y}&\nabla_{z}}\rsqb ^{\rm T}$ , and ${\bi \varepsilon}^{b} = \lsqb \matrix{\varepsilon_{x}&\varepsilon_{y}&\varepsilon_{z}}\rsqb ^{\rm T}$ are the accelerometer bias and gyro constant drift vector in the b frame, respectively. The SINS misalignment angles model is (Zhao et al., Reference Zhao, Zhao, Guo, Wang, Zhou and Wang2015; Titterton and Weston, Reference Titterton and Weston2004)

(25) $$\left\{\matrix{\delta\dot{{\bi {V}}}^{\, n}=-{\bi \Phi}\times {\bi {f}}^n+\delta {\bi {V}}^{\, n}\times \lpar 2{\bi \omega}^n_{ie} +{\bi \omega}^n_{en}\rpar +{\bi {V}}^{\, n}\times \lpar 2\delta {\bi \omega}^n_{ie}+\delta {\bi \omega}^n_{en}\rpar +{\bi {C}}^{\, n}_b{\bi \nabla}^b \hfill \cr \dot{{\bi \Phi}}={\bi \Phi}\times {\bi \omega}^n_{in}+\delta {\bi \omega}^n_{in}-{\bi {C}}^{\, n}_b{\bi \varepsilon}^b \hfill \cr \delta \dot{L}=\displaystyle{{\delta V_N}\over{R_M+h}}-\delta h\displaystyle{{V_N}\over{\lpar R_M+h\rpar^2}} \hfill \cr \delta \dot{\lambda}=\displaystyle{{\delta V_E}\over{R_N+h}}\sec L+\delta L\displaystyle{{V_E}\over{R_N+h}}\tan L\sec L=\delta h\displaystyle{{V_E\sec L}\over{\lpar R_N+h\rpar^2}} \hfill \cr \delta \dot{h}=\delta V_U \hfill \cr \dot{\nabla}^b=\lsqb 0\quad 0\quad 0\rsqb^T \hfill \cr \dot{{\bi \varepsilon}}^b=\lsqb 0\quad 0\quad 0\rsqb^T \hfill \cr}\right. $$

where ${\bi {f}}^{n}$ is the special force measured by the accelerometers in the n frame. $\delta {\bi \omega}^{n}_{ie}$ is the computational error of ${\bi \omega}^{n}_{ie}$ and $\delta {\bi \omega}^{n}_{en}$ is the computational error of ${\bi \omega}^{n}_{en}$ . ${\bi \omega}^{n}_{ie}$ , $\delta{\bi \omega}^{n}_{ie}$ , ${\bi \omega}^{n}_{en}$ and $\delta{\bi \omega}^{n}_{en}$ can be formulated as

(26) $${\bi \omega}^n_{ie}=\lsqb \matrix{ 0 & \omega_{ie}\cos L & \omega_{ie}\sin L}\rsqb ^{\rm T} $$

(27) $$\delta{\bi \omega}^n_{ie}=\lsqb \matrix{0 & -\omega_{ie}\sin L\delta L & \omega_{ie}\cos L\delta L}\rsqb ^{\rm T} $$

(28) $${\bi \omega}^n_{en}=\left[\matrix{-\displaystyle{{V_N}\over {R_M+h}} & \displaystyle{{V_E}\over {R_N+h}} & \displaystyle{{V_E\tan L}\over{R_N+h}}}\right]^{\rm T} $$

(29) $${\bi \delta}\omega^n_{en}=\left[\matrix{-\displaystyle{{\delta V_N} \over {R_M+h}}+\delta h\displaystyle{{V_N}\over{\lpar R_M+h\rpar^2}} \cr \displaystyle{{\delta V_E}\over{R_N+h}}-\delta h\displaystyle{{V_E}\over{\lpar R_M+h\rpar^2}} \cr \displaystyle{{\delta V_E\tan L}\over{R_N+h}}+\displaystyle{{V_E\sec^2 L\delta L}\over{R_N+h}}-\delta h\displaystyle{{V_E\tan L}\over{\lpar R_N+h\rpar^2}}}\right]$$

where R _M is the meridian radius of curvature and R _N is the transverse radius of curvature. The system state equation can be constructed as

(30) $$\dot{{\bi {X}}}={\bi {FX}}+{\bi {GW}} $$

where ${\bi {F}}$ is the state matrix, ${\bi {G}}$ is the noise matrix and ${\bi {W}}=\lsqb w_{ax}\quad w_{ay}\quad w_{az}\quad w_{gx}\quad w_{gy} \quad w_{gy}\rsqb ^{\rm T}$ is the white system process noise with the power spectral density ${\bi {Q}}$ . Based on Equations (20), (22) and (25), the state matrix F and noise matrix ${\bi {G}}$ can be expressed as

(31) $${\bi {F}}=\left[\matrix{{\bi {F}}_{11} & {\bi {F}}_{12} & {\bi {F}}_{13} & {\bi {F}}_{14} & {\bi 0}_{3\times 3} & {\bi 0}_{3\times 3} \cr {\bi {F}}_{21} & {\bi {F}}_{22} & {\bi {F}}_{23} & {\bi 0}_{3\times 3} & {\bi {F}}_{25} & {\bi 0}_{3\times 3} \cr {\bi {F}}_{31} & {\bi 0}_{3\times 3} & {\bi {F}}_{33} & {\bi 0}_{3\times 3} & {\bi 0}_{3\times 3} & {\bi 0}_{3\times 3} \cr {\bi 0}_{9\times 3} & {\bi 0}_{9\times 3} & {\bi 0}_{9\times 3} & {\bi 0}_{9\times 3} & {\bi 0}_{9\times 3} & {\bi 0}_{9\times 3}\cr}\right]$$

(32) $${\bi {G}}=\left[\matrix{{\bi {C}}^{\, n}_b & 0_{3\times 3}\cr 0_{3\times 3} & -{\bi {C}}^{\, n}_b \cr 0_{12\times 3} & 0_{12\times 3}}\right]$$

where

$$\eqalign{&{\bi {F}}_{11} =\left[\matrix{\displaystyle{{V_n\tan l-V_U}\over{R_N+h}} & 2\omega_{ie}\sin L+\displaystyle{{V_E\tan L}\over{R_N+h}}&-\left(2\omega_{ie}\cos L+\displaystyle{{V_E}\over{R_N+h}}\right)\cr -\left(2\omega_{ie}\sin L+\displaystyle{{V_E\tan L}\over{R_N+h}}\right)&-\displaystyle{{V_U}\over{R_M+h}}&-\displaystyle{{V_N}\over{R_M+h}} \cr 2\left(\omega_{ie}\cos L+\displaystyle{{V_E}\over{R_N+h}}\right)&\displaystyle{{2V_N}\over{R_M+h}}&0}\right]\comma \; \cr & {\bi {F}}_{12} = \left[\matrix{0&-f_u& f_N \cr f_u&0& f_E \cr -f_N& f_E&0 }\right]\comma \; \cr & {\bi {F}}_{13} =\left[\matrix{2\omega_{ie}\lpar V_U\sin L+V_N\cos L\rpar +\displaystyle{{V_EV_N\sec^2L}\over{R_N+h}}&0&\displaystyle{{V_EV_U-V_E V_N \tan L}\over{\lpar R_N+h\rpar^2}} \cr -\left(2V_E\omega_{ie}\cos L+\displaystyle{{V_E^2\sec^2 L}\over{R_N+h}}\right)&0&\displaystyle{{V_N V_U}\over{\lpar R_M+h\rpar^2}}+\displaystyle{{V_E^2\tan L}\over{\lpar R_N+h\rpar^2}} \cr -2V_E \omega_{ie}\sin L&0&-\left(\displaystyle{{V_N^2}\over{\lpar R_M+h\rpar^2}}+\displaystyle{{V_E^2}\over{\lpar R_N+h\rpar^2}}\right)}\right]\comma \; \cr & {\bi {F}}_{14} = {\bi {C}}_b^{n}\comma \; \cr & {\bi {F}}_{21} = \left[\matrix{ 0 -\displaystyle{{1} \over{R_M+h}} & 0 \cr \displaystyle{{1} \over{R_N+h}} & 0 & 0 \cr \displaystyle{{\tan L} \over {R_N+h}} & 0 & 0}\right]\comma \; \cr & {\bi {F}}_{22} = \left[\matrix{0 & \omega_{ie}\sin L + \displaystyle{{V_E\tan L}\over{R_N+h}} & -\left(\omega_{ie}\cos L+\displaystyle{{V_E}\over{R_N+h}}\right)\cr -\left(\omega_{ie}\sin L+\displaystyle{{V_E\tan L}\over{R_N+h}}\right)&0&-\displaystyle{{V_N}\over{R_M+h}} \cr \omega_{ie}\cos L+\displaystyle{{V_E}\over{R_N+h}} & \displaystyle{{V_N}\over{R_M+h}} & 0}\right]\cr & {\bi {F}}_{23} = \left[\matrix{0&0&-\displaystyle{{V_N} \over{\lpar R_M+h\rpar^2}} \cr -\omega_{ie}\sin L & 0 &-\displaystyle{{V_E} \over{\lpar R_N+h\rpar^2}} \cr \omega_{ie}\cos L+\displaystyle{{V_E\sec^2 L} \over{R_N+h}}&0&-\displaystyle{{V_E\tan L}\over{\lpar R_N+h\rpar^2}}}\right]\comma \; \quad {\bi {F}}_{25}=-{\bi {C}}^{\, n}_b\comma \; \cr & {\bi {F}}_{31}= \left[\matrix{0 & \displaystyle{{1}\over{R_M+h}}& 0 \cr \displaystyle{{\sec L}\over{R_N+h}} & 0 & 0 \cr 0&0&1}\right]\comma \; \quad {\bi {F}}_{33}=\left[\matrix{0&0&-\displaystyle{{V_N}\over{\lpar R_M+h\rpar^2}} \cr \displaystyle{{V_E\tan L\sec L}\over {R_N+h}} & 0 & -\displaystyle{{V_E\sec L}\over{\lpar R_N+h\rpar^2}} \cr 0&0&0}\right].}$$

3.1.3. The Measurement Equation of SINS/OD in the b frame

The actual output velocity of the SINS in the b frame can be formulated as

(33) $$\hat{{\bi {V}}}^{\, b}_{SINS}=\lpar {\bi {C}}^{\, n^\prime}_b\rpar ^{\rm T}\hat{{\bi {V}}}^{\, n^\prime}_{SINS} =\lpar {\bi {C}}^{\, n}_b\rpar ^{\rm T}{\bi {C}}^{\, n}_{n^\prime}\lpar {\bi {V}}^{\, n}_{SINS}+\delta {\bi {V}}^{\, n}_{SINS}\rpar $$

where $\hat{{\bi {V}}}^{\, n^{\prime}}_{SINS}$ denotes the actual calculated velocity value of SINS. ${\bi {V}}^{\, n}_{SINS}$ is the vehicle's true velocity value. $\delta{\bi {V}}^{\, n}_{SINS}$ is the computational velocity error of SINS. ${\bi {C}}^{\, n^{\prime}}_{b}$ is the computed attitude matrix. ${\bi {C}}^{\, n}_{b}$ is the true attitude matrix and ${\bi {C}}^{n}_{n^{\prime}}$ is the transformation matrix from n′ frame to n frame, which can be formulated as

(34) $${\bi {C}}^{\, n}_{n^\prime}={\bi {I}}+\lpar {\bi \Phi}\times\rpar $$

Substituting Equation (34) into Equation (33) and ignoring the second order small amount, we have

(35) $$\hat{{\bi {V}}}^{\, b}_{SINS}=\lpar {\bi {C}}^{\, n}_b\rpar ^{\rm T}\lpar {\bi {I}}+\lpar {\bi \Phi}\times \rpar \rpar \lpar {\bi {V}}^{\, n}_{SINS}+\delta {\bi {V}}^{\, n}_{SINS}\rpar = {\bi {V}}^{\, b}_{SINS} + {\bi {C}}^{\, b}_n{\bi \Phi} \times {\bi {V}}^{\, n}_{SINS}+{\bi {C}}^{\, b}_n\delta {\bi {V}}^{\, n}_{SINS} $$

Then the actual output position increment of SINS in the b frame can be formulated as

(36) $$\hat{{\bi {S}}}^b_{SINS}=\Delta t\bullet {\bi {V}}^{\, b}_{SINS}+\Delta t\bullet {\bi {C}}^{\, b}_n {\bi \Phi}\times {\bi {V}}^{\, n}_{SINS}+\Delta t\bullet {\bi {C}}^{\, b}_n\delta {\bi {V}}^{\, n}_{SINS} $$

where Δ t denotes the time duration of the update interval.

The actual output position increment of the OD in m frame can be formulated as

(37) $$\hat{{\bi {S}}}^m_{OD}=\lpar 1+\delta k\rpar {\bi {S}}^m_{OD}={\bi {S}}^m_{OD}+ \delta k {\bi {S}}^m_{OD}={\bi {C}}^m_b\lpar \Delta t\bullet {\bi {V}}^{\, b}_{SINS}\rpar +\delta k {\bi {S}}^m_{OD} $$

Substituting Equation (21) into Equation (37), we have

(38) $$\hat{{\bi {S}}}^m_{OD}=\lsqb {\bi {I}}+\lpar {\bi {a}}\times \rpar \rsqb \lpar \Delta t\bullet {\bi {V}}^{\, b}_{SINS}\rpar +\delta k{\bi {S}}^m_{OD}= \Delta t\bullet {\bi {V}}^{\, b}_{SINS}+{\bi {a}}\times \lpar \Delta t\bullet {\bi {V}}^{\, b}_{SINS}\rpar +\delta k{\bi {S}}^m_{OD} $$

Then we have

(39) $$\eqalign{\hat{{\bi {S}}}^b_{SINS}-\hat{{\bi {S}}}^m_{OD} & =\Delta t\bullet {\bi {V}}^{\, b}_{SINS} + \Delta t\bullet {\bi {C}}^{\, b}_n {\bi \Phi}\times {\bi {V}}^{\, n}_{SINS} + \Delta t\bullet {\bi {C}}^{\, b}_n\delta {\bi {V}}^{\, n}_{SINS} \cr & \quad -\lpar \Delta t\bullet {\bi {V}}^{\, b}_{SINS}+{\bi {a}}\times {\bi {S}}^b_{SINS}+\delta k{\bi {S}}^m_{OD}\rpar \cr & =\Delta t\bullet {\bi {C}}^{\, b}_n{\bi \Phi} \times {\bi {V}}^{\, n}_{SINS} + \Delta t\bullet {\bi {C}}^{\, b}_n\delta {\bi {V}}^{\, n}_{SINS}-{\bi {a}} \times {\bi {S}}^b_{SINS}-\delta k{\bi {S}}^m_{OD} \cr & =\Delta t\bullet {\bi {C}}^{\, b}_n\delta {\bi {V}}^{\, n}_{SINS} -\Delta t\bullet {\bi {C}}^{\, b}_n{\bi {V}}^{\, n}_{SINS}\times {\bi \Phi} -\delta k{\bi {S}}^m_{OD}+\lpar \Delta t\bullet {\bi {V}}^{\, b}_{SINS}\rpar \times {\bi {a}}} $$

Take the incremental position between the SINS and the OD as observations and the measurement equation can be written as

(40) $${\bi {Z}}=\hat{{\bi {S}}}^b_{SINS}-\hat{{\bi {S}}}^m_{OD}={\bi {HX}}+{\bi {V}} $$

where ${\bi {V}}$ is the white measurement noise with the power spectral density ${\bi {R}}$ . H is the coefficient matrix of the observations and can be expressed as

(41) $${\bi {H}}=\left[\matrix{\Delta t\bullet {\bi {C}}^{\, b}_n & -\Delta t\bullet {\bi {C}}^{\, b}_n{\bi {V}}^{\, n}_{SINS}\times {\bi 0}_{3\times 9} & {\bi {M}}}\right]$$

where

(42) $${\bi {M}}=\left[\matrix{0 & 0 & \Delta t \bullet V^b \cr S_{OD} & \Delta t \bullet V^b_z & -\Delta t \bullet V^b_x \cr 0 & -\Delta t \bullet V^b_y & 0 \cr}\right]$$

where $V^{b}_{r}$ , $V^{b}_{y}$ and $V^{b}_{z}$ denote the projection in the b frame of the measured velocity value ${\bi {V}}^{\, n}_{SINS}$ by SINS in n frame.

Comparing Equation (39) with Equation (10) in Zhao et al. (Reference Zhao, Zhao, Guo, Wang, Zhou and Wang2015), i.e.,

(43) $${\bi {Z}}=\hat{{\bi {S}}}^n_{SINS}-\hat{{\bi {S}}}^n_{OD}=\Delta t\bullet \delta {\bi {V}}^{\, n}_{SINS} -{\bi {S}}^n_{OD}\times {\bi \Phi} -\delta k{\bi {S}}^n_{OD}-{\bi {C}}^{\, n}_b{\bi {S}}^m_{OD}\times {\bi {a}} $$

with the notations adapted to those used in this paper, the following viewpoint is noted. Equation (39) is equivalent to Equation (43) mathematically. However, in the composition of the measurement matrix, the coefficients of installation angle error in this paper are the position increment calculated by SINS in the b frame, but is the output position increment of the OD in Zhao et al. (Reference Zhao, Zhao, Guo, Wang, Zhou and Wang2015). Equation (39) should be preferred, when an OD failure occurs. The measurement coefficients of installation angle error in this paper are not affected by the OD fault information, we just need to set the measurement noise variance of ${\bi {Z}}\lpar 2\rpar $ to infinity, only relying on ${\bi {Z}}\lpar 1\rpar $ and ${\bi {Z}}\lpar 3\rpar $ for estimate states and then the in-motion alignment method aided by the motion constraint of the vehicle which is presented in Fu et al. (Reference Fu, Qin, Li and Wang2012), can be used as a backup alignment strategy, thus we realise a tolerable alignment.

Based on the state process Equation (30) and measurement Equation (40), a KF can be employed to estimate the state in real time. Given an initial guess of the state $\hat{{\bi {X}}}^+_{0}$ and the associate covariance $\hat{{\bi {P}}}^+_{0}$ , the KF computes an a posteriori estimate $\hat{{\bi {X}}}^+_{k}$ and an a posteriori covariance $\hat{{\bi {P}}}^+_{k}$ as follows

(44) $$\hat{{\bi {X}}}^-_k={\bi {F}}_{k-1}\hat{{\bi {X}}}^+_{k-1} $$

(45) $${\bi {P}}^-_k={\bi {F}}_{k-1}{\bi {P}}^+_{k-1}{\bi {F}}^{\rm T}_{k-1}+{\bi {G}}_{k-1}{\bi {Q}}_{k-1}{\bi {G}}^{\rm T}_{k-1} $$

(46) $${\bi {e}}_k={\bi {Z}}_k-{\bi {H}}_k\hat{{\bi {X}}}^-_{k} $$

(47) $${\bi {K}}_k={\bi {P}}^-_{k}{\bi {H}}^{\rm T}_k\lpar {\bi {H}}_k{\bi {P}}^-_k{\bi {H}}^{\rm T}_k+{\bi {R}}_k\rpar ^{-1} $$

(48) $$\hat{{\bi {X}}}^+_k=\hat{{\bi {X}}}^-_k+{\bi {K}}_k{\bi {e}}_k $$

(49) $${\bi {P}}^+_k=\lpar {\bi {I}}-{\bi {K}}_k{\bi {H}}_k\rpar {\bi {P}}^-_k $$

where $\hat{{\bi {X}}}^-_{k}$ and $\hat{{\bi {P}}}^-_{k}$ are the a priori estimate and covariance respectively; ${\bi {e}}_{k}$ is called the innovation vector and ${\bi {K}}_{k}$ is called the gain matrix.

4.1. Simulation parameters setting

The parameters of the simulation are set as follows. The Inertial Measurement Unit (IMU) is composed of medium precision sensors and the errors are set as follows: the gyro constant drift: 0·01^°/h; the gyro random noise: 0·01^°/h; the accelerometer bias: $1\times 10^{-4}$  g; and the accelerometer measurement noise: $1\times 10^{-4}$  g. The SINS sampling rate is 100 Hz. The OD scale factor error is 0·2%. SINS pitch installation angle error is 5^′ and heading installation angle error is 10^′. The SINS location is north latitude 40^°, east longitude 118^° and height 400 m. The true velocity and attitude profiles for the first 300 s are shown in Figure 1.

Figure 1.

The true velocity and attitude profiles for simulated scenarios: (a) velocity, (b) attitude.

4.2. The in-motion coarse alignment algorithm simulation

The coarse alignment lasts 60 s and runs 50 times. To further test the performance of the coarse alignment algorithm, three cases are considered, i.e., case 1, simulation uses perfect sensors (error-free gyroscopes, accelerometers, and no OD measurement errors); case 2, simulation with the omitted parts kept and case 3, simulation with sensor errors.

For all three cases, the average attitude errors of 50 times coarse alignment are illustrated in Figure 2. It can be seen that the two level misalignment angles, roll error and pitch error, converge immediately at the beginning and with a good precision (better than 0·02^°) for all three cases. Specifically, the heading error takes longer than the two level misalignment angles to converge, and it stabilises at 0·5^° in 50 s for case 1. This validates the correctness of the above analysis for the coarse alignment algorithm. In comparison with case 1, we can see that the heading accuracy increased in case 2. This is mainly because the omitted parts are included. We hope that the alignment algorithm is perfect with all parts being considered, but the omitted parts are unknown since these parts need the Earth's rotation angular rate in the b frame and the velocity in the n frame. As discussed previously, for the real sensors, the sensor errors would affect the accuracy in the same way as the omitted parts. Because of the sensor errors and omitted parts, the heading error in case 3 is larger than the heading error in case 1 and case 2, but it is still less than 1·5^° after 60 s.

Figure 2.

Average attitude errors of 50 times coarse alignment for three cases.

Consequently, the attitude errors calculated by the proposed in-motion coarse alignment algorithm can fulfil the requirement for the fine alignment. The convergent speed of the coarse alignment is fast, but owing to the sensor errors and omitted parts, it only accomplished the coarse estimation of attitude errors in the initial alignment. This is why the fine alignment is required. Next, the maximum of misalignment angles for case 3 are used as input for the fine alignment to validate the proposed in-motion fine alignment algorithm based on the KF in the fine alignment algorithm simulation.

4.3. The in-motion fine alignment algorithm simulation

The simulation for fine alignment lasts 600 s and the step of the KF is set at 0.05 s. The estimation results of SINS installation angle error and OD scale factor error are presented in Figure 3 and the estimate errors of misalignment angles are plotted in Figure 4.

Figure 3.

Estimation results of SINS installation angle error and OD scale factor error.

Figure 4.

Estimate errors of misalignment angles.

It can be observed from Figures 3 and 4 that the proposed method can correctly estimate the SINS installation angle error and the OD scale factor error. The two level misalignment angles, roll error and pitch error, converge almost instantaneously with a high precision (better than 0·01^°), and the heading error can achieve and accuracy of 0·05^° in 300 s for the fine alignment stage.