Next Article in Journal
Displacement and Strain Measurement up to 1000 °C Using a Hollow Coaxial Cable Fabry-Perot Resonator
Next Article in Special Issue
An Innovative Strategy for Accurate Thermal Compensation of Gyro Bias in Inertial Units by Exploiting a Novel Augmented Kalman Filter
Previous Article in Journal
Development of PZT Actuated Valveless Micropump
Previous Article in Special Issue
Enhanced Pedestrian Navigation Based on Course Angle Error Estimation Using Cascaded Kalman Filters
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

An Improved Fast Self-Calibration Method for Hybrid Inertial Navigation System under Stationary Condition

1
High-Tech Institute of Xi’an, Xi’an 710025, China
2
The Science and Technology on Inertial Laboratory, School of Instrumentation Science and Opto-electronics Engineering, Beijing University of Aeronautics and Astronautics, Beijing 100191, China
*
Author to whom correspondence should be addressed.
Sensors 2018, 18(5), 1303; https://doi.org/10.3390/s18051303
Submission received: 9 March 2018 / Revised: 20 April 2018 / Accepted: 20 April 2018 / Published: 24 April 2018
(This article belongs to the Special Issue Inertial Sensors and Systems 2018)

Abstract

:
The navigation accuracy of the inertial navigation system (INS) can be greatly improved when the inertial measurement unit (IMU) is effectively calibrated and compensated, such as gyro drifts and accelerometer biases. To reduce the requirement for turntable precision in the classical calibration method, a continuous dynamic self-calibration method based on a three-axis rotating frame for the hybrid inertial navigation system is presented. First, by selecting a suitable IMU frame, the error models of accelerometers and gyros are established. Then, by taking the navigation errors during rolling as the observations, the overall twenty-one error parameters of hybrid inertial navigation system (HINS) are identified based on the calculation of the intermediate parameter. The actual experiment verifies that the method can identify all error parameters of HINS and this method has equivalent accuracy to the classical calibration on a high-precision turntable. In addition, this method is rapid, simple and feasible.

1. Introduction

The inertial navigation system is a high-precision, autonomous navigation system based on gyros and accelerometer measurement. It does not depend on any external system, for example, the platform, station, star, etc. and does not need to send electromagnetic radiation signals to the outside when it is working. It is an indispensable navigation equipment in aerospace, sea and environments with high electro-magnetic interference [1]. According to different construction methods, the INS systems can be divided into platform systems and strapdown systems. The platform-based inertial navigation system, whose inertial devices are installed in a multi-axis stable platform, can achieve high navigation accuracy [2]. However, there are some shortcomings such as complex structure, large volume and weight, poor reliability and high cost. In the strapdown inertial navigation system (SINS), the inertial device and vehicle are connected and there is no longer a physical stable platform. Thus, there are fewer inertial navigation system components and the structure is simpler. This system achieves better volume, weight, cost and reliability while maintaining the system navigation accuracy [3,4] and the preparation time is shortened; however, to further improve the navigation, accuracy is notably difficult [5,6]. In recent years, various research institutions have developed a unique single-axis and dual-axis rotation inertial system, whose accuracy can be improved by approximately one order of magnitude in comparison with the ordinary strapdown inertial navigation system, which indicates that the rotary inertial navigation system has great potential for improving the system accuracy [7,8]. At present, Academic Feng, of Beijing University of Aeronautics and Astronautics, presents a hybrid inertial navigation system (HINS), which combines the features of the existing platform, strapdown and rotary inertial navigation systems. Figure 1 shows the working principle of the hybrid inertial navigation system. In addition to the “self-testing, self-calibration and self-alignment” functions, the hybrid inertial navigation system integrates the physical platform that separates the angular movement of the vehicle, strapdown attitude algorithm and rotation modulation error suppression. In the process, the frame is used to separate the angular movement of the vehicle while performing the rotation modulation to effectively separate and compensate the accelerometer common drift and gyroscopic part error to improve the precision of inertial navigation. It is of great importance to examine a new type of hybrid inertial navigation application [9].
Precise calibration of error parameters such as the constant bias, scale factor and misalignment angle of the Fiber Optics Gyros (FOG) and accelerometer is the prerequisite for an inertial navigation system to obtain high-precision navigation performance. The conventional Strap-down Inertial Navigation System (SINS) parameter calibration method can be divided into instrument-level calibration and system-level calibration methods. The instrument-level calibration method includes position and rate calibration, which have the disadvantages of complicated operation, long preparation time and calibration accuracy constrained by turntable accuracy [10,11]. In the system-level calibration, each error term is transformed into a navigation result (position, speed, attitude, etc.) through the navigation solution after the navigation state, which shows the navigation error. The SINS parameters can be estimated if all or part of the navigation error information is obtained. According to different estimation methods, there are the fitting method and the filtering method. It is possible to reduce the dependence of the calibration process on the high-precision turntable [12,13,14,15,16,17,18]. Xiang Gang introduced a once-electrification calibration algorithm for part of the parameters, which can calibrate 18 parameters of the inertial navigation calibration [18]. For the rotary SINS, the system-level calibration method can self-calibrate the system using its own rotation mechanism with the characteristics of rotary inertial navigation. A fast filtering algorithm was proposed by Yuanpei Chen for single-axis rotary inertial navigation, which could calibrate five errors [17]. Zhichao Zheng proposed an eight-position system calibration method to calibrate part of the error of biaxial rotating inertial navigation [16]. Peida Hu proposed a new calibration method for the installation error of the biaxial rotation inertial navigation system, which is based on the attitude error model and attitude difference [19]. The calibration method generally has the problems of high precision for specific parameters, long calibration time for all parameters and relatively low accuracy. With the continuous development of rotating inertial navigation, new calibration methods are constantly introduced and improved. A method to realize the simple, fast and accurate calibration of all parameters of the rotating inertial navigation is the research direction.
The errors of the three-axis hybrid inertial navigation system can be better isolated through the rotation. The self-calibration of the inertial navigation system can be realized by setting a special rotation strategy and a system-level calibration algorithm [20]. To calibrate the three-axis rotary inertial navigation, many scholars introduced many targeted calibration methods for specific parameters such as the nonlinear error of accelerometer [21], size effect error [22], non-orthogonal angle error of rotating frame [23] and internal lever arm parameters [24]. In the field of full parameter calibration method, Pengyu Gao proposed a least-squares-fitting self-calibration method for three-axis rotary inertial navigation [25]. The calibration of 23 error parameters is completed in three steps, which avoids the cross-coupling effect among different parameters. However, the segmentation calibration results in long calibration time and increases the operation. The method of 19-position calibration proposed by Qingzhong Cai [26] is a more practical high-precision calibration method. The method can calibrate 24 error parameters but the calibration time is slightly long. Weng Hai-na proposed a type of “velocity + position” matching Kalman filtering method [27] based on the discrete calibration for hybrid inertial navigation systems. The method can realize the on-line calibration of inertial navigation system error parameters but the calibration must be based on discrete calibration. In general, there are many good calibration methods for specific parameters to obtain high-precision results. However, for all-parameter high-precision calibration, the long calibration time is a prevalent problem for almost all methods. In this paper, an improved fast-fitting self-calibration method is proposed for hybrid inertial navigation systems. By optimizing the position arrangement, we realize the high precision, quick excitation and identification of the error parameters of the inertial navigation system (INS). Compared with the traditional calibration methods such as the 19-position calibration method, the proposed method has three contributions. First, the calibration time is short: all parameters can be calibrated in 30 min. Second, the calibration process is simple. The high-precision calibration of the inertial navigation parameters can be realized only through the marble plate, which eliminates the dependence on the high-precision turntable. Third, the calibration process is completely automated. The parameter sensitivity of the filtering method is avoided and the self-calibration requirements of the inertial navigation system are satisfied.
This paper is divided into six sections to introduce the improved fast fitting calibration method. The Section 1 is the introduction. The Section 2 introduces the improved hybrid fast calibration fitting method of inertial navigation, calibration method flow, position arrangement, error model, etc. To prove the feasibility of the calibration method, the simulation is performed in the Section 3, which verifies the calibration method. The Section 4 further proves the rapidity and high accuracy of the method by a physical test compared with the traditional 19-position calibration method. The Section 5 summarizes the advantages and features of the improved fast fitting self-calibration method.

2. Improved Hybrid Inertial Self-Calibration Method

2.1. Calibration Methods and Processes

The calibration method can realize the continuous dynamic self-calibration of full parameters under stationary base conditions. In other words, the gyro and accelerometer data are continuously collected during the rotation of the hybrid inertial axes instead of collecting at only a few fixed positions. Through the system’s position arrangement and intermediate parameter calculation, the least-squares method is used to fit and estimate the error parameter and alignment error of the hybrid inertial navigation. Thus, the calibration of the hybrid inertial navigation can be completed in a single power-on situation. With this method, the hybrid inertial navigation parameters can be quickly self-calibrated with high accuracy and precision, the dependence on the high-precision turntable can be eliminated and the calibration process can be simplified.
For the convenience of narration, first, we introduce several coordinate system definitions:
The Inertial Coordinate Frame ( o x i y i z i ): Its origin is at the center of the earth with z-axis parallel to the earth’s rotation direction. The x, y-axes lie in the earth’s equatorial plane and the x-axis points to the First Point of Aries.
The Earth-fixed Coordinate Frame ( o x e y e z e ). Its origin and z-axis direction are the same as the inertial frame’s. The x, y-axes lie in the earth’s equatorial plane with the x-axis passing through the main meridian (i.e., longitude = 0).
The Local Geographical Coordinate Frame ( o x n y n z n ): The local level coordinate frame located at the rover is defined as the navigation frame. Its origin at the center of the hybrid inertial navigation system. The x-axis is along the local east, the y-axis is along local north and the z-axis is along the local vertical.
The IMU Body Coordinate Frame ( o x b y b z b ): Its origin at the center of the hybrid inertial navigation system. The x-axis is aligned with the input x-axis of the accelerometer. The y-axis lies in the plane defined by x and y accelerometer input axis and points to the y accelerometer side, the z-axis points upward.
θ x t θ y t θ z t are the rotation angles, L is the latitude and ω i e is the autobiographical angular velocity.
The calibration process is as follows:
First, the hybrid inertial navigation system is fixed to the immovable base, so that the outer frame axis Z is located on the horizontal plane (accuracy is +3°) and it points to the south. When the outer frame angle is 0, the middle frame axis is located on a horizontal plane (accuracy is +3°). In other words, in the initial position, the X and Z axes of the XYZ coordinate system are located on the horizontal plane with the precision of +30. At this time, the hybrid inertial rotation angle around the inner ring axis is zero.
Second, the hybrid inertial navigation system rotates into nine positions based on its own three-frame structure. The accuracy of each position relative to the local geo-referenced plane is approximately 3°. During the rotation and each position, the accelerometers and gyro data are continuously collected for approximately 3 min. The collected data include the output of the table and gyro.
Third, non-real-time calculations of hybrid inertial navigation system parameters are conducted by processing the collected data.
The specific implementation process is shown in Figure 2 and the parameter calibration accuracy can be further improved through a step-by-step iterative approach. The Self-calibration method process is shown in Figure 3.

2.2. The Calibration Rotation Sequence

The inertial analysis and alignment algorithm is used to obtain the initial position of the self-alignment. Then, according to the pre-designed multi-position flip order of rotation, the inertial instrumentation error parameters can be excited in the entire process of rotation and rest. The navigation output speed and course information are measured and stored as the navigation error observation. Finally, the least-squares method is used to separate the error parameters.
During calibration, the hybrid inertial navigation system rotates nine positions based on its own three-frame structure. The starting position X and Z axes are in the horizontal plane and the Y axis points upward. The principle and layout of the calibration are that each parameter can be fully excited and each error parameter can be separated while minimizing the cross-coupling effects among the error terms. The specific rotation order is shown in Figure 4 and Table 1.

2.3. Fitting Method Research

2.3.1. Inertial Navigation System Error Model

Using the propagation characteristics of the inertial navigation system’s error parameters during navigation, the inertial measurement unit (IMU) is flipped and stopped by rotating or stationary frames to excite different parameters. When the acquired data enable the parameters of interest to be observed, the parameter error of the inertial navigation system can be estimated. The high-precision inertial navigation system parameters can be obtained using iterative calculation to make the error of the inertial navigation system converge to nearly zero.
The error mathematical model of the acceleration measurement channel is:
δ f b = [ δ f x b δ f y b δ f z b ] = [ K a x x 0 0 K a y x K a y y 0 K a z x K a z y K a z z ] [ f x b f y b f z b ] + [ η 0 x η 0 y η 0 z ]
In the equation, f b is the ideal value, δ f b is the accelerometer measurement error, δ f I b ( I = x , y , z ) is the acceleration measurement channel error, K a I I ( I = x , y , z ) is the accelerometer scale factor error, η I ( I = x , y , z ) is the acceleration measurement channel bias and K a I J ( I = x , y , z ;   J = x , y , z ;   I J ) is the acceleration measurement channel installation error parameter.
The error mathematical model of the angular velocity measurement channel is:
δ ω i b b = [ δ ω i b x b δ ω i b y b δ ω i b z b ] = [ W g x x W g x y W g x z W g y x W g y y W g y z W g z x W g z y W g z z ] [ ω i b x b ω i b y b ω i b z b ] + [ ω 0 x ω 0 y ω 0 z ]
In the equation, ω i b b is the ideal value, δ ω I b is the angular velocity measurement channel error, W g I I ( I = x , y , z ) is the angular velocity measurement channel scaling factor, ω 0 I ( I = x , y , z ) is the angular velocity measurement channel constant drift and W g I J ( I = x , y , z ; J = x , y , z ; I J ) is the angular velocity measurement channel installation error parameter.

2.3.2. Systematic Error Model

First, the accelerometer and gyros data are used to align the inertial navigation system. After the alignment is completed, navigation begins from the first position; the navigation speed error δ v ˙ n and heading error φ ˙ are measured and recorded as the navigation error observation.
The speed error model is:
δ v ˙ n = f n × φ ˙ + C b n δ f b ( 2 ω i e n + ω e n n ) × δ v n ( 2 δ ω i e n + δ ω e n n ) × v n
The attitude error model is:
φ ˙ n = ω i n n × φ n + δ ω i n n C b n δ ω i b b
In the equation:
i is the inertial coordinate system; e is the earth coordinate system; n is the navigation coordinate system; b is the strapdown inertial combined coordinate system; and φ n is the misalignment angle between the calculated coordinate system and the ideal navigation coordinate system, that is, the inertial navigation attitude error angle. ω and δ ω are the angular velocity and angular velocity error; the superscript indicates the component values in the corresponding coordinate system and the subscripts represent the relative motion of the coordinate system. v and δ v are the speed and velocity error; f and δ f are the specific force and force error; and C b n is the attitude matrix.
According to the pre-arranged rotation sequence, each position of the stationary and dynamic flip data can be continuously sampled. The error parameters can be iteratively calculated using the local gravity and latitude information with the origin of navigation, speed error and attitude error formula.
In the calibration process, regardless of the random error of the inertial instrument, when the system is rotated from one position to another, that is, when the system is in the stationary-roll-stationary motion, the error of the stationary navigation speed δ v n in a short time after the turning position is mainly caused by the inertia instrument errors δ f b and δ ω i b b . Considering the error model of the acceleration measurement channel and angular velocity measurement channel, we can assume that the system stationary-roll-stationary motion excites part of the inertial instrument error parameters. If the direction and angle of rotation are different, the error parameters of the inertial meter are different. All error parameters of the inertial instrument can be redundantly excited by turning the position.
The velocity error formula in the navigation coordinate system ( n ) is shown in Equation (3); the analytical expressions of ω i e n and ω e n n are as follows:
{ ω i e n = [ 0 ω i e cos L ω i e sin L ] T ω e n n = [ V N R M + h V E R N + h V E tan L R N + h ] T
The calculation error of Equation (5) is as follows:
{ δ ω i e n = [ 0 δ L ω i e sin L δ L ω i e cos L ] T δ ω e n n = [ δ V N R M + h + δ h V N ( R M + h ) 2 δ V E R N + h δ h V E ( R N + h ) 2 tan L δ V E R N + h + δ L V E sec 2 L R N + h δ h V E sec L ( R N + h ) 2 ]
In the equation, R M and R N are the radius of curvature in meridian and radius of curvature in unitary, respectively; δ V N and δ V E are the navigation speed errors, L is the geodetic latitude, h is the altitude.
In each calibration position, the inertia navigation system is quasi-stationary; V N and V E do not change and can be approximated as 0. Simultaneously, δ v n , δ ω i e n and δ ω e n n are also 0.
We substitute Equations (5) and (6) into Equation (3) and rewrite (3) as:
δ v ˙ n = f n × φ n + C b n δ f b ( 2 ω i e n ) × δ v n + n
The speed increment V i g k ( j ) and rotation angle increment θ k ( j ) of each calibration position can be calculated according to the accelerometer and gyro output in the calibration process ( j is the calibration position and k is the sampling time). Based on the real-time update calculation of the attitude transition matrix, the speed error is calculated according to the output information of the calibration and Equation (7) is rewritten as:
V n k ( j ) = V n k 1 ( j ) + 1 2 ( C n b k + C n b k 1 ) f k ( 2 ω i e sin L V z n k 1 ( j ) g 2 ω i e cos L V z n k 1 ( j ) 2 ω i e cos L V y n k 1 ( j ) 2 ω i e sin L V x n k 1 ( j ) ) Δ t
Δ t is the time interval of the inertial navigation system, C n b k is attitude transformation matrix between coordinate frame n and another frame b. Among them:
f k = ( f x k f y k f z k ) = ( b x k K a x x η 0 x Δ t b y k K a y y b x k K a x x k a y x η 0 y Δ t b z k K a z z b x k K a x x K a z x b y k K a y y K a z y η 0 z Δ t )
b x k , b y k , b z k are the accelerometer read data of step k th .

2.3.3. Attitude Updated Equation

The attitude transformation matrix model is as follows:
C n b k = C n i C n b k 1 C i b ( k = 1 , , N ) ; C n b 0 = C n b ( 0 )
The initial position of the inertial transformation matrix is C n b 0 ( 0 ) :
C n i k = ( cos 2 L + sin 2 L cos ( ω i e Δ t k ) sin L cos L [ 1 cos ( ω i e Δ t k ) ] sin L sin ( ω i e Δ t k ) sin L cos L [ 1 cos ( ω i e Δ t k ) ] sin 2 L + cos 2 L cos ( ω i e Δ t k ) cos L sin ( ω i e Δ t k ) sin L sin ( ω i e Δ t k ) cos L sin ( ω i e Δ t k ) cos ( ω i e Δ t k ) )
{ C i b = ( 1 k 2 ( p y 2 + p z 2 ) k 1 p z + k 2 p x p y k 1 p y + k 2 p x p z k 1 p z + k 2 p x p y 1 k 2 ( p x 2 + p z 2 ) k 1 p x + k 2 p z p y k 1 p y + k 2 p x p z k 1 p x + k 2 p z p y 1 k 2 ( p y 2 + p x 2 ) ) k 1 = 1 ( p x 2 + p y 2 + p z 2 ) / 6 k 2 = 0.5 [ 1 + ( p x 2 + p y 2 + p z 2 ) / 12 ]
A single-sample iterative coning compensation algorithm is used to iteratively calculate the rotation vector as:
{ δ p i ( k ) = ( Δ θ i ( k 1 ) × Δ θ i ( k ) ) / 12 p i ( k ) = θ i k + δ p i ( k )
θ i k is the increment of the k step attitude angle of the gyro and can be calculated according to the gyro pulse output of step k . To improve the accuracy and convergence speed of the attitude transition matrix, the angular increment is calculated from the pulse output information in two steps. First, the effect of zero bias is deducted. Then, we compensate the installation error. The calculation formula is as follows:
{ o x d = o x k W g x x D 0 x Δ t o y d = o y k W g y y D 0 y Δ t o z d = o z k W g z z D 0 z Δ t
{ θ x k = o x d ( K g x y o y d + K g x z o z d ) θ y k = o y d ( K g y x o x d + K g y z o z d ) θ z k = o z d ( K g z x o x d + K g z y o y d )
o x k , o y k , o z k are the gyro collection data of step k .

2.3.4. Intermediate Parameter Identification

The uncompensated accelerometer error Δ x n ( j ) , Δ y n ( j ) , Δ z n ( j ) ( j = 1 , , 9 ) and gyro drift ω x n ( j ) , ω y n ( j ) , ω z n ( j ) of each calibration position in the local geographic coordinate system are calculated as follows:
{ Δ x n ( j ) = q 21 m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) + q 22 g Δ t m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) ( m m b ( j ) ) + q 23 g Δ t 2 2 m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) ( m m b ( j ) ) 2 Δ y n ( j ) = ( m = m b ( j ) + 1 m e ( j ) ( V n y m ( j ) V b y ( j ) ) + 2 m = m b ( j ) + 1 m e ( j ) ( V n y m ( j ) V b y ( j ) ) ( m m b ( j ) ) N ( j ) + 1 ) / ( N ( j ) ( N ( j ) 1 ) g Δ t ) Δ z n ( j ) = q 21 m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) + q 22 g Δ t m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) ( m m b ( j ) ) + q 23 g Δ t 2 2 m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) ( m m b ( j ) ) 2
{ ω x n ( j ) = q 31 m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) + q 32 g Δ t m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) ( m m b ( j ) ) + q 33 g Δ t 2 2 m = m b ( j ) + 1 m e ( j ) ( V n x m ( j ) V b x ( j ) ) ( m m b ( j ) ) 2 ω y n ( j ) = ( m = m b ( j ) + 1 m e ( j ) θ m ( j ) 2 m = m b ( j ) + 1 m e ( j ) ( m m b ( j ) ) θ m ( j ) N ( j ) + 1 ) / ( N ( j ) ( N ( j ) 1 ) Δ t ) ω z n ( j ) = q 31 m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) + q 32 g Δ t m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) ( m m b ( j ) ) + q 33 g Δ t 2 2 m = m b ( j ) + 1 m e ( j ) ( V n z m ( j ) V b z ( j ) ) ( m m b ( j ) ) 2
In the equation, when m = m b ( j ) and N ( j ) = m e ( j ) m b ( j ) , V b x ( j ) , V b y ( j ) , V b z ( j ) align with V g x m ( j ) , V g y m ( j ) , V g z m ( j ) . q 21 , q 22 , q 23 , q 31 , q 32 , q 33 are the elements of matrix Q = A 1 .
A = ( N ( j ) g Δ t S 1 g Δ t 2 2 S 2 g Δ t S 1 g 2 Δ t 2 S 2 g 2 Δ t 3 2 S 3 g Δ t 2 2 S 2 g 2 Δ t 3 2 S 3 g 2 Δ t 4 4 S 4 )
S 1 = N ( j ) ( N ( j ) + 1 ) / 2 S 2 = N ( j ) ( N ( j ) + 1 ) ( 2 N ( j ) + 1 ) / 6 S 3 = N ( j ) 2 ( N ( j ) + 1 ) 2 / 4 S 4 = N ( j ) ( N ( j ) + 1 ) ( 2 N ( j ) + 1 ) ( 3 N ( j ) 2 + 3 N ( j ) 1 ) / 30

2.3.5. Systematic Error Parameters Determination and Compensation

Based on the identification of the intermediate parameters, 21 systematic error parameters to be calibrated are identified through algebraic relationships with the systematic error parameters. The 21 systematic error parameters are scaled as follows:
Accelerometer bias:
η ^ 0 x = ( 8 Δ x n ( 1 ) + Δ x n ( 4 ) 4 Δ x n ( 5 ) + Δ x n ( 6 ) 6 Δ x n ( 9 ) 6 Δ z n ( 3 ) 5 Δ z n ( 4 ) + 5 Δ z n ( 6 ) + 6 Δ z n ( 7 ) ) g / 40 η ^ 0 y = ( 16 Δ x n ( 1 ) 20 Δ x n ( 2 ) 20 Δ x n ( 3 ) + 17 Δ x n ( 4 ) + 12 Δ x n ( 5 ) + 17 Δ x n ( 6 ) 20 Δ x n ( 7 ) 20 Δ x n ( 8 ) + 18 Δ x n ( 9 ) 2 Δ z n ( 3 ) 5 Δ z n ( 4 ) + 5 Δ z n ( 6 ) + 2 Δ z n ( 7 ) ) g / 80 η ^ 0 z = ( 6 Δ x n ( 4 ) + 6 Δ x n ( 6 ) + 8 Δ z n ( 1 ) + 7 Δ z n ( 2 ) 2 Δ z n ( 4 ) + 4 Δ z n ( 5 ) 2 Δ z n ( 6 ) 7 Δ z n ( 8 ) 8 Δ z n ( 9 ) ) g / 46
Accelerometer scale factor:
K ^ a x x = ( Δ y n ( 2 ) + Δ y n ( 8 ) ) / 2 K ^ a y y = ( 3 Δ y n ( 1 ) + 2 Δ y n ( 4 ) + 2 Δ y n ( 5 ) + 2 Δ y n ( 6 ) + 3 Δ y n ( 9 ) ) / 12 K ^ a z z = ( Δ y n ( 3 ) + Δ y n ( 7 ) ) / 2
Installation error of the accelerometer:
K ^ a y x = ( 16 Δ x n ( 1 ) 40 Δ x n ( 2 ) 3 Δ x n ( 4 ) + 12 Δ x n ( 5 ) 3 Δ x n ( 6 ) + 40 Δ x n ( 8 ) 22 Δ x n ( 9 ) 4 Δ z n ( 3 ) + 15 Δ z n ( 4 ) 15 Δ z n ( 6 ) + 4 Δ z n ( 7 ) ) / 80 K ^ a z x = ( Δ z n ( 2 ) Δ z n ( 3 ) Δ z n ( 7 ) + Δ z n ( 8 ) ) / 2 K ^ a z y = ( 23 Δ x n ( 3 ) + 9 Δ x n ( 4 ) 9 Δ x n ( 6 ) + 23 Δ x n ( 7 ) + 11 Δ z n ( 1 ) + Δ z n ( 2 ) + 3 Δ z n ( 4 ) 6 Δ z n ( 5 ) + 3 Δ z n ( 6 ) Δ z n ( 8 ) 11 Δ z n ( 9 ) ) / 46
Gyros zero-drift:
ω ^ 0 x = ( 62 ω x n ( 1 ) + 3 ω x n ( 2 ) + 3 ω x n ( 3 ) + 5.5 ω x n ( 4 ) 34 ω x n ( 5 ) + 5.5 ω x n ( 6 ) + 3 ω x n ( 7 ) + 3 ω x n ( 8 ) 51 ω x n ( 9 ) + 3 ω y n ( 1 ) + 48 ω y n ( 2 ) 2 ω y n ( 4 ) 2 ω y n ( 5 ) 2 ω y n ( 6 ) 48 ω y n ( 8 ) + 3 ω y n ( 9 ) 48 ω z n ( 3 ) 39.5 ω z n ( 4 ) + 39.5 ω z n ( 6 ) + 48 ω z n ( 7 ) ) / 418 ω ^ 0 y = ( 25 ω x n ( 1 ) 32.5 ω x n ( 2 ) 32.5 ω x n ( 3 ) + 27.5 ω x n ( 4 ) + 20 ω x n ( 5 ) + 27.5 ω x n ( 6 ) 32.5 ω x n ( 7 ) 32.5 ω x n ( 8 ) + 30 ω x n ( 9 ) + 72 ω y n ( 1 ) + 2.5 ω y n ( 2 ) 48 ω y n ( 4 ) 48 ω y n ( 5 ) 48 ω y n ( 6 ) 2.5 ω y n ( 8 ) + 72 ω y n ( 9 ) 2.5 ω z n ( 3 ) 7.5 ω z n ( 4 ) + 7.5 ω z n ( 6 ) + 2.5 ω z n ( 7 ) ) / 418 ω ^ 0 z = ( 4 ω x n ( 4 ) + 4 ω x n ( 6 ) + 5 ω y n ( 3 ) 5 ω y n ( 7 ) + 6 ω z n ( 1 ) + 5 ω z n ( 2 ) + 4 ω z n ( 5 ) 5 ω z n ( 8 ) 6 ω z n ( 9 ) ) / 44
Gyros scale factor:
W ^ g x x = ( Δ z n ( 4 ) Δ z n ( 7 ) ) / π W ^ g y y = ( Δ x n ( 8 ) Δ x n ( 3 ) ) / π W ^ g z z = ( Δ z n ( 2 ) Δ z n ( 9 ) ) / π
Installation error of the accelerometer:
W ^ g x z = ( Δ x n ( 2 ) Δ x n ( 9 ) ) / 2 ; W ^ g y z = ( Δ x n ( 2 ) + Δ x n ( 9 ) ) / 2 ; W ^ g z x = ( Δ x n ( 4 ) Δ x n ( 7 ) ) / 2 ; W ^ g y x = ( Δ x n ( 4 ) + Δ x n ( 7 ) ) / 2 ; W ^ g x y = ( s + d ) / 2 ; W ^ g z y = ( s d ) / 2 ; ( s = ( Δ x n ( 5 ) Δ z n ( 6 ) ) / 2 , d = ( Δ x n ( 6 ) Δ z n ( 3 ) + Δ z n ( 5 ) Δ z n ( 8 ) ) / 4
The original 21 parameters are compensated after calculating the uncompensated error parameters. This process is repeated until the desired precision is attained.

3. Mathematical Simulation

3.1. Simulation Method and Process

To verify the effectiveness of the proposed method, a simulation environment is built under all-digital conditions and the method is simulated. First, the simulation calculation software is input according to the proposed position arrangement scheme. The software simulates the state of inertial navigation system at each position. The accelerometer and gyros pulse data of the hybrid inertial navigation system in self-calibration are mathematically simulated. The fast-fitting calibration algorithm is used to process the data. Finally, various error parameters of each inertial device can be calibrated. The sketch map of mathematical simulation is shown in Figure 5.

3.2. Simulation Results and Conclusions

The hybrid inertial navigation system fast self-calibration method is used to comprehensively and accurately calibrate the systematic error parameters. The data results are shown in Table 2.
First, a standard value is provided to 21 error parameters such as the gyro zero drift, accelerometer zero bias, scale factor and installation error. Then, the outputs of the gyros and accelerometers are generated by mathematical simulation. The simulation is performed according to the position arrangement and random noise was added to the data results. The calibration algorithm was used to fit the data. Finally, the simulation results of 21 error parameters were obtained. The results of the simulation are compared with the given standard values to obtain the calibration accuracy. The accuracy requirements of three directions of the gyro zero-drift errors are less than 3.0 × 102, the scale factor error is less than 1 ppm and the installation error is ≤15 arcsec. The accelerometer zero-bias errors in three directions are less than 5.0 × 105. The error of the scale factor is less than 1 ppm and the installation error is less than 10″. The calibration accuracy obtained by the simulation is shown in Table 2. The maximum gyro zero drift error is 0.00406°/h, the maximum error of gyro scale factor is 0.93 ppm and the maximum error of gyro installation error is 7.3″. The maximum accelerometer zero-bias error is 7.03 × 10−6 g, the maximum error of the accelerometer scale factor is 0.75 ppm and the maximum error of accelerometer installation is 5.2″. The calibration precision of all parameters satisfies the accuracy requirements. In addition, the entire calibration process is completed within 30 min and the speed is fast. The simulation data show that the fast fitting calibration method can finish the calibration of all 21 error parameters with the error within the requirements and with high precision.

4. Experimental Verification

To verify the feasibility and accuracy of the hybrid inertial navigation system calibration method, the hybrid inertial navigation system was calibrated in a physical calibration experiment and compared with the 19-position calibration method on high precision turntable [26].

4.1. Experimental Scheme

First, the hybrid inertial navigation system is installed on a high-precision turntable (horizontal- and vertical-positioning accuracy of 2 arcsec. Then, the experiment is performed according to the positioning and calibration procedures of the 19-position calibration method. The hybrid inertial navigation system is in the turntable conditions after being heated. Second, we calibrate the hybrid inertial navigation system with the proposed method in this paper. We conduct a continuous dynamic self-calibration test according to the given experiment procedure. The hybrid inertial navigation system is placed on a plate on a stationary base and connected to an inertial navigation test equipment. We begin the calibration process according to the scheduled position and relying on the rotating frame structure of the hybrid inertial navigation system. The calibration parameters are calculated according to the output data. The experiment is continuously performed 3 times using the proposed method in this paper. The experiment system composition is shown in Figure 6. The results of the fast self-calibration of the three experiments and the calibration results of the 19-position method on a high-precision rotary turntable are compared to obtain a conclusion.

4.2. Experiment Data

The experiment data and calibration results are listed in Table 3.

4.3. Test Results Analysis

Under the condition that the hybrid three-axis rotating inertial navigation system is locked, the gyros and accelerometer parameters of the hybrid inertial navigation system are calibrated by 19-position calibration method based on the high-precision turntable. The calibration result is used as a standard value. Then, the continuous dynamic self-calibration of all parameters in the stationary base state is tested using the improved fast fitting calibration method in this paper and the calibration is performed three times. The results of the three groups are compared with the standard values and the maximum differences are calibrated as the accuracy to determine whether the precision requirements are met. The test results from the data are shown in Table 3: the gyro scale factor error is less than 1 ppm, the zero drift error does not exceed 0.00796°/h, the maximum gyroscopic installation error is less than 4.4″, the accelerometer scale factor error is less than 1 ppm, the accelerometer zero-bias error is less than 7.40 × 10−6 g and the accelerometer installation error does not exceed 3.2″. All parameters satisfy the requirements of calibration accuracy and the consistency of the calibration results of all calibration parameters is good. With the same precision, the calibration can be finished within 30 min using the fast fitting self-calibration method, whereas the 19-position calibration method with a high-precision rotary turntable requires almost 70 min. Thus, the proposed method in this paper can greatly reduce the calibration time and the calibration process is simple and easy to operate. The calibration equipment and processes are simplified by the method, which helps to eliminate the dependence on the high-precision turntable and improve the convenience of use.
Compared with the traditional 19-position calibration method and existing multi-position calibration method [26], the integration of the proposed fast fitting self-calibration method of the hybrid inertial navigation system in this paper has the following advantages:
(1)
The method does not rely on the turntable accuracy; the calibration process is simple and easy to operate. The traditional calibration method relies on the high-precision turntable, that is, the calibration accuracy is greatly affected by the turntable accuracy and the calibration process and operation are complex. The proposed calibration method can be used to calibrate the inertial navigation on a marble slab.
(2)
All parameters can be calibrated. Many calibration methods are only efficient for specific parameters but cannot achieve full parameter calibration, whereas the proposed method can be completed for all 21 error calibration parameters.
(3)
The calibration time is short. With the precision of the traditional 19-position calibration method, the proposed self-calibration method reduces the calibration time from 70 min to 30 min and the calibration speed is fast.

5. Conclusions and Outlook

In this paper, to solve the calibration problem of hybrid inertial navigation systems (Inertial Navigation System), a fast dynamic self-calibration method for continuous dynamic under stationary conditions is proposed to satisfy engineering demands. Through a reasonable position arrangement, the error excitation is achieved during the position change and continuous overturn. Using the navigation speed and attitude error as navigation error observables, 21 error parameters are fully identified through the intermediate parameters. The simulation experiments and physical comparison tests show that the calibration accuracy of the calibration method does not depend on the precision of the turntable and installation accuracy and can reduce the calibration cost. The calibration sequence time is short and the identification parameter has high accuracy. The proposed method in this paper has high engineering application value.

Author Contributions

Binqi Liu makes contribution to the research idea. He is responsible for the derivation of method models, data analysis and parts of the manuscript writing. Shihui Wei makes contribution to research idea, model validation, data analysis. Guohua Su makes contribution to implementation and data analysis of the semi-physical simulation test. Jiping Wang makes contribution to implementation and mathematical simulation experiments and data analysis. Jiazhen Lu makes contribution to proposing schemes and methods for mathematical simulations and semi-physical tests, submitting and modifying manuscripts.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. David, T.; John, W. Strapdown Inertial Navigation Technology. IEEE Aerosp. Electron. Syst. Mag. 2005, 20, 33–34. [Google Scholar]
  2. Xu, Y.F.; Zhang, S.F. Calibration for gimbaled platform inertial navigation system on centrifuge. Proc. Inst. Mech. Eng. Part G J. Aerosp. Eng. 2017. [Google Scholar] [CrossRef]
  3. Wang, X.-L.; Guo, L.-H. An intelligentized and fast cali-bration method of SINS on moving base for planed mis-siles. Aerosp. Sci. Technol. 2009, 13, 216–223. [Google Scholar] [CrossRef]
  4. Zhang, H.-L.; Wu, Y.-X.; Wu, W.-Q.; Wu, M.; Hu, X. Improved multi-position calibration for inertial measurement units. Meas. Sci. Technol. 2010, 21, 1–11. [Google Scholar] [CrossRef]
  5. Barbour, N.M.; Gibson, C. Demonstrating Practical Inertial Navigation: The Beginnings and Beyond. In Proceedings of the AIAA Guidance, Navigation, and Control, Boston, MA, USA, 19–22 August 2013; pp. 717–722. [Google Scholar]
  6. Jwo, D.J.; Shih, J.H.; Hsu, C.S.; Yu, K.-L. Development of a strapdown inertial navigation system simulation platform. J. Mar. Sci. Technol. 2014, 22, 381–391. [Google Scholar]
  7. Ji, Z.-N.; Liu, C.; Cai, S.-J.; Xu, H.G.; Zhou, Z.H. Improved sixteen-sequence rotation scheme for dual-axis SINS. J. Chin. Inert. Technol. 2013, 21, 46–50. [Google Scholar]
  8. Li, J.; Zhao, J.; Sha, X.; Li, F. The rotation modulation inertial navigation system for blackout area during hypersonic reentry. In Proceedings of the International Symposium on Optoelectronic Technology and Application, International Society for Optics and Photonics, Beijing, China, 25 October 2016; p. 1015813. [Google Scholar]
  9. Feng, P.-D. On hybrid inertial navigation systems. J. Chin. Inert. Technol. 2016, 24, 281–284. [Google Scholar]
  10. Cheng, J.-C.; Fang, J.-C.; Wu, W.-R.; Wang, W.-J. Integrated calibration method for RLG IMU. J. Chin. Inert. Technol. 2014, 22, 445–452. [Google Scholar]
  11. Li, J.; Fang, J.; Ge, S. Kinetics and design of a mechanically dithered ring laser gyroscope position and orientation sys-tem. IEEE Trans. Instrum. Meas. 2013, 62, 210–220. [Google Scholar] [CrossRef]
  12. Jorgensen, M.J.; Paccaagnan, D.; Poulsen, N.K.; Larsen, M.B. IMU Calibration and Validation in a Factory, Remote on land and at sea. In Proceedings of the 2014 IEEE/ION Position, Location and Navigation Symposium, Monterey, CA, USA, 5–8 May 2014; pp. 3117–3125. [Google Scholar]
  13. Wang, L.; Wang, W.; Zhang, Q.; Gao, P. Self-calibration method based on navigation in high-precision inertial navigation system with fiber optic gyro. Opt. Eng. 2014, 53, 064103. [Google Scholar] [CrossRef]
  14. Rogers, R.M. Applied Mathematics in Integrated Navigation Systems. In Applied Mathematics in Integrated Navigation Systems; Reston American Institute of Aeronautics & Astronautics Inc.: Reston, VA, USA, 2007; Volume 1, p. 78. [Google Scholar]
  15. Emel’yantsev, G.I.; Blazhnov, B.A.; Dranitsyna, E.V.; Stepanov, A.P. Calibration of a precision SINS IMU and construction of IMU-bound orthogonal frame. Gyroscopy Navig. 2016, 7, 205–213. [Google Scholar] [CrossRef]
  16. Zheng, Z.; Han, S.; Zheng, K. 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]
  17. Li, K.; Chen, Y.; Wang, L. A self-calibration method in single-axis rotational inertial navigation system with rotating mechanism. In Proceedings of the Space Optics and Earth Imaging and Space Navigation, Beijing, China, 24 October 2017; p. 12. [Google Scholar]
  18. Xiang, G.; Qiu, F.; Miao, J.; Duan, R. A self-calibration method based on one-time electrification before launching for Inertial Navigation System. In Proceedings of the IEEE Guidance, Navigation and Control Conference, Nanjing, China, 12–14 August 2017; pp. 1138–1143. [Google Scholar]
  19. Hu, P.; Xu, P.; Chen, B.; Wu, Q. A Self-Calibration Method for the Installation Errors of Rotation Axes based on the Asynchronous Rotation of Rotational Inertial Navigation Systems. IEEE Trans. Ind. Electron. 2017, PP, 1. [Google Scholar] [CrossRef]
  20. Liu, Z.; Wang, L.; Li, K.; Gao, J. 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]
  21. Gao, P.; Li, K.; Wang, L.; Liu, Z. A Self-Calibration Method for Accelerometer Nonlinearity Errors in Triaxis Rotational Inertial Navigation System. IEEE Trans. Instrum. Meas. 2017, PP, 1–11. [Google Scholar] [CrossRef]
  22. Gao, P.; Li, K.; Song, T.; Liu, Z. An Accelerometers Size Effect Self-calibration Method for Tri-axis Rotational Inertial Navigation System. IEEE Trans. Ind. Electron. 2017, PP, 1. [Google Scholar]
  23. Gao, P.; Li, K.; Wang, L.; Liu, Z. A Self-Calibration Method for Non-Orthogonal Angles of Gimbals in Tri-Axis Rotational Inertial Navigation System. IEEE Sens. J. 2016, 16, 8998–9005. [Google Scholar] [CrossRef]
  24. Song, T.; Li, K.; Sui, J.; Liu, Z.; Liu, J. Self-calibration method of inner lever-arm parameters for tri-axis RINS. Meas. Sci. Technol. 2017, 28, 115105. [Google Scholar] [CrossRef]
  25. Gao, P.; Li, K.; Wang, L.; Liu, Z. A self-calibration method for tri-axis rotational inertial navigation system. Meas. Sci. Technol. 2016, 27, 115009. [Google Scholar] [CrossRef]
  26. Cai, Q.; Yang, G.; Song, N.; Liu, Y. Systematic Calibration for Ultra-High Accuracy Inertial Measurement Units. Sensors 2016, 16, 940. [Google Scholar] [CrossRef] [PubMed]
  27. Weng, H.N.; Gong, J.; Hu, X.M.; Gao, F.; Zhang, Y.F.; Tianjin Navigation Instrument Research Institute. Online self-calibration of hybrid FOG inertial navigation system. J. Chin. Inert. Technol. 2017, 1, 1–5. [Google Scholar]
Figure 1. Working principle of the hybrid inertial navigation system.
Figure 1. Working principle of the hybrid inertial navigation system.
Sensors 18 01303 g001
Figure 2. The coordinate frames used in this paper.
Figure 2. The coordinate frames used in this paper.
Sensors 18 01303 g002
Figure 3. Self-calibration method process.
Figure 3. Self-calibration method process.
Sensors 18 01303 g003
Figure 4. Rotation sequence.
Figure 4. Rotation sequence.
Sensors 18 01303 g004
Figure 5. Mathematical simulation sketch map.
Figure 5. Mathematical simulation sketch map.
Sensors 18 01303 g005
Figure 6. Experiment system composition.
Figure 6. Experiment system composition.
Sensors 18 01303 g006
Table 1. Position arrangement.
Table 1. Position arrangement.
PositionPre-Rotation AttitudeRotation Angle
Rotation Axis
Post-Rotation Attitude
XYZXYZ
1eastupsouth+90° Zupwestsouth
2upwestsouth+90° Ynorthwestup
3northwestup−90° Xnorthdownwest
4northdownwest−90° Ywestdownsouth
5westdownsouth−90° Ysouthdowneast
6southdowneast−90° Xsouthwestdown
7southwestdown−90° Ydownwestnorth
8downwestnorth+90° Zwestupnorth
9westupnorth
Table 2. Simulation experimental data.
Table 2. Simulation experimental data.
ParameterUnitStandard ValuesSimulation ResultsPrecision
Gyros parameter repeatabilityScale factorWgxxppm5050.672120.67212
Wgyyppm5050.935230.93523
Wgzzppm5049.43174−0.56826
Zero-driftD0xdeg/h33.003390.00339
D0ydeg/h32.99594−0.00406
D0zdeg/h33.001770.00177
Installation errorWgyxarcsec100107.37.3
Wgzxarcsec100102.72.7
Wgxyarcsec10098.8−1.2
Wgzyarcsec100103.43.4
Wgxzarcsec100106.66.6
Wgyzarcsec10095.3−4.7
Accelerometer parameter repeatabilityScale factorKaxxppm3030.756250.75625
Kayyppm3029.53734−0.46266
Kazzppm3030.123280.12328
Zero biasE0xmg33.000006146.14 × 10−6
E0ymg32.99999663−3.37 × 10−6
E0zmg33.000007037.03 × 10−6
Installation errorKazyarcsec5053.63.6
Kaxzarcsec5055.25.2
Kayzarcsec5048.91.1
Table 3. Experiment data.
Table 3. Experiment data.
ParametersUnitGroup OneGroup TwoGroup Three19-Position Calibration MethodPrecision (Maximum Error)
Gyros parameter repeatabilityScale factorWgxxppm50.6040850.7692150.2551250.144450.62476
Wgyyppm50.5260750.4227550.3752550.386120.13995
Wgzzppm50.6536050.1986650.2693150.759710.56105
Zero-driftD0xdeg/h−0.02387−0.02651−0.02492−0.027770.0039
D0ydeg/h0.025570.018980.024220.02694−0.00796
D0zdeg/h−0.18155−0.17613−0.17447−0.181290.00682
Installation errorWgyxarcsec401.3396.3397.6398.72.6
Wgzxarcsec−112.3−113.8−115.1−112.0−3.1
Wgxyarcsec−80.6−78.8−78.3−80.42.1
Wgzyarcsec−85.5−89.7−90.0−85.7−4.3
Wgxzarcsec431.0427.5427.0431.4−4.4
Wgyzarcsec−299.8−297.1−296.7−300.63.9
Accelerometer parameter repeatabilityScale factorKaxxppm30.1484430.7463730.3942930.310550.43582
Kayyppm30.5045730.4752330.6814830.524410.15707
Kazzppm30.6540830.3022930.4245630.611690.3094
Zero biasE0xg−0.0006743−0.0006744−0.0006698−0.00067727.40 × 10−6
E0yg0.00054720.00054630.00054760.00054688.00 × 107
E0zg0.00072170.00072460.00072170.0007239−2.20 × 10−6
Installation errorKazyarcsec−7.5−9.6−9.0−7.12.5
Kaxzarcsec98.497.297.398.4−1.2
Kayzarcsec35.039.938.536.73.2

Share and Cite

MDPI and ACS Style

Liu, B.; Wei, S.; Su, G.; Wang, J.; Lu, J. An Improved Fast Self-Calibration Method for Hybrid Inertial Navigation System under Stationary Condition. Sensors 2018, 18, 1303. https://doi.org/10.3390/s18051303

AMA Style

Liu B, Wei S, Su G, Wang J, Lu J. An Improved Fast Self-Calibration Method for Hybrid Inertial Navigation System under Stationary Condition. Sensors. 2018; 18(5):1303. https://doi.org/10.3390/s18051303

Chicago/Turabian Style

Liu, Bingqi, Shihui Wei, Guohua Su, Jiping Wang, and Jiazhen Lu. 2018. "An Improved Fast Self-Calibration Method for Hybrid Inertial Navigation System under Stationary Condition" Sensors 18, no. 5: 1303. https://doi.org/10.3390/s18051303

APA Style

Liu, B., Wei, S., Su, G., Wang, J., & Lu, J. (2018). An Improved Fast Self-Calibration Method for Hybrid Inertial Navigation System under Stationary Condition. Sensors, 18(5), 1303. https://doi.org/10.3390/s18051303

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