Professional Documents
Culture Documents
Cheng 2008
Cheng 2008
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
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
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
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.
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