Next Article in Journal
A Hybrid FPGA-Based System for EEG- and EMG-Based Online Movement Prediction
Next Article in Special Issue
Angular Rate Sensing with GyroWheel Using Genetic Algorithm Optimized Neural Networks
Previous Article in Journal
Motor Imagery EEG Classification for Patients with Amyotrophic Lateral Sclerosis Using Fractal Dimension and Fisher’s Criterion-Based Channel Selection
Previous Article in Special Issue
Static and Dynamic Accuracy of an Innovative Miniaturized Wearable Platform for Short Range Distance Measurements for Human Movement Applications
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Damping Grid Strapdown Inertial Navigation System Based on a Kalman Filter for Ships in Polar Regions

College of Automation, Harbin Engineering University, Harbin 150001, China
*
Author to whom correspondence should be addressed.
Sensors 2017, 17(7), 1551; https://doi.org/10.3390/s17071551
Submission received: 26 May 2017 / Revised: 27 June 2017 / Accepted: 29 June 2017 / Published: 3 July 2017
(This article belongs to the Special Issue Inertial Sensors for Positioning and Navigation)

Abstract

:
The grid strapdown inertial navigation system (SINS) used in polar navigation also includes three kinds of periodic oscillation errors as common SINS are based on a geographic coordinate system. Aiming ships which have the external information to conduct a system reset regularly, suppressing the Schuler periodic oscillation is an effective way to enhance navigation accuracy. The Kalman filter based on the grid SINS error model which applies to the ship is established in this paper. The errors of grid-level attitude angles can be accurately estimated when the external velocity contains constant error, and then correcting the errors of the grid-level attitude angles through feedback correction can effectively dampen the Schuler periodic oscillation. The simulation results show that with the aid of external reference velocity, the proposed external level damping algorithm based on the Kalman filter can suppress the Schuler periodic oscillation effectively. Compared with the traditional external level damping algorithm based on the damping network, the algorithm proposed in this paper can reduce the overshoot errors when the state of grid SINS is switched from the non-damping state to the damping state, and this effectively improves the navigation accuracy of the system.

1. Introduction

Polar navigation technology is the basic condition for ships sailing in polar region safely and reliably [1,2]. Inertial navigation system has been the first choice for ships sailing in polar regions as a result of being autonomous, continuous, and comprehensive [3,4,5,6,7]. The working principle of the SINS is that the gyroscopes and accelerometers are strapped on the carrier. The gyroscopes and accelerometers measure the angular motion and linear motion of the carrier, respectively, then the navigation computer calculates the position, velocity, and the attitude of the carrier through the outputs of the gyroscopes and accelerometers. The lines of longitude tend to converge to a point in high latitudes, and the fictitious graticules change from rectangular in low latitudes to triangular in high latitudes, and because of this, the common SINS based on the geographic coordinate system cannot work properly [8,9,10]. Although the wander azimuth inertial navigation system and the free azimuth inertial navigation system can finish the calculation of the attitude and position direction cosine matrix [11,12], there are singular values when extracting the wander azimuth angle and longitude from the position direction cosine matrix [13]. Aiming at the shortcomings of the three kinds of mechanizations mentioned above, transversal SINS based on a transversal coordinate system and grid SINS based on a grid coordinate system are two main research hotspots to solve the problems of ships sailing in polar regions. The transversal SINS mechanization is built with the hypothesis that the earth is a standard sphere, obviously, this assumption brings the principle error to the design of transversal SINS mechanization [14]. However, the principle error doesn’t exist in grid SINS mechanization, so the grid SINS mechanization can be the ideal mechanization for ships working in polar regions.
Due to the presence of measurement errors of the inertial measurement units (IMU) and other error sources, the grid SINS mechanization drifts with time and includes three kinds of periodic oscillation errors, the so-called 84.4 min Schuler, 24 h earth, and Foucault periodic oscillation [15,16,17,18,19]. These periodic oscillation errors are detrimental to the high-precision navigation system over a long time [20,21,22,23], so it is necessary to adopt some methods to suppress these kinds of errors, such as damping technology. Aiming ships which have the external reference information to conduct a system reset regularly in a certain period of time, suppressing the Schuler periodic oscillation is an effective way to enhance navigation accuracy, the so-called level damping technology. Traditional level damping technology includes internal level damping technology and external level damping technology. In the absence of external reference velocity, the internal level damping technology can suppress the Schuler oscillation errors, however, the internal level damping technology is sensitive to the maneuvering of the ships [24,25]. In order to overcome the shortcomings of the internal level damping technology, when the external device such as the Doppler Velocity Log (DVL) can provide an accurate reference velocity, the external level damping technology can suppress the Schuler oscillation errors with the aid of the reference velocity, and this method is not sensitive to the maneuvering of the ships [26]. Traditional external level damping technology suppresses the Schuler periodic oscillation by adding the network to the level circuit of the system. Like the common SINS, when the work state of the grid SINS is switched from the non-damping state to the damping state, big overshoot errors are introduced to the system [27]. The overshoot phenomenon is extremely unfavorable to the improvement of navigation accuracy, and some methods must be adopted to solve this problem.
Aiming at the shortcomings of the traditional external level damping algorithm, a new external level damping algorithm based on a Kalman filter is proposed in this paper. Connecting with the practical situation, first, the criterion to judge if the velocity measured by DVL is available is built, and when the external velocity is judged to be available, the error model of the external velocity can be simplified as a constant in a certain period of time; second, the Kalman filter, based on a grid SINS error model, is established. When the external velocity error contains constant error, only grid level attitude error angles can be accurately estimated, and then the estimated level attitude error angles are used to calibrate the system. Compared with the traditional external level damping algorithm, the proposed algorithm can not only suppress the Schuler periodic oscillation, but also restrain the overshoot errors when the work state of grid SINS is switched from the non-damping state to the damping state. In the following sections of the paper, the new algorithm proposed in this paper will be called KF-DGSINS, and the traditional external level damping algorithm will be called T-DGSINS. KF represents Kalman filter; T represents traditional; D represents damping; GSINS represents grid strapdown inertial navigation system.

2. Grid SINS Mechanization

This section first introduces some common coordinate systems and the transformation relationships between each two coordinate systems, and then the grid SINS mechanization is given.

2.1. The Definitions of Common Coordinate Systems

The frequently-used coordinated systems in this paper are the geocentric inertial coordinate system i , earth centered earth fixed (ECEF) coordinate system e , body coordinate system b , and geographic coordinate system T . The detailed definitions of these coordinate systems can be seen in reference [24].
The navigation coordinate system of the grid SINS is grid coordinate system G . As shown in Figure 1, when the ship moves to the point P, the grid coordinate system is defined as follows: Grid plane: the parallel plane of the Greenwich plane which passes through the point P; Meridian tangent plane: local horizontal plane which passes through the point P. The grid north axis G N is the intersecting line of the grid plane and meridian tangent plane. The grid up axis G U coincides with the up axis of the geographic coordinate system which passes through the point P. Grid east axis G E lies in the local horizontal plane and is perpendicular to the grid north axis. G E , G N , and G U constitute the right-handed coordinate system. Obviously, the grid coordinate system is a local horizontal coordinate system, and G N is used as the reference of the grid course angle.

2.2. The Transformation Relationships of Common Coordinate Systems

As shown in Figure 1, the angle between G N and the geographic north is called the grid azimuth angle σ . So, the transformation matrix from T frame to G frame is described as:
C T G = [ cos σ sin σ 0 sin σ cos σ 0 0 0 1 ]
φ and λ represent the latitude and longitude of the point P. The sine and cosine of the grid azimuth angle σ can be described as:
sin σ = sin φ sin λ 1 cos 2 φ sin 2 λ
cos σ = cos λ 1 cos 2 φ sin 2 λ
The transformation matrix from e frame to T frame is described as:
C e T = [ sin λ cos λ 0 sin φ cos λ sin φ sin λ cos φ cos φ cos λ cos φ sin λ sin φ ]
The transformation matrix from e frame to G frame is described as:
C e G = C T G C e T = [ cos σ sin σ 0 sin σ cos σ 0 0 0 1 ] [ sin λ cos λ 0 sin φ cos λ sin φ sin λ cos φ cos φ cos λ cos φ sin λ sin φ ] = [ cos σ sin λ + sin σ sin φ cos λ cos σ cos λ + sin σ sin φ sin λ sin σ cos φ sin σ sin λ cos σ sin φ cos λ sin σ cos λ cos σ sin φ sin λ cos σ cos φ cos φ cos λ cos φ sin λ sin φ ]

2.3. Grid SINS Mechanization

The navigation frame is the grid frame, and the differential equation of strapdown attitude matrix for grid SINS is:
C ˙ b G = C b G Ω G b b
where Ω G b b is a skew-symmetric matrix related to ω G b b , and ω G b b is obtained as below:
ω G b b = ω i b b ω i G b = ω i b b C G b ( ω i e G + ω e G G )
ω i e G is described as below:
ω i e G = C T G ω i e T = [ cos σ sin σ 0 sin σ cos σ 0 0 0 1 ] [ 0 ω i e cos φ ω i e sin φ ] = [ ω i e cos φ sin σ ω i e cos φ cos σ ω i e sin φ ]
where ω i e is the rotational angular velocity of the earth. ω e G G is described as ω e G G = P 3 × 2 [ V E G V N G ] T . V E G , V N G are east and north velocity in grid frame, and P 3 × 2 is obtained as:
P 3 × 2 = [ ( 1 R M h 1 R N h ) sin σ cos σ ( cos 2 σ R M h + sin 2 σ R N h ) sin 2 σ R M h + cos 2 σ R N h ( 1 R M h 1 R N h ) sin σ cos σ sin λ cos φ 1 cos 2 φ sin 2 λ ( 1 R M h 1 R N h ) sin σ cos σ sin λ cos φ 1 cos 2 φ sin 2 λ ( cos 2 σ R M h + sin 2 σ R N h ) ]
where R M h = R M + h and R N h = R N + h . R M and R N are radius of curvature in meridian and prime vertical, and h is the altitude of the ship. For ships, h is set as zero.
The differential equation of velocity for grid SINS is:
V ˙ G = C b G f b ( 2 ω i e G + ω e G G ) × V G + g G
where g G = [ 0 0 g ] T , g represents the constant of the gravitational acceleration. V G = [ V E G V N G 0 ] is the ship’s velocity within grid frame.
The position of the ship is described as the ( x y z ) T in e frame. R e = ( x y z ) T , and the differential equation of position for grid SINS is:
R ˙ e = C G e V G
where C G e is the transpose of C e G .

3. The KF-DGSINS Algorithm

Based on the optimal estimation theory and feedback correction technology, the schematic diagram of the KF-DGSINS is shown in Figure 2. As shown in Figure 2, gyroscopes and accelerometers measure the angular motion and linear motion of the ship, respectively, and the position, velocity, and the attitude of the ship are calculated through the grid SINS mechanization. The system error states are estimated by Kalman filter with the aid of a reference velocity measured by DVL, and then the Schuler oscillation errors can be effectively suppressed by correcting some error states of the Kalman filter. This section first introduces the error model of the marine grid SINS, then the Kalman filtering and feedback correction technology are described in detail.

3.1. The Error Model of the Marine Grid SINS

Establishing an accurate error model is the premise of Kalman filtering. Nonlinear filter algorithms such as EKF, PF, and UKF has been widely studied in the field of integrated navigation system [28], when the real-time requirement is satisfied, the accuracy of the system can be increased. In order to meet the needs of the engineering, the error model is established with the assumptions: the attitude error angle is extremely small; measurement errors of the IMU are simplified as the sum of the constant and the white noise. Based on these two assumptions, the nonlinear factor of the system can be ignored, and the linear error model can be established. Reference [16] has given the airborne polar grid SINS linear error equations. In order to establish the error model which adapts to the shipborne environment, the altitude channel needs to be ignored. The state and measurement equation can be established as follows:
{ X ˙ = A X + B W Z = H X + η
where X = [ ϕ E G ϕ N G ϕ U G δ V E G δ V N G δ x δ y δ z ε b x b ε b y b ε b z b b x b b y b b z b ] T , ϕ E G , ϕ N G and ϕ U G are the grid attitude error angles; δ V E G , δ V N G are the grid east and north velocity error; δ x , δ y , δ z are the position errors along the x , y , z axes in e frame; ε b x b , ε b y b , ε b z b are the gyro constant drifts along the x , y , z axes in b frame; b x b , b y b , b z b are the accelerometer constant biases along the x , y , z axes in b frame; W = [ ε w x b ε w y b ε w z b w x b w y b w z b ] T , ε w x b , ε w y b , ε w z b are the gyro random drifts along the x , y , z axes in b frame; w x b , w y b , w z b are the accelerometer random biases along the x , y , z axes in b frame.
The difference between the external reference velocity and velocity calculated by the system is taken as the observation. η is the measurement noise array. Coefficient matrix A , system noise driven matrix B , and measurement matrix H are described as follows:
A = [ ( ω i G G × ) ( C ω G v ) 3 , 2 C ω e R + C ω G R C b G 0 3 × 3 ( f G × ) 2 , 3 ( V G × C ω G v [ ( 2 ω i e G + ω e G G ) × ] ) 2 , 2 ( V G × ( C ω G R + 2 C ω e R ) ) 2 , 3 0 2 × 3 ( C b G ) 2 , 3 0 3 × 3 ( C G e ) 3 , 2 C G e ( V G × ) C R 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 2 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 2 0 3 × 3 0 3 × 3 0 3 × 3 ]
B = [ C b G 0 3 × 3 0 2 × 3 ( C b G ) 2 , 3 0 9 × 6 ]
H = [ 0 2 × 3 1 0 0 1 0 2 × 9 ]
where the V e c t o r × means the skew-symmetric matrix related to the V e c t o r , the ( m a t r i x ) m , n means the first m rows and first n columns of the m a t r i x . The detailed expressions of submatrices C ω G v , C ω e R , C ω G R and C R can refer to the reference [16].

3.2. Kalman Filtering and Feedback Correction

Kalman filtering is a technology based on the minimum variance criteria, and the states are estimated according to the state and measurement equation. The equations of the discrete Kalman filtering are described as follows, and the detailed definition of each symbol can be seen in reference [29].
X ^ k / k 1 = ϕ k , k 1 X ^ k 1 P k / k 1 = ϕ k , k 1 P k 1 ϕ k , k 1 T + Γ k 1 Q k 1 Γ k 1 T K k = P k / k 1 H k T ( H k P k / k 1 H k T + R k ) 1 X ^ k = X ^ k / k 1 + K k ( Z k H k X ^ k / k 1 ) P k = ( I K k H k ) P k / k 1
ϕ k , k 1 , Γ k 1 , H k , and Z k are determined after the discretizing the Equation (12), when the initializations of the state vector X and P matrix are finished, the Kalman filtering can be conducted. Section 3.1 has given the error model of the shipborne grid SINS, and the error model of the DVL should be considered as well. In practice, the velocity measured by DVL can easily be affected by the external environment. On one hand, the velocity measured by DVL is easily polluted by the ocean currents when the ship is maneuvering; on the other hand, in some sea areas, such as the gulfs and trenches, the DVL measurement error is sensitive to the changes of the ocean currents. For the reasons above, establishing a precise error model of the DVL becomes difficult. In order to solve this problem, when the external reference velocity is available, combining with the actual situation, the error model of the external velocity can be simplified as a constant in a certain period of time. In this way, when the external velocity is available, supposing that the external velocity error is a constant, the grid SINS works in an external level damping state; otherwise the grid SINS works in a non-damping state. Therefore, the key to the question is to find out an effective criterion to judge if the velocity measured by DVL is available.
The criterion can be established according to the changes of the observation. The observation can be described as: Z = V G S I N S V D V L , V G S I N S represents the velocity calculated by grid SINS, and V D V L represents the velocity measured by DVL. V G S I N S and V D V L can be described as follows: V G S I N S = V + δ V G S I N S and V D V L = V + δ V D V L , where V is the true velocity of the ship, δ V G S I N S represents the velocity error of the grid SINS, and δ V D V L represents the velocity measurement error of the DVL. The observation Z can be described as:
Z = V G S I N S V D V L = δ V G S I N S δ V D V L
Z 1 and Z 2 represent the observation at time t 1 and t 2 , respectively. The difference between Z 1 and Z 2 can be obtained as:
δ Z = Z 1 Z 2 = ( δ V G S I N S 1 δ V G S I N S 2 ) ( δ V D V L 1 δ V D V L 2 )
where δ V G S I N S 1 δ V G S I N S 2 is the difference between the velocity errors of grid SINS at time t 1 and t 2 ; δ V D V L 1 δ V D V L 2 is the difference between the velocity measurement errors of DVL at time t 1 and t 2 . Obviously, δ V G S I N S 1 δ V G S I N S 2 will not change dramatically in a short period of time, thus, as long as δ Z changes dramatically, which means the external velocity measurement error has greatly changed as a result of the ship’s maneuvering or changes of the sea conditions, in this case, the external velocity measured by DVL cannot be used. On the basis of above-mentioned analysis, when δ Z changes dramatically in a certain period of time, the grid SINS works in the non-damping state, otherwise the grid SINS works in the external level damping state.
When DVL can provide an accurate reference velocity, the grid level velocity errors, position errors and grid level attitude error angles can all be accurately estimated. The attitude, velocity, and position errors of grid SINS can be compensated by using these three kinds of estimates to calibrate the system. However, as a result of the measurement error of the DVL, the observability of the state variables changes. Practical tests show that grid level velocity errors and position errors cannot be estimated accurately when the reference velocity contains constant error, but the grid level attitude error angles can still be accurately estimated. In this way, only the estimated grid level attitude error angles can be used to calibrate the system.
Two correction methods are usually used to calibrate the system: one is feedback correction and the other is output correction. Obviously, if output correction is selected, only the oscillation errors of the grid level attitude angles can be suppressed, as a result of the system’s open-loop structure. Feedback correction is the suitable way to calibrate the system for this method, and can suppress not only the oscillation errors of the grid level attitude angles, but also the oscillation errors of the grid level velocity and position. In fact, the existence of the level attitude error angles is the essential reason for the Schuler periodic oscillation, so the Schuler oscillation errors can be suppressed effectively through the feedback correction. Here we take the grid north level circuit as an example and the block diagram of the KF-DGSINS algorithm is shown in Figure 3. In Figure 3, S represents the variable after the Laplace transformation, and 1 S means the integration process. R represents the radius of the earth. ϕ ^ E G represents the estimate of the grid east attitude error angle.

4. The T-DGSINS Algorithm

Referring to the traditional external level damping algorithm based on the damping network of common SINS, the T-DGSINS based on classical control theory can be designed. Taking the grid north level circuit as an example, the block diagram of the T-DGSINS is shown in Figure 4. The external reference velocity is introduced to the system through the damping network 1 H ( s ) , from the physical sense, the introduction of the external reference velocity just adds a compensation channel to the system, and the navigation accuracy of this method is sensitive to the error of the external reference velocity.
The T-DGSINS based on the damping network can effectively dampen the Schuler oscillation errors of the grid SINS, but several obvious disadvantages of this method are difficult to overcome:
  • The damping network added to the system breaks the applicability of the Schuler adjustment condition, and an equivalent step-function signal is introduced to the system when the state of the grid SINS is switched from the non-damping state to the external level damping state. Therefore, the error overshoot phenomenon exists in the state switching process, and the navigation results cannot be used for a certain period of time.
  • T-DGSINS is designed based on the conditions of a single-input-single-output system (SISO), so the coupling effects of each calculating circuit cannot be solved.

5. Simulation Results and Discussions

This section is divided into two parts: one is the simulation results’ analysis, the other is the semi-physical simulation results’ analysis. The simulation results demonstrated the theoretical feasibility of the KF-DGSINS, and the semi-physical simulation results confirmed the validity of the KF-DGSINS in practical application.

5.1. Simulation Results and Discussions

Aiming at the grid SINS, in order to test the damping performance of the KF-DGSINS, non-damping grid SINS and KF-DGSINS are simulated on a stationary base. Gyroscopic and accelerometer outputs are generated by the track generator. The general idea of the track generator is: according to the change rules of the carrier’s position, velocity, attitude, and the settings of the IMU error, the outputs of the gyroscope and accelerometer can be back-stepped through the SINS mechanization. The simulation conditions are set as follows: simulation lasts 30 h; the initial latitude and longitude are 85 ° N and 18 ° E ; the three-axis gyro constant drifts are set as 0.003 degree per hour and the three-axis accelerometer constant biases are set as 0.00005 g , and the random error of the gyro and accelerometer are set as white noise; the error of the external reference velocity is set as white noise. The simulation results are shown in Figure 5, Figure 6 and Figure 7.
The dotted green line is the error curve of the non-damping grid SINS; the solid red line is the error curve of the grid SINS, adopting the KF-DGSINS. The simulation results show that the Schuler periodic oscillation exists in the errors of grid level attitude, grid level velocity, and position. The proposed KF-DGSINS effectively suppressed the Schuler periodic oscillation, and at the same time the Foucault periodic oscillation, which modulates the Schuler periodic oscillation. For grid level attitude errors, only the constant errors caused by accelerometer biases remain; for grid level velocity errors and position errors, the 24 h earth periodic oscillation still exists in the system. The error of the grid course angle is mainly influenced by the earth periodic oscillation, therefore, non-damping grid SINS and KF-DGSINS achieved almost the same effect. In conclusion, aiming at ships which have the external reference information to conduct a system reset regularly, the KF-DGSINS can observably improve the navigation accuracy of the grid SINS.
When the state of grid SINS is switched from the non-damping state to the external level damping state, big overshoot errors are introduced to the system by using the T-DGSINS. The KF-DGSINS proposed in this paper can restrain the overshoot errors effectively. In order to verify the advantage of the KF-DGSINS, the T-DGSINS and the KF-DGSINS are simulated under the same conditions. The simulation conditions are set as follows: gyro and accelerometer outputs are generated by the track generator; simulation lasts 10 h; the initial latitude and longitude are 85 ° N and 18 ° E ; the ship sails eastward along the latitude circle and the velocity is 10 m/s; the swing of the ship is set as the sine function:
{ p i t c h = p i t c h m sin ( 2 π / T P + P h P ) r o l l = r o l l m sin ( 2 π / T R + P h R ) h e a d i n g = 90 ° + h e a d i n g m sin ( 2 π / T H + P h H )
where p i t c h m , r o l l m , h e a d i n g m are swing amplitudes, and p i t c h m = 3 ° , r o l l m = 5 ° , h e a d i n g m = 4 ° ; T P , T R , T H are swing periods, and T P = 7 s , T R = 9 s , T H = 12 s ; P h P , P h R , P h H are initial phases and they are random values in the range from 0 ° to 90 ° .
In practice, the velocity measured by DVL is unavailable when the ship maneuvers or sails in some special sea areas. When the ship sails in a steady state, according to the previous introduction, the error of the DVL can be simplified as a constant, and the velocity measured by DVL is available. Considering the practical situation, the errors of the grid east and north velocity can be set as follows: before t = 5 h , the velocity measured by DVL is set to be unavailable. In order to simulate the condition that the error of the external reference velocity changes dramatically, the errors are set as the zero mean white noise with large amplitudes; after t = 5 h , the velocity measured by DVL is set to be available, and the error model of the velocity measured by DVL is simplified as the constant. In this case, the errors are set as the sum of the white noise and the constant (1kn). Taking the error of the grid east reference velocity as an example, the error of the grid east reference velocity is shown in Figure 8. When the reference velocity error is set as zero, the results of the T-DGSINS represent the ideal damping results of the grid SINS. In this way, in order to better reflect the advantage of the proposed KF-DGSINS, the ideal damping results are given when the reference velocity error is set as zero from beginning to end. The simulation results are shown in Figure 9, Figure 10 and Figure 11.
The solid green line is the ideal damping error curve of the grid SINS; the solid black line is the error curve of the grid SINS, adopting the T-DGSINS; the dotted red line is the error curve of the grid SINS, adopting the KF-DGSINS. Before t = 5 h , the error of the reference velocity changes dramatically. According to the criterion which is introduced in Section 3.2, the external reference velocity cannot be used. Therefore, the grid SINS works in the non-damping state; after t = 5 h , the external reference velocity changes slightly. According to the criterion, the external reference velocity becomes available, therefore, the grid SINS works in an external level damping state. What needs to be stressed is that the feedback correction should start after the process of Kalman filtering becomes stable. Some conclusions can be made from the simulation results: (1) two kinds of algorithm can effectively suppress the Schuler oscillation errors, and in the state switching process, the overshoot errors of the KF-DGSINS are obviously smaller than the overshoot errors of the T-DGSINS. For T-DGSINS, when the state of system is switched from the non-damping state to the external level damping state, the damping network is added to the level circuit of the grid SINS, and an equivalent step-function signal is introduced to the system. In this case, the equilibrium state of the system is broken, and the overshoot phenomenon occurs. For KF-DGSINS, no damping network is added to the system. When the Kalman filter is stable, the feedback correction of the grid level attitude error angles can suppress the Schuler oscillation error without breaking the equilibrium state of the system, and this is the reason why KF-DGSINS has a better performance in restraining the overshoot phenomenon than T-DGSINS; (2) the grid course angle error is hardly influenced by the overshoot phenomenon, therefore, T-DGSINS and KF-DGSINS achieved almost the same effect; (3) when the damping state is stable, the damping results of the KF-DGSINS and T-DGSINS are almost the same as the ideal damping results, which means the constant error of the external reference velocity will not affect the damping results of the KF-DGSINS and T-DGSINS when the damping state is stable. In a word, compared with the T-DGSINS, the KF-DGSINS has a better performance in overcoming the overshoot errors and this algorithm effectively improves the navigation accuracy of the grid SINS in the state switching process.

5.2. Semi-Physical Simulation Results and Discussions

Due to the limit of the geographic restriction, the semi-physical simulation is conducted to verify the performance of the proposed algorithm in practice. The outputs of the gyroscopes and accelerometers can be described as follows:
{ ω i b _ r e a l b = ω i b _ i d e a l b + ω i b _ e r r o r b f _ r e a l b = f _ i d e a l b + f _ e r r o r b
where ω i b _ r e a l b and f _ r e a l b are the measurements of the gyroscopes and accelerometers, respectively; ω i b _ i d e a l b and f _ i d e a l b are the ideal measurements of the gyroscopes and accelerometers, respectively; ω i b _ e r r o r b are the measurement errors of the gyroscopes, and f _ e r r o r b are the measurement errors of the accelerometers.
In order to get more realistic simulation measurements of the gyroscopes and the accelerometers in polar regions, the key point is to get the measurement errors of the gyroscopes and the accelerometers. Once the initial position, velocity, attitude, and the form of motion are determined, ω i b _ i d e a l b and f _ i d e a l b can be generated by the track generator. With the aid of the high-precision three-axis turntable, ω i b _ e r r o r b and f _ e r r o r b can be obtained easily. Collecting the IMU data was done in static state, and the static IMU data collection system is shown in Figure 12.
The SINS is installed on the three-axis turntable, and the attitude and position of the turntable are precisely known. The experimental data is provided by the IMU. The high-precision three-axis turntable can provide the accurate attitude reference of the carrier. With the aid of the high-precision three-axis turntable, the carrier can move in preset attitude change rules. The main technical indexes of the SGT-8 three-axis turntable in this experiment are shown in Table 1.
In static state, the three-axis gyroscopes are only sensitive to the rotational angular velocity of the earth, and the three-axis accelerometers are only sensitive to the local acceleration of gravity. Therefore, ω i b _ e r r o r b and f _ e r r o r b can be calculated by using (21):
{ ω i b _ e r r o r b = ω i e _ r e a l b ω i e b f _ e r r o r b = f _ r e a l b f b
where ω i e _ r e a l b and f _ r e a l b are the measurements of the gyroscopes and accelerometers in static state; ω i e b and f b can be calculated by using the precise position and attitude of the turntable.
The related parameters of the gyroscopes and accelerometers can be roughly calculated from the static test, and they are shown as follows: the three-axis gyro constant drifts are 2.573 × 10 8 rad / s , 2.607 × 10 8 rad / s , 2.387 × 10 8 rad / s , respectively; the three-axis gyro random drift variances are ( 2.9938 × 10 6 rad / s ) 2 , ( 2.4866 × 10 6 rad / s ) 2 , ( 3.2143 × 10 6 rad / s ) 2 , respectively; the three-axis accelerometer constant biases are 3.214 × 10 4 m / s 2 , 2.847 × 10 4 m / s 2 , 3.072 × 10 4 m / s 2 , respectively; the three-axis accelerometer random biases variances are ( 0.001594 m / s 2 ) 2 , ( 0.001771 m / s 2 ) 2 , ( 0.001817 m / s 2 ) 2 , respectively.
The simulation conditions are set as follows: simulation lasts 10 h; the initial latitude and longitude are 85 ° N and 18 ° E ; the ship sails eastward along the latitude circle and the velocity is 10 m/s; the swing of the ship is set as (18), and each parameter is the same as before. Due to the changes of the external velocity errors, before t = 5 h , the external velocity is set to be unavailable, and the grid SINS works in the non-damping state; after t = 5 h , the external velocity is available with constant errors, and the system works in the external level damping state. The results of the semi-physical simulation are shown in Figure 13, Figure 14 and Figure 15.
The solid green line is the error curve of the non-damping grid SINS; the solid black line is the error curve of the grid SINS, adopting the T-DGSINS; the dotted red line is the error curve of the grid SINS, adopting the KF-DGSINS. As shown in Figure 13, Figure 14 and Figure 15, the semi-physical simulation results further verify that the proposed KF-DGSINS has a better performance than the T-DGSINS. The results of the semi-physical simulation coincide with the results of the simulation results: on one hand, the KF-DGSINS and the T-DGSINS can suppress the Schuler oscillation errors effectively, on the other hand, in the state switching process, for KF-DGSINS, as a result of no damping network being added to the circuit, the equilibrium state of the grid SINS maintains, so the overshoot errors of the KF-DGSINS are obviously smaller than the overshoot errors of the T-DGSINS, and this effectively improves the navigation accuracy of the grid SINS in the state switching process. Grid course angle error is hardly influenced by the overshoot phenomenon, therefore T-DGSINS and KF-DGSINS achieved almost the same effect. The KF-DGSINS has a better performance in overcoming the overshoot errors when the state of grid SINS is switched from the non-damping state to the external level damping state, therefore, the shipborne grid SINS based on the KF-DGSINS is feasible for ships working in polar regions.

6. Conclusions

Aiming at ships which have the external reference information to conduct a system reset regularly, non-damping and external level damping working states are two kinds of frequently-used working states for ships sailing in polar regions. Therefore, the working state of the ship is frequently switched between the two working states mentioned above. In order to overcome the overshoot phenomenon of the T-DGSINS in the state switching process, the KF-DGSINS is proposed in this paper. The simulation results show that the KF-DGSINS can achieve the effective suppression of the Schuler oscillation errors, and can also reduce the overshoot errors in the state switching process. In conclusion, in view of the advantages of the KF-DGSINS, the KF-DGSINS can satisfy the needs of ships sailing in polar regions.

Acknowledgments

This work is funded by the National Natural Science Foundation of China under grant No. 61633008.

Author Contributions

Weiquan Huang and Tao Fang conceived and designed the experiments; Tao Fang performed the experiments; Weiquan Huang contributed experiment tools and analyzed the data; Tao Fang, Li Luo, Lin Zhao and Fengzhu Che wrote the paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Cheng, J.H.; Wang, T.D.; Guan, D.X.; Li, M.L. Polar transfer alignment of shipborne SINS with a large misalignment angle. Meas. Sci. Technol. 2016, 27, 035101. [Google Scholar] [CrossRef]
  2. Li, Q.; Ben, Y.Y.; Sun, F.; Huo, L. Transversal strapdown INS and damping technology for marine in polar region. In Proceedings of the IEEE/ION Position, Location and Navigation Symposium, Location and Navigation Symposium, Monterey, CA, USA, 5–8 May 2014; pp. 1365–1370. [Google Scholar]
  3. Chang, L.B.; Li, Y.; Xue, B.Y. Initial Alignment for Doppler Velocity Log aided Strapdown Inertial Navigation System with Limited Information. IEEE ASME Trans. Mechatron. 2016, 22, 329–338. [Google Scholar] [CrossRef]
  4. Sun, W.; Gao, Y. Fiber-based rotary strapdown inertial navigation system. Opt. Eng. 2013, 52, 076106. [Google Scholar] [CrossRef]
  5. Silva, F.O.; Hemerly, E.M.; Leite Filho, W.C. On the Error State Selection for Stationary SINS Alignment and Calibration Kalman Filters-Part II: Observability/Estimability Analysis. Sensors 2017, 17, 439. [Google Scholar] [CrossRef] [PubMed]
  6. Lyon, W.K. The Navigation of Arctic Polar Submarines. J. Navig. 1984, 37, 155–179. [Google Scholar] [CrossRef]
  7. Tazartes, D.A. Inertial Navigation: From Gimbaled Platforms to Strapdown Sensors. IEEE Trans. Aerosp. Electron. Syst. 2011, 47, 2292–2299. [Google Scholar] [CrossRef]
  8. Ren, C.H.; Pan, Y.J.; He, T.; Xiong, N.X. Research and implementation of a new orientation & incline instrument used in oil and gas wells. In Proceedings of the International Conference on Electronic Measurement & Instruments, Beijing, China, 16–19 August 2009; pp. 1027–1030. [Google Scholar]
  9. Bekir, E. Introduction to Modern Navigation Systems; World Scientific: New Jersey, NJ, USA, 2007; pp. 1–6. [Google Scholar]
  10. Hedman, E.L. A high-accuracy relationship between geocentric Cartesian coordinates and geodetic latitude and altitude. J. Spacecr. Rocket. 1970, 7, 993–995. [Google Scholar] [CrossRef]
  11. Papazoglou, M.; Tsioras, C. Intergrated SAR/GPS/INS for target geolocation improvement. J. Comput. Model. 2014, 4, 267–298. [Google Scholar]
  12. Andreev, A.G.; Ermakov, V.C.; Mafter, M.B.; Kokorin, V.I.; Rumyantsev, C.V. High Latitude Trials of Modern Russian Marine Compasses. In Proceedings of the IEEE/ION Position, Location and Navigation Symposium, Coronado, CA, USA, 25–27 April 2006; pp. 636–644. [Google Scholar]
  13. Yao, Y.Q.; Xu, X.S.; Tong, J.W. Indirect transversal inertial navigation algorithm in polar region. J. Chin. Inert. Technol. 2015, 23, 29–34. [Google Scholar] [CrossRef]
  14. Li, Q.; Ben, Y.Y.; Yu, F.; Tan, J.B. Transversal Strapdown INS Based on Reference Ellipsoid for Vehicle in the Polar Region. IEEE Trans. Veh. Technol. 2016, 65, 7791–7795. [Google Scholar] [CrossRef]
  15. Tal, A.; Klein, I.; Katz, R. Inertial Navigation System/Doppler Velocity Log (INS/DVL) Fusion with Partial DVL Measurements. Sensors 2017, 17, 415. [Google Scholar] [CrossRef] [PubMed]
  16. Zhou, Q.; Qin, Y.Y.; Fu, Q.W.; Yue, Y.Z. Grid mechanization in inertial navigation systems for transpolar aircraft. J. Northwest. Polytech. Univ. 2013, 31, 210–217. [Google Scholar]
  17. Qin, Y.Y. Inertial Navigation; National Defence Industry Press: Beijing, China, 1986; pp. 213–217. [Google Scholar]
  18. Klein, I.; Diamant, R. Observability Analysis of DVL/PS Aided INS for a Maneuvering AUV. Sensors 2015, 15, 26818–26837. [Google Scholar] [CrossRef] [PubMed]
  19. Tang, K.H.; Wang, J.L.; Li, W.L.; Wu, W.Q. A Novel INS and Doppler Sensors Calibration Method for Long Range Underwater Vehicle Navigation. Sensors 2013, 13, 14583–14600. [Google Scholar] [CrossRef] [PubMed]
  20. Gao, W.; Zhang, Y.; Ben, Y.Y.; Sun, Q. An automatic compensation method for states switch of strapdown inertial navigation system. In Proceedings of the IEEE/ION Position, Location and Navigation Symposium, Myrtle Beach, SC, USA, 23–26 April 2012; pp. 814–817. [Google Scholar]
  21. Li, K.; Liu, F.; Xu, Y.F. Research on Internal Damping Algorithm of Marine Inertial Navigation System. Commun. Comput. Inf. Sci. 2011, 135, 256–261. [Google Scholar] [CrossRef]
  22. Huang, W.Q.; Hao, Y.L.; Cheng, J.H.; Li, G.; Fu, J.G.; Bu, X.B. Research of the inertial navigation system with variable damping coefficients horizontal damping networks. In Proceedings of the MTTS/IEEE Techno-Ocean ’04, Kobe, Japan, 9–12 November 2004; pp. 1272–1276. [Google Scholar]
  23. Zheng, Z.C.; Yue, J. A Novel GPS/INS Loose Integrated Navigation Algorithm. Adv. Mater. Res. 2013, 823, 479–484. [Google Scholar] [CrossRef]
  24. Huang, D.M.; Cheng, L. Inertial Navigation System; National Defense Industrial Press: Beijing, China, 1986; pp. 108–125. [Google Scholar]
  25. Grammatikos, A.; Schuler, A.R.; Fegley, K.A. Damping Gimballess Inertial Navigation Systems. IEEE Trans. Aerosp. Electron. Syst. 1967, 3, 481–493. [Google Scholar] [CrossRef]
  26. Zhao, L.; Li, J.S.; Cheng, J.H.; Hao, Y. Damping strapdown inertial navigation system based on a Kalman filter. Meas. Sci. Technol. 2016, 27, 115102. [Google Scholar] [CrossRef]
  27. Sun, J.; Xu, X.; Liu, Y.; Zhang, T.; Li, Y.; Tong, J. An Adaptive Damping Network Designed for Strapdown Fiber Optic Gyrocompass System for Ships. Sensors 2017, 17, 494. [Google Scholar] [CrossRef] [PubMed]
  28. Zhao, L.; Wang, X.X.; Ding, J.C.; Cao, W. Overview of nonlinear filter methods applied in integrated navigation system. J. Chin. Inertial Technol. 2009, 17, 46–52. [Google Scholar] [CrossRef]
  29. Simon, D. Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches; John Wiley & Sons: Hoboken, NJ, USA, 2006; pp. 123–145. [Google Scholar]
Figure 1. Grid coordinate system G .
Figure 1. Grid coordinate system G .
Sensors 17 01551 g001
Figure 2. Schematic diagram of the KF-DGSINS.
Figure 2. Schematic diagram of the KF-DGSINS.
Sensors 17 01551 g002
Figure 3. Block diagram of KF-DGSINS algorithm.
Figure 3. Block diagram of KF-DGSINS algorithm.
Sensors 17 01551 g003
Figure 4. Block diagram of T-DGSINS algorithm.
Figure 4. Block diagram of T-DGSINS algorithm.
Sensors 17 01551 g004
Figure 5. Grid attitude angle errors of the simulation results.
Figure 5. Grid attitude angle errors of the simulation results.
Sensors 17 01551 g005
Figure 6. Grid level velocity errors of the simulation results.
Figure 6. Grid level velocity errors of the simulation results.
Sensors 17 01551 g006
Figure 7. Position errors in e frame of the simulation results.
Figure 7. Position errors in e frame of the simulation results.
Sensors 17 01551 g007
Figure 8. The error of the grid east reference velocity.
Figure 8. The error of the grid east reference velocity.
Sensors 17 01551 g008
Figure 9. Grid attitude angle errors of the simulation results.
Figure 9. Grid attitude angle errors of the simulation results.
Sensors 17 01551 g009
Figure 10. Grid level velocity errors of the simulation results.
Figure 10. Grid level velocity errors of the simulation results.
Sensors 17 01551 g010
Figure 11. Position errors in e frame of the simulation results.
Figure 11. Position errors in e frame of the simulation results.
Sensors 17 01551 g011
Figure 12. Static IMU data collection system.
Figure 12. Static IMU data collection system.
Sensors 17 01551 g012
Figure 13. Grid attitude angle errors of the semi-physical simulation results.
Figure 13. Grid attitude angle errors of the semi-physical simulation results.
Sensors 17 01551 g013
Figure 14. Grid level velocity errors of the semi-physical simulation results.
Figure 14. Grid level velocity errors of the semi-physical simulation results.
Sensors 17 01551 g014
Figure 15. Position errors in e frame of the semi-physical simulation results.
Figure 15. Position errors in e frame of the semi-physical simulation results.
Sensors 17 01551 g015
Table 1. The technical indexes of the SGT-8 three-axis turntable.
Table 1. The technical indexes of the SGT-8 three-axis turntable.
Outer AxisMiddle AxisInner AxisUnit
Location accuracy of angular position ± 3 ± 2 ± 2 arc sec
Maximum angular rate ± 180 ± 250 ± 400 °/s
Rotation rate resolution 0.001 0.001 0.001 °/s

Share and Cite

MDPI and ACS Style

Huang, W.; Fang, T.; Luo, L.; Zhao, L.; Che, F. A Damping Grid Strapdown Inertial Navigation System Based on a Kalman Filter for Ships in Polar Regions. Sensors 2017, 17, 1551. https://doi.org/10.3390/s17071551

AMA Style

Huang W, Fang T, Luo L, Zhao L, Che F. A Damping Grid Strapdown Inertial Navigation System Based on a Kalman Filter for Ships in Polar Regions. Sensors. 2017; 17(7):1551. https://doi.org/10.3390/s17071551

Chicago/Turabian Style

Huang, Weiquan, Tao Fang, Li Luo, Lin Zhao, and Fengzhu Che. 2017. "A Damping Grid Strapdown Inertial Navigation System Based on a Kalman Filter for Ships in Polar Regions" Sensors 17, no. 7: 1551. https://doi.org/10.3390/s17071551

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