Nothing Special   »   [go: up one dir, main page]
Next Article in Journal
A Multispectral Image Creating Method for a New Airborne Four-Camera System with Different Bandpass Filters
Next Article in Special Issue
Three Three-Axis IEPE Accelerometers on the Inner Liner of a Tire for Finding the Tire-Road Friction Potential Indicators
Previous Article in Journal
A New Method to Evaluate Surface Defects with an Electromagnetic Acoustic Transducer
Previous Article in Special Issue
LiDAR Scan Matching Aided Inertial Navigation System in GNSS-Denied Environments
You seem to have javascript disabled. Please note that many of the page functionalities won't work as expected without javascript enabled.
 
 
Search for Articles:
Title / Keyword
Author / Affiliation / Email
Journal
Article Type
 
 
Advanced Search
 
Section
Special Issue
Volume
Issue
Number
Page
 
Journals
Sensors
Volume 15
Issue 7
10.3390/s150717433
sensors-logo
Submit to this Journal Review for this Journal Propose a Special Issue
► Article Menu

Article Menu

share Share announcement Help format_quote Cite question_answer Discuss in SciProfiles thumb_up
...
Endorse textsms
...
Comment
first_page
settings
Order Article Reprints
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

A Method for Oscillation Errors Restriction of SINS Based on Forecasted Time Series

by
Lin Zhao
1,*,
Jiushun Li
1,
Jianhua Cheng
1,
Chun Jia
1 and
Qiufan Wang
2
1
College of Automation, Harbin Engineering University, Harbin 150001, China
2
Beijing Institute of Automatic Control Equipment, Beijing 100074, China
*
Author to whom correspondence should be addressed.
Sensors 2015, 15(7), 17433-17452; https://doi.org/10.3390/s150717433
Submission received: 23 June 2015 / Revised: 13 July 2015 / Accepted: 15 July 2015 / Published: 17 July 2015
(This article belongs to the Special Issue Inertial Sensors and Systems)
Browse Figures
Figure 1
<p>Navy testing results of the iXBlue MARINS FOG INS: (<b>a</b>) Roll error; (<b>b</b>) East velocity error; (<b>c</b>) Heading error.</p> "> Figure 2
<p>Principle diagram of suppressing oscillation errors based on forecasted time series.</p> "> Figure 3
<p>Several forms of the interference of small angular motions in the output of gyro.</p> "> Figure 4
<p>The outputs of gyro and accelerometer with the interference of small angular motions.</p> "> Figure 5
<p>Variation of <math display="inline"> <semantics> <mrow> <mstyle displaystyle="true"> <mrow> <munderover> <mo>∫</mo> <mn>0</mn> <mi>t</mi> </munderover> <mrow> <msub> <mtext>ω</mtext> <mi>x</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow> </mrow> </mstyle> <mi>d</mi> <mi>t</mi> </mrow> </semantics> </math>.</p> "> Figure 6
<p>(<b>a</b>) The new time series and curve fitting of gyro; (<b>b</b>) The new time series and curve fitting of accelerometer.</p> "> Figure 7
<p>(<b>a</b>) The change rate of north velocity; (<b>b</b>) The change rate of east velocity.</p> "> Figure 8
<p>(<b>a</b>) Simulation results of attitude errors for maneuvering carrier with no inertia device errors; (<b>b</b>) Simulation results of velocity errors for maneuvering the carrier with no inertia device errors; (<b>c</b>) Simulation results of position errors for maneuvering the carrier with no inertia device errors.</p> "> Figure 9
<p>(<b>a</b>) Simulation results of attitude errors for maneuvering the carrier with inertia device errors; (<b>b</b>) Simulation results of velocity errors for maneuvering the carrier with inertia device errors; (<b>c</b>) Simulation results of position errors for maneuvering the carrier with inertia device errors.</p> "> Figure 10
<p>Fiber gyroscope inertial navigation system.</p> "> Figure 11
<p>High-precision, three-axis turntable and SINS.</p> "> Figure 12
<p>(<b>a</b>) Test results of attitude errors for actual system; (<b>b</b>) Test results of velocity errors for actual system; (<b>c</b>) Test results of position errors for actual system.</p> ">
Versions Notes

Abstract

:
Continuity, real-time, and accuracy are the key technical indexes of evaluating comprehensive performance of a strapdown inertial navigation system (SINS). However, Schuler, Foucault, and Earth periodic oscillation errors significantly cut down the real-time accuracy of SINS. A method for oscillation error restriction of SINS based on forecasted time series is proposed by analyzing the characteristics of periodic oscillation errors. The innovative method gains multiple sets of navigation solutions with different phase delays in virtue of the forecasted time series acquired through the measurement data of the inertial measurement unit (IMU). With the help of curve-fitting based on least square method, the forecasted time series is obtained while distinguishing and removing small angular motion interference in the process of initial alignment. Finally, the periodic oscillation errors are restricted on account of the principle of eliminating the periodic oscillation signal with a half-wave delay by mean value. Simulation and test results show that the method has good performance in restricting the Schuler, Foucault, and Earth oscillation errors of SINS.

1. Introduction

Owing to its autonomy, continuity, and comprehensiveness of navigation, strapdown inertial navigation system (SINS) plays an irreplaceable role in military and civil navigation fields and it is used as the core navigation system in navigation applications [1,2,3,4].
In addition to that errors of inertial navigation systems are accumulated over time, the error sources (such as the initial alignment errors, gyros and accelerometer measurement errors, etc.) cause inertial navigation system to have a variety of errors which contain Schuler, Foucault, and Earth periodic oscillation errors. These oscillation errors greatly reduce the precision of inertial navigation system [5,6]. For example, Schuler and Foucault periodic oscillation errors have a negative influence on the precision of horizontal velocity and attitude, while Earth periodic oscillation errors reduce the accuracy of azimuth and position, which is adverse to navigation systems required to provide the high-precision navigation and positioning information. iXBlue is a leading global provider of innovative solutions and services for navigation, positioning, and imaging. Civil and defense customers rely on their systems, operations, and services for the challenges faced at sea, on land, in the air or in space. iXBlue presented navy testing results of the iXBlue MARINS FOG INS in 2014 and parts of the results are shown as follow [7].
As shown in Figure 1, there are oscillation errors in the system errors, obviously, which reduces the accuracy of SINS. Therefore, damping technology and integrated navigation technology are often used to restrain the oscillation errors of inertial navigation system [8,9]. Although there are some defects in the application of damping technology and integrated navigation technology, these two technologies are still used as the main tools of restraining the oscillation errors [7].
Sensors 15 17433 g001 1024
Figure 1. Navy testing results of the iXBlue MARINS FOG INS: (a) Roll error; (b) East velocity error; (c) Heading error.
Figure 1. Navy testing results of the iXBlue MARINS FOG INS: (a) Roll error; (b) East velocity error; (c) Heading error.
Sensors 15 17433 g001
The inertial navigation system with a damping network is called damping inertial navigation system. Based on the classical control theory, the traditional damping method is to design the damping network that is in series with the system, which can suppress the oscillation errors of the inertial navigation system effectively. However, the added damping network destroys the free interference condition of the inertial navigation system and brings dynamic errors, caused by maneuvers, to the damping inertial navigation system, reducing the accuracy of the inertial navigation system [10,11]. The damping inertial navigation system is confined to the condition that the carrier is with no acceleration or small acceleration. Nevertheless, the carrier cannot always be in its state of rest or of uniform motion in a straight line, so the inertial navigation system needs to frequently switch between the damping and the free damping states [12,13,14,15,16]. To reduce the overshoot in states switch, instantaneous velocity of SINS at the switch moment is compensated to the damping network in paper [17], which can reduce the velocity error overshoot and its steady-state error at the same time. In order to weaken the negative effect of the damping network on the inertial navigation system, the damping coefficient of the damping network is, relatively, smaller [7]. The damping inertial navigation system can also be actualized by using Kalman filtering technology [18,19]. American mainstream marine inertial navigation systems, such as AN/WSN-7B and MK49, have employed the damping method based on Kalman filtering technology and the manual switch between the traditional damping method and Kalman damping method is viable. However, due to the defect of the design principle for damping inertial navigation systems, either the traditional damping method or Kalman damping method is unable to be used in the high-maneuvering condition and suppress the oscillation errors continuously.
Integrated navigation system is a navigation system that combines two or more than two navigation subsystems in an appropriate way to achieve some purpose, such as to improve the accuracy of the system [20,21,22,23]. The emergence of various filtering algorithms provides a good theoretical and mathematical tool for the integrated navigation system [24,25,26]. Owing to this, the integrated navigation system can effectively restrain the errors of the inertial navigation system. Integrated navigation systems, especially the GPS/INS integrated navigation system, has been widely used in various fields [27,28,29,30,31]. Although the integrated navigation system can improve the precision of the inertial navigation system, help from external information makes inertial navigation system lose its autonomy, which is an inevitable shortcoming of integrated navigation.
Based on the analysis of inertial navigation system errors and the errors’ propagation mechanism, this paper proposes a method for oscillation error restriction of SINS based on forecasted time series. In the view of the math, making use of the principle of eliminating the periodic oscillation signal with half-wave delay by mean value restrains the oscillation errors based on forecasted time series. Compared with the damping inertial navigation system, the whole system is working in a free damping state and introduces no dynamic errors caused by maneuvers. Therefore, the method can be used for the carrier in a high-maneuver state and suppress the oscillation errors continuously. Compared with the integrated navigation system, the method has no aid of external reference information, which retains the autonomy of inertial navigation system. In a word, the new method can suppress oscillation errors in both static and maneuvering states on the condition of maintaining the autonomy of inertial navigation system, which has several advantages over the conventional methods.
The outline of the remainder of this paper is as follows. Analysis of periodic oscillation errors of SINS is given in Section 2. Method for oscillation error restriction based on forecasted time series is introduced in Section 3. Section 4 explains the method for obtaining forecasted time series by curve fitting based on least square method. Section 5 shows the simulation results and Section 6 presents the system test results. Finally, Section 7 concludes the paper.

2. Analysis of Periodic Oscillation Errors of SINS

In order to simplify the problem, the analysis is carried out with the error equation of SINS at rest, ignoring the vertical channel:
X = F X + W
where X = [ δ V E δ V N δφ Φ E Φ N Φ U ] T ,
F = [ 0 2 ω i e t z 0 0 − g 0 − 2 ω i e t z 0 0 g 0 0 0 − 1 R 0 0 0 0 0 − 1 R 0 0 ω i e t z − ω i e t y − 1 R 0 − ω i e t z − ω i e t z 0 0 1 R tan φ 0 ω i e t y ω i e t y 0 0 ]
W = [ A E A N 0 G E G N G U ] T , ω i e t z = ω i e sin φ ; ω i e is the earth rotation rate; R is the radius of the earth; g is the acceleration of gravity; φ is the latitude; δ V E , δ V N is the east velocity error and north velocity error respectively; δφ is the latitude error; Φ E , Φ N , Φ U is the east, north, and up platform angle error, respectively; Α E , Α N is the measurement error for east accelerometer and north accelerometer respectively; G E , G N , G U is the measurement error for east gyroscope, north gyroscope, and up gyroscope, respectively.
Doing the Laplace transform on both sides of Equation (1) and rearranging the equation gets:
X ( s ) = ( s I − F ) − 1 ( X ( 0 ) + W ( s ) )
Known from errors’ propagation characteristic of SINS, gyro bias drift and accelerometer bias are the main error sources, and from this we obtain:
{ G E ( s ) = ε E s G N ( s ) = ε N s G U ( s ) = ε U s A E ( s ) = ∇ E s A N ( s ) = ∇ N s
where ε E , ε N , ε U is gyro bias drift for east gyroscope, north gyroscope, and up gyroscope, respectively; ∇ E , ∇ N is accelerometer bias for east accelerometer and north accelerometer, respectively.
The system errors can be obtained by substituting Equation (3) into Equation (2). Taking Φ E and δφ as examples, the expressions are:
Φ E ( s ) = C 42 ( δ V N 0 + ∇ N s ) + C 43 δφ 0 + C 44 ( Φ E 0 + ε E s ) + C 45 ( Φ N 0 + ε N s ) + C 46 ( Φ U 0 + ε U s )
δφ ( s ) = C 32 ( δ V N 0 + ∇ N s ) + C 33 δφ 0 + C 34 ( Φ E 0 + ε E s ) + C 35 ( Φ N 0 + ε N s ) + C 36 ( Φ U 0 + ε U s )
where C 42 = − 1 R Δ 1 ( s ) ; C 43 = − ω i e 2 s Δ 2 ( s ) ; C 44 = s 3 Δ 2 ( s ) ; C 45 = ω i e t z s 2 Δ 2 ( s ) ; C 46 = − ω i e t y s 2 Δ 2 ( s ) ; C 32 = 1 R Δ 1 ( s ) ; C 33 = s ( s 2 + ω s 2 + ω i e 2 ) Δ 2 ( s ) ; C 34 = ω s 2 s Δ 2 ( s ) ; C 35 = ω s 2 ω i e t z Δ 2 ( s ) ; C 36 = − ω s 2 ω i e t y Δ 2 ( s ) .
where Δ 1 ( s ) = ( s 2 + ω s 2 ) ; Δ 2 ( s ) = ( s 2 + ω i e 2 ) ( s 2 + ω s 2 ) ; ω s is the Schuler oscillation frequency; ω i e is the Earth oscillation frequency; Φ E 0 , Φ N 0 , Φ U 0 are the initial values of platform angle errors; δφ 0 is the initial value of latitude error; δ V N 0 is the initial value of north velocity error.
Applying the inverse Laplace transform on Equations (4) and (5), considering ω s > > ω i e :
Φ E ( t ) = M 1 sin ω s t + M 2 cos ω s t + M 3 sin ω i e t + M 4 cos ω i e t + M 5
δφ ( t ) = L 1 sin ω s t + L 2 cos ω s t + L 3 sin ω i e t + L 4 cos ω i e t + L 5
where M 1 = 1 ω s ε E − 1 R ω s δ V N 0 ; M 2 = − ω i e t z ω s 2 ε N + ω i e t y ω s 2 ε U + Φ E 0 + 1 R ω s 2 ∇ N ; M 3 = − ω i e ω s 2 ε E ; M 4 = ω i e t z ω s 2 ε N − ω i e t y ω s 2 ε U − Φ E 0 ; M 5 = − 1 R ω s 2 ∇ N ; L 1 = − 1 ω s ε E + 1 R ω s δ V N 0 ; L 2 = ω i e t z ω s 2 ε N − ω i e t y ω s 2 ε U − Φ E 0 − 1 R ω s 2 ∇ N ; L 3 = 1 ω i e ε E + sin φ Φ N 0 − cos φ Φ U 0 ; L 4 = sin φ ω i e ε N + cos φ ω i e ε U + Φ E 0 + δφ 0 ; L 5 = + sin φ ω i e ε E − cos φ ω i e ε U + ∇ N g .
Equations (6) and (7) show that although the steady-state values of Φ E and δφ are constant, Schuler and Earth periodic oscillation errors are contained in Φ E and δφ . From the point of mathematics, these oscillation errors are the summation of a number of sine and cosine functions, whose oscillation frequency is ω s or ω i e and the amplitudes of periodic functions are decided by the corresponding error sources. According to Equation (2), other SINS errors contain the similar periodic oscillation errors, which greatly reduce the precision of inertial navigation system due to having the same characteristic root.
The conclusion above is given by ignoring Foucault periodic oscillation errors, which influences the result little since Foucault periodic oscillation errors only modulate Schuler periodic oscillation errors.

3. Method for Oscillation Errors Restriction Based on Forecasted Time Series

3.1. Principle of Eliminating Periodic Oscillation Signal with Half-Wave Delay by Mean Value

A periodic oscillation signal whose cycle is T can be written as:
y 1 ( t ) = A sin ω t
where ω = 2 π / T .
Another periodic oscillation signal with cycle T is:
y 2 ( t ) = A sin ω ( t + T 2 ) = A sin ( ω t + π ) = − A sin ω t
Averaging Equations (8) and (9) gives:
y ( t ) = y 1 ( t ) + y 2 ( t ) 2 = A sin ω t − A sin ω t 2 = 0
Concluded from Equation (10), the oscillation can be suppressed by the mean of two signals when their phases vary by π or their amplitudes are the opposite of each other. So the Schuler and Earth periodic oscillation errors can be eliminated if the difference between two phases equals to π.

3.2. Method for Oscillation Errors Restriction Based on Forecasted Time Series

Inertial navigation systems cannot switch into navigation mode until the alignment process is done. Whether using independent initial alignment or integrated initial alignment, errors of inertial devices directly determine the precision of initial alignment of inertial navigation system. Different from physical closed-loop control of platform inertial navigation system, SINS allows executing multiple sets of navigation algorithms at the same time.
SINS performs its initial alignment process in the stationary state. The theoretical values the IMU senses are fixed, so the measurement data from the IMU can be regarded as a stationary time series containing random noise. Therefore, the prediction values of time series can be obtained by analyzing and processing the measurement data from the IMU in the process of initial alignment.
In order to compensate for oscillation errors with cycle T, prospective time series whose time length is T/2 is needed. When the error of the static initial alignment process satisfies the requirements, the initial alignment process is not finished right away and an auxiliary navigation algorithm is executed, using the result of initial alignment process at current moment t and prospective time series. Auxiliary navigation algorithm does not turn into a real-time navigation state until the prospective time series is used up, while the main navigation algorithm starts working with the result of initial alignment process at current moment t′.
To compensate oscillation errors with cycle T, making use of forecasted time series lets the phases of oscillation errors in auxiliary navigation algorithm differ from the ones of the main navigation algorithm by π. The process diagram is as follow.
Sensors 15 17433 g002 1024
Figure 2. Principle diagram of suppressing oscillation errors based on forecasted time series.
Figure 2. Principle diagram of suppressing oscillation errors based on forecasted time series.
Sensors 15 17433 g002
As shown in Figure 2, making use of forecasted time series obtained from the static initial alignment process lets the phases of oscillation errors with cycle T in the auxiliary navigation algorithm differ from the ones of the main navigation algorithm by π. The simulation consumes very little time because it is not a real-time process. In other words, oscillation errors are restricted with little cost.
Based on the process shown in Figure 2, reanalyzing and arranging Equations (5) and (6) gives:
Φ E ( t ) = Φ E 1 ( t ) + Φ E 2 ( t ) + M 5
δφ ( t ) = δφ 1 ( t ) + dj 2 ( t ) + L 5
where Φ E 1 ( t ) = M 1 sin ω s t + M 2 cos ω s t ; Φ E 2 ( t ) = M 3 sin ω i e t + M 4 cos ω i e t ; δφ 1 ( t ) = L 1 sin ω s t + L 2 cos ω s t ; δφ 2 ( t ) = L 3 sin ω i e t + L 4 cos ω i e t .
Considering T = 2 π / ω s , averaging the system errors of the auxiliary navigation algorithm and main navigation algorithm presents:
Φ ˜ E ( t ) = 1 2 [ Φ E ( t ) + Φ E ( t + T 2 ) ] = 1 2 [ Φ E 1 ( t ) + Φ E 2 ( t ) + Φ E 1 ( t + T 2 ) + Φ E 2 ( t + T 2 ) ] + M 5 = 1 2 [ M 1 sin ω s t + M 2 cos ω s t + M 1 sin ( ω s t + π ) + M 2 cos ( ω s t + π ) + M 3 sin ω i e t + M 4 cos ω i e t + M 3 sin ( ω i e t + ω i e π ω s ) + M 4 cos ( ω i e t + ω i e π ω s ) ] + M 5
According to the trigonometric function relationship, simplifying the mean shows:
Φ ˜ E ( t ) = 1 2 [ Φ E 2 ( t ) + Φ E 2 ( t + T 2 ) ] + M 5
Likewise:
δ φ ˜ ( t ) = 1 2 [ δφ 2 ( t ) + δφ 2 ( t + T 2 ) ] + L 5
Equations (13) and (14) show that when T = 2 π / ω s , Schuler periodic oscillation errors can be eliminated directly. Owing to the fact that Foucault periodic oscillation errors modulate Schuler periodic oscillation errors, Foucault periodic oscillation errors can be compensated as well.
Assuming T = 2 π / ω i e , averaging system errors of auxiliary navigation algorithm and main navigation algorithm gives:
δ φ ¯ ( t ) = 1 2 [ δφ ( t ) + δφ ( t + T 2 ) ] = 1 2 [ δφ 1 ( t ) + δφ 1 ( t + T 2 ) ] + L 5
Likewise:
Φ ¯ E ( t ) = 1 2 [ Φ E 1 ( t ) + Φ E 1 ( t + T 2 ) ] + M 5
Known from Equations (15) and (16), Earth periodic oscillation errors can be compensated when T = 2 π / ω i e .
Among the errors of SINS, Earth periodic oscillation errors are obvious in yaw error and latitude error; horizontal attitude and horizontal velocity are influenced by Schuler periodic oscillation errors and Foucault periodic oscillation errors. Therefore, according to the different forms of oscillation errors, making use of forecasted time series with different time length can suppress Schuler, Foucault, and Earth periodic oscillation errors at the same time.
The main navigation algorithm outputs the navigation parameters noted as B i , the first auxiliary navigation algorithm using forecasted time series with time length of π / ω s outputs the navigation parameters noted as C i , and the second auxiliary navigation algorithm using forecasted time series with time length of π / ω i e outputs the navigation parameters noted as D i . Schuler periodic oscillation errors and Foucault periodic oscillation errors of horizontal attitude and horizontal velocity in B i can be compensated by the ones in C i , and Earth periodic oscillation errors of position and yaw in B i can be compensated by the ones in D i . The formulation is as follow.
{ S ′ i = ( B i + C i ) / 2 S ″ i = ( B i + D i ) / 2 i = 1 , 2 , ... , 7
Known from Equation (17), the method for oscillation error restriction based on forecasted time series introduces no external reference information and retains autonomy of the inertial navigation system. Because the inertial navigation system is still working without a damping state, there are no dynamic errors encouraged by the acceleration from maneuvers.
The method is suitable for SINS whose initial alignment process is finished in a stationary state. It is worth noting that during the movement of carrier ε E , ε N , ε U , ∇ E , ∇ N would vary over time due to the factors, such as changes of the attitude, which weakens the effect of suppressing oscillation error caused by them. However, the initial errors are constant and so oscillation errors caused by them can be restrained effectively all the time.
Although the results are given by the analysis of the error equation of SINS at rest, they are also applicable to SINS in a motion state. As the error equation of SINS in motion state is too complicated to obtain the analytical solution, it is very difficult to give a detailed deduction and some qualitative analyses would be done here. For the carrier with velocity in the range of 0–50 m/s, V E R and V N R are at least one order of magnitude smaller than ω i e , in general. Thus, the difference between the static state and motion state is small and the error equation of SINS at rest can be used for concise analyses in this condition. For the carrier with high velocity, Schuler oscillation period and Earth oscillation period would change over time. However, in the static state, obtaining a set of navigation solution whose phases of oscillation errors vary by π is equal to getting a set of navigation solution whose amplitudes of oscillation errors are the opposite of each other in the beginning. No matter what the subsequent movement state is, the frequencies of the oscillation errors are always the same. Thus, the effect of suppressing oscillation errors always exists, which will be analyzed and confirmed in the subsequent simulation.

4. Method for Obtaining Forecasted Time Series by Curve Fitting Based on Least Square Method

4.1. Curve Fitting Based on Least Square Method

A set of data for a certain physical process is known as:
( x i , f ( x i ) ) , i = 1 , 2 , ⋯ , m
Seeking an approximate function ϕ ( x ) of f ( x i ) in a particular class of functions φ ( x ) , their residual on x i is:
δ i = ϕ ( x i ) − f ( x i ) , i = 1 , 2 , ⋯ , m
Minimizing the residual according to some metric which is always chosen as:
‖ δ ‖ 2 = ( ∑ i = 0 m δ i 2 ) 1 2 = { ∑ i = 0 m [ ϕ ( x i ) − f ( x i ) ] 2 } 1 2
Or:
‖ δ ‖ 2 2 = ∑ i = 0 m δ i 2 = ∑ i = 0 m [ ϕ ( x i ) − f ( x i ) ] 2
Curve fitting based on least square method makes the sum of error squares minimal and gives the optimal estimation in minimum variance criterion.

4.2. Problem Description

Curve fitting based on least square method can objectively predict the time series with arbitrary length on the ideal condition, where the carrier is in the stationary state. However, due to the presence of various disturbances, the carrier may have small angular motions in the actual application. Several forms of the interference of small angular motions in the output of gyro are shown as follow.
Sensors 15 17433 g003 1024
Figure 3. Several forms of the interference of small angular motions in the output of gyro.
Figure 3. Several forms of the interference of small angular motions in the output of gyro.
Sensors 15 17433 g003
Case 1: IMU moves by a small angular along positive direction (clockwise);
Case 2: IMU moves by a small angular along negative direction (anti-clockwise);
Case 3: IMU moves by a small angular along positive direction and then moves along negative direction.
Figure 3 shows that small angular motions bring a certain bias to forecasted time series obtained by curve fitting based on least square method. Therefore, it is necessary to distinguish small angular motions from random noise and remove the effect of small angular motions on forecasted time series.

4.3. Forecasted Time series Obtained by Curve Fitting Based on Least Square Method

Measurement time series from IMU in the initial alignment process is:
Z ( t ) = [ ω i b b ( t ) , f b ( t ) ] T
where ω i b b ( t ) = [ ω x ( t ) , ω y ( t ) , ω z ( t ) ] T ; f b ( t ) = [ f x ( t ) , f y ( t ) , f z ( t ) ] T ; ω x ( t ) , ω y ( t ) , ω z ( t ) is the measurement time series for gyroscope in x axis, gyroscope in y axis, and gyroscope in z axis, respectively. f x ( t ) , f y ( t ) , f z ( t ) is the measurement time series for accelerometer in x axis, accelerometer in y axis, and accelerometer in z axis, respectively.
Measurement time series for gyroscopes:
ω i b b ( t ) = ω i e b ( t ) + ω e p b ( t ) + ω p b b ( t )
Integrating on both sides gives:
∫ ω i b b ( t ) d t = ∫ ω i e b ( t ) d t + ∫ ω e p b ( t ) d t + ∫ ω p b b ( t ) d t
Because the carrier is static, the theoretical value of ω e p b ( t ) is zero. Assuming the carrier have small angular motion during the time of t 1 ∼ t 2 :
∫ 0 t ω i b b ( t ) d t = ∫ 0 t ω i e b ( t ) d t + ∫ 0 t ω p b b ( t ) d t = ∫ 0 t ω i e b ( t ) d t + ∫ t 1 t 2 ω p b b ( t ) d t
where ∫ 0 t ω i b b ( t ) d t is the variation of angular of body frame, with respect to inertial frame in the body frame. Integral operation can eliminate the interference of noise with high frequency in ω i b b ( t ) . ω i e b ( t ) is the projection of ω i e whose magnitude is 10−5 in body frame, so ω p b b ( t ) produced by a small angular motion is higher by several orders of magnitude, in general. Therefore, ∫ 0 t ω i b b ( t ) d t changes significantly during t1~t2.
In the stationary state, the outputs of gyro and accelerometer in fiber gyroscope inertial navigation systems with the interference of small angular motions are as follows in Figure 4.
Known from Figure 5, angular movements of the IMU happened during 100 s~105 s and 198 s~203 s. Therefore, the time when the angular motions occurred can be distinguished by variation of ∫ 0 t ω i b b ( t ) d t .
Sensors 15 17433 g004 1024
Figure 4. The outputs of gyro and accelerometer with the interference of small angular motions.
Figure 4. The outputs of gyro and accelerometer with the interference of small angular motions.
Sensors 15 17433 g004
Based on the output of gyro shown in Figure 4, the variation of ∫ 0 t ω x ( t ) d t is:
Sensors 15 17433 g005 1024
Figure 5. Variation of ∫ 0 t ω x ( t ) d t .
Figure 5. Variation of ∫ 0 t ω x ( t ) d t .
Sensors 15 17433 g005
Assuming small angular motion occurred more than one time, making use of variation of ∫ 0 t ω i b b ( t ) d t determines the time when small angular motions happened. Z ( t ) is divided into N time series, noted as Z i ( t ) by determined span, doing curve fitting based on least square method on every time series gives estimations E ^ i ( t ) for each time series where i = 1 , 2 , ⋯ , N . Get Z ^ M ( t ) by the formulation:
Z ^ M ( t ) = Z M ( t ) + E ^ N ( t ) − E ^ M ( t ) , M = 1 , 2 , ⋯ , N
And the new time series is:
Z ^ ( t ) = [ Z ^ 1 ( t ) , Z ^ 2 ( t ) , ⋯ , Z ^ N ( t ) ]
Z ^ ( t ) is a new time series gained by eliminating angular motions in Z ( t ) . Processing ω x ( t ) and f y ( t ) shown in Figure 4 obtains the new time series and curve fitting as follows.
Sensors 15 17433 g006 1024
Figure 6. (a) The new time series and curve fitting of gyro; (b) The new time series and curve fitting of accelerometer.
Figure 6. (a) The new time series and curve fitting of gyro; (b) The new time series and curve fitting of accelerometer.
Sensors 15 17433 g006
According to Figure 6, curve fitting based on least square for Z ^ ( t ) can objectively predict the time series with arbitrary length in the future. Since the least squares method is a type of unbiased estimator, forecasted time series still contains gyro bias drift and accelerometer bias. Schuler and Foucault periodic oscillation errors can be restrained with forecasted time series for π / ω s and Earth periodic oscillation errors can be suppressed with forecasting time series for π / ω i e .

5. Computer Simulations

5.1. Simulation of Maneuvering Carrier

5.1.1. Simulation with No Inertia Device Errors

(1) Simulation conditions
There are no inertia device errors.
The initial alignment errors: Errors of initial position: longitude 2″, latitude 2″; Errors of initial velocity: east velocity 0.1 m/s, north velocity 0.1 m/s; Errors of initial attitude: pitch 0.6′, roll 0.6′, yaw 7′.
Others: Time of initial alignment in static state: 10 min; Time of simulation: 24 h; Step of simulation: 0.01 s; After the whole system turns into navigation mode, the range of east velocity is in 0~300 m/s, the range of north velocity is in 0~30 m/s, the range of attitude components is in 0°~90°, the change rate of velocity is as follow.
Sensors 15 17433 g007 1024
Figure 7. (a) The change rate of north velocity; (b) The change rate of east velocity.
Figure 7. (a) The change rate of north velocity; (b) The change rate of east velocity.
Sensors 15 17433 g007
In the whole simulation time, the change rate of velocity varies over time, as shown in Figure 7, and the traditional damping technology without using external reference information cannot apply to this condition.
(2) Simulation results
Based on the conditions above, the simulation results are as follows.
Sensors 15 17433 g008 1024
Figure 8. (a) Simulation results of attitude errors for maneuvering carrier with no inertia device errors; (b) Simulation results of velocity errors for maneuvering the carrier with no inertia device errors; (c) Simulation results of position errors for maneuvering the carrier with no inertia device errors.
Figure 8. (a) Simulation results of attitude errors for maneuvering carrier with no inertia device errors; (b) Simulation results of velocity errors for maneuvering the carrier with no inertia device errors; (c) Simulation results of position errors for maneuvering the carrier with no inertia device errors.
Sensors 15 17433 g008
Figure 8 shows that although the carrier is in the maneuvering state sustainably, Schuler, Foucault, and Earth periodic oscillation errors caused by initial errors can be suppressed, which is impossible for the damping inertial navigation system. Known from the simulation curves of Φ U , δφ , and δλ , the period of oscillation errors that relate to the rotation of the Earth is smaller than 24 h, primarily due to the high velocity. However, the method has good performance in restricting the oscillation errors still, which indicates that the method is not affected by the motion state of the carrier.

5.1.2. Simulation with Inertia Device Errors

(1) Simulation conditions
Errors of IMU: Gyro bias drift: 0.01°/h; Angle random walk: 0.005°/h; Accelerometer bias drift: 1 × 10−4 g; Velocity random walk: 5 × 10−4 g.
The other conditions are the same as the simulation with no inertia device errors.
(2) Simulation results
Based on the conditions above, the simulation results are as follows.
Known from Figure 9, although ε E , ε N , ε U , ∇ E , ∇ N vary over time, the new method has good performance in suppressing Schuler, Foucault, and Earth periodic oscillation errors as well, and greatly improves the precision of SINS.
Sensors 15 17433 g009 1024
Figure 9. (a) Simulation results of attitude errors for maneuvering the carrier with inertia device errors; (b) Simulation results of velocity errors for maneuvering the carrier with inertia device errors; (c) Simulation results of position errors for maneuvering the carrier with inertia device errors.
Figure 9. (a) Simulation results of attitude errors for maneuvering the carrier with inertia device errors; (b) Simulation results of velocity errors for maneuvering the carrier with inertia device errors; (c) Simulation results of position errors for maneuvering the carrier with inertia device errors.
Sensors 15 17433 g009

6. System Test

6.1. Test Equipment

Using the fiber gyroscope inertial navigation system shown in Figure 10 validates the method for oscillation error restriction based on forecasted time series.
Sensors 15 17433 g010 1024
Figure 10. Fiber gyroscope inertial navigation system.
Figure 10. Fiber gyroscope inertial navigation system.
Sensors 15 17433 g010
As shown in Figure 10, the fiber gyroscope inertial navigation system is accompanied with a temperature control box. The IMU is put in the temperature control box in order to insulate external interference from thermal and magnetic sources. Some main performance parameters of the IMU are as follows.
Gyros: Gyro bias drift <0.005°/h; Angle random walk <0.005°/h; Scale factor non-linearity 10 ppm; Scale factor sign asymmetry 10 ppm; Scale factor reiteration 10 ppm. Accelerometers: Accelerometer bias drift <7 × 10−5 g; Velocity random walk <5 × 10−5 g. Scale factor 1.3~1.6 mA/g; two order nonlinear coefficient <µg/g2.
Reference datum is a high-precision, three-axis turntable (SGT-3). Its performance parameters are as follows. Wobble error: ±2″; Axis perpendicularity: ±2″; Positioning accuracy: ±3″; Position control resolution: 0.0001°; Position repeatability accuracy: ±1″; Rate resolution: 0.0001°/s. Owing to the high attitude measurement accuracy of the turntable, it can be used as the attitude reference. Since the IMU is placed in the swing center, the velocity of the IMU is approximately zero and the position is unchanged.
The test equipment is shown in Figure 11.
Sensors 15 17433 g011 1024
Figure 11. High-precision, three-axis turntable and SINS.
Figure 11. High-precision, three-axis turntable and SINS.
Sensors 15 17433 g011

6.2. Test

6.2.1. Test Preparation

The IMU was installed on the turntable and the coordinate system of the IMU was made coincident with the turntable as closely as possible. The misalignment matrix between the two coordinate systems was obtained though calibration, which was used for error compensation.

6.2.2. Test Process

(1) In order to make the outputs of gyroscopes and accelerometers stable, the temperature control system needed to make the temperature of IMU stable at 33° C. The whole process, called system startup, consumed about 1 h.
(2) After the system startup, the initial alignment process was conducted for 10 min, during which the initial values of the main algorithm and auxiliary algorithms were obtained according to the method mentioned above. Small angular motions were added in the initial alignment process with the help of the turntable.
(3) The whole system then switched to the navigation state and was tested for 25 h.

6.2.3. Test Set

The turntable did not start to swing until the whole system switched to the navigation state. Swing range of the turntable was 5° and swing period of the turntable was 20 s.

6.2.4. Sampling Frequency and Update Frequency

The sampling frequency of the IMU was 100 Hz and the update frequency of the algorithms was 50 Hz.

6.2.5. Reference Datum

In the process of navigation, the measurement data from the turntable was obtained at the same time. The attitude reference was chosen as the attitude measured by the turntable. The velocity reference was chosen as zero. The position reference was chosen as the local location (longitude: 126.6773°E, latitude: 45.7796°N).

6.2.6. Initial Attitude Errors

Pitch: about 0.15; roll: about 0.14; yaw: about 1.3′.

6.3. Test Results

Based on actual test, test results are obtained as follows in Figure 12.
Sensors 15 17433 g012 1024
Figure 12. (a) Test results of attitude errors for actual system; (b) Test results of velocity errors for actual system; (c) Test results of position errors for actual system.
Figure 12. (a) Test results of attitude errors for actual system; (b) Test results of velocity errors for actual system; (c) Test results of position errors for actual system.
Sensors 15 17433 g012
As can be seen from the simulation and test results, the method can suppress Schuler periodic oscillation errors, Foucault periodic oscillation errors, and Earth periodic oscillation errors effectively. The method can be used for the carrier in a high-maneuver state and restrain the oscillation errors continuously. The main reasons why Schuler period oscillation errors are not completely suppressed are as follows: (1) ε E , ε N , ε U , ∇ E , ∇ N vary over time; and (2) Schuler periodic oscillation errors are modulated by Foucault periodic oscillation errors, which are not compensated at all.

7. Conclusions

Aiming at the problem that the precision of SINS is influenced a lot by periodic oscillation errors, a method for oscillation errors restriction based on forecasted time series is proposed in this paper. Simulation and experimental results show that the method can effectively suppress periodic oscillation errors and greatly improve the precision of SINS. The method not only preserves autonomy of SINS but also introduces no dynamic errors caused by acceleration, which has important practical application value.

Acknowledgments

This work was supported in part by the National Natural Science Foundation of China (No. 61273081 and No. 61374007).

Author Contributions

Lin Zhao provided the ideas and innovations for this article. Jiushun Li was responsible for writing and verification. Jianhua Cheng was responsible for conducting the experiment and polished the article. Chun Jia and Qiufan Wang afforded some work on digital image processing and modification of this manuscript.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Tazartes, D.A. Inertial Navigation: From Gimbaled Platforms to Strapdown Sensors. IEEE Trans. Aerosp. Electron. Syst. 2011, 47, 2292–2299. [Google Scholar]
  2. Malakar, B.; Roy, B. A novel application of adaptive filtering for initial alignment of strapdown inertial navigation system. In Proceedings of the 2014 International Conference on Circuits, Systems, Communication and Information Technology Applications (CSCITA), Mumbai, India, 4–5 April 2014; pp. 189–194.
  3. Vajda, S.; Zom, A. Survey of existing and emerging technologies for strategic submarine navigation. In Proceedings of the IEEE Position Location and Navigation, Symposium, Palm Springs, CA, USA, 20–23 April 1998; pp. 309–315.
  4. Acharya, A.; Sadhu, S.; Ghoshal, T.K. Improving Self-Alignment of Strapdown INS Using Measurement Augmentation. In Proceedings of the 12th International Conference on Information Fusion, Seattle, WA, USA, 6–9 July 2009; pp. 1783–1789.
  5. Ma, Y.; Fang, J.; Wang, W. Decoupled Observability Analyses of Error States in INS/GPS Integration. J. Navig. 2014, 67, 473–494. [Google Scholar] [CrossRef]
  6. Zheng, Z.; Yue, J. A Novel GPS/INS Loose Integrated Navigation Algorithm. Adv. Mater. Res. 2013, 823, 479–484. [Google Scholar] [CrossRef]
  7. Kevin, C.; Robert, G.; Marvin, B.M.; Scott, G. Navy Testing of the iXBlue MARINS Fiber Optic Gyroscope (FOG) Inertial Navigation System (INS). In Proceedings of IEEE/ION Position, Location and Navigation Symposium-PLANS, Monterey, CA, USA, 5–8 May 2014; pp. 1392–1408.
  8. Tawk, Y.; Tomé, P.; Botteron, C.; Stebler, Y.; Farine, P.A. Implementation and Performance of a GPS/INS Tightly Coupled Assisted PLL Architecture Using MEMS Inertial Sensors. Sensors 2014, 14, 3768–3796. [Google Scholar] [CrossRef] [PubMed]
  9. Gao, W.; Zhang, Y.; Wang, J. A Strapdown Interial Navigation System/Beidou/Doppler Velocity Log Integrated Navigation Algorithm Based on a Cubature Kalman Filter. Sensors 2014, 14, 1511–1527. [Google Scholar] [CrossRef] [PubMed]
  10. Chen, J.; Zou, J.; Wu, L.; Hao, Y.; Gan, S. The Design of an Effective Marine Inertial Navigation System Scheme. In Proceedings of the International Workshop on Knowledge Discovery and Data Mining (WKDD 2008), Adelaide, Australia, 23–24 January 2008; pp. 671–676.
  11. Grammatikos, A.; Schuler, A.R.; Fegley, K.A. Damping gimballess inertial navigation system. IEEE Trans. Aerosp. Electron. Syst. 1967, 3, 481–493. [Google Scholar] [CrossRef]
  12. Hao, Y.; Gong, J.; Gao, W.; Li, L. Research on the dynamic error of strapdown inertial navigation system. In Proceedings of the IEEE International Conference on Mechatronics and Automation, 2008 (ICMA 2008), Takamatsu, Japan, 5–8 August 2008; pp. 814–819.
  13. Xu, B.; Sun, F. An independent damped algorithm based on SINS for ship. In Proceedings of 2009 International Conference on Computer Engineering and Technology, Singapore, Singapore, 22–24 January 2009; pp. 88–92.
  14. Gao, W.; Zhang, Y. Analyses of Damping Network Effect on SINS. In Proceedings of the International Conference on Mechatronics and Automation, Changchun, China, 9–12, August 2009; pp. 2530–2535.
  15. Ra, W.S.; Whang, I.H.; Park, H.R. Robust damping loop design for GPS/INS vertical channel. Electron. Lett. 2006, 42, 617–618. [Google Scholar] [CrossRef]
  16. Huang, W.Q.; Hao, Y.L.; Cheng, J.H.; Li, G.; Fu, I.G.; Bu, X.B. Rearch of the inertial navigation system with variable damping coefficients horizontal damping networks. In Proceedings of Oceans’ 04 MTS /IEEE Techno-Ocean’ 04 Conference, Kobe, Japan, 9–12 November 2004; pp. 1272–1276.
  17. Gao, W.; Zhang, Y.; Ben, Y.; Sun, Q. An Automatic Compensation Method for States Switch of Strapdown Inertial Navigation System. In Proceedings of IEEE/ION Position Location and Navigation Symposium, Myrtle Beach, SC, USA, 23–26 April 2012; pp. 814–817.
  18. Tucker, T.; Levinson, E. The AN/WSN-7B marine gyrocompass/navigator. In Proceedings of the 2000 National Technical Meeting of the Institute of Navigation, Anaheim, CA, USA, 26–28 January 2000; pp. 348–357.
  19. Du, Y.; Liu, J.; Liu, R.; Zhu, Y. The fuzzy Kalman filtering of damp attitude algorithm. J. Astronaut. 2007, 28, 305–309. [Google Scholar]
  20. Ma, X.J.; Liu, H.W.; Xiao, D.; Li, H.K. Key technologies of geomagnetic aided inertial navigation system. In Proceedings of the IEEE Intelligent Vehicles Symposium, Xi’an, China, 3–5 June 2009; pp. 464–469.
  21. Jaradat, M.A.K.; Abdel-Hafez, M.F. Enhanced, Delay Dependent, Intelligent Fusion for INS/GPS Navigation System. IEEE Sens. J. 2014, 14, 1545–1554. [Google Scholar] [CrossRef]
  22. Adusumilli, S.; Bhatt, D.; Wang, H.; Bhattacharya, P.; Devabhaktuni, V. A low-cost INS/GPS integration methodology based on random forest regression. Expert Syst. Appl. 2013, 40, 4653–4659. [Google Scholar] [CrossRef]
  23. Lee, J.K.; Jekeli, C. Neural Network Aided Adaptive Filtering and Smoothing for an Integrated INS/GPS Unexploded Ordnance Geolocation System. J. Navig. 2010, 63, 251–267. [Google Scholar] [CrossRef]
  24. Nassar, S.; El-Sheimy, N. A combined algorithm of improving INS error modeling and sensor measurements for accurate INS/GPS navigation. GPS Solut. 2006, 10, 29–39. [Google Scholar] [CrossRef]
  25. Musavi, N.; Keighobadi, J. Adaptive fuzzy neuro-observer applied to low cost INS/GPS. Appl. Soft Comput. 2015, 29, 82–94. [Google Scholar] [CrossRef]
  26. Gonzalez, R.; Giribet, J.I.; Patino, H.D. An approach to benchmarking of loosely coupled low-cost navigation systems. Math. Comput. Model. Dyn. Syst. 2015, 21, 272–287. [Google Scholar] [CrossRef]
  27. Welker, T.C.; Pachter, M.; Huffman, R.E. Gravity Gradiometer Integrated Inertial Navigation. In Proceedings of European Control Conference, Zurich, Switzerland, 17–19 July 2013; pp. 846–851.
  28. Hong, S.P.; Lee, M.H.; Chun, H.H.; Kwon, S.H.; Speyer, J.L. Observability of error states in GPS/INS integration. IEEE Trans. Veh. Technol. 2005, 54, 731–743. [Google Scholar] [CrossRef]
  29. Yang, Y.; Zhou, J.; Nies, H.; Loffeld, O.; Knedlik, S. Development of a Deeply-Coupled GPS/INS Integration Algorithm Using Quaternions. In Proceedings of 16th International Conference on Information Fusion, Istanbul, Turkey, 9–12 July 2013; pp. 1791–1796.
  30. Babu, R.; Wang, J.L. Ultra-tight GPS/INS/PL integration: A system concept and performance analysis. GPS Solut. 2009, 13, 75–82. [Google Scholar] [CrossRef]
  31. Leung, K.T.; Whidborne, J.F.; Purdy, D.; Dunoyer, A. A review of ground vehicle dynamic state estimations utilising GPS/INS. Veh. Syst. Dyn. 2011, 49, 29–58. [Google Scholar] [CrossRef]

Share and Cite

MDPI and ACS Style

Zhao, L.; Li, J.; Cheng, J.; Jia, C.; Wang, Q. A Method for Oscillation Errors Restriction of SINS Based on Forecasted Time Series. Sensors 2015, 15, 17433-17452. https://doi.org/10.3390/s150717433

AMA Style

Zhao L, Li J, Cheng J, Jia C, Wang Q. A Method for Oscillation Errors Restriction of SINS Based on Forecasted Time Series. Sensors. 2015; 15(7):17433-17452. https://doi.org/10.3390/s150717433

Chicago/Turabian Style

Zhao, Lin, Jiushun Li, Jianhua Cheng, Chun Jia, and Qiufan Wang. 2015. "A Method for Oscillation Errors Restriction of SINS Based on Forecasted Time Series" Sensors 15, no. 7: 17433-17452. https://doi.org/10.3390/s150717433

APA Style

Zhao, L., Li, J., Cheng, J., Jia, C., & Wang, Q. (2015). A Method for Oscillation Errors Restriction of SINS Based on Forecasted Time Series. Sensors, 15(7), 17433-17452. https://doi.org/10.3390/s150717433

Article Metrics

Back to TopTop