Next Article in Journal
Non-Contact Measurement of the Surface Displacement of a Slope Based on a Smart Binocular Vision System
Next Article in Special Issue
Economical High–Low Temperature and Heading Rotation Test Method for the Evaluation and Optimization of the Temperature Control System for High-Precision Platform Inertial Navigation Systems
Previous Article in Journal
A High-Efficiency Data Collection Method Based on Maximum Recharging Benefit in Sensor Networks
Previous Article in Special Issue
Oscillation Suppression in the Sense Mode of a High-Q MEMS Gyroscope Using a Simplified Closed-Loop Control Method
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Three-Stage Accelerometer Self-Calibration Technique for Space-Stable Inertial Navigation Systems

Department of Precision Instrument, Tsinghua University, Beijing 100084, China
*
Author to whom correspondence should be addressed.
Sensors 2018, 18(9), 2888; https://doi.org/10.3390/s18092888
Submission received: 19 June 2018 / Revised: 29 July 2018 / Accepted: 29 August 2018 / Published: 31 August 2018
(This article belongs to the Special Issue Inertial Sensors and Systems 2018)

Abstract

:
As a specific force sensor, the tri-axis accelerometer is one of the core instruments in an inertial navigation system (INS). During navigation, its measurement error directly induces constant or alternating navigation errors of the same order of magnitude. Moreover, it also affects the estimation accuracy of gyro drift coefficients during the initial alignment and calibration, which will indirectly result in navigation errors accumulating over time. Calibration can effectively improve measurement accuracy of the accelerometer. Device-level calibration can identify all of the parameters in the error model, and the system-level calibration can accurately estimate part of these parameters. Combining the advantages of both the methods and making full use of the precise angulation of the space-stabilized platform, this paper proposes a three-stage accelerometer self-calibration technique that can be implemented directly in the space-stable INS. The device-level calibration is divided into two steps considering the large amount of parameters. The first step is coarse calibration, which identifies parameters except for the nonlinear terms, and the second step is fine calibration, which not only identifies the nonlinear parameters, but also improves the accuracy of the parameters identified in the first step. The follow-on system-level calibration is carried out on part of the parameters using specific force error and attitude error to further improve the calibration accuracy. Simulation result shows that by using the proposed three-stage calibration technique in the space-stable INS, the estimation accuracy of accelerometer error can reach 1 × 10 6   g order of magnitude. Experiment results show that after the three-stage calibration, the accuracy of latitude, longitude, and attitude angles has increased by over 45% and the accuracy of velocity has increased by over 22% during navigation.

1. Introduction

Inertial navigation systems (INSs) tend to be the first choice for marine navigation because they are able to output motion parameters completely, autonomously, and continuously [1,2,3]. In order to fulfill the requirement for long-term and high-precision marine navigation, it is essential for INSs to employ high-precision inertial instruments. The gyroscope should be able to work stably for a long time, of which the drift error needs to be small and the constant drift can be precisely compensated. And as for the accelerometer, high stability of the bias and the scale factor is required [4].
All of the inertial instruments must be precisely tested and calibrated before they can work properly to provide accurate measurement in the INS [5,6]. According to the observed quantities, accelerometer calibration can be divided into two types, device-level calibration and system-level calibration. In device-level calibration, the accelerometer is set to measure the gravity of Earth at different positions by using a dividing head, a centrifuge, or a turntable, and error parameters are identified according to the outputs of the accelerometer [7,8,9]. The accelerometer data measured during the multi-position rotation of the turntable are compared with the theoretical value of the local gravity, and then using the least square method, error parameters can be estimated from their difference. The system-level calibration is based on the propagation of error parameters of inertial instruments to the final navigation errors. Error parameters can be precisely identified with a proper rotation scheme that is designed considering the parameter observability [3].
Jiang et al. [9] proposed a device-level calibration method based on the static-base condition, and the precise attitude and attitude rate provided by a tri-axis precision turntable, where the calibration accuracy can reach 1 × 10 6   g order of magnitude. However, in practical applications, it is difficult to provide an ideal laboratory environment for the implementation of this method. Won et al. [10] and Ye et al. [11] calibrated the accelerometer on the basis that the amplitude of the output vector of the tri-axis accelerometer equals 1 g. Studies [12,13,14,15,16,17,18,19,20,21] presented several system-level calibration methods specific to the microelectromechanical system (MEMS) inertial measuring unit (IMU), but the calibration accuracy needs to be improved. The methods proposed in references [22,23,24,25,26,27,28,29,30] are appropriate for the rotational INSs, and several novel methods are presented for the hybrid INSs in references [31,32]. Gao et al. [22] used position error and velocity error as the observed quantities to estimate the nonlinear error coefficients. They also used velocity error and attitude error to estimate the error coefficients of the gyroscope and the accelerometer [23]. Pan et al. [33] calibrated the nonlinear term in the scale factor based on the change rate of velocity error. Gao et al. [27] and Liu et al. [31] proposed methods to compensate the size effect and the lever arm effect, respectively. As for the turntable rotation strategy, the 6-position [22], 9-position [24,32], 18-position [18,34], and 24-position [35] methods have been proposed. In existing works, calibration methods are rarely designed for the space-stable INSs. In addition, the complementary benefits of device-level and the system-level calibration have not been taken into consideration.
In the space-stable INS, the platform is stabilized in inertial space by the gimbal servo system. With no applied torque, the moment of momentum of the rotor in the free-rotor gyroscope maintains fixed orientation in inertial space, which can ensure the high precision of the system [1]. As there is a stabilized platform in a space-stable INS, self-calibration based on such an own condition becomes the current development trend. This paper attempts to combine the advantages of full-parameter estimation in the device-level calibration and high-precision estimation of partial parameters in the system-level calibration. A three-stage self-calibration technique is proposed for the high-precision accelerometer calibration in practical applications. Firstly, device-level self-calibration is conducted directly in the system. It is divided into two steps considering the large amount of parameters. The first step is coarse calibration which identifies parameters except for the nonlinear terms, and the second step is fine calibration which identifies the nonlinear terms and simultaneously improves the accuracy of parameters identified in the first step. Secondly, the follow-on system-level calibration is carried out on part of the parameters using the errors of specific force and attitude angles to further improve the calibration accuracy. The proposed method is specific to the space-stable INS and has three contributions. First, taking advantage of the high-precision angulation ability of the gimbaled platform, the two-stage device-level calibration can be directly implemented in the system. Second, based on the error propagation of the residual accelerometer model error to navigation errors, the system-level calibration uses specific force error and attitude error to form the observation model. Third, the proposed three-stage calibration method merges the complementary advantages of both the device-level calibration and the system-level calibration to achieve full-parameter calibration of the accelerometer measurement model as well as high-precision estimation of part of these parameters. This can help further improve the performance of the system.
The rest of this paper is arranged as follows: In Section 2, the accelerometer measurement model is introduced. The device-level coarse calibration and device-level fine calibration are presented in Section 3 and Section 4, respectively. The system-level calibration method based on the errors of specific force and attitude angles is proposed in Section 5. Simulation and experiment results are discussed in Section 6. And finally conclusions are drawn in Section 7.

2. Accelerometer Measurement Model

For the convenience of following discussion, several coordinate frames are defined first, and the superscript of a vector will indicate which frame it is in.
O n x n y n z n —the local geographic navigation frame (n-frame), where the x n axis and the y n axis are in the local-level plane pointing north and east, respectively, and the z n axis is angled vertically downward. The gravity vector g has the same orientation with the z n axis in this coordinate system.
O b x b y b z b —the body-fixed coordinate frame (b-frame). The origin O b is usually located at the center of the mass of the vehicle. The x b axis points forward along the longitudinal axis, the z b axis points to the bottom, and the y b axis points rightward to form a right-handed coordinate system.
O p x p y p z p —the platform-fixed coordinate system (p-frame). The z p axis is along the axis of revolution of the platform. And ideally, x p and y p are along the revolution axes of the inner gimbal and the middle gimbal, respectively.
O a x a y a z a —the accelerometer coordinate system (a-frame), which is fixed on the tri-axis accelerometer. The x a , y a and z a axes are along the three sensitive axes, respectively. This coordinate system is non-orthogonal due to the installation error.
For a static system, the specific force measured in the n-frame should be:
f n = [ 0 0 g ] T ,
where g is the scalar gravity. Transforming it to the p-frame yields:
f p = C b p C n b f n ,
where the direction cosine matrix from the n-frame to the b-frame is:
C n b = [ cos ψ cos θ sin ψ cos θ sin θ sin ψ cos ϕ + cos ψ sin θ sin ϕ cos ψ cos ϕ + sin ψ sin θ sin ϕ cos θ sin ϕ sin ψ sin ϕ + cos ψ sin θ cos ϕ cos ψ sin ϕ + sin ψ sin θ cos ϕ cos θ cos ϕ ] ,
and the direction cosine matrix from the b-frame to the p-frame is:
C b p = [ cos S t sin h cos q sin S t sin q cos S t sin h sin q sin S t cos q cos S t cos h sin S t sin h cos q + cos S t sin q sin S t sin h sin q + cos S t cos q sin S t cos h cos h cos q cos h sin q sin h ] .
In Equation (3), ψ ,   θ ,   and   ϕ are yaw, pitch, and roll, respectively. In Equation (4), S t is the rotation angle of the platform’s revolution axis relative to the revolution axis of the inner gimbal, h is the rotation angle of the revolution axis of the middle gimbal relative to that of the outer gimbal, and q is the rotation angle of the revolution axis of the outer gimbal relative to the base. The rotation angle of the revolution axis of the inner gimbal relative to that of the middle gimbal is zero, for the outer gimbal is tracking the rotation angle of the inner gimbal, and for the revolution axes of the platform, the inner gimbal and the middle gimbal are orthogonal.
The geometric relationship between the orthogonal p-frame and the non-orthogonal a-frame is shown in Figure 1. It is assumed that installation error angles are all small quantities. β x ,   β y   and   β z denote the three installation error angles in the x-direction, y-direction, and z-direction, respectively. Each of these three small angles can be decomposed into two rotation angles around the axes of the p-frame, namely β x y   and   β x z , β y z   and   β y x , and β z x   and   β z y .
According to the geometric relationship shown in Figure 1, the direction cosine matrix from the p-frame to the a-frame can be calculated as:
C p a = [ 1 β x z β x y β y z 1 β y x β z y β z x 1 ] .
Thus the specific force measured by the tri-axis accelerometer satisfies an equation, as:
f a = S F 1 C p a C b p C n b f n + δ b + K n l ( f a δ b ) 2 ,
where SF is the matrix of scale factors, δ b is the bias vector, and K n l is the matrix of nonlinear coefficients of the scale factors. In this paper, a three-stage calibration technique is proposed, to estimate and compensate all the parameters shown in Equation (6). The first two stages will lay a foundation of full-parameter and full-value estimations of model coefficients. The third stage will then correct part of the coefficients and further improve the calibration accuracy. Although the final calibration accuracy will mainly depend on the novel system-level calibration method, it must work on the basis of the device-level calibration. Therefore, the first two stages of the device-level calibration designed for the space-stable INS will also be introduced to form the integrated three-stage calibration technique.

3. Device-Level Coarse Calibration

For the tri-axis accelerometer, there are totally 18 error coefficients that need to be calibrated: three scale factors, S F x ,   S F y   and   S F z ; three biases, δ b x ,   δ b y   and   δ b z ; three nonlinear coefficients of the scale factors, K n l x ,   K n l y   and   K n l z ; six installation error angles β x y ,   β x z , β y z ,   β y x ,   β z x   and   β z y ; and three zero-point offsets of the gimbals’ angular sensors, θ 10 of the platform axis, θ 20 of the inner gimbal axis, and θ 30 of the middle gimbal axis. The platform needs to be rotated to 18 positions. Table 1 lists the order of rotation, and the corresponding rotation angles of the gimbals and components of the p-frame gravity vector [3], where the symbol denotes that the angle remains unchanged. Figure 2 shows the directions of the accelerometer’s sensitive axes in detail, where N, W, and U denote the local northern, western and up directions, respectively, and x, y, and z denote the orientations of the tri-axis accelerometer.
During coarse calibration, the nonlinearity of scale factors is ignored. Thus the accelerometer measurement equation shown in Equation (6) can be simplified as:
f a = S F 1 C p a g p + δ b ,
where C p a g p is the gravity vector sensed by the tri-axis accelerometer.
Each position takes 20 s for the rapid measurement. Based on the outputs of the tri-axis accelerometer at different positions and Table 1, 18 equations can be obtained according to Equation (7) to preliminarily estimate 15 parameters except the nonlinear coefficients. Scale factors and biases can be coarsely estimated by solving the equation set corresponding to the six rotation positions (No. 1, 3, 5, 7, 9, and 11) where each sensitive axis of the tri-axis accelerometer points upward or downward along the z n axis in turn. The other equations corresponding to the rest of the rotation positions (No. 2, 4, 6, 8, 10, and 12~18), where one of the sensitive axes is parallel to the x n axis or the y n axis, and other two sensitive axes have included angles of 45° with the vertical direction, are used to estimate zero-point offsets of the angular sensors and installation error angles.
Estimated values of zero-point offsets, θ ^ 20 and θ ^ 30 , are used to coarsely correct the orientation of the p-frame, and to make the directions of the middle gimbal axis and the inner gimbal axis approach the directions of axes of the p-frame. Concretely, the inner gimbal axis and the middle gimbal axis are inversely rotated θ ^ 20 and θ ^ 30 , respectively, and then coarse calibration is re-executed. This procedure will repeat until the re-estimated θ ^ 20 and θ ^ 30 decrease to negligibly small quantities.

4. Device-Level Fine Calibration

Fine calibration will be executed on the basis of coarse calibration. The orientation of the platform has been corrected and new data will be measured in more accurate rotation positions. In order to improve the data collection accuracy, the measurement time of each position is extended to 10 min. Moreover, to improve the data processing accuracy, the estimation error of coarse calibration is estimated instead of the full values of error parameters.
According to Equation (6), the ideal specific force in the p-frame satisfies:
f p = C a p S F ( f a δ b K n l ( f a δ b ) 2 ) .
If the result of coarse calibration and outputs of the tri-axis accelerometer during fine calibration ( f a ) have been obtained, the coarse estimation of f p can be calculated as:
f ^ p = C ^ a p S F ^ ( f a δ b ^ ) ,
where “hatted” symbols denote the estimated values.
In order to reduce the requirement for position control accuracy of the platform during fine calibration, the observed variable is not the direct difference between the coarsely estimated value and the ideal value of the specific force at one certain position, but the difference between the squared amplitudes of them. Subtracting the squared amplitude of Equation (9) from that of Equation (8), and then taking half of the result yields the observed variable, as:
1 2 ( ( f p ) T f p ( f ^ p ) T f ^ p ) = ( S F ^ ( f a δ b ) ) 2 S F ^ 1 Δ S F + 1 2 ( S F ^ ( f a δ b ) ) T ( ( Δ C p a ) T + Δ C p a ) ( S F ^ ( f a δ b ) ) ( S F ^ ( f a δ b ) ) T S F ^ δ b ˜ ( S F ^ ( f a δ b ) ) T S F ^ K nl ( f a δ b ) ( f a δ b ) ,
where:
1 2 ( ( f p ) T f p ( f ^ p ) T f ^ p ) = 1 2 ( ( f p ) 2 ( f ^ p ) 2 ) f p ( f p f ^ p ) ,
Δ S F = S F S F ^ = [ Δ S F x 0 0 0 Δ S F y 0 0 0 Δ S F z ] ,
δ b ˜ = δ b δ b ^ = [ δ b x ˜ 0 0 0 δ b y ˜ 0 0 0 δ b z ˜ ] ,
Δ C p a = [ 0 Δ β x z Δ β x y Δ β y z 0 Δ β y x Δ β z y Δ β z x 0 ] ,   and
f ^ a = S F ^ ( f a δ b ) = ( f ^ x a f ^ y a f ^ z a ) .
According to Equations (10)–(15), the observation equation at position j can be written as:
[ ( f ^ x j a ) 2 ( f ^ y j a ) 2 ( f ^ z j a ) 2 f ^ x j a f ^ y j a f ^ z j a ( f ^ x j a ) 3 ( f ^ y j a ) 3 ( f ^ z j a ) 3 f ^ x j a f ^ y j a f ^ x j a f ^ z j a f ^ z j a f ^ y j a ] d x = f p ( f p f ^ j p ) ,
where the unknown error vector is:
d x = [ Δ S F x ^ S F x ^ Δ S F y ^ S F y ^ Δ S F z ^ S F z ^ S F x ^ Δ b ˜ x S F y ^ Δ b ˜ y S F z ^ Δ b ˜ z K nlx S F x ^ K nly S F y ^ K nlz S F z ^ Δ β y z Δ β x z Δ β x y Δ β z y Δ β z x Δ β y x ] T .
Based on the data collected at the 18 positions, an 18 × 12 -dimension observation equation can be formed based on Equation (16), and the unknown variables shown in Equation (17) can be solved by the least squares method. Finally, using scale factors to convert the solved d x and adding the result to the coarse estimation will yield a full-value fine estimation of 12 error coefficients. It should be noted that β x z   and   β y z , β z y   and   β x y ,   and   β y x   and   β z x are linearly correlated in pairs and cannot be decomposed from each other. Therefore the fine calibration can only improve the accuracy of f p , but it cannot calibrate the rotation characteristics of the a-frame.

5. System-Level Calibration Based on Specific Force Error and Attitude Error

Errors of inertial instruments will induce the navigational errors of INSs, including the positional error, the velocity error and the attitude error. Inversely, the independently observed navigation errors such as the specific force error, the attitude error and the position error can be used to calibrate the main error parameters in the system. As the position error is affected by both the gyroscope error and accelerometer error, it is generally difficult to directly extract the accelerometer-induced term from the position error. On the other hand, the specific force error and the horizontal attitude error are mainly caused by the accelerometer error. Therefore this paper employs the specific force and horizontal attitude angles to correct part of the accelerometer’s error coefficients. The prerequisite for accurate observation in such a system-level calibration is that the system should be installed on a static and horizontal base.

5.1. Calibration Using Specific Force Error

Under the ideal condition, that there is no installation error between the base and the stabilized platform, and that the measurement of gimbals’ rotation angle is accurate, there is an approximate relationship:
C b p C n b [ cos S t sin L sin S t cos S t cos L sin S t sin L cos S t sin S t cos L cos L 0 sin L ] ,
where L denotes the latitude. On the static and horizontal base, the local scalar gravity g can be accurately calculated. Then, according to Equations (1) and (18), the ideal specific force vector in the p-frame can be written as:
f p g = ( f x P / g f y P / g f z P / g ) = C b p C n b ( 0 0 1 ) = ( cos S t cos L sin S t cos L sin L ) .
Similar to the device-level calibration method presented in the previous section, the difference of the squared amplitudes of the measured and the ideal specific force vectors is chosen as the observed variable, as:
z = 1 2 [ | f ^ p g | 2 | f p g | 2 ] ( f p g ) T Δ f p g .
A 5-dimensional state vector is constructed as x = [ x 1 x 2 x 3 x 4 x 5 ] T , where:
x 1 = ( Δ S F x 2 S F x + Δ S F y 2 S F y ) cos 2 L ( δ b ˜ z g Δ S F z S F z sin L ) sin L ,
x 2 = δ b ˜ x g Δ β x y sin L + Δ β z y sin L ,
x 3 = δ b ˜ y g + Δ β y x sin L Δ β z x sin L ,
x 4 = Δ S F x 2 S F x Δ S F y 2 S F y ,   and
x 5 = Δ β y z Δ β x z 2 .
Thus the observation equation is:
z = H x + v .
Considering Equation (19), the observation matrix is:
H = [ 1 f x p / g f y p / g ( ( f x p ) 2 ( f y p ) 2 ) / g 2 2 f x p f y p / g 2 ] .
The five components of x are actually the mean value, the sine and the cosine fundamental waves, and the sine and the cosine second harmonics of the Earth’s rotation rate in the specific force error. Assuming that the observation noise is a zero-mean Gaussian white noise, x can be estimated by a Kalman filter.

5.2. Calibration Using Attitude Error

On the static and horizontal base, the attitude error of the INS with both vertical damping and horizontal velocity damping mainly consists of a constant value and a 24 h long period component, which is induced by the gyroscope error, the accelerometer error, and the rotation angle errors of platform’s gimbals. Using the space-stable mechanization, the azimuth error will accumulate over time due to the gyroscope error, while the horizontal attitude errors are mainly caused by the accelerometer error and have no such accumulation. Therefore, the horizontal attitude errors are chosen as the observed quantities for accelerometer calibration.
Neglecting the short-period misalignment angle of gyro case rotation, the attitude error on the static and horizontal base has an expression as:
( δ ϕ δ θ δ ψ ) = ( Δ f y e g Δ f x e sin L Δ f z e cos L g Δ S 1 cos L Δ f y e g tan L ) ( δ S t cos L + δ κ x b cos ψ δ κ y b sin ψ δ h + δ κ x b sin ψ + δ κ y b cos ψ δ q δ S t sin L + δ κ z b ) ,
where δ κ x b , δ κ y b , and δ κ z b are the transverse tilt error, the longitudinal tilt error, and the azimuth error of the base, respectively, and the superscript e denotes the earth-fixed frame (e-frame).
Substituting the e-frame specific force error into Equation (28) yields the expressions of pitch error and roll error. Both of them consist of the mean value, the fundamental wave, and the second harmonic of the Earth’s rotation rate. The five Fourier coefficients of the pitch error are:
δ θ ¯ = ( δ h + δ κ x b sin ψ + δ κ y b cos ψ ) + [ z g ( Δ S F z S F z Δ S F x 2 S F x Δ S F y 2 S F y ) sin L ] cos L ,
δ θ 1 c ˜ = ( x g sin L Δ β x y sin 2 L Δ β z y cos 2 L ) ,
δ θ 1 s ˜ = ( y g sin L + Δ β y x sin 2 L + Δ β z x cos 2 L ) ,
δ θ 2 c ˜ = ( Δ S F x 2 S F x Δ S F y 2 S F y ) sin L cos L ,   and
δ θ 2 s ˜ = ( Δ β y z 2 Δ β x z 2 ) sin L cos L .
The other five Fourier coefficients of the roll error are:
δ ϕ ¯ = ( δ S t cos L + δ κ x b cos ψ δ κ y b sin ψ ) + ( Δ β y z 2 + Δ β x z 2 ) cos L ,
δ ϕ 1 s ˜ = x g Δ β x y sin L ,
δ ϕ 1 c ˜ = y g Δ β y x sin L ,
δ ϕ 2 s ˜ = ( Δ S F x 2 S F x Δ S F y 2 S F y ) cos L ,   and
δ ϕ 2 c ˜ = ( Δ β y z 2 Δ β x z 2 ) cos L .
The subscripts indicate which component each expression is (1 for the fundamental waves, 2 for the second harmonics, s for the sine functions, and c for the cosine functions). After the error curves of pitch and roll are obtained, these coefficients can be extracted by Fourier expansion.

5.3. Parameter Separation Algorithm for Combined Error Coefficients of Accerelometer

In Section 5.1 and Section 5.2, 15 combined coefficients (Equations (21)–(25), (29)–(33), and (34)–(38)) are estimated by static Kalman filter and Fourier expansion. Twelve of them are selected and divided into three groups to extract the residual error parameters of the tri-axis accelerometer. Since only the fundamental waves and second harmonics of pitch and roll errors are concerned, the requirement for the horizontality of the base need not be very strict.
The first group consists of three equations, which are the coefficients of the sine and cosine second harmonics of Earth’s rotation rate about Δ S F x 2 S F x Δ S F y 2 S F y . They are the linearly correlated Equations (24), (32), and (37). Thus Δ S F x 2 S F x Δ S F y 2 S F y can be solved using their equally weighted average, as:
Δ S F x 2 S F x ^ Δ S F y 2 S F y ^ = 1 3 ( x 4 ϕ N 2 s cos L + ϕ E 2 c cos L sin L ) .
Similarly, the second group consists of Equations (25), (33), and (38), and Δ β y z Δ β x z 2 can be solved as:
Δ β y z ^ Δ β x z ^ 2 = 1 3 ( x 5 + ϕ N 2 c cos L + ϕ E 2 s cos L sin L ) .
Another six parameters ( 𝛻 x g , 𝛻 y g , Δ β y x , Δ β z x , Δ β x y , Δ β z y ) can be solved using the least square method based on the remaining six combined coefficients, according to:
[ 1 0 0 0 sin L 0 0 1 sin L 0 0 0 sin L 0 0 0 sin 2 L cos 2 L 0 sin L sin 2 L cos 2 L 0 0 1 0 0 0 0 0 0 1 0 0 0 0 ] [ 𝛻 x / g 𝛻 y / g Δ β y x Δ β z x Δ β x y Δ β z y ] = [ δ ϕ 1 s ˜ δ ϕ 1 c ˜ δ θ 1 c ˜ δ θ 1 s ˜ x 2 ^ x 3 ^ ] .
The six parameters in Equation (41) can be directly compensated by substituting them into the accelerometer’s error model. Also, Δ β y z Δ β x z 2 and Δ S F x 2 S F x Δ S F y 2 S F y will be indirectly compensated by deducting the error terms about them from the n-frame specific force expression.

6. Simulation and Experiment

6.1. Simulation Result

As the final accuracy of the three-stage calibration mainly depends on the performance of the last stage, the simulation of the system-level calibration is conducted first. In the simulation, the location of the static base is set at 40° N. The non-orthogonal installation error of the tri-axis accelerometer is quite a stable mechanical error, and after the 18-position two-stage device-level calibration, the residuals are generally less than 10″. Thus, the residuals of accelerometer’s error parameters are assigned as Table 2 and Table 3. In addition, a zero-mean random noise with an amplitude of 5 × 10 3   m / s 2 is added to each sensitive axis of the tri-axis accelerometer.
Truth values of the system-level combined coefficients are calculated according to the error parameters shown in Table 2 and Table 3, and are listed in Table 4 as reference values. The combined coefficients are estimated by system-level calibration based on specific force error and attitude error, and are also listed in Table 4. Comparison shows that the estimation accuracy of each combined coefficient is better than 10 6   rad , which is equivalent to an accelerometer calibration accuracy that is better than 10 6 g. It indicates that the method can be used for the accelerometer calibration of high-precision INSs.

6.2. Experiment Results

In order to validate the proposed three-stage accelerometer calibration method, a static-base navigation test has been conducted using a high-precision space-stable INS. The INS is in the navigation grade class and has been introduced in reference [36]. Two dual-axis free-rotor gyros and a tri-axis quartz accelerometer are mounted on a gimbaled platform. According to the outputs of the free-rotor gyros, the platform is servo-controlled to be stabilized in the inertial space. The gyros have an ultra-low drift of less than 0.001°/h. The measurement error of the accelerometer is of a 1 × 10 5 g order of magnitude, and its stability is better than 1 × 10 5 g per year. The static measurement accuracy of gimbals’ rotation angles can reach the level of 1″. The position error of this navigation system can reach the order of magnitude of 1 n mile per day. The data used in the experiment are collected when the system is installed on a static and horizontal base.
Navigation errors before calibration, after the original two-stage 18-position coarse and fine self-calibration, and after the entire three-stage calibration are compared in Figure 3, Figure 4 and Figure 5 and Table 5. Since the system employs vertical damping, height error and vertical velocity error can be neglected and are not presented. The output position of the system is compared with the reference position of the base to obtain the position error. The output velocity and horizontal attitude angles are actually the velocity error and horizontal attitude error, for the base is static and horizontal. All experiment results here have been normalized.
The system has employed gyro case rotation techniques to decrease the gyro drift. Although its influence on the platform’s motion has been deducted during navigation calculating, there are still 8-minute residuals in the velocity and attitude error curves. As the cycle of these residuals are much shorter than the test time, they are severely squeezed in the error curves shown in Figure 4 and Figure 5.
Accelerometer parameters will change after the high-precision INS works for a period of time, which will consequently lead to the increase of navigation errors. Therefore, on-site and online calibration is necessary to improve the navigation precision. Latitude error, longitude error, and attitude errors are reduced by over 30% after the two-stage calibration, and by over 45% after the three-stage calibration. Since the velocity error mainly consists of Schuler oscillation, and the error term is related to the gyro case rotation residual, the improvement of velocity accuracy is not conspicuous. The velocity error has decreased by over 10% after the two-stage calibration, and by over 22% after the three-stage calibration.

7. Conclusions

A three-stage tri-axis accelerometer self-calibration technique is proposed with a thorough theoretical and mathematical analysis. Compared with existing calibration methods, the proposed three-stage calibration method has the following features and advantages: (1) Taking full advantage of high-precision angulation of the gimbaled platform in the space-stable INS, the two-stage device-level calibration is implemented directly on the platform of the space-stable INS. Thus the entire three-stage self-calibration can be implemented in the INS after the tri-axis accelerometer has been mounted on the platform. Besides, during the device-level calibration, zero-point offsets of the gimbals’ angular sensors are simultaneously estimated and used to correct the platform’s orientation. This will help improve the system’s navigation performance. (2) Different from the existing calibration methods which usually estimate error parameters of both accelerometer and gyroscope simultaneously, the proposed system-level calibration is designed based on error propagation to choose observed quantities only resulting from accelerometer measurement error. This can get rid of the influence of gyro drifts. (3) Combining device-level calibration and system-level calibration, the proposed method can achieve both full-parameter estimation of the accelerometer measurement model and high-precision correction for part of the parameters, while existing calibration methods normally concentrate on one of the two aspects. Both simulation and experiment results validate the proposed method. The simulation result shows that using the proposed three-stage calibration technique, the estimation accuracy of accelerometer error is better than 1 × 10 6 g. Experiment results show that after implementing the three-stage calibration, during navigation, the accuracy of latitude, longitude, and attitude angles has increased by over 45%, and the accuracy of velocity has increased by over 22%.

Author Contributions

Conceptualization, Q.W.; Methodology, Q.W., R.W., F.H. and R.Z.; Software, Q.W. and R.W.; Validation, Q.W. and R.W.; Formal Analysis, Q.W. and R.W.; Investigation, Q.W., R.W., F.H. and R.Z.; Resources, Q.W., F.H. and R.Z.; Data Curation, Q.W. and R.W.; Writing—Original Draft Preparation, Q.W., R.W. and F.H.; Writing—Review & Editing, Q.W., R.W. and F.H.; Visualization, Q.W. and R.W.; Supervision, Q.W. and R.Z.; Project Administration, Q.W.; Funding Acquisition, Q.W.

Funding

This research was funded by National Natural Science Foundation of China 61603208.

Conflicts of Interest

The authors declare no conflict of interest. The founding sponsors had no role in the design of the study; in the collection, analyses, or interpretation of data; in the writing of the manuscript, and in the decision to publish the results.

References

  1. Britting, K.R. Inertial Vavigation Systems Analysis; John Wiley & Sons, Inc.: New York, NY, USA, 1971. [Google Scholar]
  2. Nash, R.A.; Levine, S.A.; Roy, K.J. Error analysis of space-stable inertial navigation systems. IEEE Trans. Aerosp. Electron. Syst. 1971, 4, 617–629. [Google Scholar] [CrossRef]
  3. Gao, Z.Y. Inertial Navigation System Technology; Tsinghua University Press: Beijing, China, 2012. (In Chinese) [Google Scholar]
  4. Wang, H.G.; Williams, T.C. Strategic Inertial Navigation Systems High-Accuracy Inertially Stabilized Platforms for Hostile Environments. IEEE Control Syst. 2008, 28, 65–85. [Google Scholar]
  5. Chatfield, A.B. Fundamentals of High Accuracy Inertial Navigation; AIAA: Washington, DC, USA, 1997. [Google Scholar]
  6. Titterton, D.H.; Weston, J.L. Strapdown Inertial Navigation Technology, 2nd ed.; AIAA: Washington, DC, USA, 2004. [Google Scholar]
  7. Sun, F.; Cao, T. Ten-position calibration for accelerometer based on Kalman filter. Syst. Eng. Electron. 2011, 33, 2272–2276. (In Chinese) [Google Scholar]
  8. Ren, S.Q.; Feng, S.W.; Ma, X.B. All combination method for calibrating accelerometer. J. Chin. Inert. Technol. 2017, 15, 760–764. (In Chinese) [Google Scholar]
  9. Jiang, X.X.; Liu, Y.; Su, B.K. Calibration test method of high-precision accelerometer in gravitational field. J. Jilin Univ. Eng. Technol. Ed. 2010, 40, 287–292. (In Chinese) [Google Scholar]
  10. Won, S.P.; Golnaraghi, F. A triaxial accelerometer calibration method using a mathematical model. IEEE Trans. Instrum. Meas. 2010, 59, 2144–2153. [Google Scholar] [CrossRef]
  11. Ye, L.; Guo, Y.; Su, S.W. An efficient autocalibration method for triaxial accelerometer. IEEE Trans. Instrum. Meas. 2017, 66, 2380–2390. [Google Scholar] [CrossRef]
  12. Syed, Z.F.; Aggarwal, P.; Goodall, C.; Niu, X.; El-Sheimy, N. A new multi-position calibration method for MEMS inertial navigation systems. Meas. Sci. Technol. 2007, 18, 1897–1907. [Google Scholar] [CrossRef]
  13. Zhang, X.; Li, J.; Qin, L.; Shen, C. Comprehensive calibration of strap-down tri-axis accelerometer unit. Micromachines 2017, 8, 68. [Google Scholar] [CrossRef]
  14. Fong, W.T.; Ong, S.K.; Nee, A.Y.C. Methods for in-field user calibration of an inertial measurement unit without external equipment. Meas. Sci. Technol. 2008, 19, 085202. [Google Scholar] [CrossRef]
  15. Nieminen, T.; Kangas, J.; Suuriniemi, S.; Kettunen, L. An enhanced multi-position calibration method for consumer-grade inertial measurement units applied and tested. Meas. Sci. Technol. 2010, 21, 105204. [Google Scholar] [CrossRef]
  16. Li, Y.; Niu, X.; Zhang, Q.; Zhang, H.; Shi, C. An in situ hand calibration method using a pseudo-observation scheme for low-end inertial measurement units. Meas. Sci. Technol. 2012, 23, 105104. [Google Scholar] [CrossRef]
  17. Niu, X.; Li, Y.; Zhang, H.; Wang, Q.; Ban, Y. Fast thermal calibration of low-grade inertial sensors and inertial measurement units. Sensors 2013, 13, 12192–12217. [Google Scholar] [CrossRef] [PubMed]
  18. Ma, L.; Chen, W.; Li, B.; You, Z.; Chen, Z. Fast field calibration of MIMU based on the powell algorithm. Sensors 2014, 14, 16062–16081. [Google Scholar] [CrossRef] [PubMed]
  19. Qureshi, U.; Golnaraghi, F. An Algorithm for the In-Field Calibration of a MEMS IMU. IEEE Sens. J. 2017, 17, 7479–7486. [Google Scholar] [CrossRef]
  20. Sarkka, O.; Nieminen, T.; Suuriniemi, S.; Kettunen, L. A Multi-Position Calibration Method for Consumer-Grade Accelerometers, Gyroscopes, and Magnetometers to Field Conditions. IEEE Sens. J. 2017, 17, 3470–3481. [Google Scholar] [CrossRef] [Green Version]
  21. Lu, J.Z.; Lei, C. Applied system-level method in calibration validation for personal navigation system in field. IET Sci. Meas. Technol. 2017, 11, 103–110. [Google Scholar] [CrossRef]
  22. Gao, P.U.; Li, K.; Wang, L.; Liu, Z.J. A Self-Calibration Method for Accelerometer Nonlinearity Errors in Triaxis Rotational Inertial Navigation System. IEEE Trans. Instrum. Meas. 2017, 66, 243–253. [Google Scholar] [CrossRef]
  23. Gao, P.Y.; Li, K.; Wang, L.; Liu, Z.J. A self-calibration method for tri-axis rotational inertial navigation system. Meas. Sci. Technol. 2016, 27, 115009. [Google Scholar] [CrossRef]
  24. Zhang, H.L.; Wu, Y.X.; Wu, W.Q.; Wu, M.P.; Hu, X.P. Improved multi-position calibration for inertial measurement units. Meas. Sci. Technol. 2010, 21, 015107. [Google Scholar] [CrossRef]
  25. Song, T.X.; Li, K.; Sui, J.; Liu, Z.J.; Liu, J.C. Self-calibration method of the inner lever-arm parameters for a tri-axis RINS. Meas. Sci. Technol. 2017, 28, 115105. [Google Scholar] [CrossRef] [Green Version]
  26. Zhang, Q.; Wang, L.; Liu, Z.; Zhang, Y. Innovative self-calibration method for accelerometer scale factor of the missile-borne RINS with fiber optic gyro. Opt. Express 2016, 24, 21228. [Google Scholar] [CrossRef] [PubMed]
  27. Gao, P.Y.; Li, K.; Song, T.X.; Liu, Z.J. An Accelerometers Size Effect Self-calibration Method for Tri-axis Rotational Inertial Navigation System. IEEE Trans. Ind. Electron. 2017, 65, 1655–1664. [Google Scholar] [CrossRef]
  28. 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]
  29. 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]
  30. Wang, B.; Ren, Q.; Deng, Z.H.; Fu, M.Y. A self-calibration method for nonorthogonal angles between gimbals of rotational inertial navigation system. IEEE Trans. Ind. Electron. 2015, 62, 2353–2362. [Google Scholar] [CrossRef]
  31. Liu, Z.J.; Wang, L.; Li, K.; Gao, J.X. A compensation method of lever arm effect for tri-axis hybrid inertial navigation system based on fiber optic gyro. Meas. Sci. Technol. 2017, 28, 055103. [Google Scholar] [CrossRef]
  32. Liu, B.Q.; Wei, S.H.; Su, G.H.; Wang, J.P.; Lu, J.Z. An Improved Fast Self-Calibration Method for Stationary Condition. Sensors 2018, 18, 1303. [Google Scholar] [CrossRef] [PubMed]
  33. Pan, J.Y.; Zhang, C.X.; Cai, Q.Z. An accurate calibration method for accelerometer nonlinear scale factor on a low-cost three-axis turntable. Meas. Sci. Technol. 2014, 25, 025102. [Google Scholar] [CrossRef]
  34. Cai, Q.Z.; Yang, G.L.; Song, N.F.; Liu, Y.L. Systematic calibration for ultra-high accuracy inertial measurement units. Sensors 2016, 16, 940. [Google Scholar] [CrossRef] [PubMed]
  35. Cai, Q.Z.; Song, N.F.; Yang, G.L.; Liu, Y.L. Accelerometer calibration with nonlinear scale factor based on multi-position observation. Meas. Sci. Technol. 2013, 24, 105002. [Google Scholar] [CrossRef]
  36. Hu, P.D.; Gao, Z.Y.; She, Y.J.; Cai, L.; Han, F.T. Shipborne heading determination and error compensation based on a dynamic baseline. GPS Solut. 2015, 19, 403–410. [Google Scholar] [CrossRef]
Figure 1. The geometric relationship between the p-frame and the a-frame.
Figure 1. The geometric relationship between the p-frame and the a-frame.
Sensors 18 02888 g001
Figure 2. The 18 positions chosen for accelerometer calibration.
Figure 2. The 18 positions chosen for accelerometer calibration.
Sensors 18 02888 g002
Figure 3. Horizontal position errors. (a) Longitude errors; (b) latitude errors.
Figure 3. Horizontal position errors. (a) Longitude errors; (b) latitude errors.
Sensors 18 02888 g003
Figure 4. Horizontal velocity errors. (a) Northern velocity errors; (b) eastern velocity errors.
Figure 4. Horizontal velocity errors. (a) Northern velocity errors; (b) eastern velocity errors.
Sensors 18 02888 g004aSensors 18 02888 g004b
Figure 5. Attitude errors. (a) Roll errors; (b) pitch errors; (c) yaw errors.
Figure 5. Attitude errors. (a) Roll errors; (b) pitch errors; (c) yaw errors.
Sensors 18 02888 g005
Table 1. The order of rotation for the 18-position calibration, and the corresponding rotation angles of the gimbals and components of the p-frame gravity vector.
Table 1. The order of rotation for the 18-position calibration, and the corresponding rotation angles of the gimbals and components of the p-frame gravity vector.
The Order of RotationRotation Angles of GimbalsComponents of the p-Frame Gravity Vector
θ 1 θ 2 θ 3 g x p g y p g z p
1 θ 10 θ 20 θ 30 g θ 30 g θ 20 g
2 θ 20 + π 4 ( 2 2 θ 10 θ 30 ) g 2 2 g 2 2 g
3 θ 20 + π 2 g ( θ 10 θ 30 ) g g θ 20
4 θ 10 + π 4 2 2 g 2 2 g g θ 20
5 θ 10 + π 2 g g ( θ 30 θ 10 ) g θ 20
6 θ 20 + π 4 2 2 g ( θ 30 2 2 θ 10 ) g 2 2 g
7 θ 20 + π g θ 20 g θ 30 g
8 θ 30 π 4 2 2 g ( θ 10 + θ 20 ) 2 2 g 2 2 g
9 θ 30 π 2 g θ 10 g g θ 30
10 θ 10 + 3 π 4 2 2 g 2 2 g g θ 30
11 θ 10 + π g g θ 10 g θ 30
12 θ 30 π 4 2 2 g 2 2 g ( θ 10 + θ 20 ) 2 2 g
13 θ 20 + 5 π 4 θ 30 ( 2 2 θ 10 + θ 30 ) g 2 2 g 2 2 g
14 θ 10 + 3 π 4 θ 20 + 3 π 2 2 2 g 2 2 g 2 2 g θ 20
15 θ 10 + π 2 θ 20 + 7 π 4 2 2 g 2 2 g ( θ 30 + θ 20 ) 2 2 g
16 θ 20 θ 30 π 4 2 2 g ( θ 10 + θ 20 ) 2 2 g 2 2 g
17 θ 10 + π 4 θ 30 π 2 2 2 g 2 2 g g θ 30
18 θ 10 θ 30 3 π 4 2 2 g 2 2 g ( θ 10 + θ 20 ) 2 2 g
Table 2. Residuals of scale factor errors and biases.
Table 2. Residuals of scale factor errors and biases.
Δ SF x / SF x Δ SF y / SF y Δ SF z / SF z x y z
10 4 2 × 10 4 10 4 10 3   m / s 2 5 × 10 4   m / s 2 10 3   m / s 2
Table 3. Residuals of installation error angles.
Table 3. Residuals of installation error angles.
Δ β xz Δ β yz Δ β zy Δ β xy Δ β yx Δ β zx
5″10″−5″−10″5″−5″
Table 4. Simulation result of system-level calibration of the combined accelerometer error coefficients (unit: rad).
Table 4. Simulation result of system-level calibration of the combined accelerometer error coefficients (unit: rad).
Combined CoefficientsReference ValuesEstimated ValuesErrors
x 1 1.1228 × 10 4 1.1256 × 10 4 2.8 × 10 7
x 2 8.645 × 10 5 8.612 × 10 5 3.3 × 10 7
x 3 8.217 × 10 5 8.206 × 10 5 1.1 × 10 7
x 4 5.000 × 10 5 4.957 × 10 5 4.3 × 10 7
x 5 1.212 × 10 5 1.185 × 10 5 2.7 × 10 7
δ ϕ 1 s 1.3319 × 10 4 1.3343 × 10 4 2.4 × 10 7
δ ϕ 1 c 3.542 × 10 5 3.575 × 10 5 3.3 × 10 7
δ ϕ 2 s 3.830 × 10 5 3.848 × 10 5 1.8 × 10 7
δ ϕ 2 c 9.28 × 10 6 9.47 × 10 6 1.9 × 10 7
δ θ 1 s 5.521 × 10 5 5.536 × 10 5 1.5 × 10 7
δ θ 1 c 1.3629 × 10 4 1.3695 × 10 4 6.6 × 10 7
δ θ 2 s 5.97 × 10 6 5.76 × 10 6 2.1 × 10 7
δ θ 2 c 2.462 × 10 5 2.484 × 10 5 2.2 × 10 7
Table 5. Maximums of navigation errors.
Table 5. Maximums of navigation errors.
Navigation ErrorsBefore CalibrationTwo-Stage CalibrationImprovement after
Two-Stage Calibration
Three-Stage CalibrationImprovement after
Three-Stage Calibration
Longitude0.840.5830.95%0.3360.71%
Latitude0.860.6030.23%0.2669.77%
Northern Velocity0.850.7017.65%0.5634.12%
Eastern Velocity0.870.7810.34%0.6722.99%
Roll0.890.5043.82%0.3857.30%
Pitch0.950.5838.95%0.4354.74%
Yaw0.800.5432.50%0.4445.00%

Share and Cite

MDPI and ACS Style

Wu, Q.; Wu, R.; Han, F.; Zhang, R. A Three-Stage Accelerometer Self-Calibration Technique for Space-Stable Inertial Navigation Systems. Sensors 2018, 18, 2888. https://doi.org/10.3390/s18092888

AMA Style

Wu Q, Wu R, Han F, Zhang R. A Three-Stage Accelerometer Self-Calibration Technique for Space-Stable Inertial Navigation Systems. Sensors. 2018; 18(9):2888. https://doi.org/10.3390/s18092888

Chicago/Turabian Style

Wu, Qiuping, Ruonan Wu, Fengtian Han, and Rong Zhang. 2018. "A Three-Stage Accelerometer Self-Calibration Technique for Space-Stable Inertial Navigation Systems" Sensors 18, no. 9: 2888. https://doi.org/10.3390/s18092888

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