You are on page 1of 6

2008 Workshop on Knowledge Discovery and Data Mining

The Design of an Effective Marine Inertial Navigation System Scheme

Cheng Jian-hua1,2, Zou Ji-bin1, WU Lei2, Hao Yan-ling2, Gan Shuai1


1. School of Electrical Engineering and Automation, Harbin Institute of Technology
2. School of Automation, Harbin Engineering University
ins_cheng@163.com

Abstract system[2]. But there are three kinds of periodic


oscillation in this state: 84.4 minutes Schuler
Accuracy of Marine Inertial Navigation System(INS) oscillation, 24 hours earth oscillation and Foucault
is mainly dominated by gyroscope. In this paper, a new oscillation that modulates Schuler oscillation and
scheme (Inertial Gyrocompass System) is designed to changes with Latitude. For marine system which
realize high accuracy INS on the basis of low accuracy always works in a long time continuous state, these
float gyros and velocity information of Doppler log. By oscillations must be damped to improve accuracy of
choosing optimal 2-order horizontal damping network INS. HDN (horizontal damping network) can damp
and 1-order azimuth damping network and designing Schuler oscillation, meanwhile the Foucault oscillation
logical damping parameter, the positioning error disappeared.
caused by gyro drift can be eliminated to a large extent.
Computer simulation and experimentations show this
scheme is effective and practicable.

1. Introduction
INS is widely used in many military and civil
scopes because of its ability of independent operation
and high attitude, velocity and position information.
Fig.1 Attitude error curve of INS
The primary disadvantage of INS is that its position In Fig.1, curve 1 is northern-horizontal angle error
error increases with the time[6]. From error analysis of curve of no-damping state, curve 2 is northern-
INS, we can find that gyro drift is the main error horizontal angle error of horizontal damping state
source. That is to say, gyro performance dominates the
accuracy of the whole system. which damping coefficient ( ξ ) is 0.5. From Fig.1, we
There are two methods to improve the accuracy of can find Schuler and Foucault oscillation are all
INS. One method is to develop new inertial sensor and disappeared.
the other method is by using system technology to Constant gyro drift can be compensated accurately
improve the accuracy of INS. By logical choice and by using gyro measurement, but random drift can not
design of horizontal damping network, azimuth be compensated. In no-damping state, random drift
damping network and external velocity error adds the system as a series of impulse, its influences on
compensation in addition, inertial gyrocompass system the system accumulatively. The result is that system
can be realized to eliminate position error to a large error increases with the time.
extent. In order to know the influence caused by random
drift, a linear oscillator which input and output
2. Design of Horizontal Damping Network relationship is equal to relations of gyro and INS errors
(velocity and attitude errors on horizontal axis) is
given to describe the influence[3].
2.1 Analysis of INS error
2-order damping linear oscillator transfer function is:
The most state of INS is no-damping state, because
ω0
INS is designed to work in Schuler condition. In this F ( s) = 2 (1)
state, vehicle acceleration cannot influences on the s + 2ξω 0 s + ω 02

0-7695-3090-7/08 $25.00 © 2008 IEEE 671


DOI 10.1109/WKDD.2008.130
Where ξ is damping coefficient. less than 0.5.
If white noise is added to F (s ) as input, mean 3) The third principle is that HDN must approach one
in order to make platform coordinate follow
square root can be expressed as equation (2) and (3).
geographic coordinate accurately.
πP ⎛ 1 ⎞
e02 (t ) = ⎜ ω0t − sin 2ω0t ⎟ ξ = 0 (2) 4) The final principle is that HDN must make the
2ω0 ⎝ 2 ⎠ system stable. That is to say, HDN should provide
e02 (t ) =
πP ⎡⎛ 1⎞
⎢⎜ n + ⎟ 1 − e (
−2ξω0t
)
+ e −2ξω0t n cos 2 1 − ξ 2 ω0t
positive phase at Schuler angular frequency ω s .
4ω0 1 − ξ ⎣⎝2 n⎠ According to Fig.3, output of α (s ) can be
−e − 2ξω0t
sin 2 1 − ξ ω 0 t − n ⎤ 0 < ξ < 1
2 (3) described by
⎥⎦
R Vy ( s)
Where P is average power per frequency unit. α ( s) = F ( s)ε x ( s) + F ' ( s) (4)
In order to make the expression visually, output of gs R
G(s) g 1
2ω0 e02 / πP is given as Fig.2.
Where F ( s ) = ; G(s) =
1 + H y ( s )G ( s) R s2
G( s)
F ' ( s) = [1 − H y ( s)] .
1 + H y ( s)G ( s)
From equation (4), we can find that F (s ) is not
equal to the closed loop transform function in control
system, it is multiplied by 1 / H y ( s) . So try method is
the unique method to design damping network.
First, comprising between characteristic of HDN and
difficulty of realization, 2-order damping network is
the fist choice, function (5) is a good equation which
Fig.2 Curve of damping linear oscillator can meet principle 3).
From result of Fig.2, we can find that the larger s 2 + ω0 s / p + ω02 ( s + ω5 )( s + ω8 )
damping coefficient is, the smaller mean square root is. H y (s) = 2 = (5)
2.2 Design of horizontal damping network s + ω0 s / q + ω02 ( s + ω6 )( s + ω7 )
The HDN can be realized in three kinds of networks, Using equation (5), F (s ) can be described by:
they are 1-order network, 2-order network and 3-order ω s2 s 2 + ω s2 ω 0 s / q + ω s2 ω 02
F (s) = (6)
network. Considering network and performance and s + ω 0 s / q + (ω s2 + ω 02 ) s 2 + ω s2 ω 0 s / p + ω s2 ω 02
4 3
realization difficulty, is the best choice to damp
In this paper, ξ = 0.5 , ξ = 0.3 , ξ = 0.1 are chosen.
Schuler oscillation[1].
In higher than 2-order system, its damping coefficient
is equivalent damping coefficient. For example, if
equivalent damping coefficient is ξ = 0.5 , the system
closed loop gain should have 1.239dB peak value.
There are magnitude and phase of equation (6):
(ω 2 − ω 02 ) 2 + ω 2ω 02 / p 2
Fig.3 Block chart of signal northern-horizontal axis of INS M ( H ) = H (s) = (7)
Here R is earth radius; ε x is gyro drift of eastern (ω 2 − ω 02 ) 2 + ω 2ω 02 / q 2
axis; ΔA y is original accelerator error; H y (s ) is ω 0ω / p ω ω/q
ϕ ( H ) = arctg 2 2 2
− arctg 2 0 2 2 (8)
horizontal damping network. (ω 0 − ω ) (ω 0 − ω )
Fig.3 gives signal flow chart of INS so as to make And equation (7), (8) are drawn from equation (5)
analysis simply. We should take the following
principle into account during the course of choice: ω5 = −ω0 (1 + 1 − 4 p 2 ) / 2 p , ω8 = −ω0 (1 − 1 − 4 p 2 ) / 2 p
1) The first principle is that the HDN ought to damp (9)
Schuler oscillation with angular frequency 2 2
ω6 = −ω0 (1 + 1 − 4q ) / 2q , ω7 = −ω0 (1 − 1 − 4q ) / 2q
ω s =1.24×10-3(rad/s).
2) During the choice, we should also know that larger (10)
the damping coefficient is, the more influence will From equation (9) and (10), it can be seen that at
be on the system by vehicle. Thus the coefficient is very low and very high frequency

672
M ( H ) ≈ 1 , ϕ ( H ) ≈ 0 ; and at frequency ω 0 , ϕ ( H ) = 0 The magnitude and phase diagrams of H y (s ) and
and M (H ) arrives at maximum value q / p . 3-order HDN H ' ( s ) with both ξ = 0.5 are shown in
According to the final choice principle that the Fig,5.
system must be stabilized, it is expected that H y (s ) The magnitude and phase diagrams of F (s ) and
must be positive phase at Schuler frequency ω s so ω 0 F ' ( s) that H ' ( s ) is introduced into G /(1 + GH ' ) are
must be bigger than ω s , this means p < q . Meanwhile, shown in Fig.6.
in order to assure H y (s ) has real root, p and q must
be less than 0.5.
Try three parameters p , q and ω 0 gradually, and
verify characteristic of equation (6) according to the
second choice principle of HDN, the three parameters
p , q and ω 0 are determined :
p = 0.1410 , q = 0.4150 , ω 0 = 6.2 × 10 −3
Then
ω 5 = 4.308 × 10 −3 , ω 8 = 8.923 × 10 −4 , F (s ) and F ' ( s)
Fig.6 Bode diagram of
ω 6 = 1.164 × 10 −2 , ω 7 = 3.303 × 10 −3 From Fig.5 and Fig.6, it can be find that H y (s ) and
2.3 Horizontal damping network simulation H ' ( s ) have exactly the same characteristic, so it is
verified that HDN H y (s ) is optimal.
2.4 Low damping coefficient of HDN
Using the same method, HDN parameter with
ξ = 0.3 , ξ = 0.1 can also be chosen, the result is:
H 1 y ( s ) ( ξ = 0.3 ):
ω 5 = 3.650 × 10 −2 , ω 8 = 1.157 × 10 −3 ,
ω 6 = 1.273 × 10 −2 , ω 7 = 3.319 × 10 −3
H 2 y ( s ) ( ξ = 0.1 ):
Fig.4 Magnitude and Phase characteristic of H y (s )
ω 5 = 2.668 × 10 −2 , ω 8 = 1.584 × 10 −3 ,
From Fig.4, we can find H y (s ) can satisfy
ω 6 = 1.752 × 10 −2 , ω 7 = 2.450 × 10 −3
principle 1) to 4). In addition, there have a very perfect
The magnitude and phase diagrams of H 1 y ( s ) and
3-order HDN[5] H ' ( s ) with ξ = 0.5 , it can be used to
exam characteristic of H y (s ) H 2 y ( s ) are shown in Fig.7.
The magnitude and phase diagrams of F1 y ( s ) and
( s + 8.8 × 10 −4 )(s + 1.97 × 10 −2 ) 2
H ' (s) = F2 y ( s ) are shown in Fig.8.
( s + 4.41 × 10 −4 )( s + 8.8 × 10 −3 ) 2

Fig.5 Bode diagram of H y (s ) and H ' (s)


Fig.7 Magnitude and Phase characteristic of H 1 y ( s) and H 2 y (s)

673
The same as HDN, ADN would have a good
characteristic if we take the following into account
during the course of choice.
1) HDN in inertial gyrocompass system should
following the former four principles, because
inertial gyrocompass should realize navigation
function.
2) The second principle is that AND ought to damp
earth oscillation.
3) The third principle is that ADN must make the
system stabilized.
Fig.7 Magnitude and Phase characteristic of F1 y ( s ) 4) In order to make the navigation system is less
sensitive to vehicle movement, damping
and F2 y ( s )
coefficient of whole system is also less than 0.5.
According to Fig.9, expression of γ (s ) is
3. Design of azimuth damping network
Rs 2 + gH y ( s )
γ (s) = ε z (s) (12)
3.1 Analysis of system error Rs 3 + gH y ( s ) s + gRΩ cos ϕK ( s )
Although HDN play a good role in damping Schuler Here
oscillation and Foucault oscillation, earth oscillation H y ( s ) = ( s + ω 5 )( s + ω 8 ) /[( s + ω 6 )( s + ω 7 )]
exists. Usually, accuracy of azimuth gyro drift ( ε z ) is
K1 K
lower than horizontal gyro drift ( ε x , ε y ). After INS K (s) = =
RΩ cos ϕK 2 RΩ cos ϕ
enter navigation state, change of azimuth gyro drift can
cause big azimuth error, then latitude error and M1(s) = s4 + (ω6 + ω7 )s3 + (ω6ω7 + ωs2)s2 + ωs2(ω6 + ω7 )s + ωs2ω6ω7
longitude error will increase after azimuth error M 2 ( s ) = s 2 + (ω 6 + ω 7 ) s + ω 6 ω 7
increases[4]. These errors can only modulate by earth
oscillation. Equation (11) give system error caused by M3(s) = s4 + (ω6 + ω7)s3 + (ω6ω7 + ωs2)s2 + ωs2(ω5 + ω8)s + ωs2ω5ω8
εz : Characteristic expression of equation (12) is :
⎧γ = ε z sin Ωt / Ω Δ(s) = s 5 + (ω6 + ω7 )s 4 + (ω6ω7 + ωs2 )s 3 + ωs2 (ω5 + ω8 + K)s 2

⎨δϕ = −ε z (1 − cos Ωt ) cos ϕ / Ω (11)
+ [ω s2 ω 5ω8 + ω s2 K (ω 6 + ω 7 )]s + ω s2 Kω 6 ω 7 .
⎪δλ = ε (sin ϕ sin Ωt − Ω sin ϕ ⋅ t ) / Ω
⎩ z
According to third principle, azimuth damping
From equation (11), it can be seen that azimuth error network must make the system stable. That is to say,
is mainly dominated by ε z . The result of azimuth is to all roots of Δ(s ) are in left middle plane. Using Lawes
cause latitude and longitude error. In order to solve Stabilizing Criterion can solve this problem.
this problem, external velocity information and The Lawes Stabilizing expression is
azimuth damping network (ADN) will be used to
eliminate azimuth, latitude and longitude error. s5 1 ω 6 ω 7 + ω s2 ω s2 (ω 5ω 8 + K (ω 6 + ω 7 ))
3.2 Design of azimuth damping network s4 ω6 + ω7 ω s2 (ω 5 + ω 8 + K ) ω s2 ω 6 ω 7 K
Fig.9 gives Error block diagram of inertial s3 b0 b1 b2
gyrocompass system which involves HDN and ADN.. s 2
c0 c1 c2
By designing optimal ADN, earth oscillation can be
s1 d0 d1 d2
destroyed.
s0 e0 e1 e2

By using ω 5 , ω 6 ω 7 , ω 8 ( ξ = 0.5 ) ,
parameter calculation of Lawes table can be get:
⎧b0 = 3.5432 × 10 −5 − 1.0273 × 10 −5 K
⎪ −11 −8
⎨b1 = 5.9011 × 10 + 1.8990 × 10 K
⎪b = 0
⎩ 2
Fig.9 Error block diagram of inertial gyrocompass system

674
⎧ 1.5271 × 10 −12 − 2.3636 × 10 −10 K − 1.5771 × 10 −10 K 2 δVry εx
⎪c 0 = γ =− + (15)
⎪ 3.5432 × 10 −5 − 1.0273 × 10 − 4 K RΩ cos ϕ Ω cos ϕ
⎪ −11 From equation (15), it can be seen that accuracy of
⎨c1 = 5.9022 × 10 K
⎪ azimuth error is dominated by ε x and δV ry . Thus,

⎪c 2 = 0 high accuracy system can be realized despite of low
⎩ accuracy azimuth gyro.
⎧ 9.0115× 10−23 − 5.9048× 10−20 K − 4.0681× 10−18 K 2 − 3.6179× 10−18 K 3
⎪d0 =
1.5271× 10−12 − 2.3636× 10−10 K − 1.5771× 10−10 K 2


4. COMPUTER SIMULATION
−10
⎨e0 = 1.2280× 10 K

⎪ 4.1 Simulation Condition
⎪d1 = d2 = e1 = e2 = 0
⎩ Initial angle error: α 0 = β 0 =30'', γ 0 = 2';
(13) Initial position: ϕ 0 =42.3°, λ 0 = 121°;
In Lawes table, if we can make sure b0 > 0 , c 0 > 0 ,
External velocity error: δVrx = δVry = 0.0 kn ;
d 0 > 0 , e0 > 0 , then the inertial gyrocompass system
is absolutely stable. Calculation result of equation (13) Gyro drift: ε x = ε y =0.002°/h, ε z =0.004°/h;
is 4.2 Simulation Figure
⎧b0 > 0 ⇒ K < 0.3449 According with the given condition, error curve of
⎪c > 0 ⇒ − 1.50509 < K < 0.006433 azimuth angle error and northern velocity error are
⎪ 0
⎨ shown in Fig.11
⎪d 0 > 0 ⇒ − 0.01612 < K < 0.001392orK < -1.10969
⎪⎩e0 > 0 ⇒ K >0
Then the range of K is 0 < K < 0.001392 .
The optimal value of K should be find from it
choice range. The main criterion is oscillation period
and damping coefficient of the whole system.
Influenced by HDN, the whole system can not reach
the same characteristic as the standard system. We can
only try our best to make the system to approach the
standard system by modulating the value of K .
Fig.11 Error curve of azimuth angle error and northern velocity error
In order to improve the filter characteristic of the
system, K (s ) is usually designed 1-order inertial 4.3 Simulation Conclusion
1) From computer simulation result, it can be find that
network as K ( s ) = K 1 /[RΩ cos ϕ ( s + K 2 )] . Schuler oscillation, Schuler oscillation and Foucault
By continuous modulation of K 1 and K 2 , an oscillation disappeared. That is to say, HDN have
optimal result is given as equation (14): played a good role in damping the horizontal loop
K 1 = 9.02 × 10 −6 , K 2 = 1.64 × 10 −2 (14) of the navigation system.
2) The system has decreased to a large extent after
Fig.10 gives the frequency and time domain
azimuth damping network is imported. This means
output of inertial gyrocompass system.
that azimuth damping network has destroyed earth
oscillation and the result is the increase of system
accuracy.

5. EXPRIMENTATIONS

5.1 Experimentation condition


System: Gimballed Marine Inertial Navigation System
composed by Gimballed platform, float gyro, float
Fig.10 Frequency and time domain output of AND
accelerometer.
According to equation (12), the stable output of γ (s ) is: 5.2 Experimentation Result
1) Swingy experimentation Result

675
7. ACKNOWLEDGMENT
The financial support from National Natural Science
Foundation of China-NSFC under the grant NO.
60474046 and postdoctoral fund of Heilongjiang under
the grant NO.LBR06-147 are all gratefully
acknowledged.

8. REFERENCES
Fig.12 velocity and position error of indoors vibrational experimentation [1] CHENG Jian-hua. Study on the Crucial Technology of
2) Mooring experimentation Result Platform Inertial navigation System. Doctor paper of
Harbin Engineering University, 2006.
[2] Huang, Weiquan, Hao, Yanling, Cheng, Jianhua, Li,
Gang. Research of the inertial navigation system with
variable damping coefficients horizontal damping
networks. Ocean '04 - MTS/IEEE Techno-Ocean '04
[3] Charles Broxmeyer. Inertial Navigation Systems. P185~
P195. 1964.
[4] Broxmeyer, C. Damping an Inertial Navigation System,
in R. E Roberson and J. S. Farrior (eds), “Guidance and
Control,” Academic Press Inc, New York,1962.
[5] Huang De-ming, Cheng Lu. Inertial Navigation System.
Fig.13 velocity and position error of indoors mooringl experimentation Publishing company of National Defence Industry.
3) Voyage experimentation Result P107~P113. 1990.
[6] Wu Jun-wei, Zeng Qi-ming, Nie Li-juan. Estimation of
INS’ Error. Journal of Chinese Inertial Technology.
December 2000.

Fig.14 voyage track and position error of voyage experimentation


Here, dVcx is eastern velocity error, dVcy is
northern velocity error, dphi is error of latitude, dlam
is error of longitude. In addition, external velocity and
position information are provided by GPS receiver
which style is MS860 of Trimble Corporation.

6. CONCLUSION
In this paper, inertial gyrocompass system is
designed to improve positioning accuracy of INS. This
make impossible to realize high accuracy INS by using
low accuracy gyro and moderate log. Theoretic analyse,
computer simulation and experimentation result show
that inertial gyrocompass system scheme is effective
and practicable.

676

You might also like