Next Article in Journal
Conditional Random Field (CRF)-Boosting: Constructing a Robust Online Hybrid Boosting Multiple Object Tracker Facilitated by CRF Learning
Next Article in Special Issue
Improving Observability of an Inertial System by Rotary Motions of an IMU
Previous Article in Journal
Phase Error Correction for Approximated Observation-Based Compressed Sensing Radar Imaging
Previous Article in Special Issue
Inertial Motion Capture Costume Design Study
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Accurate Compensation of Attitude Angle Error in a Dual-Axis Rotation Inertial Navigation System

1
School of Instrument Science and Opto-Electronics Engineering, Beihang University, Beijing 100191, China
2
Inertial Technology Key Laboratory of National Defense Science and Technology, Beihang University, Beijing 100191, China
*
Author to whom correspondence should be addressed.
Sensors 2017, 17(3), 615; https://doi.org/10.3390/s17030615
Submission received: 17 December 2016 / Revised: 28 February 2017 / Accepted: 10 March 2017 / Published: 17 March 2017
(This article belongs to the Special Issue Inertial Sensors and Systems 2016)

Abstract

:
In the dual-axis rotation inertial navigation system (INS), besides the gyro error, accelerometer error, rolling misalignment angle error, and the gimbal angle error, the shaft swing angle and the axis non-orthogonal angle also affect the attitude accuracy. Through the analysis of the structure, we can see that the shaft swing angle and axis non-orthogonal angle will produce coning errors which cause the fluctuation of the attitude. According to the analysis of the rotation vector, it can be seen that the coning error will generate additional drift velocity along the rotating shaft, which can reduce the navigation precision of the system. In this paper, based on the establishment of the modulation average frame, the vector projection is carried out, and then the attitude conversion matrix and the attitude error matrix mainly including the shaft swing angle and axis non-orthogonal are obtained. Because the attitude angles are given under the static condition, the shaft swing angle and the axis non-orthogonal angle are estimated by the static Kalman filter (KF). This kind of KF method has been widely recognized as the standard optimal estimation tool for estimating the parameters such as coning angles (α1 , α2), initial phase angles (ϕ12), and the non-perpendicular angle (η). In order to carry out the system level verification, a dual axis rotation INS is designed. Through simulation and experiments, the results show that the amplitudes of the attitude angles’ variation are reduced by about 20%–30% when the shaft rotates. The attitude error equation is reasonably simplified and the calibration method is accurate enough. The attitude accuracy is further improved.

1. Introduction

The process of improving the precision of the inertial sensor used in an inertial navigation system (INS) is very difficult. Not only new manufacturing process techniques but also advanced assembly techniques and neoteric original materials are necessary to achieve the higher precision [1,2,3]. This is obviously costly. The dual-axis rotation modulating technique means the precision of an INS can be improved without using higher precision gyros. It is one of the strategies of improving the system precision performance at the system level. The key building blocks of the INS comprise an inertial measurement unit, a turntable, a navigation center processing unit (CPU), a display unit, and a control unit. The inertial measurement unit (IMU) has three gyroscopes and three accelerometers. Because the random drift noise cannot be modulated, normally dithered ring laser gyroscopes are used in the rotation modulating INS [4].
Obviously this is much more economical and convenient than the technique of improving the precision of the inertial sensors in an INS. Therefore, this technology has received wide attention in recent years in marine navigation for achieving high performance and low cost [4]. The North Atlantic Treaty Organization (NATO) including the United States uses this technology widely in naval ships and submarines [5,6].
As integration is essence of inertial navigation, the velocity and the position of a carrier can be obtained by integrating the output signals of the gyros and accelerations. Through the presentable symmetrical rotation around the axis with the IMU, some kinds of errors’ mean values such as the constant drift, asymmetry error of scale factor, etc., can be shifted to sinusoidal form [7,8,9,10]. Through the integration, these parameters can approach to zero. Then, the precision of the system is improved indirectly [11,12,13]. Thus the higher position accuracy can be obtained by the rotating modulation technique without raising the inertial component precision.
All technologies have two sides. Either case rotation or platform rotation creates coning errors. The disadvantage of rotation modulation is that it brings out an additional drift rate caused by the rotating vector, and then the attitude error is produced [14]. The nonconforming angle between the axis of casing rotation or the axis of platform rotation and the sensitive axis of the gyroscope obviously exists. In particular, misalignment will cause attitude error [15]. Another disadvantage of modulating technology is that demodulation is needed to show the real attitude of the carrier. That means that the attitude accuracy processing equation is more complex in dual-axis rotation modulation INS than in the strap down inertial navigation system (SINS) and single-axis rotation modulation INS. The attitude transformation matrix considered regarding the nominal trajectory of platform movement, case rolling non-alignment angle, gimbal-angle error, and setting error has been built in [14]. The matrix is suitable for space-stable systems, especially electrostatically suspended gyroscope (ESG) monitors. For dual-axis rotation modulation INS, the attitude transformation matrix should be rebuilt. This has not discussed completely up to now.
The attitude error propagation equation in [16] is concentrated by the fixing error angle between the two axes. A calibration method based on the theoretical study is put forward in this article. A demodulation program has been built regarding the angle conversion between the six different coordinate systems. The angle between the IMU and inner axis and the angle between the inner axis and outer axis are calculated by traditional calibration. [17] discusses the influence of the installation inclination angle on attitude accuracy. Because the analysis is based on the single-axis system, only the azimuth angle is considered. An approximate sinusoidal principle mathematic model is established and applied to the compensation of the vehicle attitude output deviation. [18] provides the error model considering the gyro drift, accelerometer error, misalignment angle of the gyro case rotation axis, installation error, and frame angle bias. The system parameters are identified by the least squares identification method. The discussion focuses on the attitude accuracy of space-stable INS. [19] builds the calibration and compensation method for the precision of the output attitude in the dual-axis rotational INS. The mounting errors between the inertial measurement unit and the turntable are analyzed and calibrated. The calibration method is a thin-shell (TS) algorithm. Again, the turntable frame is an orthogonal coordinate frame. Only article [20] talks about the redundancy angle variation causing the cross coupling effect. It can also cause velocity and attitude disturbances. The model is still based on the coordinate transformation between the platform frame and ESG.
All the articles mentioned above do not analyze the axis non-orthogonal angle. The research done before also does not consider the coupled effects caused by this angle. Therefore, the attitude error caused by the shaft swing angle cannot be compensated thoroughly. The variation of the velocity and attitude are increased with the increase of the axis non-orthogonal angle. This article puts emphasis on the non-orthogonal angle of the axes and the shaft swing angle among all the diathesis.
The structure diagram is used to illustrate that these two angles are indeed unavoidable. The variation component of the shaft swing angle will increase the uncertainty component in the attitude error. Observing the actual uncompensated attitude of the designed dual-axis rotational system, two main kinds of error are shown. One has a sinusoidal curve, and the other has a jagged curve. The quantity of the former is about scores of arc-min and the latter is about 10% of the former. As for the sinusoidal curve, the core of the theory is the coning error which is evidenced by the rotating vector differential equation. Besides, the rolling non-alignment angle, axis non-orthogonal angle, and shaft swing angle all influence the attitude transform matrix through coining error formation. So the attitude precision is determined greatly by these factors. It also decides the platform price of mainly the two axis platform. The cross coupling effect due to shaft swing angle and its variation should make the platform rolling non-alignment angle not be compensated completely. Due to the axis non-orthogonal angle, periodic components exist. When the IMU rotates around the horizontal axis, the X gyro and Y gyro will produce periodic components on the horizontal axis. In order to obtain high precision attitude, we need to determine the axis non-orthogonal angle and the shaft swing angle. Then we can compensate for them.
The direction-cosine matrix (DCM) including the axis non-orthogonal angle and platform rolling angle is described based on the geometric projection of the error vectors. In order to obtain the values of the parameters, the calibration and compensation methods are given based on the attitude error matrix. Notice that the attitude angle and heading angle are unchanged under the static condition, and the fluctuation of the attitude angle and heading angle can be used as observations. Five resolutions of vectors which are decomposed by the non-orthogonal angle and shaft swing angle in the navigation coordinate can be taken as state vectors. Then, the observed equation is developed in this article. 500 Monte Carlo simulations are performed to verify the filtering accuracy. Simulation and test results show that, with the new compensation model, the attitude errors can be reduced by about three or four times.
The outline of this paper is as follows: Section 1 is the introduction. The brief description about the gimbaled structure of the dual-axis rotation inertial navigation system is introduced briefly in Section 2, and the cause of the non-orthogonal angle and the shaft swing angle is also given in this section. Section 3 provides the definition of correlative coordinates. The modulation average frame is especially defined here to help set up the projection of the axis non-orthogonal angle. The expression form and the influence of the coning error are explained in detail by the rotating vector differential equation in Section 4, and the attitude transform matrix and attitude error equation are built in this section. In Section 5, the calibration method is shown. The simulation results and the practical experiment results are shown in Section 6 along with the discussion. The conclusions are given in Section 7 with some necessary discussions.

2. Structure of the Dual-Axis

The axes of the dual-axis rotational inertial navigation system should be orthogonal in space. The structure of the dual-axis rotational INS is shown in Figure 1.
Notice that any one of the axes consists of two discontinuous parts due to the IMU. The figure shows that the inner axis is neither the upper axis nor the lower axis. The communal axis which is determined by the upper and lower axes is actually the real rotational axis which is not any one of the physical axes. It is the same as the outer axis. The outer axis is the communal axis determined by the left and right axis. This means the center lines’ positions of the rotary axes are determined by the axis hole and the axis itself. The swing amplitude of the axis is affected by the coaxial degree between the shaft hole, the bearing saddle bore, and the bearing precision. The verticality of the common axes of the two sets of holes on the outer gimbal and the coaxiality of the two holes on the inner gimbal influence the initial static perpendicularity of the inner axis and the outer axis. The vertical and lateral degrees of the inner and outer axes are affected by the common axis, each of which consists of two holes on the outer gimbal. There are many factors that determine the stability of the actual axis, such as the machining precision of the holes, the precision of the bearings, the assembly precision, etc. As a result, the inner axis cannot be perpendicularly rigid with the outer axis. Even the co-planarity requirement of the two axes is difficult to ensure. So the actual rotation axis is swaying all the time when the physical axis is rotating.
The turntable frame is a non-orthogonal coordinate system because of the non-perpendicularity of the two rotational axes. Furthermore, the rotational axes are unstable with the rotation of the shaft. The non-orthogonal angle between the inner axis and the outer axis and the swaying of each communal axis introduce additional errors of the attitude. A quantitative analysis in theory is necessary to determine the effects of the orthogonal error and the swaying error and whether to compensate for such errors.

3. Coordinate Systems

The error analysis is developed in the determined orthogonal and right-handed coordinate frames. However, it is obvious that the sensitive axes of gyros and accelerometers are not orthogonal in the actual physical structures [19]. In addition, the turntable frame is also non-orthogonal. All useful frames should be established for modeling and analysis.
The frames include the IMU, turntable, modulation average, basement, the body, and navigation frames. Figure 2 shows the relationship between these when the INS is settled on a horizontal plane.

3.1. IMU Frame

The IMU frame, denoted by S, is an orthogonal coordinate frame. All the accelerometers and gyros are not strictly orthogonally mounted. For ensuring correct calculations, all sensor outputs should be transformed into an orthogonal coordinate frame called the IMU frame. The origin of this frame is the centroid of the IMU. At the beginning time, the Ys is defined to coincide with the Yg. The Xs is perpendicular with the Ys in the same plane. The Zs axis is orthogonal to both Xs and Ys, which make up a right-hand orthogonal frame. Because the non-orthogonal angles between the gyros and accelerometers are not considered here, the errors between the IMU frame, gyro frame, and accelerometer frame are considered as zero. The S frame is strapped to the turntable and rotates with it. At the beginning time, the S frame coincides with the n frame. At the same time, the angles of the two encoders mounted on the gimbals are marked as zero.

3.2. Turntable Frame

The turntable frame, denoted by P, is defined by the turntable’s two axes as a real frame. The Yp axis is defined to coincide with the direction of the outer axis of the turntable. The Zp axis is consistent with the inner axis of the turntable. The Xp axis is orthogonal to both Yp and Zp axes and makes up a right-hand orthogonal frame. The P frame is a non-orthogonal frame because the Zp axis is not perpendicular to the Yp axis. This frame can be also expressed as {Yp × Zp ,Yp, Zp} Of course, it is a dynamic coordinate system.

3.3. Modulation Average Frame

The modulation average frame, denoted by P ¯ , is an orthogonal coordinate system. Since the P frame is non-orthogonal, it is necessary to build a new orthogonal frame so that the navigation parameter resolution can be calculated in this frame. In order to simplify the calculation and using the projection method, we define the Z P ¯ axis, the X P ¯ axis overlap with the Zp axis, and the Xp axis, respectively, when the P frame is in the initial state. The Y P ¯ axis is orthogonal to both X P ¯ and Z P ¯ axes and makes up a right-hand orthogonal frame. This frame can be also expressed as {Yp × Zp , Zp × (Yp × Zp), Zp}. The misalignment angle between the P ¯ frame and the n frame is considered as zero to simplify the calibration. This frame is a dynamic coordinate system rotating with the turntable.

3.4. Body Frame

The body frame, denoted by b, is rigidly attached to the vehicle. The Xb axis points rightward, the Yb axis points forward, and the Zb axis points upwards. The origin of this frame is in the centroid of the vehicle. In the initial state, the body frame coincides with the P ¯ frame.

3.5. Navigation Frame

The navigation frame, denoted by n, is defined by the East-North-Up geographic frame. The Xn axis points in the direction of geodetic east. The Yn axis points in the direction of geodetic north. The Zn axis points in the direction of geodetic vertical. The attitude of the ship is defined by the Euler angles of the body frame with respect to the corresponding navigation frame.

4. Coning Error Analysis and Attitude Modeling

According to the definition of all the frames, the S, P ¯ , b, n frames are all orthogonal coordinate frames. Only the P frame is a non-orthogonal coordinate frame. After the rolling misalignment angle of the S frame with the P frame has been calibrated and compensated, the shaft swing angle caused by the bearing accuracy and shaft assembly accuracy and the non-orthogonal angle between the P ¯ frame and P frame produce coning errors.

4.1. Coning Error Analysis

When the S frame rotates around the oyp axis, two cones are created according to the definition of the frames. The oy p ¯ , oz p ¯ axes are the generatrices of the two cones, respectively. The oyp axis is the symmetrical axis. Figure 3 shows the two cones.
The rotation vector from the S frame to the P frame is expressed as
φ ps s = [ ϕ x s ϕ y s ϕ z s ] = ϕ u
where, u = φ ϕ is a unit column vector along the direction of the rotational axis. The orientation here is the direction of the oyp axis;
ϕ = ( ϕ x s ) 2 + ( ϕ y s ) 2 + ( ϕ z s ) 2 . The rotation angle φ is created when the S frame rotates around the axis of the P frame;
When the rotational velocity is ω, the relationship between the rotation vector ϕ and the rotational velocity vector ω can be expressed as
φ · = ω + 1 2 φ × ω + 1 ϕ 2 ( 1 ϕ 2 cos ( ϕ 2 ) ) φ × ( φ × ω )
The first item on the right is an interchangeable component. It is a fixed axis rotation component. The second term is the cone component. The cone movement of the gyroscope sensitive axis is caused by the rolling non-alignment angle, shaft swing angle, and axis non-orthogonal angle. This kind of cone motion creates a certain drift angular speed along the axis of the rotation direction. The expression obtained by matrix inverse for (2) is
ω = { I 1 c o s ϕ ϕ 2 [ φ ] + 1 ϕ 2 ( 1 s i n ϕ ϕ ) [ φ ] 2 } φ ·
where ω is the additional drift angular velocity, which increases the attitude errors. As a result, the rate of roll angle error is increased. It is easy to see from Figure 3 that two gyroscopes produce the coning movement after the rolling non-alignment angle has been calibrated. The gyro with the sensitive axis that is coincident with the rotational axis produces the drift angular velocity directly. The drift angular velocity caused by the other gyro couples to the rotational axis. Not only the attitude error but also the position error increases. The coupling component of the cone motion, created by the vertical gyro rotating around the oyp axis, causes the fluctuation of the roll angle. Therefore, it is necessary to calibrate and compensate for the non-orthogonal angle and the shaft swing angle to improve the attitude precision.
Article [17] introduces a calibration method to calibrate the skew angles, which are always large angles. This article focuses on the small angles after large coning errors have been compensated for.

4.2. Attitude Modeling Method

In order to obtain the relatively complete formula of the attitude, some transformation matrices should be established.

4.2.1. The Transformation Matrix between the S Frame and the P ¯ Frame

The figure of the relationship between the S frame and the P ¯ frame is shown in Figure 4 according to the definition mentioned in Section 3.
Here we assume that the misalignment angle between the S frame and the P frame has been calibrated and compensated for. The emphasis here is put on the shaft swing angle and the non-orthogonal angle, which are small angles and are caused by the reasons mentioned in Section 2. In Figure 4c, η is a non-orthogonal angle between the ozp axis and the oyp axis, and is also the angle between the oyp axis and the o y p ¯ axis. In Figure 4a, α1 is a cone angle caused when the S frame rotates around the ozp axis. In Figure 4b α2 is a cone angle caused when the S frame rotates around the oyp axis. α1 and α2 belong to the shaft swing angle. The rotational angular velocity of the ozp axis and oyp axis are ω1 and ω2, respectively. So the shaft swing angle along the ozp axis can be resolved as:
α 1 x = α 1 cos λ 1
α 1 y = α 1 sin λ 1
where λ1 = λ + ϕ1, and λ is the rotation angle when the IMU rotates around the ozp axis. It can be measured by the angle encoder or calculated as λ=ω1t. ϕ1 is the initial phase angle.
Similarly, the shaft swing angle along the o y P axis can be written as:
α 2 x = α 2 sin λ 2
α 2 z = α 2 cos λ 2
where λ2 = λ + ϕ2, and ϕ2 is the initial phase angle. Generally, ω1 = ω2 = ω. Then λ = ω1t = ω2t = ωt.
Three angles need to rotate to transform the S frame to the P ¯ frame. First, the S frame rotates around the o z P ¯ axis with α1z; Second, the S frame rotates around the oys axis with α1y; Third, the S frame rotates around the oxs axis with α1x. Notice that the non-orthogonal angle affects the computing coning angle when we obtain the DCM between the S frame and the P ¯ frame. The P1 frame is created by rotating the P ¯ frame around the Xp axis with angle η to help find its projection in the P ¯ frame. The geometric projection of the non-orthogonal angle in the P ¯ frame is shown in Figure 4c. So the relationship between α1z and η is
α 1 z cos η = α 2 z α 1 x sin η
By substituting Equation (8) with Equations (4) and (7),
α 1 z cos η = α 2 cos λ 2 α 1 cos λ 1 sin η
since
C S P ¯ = ( C P ¯ S ) T = [ 1 α 1 z α 1 y α 1 z 1 α 1 x α 1 y α 1 x 1 ]
so
C S P ¯ = [ 1 α 2 ω cos λ 2 sec η + α 1 ω cos λ 1 tan η α 1 ω sin λ 1 α 2 ω cos λ 2 sec η α 1 ω cos λ 1 tan η 1 α 1 ω cos λ 1 α 1 ω sin λ 1 α 1 ω cos λ 1 1 ]
and
α = [ α 1 cos λ 1 α 1 sin λ 1 α 2 cos λ 2 sec η α 1 cos λ 1 tan η ] T

4.2.2. Attitude Model Method

The attitude angle should be demodulated because of the rotation of the IMU. The real output of the body can be calculated from the angles between the IMU frame and the navigation frame by removing the turntable’s rotation angles from the IMU attitude. We can obtain more precise attitudes if the parameters such as α1, α2, and η mentioned before are calibrated and compensated for correctly. The attitude transform matrix C b n is important in the process of calculating the attitude of the dual-axis rotation INS. All useful and necessary messages for the attitude algorithm are included in this matrix. The rotation from the b frame to the n frame can be derived from three rotations, C P ¯ n , C S P ¯ , C b S , using the relation
C b n = C P ¯ n C S P ¯ C b S
where C P ¯ n is a transform matrix from the P ¯ frame to the n frame. This matrix can be decomposed into two matrices.
C P ¯ n = C P 0 ¯ n C P ¯ P 0 ¯
It does not matter whether the rotation scheme is 8, 16, or 64 sequences; the turntable rotates among four static positions in absolutely symmetrical sequences. Therefore, the turntable attitude matrix C P ¯ n at the four positions 1, 2, 3, and 4 can be written as:
( C P ¯ P 0 ¯ ) 1 = [ 1 0 0 0 1 0 0 0 1 ] ( C P ¯ P 0 ¯ ) 2 = [ 1 0 0 0 1 0 0 0 1 ] ( C P ¯ P 0 ¯ ) 3 = [ 1 0 0 0 1 0 0 0 1 ] ( C P ¯ P 0 ¯ ) 4 = [ 1 0 0 0 1 0 0 0 1 ]
C P 0 ¯ n = [ sin L 0 cos L 0 1 0 cos L 0 sin L ]
C b S is the transformation matrix from the body frame b to the turntable frame S. It can be represented by two angles measured by the two angle encoders in real-time. β is the relative angle between the inner gimbal and the outer gimbal. ζ is the relative angle between the outer gimbal and the basement. The expression is written as:
C b S = [ cos ( β ) sin ( β ) 0 sin ( β ) cos ( β ) 0 0 0 1 ] [ sin ( ζ ) 0 cos ( ζ ) 0 1 0 cos ( ζ ) 0 sin ( ζ ) ] = [ cos β sin ζ sin β cos β cos ζ sin β sin ζ cos β cos ζ sin β cos ζ 0 sin ζ ]
C b n represents the DCM of the n frame with respect to the b frame. When the yaw, pitch, and roll angle are ψ, θ and Υ, respectively, the C b n can be written as:
C b n = [ cos γ cos ψ + sin γ sin ψ sin θ sin ψ cos θ sin γ cos ψ cos γ sin ψ sin θ cos γ sin ψ + sin γ cos ψ sin θ cos ψ cos θ sin γ sin ψ cos γ cos ψ sin θ sin γ cos θ sin θ cos γ cos θ ] = [ T 11 T 12 T 13 T 21 T 22 T 23 T 31 T 32 T 33 ]
So
Φ = [ θ γ ψ ] T = [ arcsin T 32 arctan T 31 T 32 arctan T 12 T 22 ] T

4.3. Attitude Error Modeling Method

Substituting Equation (14) into (13) and differentiating both sides of the equation gives:
δ C b n = δ C P 0 ¯ n C P ¯ P 0 ¯ C S P ¯ C b S + C P 0 ¯ n C P ¯ P 0 ¯ δ C S P ¯ C b S + C P 0 ¯ n C P ¯ P 0 ¯ C S P ¯ δ C b S
where,
δ C b n = [ Φ n ] C b n = [ 0 ϕ ψ ϕ γ ϕ ψ 0 ϕ θ ϕ γ ϕ θ 0 ] C b n
Φn is the attitude angle error vector. It can be expressed as
Φ n = [ ϕ θ ϕ γ ϕ ψ ] T
δ C S P ¯ = [ α g ] C S P ¯ = [ 0 α 2 ω cos λ 2 sec η α 1 ω cos λ 1 tan η α 1 ω sin λ 1 α 2 ω cos λ 2 sec η + α 1 ω cos λ 1 tan η 0 α 1 ω cos λ 1 α 1 ω sin λ 1 α 1 ω cos λ 1 0 ] C S P ¯
δ C b S = [ δ χ S ] C b S = ( [ 0 δ ζ 0 ] + [ cos ζ 0 sin ζ 0 1 0 sin ζ 0 cos ζ ] [ 0 0 δ β ] ) C b S
δ χ = [ δ β sin ζ δ ζ δ β cos ζ ] T
Substituting Equations from (21) to (25) into Equation (20), and then right multiplying C n b on both sides of the equation. At last changing the result to vector form:
Φ n = C P ¯ n α · + C S n χ
Because the gimbal angle error is not the main error considered here, Equation (26) can be rewritten as
Φ n = C P ¯ n α ·
So
[ ϕ θ ϕ γ ϕ ψ ] = [ sin ( ω t β ) cos ( ω t β ) 0 0 0 sin L cos ( ω t β ) sin L sin ( ω t β ) cos L sin ω t cos L cos ω t sin L cos ω t cos L cos ( ω t β ) cos L sin ( ω t β ) sin L sin ω t sin L cos ω t cos L sin ω t ] · [ α 1 ω cos ϕ 1 α 1 ω sin ϕ 1 α 2 ω cos ϕ 2 sec η α 1 ω cos ϕ 1 tan η α 2 ω sin ϕ 2 ]
According to Equation (20), it is obvious to see that the attitude errors are caused by the non-orthogonal angle, the shaft swing angle, and the gimbal angle error. The amplitude of the attitude errors directly increase with the increase of the coning angles α1, α2, and the non-orthogonal angle η.

5. Calibration Method

Before calibrating the model parameters of the shaft swing angle (α1, ϕ1), (α2, ϕ2), and the non-orthogonal angle η, traditional methods should be used to calibrate and compensate for the IMU errors in the conventional sensor model. Then the mounting errors should be calibrated using the method mentioned in article [17].
The parameters (α1, ϕ1), (α2, ϕ2), and η can be calibrated by using the difference between the in-situ test data and the known attitude angle. The roll and pitch angles are zero when the system is set on a horizontal basement. At the same time, the head angle is a fixed value. We can use this information to calibrate the parameters by the Kalman filter.
The state vectors of the filter can be set as:
X = [ α 1 cos ϕ 1 α 1 sin ϕ 1 α 2 cos ϕ 2 sec η α 1 cos ϕ 1 tan η α 2 sin ϕ 2 ]
The measurement vectors are
Z k = [ ϕ x ϕ y ϕ z ] T
From Equation (28), the measurement equation is
Z = Hx + υ
where H is the measurement matrix.
H = [ sin ( ω t β ) cos ( ω t β ) 0 0 0 sin L cos ( ω t β ) sin L sin ( ω t β ) cos L sin ω t cos L cos ω t sin L cos ω t cos L cos ( ω t β ) cos L sin ( ω t β ) sin L sin ω t sin L cos ω t cos L sin ω t ]
υ is the measurement noise that has the nature of white noise. It satisfies
E ( υ ) = 0 E ( υ k υ j T ) = R k δ kj
where R is a symmetic, positive, definite matrix. δ kj = { 1 k = j 0 k ? j is the Kronecher δ function.
Suppose that x0 has x 0 ¯ as its mean value and P0 as the covariance matrix is independent with {υ}. Thus, the state Kalman filter is
x ^ ( t k ) = x ^ ( t k 1 ) + P ( t k ) H ( t k ) R 1 ( z ( t k ) H ( t k ) x ^ ( t k 1 ) ) , x ^ ( t 0 ) = x ¯ 0 P ( t k ) = ( P ( t k 1 ) + H ( t k ) R 1 H T ( t k ) ) 1 , P ( t 0 ) = P 0
According to the measurement vector z(tk), the filter state estimation vector x ^ ( t k ) can be obtained. When the output of the filter is stable, the estimated variables converge to the true value, and the calibration process is over. After obtaining the estimate of the variables, the shaft swing angle and the non-orthogonal angle can be calculated as follows:
α ^ 1 = x ^ 1 2 + x ^ 2 2 ϕ ^ 1 = arctan 2 ( x ^ 1 , x ^ 2 ) η = arctan 2 ( x ^ 4 , x ^ 1 )) α ^ 2 = ( x ^ 3 cos ( arctan 2 ( x ^ 4 , x ^ 1 ) ) 2 + x ^ 5 2 ϕ ^ 2 = arctan 2 ( x ^ 5 , x ^ 3 cos ( arctan 2 ( x ^ 4 , x ^ 1 ) ) )

6. Results

6.1. Simulation Results

To verify the compensation effect of the method of calibrating the rolling non-alignment angle and the non-orthogonal angle, a simulation experiment was performed. The data used in the simulation were collected from the designed and manufactured INS mentioned in Section 6. In this system, the IMU is an independent unit. Not only three dithered ring laser gyroscopes and three quartz accelerometers, but also a data acquisition board and a calculating board are used in the IMU. Therefore, the IMU can output the angular velocity and the acceleration of the vehicle by operating a certain program in Digital Signal Processing board.
In order to guarantee the repeatability of the results, the test environment is kept as consistent as possible. The system preheating time, the data acquisition time, method of data acquisition, test equipment, navigation solution method, the rotation scheme, etc., are all kept the same during this study.
The IMU has been calibrated independently before being mounted in the turntable. The mislignment matrix of the gyro and accelerometer in the IMU frame and the scale factor are all calibrated. The specifications of the designed dual-axis rotation INS are shown in Table 1. Data are collected for 200 s in each test group, with an angular velocity of 10°/s (±0.1%) for the calibration. After all kinds of the mounting errors and the angle errors of the angle encoders are calibrated for, we can use Equation (28) to calibrate for the slight errors such as α, ϕ, and η.
Here a 500 Monte Carlo simulation was used to evaluate the calibration precision. The swaying angle for the calibration was set following the distribution S (− 10 , + 10 ). The phase for the calibration was set following the distribution A (− 1 ° , + 1 ° ). The non-orthogonal angle for calibration was set following the distribution Q (−20′′, +20′′). Table 2 is a set of simulation results for certain errors. Table 3 shows the precision of the calibration estimated by the 500 Monte Carlo simulation.

6.2. Laboratory Experimental Results

A dual-axis rotational inertial navigation system was designed for the experiment, shown in Figure 5. The turntable was designed in theory by two orthogonal gimbals. The IMU was mounted in the middle of the turntable. Driven by the torque motor, the IMU rotates about one axis at one time alternately with a special scheme. In consideration of the calibration in real-time and the isolation of the craft movement [21,22], the inner gimbal rotates in an azimuth plane and the outer gimbal rotates in a horizontal plane. Therefore the inner axis can be called the vertical axis, and the outer axis can be called the rolling axis.
A navigation grade IMU was developed using three dithered ring laser gyroscopes (0.005°/h) and three quartz accelerometers (100 μg). On the rotors of the gimbals, two electrical torques and two angle encoders were mounted to control the rotations. In addition, three slip-rings were mounted individually in the up-axis, down-axis, and right-axis. They support cables connecting the inertial sensors and outer circuits. Figure 6 shows the functional diagram of the system.

6.2.1. The Data Analysis before Compensation

After compensating for the installation misalignment angle, the attitude of the INS is shown in Figure 7.
Figure 7a shows the rotation angles and the sequence of the two axes. The head angle change regulation of the head angle with the axes is shown in Figure 7b. The change regulation of the roll angle with the axes is shown in Figure 7c. The change regulation of the pitch angle with the axes is shown in Figure 7d. Observing these curves, it can be found that the head angle changes with the inner axis rotation. The roll angle changes with the outer axis rotation. Any rotation of the shaft can cause the change of the pitch angle. This is the result of the coupling component of the cone error, according to the previous analysis.
It can be seen that the head angle error is about 2.5′ from the Figure 7b; the roll angle error is about 1.86′ from the Figure 7c; and the pitch angle error is about 1.6′ from the Figure 7d.

6.2.2. The Data Analysis after Compensation

After the shaft swing angle and the non-orthogonal angle are compensated for by using the methods mentioned in Section 5, the attitudes of INS are shown in Figure 8. The attitudes before the compensation are also shown in Figure 8.
Through data analysis, the changes of the attitude angle error before and after compension are as follows:
The head angle error reduces from 2.5′ to 49.32″; the roll angle error reduces from 1.86′ to 30.24″; and the pitch angle error reduces from 1.6′ to 25.2″.
There are still some changes of the attitude angles after calibrating the shaft swing angle and the non-orthogonal angle. This is because the shaft swing angle is not a constant. Therefore, the smaller the change of the swing angle, the higher the attitude accuracy of the system.

7. Conclusions

In this paper, we found that the shaft swing angle and the non-orthogonal angle are inevitable errors after analyzing the structure of the dual-axis rotation INS, and they are also coning errors. They not only can reduce the accuracy of the attitude, but can also reduce the position accuracy of the dual-axis rotation INS in long-term navigation. In order to improve the attitude accuracy further, a calibration method is proposed in this paper. Specifically, the following contributions have been made:
The modulation average frame P ¯ is established. The attitude transformation matrix C b n , attitude, and its error equations including the shaft swing angle and non-orthogonal angle are mainly derived in the frame P ¯ . The static Kalman filter is used to estimate the coning angles (α12), initial phase angles (ϕ1,ϕ2), and non-perpendicular angle (η).
Through the simulation and the static verification of the actual system, the results show that the calibration method is feasible. The attitude accuracy increased about 20%–30% after the precise compensation. The attitude error equation is reasonably simplified and the calibration method is accurate enough.
At the same time, we found that there are still slight perturbations of the attitude angle curve. This is caused by two factors; one is the encoder reading angle, and the other is the shaft swing angle that is not a fixed value. Furthermore, the calibration is established under the static condition and is not feasible for a ship at the docking side. For a wider range of applications, the static Kalman filter based on disturbed specific forces should be designed to identify the model coefficients.

Acknowledgments

The project is supported by the National Natural Science Foundation of China (61340044) and the Fundamental Research Funds for the Central Universities (YWF-10-01-B30). Special acknowledgment is given to Rui Jiang of Beihang University for performing the ship experiment during May 2015.

Author Contributions

This paper was completed by the listed authors. Rui Jiang completed the INS design, error modeling, simulation, and manuscript writing. Gongliu Yang provided funding for the research and design of the INS. As members of the research and design team, Rui Zou was responsible for the preparation of the DSP program and the PC program. Jing Wang and Jing Li provided a lot of help in the experiments.

Conflicts of Interest

The authors declare no conflict of interests.

References

  1. Ciminelli, C.; Dell’Olio, F.; Campanella, C.E.; Armenise, M.N. Photonic technologies for angular velocity sensing. Adv. Opt. Photonics 2010, 2, 370–404. [Google Scholar] [CrossRef]
  2. Ciminelli, C.; Dell’Olio, F.; Armenise, M.N.; Soares, F.M.; Passenberg, W. High performance InP ring resonator for new generation monolithically integrated optical gyroscopes. Opt. Express 2013, 21, 556–564. [Google Scholar] [CrossRef] [PubMed]
  3. Ciminelli, C.; Agostino, D.D.; Carnicella, G.; Olio, F.D.; Conteduca, D.; Ambrosius, H.P.M.M.; Smit, M.K.; Armenise, M.N. A high-Q InP resonant angular velocity sensor for a monolithically integrated optical gyroscope. IEEE Photonics J. 2015, 8, 1–19. [Google Scholar] [CrossRef]
  4. Zheng, Z.C.; Han, S.L.; Yue, J.; Yuan, L.L. Compensation for stochastic error of gyro in a dual-axis rotational inertial navigation system. Navigation 2016, 69, 169–182. [Google Scholar] [CrossRef]
  5. Titterton, D.H.; Weston, J.L. Strapdown Inertial Navigation Technology, 2nd ed.; IET/AIAA: London, UK; Reston, VA, USA, 2004. [Google Scholar]
  6. Gai, E. The century of inertial navigation technology. Aerosp. Conf. Proc. 2000, 1, 18–25. [Google Scholar]
  7. Zheng, Z.C.; Han, S.L.; Zheng, K.F. An eight-position self-calibration method for a dual-axis rotational inertial navigation system. Sens. Actuators A Phys. 2015, 232, 39–48. [Google Scholar] [CrossRef]
  8. Ren, Q.; Wang, B.; Deng, Z.H.; Fu, M.Y. A multi-position self-calibration method for dual-axis rotational inertial navigation system. Sens. Actuators A Phys. 2014, 219, 24–31. [Google Scholar] [CrossRef]
  9. Han, S.; Yuan, B.; Lu, G.; Rao, G.; Wang, G. The development and evaluation of a two-axis indexing NFFDLG INS for marine navigation. In Proceedings of the Inertial Sensors and Systems Symposium (ISS), Wuhan, China, 22–23 September 2015; pp. 19–35.
  10. Rao, G.Y.; Wang, G.C.; Han, S.L.; Zhang, W. Calibration of laser inertial navigator with dual-axis rotation. Int. J. Control Autom. Syst. 2015, 13, 960–966. [Google Scholar] [CrossRef]
  11. Levinson, E.; Ter Horst, J.; Willcoks, M. The next generation marine inertial navigation is here now. In Proceedings of the Position Location and Navigation Symposium, Las Vegas, NV, USA, 11–15 April 1994; pp. 121–127.
  12. Levinson, E.; Majure, R. Accuracy enhancement techniques applied to the marine ring laser inertial navigation. Navigation 1987, 34, 64–86. [Google Scholar] [CrossRef]
  13. Yuan, B.L.; Liao, D.; Han, S.L. Error compensation of an optical gyro INS by multi-axis rotation. Meas. Sci. Technol. 2012, 23, 025102. [Google Scholar] [CrossRef]
  14. Gao, Z.Y. Inertial Navigation System Technology, 1st ed.; Tsinghua University Press: Beijing, China, 2012; pp. 24–27. [Google Scholar]
  15. Hu, P.D.; Gao, Z.Y. Least square identification method of the misalignment angle of gyro case rotation axis. Chin. Inert. Technol. 2009, 17, 393–396. [Google Scholar]
  16. Liu, C.; Sun, L.K. A calibration method of fixing error angle between axes for dual-axis SINS. Navig. Position. Timing 2015, 2, 1–5. [Google Scholar]
  17. Gao, Y.B.; Guan, L.W. Compensation for inclination angle deviation of single-axis rotation modulation SINS. J. Chin. Inert. Technol. 2013, 21, 446–451. [Google Scholar]
  18. Hu, P.D.; Gao, Z.Y. Parameter calibration based on attitude errors of space-stable INS. J. Chin. Inert. Technol. 2012, 20, 521–524. [Google Scholar]
  19. Song, N.F.; Cai, Q.Z. Analysis and calibration of the mounting errors between inertial measurement unit and turntable in dual-axis rotational inertial navigation system. Meas. Sci. Technol. 2013, 24, 115002. [Google Scholar] [CrossRef]
  20. He, Q.N.; Gao, Z.Y. Accurate compensation for case rolling misalignment angle in space-stable systems. J. Chin. Inert. Technol. 2014, 22, 572–575. [Google Scholar]
  21. Wei, G. Research on Some Key Technologies for Double-Axis Rotation Inertial Navigation System with Mechanically Dithered Ring Laser Gyroscope. Ph.D. Thesis, Graduate School of National University of Defense Technology, Changsha, China, 2013; pp. 23–45. [Google Scholar]
  22. Yuan, B.L. Research on Rotating Inertial Navigation System with Four-Frequency Differential Laser Gyroscope. Ph.D. Thesis, Graduate School of National University of Defense Technology, Changsha, China, 2007; pp. 140–154. [Google Scholar]
Figure 1. Structural diagram of the dual-axis rotational inertial navigation system.
Figure 1. Structural diagram of the dual-axis rotational inertial navigation system.
Sensors 17 00615 g001
Figure 2. Regulation of the different frames.
Figure 2. Regulation of the different frames.
Sensors 17 00615 g002
Figure 3. Coning error caused by the non-orthogonal angle of the P frame.
Figure 3. Coning error caused by the non-orthogonal angle of the P frame.
Sensors 17 00615 g003
Figure 4. Geometric projection of the shaft swing angle and the non-orthogonal angle between the S frame, P frame, P1 frame, and the P ¯ frame. (a) one cone created when IMU rolls around the ozp axis; (b) another cone when IMU rolls around the oyp axis; (c) the geometric projection of the non-orthogonal angle in the P ¯ frame.
Figure 4. Geometric projection of the shaft swing angle and the non-orthogonal angle between the S frame, P frame, P1 frame, and the P ¯ frame. (a) one cone created when IMU rolls around the ozp axis; (b) another cone when IMU rolls around the oyp axis; (c) the geometric projection of the non-orthogonal angle in the P ¯ frame.
Sensors 17 00615 g004
Figure 5. An overall view of the designed dual-axis rotational INS.
Figure 5. An overall view of the designed dual-axis rotational INS.
Sensors 17 00615 g005
Figure 6. A functional diagram of the designed dual-axis rotational INS.
Figure 6. A functional diagram of the designed dual-axis rotational INS.
Sensors 17 00615 g006
Figure 7. System attitude angle after compensating for the misalignment angle. (a) Two axes rolling angels; (b) Head angle; (c) Roll angle; (d) Pitch angle.
Figure 7. System attitude angle after compensating for the misalignment angle. (a) Two axes rolling angels; (b) Head angle; (c) Roll angle; (d) Pitch angle.
Sensors 17 00615 g007aSensors 17 00615 g007b
Figure 8. System attitude angle after compensating for the non-orthogonal angle and shaft swing angle.
Figure 8. System attitude angle after compensating for the non-orthogonal angle and shaft swing angle.
Sensors 17 00615 g008aSensors 17 00615 g008b
Table 1. Specifications of the designed dual-axis roational INS.
Table 1. Specifications of the designed dual-axis roational INS.
CharacteristicsDescription
Output rates200 Hz
Accel. fixed bias (1σ)100 μg
Accel. stochastic error50 μg/h1/2
Accel. scale factor error<20 ppm
Accel. misalignment error<5′′
Range of accel±40 g
Gyro fixed bias (1σ)0.005°/h
Gyro stochastic error0.0005°/h1/2
Gyro scale factor error<20 ppm
Gyro misalignment error<5′′
Gyro g-dependent bias0.0001°/h/g
Range of Gyro±300°/s
A/D resolution32 bit
Supply Voltage24 V, ±5 V
Turntable ( 1 σ )12′′
Table 2. Specifications of the designed dual-axis roational INS.
Table 2. Specifications of the designed dual-axis roational INS.
ParameterSet ValueCalibrated ValueCalibrated Error
α 1 5′4′58.98′′1.02′′
φ 1 0°59′56.76′′−3.24′′
α 2 10′′9′58.57′′1.43′′
φ 2 0°59′57.87′′−2.13′′
η 20′′18.39′′1.61′′
Table 3. Calibration errors of simulations.
Table 3. Calibration errors of simulations.
ParameterError MeanStandard Deviation Error
α 1 0.98′′0.0238′′
φ 1 1.14′′0.6103′′
α 2 0.78′′0.0078′′
φ 2 0.65′′0.0317′′
η 1.05′′0.0091′′

Share and Cite

MDPI and ACS Style

Jiang, R.; Yang, G.; Zou, R.; Wang, J.; Li, J. Accurate Compensation of Attitude Angle Error in a Dual-Axis Rotation Inertial Navigation System. Sensors 2017, 17, 615. https://doi.org/10.3390/s17030615

AMA Style

Jiang R, Yang G, Zou R, Wang J, Li J. Accurate Compensation of Attitude Angle Error in a Dual-Axis Rotation Inertial Navigation System. Sensors. 2017; 17(3):615. https://doi.org/10.3390/s17030615

Chicago/Turabian Style

Jiang, Rui, Gongliu Yang, Rui Zou, Jing Wang, and Jing Li. 2017. "Accurate Compensation of Attitude Angle Error in a Dual-Axis Rotation Inertial Navigation System" Sensors 17, no. 3: 615. https://doi.org/10.3390/s17030615

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

Article Metrics

Back to TopTop