AGARDAG6331
AGARDAG6331
AGARDAG6331
AQARD-AQ-331
LT
n
9
3a
AGARD
ADVISORY GROUP FOR AEROSPACE RESEARCH & DEVELOPMENT
7 RUE ANCELLE, 92200 NEUILLY-SUR-SEINE,FRANCE
AGARDograph 331
'.*
"
e
T FOR DESTRUCTION
This AGARDograph has been sponsored by the Guidance and Conrr~lPanel of AGARD.
AGARD-AG-331
ADVISORYGROUPFORAEROSPACERESEARCH &DEVELOPMENT
7 RUE ANCELLE, 92200 NEUILLY-SUR-SEINE, FRANCE
AGARDograph 331
This AGARDograph has been sponsored by the Guidance and Control Panel of AGARD.
According to its Charter, the mission of AGARD is to bring together the leading personalities of the NATO nations in the
fields of science and technology relating to aerospace for the following purposes:
- Recommending
effective ways for the member nations to use their research and development capabilities for the
common benefit of the NATO community;
- Providing scientific and technical advice and assistance to the Military Committee in the field of aerospace research
and development (with particular regard to its military application);
- Continuously stimulating advances in the aerospace sciences relevant to strengthening the common defence posture;
- Improving the co-operation among member nations in aerospace research and development;
- Exchange of
- Providing assistance to member nations for the purpose of increasing their scientific and technical potential;
- Rendering
scientific and technical assistance, as requested, to other NATO bodies and to member nations in
connection with research and development problems in the aerospace field.
The highest authority within AGARD is the National Delegates Board consisting of officially appointed senior
representatives from each member nation. The mission of AGARD is carried out through the Panels which are composed of
experts appointed by the National Delegates, the Consultant and Exchange Programme and the Aerospace Applications
Studies Programme. The results of AGARD work are reported to the member nations and the NATO Authorities through the
AGARD series of publications of which this is one.
Participation in AGARD activities is by invitation only and is normally limited to citizens of the NATO nations.
Published June
1995
92-836-1018-0
ii
Preface
The need for an up to date, comprehensive treatise on aerospace navigation systems has been recognized by the Guidance,
Control and Navigation community. Such a document will serve as a lasting reference as did material prepared in the late
60s and early 70s. These earlier documents, though remarkably prescient in their technical forecasts, have been overtaken
by very rapidly advancing technology.
This new document should be of interest to those who are involved in the integration of navigation equipment aboard an
aerospace vehicle and who may not be knowledgeable about, but would like to have an experts perspective on the
capabilities and limitations of the various navigation sensors, integration techniques and concepts. In addition, it is expected
that navigation specialists will have an interest in broadening their understanding of aerospace navigation. Great care has
been given to the selection of references to previously published material.
The editor would like to acknowledge Dr. George Schmidt of the Charles Stark Draper Laboratory, who conceived of this
AGARDograph and Ir Pieter Ph van den Broek of Delft University of Technology, who provided many constructive
suggestions in the course of its preparation.
JOHN NIEMELA
U.S. Army Member
AGARD Guidance and Control Panel
Prkface
La communautC Guidage, Pilotage et Navigation reconnait la nCcessitC dun trait6 modeme et complet sur les systhmes de
navigation akrospatiaux. Un tel document servirait de rCfCrence permanente, & linstar des textes Ctablis pendant les annCes
60 et 70. Ces documents, dune prescience remarquable dans leurs prkvisions techniques, ont toutefois CtC vite dCpassCs par
des technologies dont lavancke sest rCvk1Ce trks rapide.
Ce nouveau document devrait intCresser tous ceux qui sont impliquCs dans IintCgration des Cquipements de navigation dans
les vChicules drospatiaux et qui ne connaitraient peut-Etre pas, mais qui aimeraient connaitre, le point de vue dun expert sur
les capacitCs et les limitations des diffkrents senseurs de navigation, des techniques et des concepts dintegration. En outre, il
est privisible que les spCcialistes en navigation voudront Clargir le champ de leurs connaissances dans le domaine de la
navigation akrospatiale. Un soin particulier a CtC apportC & la stlection des rCfCrences qui sont faites aux textes dCj&publiCs.
Le rCdacteur tient i remercier le D George Schmidt du Charles Stark Draper Laboratory, qui a conqu cette AGARDographie,
ainsi que lIr Pieter Ph van den Broek de 1UniversitC de technologie de Delft pour les nombreux conseils positifs quil a bien
voulu foumir lors de 1Claboration du manuscrit.
JOHN NIEMELA
U.S. Army Member
AGARD Guidance and Control Panel
iii
Chief,
Flight Control Systems Branch
WLFIGS, Bldg 146
2210 Eighth St, Ste 11
Wright-Patterson AFB, OH 45433-7521
United States
PB 121
British Aerospace Defence Ltd
PO Box 19
Six Hills Way, Stevenage
Herts SGI 2DA
United Kingdom
TECHNICAL PROGRAMME
Programme Director and Editor: Dr. John Niemela
Department of the Army
Electronics Systems Division
A'ITN: AMSEL-RDC2-TS
Fort Monmouth, NJ 07703-5603
PANEL EXECUTIVE
Lieutenant-Colonel M. Mouhamad, FAF
Mail from USA and Canada:
AGARD-NATO
Attn: GCP Executive
PSC I 16 AE 09777
Tel: 33(1) 47 38 57 80
Telex: 610176 (France)
Telefax: 33 (1) 47 38 67 20/57 99
ACKNOWLEDGEMENTDtEMERCIEMENTS
The Programme Director and the Guidance and Control Panel wish to express their appreciation to all authors who
contributed to this AGARDograph and made its publication possible.
Le directeur du programme et la Commission guidage et pilotage tiennent 2 remercier tous les auteurs qui contribukrent ?
lai
rkalisation et la publication de cette AGARDographie.
iv
Contents
Page
PrefaceJPrCface
iii
iv
SECTION I
1
Introduction
by Dr. J. NIEMELA
SECTION II
Coordinate Frames
by M. KUMAR
I
43
Inertial Navigation
by B. STIELER
45
132
152
Satellite Navigation
by R.B. LANGLEY
158
177
187
200
I
~
Introduction
by Dr. D.F. LIANG
207
210
231
265
281
295
312
329
330
381
390
SECTION VI
Test Methodology
by C.L. HUNT
407
vi
SECTION I
INTRODUCTION
DR. JOHN NIEMELA
U.S. ARMY COMMUNICATIONS - ELECTRONICS COMMAND
RESEARCH AND DEVELOPMENT CENTER
FORT MONMOUTH, NJ 07703-5000
US A
1.
OPERATIONAL REOUIREMENTS
Reliability
Availability
O
Size
Weight
Power
ECM Environment
2.2
Technical Reauirement
2.2.1 Characteristics of
Inteqrated Navisation Systems
In general, an integrated
system will consist of a
number of subsystems, linked
together by means of
interfaces and software that
are located in processors
which may be separate devices
or integral parts of one or
more of the sensors. Each of
the subsystems may be capable
of independent operation under
some conditions but will
benefit by making use of
information derived from other
subsystems. In the primary
mode of operation all
subsystems will be
contributing information to
the integrating computer and
the resulting total system
will have greater accuracy
than any individual subsystem.
An important aspect of the
integration is that many of
the deterministic errors of
the subsystems may be
calibrated during the
integration process by cross
comparison of the subsystem
outputs. This has the effect
that when one or more
subsystems become nonoperative, e.g:, due to
terrain screening, the other
systems may continue at a
higher level of accuracy than
would otherwise be possible.
The accuracy will degrade
slowly, depending on the
variability of the calibrated
error sources, rather than
suddenly as would occur with
an uncalibrated sensor. When
operation of the missing
sensor is restored, the system
will once again return to full
operation.
Generally, an operational
requirement will give general
descriptions of the scenarios
of operation and the desired
mission capabilities of an
aerospace platform. An
integrated navigation system
will have various modes of
operation which will react in
various ways to the particular
environment in which they
operate. It is therefore
necessary that the operational
requirement state prospective
missions in some detail, and
to define the requirements for
the navigation system for each
stage of the mission. The
technical requirement must
translate the several mission
capabilities and environments
into technical capabilities
and parameters on which a
system design can be
developed.
For instance, the initial part
of a sortie may be carried out
under benign conditions during
which time the integrated
system is able to calibrate
the sub-system error sources.
Knowledge of the duration of
this period is important in
determining the accuracy to
which the errors may be
calibrated. The sortie may
then continue with a low level
penetration in rugged terrain
I
~
2.2.4
Affordability
Inteqritv Aspects
O
The system reliability
and maintainability
requirements.
The characteristics of
each flight segment in terms
of:
- The integrity
requirements at each segment,
including the allowable
degradation in function
performance
3.
SUMMARY
C
C
1
l
SECTION I1
COORDINATE FRAMES
Muneendra Kumar
Defense Mappinq Aqency
8613 Lee Hiqhway
Fairfax, VA 22031, USA.
INTRODUCTION
3
The ECI (or CIS) transformation to the
ECEF (or CTS) frame makes use of the new
theories of precession [1,2], astronomic
nutation [ 3 , 4 , 5 ) , change to a new 52000.0
Standard Time Epoch (21, the new definition of Universal Time as defined and
adopted by the International Astronomical
Union (IAU) [6,7], and the latest ECEF
frame, viz., World Geodetic System (WGS)
1984 [e].
In the discussion that follows, all
(1)
BE(1950.0) = 1900.O+(JED-2415020.3)(2)
365.24219878
The correspondence between the six
different epochs of BEs and JEs and the
matrix (M) to transform precessing position and velocity components from BE to
JE, as computed through equation ( 2 ) , are
also available in [2].
4
4 . 1 General
The transformation of position components from the CIS (or mean ECI system of
epoch) to the true ITS (or ECEF) system
(Figure 1) requires formation of three
matrices, viz., the general precession
matrix [D], the astronomic nutation matrix
[C], and the sidereal time matrix [B]. The
starting epoch J2000.0 is defined at noon
time on 1 January 2000 (Section 3.3).
Txl
1x1
[Dl
XI
[DIT X,
(5)
(6)
x,
[Cl
x,
(7)
X,
[C]' x,
(8)
x,
x*
[el x,
x4
[AIT X,
(9)
6.1 General
(10)
vector form:
5.1 General
6.2 Realization
a (1-f)
e2
(a2 - b2)/a2
2f - f2
(13)
(15)
R2
tan I$
(1 - e2) tan 4
(17)
12
(20)
WO
(21)
point.
For some practical applications, the
geoid, defined as above, is approximated
by the mean sea level (msl) at 1 to 2
meter accuracy level along the coast lines
and over the ocean areas. Under the
continental land masses, the hypothetical
extension of msl is sometimes used as an
approximation for the geoid.
It may be necessary to clarify here
that msl is not an equipotential surface.
By definition, msl is the averaae or mean
of hourly sea level surfaces obGerved at a
point (or tidal benchmark) over a period
of 18.67 years. However, all msl surfaces
so determined in different parts of the
world differ in definition and also do not
belong to a common zero reference.
In a mathematical sense, the geoid is
defined (or realized) as so many meters
(m) above ( + N) or below ( - N) the
reference ellipsoid, the geometric figure
of the earth (Figure 8). Figure 9 depicts
one version of the WGS 84 geoid as a
contour chart with respect to the WGS 84
ellipsoid.
NOTE: More detailed contour charts or
denser grid values of the WGS 84 seoid
with absolute accuracy ranqe of f - 2 to 6 m
are now UNCLASSIFIED and available).
The distance of any point P from the
actual physical surface of the earth to
the geoid (Figure E), measured along the
direction of gravity or plumb line is
called the orthometric height (H) of P. If
P is above the geoid, the H is positive
and, if below the H is negative. 3
practice, the height H is also approximated by elevation above or below the msl.
6 . 4 Relationship Between h, H I and N
13
(22)
(23)
<
-sin&inA
cos1
0
1](25)
cost$]
CTS
or
(27
J
CTS
1 i:]
Cll
c12
13
C2l
c22
23
31
32
33
14
c,,
c,,
C,,
c,,
C,,
C,,
c,,
c,,
c,,
=
=
=
=
=
=
=
=
=
-cosasin),
cosacosi
cosQsina
sinasinli
-sinacosi
cosQcosa
cosQcosi
cosQsini
sin6
- sinasinQcosli
- sinasinQsinl
- sinQcosacosl
- cosasinQsinli (29)
'33
c32/c31
c13/c23
"
li "
li
h
N (meters)
+ T)/cos Q
(31)
8.1 General
(Step# 2) (AX,AY,AZ)
16
4.
5.
6.
7.
8.
9.
9.1 General
In the present era of aviation over
long distances, it is very important to
use correct units. Unit measures of meter
and foot can be significantly different
(Table 10) and thus should be used with
caution.
9.2
Units of Length
10 REFERENCES
1.
2.
17
I,
18
North Ecliptic
Pole (NEP)
Winter
Solistice
z1
Celestial Equator
19
5, e , z
7 toQ
0
Q to P
= Precession Parameters
= 9OO-L
= Angle Between Equators
- (90' + Z)
20
21
I I Z 2 Axis
II CEP
I4
I
I
I
/Or
z;p
Mean EqJator
Date
True Equator
<
of
Date
(Ito CEP)
Ap = Nutation in Right
Ascension
AV = Nutation in Declination
tanAp= tanAV c o g
sin AV = sin A y sinE
E:
22
11 CEP or Z 4Axis
11 CEP or Z
Axis
h = O
at
Oh UT1
h =
oo
at
Timet
A =Ho+ AH+o*(t-'At)
o * = 0 8+
23
24
WGS 84
BIH-Defined
Zero
Meridian
(1984.0)
Earth's Center
- of Mass
WGS 84
Analogous to the BIN Defined Conventional Terrestrial System (CTS) , or BTS, 1984.0.
25
I'
Separation
-N
26
?
5!
::
8
n
0
.
P
n
0
0
n
n
0
P
0
n
0
n
N
L
P
0
n
n
n
n
n
n
n
n
..
n
n
n
t
n
0
n
n
N
n
n
n
c
n
.
n
. . . . .
. .
21
Z
4
28
Geodetic
{ meridian of P
29
N', U).
a =alpha
E'
30
A'
= Astronomic
Latitude
= Astronomic
Longitude
E"
31
Table 1.
The Sidereal Time Equations **
A = Ho +AH + w*(t-At)
+ 0.093104 T,'-
6.2 x
Where,
T =du/36525
U
d = JED - 2451545
U
= True Obliquity
A y = Nutation in Longitude
t
At = UTC -UTI
(Radians/Second)
Ti
32
Table 2.
The Precession Equations *
g"
= 2306.2181 T + 0.30188 T
Z"
e"
2+
0.017998 T
Where,
Note:
Table 3.
The Precession Transformation Matrix
[Dl = R [- (90+2)] Rx (e) R [90-g]
z
[Dl =
sinz sing
- cosz
+ cosz sing
- sinz sine
sine cosg
- sine sing
cose
sine
33
Table 4.
The Astronomic Nutation Equations And Arguments
- 46.8150
= E,
+ AE
= E
= [ JED - 24515451/36525
= d/36525
= Julian Centuries from Epoch J2000.0
A y = Nutation in Longitude
106
106
=x (A + B . T ) Sin(alik' + a2i.!j''
i=1
F +a
3i
4i
as, n)
I
AE = Nutation in Obliquity
106
=z
i=
1
106
=E
i=l
li
k' +
a .F
31
a .D
41
a,,n)
I
34
Table 4 (Contd.).
The Astronomic Nutation Equations and Arguments
e
el
31.310T
0.064T
= 1287099.804
F =
=
D =
=
R =
=
ArcSeconds
Arc Seconds
Arc Seconds
335778.877 + (1342r + 295263.137)T - 13.257T + 0.01 1T
(Mean Longitude of Moon) - R
r
2
3
1072261.307 + (1236 + 1105601.328)T - 6.891T + 0.019T ArcSeconds
Mean Elongation of Moon From Sun
r
2
3
450160.280 - (5 + 482890.539)T + 7.455T + 0.008T
Arc Seconds
Longitude of Ascending Node of Lunar Mean Orbit on
Ecliptic Measured From Mean Equinox of Date
T = (JED - 2451545)/36525
lr = 1296000"
35
Table 5.
1980 IAU Theory of Nutation
Series for Nutations in Longitude (AV) and Obliquity (AE)
(See Table 4)
i a i a 2 a 3 a4 a5
1 0 0 0 0
2 0 0 0 0
3 - 2 0 2 0
4 2 0 - 2 0
5 - 2 0 2 0
1 - 1 0 - 1
6
7 0 - 2 2 - 2
8 2 0 - 2 0
2 - 2
9 0 0
1 0 0 1 0 0
0 1 2 - 2
11
12 0 -1 2 -2
13 0 0 2 - 2
2 0 0 - 2
14
2 - 2
15 0 0
1 6 0 2 0 0
1 7 0 1 0 0
0 2 2 - 2
10
19 0 - 1 0 0
2 0 - 2 0 0 2
2 -2
21 0 -1
22 2 0 0 - 2
23 0 1 2 - 2
1 0 0 - 1
24
25 2 1 0 - 2
26 0 0 - 2 2
27 0 1 -2 2
2 8 0 1 0 0
2 9 - 1 0 0 1
30 0 1 2 - 2
31
0 0 2 0
3 2 1 0 0 0
0 0
2 0
33
3 4 1 0 2 0
35 1 0 0 - 2
36-1 0
2 0
3 7 0 0 0 2
3 0 1 0 0 Q
39-1 0 0 0
4 0 - 1 0
2 2
4 1 1 0 2 0
4 2 0 0 2 2
4 3 2 0 0 0
1 0
2 - 2
44
4 5 2 0 2 0
4 6 0 0 2 0
47-1 0 2 0
4 8 - 1 0
0 2
1 0
0 - 2
49
50-1 0 2 2
1 1 0 - 2
51
5 2 0 1 2 0
0 - 1 2 0
53
1
2
1
0
2
0
1
1
2
0
2
2
1
0
0
0
1
2
1
1
1
1
1
0
0
1
0
2
1
0
2
0
1
2
0
2
0
1
1
2
1
2
0
2
2
0
1
1
1
1
0
2
2
Units: A
i
~
a i a 2 a 3 a 4 a5
2 = 0.0001"; B = D 0.0001'
0
0
0
2
0
2
0
2
0
2
0
0
- 1
0
2
0
2
1
0
0
-2
0
0
0
1
0
0
2
- 1
2
-1
2
0
0
0
0
0
- 1
1
0
0
0
0
0
0
0
0
Q
0
1
0
0
0
-1
0
0
0
0
0
0
1
-1
0
0
1
2
2
- 2
2
2
- 2
-2
0
0
- 2
2
0
2
1
1
1
1
0
1
0
1
0
0
0
2
0
0
0
2
2
-0
6
6
-6
-7
6
-5
5
-5
-4
4
-4
0.0
0.0
3
0
0.0
0.0
0.0
-3
0.0
0.0
0.0
3
3
-3
3
0
3
0
0
0
0
0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
1
1
1
1
-1
1
-1
1
0
-1
-1
0.0
0.0
-3
3
-3
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
2 - 2
2
2
2
4
4
0
0
-2
2 - 2
2
2
0
2
4 - 2
2 - 2
2 - 2
2
0
0
2
-2
0
2 - 1
0
2
2
1
2
2
-3
-2
-3
-3
2
-2
2
-2
2
2
1
-1
1
-2
-1
1
-1
-1
1
0.0
1
2
1
2
2
0
1
1
1
2
0
1
-1
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
2
0
2
2
2 2
2
0 2
2
-2 1
0
0 1
0
0 2
0
0 0
2
1
2
0
0 2
0 - 4 0
2
2 2
2
4 2
0
-1
1
1
-1
1
1
-1
-1
-1
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
-1
1
0
-1
1
1
0
0
-1
0
0
0
0
0
0
0
0
0
0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
0.0
36
Table 6.
The Astronomic Nutation Matrix
- sinby
- sinAy cosi
cosAy
sinby
sinE sinAy
- COSE sinE
sine sing
Table 7.
The Sidereal Time Transformation Matrix **
[BI =
61=
cosA
sinA
- sinA
cosA
-a' sinA
-0'
Cosh
a' COSA
--o'sinA
sinE
sinE cosE
+ COSE COSE
31
Table 8.
The Polar Motion Transformation Matrix
38
r(
aa
'
40
01
I
(D
0
4
0
0
0
0
In
4
\o
\o
In
4
+I
+I
+I
*E
4
r(
+I
+I
+I
0
-4
r(
In
a
a
'p
c,
.I.
-4
a
a
rl
In
rl
In
0
0
(v
rl
(U
fi
(v
-4
U
ul
k
0
w
OD
rn
t,
a,
m
*
0
NI
5k
0
\o
OD
rn
0,
-4
k
7
c,
m
Q,
rl
a,
U
a : :
>
c
c3
k
Q,
c,
Q,
-4
c r l
oa,a
E d E:
w
0
a
C O ,
ow k
-4
0 a,
a
k
a
PI
t3
E:
-4
7
t,
II
E+>
39
Table 10
Derived Parameters and Conversion Factors
Derived Constant
Notation
Value
Geometric
Flattening
1/298.257223563
(.00335281066474)
Semi-Minor Axis
6356752.3142 m
First Eccentricity
Squared
e'
0.00669437999013
Physica1
Ellipsoidal Gravity
or Geoidal Constant
U, or
WO
ye
y,
ym
62636860.8497
m2 s-'
9.7803267714 m s-'
9.8321863685 m s-'
9.7976446561 m s-'
Conversion Factor
1
1
1
1
Meter (m)
Meter (m)
Int'l Foot
US Survey Foot
=
=
=
=
=
=
=
= 299792458
s-l
40
Table 11
Relationship Between Rectangular and Geodetic Coordinates
A.
Geodetic to Rectangular
(RN + h) cos4 cos1
{RN (1 - e) + h} sin4
where,
B.
Rectangular to Geodetic
tan- (Y/x)
41
Table 12
The Standard Molodensky Transformation Equations
- Local Geodetic Datum to WGS 8 4 THE MOLODENSKY EQUATIONS:
The corrections (A$,Al,Ah) for transforming local datum
geodetic coordinates (4,l,h) to WGS 8 4 are:
AX siq$ cosl - AY sin4 sinl +AZ cos$
+ Aa(R,e sin$ cos$)/a + Af { R, (a/b)
+ R, (b/a) } sin$ cosl$ ]
[ (R, + h) sin 1" 1-
A$
= [-
AA.
= [ - AX sinl + AY cosl 3
[ (R, + h) cos$ sin 1"
Ah
I-'
where,
AX,AY,AZ are
and WGS
4,l,h (to be
are the
NOTE:
2 . As
43
SECTION I11
NAVIGATION TECHNOLOGY
INTRODUCTION
DR. JOHN NIEMELA
44
45
Inertial Navigation
B. Stieler
DLR, Institute for Flight Guidance
Postfach 3267
W-3300 Braunschweig
GERMANY
1. Introduction
The development of this technology is truly exciting. It took place primarily in Germany, the United States and the former Soviet
Union [Gi 71, So 76, Ma 901.
The gyrocompass indicating true north on a moving base as on ships can be regarded as the beginning of inertial navigation. The
first seaworthy instrument was built by Anschutz with contributions made by Max Schuler and Albert Einstein and installed on the
fast steamer "Imperator" in 1913 [Sc 621.
At the end of World War I the allies had in the Treaty of Versailles imposed restrictions to Germany for the maximum size of
ships to be built. The so-called "vest-pocket battleships" were much more exposed to heavy seas than their bigger counterparts.
These restrictions promoted in this country gun stabilization and inertial technology in general, which culminated at the end of
World War 11 in a functioning air-supported gyrocompass with electronic Schuler tuning for the "One-Man Submarines", in the V2
guidance system and a true concept for an inertial navigation system (INS) [Gi 711. After the war the development of this
technology was taken over by the superpowers, the United States and the former Soviet Union [Ma 901.
The functional diagrams for a platform INS and for a so-called "strapdown INS (SDS)" are shown in Figs. 1.1 and 1.2. "Strapdown"
comes from the fact that the sensors of the SDS are strapped down to the vehicle. Both figures show us that the inertial
navigation system (INS) provides all information about the kinematics of a vehicle, namely attitude and heading, ground speed and
position, and also angular rate and acceleration independent of any sources of reference from outside. No question about its role
for military aviation, marine navigation and for missiles! A high inertial technology is nowadays a trademark for military
independence of many countries. Inertial navigation is also widespread in use in civil aviation and in space flight. Any large civil
aircraft is equipped with tvm or three inertial navigation reference systems. The advent of the "Global Navigation Satellite System
(GNSS)" will in principle not change this situation in the time to come, especially under the consideration that a solution for its
undisturbed availability in times of strained political situations for the countries running the system is not yet in sight.
Since the whole chain of information on the vehicle motion is contained in the INS output, these systems are also used as
measuring instruments in flight tests and in other cases where accurate angle, velocity and position measurements have to be
carried out in a difficult dynamic environment. Inertial sensors and systems are used above, on and under the ground. Examples
are land surveying, borehole measurements, pipeline inspection in the Arctic and inspection of the tracks for highspeed trains and
automobile tests, to name only a few.
Recent achievements in the high accuracy flight tests of "Microwave Landing Systems (MU)"[Hu 741 and the high accuracy
landing guidance of aircraft [Ja 901 are based on outputs from inertial systems which, together with outputs from other sensors,
were combined into optimal information on attitude, velocity and position.
This draws attention to one aspect which, among others, should be one of the conclusions from this contribution. Like all technical
instruments an INS has its specific error behaviour which is, however, of different nature compared to those of satellite and radio
aids (e.g. GNSS, VOR/DME, TACAN, radar, laser tracker, Doppler radar, U).An optimum of information can be obtained by
using information from different sources. In this respect mathematicians have provided technicians with a fairly efficient tool in
the form of the Kalman filter algorithms [Ka 601. The above mentioned achievements in precision navigation and flight testing
have been obtained through the contribution of engineers in the form of hardware and of mathematicians in the form of software.
The advantage of blending INS data with those of different sources lies in the fact that the levels of information on angular rate,
acceleration, attitude, heading, ground speed and position are connected in the system in a mathematically strict sense as to be
seen from Figs. 1.1 and 1.2. Aiding the system by means of external references on the velocity level (e.g. Doppler radar) or
position level (e.g. GNSS, VOR/DME), also increases the accuracy for the other levels. In Fig. 1.3 it is shown that the Kalman
filter estimates the systematic INS errors down to the levels of gyro drift and accelerometer bias, i.e. based on the external
measurements, an in- flight INS calibration is carried out by this algorithm. After a sufficient calibration time periods of missing
external measurements are bridged with only slowly growing system errors. This is the reason why systems for high-accuracy
simultaneous measurements of velocity and position or attitude and velocity, or even the three states together, are always
centered around an INS. It is also advantageous to use an INS in those cases when the high-accuracy measurement of position is a
main purpose of the test as indicated above with the example of MLS testing.
This chapter is arranged in the following train of thoughts. The directional reference in an INS is explained with the mechanical
gyro and stabilized platform as examples. It is symbolized by the weathercock in the functional diagram for a platform INS in Fig.
1.1. The characteristics of the gyrostabilized platform as directional reference serve to visualize the characteristics of the
"analytic platform" in the navigational computer of modern strapdown systems. Again this is symbolized by a weathercock in Fig.
1.2, the functional diagram for a strapdown system. Directional references and their error characteristics are discussed in Section
2.
Accelerometers as sensors for measuring the translational motion are fairly simple instruments in principle, but the formula for
their output signal on the rotating earth is lengthy and it is the basis for programming the navigational computer of an INS. These
aspects are treated in Section 3.
The integration of the accelerometer signal to ground speed and position and the control or computation of the directional
reference is subject of the navigational computer. The interlinking of all signals within an INS causes error characteristics more
benign than we would expect from our school learning. This is subject of Section 4. Also the INS for worldwide navigation, common
features and differences of all mechanizations are discussed. The goal is to derive the error model appropriate for integrating the
INS with the other sensors and systems discussed in this book.
The main part of this chapter contains only general outline which are essential from the system point of view. Special features as
coordinate systems for inertial navigation supplementing the chapter "Navigation Coordinate Systems", digital data processing Of
inertial signals especially in strapdown systems, and optical gyros are treated in the appendices which are named correspondingly
with C, D and 0.
An excellent textbook about the material covered in this chapter was written by the author's teacher and friend at MIT, the kite
Kenneth R Britting, Sc. D [Br 711.
46
---------Navigation Computer
h
h
f rm
altimeter
horizontal and
p o i it ion
(:$
groundspeed
attitude,
heading
T=
04 min
24 hour o s c i l l a t i o n
llaviqation Computer
49
\f;l
acceleration
24 hour oscillation
F i g . 1 . 4 . 8 Functional Oiaqram of an I n e r t i a l Navigation System (Strapdown System)
47
INS
Optimal'.Estimates on
Angular Rate
Gyro Drift
Acceleration
Accelerometer Bias
P
Ground S eed
>
Kalman
Filter
1
Position
Position Error
Position
Reference
Fig. 1.3 Aiding an Inertial Navigation System on the Position Level with the Use of a Kalman Filter
Literature Chapter 1
[Hu 74) Hurrass, R, Stieler, B.: "Zum Einsatz des hybriden FlugmeDsystems bei der Vermessung eines Mikrowellenlandesystems."
Proceedings of the DGON Symposium Gyrotechnology, Braunschweig 1976
[Ja 901 Jakob, Th.: "Integrated System for Automatic Landing Using Differential GPS and Inertial Measurement Unit."
Proceedings of Second International Symposium on Precise Positioning with the Global Positioning System, Ottawa, Canada 1990
[Ka 601 Kalman, RE.: "A New Approach to Linear Filtering and Prediction Problems".
Journal of Basic Engineering (ASME), Vol. 82 D, pp. 35-45, 1960
[Ma 901 MacKenzie, D.: "Inventing Accuracy - A Historical Sociology of Nuclear Missile Guidance."
MIT Press, Cambridge, Mass., USA, 1990
[Sc 621 Schuler, M.: "Die geschichtliche Entwicklung des Kreiselkompasses in Deutschland." VDI-Zeitschrift, Vol. 104, No. 11, pp.
469 - 508, 1962
[So 761 Sorg, H.: "From Serson to Draper - Two Centuries of Gyroscopic Development."
Proceedings of the International Navigational Congress 1976, Boston, Mass., USA
48
2. Directional References
2.1 T h e Mechanical Gyro a s Directional Reference
Mechanical gyros and gyro-stabilized platforms are the classical directional references in moving vehicles. Once their functioning
and their error behaviour is well understood, it is not a major step to see the common features and differences to strapdown
systems whose directional reference is called "analytic platform".
We will look at the mechanical gyro and platform in this chapter from the system point of view only, i.e. exclude major design
specifics, high frequency characteristics and other details. The reader interested in these details is referred to the literature v r
69, De 70, St 821.
The rotating wheel is the sensing element of the mechanical gyro. To describe its characteristics mathematically, we define the
angular momentum vector in the gyro element-fixed coordinate system shown in Fig. 2.1:
This vector is dominated by H, , the rotor's angular momentum about the spin axis, whose magnitude is estimated from:
(2. 2)
H = 1.w
with I = rotor's moment of inertia about the spin axis, which for a ring and the measures of Fig. 2. 2 is:
(2. 3)
w = 2 n f and f
(2. -5)
1.046 IO-' N m s.
Gyros mounted on a platform of an inertial navigation system (INS) have an angular momentum of this magnitude, since they
stabilize the platform and rotate with respect to inertial space very slowly about their sensitive axes, i.e. the axes perpendicular to
the spin axis. Gyros in a strapdown INS are hardmounted to the aircraft and and have to be tor ed about these axes
corresponding to the aircraft maneuver. Since the electric power for torquing is proportional to H , their rotor angular
momentum is lower by 1 order of magnitude.
Y '
Because of the high magnitude of the rotor's angular rate and momentum about its spin axis, we can neglect the maneuver
dependent components and approximate the total angular momentum vector by:
(2. 6)
= (0
H)T.
El
wig
x .H
main contributor
"technical gyro
equation"
causing interior
gyro dynamics
"nutation" for instance.
The z-component of this equation is of no interest, since it expresses: motor torque E friction torque.
In the low frequency range the gyro characteristics are described solely by the "Technical Gyro Equation":
(2.8a)
M E w x H ,
and in components:
49
G y r o Element G i m b a l
Rotor
Rotor Drive
Spin Axis
50
The Technical Gyro Equation can be interpreted by the "Rule of Spinvector Alignment" illustrated in Fig. 2.3.
'Rule of Spinvector Alignment"
T h e gyro r e a c t s t o a disturbance vector M or o in such a way t h a t i t s angular momentum vector
will align itself with t h e disturbance vector M or U following t h e s h o r t e s t path
H applied:
w applied:
D i r e c t i o n o f response angular r a t e :
H vector i s "hunting" the i n p u t
torque vector! caused by mass m
D i r e c t i o n o f response toraue:
a c t s so as t o take the H vector by the shortest
way towards the input aiigular r a t e vector
For the derivation of the block diagram of Fig. 2.4a for such an instrument we introduce in Eq. 2.8b:
(2.9)
6 ig
with Big = the spin vector's angle with respect to the inertial reference. For small angles Oig can be regarded as a vector.
The torques on the gyro rotor comprise:
- the command torque M' a lied through the gyro torquer mounted at the gimbal axes and
- the disturbance torque MfPdiscussed below.
Instead of the torques we introduce the corresponding angular rates due to the "Technical Gyro Equation":
(2.lOa,b,c)
M d = d x H ,
M' = o' x H,
M = M ' + M d
with w ' = command rate vector and d = gyro drift vector. Bearing this in mind we may derive from Eqs. 2.8 and 2.9:
(2.11)
dig
0'
+ d.
The corresponding block diagram of the gyro as directional reference with respect to inertial space is shown in Fig. 2.4b.
The inertial-fixed reference direction is now replaced by the reference direction in question (index r). For navigational purposes i t
is the earth-fixed reference direction (index r = n) with its components x = north (N), y = east (E) and z = down (D) (s.
Appendix C, Fig. Cl). For missile control the reference direction often is the line of sight (LOS, index r = I). For the
corresponding block diagram we split up oIg:
(2.12)
with
olg
Laer
T'T
org
earth rate
transport rate
misalignment rate =
We thus obtain for the rate of change of the misalignment of the gyro spin axis with respect to the reference direction:
(2.13)
+ d -
mir.
51
'
*
acceleratio
-b
I
I
attitude,
heading
Figure 2.4 Block Diagrams of the Mechanical Gyro a s Directional Reference with Respect to Inertial Space (a,b),
with respect to North, East and Down (c) and Functional Diagram of the Directional Reference on a Moving Base (d).
52
The block diagram illustrating this equation, i.e. the use of a PO as directional reference on the earth is shown in Fig. 2.4~.We
have combined @ I r = U'" + onrwith ole = earth rate and o = reference direction rate with respect to the earth.. The small
has its components with respect to north, east and down ( S . Appendix C, Fig. C 4).
angle misalignment vector e = (eN cE
The gyroscopic directional reference with respect to the navigational frame on a moving base is finally illustrated in Fig. 2.4 d.
The integrator with its 3 input signal vectors is the representation of the gyro - or the gyro-stabilized platform as we will in the
next section. For proper functioning (eng-+0) this input has to be kept close to zero as indicated in this figure. It also shows as
dotted lines the mechanical linking of the gyro to the base via the gimbal axes. Synchros mounted to the gimbal axes allow to
measure attitude and heading of the base (aircraft, missile) with respect to this reference direction.
With the torquing signal o t in Fig. 2 . 4 ~being zero, d t cain cause the gyro spin vector to deviate from its initial direction. This is
also true for U' = d = 0 and for a geostationary gyro with,its spin vector initially slightly misaligned with respect to the earth axis
and as shown in Fig.2.5. The component: of earth rate ole in t h e gyro coordinate frame (index g) cause this sensor to carry out
the motion expressed through Eq. 2.13: E = - oICand illzstrated in this figure. We will come back to the analysis of this motion
I
Figure 2.5 Motion of the Geostationary Gyro on the Rotating Earth
For inexpensive directional references of lower quality as the vertical gyro (VG) and the directional gyro (DG) the excursion of
the misalignment angle with respect to the reference plumb line or to the reference magnetic north is measured by additional
sensors and is driven close to zero by means of control loops to the gyro torquer as indicated in Fig. 2.6. Fig. 2 . 4 ~may be used
for the derivation of the block diagrams in Fig. 2.7 where instead of the currents fed into the torquers the corresponding
command rate vectors U' are shown. In the case of the vertical gyro (VG) bubble levels sense the horizontal misalignment
components ch. In the case of the directional gyro (DG) a magnetic compass (flux valve, flux gate) measures eD. Though the long
term directional reference is provided by the additional sensors, they cannot be used without a gyro. The reference direction
sensors are too much affected by the aircraft maneuvers. The gyro's task is to avarage the high frequency components of the
sensor's measurements. The following torquing rule applies for these instruments:
(2.14a)
of
- e.
In the case of an INS the misalignment angles are kept close to zero by the following torquing rule:
(2.14b)
Ut
i.e. by the computed s u m of earth rate and transport rate (s. Section 4.2).
The so-called "Attitude and Heading Reference System (AHRS)"is settled in its accuracy as directional reference between the
VG/DG and the INS. They are mechanized like an INS but equipped with inertial sensors of lower quality. For high quality
attitude and heading indication they are aided by external sensors; in their most simple realization they are slewed to magnetic
north by means of a flux valve, for instance, as it is done in the DG.We will come back to the AHRS in Section 6. Table 2.1 shows
the achievable accuracy for attitude and heading, i.e. the uncertainty range of the misalignment angles eN,E,Dfor all three
applications.
VG
horizontal misalignment
(plumb-line error)
vertical misalignment
(heading error)
eE
fdcgI
DG
.4l)
AHRS
.25
3+6a
1t6u
INS
.os
.4
') unaccelerated flight; 6u = deviation t variation; deviation = difference between magnetic north and true north variation =
difference between indicated north and magnetic north (s. Chapter "Magnetic Heading References").
53
synchros
rotor
bubble
levels
heading
synchro
torquers
Principles of
remote magnetic
compass
DirectionaI Gyro
Vertical Gyro
vertical gyro
V h
.
accelero-meter
K,
directional gyro
(index h = horizontal)
Figure 2.7 Control Loops for the Directional Gyro (CG) and the Vertical Gyro (VG)
54
As already mentioned, the VG's and DG's as fairly simple directional references are characterized by the fact that the gyro rotor
has a high angular freedom with respect to the case - the angle between the rotor and the case being the aircraft's attitude or
heading angle, for instance. Mechanical gyros for platform stabilization or angular rate measurements, shown in their principles in
Fig. 2.8, have a very low angular freedom. The "DynamicallyTuned Gyro (DTG)" [St 821 is the modern version of such a sensor.
As to be seen from Fig. 2.8, one "Two-Degree-of-Freedom Gyro (TDF gyro)" can be used for stabilizing two axes.
The mechanical gyro for platform stabilization is a nullsensor. The angle Elcg = 0 (pickoff angle) between the rotor and the case
(subscript c) is closely held to zero by means of a control 1.00~for properly slewing t h e case and platform. For the derivation of
the block diagram for the TDF gyro in Fig. 2.9 we split up w'g in the Technical Gyro Equation 2.8 :
(2.15)
= @ic +
+ 6cg
and solve it for the components of 6. We introduce wiC = o for the input rate of the case with respect to inertial space. Due to
the transfer function to be seen in Fig. 2.9:
the TDF gyro is often called "free rotor gyro (FRG)". We have put in this relationship p =
o dt.
As to be seen from Fig. 2.10, the control loops for stabilizing the two axes of a platform connect the gyro pickoff output signals 0
via electronic networks F to the servo motors SM mounted on the gimbal axes parallel to the pickoffs. Since both axes of the TDF
gyro can be regarded as uncoupled (s. Fig. 2.9), the block diagram for only one axis is shown in Fig. 2.11. We will use this for
discussing the characteristics of the gyro-stabilized platform.
Three major subsystems are to be seen in this block diagram: the gyro, the electronics and the platform. The input into the latter
one is the output current from the electronics. It is converted into a torque in the servo motor with the gain StM:The torquer
time lag has been neglected. Disturbance torques M Y acting on t h e platform are due to friction in the gimbal bearings or due to
mass unbalance of the platform, for instance. Both torques move the platform against its inertia. The platform output angular
rate o ' p with respect to inertial space is sensed by the gyro.
From the system's point of view we are only interested in the low frequency response of the gyro-stabilized platform, for which the
inputs into the integrators of the block diagram must be zero.
At first we assume a disturbance torque M Y is acting on the platform and no command or disturbance torques M', Md are acting
on the gyro. Since for quasistationary conditions the input into the gyro as integrator must remain zero, this disturbance torque is
compensated by a servomotor torque i; St', with the current generated by the control loop.
With similar arguments we can see, that a in the low frequency range command or disturbance torques acting on the gyro rotor
are compensated by a gyroscopic torque 0; H, i.e. by a corresponding rotation of the platform. Making use of Eq. 2.10, we obtain
as Performance Equation of t h e Gyro-Stabilized Platform:
(2.17)
o'p
0'
which, in principle, is identical to Eq. 2.11 for the free gyro. This is not surprising, since the stabilization loop slews the platform
with respect to the rotors of the 3 orthogonal gyros and t h e gyro-stabilized platform can be regarded as an ideally supported 3axis gyro. Figs. 2.4 b to d can thus also be used for the representation of t h e gyro-stabilized platform in a block diagram or a
functional diagram.
Stabilization of a 3-axis platform requires the use of 3 SDF gyros, as shown in Fig. 2.12 or 2 TDF gyros. In the latter case one
gyro axis is redundant and often is used for fault detection, i.e. for checking whether the platform truly moves according to the
command rate vector applied to the 3 gyro axes.
Fig. 2.12 shows 2 platform mechanizations, the "three- gimbal platform (TGP)" and the "four-gimbal platform (FGP)". The latter
is a prerequisite for flight maneuvers, when the aircraft attitude passes a 90 pitch angle.
The definition of the Euler angles for roll, pitch and yaw for describing the aircraft's attitude and heading is given in Appendix C ,
Fig. C 2. The TGP is mechanized in a way, that these angles are directly measured at the gimbal axes via the resolvers RR, PR
and YR. From this drawing and Appendix C, Fig. C 2 it can be deduced also, that at the pitch angle 0 = 90 the roll and yaw
axes are parallel and the TGP has lost one degree of freedom. This state is called "gimbal lock".
The FGP is a TGP mounted in an additional outer gimbal OG', but with its roll and pitch axes transposed. The 3 innermost
gimbals are gyro- stabilized as in the TGP, but the outer roll servo motor is controlled by the angle between the inner gimbal IG
and the former outer gimbal OG. Its task is to keep the angle $' = 0 in normal flight. If the aircraft passes the critical region
where gimbal lock w u l d occur with the TGP, the control loop from the inner roll angle +' to the outer servo motor changes its
sign and becomes unstable. This causes the outer gimbal OG' to seek another equilibrium which is 180 away from the initial one.
The FGP thus trades the "gimbal lock" problem for the "gimbal flip" problem which requires a servo loop fast enough so that the
gyros do not hit their stops during the maneuver of the aircraft. In the Litton LN-3 Inertial Navigation System (INS) - mounted in
the Starfighter and the Phantom Fighters - the gimbal flip requires less than .3 s to achieve 90 of the required 180 change. For
more details see [St 821.
2.3 Misalignment Kinematics of an Earth-Referenced Gyro-Stabilized Platform
Since Eq. 2.17 is identical in principle with the characteristics of the free gyro, we can use the block diagram Fig 2 . 4 ~and Eq. 2.13
for the earth-referenced gyro-stabilized platform, too, and we can write:
(2.18)
E,
0'
d - cain
P
Case
Case
Torque
Generator
Torque Generator
Signal
Generator
Torque Generator
\\
Elastic Restrajnt
Gyro Element Gimbal
Damper
Signal
Generator
Signal Generator
Outer Gimbal
0,
>
'"
>
-1
-
ox
>
ex >
M,'
Figure 2.9 Block Diagram of the Two-Degree-of-Freedom Gyro, also Called Free Rotor Gyro
56
Figure 2.11 Block Diagram for the Platform Stabilization by Means of a Two-Degree-of-Freedom Gyro
(one axis shown only)
57
NA, EA, VA
NG, EG,VG
t
Yaw Axis
SM
= Platform
OG
= Outer Gimbal
IG
= Inner Gimbal
Roll A x i s
Yaw Axis
Figure 2.12 Schematic View of a Three-Gimbal Platform (TGP) and a Four-Gimbal Platform (FGP)
58
The vectors e' and d do not need the index p, since it is quite obvious that they are acting in the platform coordinate frame. The
term wln is known in the navigational coordinate frame only. With the platform misalignment angles E = (eN e,
we
may transform it into the platform frame (s. Appendix C, Eq. C 19 and C 20):
(2.19)
win
x wfp.
win t E,
For keeping E , to zero, i.e. the gyro-stabilized platform aligned with north, east and down, the right hand side of Eq. 2.18 must
vanish, i.e. the gyros must in theory be torqued with a'* - d. In practice this is never the case exactly and one has to live with
deficiencies as indicated in Fig. 2.4 d by the asterix. Th&e are firstly daily variations of the gyro drift. Secondly one has to rely on
values for earth rate and transport rate compensation computed in the navigational computer and applied to the gyros as
feedback signals in the so-called. "Schuler feedback loop" (s. Section 4.2.2). They are corrupted by velocity and position errors
resulting in in the error term 6 ~ " .The platform slewing is also affected by the gyro scalefactor error IC and gyro reference axes
alignment errors (aii = misalignment of the ith sensor reference with respect to the jtb platform axis). The latter are comprised
in the following matrut:
(2.20)
We thus obtain for the true platform slewing rate:
at =
(2.21)
(I t K ) - ( a i e
:
)
'a
= (I
+Kahn.
The gyro errors due to scalefactor and input axis alignment errors (elements of K) and to drift d in Eq. 2.18 are combined to:
K . ( a i C t men), t d
K - a ' t d,
whereby Kwen generates roughly speaking groundspeed-dependent and Kw ie + d time-dependent platform misalignment errors.
The effect oPK(ale t wen), is more dominant during easterly than westerlyhights.
(2.22a,b)
6wg =
=
The variations of the platform misalignments with respect to north, east and down over time thus are governed by the following
differential vector equation:
(2.23)
6,
e, x wfp tgw;
t hag.
Assuming the geostationary case (ain= ai'), perfect platform slewing (bin
= 0) and gyro bias drift only (608 = D), we obtain
the following relationship:
(2.24)
de t
0'
- wiC t D = R
cos4
cD cos4
- sin4
E,
t eN
e,
sin4
sin4
cos4
wL
D,
which is shown in Fig. 2.13 as block diagram. All 3 platform axes are coupled within an oscillation network. Oscillations are excited
by initial misalignment angles, for instance.
The following differential equation can be derived for the input of the east-west axis:
(2.25)
..
R sin4
/eE
(-R sin#) dt
t e . ~ 2(cos24
t sin241 = o ,
E
E
wllich shows that the frequency of this oscillating network is equal to earth rate ( U = Q). This should not surprise us if we
remember that a gyro and thus the gyro-stabilized platform keeps its attitude with respect to inertial space, for zero input driving
functions. On the rotating earth it carries out a motion in the negative sense of the earth rate, as indicated in Fig. 2.5.
(2.26)
In strapdown computers the reference direction is computed in form of the Crib matrix - a 3x3 matrix for vector transformation
from the body (index b) to the navigational (index n) frame, with its axes north (x = N), east (y = E) and down (z = D, s.
Appendix C, Eq. ClO). With the computed transformation matrix C, the acceleration f,measured in the body-fixed coordinate
system can be transformed to the navigational coordinate system accorkng to:
(2.27)
f,
c,, .
f,
The C,, matrix thus is the directional reference for strapdown inertial navigation. It can be regarded as the "Analytic Platform"
as indicated by the weathercocks in Fig. 1.2 in comparison with Fig. 1.1. There is no difference in principle between the
acceleration and the computational process of inertial navigation following the weathercocks, i.e the directional references in
strapdown and platform systems - regardless of the aircraft maneuver, the computed vertical acceleration will always point
downwards in a strapdown system, too! From Appendix C, Eq. C11 we also see that the C,, matrix allows to compute attitude and
heading of the vehicle as already indicated in Fig. 1.2.
These considerations give an indication of the allowable overall drift of the reference direction computation. Its numerical
integration must be of "inertial quality", i.e. its uncertainty < < .01 deg/h. More details about the problems for computing this
matrix are discussed in Appendix D.
Now we turn only to the principles of the C,, matrk computation. It can be computed from the matrix differential equation:
59
1
Qsi ncp
-Qsincp
+Rsincp
60
(2.28)
c,,.
C,,
R"b,
where
This skew spmetric R matrix can be regarded as the 6q x operator, i.e its matrix-vector product is identical to the vector cross
product. R: is the result of the aircraft angular rate akb measured by the gyros in the body frame b and the Schuler feedback
:
a computed from earth and transport rate in the navigational frame n:
(2.30)
RP
n;b
- c , , .n;-c, ,.
This relationship will be used in the error analysis further below. In practice the Cnbmatrix is mostly derived from the product of
the 2 matrices:
c,,
(2.31)
= Cni.Cib
CT, ' C i b ,
i.e. the transformation matrices from the navigational to the inertial frame and from the inertial to the body frame. Again it
should be mentioned that the former changes with earth and transport rate, i.e. very slow with regard to time and the latter with
the aircraft maneuver, i.e. very fast. Its computation is most demanding as regards computer speed and algorithms. This is
discussed in more detail in Appendix D.
Assuming the first order integration algorithm would deliver sufficient accuracy, we may write for the time increment t i
tn
Cib (t,)
(2.32)
= Cib(tn-l)
+ J Cib(r)-a t ( r ) d r
Ci, (tn-l )
(I
A*:),
'n-1
(2.33)
A+:
Rib
b
At
:.
-A#z
$z:
0
-A$y A # x
]I!:-
ib
A#;
X.
The elements of A9Lb in this first order algorithm are the angle increments A # p of the mechanical or optical gyros. They deliver
a pulse train proportional to the input angular rate component wlb, whereby each pulse has an identical weight A#p (s.
Appendices D and 0).The pulse train is counted in an up/down counter and read out at sampling times TSto deliver the integral
of the measured angular rate over the sampling interval. Written as a vector it is:
I, tr'
A # i b = Saib dt.
(2.34)
'n
The integration of C in in Eq. 2.31 is carried out similarly but does not cause major numerical problems, since the elements of Rin
contain the sum of earth rate and transport rate only. The latter is the so- called "Schuler feedback" discussed in Chapter 4.2.
2.5 Misalignment Kinematics of t h e Directional Reference in Platform and Strapdown Systems
Up to now we have discussed the computational problems only. For any gyroscopic measurement of uibdeficiencies 6aibdue to
scalefactor errors and drift (s. Appendix 0 for optical gyros or the cited references for mechanical gyros) and due to the
digitizing of analog signals (s. Appendix D) have to be taken into account:
(2.3Sa,b)
aib*= aib + 6 a i b = (I
6oib = 6 o g = K a i b + d,
+ K)*(aib + d)
(I + K ) . o i b
with the scalefactor and input axes misalignment matrix K as shown in Eq. 2.20 and d = gyro drift vector. The superscript
refers more distinctly to a gyro error.
'g"
After integration, i.e. on the level of the directional reference, K causes maneuver-dependent errors and d time-dependent
errors.
The rest of this section is devoted to the discussion of the common features of the gyro-stabilized and the analytic platforms with
respect to their error characteristics. Once this has been achieved, we have found an essential basis for the common features of
the navigational system error propagation within platform and strapdown systems.
The subject of the following train of thoughts is the error propagation of the C,, matrix, whose computation is based on Eq. 2.28.
Instead of the exact matrix C,, we introduce the erroneous one:
(2.36)
where C
,
.
,
Ci
,=
C
,
.
;
= (I
- E)
(s. Appendix C,
C,, = (I
- E). C,,,
Eq. C 20) comprises the small angle deviation elements cN, E,.+ and
tD
between the
61
computed (index n*) and the true (index n) navigational reference coordinate frame. The time derivative of C;, can either be
computed from C:, = (I - E) . C,,:
(2.37a)
C:,
E . C,,
( I - E)*C,,
E . C,,
( I - E).Cn,*
QEb,
C:,
CO',
Robb*
(I
E).C,,-
Robb*,
QT* and
the
into the
The angular rate matrix QEbr is according to Eq. 2.30 computed from the difference of, the gyro measurements
Due to velocity and position errors the latter has an error of 6Qf. The transformation of Q*:
Schuler feedback
body frame is based on the computed Cf matrix:
Qr'.
(2.38)
QF*
c;, .
C,;
(Q?
(I
6QF)
(
E)
Cib
QF +
)
:
2
5
6
( I - E)
. Cnw
(2.39)
6Qg
-7'
- 6 ~
6wX
y"]
Subtracting Eq. 2.37a and 2.3% and using the relationship C,;
equation:
Qb-
L,
E,
cd;
+ sed; +
Cn,*6cd~
This equation is identical in principle to Eq. (2.23) for the gyro-stabilized platform. It differs insofar only as the gyro drift affects
the analytic directional reference computation via the C,, matrix; in a strapdown system the gyros are "strapped down" to the
vehicle, i.e. they are moving with respect to north, east and down according to the aircraft maneuver. This is visualized in Fig.
2.14; in a 360 deg turn the effects of constant sensor errors will thus partially cancel out. During this maneuver the error
propagation of the strapdown system is similar to the one of Carousel INS. This is a platform system with continuous rotation of
the horizontal sensors about the vertical axis for avaraging out the effect of their errors.
It is interesting to note that the directional accuracy of the strapdown system does not depend directly upon the aircraft maneuver only indirectly through the measurement errors d which contain terms due to gyro scalefactor error and input axis misalignment.
Since the C,, matrix is the only term in Eq. 2.40b hinting at the gyro axes coordinate frame, we may generalize its use for all
inertial system mechanizations navigating with respect to the navigational coordinate frame. The index b is then replaced by the
gyro measurement axes coordinate frame m:
(2.41~)
E,
win
6cdF
cn;6wg
m = n, i.e. C,,
I,
(the system error dynamics derived in Section 4.2.2 are characteristic for all the subsequent system mechanizations);
- for the platform system measuring in the wander azimuth coordinate frame:
m = a;
(in Section 4.3 it is shown that this mechanization avoids the singularities of the NIS at the geographic poles);
- for the platform system measuring in a coordinate frame which is continuously rotating about the vertical axis (Carousel
System):
m = c
(by means of the "carouseling" the effect of the horizontal sensor errors upon the navigational accuracy should be reduced);
- for the platform system measuring in the inertial coordinate frame:
m = i;
62
/
-'
EN
/
,T\,
I
I
I
\
'\
'\
Figure 2.14 Horizontal Misalignment Error Growth During a Straight Flight with Subsequent Turn in a Strapdown System
Due to a Constant Drift
Literature Chapter 2
[De 701 Denhard W.G. (Ed): " Inertial Component Testing: Philosophy and Methods"
AGARDograph 128, AGARD 1970
[St 821 Stieler B., Winter H.: "Gyroscopic Instruments and their Application to Flight Testing"
AGARDograph No. 160, Vol. 15, 1982
wr 691 Wrigley W., Hollister W. M., Denhard W.G.: "Gyroscopic Theory, Design, and Instrumentation"
The M.I.T. Press Cambridge, Mass. USA, 1969
63
The principle of a conventional accelerometer is shown in Fig. 3.1. A proof mass is suspended in a case and confined to a zero
position with the help of a spring or a rebalance loop as described below. In general, damping is added to give the spring/mass
system a proper dynamic transfer function. Aircraft accelerations act upon the accelerometer case and cause the mass to react
with a displacement with respect to the zero position so that the resulting spring force F compensates the acting acceleration. The
displacement of the mass with respect to the case is then proportional to F.
For convenience we introduce the specific spring force f = F/m and call it the accelerometer output signal as indicated in Fig. 3.1.
Not only f but also gravitation G is acting upon the proof mass. Both cause its acceleration with respect to inertial space due to
Newton's second law:
(3.la,b)
f + G
d2R
-
where R is the radius vector from the earth's center of gravity which is the origin of the inertial coordinate system (index i), to
the proof mass' center of gravity.
In some cases it is convenient to combine the right hand side of Eq. 3.lb into a vector a or
acceleration or of gravitation is of prime importance. The specific force vector is then:
(3.2)
or
f = a
f =
g'.
The type of accelerometer that is presently used in most operational inertial navigation systems is the restrained pendulum
accelerometer [QF]. Fig. 3.2 shows the construction principle of such a device. A pendulous mass is suspended and restrained to
a zero position by a control loop. Optical, capacitive or inductive pickoffs detect a deflection of the pendulum which is forced back
to its zero position by means of this control loop with an input current into the torquer. This current i that is necessary to
compensate an acceleration and to bring the pendulum back to its null position is then a measure of the specific force f. It is
converted into a voltage U by means of a precision resistor.
The true output signal of an accelerometer contains input signal-dependent errors comprised in the scale factor error
signal-independent errors comprised in b:
(3.3)
f'
= (1
IC)
(a
b) = (1 t IC)a
IC
and input
b.
As soon as both parameters can be modelled - as a function of temperature, for instance - they do not affect the measurement
accuracy. What bothers is the stochastic variation, i.e. the day-to-day repeatability, for instance. This is a true indication of
quality. Threshold is another one.
3.2 T h e Acceleration with Respect to Ground
The second time derivative of the radius vector in Eq. 3.1 is the acceleration of the point P of measurement with respect to the
earth's center of gravity which is the origin 0 of the inertial frame (index i = Earth Centered Inertial Frame (ECI), s. Chapter
"Navigation Coordinate Frames")). It can be expressed in any other reference coordinate frame (index r), for instance the line of
sight (LOS) coordinate frame for missile application or the navigational frame (index n) for navigation with respect to the earth
through application of the Theorem of Coriolis:
d R
d R
d t
(3.4)
dt
(3.Sab)
d2 R
d2 R
z
li xlr
+
Ii
with
-1 d Rt2
T
vertical
d2
a i r x R.
zir
;1
R
2 airx
d R
-
Ix R
2 win x
d t
d R
d win
d t
horizontal
d t
1'
Coiiolis
uir x (a" x
cain x (ainx R)
R)
1'
centrifugal accelerations.
The angular rate uir or ai' are the respective s u m s of earth rate plus transport rate (s. Appendix C, Eq. C 7 to C 9).
Eq. 3.5 simplifies considerably if we introduce the velocity of the point P of measurement with respect to the surface of the
reference ellipsoid of the earth:
(3.6)
which, expressed in the n-frame coordinates, is:
64
el
dt2 i
= acceleration w i t h respect
t o i n e r t i a l frame
f = specific force t o
b a l a n c e p r o o f mass
(spring force)
G = gravitation
S I GNAL
0
POWER
0
65
I2 1
(RN + h)
[ ( R E + h)
VN
(3.7)
Vn
d
COS
-h
d t 2
v + (2
WiC
v +
Wen)
Oie x
( ai'
R).
The last term on the right hand side is compounded with the gravitation G in Eq. 3.1 to give the gravity g as shown in Fig. 3.3:
(3.9)
uie x (mi'
R)
= G
R.Q2/2
- sin 24
0
1 + cos 24
deflection of the
B
.
RR2
s i n 2 p S f - 6 arc min
(3.10a,b)
(2 w
Wen)
v +
+ g
or in components:
-2 vE P sin
2 V, P sin
-2 v, R' cos
4 + h 6
4 - 2 h R' cos 4
4 - v, 6
R' =
n +
i/2
= (2
WiC
Wen
v.
-1
[ -":1,
1'
66
A good example for understanding Coriolis acceleration is to think of a car driving with constant speed V, from the equator to
the northpole. Though not accelerating with respect to the ground an east-west accelerometer will sense an acceleration because
the earths tangential velocity of fl. R = 1668 km/h has to be slowed down to zero at the northpole.
3.3 T h e Accelerometer Output on a Misaligned Directional Reference
In platform systems the acceleration is measured in the platform coordinate frame f = C ,f,, with C the transformation
matrix containing the platform misalignment. According to Appendix C, Eq. C 20 it iscompofed of the smae angles c , , ~ , ~ .In the
strapdown system the acceleration is measured in the body frame and then transformed into the navigational frame n a the C &
matrix which is in error with respect to the accurate one by the small misalignment matrix C,:,. Both misalignment matrices are
identical (s. J2q. C 20). With the same arguments as in Section 2.5 we can make for all inertial navigation systems the following
assumption for the acceleration in the navigational coordinate frame:
(3.11)
6V, =
E,
a,
6 cn + 6 g,
C,;
bm ,
where the index m stands for the coordinate frame, in which the accelerometers are measuring (s. Section 2.5).
Literature Chapter 3
[QF]: QA-1000 Series, QA- 1200-Series and QA-1300 Series Q-Flex Accelerometers.
Sundstrand Data Control, Inc. Document 012-0293-001
67
4. Inertial Navigation
Integration of the DirectJonal Reference with
the Translational Motion Measurement
4 . 1 Introduction
In Section 4.2 we will begin the discussion on inertial navigation systems (INS) and their error characteristics based on the
mechanization indicated in Fig 1.1. The platform shown here is always kept horizontal and pointing north regardless of t h e
vehicle's maneuver. Therefore an inertial navigation system (INS)with this characteristic is called "North Indicating System (NIS)"
in the following. Special emphasis is also laid on the vertical channel in which as compared to the horizontal channels the physical
law of mass attraction between two bodies (earth and proof mass of the accelerometer) leads to an instability of the error
growthz. The aiding of the vertical channel with the barometric altitude will be discussed.
The NIS can certainly not be used for passing the geographic poles where all directions are pointing south or north. For worldwide
inertial navigation another mechanization is required. It is the so-called "Wander Azimuth INS" discussed in Section 4.3. Some
words will be said in Section 4.4 about the INS with space-stabilized coordinate frames used on earth and in space. As pointed out
in Section 2.3, the functioning of the mechanical platform can be taken over by an analytic platform computed in the navigation
computer. The data processing following this analytic platform computation is identical to that of the mechanical platform system
as indicated in Fig. 1.2 for the NIS as an example. Section 4.4 deals with this modern INS mechanization, commonly known as
"strapdown systems (SDS)". The characteristics of the error dynamics for all inertial navigation systems constitute the topic of
Section 4.6. The error model derived therefrom can be used in a Kalman filter for the integration of any platform or strapdown
INS navigating in terms of longitude and latitude with external sensors and systems.
As autonomous inertial navigation systems are expensive and other navigational information often lies at the wayside and can be
blended with the inertial information, accuracy requirements on the inertial side can be reduced thus leading also to a reduction of
costs. Inertial systems of this kind are often referred to as "attitude and heading reference systems (AHRS)".They will be
treated in Section 4.7.
4.2
Fig. 1.1 shows the diagram of an N I S which we use to obtain an understanding of the inertial navigation system (INS) functioning.
The platform represented as a round disc in Fig. 1.1 is suspended in the vehicle (airplane, missile, ship) with three degrees of
rotational freedom. For simplification this figure shows only the vertical axis. The rotational freedom as well as the other
indicated signals are understood to have 2 or 3 orthogonal components; 2 components for horizontal acceleration, velocity and
position, 3 components for the angular rate.
On the platform one gyro can be seen - in place of the three gyros - which, with the control loop from gyro pickoff (P) via the
electronics to the servo-motors at the gimbals, ensures the stabilization of the platform.
As we have seen in Section 2.2, the gyro;stabilized platform used as a directional reference with respect to the navigational
frame, follows the performance equation: E = 0' + d - m l n , regardless of the vehicle's maneuver. To keep the misalignment
L )
T < < 1 deg in magnitude, the condition for torquing the 3 gyros 0' =
- d has to be met, i.e.
angle vector E =
with w L n =U ' ' + m'ys.
Appen& C, Eqs. C 8 and C 9) it has to be equal to the s u m of earth rate plus transport rate and drift as
indicated in Fig. 1.1.
The computation of the earth rate and transport rate vectors are dependent on the computed ground speed and position, i.e. on
the measured acceleration vector f'. Eq. 3.10 is the basis for their computation.
Since with the NIS the geographic coordinate frame is stored in the platform, the aircraft attitude and azimuth can directly be
measured at t h e gimbal axes (s. Fig. 1.1).
As already mentioned above, pure inertial navigation can only be carried out in the horizontal plane and Fig 1.1 is valid for this
case only. Navigation in the vertical plane has to be aided by the barometric altitude, as will be discussed in Section 4.2.3.
4 . 2 . 2 T h e E r r o r Dynamics in t h e Horizontal Channels of t h e NIS
4 . 2 . 2 . 1 T h e E r r o r Dynamics of a Single Axis Inertial Navigation System
The signal flow of Fig. 1 . 1 for the two horizontal channels from the accelerometer, via the integrators and the division by the
representative radius of curvature of the earth, to the torquers of the gyros are called Schuler loops. They are the electronic
implementation of a two-axis mathematical pendulum whose length is equal to the radius R of the earth, having the frequency and
period of
(4.2.la,b)
ws =
I/g/R
TS = 84.4 min
68
Neither a mathematical pendulum nor a physical pendulum can b e implemented with this frequency. For the latter the following
relationship would have to be satisfied:
i2/ r = R
(4.2.2)
Assuming i = radius of inertia = 2.5 m, the pivot-to-center-of mass separation of r = 1 pm would have to be manufactured. In
practice the Schuler tuning condition can only be met with the aid of a gyroscope - as in a gyrocompass or the INS.
The simplified single axis INS shown in Fig. 4.2.1 may serve as a basis for the following discussion.
The platform (P) is mounted on a vehicle heading north and gyro-stabilized about its east-west axis (perpendicular to the plane of
the drawing) by means of the servo loop from the gyro (G) signal generator (S) to the servomotor (SM) of the platform. The
accelerometer (A) has its sensitive axis in the direction of motion and its output signal f is coupled to the torquer (T) of the gyro
via the integrator and the amplifier - 1/R V is the north velocity and e the angular deviation with respect to the vertical.
The system's error dynamics are described by the linearized state space equations:
0
with D = gyro and B = accelerometer bias assumed to be constant in the mean. The state vector is:
x
(4.2.4)
6V
(6.5
B)T
The w-terms comprise random Gaussian distributed noise with zero mean. Instead of w; and w&, we have introduced wD and we
to remind of the fact that these terms are caused by gyro and accelerometer noise.
Equation 4.2.3 is of the following form:
x
(4.2.5)
P.x
w.
x(t,)
(4.2.6)
J *(t,,T).W(T)
dT,
'0-1
with +(tII,
domain:
*(s) = ( s I
(4.2.7)
P)-',
1;
with s = Laplace variable. For zero random driving functions (w = 0) this leads to the following solution of Eq. (4.2.3) in the time
domain:
(4.2.8)
6V
II
1
si/w
R(l - CO)
0
CO
R w si
0 -si/(R w)
CO
0
0
0
0
0
0
(t) =
D
B
R(At - si/w)
R(l - CO)
(1
si/w
1
0
co>/w*
-(lsi!wco),g]
01
At = t
to.
si = sin os At,
CO
cos os At.
Horizontal platform misalignment e, velocity error 6V and position error 6s = R. 6@ due to east-west gyro drift D and northsouth accelerometer bias B are plotted in Fig. 4.2.2. All position errors begin with zero slope, indicating that for short periods of
time the NIS is very accurate.
Distinctly to be seen is the Schuler oscillation on the 3 system levels. All NIS errors are bounded, except for the effect of gyro
drift D on the position error. It confirms the importance of the gyro on the long-term system accuracy. The slope, i.e. the mean
velocity error provides the 'Rule of Thumb for Inertial Navigation':
(4.2.10)
6v
R.D
=)
Physically this rule becomes understandable if we consider that t h e gyros keep the reference coordinate system for navigation,
stored in the platform and that the gyro drift causes an analogous drifting of it (as a reminder: 1 degree of longitude = 111 km
at the equator).
It is interesting to note that the effect of accelerometer bias B upon the NIS position error is not as severe as one could expect.
The misalignment error and the position error are alike. The mean error is limited to:
(4.2.11)
e = 6S/R = 6$ = B/g.
69
Fig
4.2.1 Signal
Diagram
IQ
Ellecl of
h )
on Alldude
IKnI
0.34
40
20
I I m i n l 60
80
u.4
on Velocily
6V
,' B1
r$
an Position
6S, Rbq
meon'value
71
This means that the accelerometer bias is compensated by a component of gravity due to the mean platform tilt.
For periods that are short with respect to the Schuler period, one can introduce the approximations in Eq. (4.2.8):
(4.2.12a,b)
si
CO
This leads to the curves marked in dotted lines in Fig. 4.2.2, which for a longer time period are also valid for the set-up of Fig.
4.2.1 without Schuler loop or for inertial navigation on a flat earth.
Another effect is worth mentioning, the effect of sensor scalefactor errors on the NIS performance. Let us begin with the gyro
scalefactor error Kg ( s . Eq. 2.22). It causes an error in the platform slewing 60' = K g ( o l e + wen) and thus has a similar effect
as the gyro drift. It is bigger for easterly flights when O" and men have the same sign than for westerly flights. The corresponding
drift component about the north-south axis is then:
(4.2.13)
d' =
I C ~a' Z
,002 deg/h
for
I C ~ 9
The assessment of the accelerometer scalefactor error's ( K ~ )effect on system performance yields again a surprising result. It is
active only when the vehicle is accelerating, but not during cruise. Assuming that the take-off acceleration is very short compared
to the Schuler period, we may regard the velocity error 6V = wa.V as an initial velocity error 6V(t,). From Eq. 4.2.15 we obtain
as position error:
(4.2.14a)
6S(t) =
I C ~
(V/us) sin us t,
i.e. it is zero in the mean! Only for short intervals of time compared to the Schuler period of 84 min, say 10 min, or for inertial
navigation on a flat earth the position error is as expected:
(4.2.14b)
6s
d.S.
In summary we may conclude that inertial navigation is only feasable because our Lord has made the earth spherical. The time
exponent of the position error growth is lower by 2 as compared to our expectations from school physics!
It is not surprising that this was not recognized at the beginning of the inertial navigation development which took place in
Germany before and during World War 11. Outsiders did not believe in the feasability of inertial navigation due to their
interpretation of the position error growth with school physics as a basis. The so-called "law of the third power" to which they
t3. It was Reisch who proclaimed inertial navigation as the
referred says that the position error due to gyro drift grows
"principle of plumb line rotation" shown in Fig. 4.2.3 [He SO]. It indicates that position changes can be measured by the inclination
of a space-stabilized platform with respect to a plumb line reference. Gyro drift causes a position error growing linearly with time
in this navigation system which lacks the plumb line reference on a moving vehicle. The INS in Fig. 4.2.1 has the plumb line
reference in form of the Schuler feedback. From today's point of view this was Reisch's valuable contribution to this development,
but one cannot follow him in his demand to be the inventor of inertial navigation as proclaimed again in [Hi 921. This honour is
certainly due to Boykow [Bo 351. The fairly benign INS error characteristics do not depend on the mechanization proposed by
Reisch and before him by Boykow. It governs any INS mechanization as shown in Sections 4.4 and 4.6 and is due to the shape of
the earth.
Figure 4.2.3 Reisch's "Principle of Plumb Line Rotation" for Position Measurement from the
Inclination Measurement of a Space Stabilized Platform
72
So far we have discussed t h e effect of deterministic sensor errors on the NIS performance only. In modern sensors, especially in
the ring laser gyro (RLG), the deterministic errors are fairly small and the effect of stochastic errors on system performance
becomes more dominant (s. Appendix 0). It is also of great importance for system modelling in a Kalman filter, and this will be
the subject of our next discussion.. Tools for estimating their effect are the Monte Carlo simulation on a digital computer and the
covariance analysis for predicting their f 1 U boundaries. The results of the former, shown in Fig. 4.2.4, are based on a simplified
version of Eq 4.2.6:
(4.2.15)
x(tJ
*(tnltn-lIfx(tn-1)
W(fn-J>
with the following state transition matrix for a first order integration:
(4.2.16)
*(tn ,tn-
I t P(tn- 1) -At.
In this simulation gyro noise was investigated with a random walk coefficient of rD = .01 d e g / f i .
From the different sample functions plotted in Fig. 4.2.4 the R M S values were calculated for a fixed time and plotted as dotted
flu-curves. In order to compare the simulation with the theory, we carry out a covariance analysis using the formular [Ge 741:
deterministic propagation of
covariance, i.e. propagation of
uncertainty in knowledge of
system error state between
tn-l and to.
where
The covariance matrix q specifying the sensor and system noise, has on its main diagonal the squares of the corresponding
random walk coefficients and otherwise zeros. For noise the corresponding elements read on the accelerometer and gyro level (in
Eq. 4.2.3 wB =k 0 and wD +: 0):
(4.2.18a,b)
q22 = (re/60)2
with rB [(m/s)/l/;;-]
and
and rD [deg/
q33 =
(1-~/60)~
fi].
The lo-values for the system uncertainty is the square root of the corresponding element on the main diagonal of the resulting
covariance matrix, for instance:
(4.2.19)
06s = P I 1
Using the state transition matrix from Eq. 4.2.8, we obtain the following result for the system uncertainty propagation due to gyro
noise, i.e. a random walk on the misalignment level:
(4.2.20a,b,c)
uZE
u2hv =
u2hs =
rZD
[t/2 t 1/(4ws) .si2],
r2D R g . [t/2 - 1/(4ws). si21,
r2DR~ . [3. t/2 - 2/w;si
+ 1/(4wS)-si2],
f
The results of the computed f 1 U values are plotted in Fig. 4.2.4 as dot-dash curves. They correspond fairly well with the
simulation if it is kept in mind that the +lo bands enclose 68% of the 8 Monte Carlo runs.
In a Kalman filter Eqs. 4.2.15 and 4.2.16 are used for the prediction of the system error state based on the last optimal estimate
(x(tn-l) = %(tn-l)).Since the random driving function w(t) cannot be predicted but its mean is zero per assumption, w(tn.l) has to
be assumed to be zero for the prediction.
4.2.2.2 T h e Error Dynamics of a T h r e e - A x i s Inertial Navigation System
Fig. 4.2.5 shows in simplified form the block diagrams of the error models for a three-axis NIS in the lower half and the
barometric aided altitude channel in the upper half. On the left side the sensor errors are listed and on the right side the system
output errors.
As compared to the complete error model of an MS [Br 711, which will be discussed in Section 4.2.2.3 (s. Fig. 4.2.7), the SOcalled 24-hour oscillatio? caused by the cpupling of the platform angles N,E,D via the components of the earth rate plus t h e
transport rate A (with A = R + X ) or 4 , respectively, has been cut down to the coupling of the azimuth misalignment E,, into
the rotation about the east-west axis. For the purpose of discussion this is justified because on the one hand cD is in general one
order of magnitude higher than the-horizqntal misalignment angles E, E. .On the other hand, for flight periods of up to 2 hours we
can assume with good accuracy: sin A t A t and cos A t S 1 (error in'this approximation < 10 %).
For an estimation of the errors in the MS channels we assume that the slewing of the vertical gyro as well as the compensation of
the Coriolis acceleration can occur without errors and there remain two Schuler loops as in Fig. 4.2.1. In addition to these Schuler
loops the influences of the azimuth error cD as well as of the vertical gyro drift are indicated.
On the one hand the azimuth deviation E~ causes acceleration errors in the horizontal channels which are orthogonal to the
respective components VN,Eof the horizontal acceleration of the vehicle. This is indicated in Fig. 4.2.6a for an acceleration of V,.
13
2.88
epsikrcnin)
-2.ee
5.88
dU (n/s)
-5 .ee
Figure 4.2.4 Errors and f l u Bands of a Single Axis Inertial Navi a 'on System
Due to a Stochastic Gyro Drift (Random Walk of .01 d e g w )
74
I
Sensor
System E r r o r Model
Errors
I
Model Atmosphere
Altimeter
Vertical Accelerometer
6hb
I
I
--2T
-+
I Altimeter
Error
63
I Altitude
I Error
8"
I
I
I Longitude
East Accelerometer
Error
North Gyro
Vertical Gyro
I1 Latitude
Error
I
East Gyro
North
cc e\erometer
Figure 4.2.5 Simplified Block Diagram for the 3-Axis Error Model of a North Indicating INS
Including Vertical Channel
Figure 4.2.6 View upon the Platform Misaligned about t h e Vertical Axis
75
Assuming that the acceleration of the vehicle from start to the constant cruise velocity is short compared to the Schuler period,
the time integral of this cross-track acceleration error is equal to an initial velocity error:
6VN = 6V,(O)
(4.2.23a,b)
~ ~ ( 0. )V,,
6VE(0) = 6V(O)
ED(0)
v,.
DL
(4.2.24a,b)
D, -
(E,
+ D,. t ) . 4;
Db = DE
t (E,
+ D,.
t). A
.COS
I$
The relationships compiled in Eq. 4.2.25 were obtained in a way similar to the one for the single axis inertial navigation system in
Section 4.2.1; the state space equations of the two uncoupled horizontal channels were supplemented by Eqs. 4.2.23 and 4.2.24 and
cos4 was assumed to be constant.
(4.2.25)
T
si/(Rw)
0
si/(Ro)
-( 1-CO)
CO
0
0
0
0
CO
si/(Ro)
-Ro si
CO
-si/( R o )
0
0
(1 - CO)
R o si
CO
0
0
0
0
-Ri
-A$
R(A- R co)cos$
0
t - si/@
AA
COS$
(R/o)cosI$ si
1
0
0
t/2-
A /W2)COSQ( 1-CO)
0
0
(l-co)/g
0
We have again made use of the abbrevations in Eq. 4.2.9, i.e. w = us,si = sin wSt and CO = cos wSt. The readers attention is
also drawn to the fact that the vector-matrix arrangement in this equation alleviates the identification of state vector
dependencies.
Of the results we want to discuss only the position error equations and cast a glance at the main sources. The initial position
error (6I$(O) and 6A(O)) can be assumed to be zero, as on any major aerodrome the geographic longitude and latitude are
indicated at the aircraft parking positions. The initial velocity error can also be neglected if the switching of the NIS into the
navigational phase takes place on a stationary aircraft, V(0) is then accurately known.
In comparison to Eq. (4.2.8) essentially only the effects of t h e azimuth alignment error E , and of the vertical gyro drift D, have
been added. It is interesting to note that the deviation with time of the cross-track-error is equal to that of a common dead
reckoning navigational system in the east-west channel (6h(t) cos 4 = - ~ ~ ( 0AI$).
) . In the north-south channel this is true for
short times only when 6Q(t) = ~ ~ ( 0 [AA
) . - (Q/ws). sin w,At]. cos Q Z E , . Ah. cos Q. After approximately 10 minutes, earth
rate coupling becomes effective.
It is this difference in t h e error characteristics that allows in-flight gyrocompassing of a misaligned MS based on a Doppler radar
for measuring the body-fixed ground speed components (s. Chapter Doppler Navigation) and the misaligned platform as heading
reference. We will come back to this topic in Section 6.
If we start from the assumption that before the start the platform has aligned itself in the north direction and in the horizontal
plane as a result of a gyrocompassing procedure, we shall under ideal conditions have the following relationships between the
alignment and sensor errors (s. Section 5):
(4.2.26a,b)
E,,~(O)
~ ~ ( 0z)
f BE,,/g
DE/(Q cos
6Q(t)
6A(t)
(Z
Q)
(Z
1 mrad
g and D = .01 deg/h as well as Q = 45 deg. The position errors in Eqs. (4.2.25) are
E,(O).S~/R - D, -[AA.t/2
76
S,, being the distance flown. For periods that are short in comparison with the Schuler period (6 min approximately for a 10 %
erior) these relationships will be reduced to:
(4.2.28a,b)
6$(t)
~ A ( ~ ) . c o4s E
~ ~ ( 0S,/R
) .
E~(O).S,/R,
which means, that after fully completing self-alignment, the navigation error of the NIS under ideal conditions initially consists
exclusively of the cross-track error, and is identical with that of a normal dead reckoning navigational system with ideal
velocimeters!
Before we discuss in Section 4.6 the NIS horizontal errors over a longer period of time ( > 6h), the INS vertical channel and other
INS mechanizations should be described briefly. Then we are in a better position to understand common features and differences
in their error models as a basis for Kalman filter design.
4.2.3 T h e Error Model f o r t h e V e r t i c a l Channel o f a n Inertial Navigation System
The decoupling of the vertical from the horizontal channels is justified, as will be shown in Section 4.6. Inertial navigation in the
vertical channel consists of a mere double integration with gravity compensation. The latter includes the decrease of gravity as a
function of height due to the physical law of mass attraction between two bodies - the earth and the accelerometer's proof mass.
The block diagram for the vertical channel's error model is shown in Fig. 4.2.5, top, in thin lines. Due to the positive feedback of
the gravity dependence upon height the autonomous inertial navigation in the vertical is unstable with the eigenvalues:
(4.2.29)
A,,2 = k
p = 1/2g/R.
f
6h(t) = 6h(O).cosh At
- B,/A2-(1
- cosh At),
where B, is the accelerometer bias. This error growth is plotted in Fig. 4.2.7.
For navigating over a longer period of time, the vertical channel has to be aided by external measurements, as indicated in Figs.
4.2.5 and 4.2.8 for use in a civil aircraft. The difference between the baroinertial height h and the barometric height hb is fed
serves to
back to the baroinertial velocity and the acceleration via the gains K, and q.The shunting integrator with input gain
compensate quasiconstant acceleration errors due to sensor bias and gravity compensation errors. The gains quoted in this figure
are valid for the Litton LTN 90. Due to the fairly weak barometric coupling, the baroinertial height follows in the low frequency
domain the barometric height and in the high frequency domain the purely inertial height. The most important sideeffect of this
baroinertial coupling is the generation of a signal for the vertical velocity. It can hardly be derived from pure barometric
measurements.
Within a flying aircraft the static barometric pressure measurement is a function of
- the magnitude of the air flow, i.e. the true air speed (TAS) and the Mach number,
the direction of the air flow, i.e. the angles of attack and sideslip,
means of windtunnel tests and by calibration flights, the results of which are "optimal" for a certain flight condition only. For other
flight conditions an error model including calibration parameters is layed down in the "air data computer (ADC)" [NM 841.
The static pressure is thus a fairly accurate altitude reference during cruising speed in the subsonic range. It is true that the
aircraft will thus not follow a certain geometric altitude, but the isobars of the atmosphere. This is a sound basis for air traffic
control, since the controller knows that all aircraft will fly in their respective flight levels (FL) which he has assigned them to (FL
= barometric mean sea level altitude [ft]/lOOO above 3000 ft above mean sea level (MSL)).
The calibration of the static pressure for instationary flight conditions and the generation of a reliable reference for the vertical
speed and the height is difficult and limited in its accuracy [Au 911. Out of this reason a separate chapter is devoted to this topic
in this book (s. Chapter "Vertical Channel Design Considerations").
For flight-test with accuracy requirements in the 1 m range it has also to be kept in mind that additional errors are due to the
conversion of the analog pressure measurement into a digital signal and due to the conversion of this digital signal into a
barometric altitude.
The former is affected by the volume of the pressure transducer, for instance, which causes the time lag in the order of
magnitude of 1s [Re 851. The digital data handling within the ADC includes a lowpass filtering with a time constant of the same
order of magnitude [NM 841 again. These time lags T affect the barometric computation during ascent and descent with 6h Z
T-h.
The latter, i.e. the conversion of the pressure into the barometric altitude, depends upon t h e ground pressure and temperature as
well as the outside temperature.
The ground parameters are requested by the pilot from the controller and entered into the ADC when approaching an airport.
Errors in these parameters cause additional barometric altitude bias and scalefactor variations.
If all error parameters mentioned above remained constant during the flight with respect to the runway, they could be modelled as
a bias in an estimation process based on external measurements. Unfortunately this is quite often not the case as the flight test
results in Fig. 4.2.9 demonstrate. They were obtained with the twin engine turboprop aircraft Do 228 of DLR with static pressure
holes in the fuselage. The plotted differences between the barometric altitude obtained from the Nord Micro ADC and the
reference obtained from the DLR "Avionic Flight Evaluation System (AFES)", i.e. a flight path based on microwave radar, laser
tracker and INS, shows a very problematic time characteristic during the approach. Neither can this be removed by feeding the
barometric altitude into the inertial system as indicated in Fig. 4.2.8, nor can this be estimated correctly by a Kalman filter with
IO'
Ah
PI
1-
Ii
x)
Figure 4.2.7 Unstable Error Growth of the Unaided Inertial Vertical Loop
"
I
c)
baroinertial
s
baro
78
2200
2000
1800
1600
+
E!
1400
-2
1200
1000
i3
800
600
400
200
10 15 20 25 30 35 40 45 50 55 60 65 70 75 80 85 90 95
time [min]
500
400
300
n
I$=
200
100
a)
a)
E!
-3
-100
- 200
-300
- 400
__
0
10 15 20 25 30 35 4 0 45 50 55 60 65 70 75 80 85 90 95
time [min]
Figure 4.2.9 Barometric Altitude and Altitude Error of the Twin Engine Aircraft Do 228
During Several Runway Approaches
79
the bias modelled as a state vector component.
The modelling and calibration of the barometric altitude errors during flight maneuvers is a fairly difficult task and their
compensation or estimation accuracy with a Kalman filter is limited [Wi 751. For obtaining a vertical flightpath reference over a
limited period of time, it is advisable to rely on the inertial altitude aided only by external measurements as satellite navigation or
the radar altimeter. This topic and problems connected when using a conventional INS for this purpose are covered in [St 94).
4.3 Inertial Navigation with S e o s o r s Aligned t o a Waoder Azimuth Coordinate F r a m e
The wander azimuth coordinate frame (subscript a), defined in Appendix C, Section C 4 (s. Fig. C3), is obtained from the
navigational frame through the "wander azimuth rotation U" about the vertical axis. Among different choices for the selection of
the U [St 821 the most common stems from the fact that the a-frame is not slewed about the vertical a i s with transport rate, i.e.:
(4.3.1)
0:
= [V,/(R,
= -
h)] tan #.
Prior to navigation t h e a-frame is aligned to true north, and the vertical in the same fashion as in an N I S (s. Section 5). The aframe remains in these directions when the system stays stationary or moves exactly northward. When it then passes the north
pole, there is not switching about the vertical by 180 deg as in an NIS, and its x-axis is pointing south. When the system moves
eastward, the wander angle o! increases; it decreases again, when it moves westward. Arriving at the initial meridian, the x-axis of
the a-frame is pointing exactly north again. Only after a passage of the pole and returning to the starting point on a different way
the x-axis of the a-frame is pointing in the opposite direction.
The computation of the position is based on the integration of a transformation matrix (s. App. C, Eq. C 17):
(4.3.2)
t
Cca(t) = cca(o) t ]Cca(T).
nY(T) dT
[ :;
'31
cl,
'131
'22
'23
'32
'33
'
where
tank = -C23/C33 ,
tano! = -C12/Cll.
Although singularities do exist in the computation of longitude X and the wander angle o! at the geographic poles, they do not
exist for the computation of the matrix C c (t), so that inertial navigation is assured on a polar flight and A as well as 0: are again
correctly computed shortly after passage of a pole.
According to [Ka 691 the integration of Eq. 4.3.6 has to be executed with 26-bit words and the integration of acceleration with 17bit words, if the corresponding drift is to be kept below 0.001 deg/h.
4.4 Inertial Navigation with Sensors Aligned t o an Ioertial Coordinate F r a m e
Inertial navigation systems aligned to a space-stabilized coordinate frame (index "i") are used for terrestrial navigation using
platform systems equipped with electrostatically supported gyros (ESG); those gyros remain untorqued in the navigation mode.
These systems are also used for space navigation with platform and strapdown systems.
Figs. 4.4.la,b show twu possible configurations for inertial navigation with the acceleration measurement in the i-frame. It is quite
obvious that the system in Fig. 4.4.la navigates with respect to the earth after transforming the acceleration from the i-frame
into the n-frame with the help of the transformation matrix in Appendix C, Eq. C 3b. The navigational computation is identical
with that of the N S . The Autonetics ESGM (electrostatically supported gyro monitor) system for marine application works in this
fashion.
With the help of the transformation matrix C i = CinCna(s. Appendix C, Eqs. C 3b and C 17) navigation could also be carried
out in the wander azimuth frame, discussed in t%eprewous section.
The configuration in Fig. 4.4.lb is the one for space navigation with strapdown and platform systems. Navigation is carried out
within the inertial frame. This kind of navigation seems very simple on first sight due to the mere double integration of
(4.4.1)
t2
= fi
Gi(Ri).
The difficulty lies in the exact modelling of the earth's mass attraction Gi(Ri) for which we can find assumptions in Chapter
"Navigation Coordinate Frames".
On first sight again it is difficult to see that, when geostationary, this INS is governed in its interior error dynamics by the Schuler
oscillation and the instability of the vertical channel similar to the conventional NIS. Fig. 4.4.2 may serve to explain this. It shows
80
Gi(Ri) = Go
!!S!-zi
R3
with Go and ,R
, the values at the surface of the earth. When the stationary INS computes a position error into the y-direction, for
instance, the resulting computed but not acting horizontal y-component of G tries to pull this error back. The computed Gcomponent due to an x-position error causes the instability discussed in Section 4.2.3. So we obtain as simplified error equation
for the stationary INS
A=
Platform
3 Accelerometers
G = 3 Gyros
Computer
I
I
win
--n
W
uie
-n
Computer
I !*
b)
U,
Y
R_i
I
I
Figure 4.4.1 Two Concepts for Inertial Navigation in the Space-Stabilized Coordinate Frame
where E is the respective misalignment angle including the effect of gyro drift and b is the respective accelerometer error. This
equation shows that the horizontal channels are governed by the Schuler frequency (s. Eq. 4.2.1a) and the vertical by the
instability known already from Section 4.2.3 (s. Eqs. 4.2.29 and 4.2.30). Fig. 4.4.2 visualizes these effects.
The Honeywell ESGN (electrostatically suspended gyro navigator) for marine application and the Honeywell GEANS (gimballed
ESG aircraft navigation system) - both are space stabiliced platform systems - navigate in the inertial coordinate frame. The
position components
are transformed to geocentric latitude, longitude and altitude with the help of the transformation
matrix CO,in Eq. C 3b ofkppendix C.
The next question is connected with the error dynamics of the space-stabilized INS in orbit. The main role of such a system in a
satellite is thrust control durin orbital changes and attitude determination. For a satellite in orbit the forces due to gravitation G
and centrifu al acceleration w gR are in equilibrium - thus its orbital frequency w is equal to the Schuler frequency for this orbit
w s = ( G / R ) k l t ( s . Eq. 4.2.1). This may give already an indication that the INS error dynamics will be governed by the local
81
0,50
-t
0,75
1,O
,42
0
Figure 4.4.2 Physics of the Schuler Feedback and the Vertical Instability in a Space-Stabilized Inertial Navigation System
."Ti
x,
orbit
earth
k
Figure 4.4.3 Physics of the Schuler Oscillation of a Space-Stabilized Inertial Navigation System in Orbit
82
Schuler frequency us,too, as in all o!her INS mechanizations. This is indeed the case as may be shown for an INS whose computed
coordinate frame is used in the satellite as vertical reference with respect to the earth. The local vertical coordinate frame (index
v) has its x-axis pointing up parallel to local vertical, its y-axis pointing tangentially to the orbit righthanded in Fig. 4.4.3, and its zaxis pointing normal to the orbital plane. Making use of the block diagram in Fig. 2 . 4 ~for the kinematics of a computed reference
direction with respect to the true direction and of the transformation matrix in Eq. C 20 of Appendix C between both, we arrive at
the following state space equation of the misalignment angles:
cos uSt,
E,(t) = c,(O)
(t) =
These results correspond in principle to the ones of the NIS on ground in Eq. 4.2.25.
4.5 Inertial Navigation with Body-Fixed S e n s o r s - Strapdown S y s t e m s
Strapdown systems (SDS) have beeen treated in this section in one breath with platform systems, since the platform as inertial
measurement unit (MU) including the command rates for platform slewing can be fully replaced by a strapdown IMU plus
computer for the corresponding transformation matrix computation. The latter is nowadays the preferred INS mechanization due
to the obvious reasons concerning cost and reliability. Throughout this chapter the platform system is used primarily for
visualization of system characteristics.
Besides the advantages mentioned above, strapdown systems offer additional ones:
- they deliver measurement signals not only for navigation and guidance, but also for flight control, namely angular rate and
acceleration in the body-fixed coordinate frame (s. Pig. 1.1 and 1.2);
- they are much more flexible in their adaptation to different system concepts, since no restrictions exist for the choice of the
IMU coordinate frame. This means that a strapdown M U not hard-mounted to the vehicle can carry out its measurement in any
coordinate frame and the SDS Will still navigate correctly. Here are some examples:
For submarines the INS is the only navigational means for underwater missions. The accuracy requirements for these missions are
with 1 Nh4/day allowable upper position error growth fairly difficult to achieve. Solutions developped by two competitive companies
are based upon ring laser gyro (RLG) strapdown MUS mounted again on a rotable platform.
In the model developed by Litton, the RLGs and the accelerometers are rotated with alternating directions about the vertical
platform axis, thus raising the 3 FUG'S input above the lock-in level (rate bias) and providing conditions for avaraging out the
effect of sensor errors with respect to the navigational coordinate frame (carouselling) [KO 901.
In the model developed by Honeywell, a two-axis indexer (roll on outside, azimuth on the inside) is employed for rotating the IMU
with dithered RLGs periodically 180 degrees about the roll and the azimuth axes, thus providing again the conditions for avaraging
out the effect of constant sensor errors upon the navigational error [Le 871.
In another proposal it was shown how to use a strapdown M U for gyro-stabilizing an instrument and at the same time using it for
inertial navigation [St 801.
Conventional SDSs used in civil and military aircraft are truely "strapped down" to the vehicle. They are equipped with RLGs in
general and use the wander angle coordinate frame for inertial navigation. As mentioned in Section 4.3, their output signals are
identical with the one navigating in the navigational coordinate frame (North Indicating System (MS)), but they do not have any
problems in passing the geographic poles.
The reader more interested in SDSs is referred to Section 1 for a brief opposition of platform and strapdown systems. Sections
2.4 and 2.5 give an introduction into the core of the SDS - the analytic platform as directional reference and its error behavior.
The problems of SDS signal processing are outlined in Appendix D. Appendix 0 describes the optical gyros as sensors which are
responsible for the widespread use of the SDS. Sections 3 and 4 are applicable to platform and strapdown systems as well.
4.6 Error Model f o r all Inertial Navigation S y s t e m Mechanizations
The derivation of the vector error equations for the directional reference of a strapdown system in Section 2.5 and the
acceleration measurement in Section 3.6 have enabled us to generalize these results for any INS mechanization system with
respect to the earth. The idea behind this generalization is similar to the statement made in the previous section about the
flexibility of a SDS for adaptation to different system concepts - no restrictions exist for the choice of the IMU coordinate frame
(index m), i.e. a strapdown IMU not hard-mounted to the vehicle can carry out its measurements in any m-coordinate frame and
the SDS will still navigate like the INS developed in this sense. The error propagation of this SDS will thus be the same as that of
the INS.
The vector error equations for the directional reference and the acceleration measurement in Eqs. 2 . 3 6 ~and 3.12 read:
(4.6.la,b)
with
En
= en x w r
(4.6.2)
eo
= (eN
+ 60:
t 6 ~ : ~ ,
Vn =
en x a n - 6cn t 68,
6fn,
83
(4.6.3)
gin
,ie
(4.6.4a)
6~:"'
cn,. 6 w g
Cnm = matrix for vector transformation from the sensor measurement (index m)
(4.6.4b)
m = a for the platform system slewed to the wander azimuth coordinate frame,
i.e. Cnm = Cna (s. Eq. C 13),
m = c for the platform system continuously rotated about the vertical axis
with 1 revolution per minute, for instance (Carousel System)
for avaring out the effect of horizontal sensor errors upon navigational accuracy,
m = i for platform systems measuring in the inertial coordinate frame,
i.e. Cnm = Cni (s. Eq. C 3b),
m = b for strapdown systems mounted to the vehicle,
(4.6.4~)
6gS = K u m
im
~ =) angular
~
rate of [MU-slewing (platform-slewing = cat applied to the
(ox my w
gyros, s. Eq. 2.21 for the case m=n) or IMU angular rate measurement;
(4.6.4e)
x;:
ry
y;
;:
a=
scalefactor error plus input axes misalignment matrix (s. Eq. 2.20),
zy
Qzx
(4.6.4f)
(dx
dy
(4.6.5)
vn
(VN
VE
V,)T
(4.6.6a)
an =
(ax
ay
aZ)T =
(4.6.6b)
fm =
(fx
fy
fZlT=
(4.6.7)
cn
(4.6.8)
gn = g($). (5
(4.6.9a)
(4.6.9b)
6fa = Kam
(VN
v,
-h)T;
vehicle acceleration
accelerometer output;
with 5 and
r)
6fa
E ~ .
These relationships show u s that for INS error modelling its mechanization enters the algorithm only through the transformation
matrix C . The internal coupling between the state vector components is the same for all of them and we can use the "North
Indicatini3ystem (NIS)" as basis for further discussion.
Fig. 4.6.1 shows without simplifications the block diagram for the erroneous signal flow in an NIS. The lower feedback for slewing
the vertical platform axis is proportional to tan$ , indicating that inertial navigation with this kind of mechanization is impossible
for polar flights. In the discussion of this section we will stay in the allowable latitude ranges (e.g. $ < f 88.5 deg for the
Ferranti FE 500).
For flight times above 6 minutes, the drifts of the horizontal gyros become significant. The Coriolis acceleration errors and the
earth rate couplings are of importance after approximately 2 hours.
If the N I S is standing on the ground, the dynamics of its errors for long periods are described
711, Eq. (7-49)):
(4.6.1 1)
= os f
wj
a, see Figures 1.1 and 4.6.1 feedbacks C and also Figure 2.14.
The first two frequencies characterize the Foucault-modulated Schuler oscillation, i.e. the oscillation of a freely swinging pendulum
of length R on the rotating earth. The oscillation plane of this pendulum stays, as it is well known, inertially fixed, i.e. it rotates
with respect to the earth with the negative vertical component of the earth rate.
The third frequency characterizes the 24-hour oscillation, i.e. the motion as indicated in Fig. 2.13, which is carried out by a
84
o w
m
:
m
W
U
.>
.>
W
II
-w
U-
cum
U >
nu
3
:c
m
Lzg
II
-01
*.
_I
I--
O L
u a
1 YI
4
1
I
I
I
I
I
I
Figure 4.6.1 Block Diagram for the Signal Flow in a North Indicating System (NIS) Subject to Errors
85
The linearized error Eq. 4.6.12 for the M S is arranged in a way to alleviate the insight into the relationship between left and
right hand side.
(4.6.12)
[ 66
6);
63,
6V,
I/R
-6 /R
-2Asin$
l/(Rcos$)
-(Rcos$ +
/cos$)
-!&in$
2Q'sin$
-1/R
(VNtan$-h )/R
1/R
-tan$/R
Asin$
-4
Aces$
-g'
g'
+E
-vN
-Asin$
Acos$
wQ
WA
WbN
WbE
WdN
WdE
wdD
0)
V,/R
R + A
V,
+ ZR
+ A/2
' V ~ S+ ~h~Q ~
V,/(RCOS~
GE
& + h
V, -
sin# - hcos4)
g + h . - 2VER'C0S4 - Q v,
A6h/R
6h/R
g' =
AA' =
A&; =
6h/R
- A C O S ~6h/R
A s i n 4 6h/R
- E$ 6h + (VE A sin4 + h g ) 6h/R
-2R'cos4 6h - 2); (VNsin4 - hcos4) 6h/R
uncorrelated noise.
The third last column on the right hand side of Eq. 4.6.12 contains terms proportional to 6h and ah. They are separated from the
horizontal components of position and velocity errors, since their contribution is fairly often negligible so that the M S horizontal
and vertical axes can b e separated, as shown with the following numerical example.
The altitude error 6h causes-an error in the platform slewing corresponding to a gyro drift d' and both 6h and 6h a corresponding
accelerometer error b'. For A G 4 f R or V G 1000 km/h at 4 = 45 deg we obtain:
(4.6.14a,b,c)
d'
3 . los3 deg/h
and
b'
b'
3 . lo-' g
3.
per 6h = 1000 m.
per 6h = 10 m/s.
Eq. 4.6.12 is of the type 4.2.5 and can be used in a Kalman filter for modelling the errors of any INS, i.e. the north indicating
system (NIS), the wander azimuth platform system, the space stabilized platform system employing electrostatic gyros and the
strapdown system (SDS). This statement is true as long as "north and south" are still meaningful, i. e. the regions of the
geographic poles are exempted. The state vector consisting in this equation of the position errors (64, 6A), the velocity errors
(6V,, 6V,) and the attitude and heading errors (E,, eE, eo) has to be supplemented by the model of the sensor errors, i.e. the
accelerometer errors (6f ,6f ) and the gyro errors (6wx,6,w ,6wz) in the coordinate frame of the measurement axes. In case they
are modelled as bias tern% &th additional uncorrelated n o d , Eq. 4.2.3 for the single axis INS may serve as an example. It should
also be emphasized that the transformation matrix Cn, between the sensor measurement axes and the axes of the navigational
coordinate frame is properly considered as pointed out above. For a system in flight all components of the so-called system matrix
P are maneuver-dependent coefficients. The state transition matrix for predicting the INS errors thus can only be computed online.
For using the error model 4.6.12 some more practical hints. If an NIS has to be modelled, the accelerometer error BN,Eshould
not be included in the state vector, because it is not observable. These sensor errors cannot be distinguished from a platform
misalignment, i.e. the state vector components .zEN 5
11 comprise them, too. In all other cases when the accelerometer axes are
not always held parallel to the axes of the nawgational coordinate frame, the accelerometer biases are observable and worth
modelling.
At the end of an M S selfalignment mode discussed in Section 5 , the accelerometer errors B, are compensated by a platform tilt
about the horizontal axes and the east-west gyro drift DE is compensated by an azimufE offset eo. These conditions remain
en the N I S is switched from the alignment to the navigational mode, but still is geostationary. So theoretically these sensor
errors do not directly cause a position error growth at the beginning of the navigational mode. They do it indirectly only due to
86
the cross-track error which according to Eq. 4.2.28 depends upon the azimuth misalignment tD which again depends upon DE at
the end of the alignment mode.
The situation is different for the north-south gyro drift. At the end of the alignment mode it is compensated by a platform tilt (s.
Fig. 5.4) unless the gain
is shunted by an integrator (s. Fig. 5.4). In the former case the east-west position error increases
immediately after switching into the navigational mode.
All items mentioned above are also valid for the geostationary strapdown system (SDS). But when this system is moved, the
equilibrium between sensor error projection in the north-south, east-west and down directions and the misalignment angles is
disturbed as indicated in Fig. 2.14. Due to this maneuver-dependency all sensor errors are observable in a Kalman filter and are
worth modelling.
The theory discussed above is confirmed in the measurements of a stationary Litton LN-3A platform INS plotted in Fig. 4.6.2 for
the velocity and position, and the Schuler oscillations as well as the initial part of a 24-hour oscillation are distinctly to be seen.
The INS in-flight system errors differ from the stationary system errors by the maneuver-dependency of several contributors, as
to be seen from Fig. 4.6.3.
There are firstly the cross-track velocity (6VNE E, f tD.VEN) and position errors (6SN, E f cD.AS ) as outlined in the
previous section. They are common to all inertial' navigation sysfems and are superposed to the Schuler oscf&ons.
There is secondly the fact that with strapdown systems the sensor errors are effective within the body-fixed axes, i.e. they act
within the navigational coordinate frame via the maneuver-dependent Cn,matrix (s. Eqs. 2 . 4 1 ~and 3.11 as well as Fig. 2.14).
There is thirdly the fact that the sensor errors themselves can be maneuver-dependent as within mechanical gyros, for instance
(s. [St. 821).
In order to estimate the accuracy of a geostationary INS over more than 2 hours time of flight for a certain class of sensor and
initial alignment errors comprised as 1-0 values, Eq. 4.6.12 was solved on a digital computer and its results have been plotted in
Fig. 4.6.4 as 1-U INS errors over a 6-hour and a 36-hour period. They describe the two-dimensional Gaussian distribution of the
horizontal position error (s. Fig. 4.6.5 and 4.6.6). From the effect of the various uncorrelated error sources on the position error
the following can be stated:
-As V = 0, the cross-track error does not become significant.
-For short periods of up to 1/2 h in the north-south channel or 2 h in the east-west channel the influences of the initial
misalignment and of the accelerometer bias are identical, which can be explained by the fact that initially the azimuth
misalignment does not become significant.
-In the north-south channel the initial misalignment causes a mean position error increasing linearly with time - according to Eq.
(4.2.24b) the azimuth misalignment has the effect of an east-west gyro drift.
-The gyro drift causes a mean position error increasing linearly with time, which is due mainly to the horizontal gyros. According
to Eq. (4.2.25) the vertical gyro drift of a stationary NIS after a time of
(4.6.15)
causes the same mean position error as that produced by an east-west gyro drift of the same amount. However at longer times
the effect of the vertical gyro drift becomes dominant.
The two components of the horizontal velocity error or the horizontal position error have Gaussian distribution as indicated in Fig.
4.6.5. Horizontal sections through this distribution are error ellipses as described by the exponent of p(x) in Fig. 4.6.5 and as
shown in Fig. 4.6.6 for the position. The projection of the ellipses on the north-south and east-west axes are the 1-U values
obtained from Eq. 4.6.6 for SNE. For system specification these 1-U values in the two axes are not so convenient; the
manufacturer often gives the oveiall specification in form of the CEP or SEP (circular error probable, spherical error probable)
value which in a two-dimensional or three-dimensional case is the radius of a circle or sphere comprising the errors with 50 %
probability unless otherwise mentioned (e.g. CEP,, or SEP,, corresponds to 95 % probability) [STA 1. The CEP can be
computed from the corresponding elements of the covariance matrix as pointed out in [Ka 691. In the example of Fig. 4.6.6 we
obtain, with u N = 5.62 km, uE ;3.81 km and p = - 0.8, the 50 %
' and 90 % probability circles CEP = 5.0 km. For equal U-values
in all three dimensions we obtain for instance: SEP = 1.5382 U.
87
0.01
-fN
s *]
[m/
-0.01
5
6V
53
-5
time [h]
time [h]
10
-10
Figure 4.6.2 Velocity and Position of the Stationary Litton LN-3A Platform Inertial Navigation System
88
1
E:
.r(
'0
c8
e,
5:
30
20
10
5@
40
60
70
FO
70
90
80
100
time [min]
0.e
0.6
0.4
0.2
0.0
-0.2
-0.4
-0.6
-0.8
- 1 .o
IO
50
20
50
40
a0
90
100
time [rnin]
200
-1looI
'
10
'
20
'
30
'
'
40
.
A
.
-
' . '
53
60
70
80
90
.
100
time [min]
Figure 4.6.3 Typical Flight-Test Results of the Litton LTN-90 Strapdown Inertial Navigation System
89
10.0
(ij Effect of i n i t i a l platforn misaiignment
6%
L O O
Kfl
2.0
0.
time [ h ]
10.0
8.0
6.0
6%
4.0
Kfl
2.0
0.
[hl
time
12
2L
time [ h ]
0.
90.C
60.
bSE
Kfl
30.
1 I
_-
----
---
0.
12
36
1
i
-
time
[hl
0.01 deg/h,
O(B,.,~) = 0.0001 g.
u(DN,E,D) =
36
90
)T
6SNkm
5,62*
2
-0,8.3,81 5,62
3,812
Figure 4.6.6 Position Error Ellipsis and Circular Error Probable of a North Indicating System
91
Literature Chapter 4
[Au 91 J Ausmann, J. S.: "Baro-Inertial Loop for the USAF Standard RLG I N . "
Navigation: Journal of The Institute of Navigation, Vol. 38, No. 2, Summer 1991, pp. 205
- 220
[KO901 Kohl, KW.: "A new High Accuracy Ship's Inertial Navigation System PL4l MK4."
Proceedings Symposium Gyro Technology 1990, DGON and Universitaet Stuttgart, 1990
[Le 871 Levinson, E., Majure, R: "MARLIN - The next Generation Marine Inertial Navigator."
Proceedings Symposium Gyro Technology 1987, DGON and Universitaet Stuttgart, 1987
[Ma 781 Magnus, K: "Kreisel als vielseitige Hilsrnittel in Luft- und Raumfahrt."
Zeitschrift fur Flugwissenschaften und Weltraurnforschung 1978, Vol. 2, pp 217 - 227.
[NM 841 "Digital Air Data Computer, Part No. 12238-3, Maintenanca Manual with Illustrated Part List, 34-10-10"
Nord Micro, Oct. 15/84
[Re 85J Redeker, A, Voersmann, P.: "Precise Vertical Speed Reconstruction Based on Vertical Acceleration and Barometric
Altitude."
Z. Flugwiss. Weltraurnforsch. 9. 1985, Heft 4
[STA ] " Standardization Agreement; Subject Method of Expressing Navigation Accuracies."
North Atlantic Treaty Organization, STANAG 4278
[St 80J Stieler, B.: "Fahrzeug mit einer Plattforrn fuer eine Ziellinienstabilisierung in Verbindung mit einem Inertialsystem."
Deutsch Patentschrift DE 3019743 C2, Anmeldetag 32.5.1980
[St 821 Stieler, B., Winter, H.: "Gyroscopic Instruments and their Application to Flight Testing."
AGARD-AG-160-Vol.15, 1982
[St 941 Stieler, B.: "Generation of an Altitude Reference Using a Conventional INS.
DLR-Mitt. 94-xx, 1994
[Wi 75 J Winter, H.: "Messung der Vertikalbewegung eines Flugzeugs."
Deutsche Luft- und Raumfahrt, Forschungsbericht 75-4 1
[ w u 80 J Wuest, W.: "Pressure and Flow Measurement."
AGARD-AG-160-Vol.11, 1980
92
The initial self-alignment loop or gyrocompassing loop of a stationary inertial platform is in principle the electronic equivalent of a
mechanical gyrocompass used as a heading reference on ships.
The gyrocompass is in principle a damped gyropendulum with a horizontal spin axis and a separation between center of gravity
and center of support of about 1 mm. In the geostationary case this is a northseeking instrument, the input signals being the
rotation of the earth and gravity. It has a settling time in the order of 4 hours.
In the following we will briefly review the principles of the gyrocompassing loop of an inertial platform and the accuracy achievable
for the initial alignment.
5.2 The G y r o c o m p a s s i n g Loop of a n I n e r t i a l Navigation S y s t e m
In Section 2.1 we have discussed the effect earth rotation has upon a free gyro whose spin axis is slightly misaligned with respect
to the earth axis. This gyro will carry out a 24-hour motion around Polaris (s. Fig. 2.5).
Fig. 5.1 shows in principle the mechanical gyrocompass differing from the free gyro in Fig. 2.5 through the pendulosity only. Its
spin axis is nearly horizontal. Once disturbed from its equilibrium, namely true north, it will oscillate in an elliptic cone about this
equilibrium with a frequency adjustable by the pendulosity or it will align itself with true north if it is damped as indicated in this
figure.
Fig. 5.2 indicates how the pendulosity and the damping can be replaced by an accelerometer
and two feedback loops. The
accelerometer input axis is aligned with the spin axis. Its output signal is fed via the gain - K
to the horizontal torquer for
raising the frequency, and via the gain - K, * H to the vertical torquer for raising the damping opthe sensor's oscillation.
Fig. 5.1 The Motion of the Undamped and the Damped Gyrocompass
Fig. 5.2 The Gyrocompass Implemented with a Free Gyro, an Accelerometer and Two Feedback Loops
93
We find the same interconnections in the simplified gyrocompassing loop of an inertial platform whose block diagram is shown in
the lower half of Fig. 5.3. The output of the north-south accelerometer A causes a platform rotation w, and 0 , about the eastwest and the down axes via the gains -KE and - K,. The upper half of tge block diagram shows the levelling loop for the northsouth axis.
One of the simplifications in this diagram concerns the model of the free platform ( S . Fig. 2.13) which has been reduced to the
coupling of the vertical misalignments into the east-west axis via the horizontal component of earth rate Q.cos 4. The coupling
between the horizontal axes via the vertical component Q.sin of earth rate has been neglected, which is acceptable since the
horizontal misalignment angles are smaller by one order of magnitude than the azimuthal misalignment as indicated in Table 2.1
and as will be shown below.
5.3 Equilibrium and Sensor Calibration a t t h e End of t h e Alignment Process
From the block diagram in Fig. 5.3 one can easily derive t h e following relationships for the equilibrium of the platform at the end
of the alignment process when the inputs to the integrators are zero:
- for ideally compensated sensors, i.e. no accelerometer biases (BN,E = 0) and no gyro drifts (D,,E,D= 0) the platform will be
ideally aligned with the vertical and true north:
- the horizontal accelerometer biases (B, E 0) are compensated by corresponding gravity components generated by horizontal
platform misalignment angles (remember the accelerometer output signals are null in the equilibrium phase in this case):
(5.2)
E,,,
= f BE,, / g (=
. I mrad = 20 arc sec for B,,, =
9);
- the east-west gyro drift (DE 0) is compensated by a corresponding component of the horizontal earth rate generated by a
vertical platform misalignment angle in the equilibrium phase:
(5.3)
cD
DE
/ (R.cos 4)
- if in addition the north-south and the vertical gyros are corrupted by the drift D,,,,
equilibrium phase additional control offset signals:
= 45');
(5.4)
Whilst the accelerometer biases B,, and the east-west gyro drift DE cannot be measured - their effect is compensated by gravity
or earth rate, respectively - the' north-south and the vertical gyro drift D,,, cause an output voltage of the horizontal
accelerometers and thus can be measured.
The additional tilt due to D,, and thus the control offset voltage, can be reduced by setting the loop gain K, high or preferably by
shunting the amplifier of the levelling loop with an integrator as indicated in Fig. 5.4 for the north-south gyro drift. In practice
only this sensor error is compensated in the manner shown. The vertical gyro drift can only be measured by means of the synchro
mounted on the vertical gimbal axis, which requires the absence of any platform motion.
Eq (5.3) is applicable to all north-seeking methods with gyroscopic sensors. These methods are limited to 80 deg latitude,
approximately (= 76.5 deg for Delco Carousel lV platform system). Note that only the initial self-alignment of the INS is limited
to this latitude; the actual navigation function can b e performed at all latitudes (s. Section 4.3).
If we choose the following gains in the gyrocompassing loop of Fig. 5.4:
(5.5 a,b)
1/(2gT),
K,
K,
K,
1/(16gT Rcos
4)
KL
K,
Qcos
4,
both loops - the north-south levelling loop and the gyrocompassing loop - have the same dynamics, namely four equal roots w i t h
the time constant:
(5.6)
~ = 2 T = 6 0 s
(the figure was selected in laboratoy tests [St 781) and the problems of compensating the north-south gyro drift and of vertical
platform alignment are alike.
If the gyrocompassing alignment loop is implemented in this fashion, the system will carry out the elliptical motion as shown in Fig.
5.1; the semimajor axis of the ellipsis is then proportional to the vertical or azimuthal misalignment and the semiminor axis to the
east-west or horizontal misalignment. With the time constant mentioned above we obtain as ratio of both axes 140, i.e an initial
horizontal misalignment excites a much bigger disturbance motion of the gyrocompassing process than an initial vertical
misalignment. In order to speed up the alignment process, it is advisable to split it up into two modes - the levelling and the
gyrocompassing mode. During the former the horizontal misalignments in both axes are minimized with a levelling loop as
indicated in Figs. 5.3 and 5.4 lasting 1 min approximately. During the subsequent gyrocompassing mode the azimuthal
misalignment is minimized during 8 min approximately. The figures quoted are valid for the Litton LN-3A platform system.
It is shown in [St 781 that for strapdown systems another alignment concept has advantages as compared to the control loops
shown in Figs. 5.3 and 5.4. Only two levelling loops are implemented here, and the steady state signal to clamp both horizontal
axes to gravity are proportional to the north-south system drift D, and the vertical misalignment E,. Both parameters are
estimated with the use of a simple Kalman filter neglecting all system dynamics. The major advantage of this concept lies in the
fact that the estimation of both parameters becomes with time increasingly insensitive to vehicle sway due to wind gusts or
94
I K" I
Vo
Drift
Vertical
and oise
Gyrocompassing
Loop
East Gyro
Drift and Noise
I
1-4
1
<
1 1% I
Norkh Accelerometer
Bios and Noise
Figure 5.3 Simplified Block Diagram of the Gyrocompassing and the North Levelling Loops for an Inertial System
North Gyro
Drift and Noise
I
I
North - South
Levelling Loop
Vertical G ro
Drift a n d t k s e
East Gyro
Drift o n d Noise
North Accelerometer
Bias and Noise
I
Figure 5.4 Simplified Block Diagram of the Gyrocompassing and the North Levelling b o p s
for an Inertial System Including Integrating Network for North Gyro Drift Compensation
95
baggage loading in an aircraft.
We have not yet mentioned the vertical accelerometer. Its output signal, which should be grevity, can certainly he used for
calibration. For the field-calibration of all sensor biases (DNE and B, E D ) and scale factors (S, E for the gyros, S, ,D for the
accelerometers) the gyrocompassing mode is carried out sev&ra? times with the input axes of each i>;o once in the nor# and once
in the south directions and the input axes of each accelerometer once in the up and once in the down directions, which requires 9
orientations of the platform. The s u m and differences of the currents into the north or south gyro iNs and into the up or down
accelerometer iu,D are evaluated in the following way:
(5.7a,b,c,d)
+ is
D = -S (I,
)/2
B = -S (io
iu)/2
S'
= (i,
sa
(iD -
is )/(2 R cos
4)
iu)/(2g).
So far we have discussed the initial alignment accuracy due to systematic sensor errors. We know that such errors can be
compensated once they are known, but the user has to live with a certain day-to-day variation of the systematic errors which
always limit the final alignment accuracy. Modern sensors, especially the ring laser gyros, have an unprecedented low systematic
drift so that the stochastic error known as random walk dominates. One cannot predict the effect of stochastic errors as we have
done for systematic errors. All one can predict is the expected value or the f l u band which encloses 68% of all samples. In
order to derive the f 1 U values for the azimuth alignment due to east-west gyro random drift, we use the integral of Eq. 5.3, i.e.
we divide the f 1u values for all integrated random drift angles through the integral of earth rate. The result is:
(5.8)
u(cD )
=
=
r(dE ) t'/*
P
O
/ ( R cos 4 - t )
r(dE) [deg/l/h ]
/ (R cos 4 . [ G I ) .
This equation is evaluated in Fig. 5.5 for a random walk coefficient of r(d ) = .001 d e g / F which is approximately the value
measured at DLR for the Honeywell GG 1342 RLG (U1 88). According to mjitary requirements the alignment time is limited to
below 4 min with an accuracy below 10 arc min.
CJ ( E ~ /) arc
min
4 Vmin 6
Fig. 5.5 Azimuth Alignment Accuracy Due to East-West Random Walk as a Function of Time
Literature Chapter 5
[St 781 Stieler, B., Zenz, H.P.,: "On the Alignment of Platform and Strapdown Systems."
Proceedings of the DGON Symposium Gyro Technology 1978, Stuttgart, Germany
[UI 881 Ullrich, D., Liibeck, E., Wetzig, V.: "Static and Dynamic Measurements with a Ring Laser Gyro."
Proceedings of the DGON Symposium Gyro Technology 1988, Stuttgart, Germany
96
Attitude and Heading Reference Systems (AHRS) will play an increasing role in future aerospace guidance and control due to the
increasing role of the Global Navigation Satellite System (GNSS) and its integration with inertial reference systems of reduced
performance. T h e latter is the keyword for describing the AHRS system structure. As already mentioned in Section 2, the AHRS
is no stand-alone system, but always integrated with other types of sensors or systems in a predefined control loop structure or
with the aid of Kalman filters. The margin between both types of system integration is floating.
The principles of a fairly simple AHRS system were already outlined in Section 2.1 in connection with the Vertical Gyro (VG) and
the Directional Gyro (DG). We will review them in this section briefly and describe some modem system implementations.
6.2 T h e
In Section 2 we have seen that the directional reference of the inertial navigation system (INS) and thus also of the AHRS can be
implemented as a physical or analytic platform. It was shown that its characteristics can be described in both cases by that of a
three axes free gyro with an ideal suspension. The AHRS signal flow is discussed in the following as platform implementation only.
Let u s first discuss the basic functioning of the "attitude and heading reference" within the simplest AHRS application by looking
again to that of the VG and DG in Figs. 2.6 and 2.7.
We recall that in the INS the accelerometer output signals were used in a first step to compute groundspeed and in a second step
to compute the Schuler feedback for platform slewing. This resulted in an ideal vertical reference with an 84-minute Schuler
period of the closed loop, but required gyros of "inertial qualitf (s. Section 4.2.2.1).
The vertical reference in Figs. 2.6 and 2.7 for measuring attitude is based upon bubble levels or accelerometers for sensing the
misalignment about the horizontal axes. Their output signals are directly used for gyro or for platform slewing for nulling the
misalignments as shown in these figures.
Assuming in Fig. 2.8 the gain
defines the system's tuning about the horizontal axis. The time constant:
T = D,/(g
K,)
is much smaller than in an INS and the requirements for the gyro performance can be reduced by at least one order of
magnitude. Even this sensitivity to constant or slowly varying gyro drift is reduced by the additional integrator within the control
loop.
These advantages are paid by the increased sensitivity of the misalignment angles to horizontal accelerations. As indicated in this
figure, the most simple means to cope with this effect is the cutoff of the feedback at B certain acceleration level.
The directional reference for measuring heading is based in an AHRS upon a magnetic compass for sensing magnetic north, i.e.
based upon a so-called flux-gate as indicated in Figs. 2.6 and 2.7 (s. Chapter "Magnetic Heading References") or based upon a 3axis strapdown magnetometer. The difference between AHRS north and compass north is used for gyro or for platform slewing to
magnetic north.
The flux gate has its built-in vertical reference which is not as accurate as the AHRS vertical reference. The integration of a 3axis strapdown magnetometer with an AHRS is thus the system concept of higher performance.
Soft and hard iron induced magnetometer errors can fairly well be calibrated with the help of the gyros within the AHRS. For this
purpose the aircraft standing on the airfield is rotated about the vertical axis with respect to magnetic north and the vertical gyro
readings and magnetometer readings are evaluated with special software described in [Ba 85, St 901, for instance.
6.3 T h e A H R S with Doppler Aiding
The Doppler-aided AHRS is of higher performance than the one mentioned above. It has true navigational capability and is a
preferred system for helicopters. It combines the advantages of the INS and Doppler, i.e. accurate attitude heading and
groundspeed with reduced time-dependent position error growth.
The AHRS for this application is in principle identical in its signal flow to an INS (s. Fig. 4.2.5), cut is equipped with sensors of
lower performance. Its Doppler aiding consists of feeding the differences between the inertial velocities and the Doppler velocity
back into the AHRS to correct the system attitude, heading and velocities.
Fig. 6.1 shows the error block diagram of a so-called third-order in-flight gyrocompassing loop, whereby the Doppler velocities
measured in the body-fixed coordinate frame are resolved into the north and east directions by the attitude and heading angles as
measured by he AHRS. This is indicated in the upper right corner of Fig. 6.1. Due to the feedback in the horizontal channels, the
Schuler oscillations of the AHRS are damped and the frequency is augmented: the loops are N-times Schuler tuned and often
critically damped.
fairly simple analysis reveals the ground speed error 6V due to a Doppler velocity error 6vd, to an accelerometer error b and
to a gyro drift d C means "variable in the Laplace domain"):
91
8,
East Accelerometer
Horlh Gyro
I
I Longitude
! Error
1
-
0,
cos q
I
Vertical Gyro
I Lotitude
I Error
1
-
East Gyro
North Accelerometer
6V:
Resolver
6VdcosJ, - E~ V d sinq
6V =
(6.3a)
ss
[s2 +
1
+ (w')*(l
H
-)
R K,)]
[sc
+ gz
(sK,
LOOP
gK,) 6?].
6V
11 4. R K11
[D
+ K,SVd]
.01 RD
+ 6vd.
The latter is valid for the following gains used in the Singer Kearfott AHRS of the type SFIM 253 A
(6.4 a)
with w
(6.4b)
1
=
RK, z 100
w f
10 w s
K,
P 14 w s
.l,
The Doppler noise is thus damped out and the navigation system error follows the low frequency Doppler error, but reduces the
effect of inertial sensor errors upon navigation accuracy.
Fig. 6.1 also shows that the north velocity difference between the AHRS and the Doppler is fed back to the vertical gyro to
correct the azimuth AHRS misalignment. Though neither the AHRS nor the Doppler radar "knod the direction of true north,
both find it "hand in hand" by means of this feedback signal. This in-flight gyrocompassing becomes feasible, since due to earth
rate the errors of this AHRS caused by an azimuth misalignment differ in the north- south channel from those of a Doppler
system with external heading reference, i.e. a conventional dead reckoning system. In the east-west channel the INS error due to
98
the azimuth misalignment equals the conventional dead reckoning system through the well known crosstrack error, and feeding
back the corresponding velocity difference is of no use. For verification compare in Eq. 4.2.5 64(t) = f(ED) and 6h(t) cos 4 =
f(ED).
Eq. (4.2.28b) finally reveals that also in the north-south channel the INS error is equal to that of the dead reckoning system, if it
is initially aligned using the stationary gyrocompassing procedure. From this we may deduce that Eq. (4.2.26b) also limits the inflight gyrocompassing accuracy under the presumption that the Doppler velocities are measured accurately in the body-fixed
coordinate frame.
Since the AHRS is equipped with lower quality gyros,. this in-flight gyrocompassing is not applied in general and it is always
integrated with a sensor for magnetic north.
6.4 Modern
AHRS Implementations
From the previous sections we may deduce the following principal differences between the modern AHRS and the INS
implementations:
-The AHRS is equipped with sensors of lower performance; fiber optic gyros (FOGS, see Appendix 0) are very promising sensors
at present, micromechanical gyros and accelerometers have the potential to penetrate this application in t h e future [Ma 92, El
911.
-The computation of the analytic platform (see Section 2.4 and Appendix D), i.e. the high frequency data processing is identical in
principle in both systems, the AHRS and the INS.
-In contrast to the INS the AHRS always depends upon external sensors as for heading (magnetic compass), for ground speed
(Doppler radar or air speed indicators) or for position (ground- or satellite-based radio stations) aiding.
For the development of the proper aiding software on the basis of Kalman filtering modern AHRSs can be treated in their error
models like an INS (see Section 4.6), whereby the lower sensor performance is reflected in the initial covariance matrix and the
system noise matrix.
In integrated AHRS-based navigation systems available on the market one can find fixed gain control loops again, as discussed in
the previous sections [Ha 891, which often are the result of a laboratory Kalman filter simulation.
,
Literature Chapter 6
99
Appendix C
Coordinate Frames f o r Inertial Navigation
C 1 Introduction
I
This appendix is written by the authors of Chapters "Navigation Coordinate Frames" [Ku 941 and "Inertial Navigation" in order to
harmonize the coordinate frames with the practical requirements of inertial navigation and to introduce notations used in this
chapter. Notes in { ) refer to [Ku 941 and those in ( ) to this chapter.
For navigation in a geodetic system, the required reference is the Earth Centered Earth Fixed (ECEF) coordinate system or the
Conventional Terrestrial System {CTS) It is called earth-fixed coordinate frame (index e ) in this chapterdefining positions in a
three-dimensional frame on the surface of the earth and its adjoining space [Ku 94, Section 5).
At time zero, the basic Earth Centered Inertial (ECI) (index i) system and the Conventional Terrestrial System {CTS) (index e)
are assumed to be coincident. Currently, the zero epoch is J2000.0, which is defined to start at noon on 1 January 2000 [Ku 94,
Section 31.
The rigorous transformation from ECI to CTS frames are described in [Ku 94, Section 41. However, for the purpose of navigation
and the accuracies involved, we can make certain approximations.
To achieve the above, the matrix [D] for precession, matrix [C] for astronomic nutation, and the matrix [A] for polar motion
defined in Chapter 1 can be omitted. This approximates the relationship between the X1 and XS frames of [Ku 94, Section 41 to:
XS = [B] X1 with [B] according to Table 7 and A according to [Ku 94, Table 11.
In this chapter we use the orientation of the i- and the e- frames as shown in Fig. C1, i.e. with their origin in the center of the
ellipsoid, the x-axis pointing to geodetic north and the y- and z-axes in the equatorial plane. At t = 0 the z-axes of both systems
are pointing to the Greenwich meridian. For inertial navigation we reduce the rotation angle A contained in [B] by A = R -t with:
(C 1)
deg/h.
The matrix cooresponding to [B] in [Ku 94, Table 71, for vector transformation from the e- to the i- frame is thus:
The reference navigational coordinate system (index n) for inertial navigation is the local geodetic system defined in [Ku 94,
Section 7.21. Its origin is in the proof mass of the accelerometer or the origin of the inertial measurement unit (IMU). Instead of
the sequence of axes east, north, up {E,N,U) used in [Ku 941 we use north, east and down (N,E,D
x,y,z) in this chapter. The nframe is the result of a first rotation with respect to the e-frame through the geodetic longitude about the xe-axis, a second
rotation through the geodetic latitude $ about the y -axis and a translational motion through the geodetic height h to the nframe origin mentioned above. The matrix correspon&ng to Rx(90-9). Rz(h+90) in [Ku 94, Eq. 241 for vector transformation
from the n- to the e-frame is:
0
-sin$ sinh
sin$ cosh
cosh
sinh
-sin$
cos$ sinh
cos$ cosA
For C i n replace in this relationship the geodetic longitude A by the celestial longitude:
(C 4 )
A = h + R t .
(C 3b)
cosh
sin$ cosh
sinh
-sin$
cos$ sinh
cos$ cosh
The actual coordinate frame for inertial navigation is the horizon or the local level system [Ku 94, Section 7.41. Due to the
"deflection of the vertical" gravity in the n-frame has small horizontal components:
which, when left uncompensated in t h e computer, are nulled during the initial alignment of the inertial navigation system (INS).
T h e true rotation of the actual navigational frame with respect to the e-frame is thus:
, y ,z
inertial
XsXe
frame i
x, , y e , z e e a r t h - f i x e d frame e
x,, y,, z,
navigational
frame n
present point of
measurement
Greenwich
meridian
l o c a l meridian
Earth R a t e a n d
Transport R a t e in
t h e n -Frame
Fig. C 1 The Inertial, the Earth-Fixed and the Navigational Coordinate Frames
101
4'
(C 6a,b)
4 - <,
X' = X
r)
cos
4.
In conventional inertial navigation systems with 1 NM/h position error growth these effects are neglected.
The vector for the s u m of earth rate
with
[Ku
2Section and
= {\)
= {RJ the radii of curvature of the reference ellipsoid in the meridian (N-S) and of prime vertical plane
6.3.11.
C 3 T h e Body-Pixed C o o r d i n a t e F r a m e
The body-fixed coordinate frame (YPR)(index b), i.e. the coordinate frame fixed to the aircraft and relates with the navigational
or the local level system {E"N"G) through attitude and heading
as the yaw angle, P as the pitch angle and R as the roll angle).
In this chapter we use the international standards of flight mechanics [Std 701 (s. Fig. C2) with the Euler angles defined by the
following sequence of rotations from the navigational into the body frame, i.e.:
- the first rotation about the zn and zb "f's (both are parallel in the beginning) through the yaw angle Y,
- the second rotation about the y, axis lyng still in the horizontal plane through the pitch angle 8 and
- the third rotation about the xb axis through the roll angle O.
L"
Figure C 2 The Body-Fixed Frame (Index b), the Local Geodetic or Navigational Frame (Index n)
and the Euler Angles for Aircraft Roll (0), Pitch (e) and Yaw (Y)
The matrix C, for vector transformation from the b- to the n-frame is composed of 3 transformation matrices
(C IOa,b,c)
Cn
= C(O)-C(e).C(Y).
=I
cos0
as''
c o s 0 sin''
-sine
sin+
s i n 0 cos''
cos+
sin''
sin+
s i n e sin''
+cos+
cos''
sin+
cos0
as+
s i n 0 cos''
+sin+
sin''
s i n 0 sin"
-sin+ cos''
cos+
cos+
case
'12
i
'l
l
'22
'31
'32
'13
32'
c33
102
In platform systems the 3 Euler angles are measured at the gimbal axes with angle encoders. In strapdown systems they are
computed from the elements of the C,, matrix:
(C lla,b,c)
0 =
tan-'
tan-'
sin-' C,,
c,,/c,,
c,, /cl,.
C . T h e Wander Azimuth Coordina : F r a m e
The wander azimuth coordinate frame (subscript "a", s. Fig. C 3) or the generalized local geodetic system [Ku 94, Section 7.31 is
rotated about the vertical with respect to the navigational coordinate frame through the "wander angle a".The angular rotation
vector between both frames is:
(CW
= (0
O:
oc)T.
north pole
wander a n g l e -
geographic-
(C 13)
c,,
CT" =
cosa
sina
sina
cosa
103
(C 16)
3,Section
(Q},
=
v
cav,
(G}areHgain
the radii curvature of the reference ellipsoid in the meridian and the prime vertical plane
(V
=
6. .1].
-h)T
o?
T h e matrix C,, for vector transformation from the a- to the e frame is essential for the computation of position A, $ and the
north direction a:
cos$ cosa
-cos$ sina
c,,
C,;Cna
sin$ sinX s i n a
+cosX cosa
-cos$ sinX
cos$ cosX
+cosX sina
-sin$
Cll
c12
c2,
c22
:;:
c3,
c3,
c33
The navigational coordinate frame (s. Section C 2) is the reference frame for navigation with respect to the earth. In the North
Indicating Platform INS (NIS) the platform is slewed to this direction (s. Fig. 1.1 and Section 2.2). In strapdown systems it is a
computed reference frame (s. Fig. 1.2 and Section 2.4). In both cases we have to assume a small angle misalignment of the
platform (index p) or the computed navigational coordinate frame (index n*) about all three axes:
i.e. the small angle vector E contains as its components the misalignments about the north, east and down axes as indicated in Fig.
C 4. The small angle transformation matrix C in case of the platform system or C,,. in case of the computed frame can be
nP
written as:
I
(C 20a)
= ( I
= C,,'
Cnp
E),
with I = unity matrix and E = skew symmetric containing the misalignment angles:
0
(C 20b)
E =
.ON -;
-ED
E,
+E
E X .
The right hand side of the relationship indicates that E may also be regarded as the vector cross product of
From both relationships it is obvious that:
( C 20c)
c:p
Cn.,
c:,.
Down,
(I
2,.
E).
1,
E.
104
Literature Appendix C
[Ku 94) Kumar, M.: Chapter "Navigation Coordinate Frames" of this AGARDograph
(Std 701 "Flugmechanik, Begriffe, Benennungen, Zeichen, Grundlagen LN 9300."
Beuth Vertrieb GmbH, Koln, 1970
105
Appendix D
Digital Readout of Inertial Sensors and
Strapdown Algorithms for the 'Analytic Platform'
D1 Introduction
In so-called "strapdown systems" the gyros and accelerometers are rigidly mounted to the vehicle and their output signals are
processed in the computer for attitude, heading, ground speed and osition computation. The sensor delivers analog signals in
general which are digitized and sampled at time intervals n * TS
= sampling time increment) for further processing in the
computer.
(g
Three different possibilities for digitizing the analog readout signal of inertial sensors are discussed in this section under the
aspect of subsequent high accurate integration. The digital integration process is the basis of attitude and heading computation
and inertial navigation. Its accuracy must be adapted to that of the measurement process. For the reference direction computation
with "inertial qualit)' with < .01 deg/h uncertainty, for instance, the integration error should be lower by at least 1 order of
magnitude. This makes it understandable that the following considerations apply primarily to the gyro measurements.
The three digitizing methods discussed are:
- the analog-to-digital converter (ADC), s. Fig. D 1,
- the voltage-to-frequency converter (VFC), s. Fig. D 2,
- and the pulse rebalance loop (PRL), s. Fig. D 3.
Not only the digitizing method is of importance for the subsequent integration process, but also the computation speed, i.e. the
sampling time and closely connected to it the algorithms for integrating the gyro and accelerometer readings into the computed
spatial reference direction, velocity and position. They are called "strapdown algorithms". This aspect will be briefly discussed at
the end of this section.
D2 Analog-to-Digital Conversion ( A D C )
The ADC converts the analog signal into a whole number digital signal with a resolution limited by the "least significant bit
(LSB)". Table D 1 lists some data of a high-accuracy ADC and Fig. D 1 shows the block diagram for a gyro with analog readout
and AD conversion. It also includes the subsequent sampling and the scaling by S', which comprises the gyro and ADC scalefactor.
The output signal U * is a whole number representation of the input signal w , but contains the sensor errors and the ADC errors
listed in Table D 1 plus the noise due to the limited resolution. Because of the roundoff process, information of LSB/2 may get
lost.
Table D 1 Data of the High Accuracy Analog-to-Digital Converter Type DAS 1153 of Analog Devices [AD 901
Resolution n:
Throughput ,Rate:
Nonlinearity
Nonlinearity Temperature coefficient (TC):
Gain T C
Zero T C
Power Supply Sensitiviv.
For ,
o
(D 1)
*f 2ppm/K
max
8ppmlK max
= 500 deg/s the peak value of this quantization error (uncorreleted noise) is:
6w,
= fLSB/2
= f o,/zn
(-
55 deg/h );
u6w = f LSB/I/ 1 2
* LSB/2.
Its standard
= f .289.LSB (= f 3 2 deg/h).
In order to derive the time dependence of the so-called "random walk" angle, i.e. growth of the standard deviation of the integral
of the angular rate roundoff noise over time, we assume a first order integration algorithm whereby the angular rate W * sampled
at time intervals TS delivers the angle increment of A + = a* .Ts for each cycle. The standard deviation of one integrated angle
= u6@*TS.As the A # * s add up to the total angle so do the angle error
error increment AE is obtained in the same way:
increments AES add up to the total error E. Since the ALESare uncorrelated from cycle to cycle, their variances have to be summed
up over the integration time. With n = t/T' the standard deviation of the integrated angle error is:
This result holds for all integrated ADC output signals. It also holds for the first order integration process in any digital
computer, where in critical cases, as with the strapdown algorithms discussed below, the word length has to be properly adapted.
This characteristic is called "random walk", whose uncertainty increases with t1I2. We define as corresponding "random walk
coefficient":
rADC
= LSB.V-
(=
Applied to the ADC-digitized gyro signal, we obtain for an integr on cycle of 50 Hz, which is a common value in strapdown
inertial. navigation systems, a random walk coefficient of .075 deg/ r h . Since this value is intolerable for inertial navigation, the
ADC is not recommendable for this application. This stochastic error is avoided by using one of the other two digitizing methods
106
IMd
U'
.Y
Fig. D 1 Block Diagrams and Signals for Analog (a) and Digital Gyro Readout (b) Using an Analog-to-Digital Converter (ADC)
107
G'
QO
1
VFC
r----------1
I
I
--
' Y '
I
- 1
-ti
Fig. D 2 Block Diagram and Signals for Digital Gyro Readout Using a Voltage-to-Frequency Converter (VFC)
108
QO
G'
AP
Reset
Counter
4 C'rP
IW '
A0
synchronized w i l h v o l l a g e
Ap
I Ap
Ap
Fig. D 3 Block Diagram and Signals for Digital Gyro Readout Using a Pulse Rebalance Loop (PRL)
I09
discussed below.
In Fig. D 4 simulation results are plotted proving the theory derived above. An ADC with LSB =
receives as input signal a
sine wave and the difference between the truncated and the exact sine wave was integrated over a time of 300 s. Ten runs were
simulated with different initial conditions for the input signal. The single input sample function shows the computed mean value
and standard deviation as well as the theoretical standard deviation according to Eq. D 2. The ten output sample functions are
plotted together with their
1 U bands computed for fixed times. The theoretical standard deviation according to Eq. D 3 can
thus b e compared with the calculated one - the correspondance is satisfying if it is kept in mind that it is based on ten sample
functions only.
A = 7,78
Asinot
CO
= 6,464 rad/s
T, = I s
$+-
LSB=103
xa for 10 runs
J ~ ~
J ~ ~
10.2
. .
300s
300s
-5 10.4
-10-2
Fig. D 4 Simulation Results for the Random Walk Error in the Integrated Output of an Analog-to-Digital Converter
D3 Voltage-to-Frequency Conversion ( W C )
In the VFC the analog output voltage of a gyro is converted into a pulse train, whereby each pulse A P carries the same
information proportional to the input voltage. In the case of a gyro A P it is an angle increment A+p. Its weight is derived from the
ratio OF voltage to frequency
(D 5 4
A P = umax/f,
(D Sb)
A W = wF/,
= 500 O/s
and ,f
= 1 MHz).
The frequency in the numerical example equals the high-accuracy synchronous VFC whose data are listed in Table D 2.
Table D 2 Data of a High Accuracy Synchronous Voltage-to-Frequency Converter Type AD652KP/BQ
of Analog Devices [AD 901
Output Frequency
Initial Gain Error:
Gain Temperature Coefficient (TC):
Linearity Error:
OfFset:
Offset:
Response Time:
lMHz
<*.5 %
< *25 ppm/K
<*SO ppm
<*2 mV
TC <25 pV/K
One period of new output frequency plus one clock period
This pulse train is fed to a buffer or reset counter which is read out at the sample time T by the computer and multiplied with
the scalefactor For processing by the integration algorithm. As indicated in Fig. D 2, the sampled angle increment A* is
proportional to a mean angular rate w .
110
The sampled angular increment ACP' is also corrupted by noise, known as "quantization noise" - at each sample time increment
just one pulse increment A W may have got lost. In reality this information is not lost, but saved for the next sampling cycle, as
can be seen from the simplified VFC block diagram in Fig. D 2. The input voltage U is integrated and the output of the integrator
is fed to a comparator. Each time the output voltage of the integrator exceeds a certain threshold, an electric charge increment
AQ of a precisely known area is released to reduce the integrator's net charge. The voltage pulse A P is fed to a reset counter
The roundoff error remains stored in the integrator. The functioning of the VFC in Table D 2 is different, but here again no
information is lost.
D 4 T h e P u l s e R e b a l a n c e Loop (PRL)
A different approach for accurate readout of inertial sensors, the so called "pulse rebalance loop (PRL)" or "incremental caging
loop", is shown in Fig. D 3. A quantizer is placed into the rebalance loop releasing a current i of constant amplitude to flow
through the torque generator in positive or negative directions for the pulse time increment .Ip.The maximum input angular rate
is thus defined by the current level i flowing in one direction only:
but reduced by the fact that the current is not applied continuously but as a flow of electric charges Q, which need time to reach
the maximum level. The resulting torquer scalefactor S' is thus reduced by a certain amount, 10 % for instance.
With the so-called "binary pulse width modulation" - this will be discussed only - the current pulse is applied in the positive and
negative directions during one cycle, whereby the switching of the current direction is controlled by the input signal.
Due to the inductivity of the torquer coil the pulse rebalance torquing frequency is fairly low. A common value is:
(D 7a)
fQ
= 1
kHz.
Each positive and negative pulse is measured with readout counting pulses of much higher frequency:
(D
(the figure is taken from [Ra 77]), thus improving the resolution of one pulse to
(D 8 )
A W = o,/f'
500
O/s
).
The pulse evaluation is the same as mentioned for the VFC digitizing method.
Compared to the analog rebalance techniques and external digitizing process, the pulse width modulation torquing has the
following advantages:
- the dissipated rebalance energy within the sensor is constant and not proportional to w 2 as with the analog rebalance method
employed with the other two methods; this is an optimal basis for keeping the torquer at constant temperature and thus its
scalefactor at a constant value;
- it works only at two points of
the torquer characteristic line (torque = function of current), which is favorable for linearity;
- the scalefactor stability depends upon the stability of the constant current source only and not upon additional error sources of
the digitizing element (ADC or VFC).
Nonlinearities may arise in pulse-rebalanced sensors from eddy currents varying with the input signal. These effects are
minimized by observing certain rules in the design of the torquer [Ra 771.
Fig. D 5 shows two test results for the stability of a SDF gyro (Ferranti M 2519) and an accelerometer (Litef B 250) plus pulse
rebalance electronics designed at DLR [Ra 77).
The accelerometer readings were taken in 1976 during a period when earthquakes in China may have caused movements in the
foundation of the laboratory. The digital accelerometer readout, compensated for these movements, has a mean slope of 3 .
glday.
The gyro measurements were taken with the axes in the optimal orientation (output axis up). The readings prove that the stability
of t h e sensor in this position plus rebalance loop is better than 0.001 deg/h.
The pulse rebalance method may be used not only with inertial sensors but also with all sensors with compensation readout (e.g.
flow and pressure sensors).
D5 Computation Cycle and A l g o r i t h m s for Spatial D i r e c t i o n , V e l o c i t y and Position
I n t e g r a t i o n from Gyro and A c c e l e r o m e t e r D a t a
1/(2.TS).
In that case only the original signal can be recovered from the sampled signal. Once this sampling theorem has been violated, the
frequency spectrum of the sampled signal is contaminated by the so-called "aliasing error", which is impossible to correct
afterwards.
Fig. D 6 shows the aliasing error for the two cases that the signal vias digitized by the ADC and by the VFC or PRL method. For
illustration the sampling time has been chosen in both cases to be 20% longer than the sine wave period T. All sampled data
contain t h e aliasing error, i.e. they pretend a signal of much lower frequency, whereby the amplitude of the ADC-digitized signal
111
B 250
ooo uncompensated t e s t r e s u l t
... e r r o r due t o i n c l i n a t i o n o f foundation
xxx compensated t e s t r e s u l t
112
t-l
w*(TS = 1.2T)
Ts
Figure D 6 Aliasing Error Due to Sampling of an Analog Signal without Avaraging (ADC)
and with Avaraging over the Sampling Period (VFC, PIU) when the Sampling Frequency is Too Low
113
is identical to the input amplitude and the VFC and PRL digitized amplitudes are much lower. The latter ones are integrating
digitizing methods!
A common source for the high frequency content in the measurement signal of inertial sensors is the vibration due to the turbines
of an aircraft, for instance, or due to the piston motor of vehicles. In inertial navigation systems (INS) employing ring laser gyros
(RLG), the dithering mechanism of these sensors is another vibration source. The RLG is dithered with a 400 Hz frequency and
an amplitude of a few arc minutes, for instance. Neither for navigation nor for vehicle control the tracking of the high frequency
vibration is of importance, especially since its amplitude is fairly small in general. For inertial navigation another aspect is of
highest importance and because of this the sampling theorem has to be met: the core of the navigation computation is the
integration of the gyro and accelerometer measurements to the spatial direction reference, the velocity and position (s. Fig. 1.2).
Algorithm errors much smaller than the "inertial quality" mentioned above are required.
Let u s first concentrate on the computation of the direction reference, i.e. the computation of the C,, matrix in Eq. 2.21 and Fig.
1.2.
For motions in one plane only, the angle between two directions is the integral of a single gyro measurement - regardless of the
sampling time its accuracy at sampling intervals is limited by the quantization noise only. For spatial motions this is no longer true,
as visualized by Fig. D 7a. The so-called "coning motion" is shown here, i.e. a spatial sinusoidal motion about the two axes x and y
which are phase-shifted by 90. The analysis of the kinematics indicate, that the z-axis senses a continuous rotation, though the
coordinate system stays inertially fixed. If these angular rotations are correctly measured by the gyros and the algorithms for
computing the direction of the coordinate system are correct, the computed direction will stay inertially fixed as required. If the
sampling theorem is violated or the algorithms are of low quality, the reference direction computation will drift.
The so-called "non-commutativity, indicated in Fig. 7 b is another example of the requirements for spatial rotation integration. A
1" rotation about the x-axis and a 2nd about the y-axis bring the coordinate system into a position differing from that after a
reversed sequence of rotation. This shows us that in a vibrating environment the sampling theorem has to be met in a strict
sense, so that the computer can accurately follow the sequence of the spatial rotation.
The problem of strapdown algorithms touched off in Section 2.4 can mathematically be visualized after partially integrating Eq.
2.26 a:
where AOib(7) is the integral of the gyro measurements. The update of the first term on the right hand side of this equation is
not so problematic. It comprises the first order integration algorithm. The integral on the right hand side indicates the
contribution of the higher order terms. It depends not only on the integral of the gyro measurements, but also on the rate of
change of the transformation matrix, indicating that Eq. 2.26 can only be solved in the computer by means of approximations which
should be accurate enough so that:
- there is no drifting of
- the computed transformation matrix is "normal", i.e. its unity vectors remain unity in magnitude and
-
the computed matrix is "orthogonal", i.e. its unity vectors keep their orthogonality.
If Eq. D 10 is chosen for the computation of the C. matrix, only 3 of its elements can be derived independently of 3 gyro
measurements. The other 6 can be computed by the retuirements of normality and orthogonality. Due to the former the quadratic
sum of one column's or r?ds elements must be.unity:
(D l l a )
CZl
Cii
+ c;2 + CZ3
+ Cii + c23i
1,
and due to the latter the dot product of one row and one column must vanish:
(D l l b )
Though the direct integration of the C,, matrix according to Eqs. D 10 and D 11 is not the preferred way for integrating the
gyro data, this matrix is the core of the strapdown algorithms. We have called it "analytic platform" in Section 2.4 because the
acceleration measured in the body frame is transformed with its help into the navigational frame. Neglecting Coriolis and gravity
compensation, the latter is:
(D 12)
= ',b(')
'
v b(t)
The transformation of the accelerometer output increments into the navigational frame and their summing up is an integration
algorithm of first order only neglecting higher order terms due to the integral on the right hand side of this equation. A sampling
frequency adapted to the vibration environment and higher order algorithms are prerequisite for an acceleration transformation
and integration with sufficient accuracy. Otherwise the so-called "sculling errors", resulting from in-phase transformation and
acceleration errors as illustrated in Fig. D 8a, may arise and act like measurement signal errors.
Still another acceleration error source - the so-called "size effect" - has to be taken into account in a vibrating environment. It is
not due to an algorithm error, but due to the fact that the three accelerometers have different distances to the axis of rotation.
This is illustrated with the help of Fig. D 8b. Choosing in Eq. 3.5 the body-fixed coordinate frame (index n = b), neglecting earth
rate and setting R = r, we may derive the following output signals of the north and down accelerometers for a vibration with 8 =
114
0,=
Y
0,=
an sin Rt
pn cos nt
Z
1
-apn
-2
0,
dY
initial
position
x7
/"
x-axis
y-axis
after 90
1st rotation
about :
after 90
2ndrotation
about :
x+Y
X
/""
y-axis
' y
x-axis
Z
Figure D 7
The Coning Motion and an Illustration for the Non-Commutativity of Rotational Sequences
I15
1, - 4 0 0 H ~
a.
3 . 6 0 ~min
150/S
I7
A n /
w u v
i.p.4'1 J
Y
sculling a boat
Fig. D 8 Acceleration Errors due to Sculling (a) and Size Effect (b)
116
(D 14a)
(D 14b)
-(6)'-rX
= -
(b
rx
w cos ut)'
x rz = (rX t A?)
w 2 sin wt.
(D 15)
= a
cos 8 t a
X
(b
sin 8
rx [-cos2wt
U)'
t(l t
Arz/rx) sin'wt].
cos 2wt, i.e. zero in the mean, otherwise it is rectified. It is compensated in a RLG-INS.A survey of
For Arz = 0 we obtain a
computation and compens%ion problems in such a system is to be found in [Ma 821.
Two other ways of transformation matrix computation should briefly be mentioned
so-called "quaternions".
The rate of change of the Euler angles is governed by the differential equation [Std 701:
(D 16)
[i] [
=
sin+ tan8
cos+ tane
cos*
-sin*
sin*/cose
cos*/cose
1. [ i]
nb
with:
with
TI I '
. Section
gyro measurements.
The integration of the Euler angles and the computation of the C,, matrix according to Eq. 2.24 has the following properties:
Advantage:
Disadvantage:
The transformation matrix computation based on the so- called "quaternions" is most commonly used. The orientation of the bodyfixed frame with respect to the navigational coordinate frame can be described by one rotation through an angle 6 about one
axis defined with respect to the reference frame through the 3 direction cosines [Br 55) (s. Fig. D 9). These 4 parameters are
comprised in the 4 quaternions, written as a column matrix:
(D 18)
with
90
(qo
91
'1
%IT
q2
= cos(6/2)
q1 = cosa sin(6/2)'
q2 = COSSsin(6/2)
q, = cos7 sin(6/2).
Though the vector transformation can directly be based on quaternions using special algorithms, it is carried out with the
transformation matrix C,, in the strapdown computer. C,, is composed of the quaternion elements in the following way:
(D 20)
q = Q-w'/2,
where:
(D 21)
w ' = ( O
wy
ox
wz
IT
and
9,
Q =
-9,
91
9,
92
93
93
-92
-4,
-9,
-93
42
9,
-91
9,
9,
When initially both coordinate frames b and n coincide and the Euler angles (@o, l
U
' ,)oare
, zero, the quaternions are:
(D 23)
( 1
0)T.
For nonzero initial Euler angles the initial quaternions are derived by means of a successive rotation with 'Yo (i = l), 8, (i = 2)
and 4'o (i = 3), using Eqs. D 20 to 23:
(D 24)
(D
25)
Aq(1, 0)
(c0s('U0/2)
~in('U,/2>)~.
The transformation matrix computed with uaternions is always orthogonal. The normalisation is based on the fact that the socalled "quaternion norm" has to be unity (9, + q2 + qf t q2 = 19: = I), its approximation reading:
The most severe environment for strapdown algorithms is within a ring laser gyro INS, where the whole inertial measuring unit
( M U ) is vibrating due to the dithering of the RLGs with a few arc minutes amplitude and 400 Hz frequency. The sampling
frequency in these systems has to be 3 to 4 times this dither frequency, i.e. it is above 1 kHz. The transformation matrix
computation and the velocity transformation are in general split up into 2 parts ]Sa 841. The results of a high frequency (>' 1
kHz) precomputation are the corrected angle and velocity increments. At a lower frequency (50 to 100 Hz) the integration of the
transformation matrix and the acceleration transformation are carried out. This can b e seen from Fig. D 10, the functional
diagram of the Litton LTN-90 INS.
References (Mc 68, We 78,Sa 841 give a good insight into the problems of strapdown algorithms.
118
L i t e r a t u r e Appendix D
I19
Appendix 0
Optical Gyros
0 1 Introduction
The so-called "Sagnac Effect" is the basis for optical gyros. It describes the effect of rotation upon 2 light beams travelling in
opposite directions on the same optically closed path. Their phaseshift is proportional to the rotation component about the axis
normal to the plane set up by the beams. This phenomenon was first observed by Harres in 1912 and by Sagnac in 1913 [Ha 12,
Sa 131.
The sensing element of the optical gyro thus is massless and in contrast to the mechanical gyro is not affected by the dynamic
environment. This feature appears to offer enormous advantages in a strapdown system (Section 2 and App. D). Therefore,
optical gyros seem to be the ideal sensors for use in navigation and flight test systems.
Optical gyros in use today are fiber optic gyros (FOG) and ring laser gyros (RLG).In the following sections a brief review of the
physics of the Sagnac ring interferometer and its use in the FOG and RLG is provided. The main sources of errors are also
discussed and examples are given for both of them.
0 2 T h e Sagnac Ring I n t e r f e r o m e t e r (SRI) as Basis f o r Optical Gyros
Around the turn of the century physicists discussed intensely the nature of light. Michelson contributed to the discussions in 1881
with his investigations about the effect of translatory motion of a light source upon the speed of the emitted light. For his
observations he used the interference of lightbeams travelling in the direction of motion and perpendicular to it. They did not
show any measurable effect, thus proving that the speed of light (c) is not affected by the motion of its source, but remains
constant with respect to inertial space. However, for the same reason, the investigations of Sagnac with lightbeams in rotary
motion, see Fig. 0 1, showed an effect [So 781.
The SRI setups in Figs. 0 l a and b consist of a light source (U),
a beam splitter (BS), three fully reflecting mirrors M1, M2 and
M3 in Fig 0 la, or a glass fiber in Fig 0 lb for guiding the t
m light beams I and I1 on a square or circular path back to their
common origin on BS, where part of their power is combined and projected onto the screen (SC). If the optical pathes for both
beams are identical, a photon emitted from BS on paths I or I1 will reach the origin again after time T = L/c, where L is the
length of the path and c the speed of light.
wave
M2
glass
sc
sc
Figure 0 1 Sagnac Ring Interferometer (a) and its Circular Substitute (b)
For derivation of the effect of rotation upon both beams we follow [Ro 851. Any rotation
the axis normal to the plane of both beams affects the travelling length of both beams:
(0 1)
L,,,, =
"' TLII
- positive as shown in
Fig. 0 1 - about
= u1,11. T1,Il~
with T = signal transmission time, v = w ' r = tangential velocity of the ring and
120
arrangement:
(0 2 )
TI,,, = L/(U,,,,
An observer in the center
;4.
of rotation will measure the signal transmission velocities according to the relativistic addition theorem
as:
(0 3a,b)
U,,,,
(U
v)/(l
u-v/ct)
with co = vacuum light speed. The transmission time difference between both beams is:
(0 4a,b,c)
AT = T,
TI,
2 L v
=
2
CO
(1
--
- S2)
2 L v
2
CO
2 L r
w.
CO
with B = v/co. The time difference can also be interpreted as if the beams had travelled optical paths differing by the length. This
interpretation helps us to understand the ring laser gyro very easily.
It is interesting to note that this formular is valid for any signal travelling in a closed path in opposite directions, i.e. as well for
sound and for light! The technical problem lies in the measurement of the minute time difference - remember c," is in the
denominator! In practice it can.only be measured with light as transmitting signal. When the two light beams are brought to
interference, the time shift causes a noticeable Sagnac phaseshift of
(0 5 )
$s
= 2n uAT =
U
CO
ho
877 A
CO A0
with v = co/ho = frequency of light and A = Lr/2 = area of the circle. The figures in this equation are valid for the following
assumptions: a circular path of 10 cm diameter, a light source of He-Ne ( = 6.33 lo-' cm) and c = 3 10" cm/s. The numbers
reveal how weak the signal is.
It has been shown in [Po 671 that A is the area enclosed by the beams travelling on any path.
0 3 T h e Fiber Optic Gyro (FOG)
Though the FOG is in its principle closer to the Sagnac ring interferometer than the ring laser gyro discussed in the next section,
its development began a t a time when the latter was commercially already available. This is due to the fact that the proper
technology and readout concepts became available only in the late 1970ies.
Its basic principles are shown in Fig. 0 l b with the output signal according to Eq. 0 5 .
Three principle obstacles had to be overcome in order to make the FOG a serious competitor to existing gyros:
- the low scalefactor according to Eq. 0 5 ,
- the readout insensitivity at low input rates and
- readout nonlinearity as well as ambiguity.
0 3 . 1 S c a l e f a c t o r I n c r e a s e and E r r o r Reduction
With the advent of fibers as optical wave guides the increase of the Sagnac ring interferometer sensitivity became easily
accessible. Each turn of a fiber optic coil increases the sensitivity in Eq. 0 5. This idea was first suggested in [Kr 681. But along
with this benefit went adverse effects, since light was increasingly brought in contact with matter.
The resulting increase of temperature sensitivity and magnetic sensitivity was reduced by the use of polarization preserving fiber
and designing the sensor setup in a reciprocal fashion [U179, U1 801, in which both lightbeams suffer the same fate on their path
from light source to light sink or they follow the same number of reflections and transmissions. This is accomplished by using 2
beam couplers so that both beams are reflected and transmitted twice (s. Fig. 0 2).
Superluminiscend
Diode (SLD)
Polarizer (Pol)
CP 2
121
The increasing pathlength of both optical beams increases the effect of backscattering and output noise, since the backscattered
light causes a phaseshift of the light beams in a similar fashion as the the Sagnac effect. Light from a luminiscent diode with very
short correlation length brought a drastic improvement [Pe 821.
03.2 Increasing Sensitivity f o r Low Input R a t e s
Fig. 0 3 may serve to explain the problem. It shows the superposition of the two countertravelling beams and the corresponding
light intensity as a (1 + cos$,)- function of the Sagnac phaseshift $ with zero scalefactor at zero input rate. Only a phaseshift of
f n / 2 would bring the sensor into the desired range of highest senztivity at low input rate. Such a "nonreciprocal" phaseshift $nr,
i.e. a phaseshift acting upon both beams in a different manner, is generated by the phase modulator PM in Fig. 0 2 at one end of
the fiber coil.
The phase modulator PM causes a photon of beam I to be delayed after having travelled through the coil and a synchronous
photon of beam I1 to be delayed before entering the coil. PM is stimulated with a squarewave voltage U
for an individual
phaseshift of n/4 and a period of twice the light travelling time nL/c with n = refraction index of the #er. The resulting
phaseshift $ is the difference of both beams, i.e. equal to f n / 2 . It is superposed to the Sagnac phaseshift and causes a lightintensity-fun%on proportional to (1 + cos($
n/2)] as indicated in Fig. 0 4 left. It is demodulated and results in an output
voltage U
sin$. For low input rates the sensitivity of this "phasemodulated" FOG is thus proportional to CO, as expected. For
high input rates it is both nonlinear and ambiguous. The proper signal evaluation in so-called "phasemodulated FOGS" (s. Fig. 0
Sa ) is then carried out digitally.
Phase modulation can be accomplished by simply stretching the fiber with piezo elements or better by applying an electric field
perpendicular to the fiber. These phase modulators are manufactured in integrated optics based on the use of lithium niobade.
03.3 Scalefactor Linearization with a Control Loop f o r Sagnac Phaseshift Compensation
The scalefactor of the Sagnac ring interferometer can only be linearized through a control loop for nulling the Sagnac phaseshift
4s,i.e. a method must be found for generating a controllable constant nonreciprocal phaseshift between both beams. This can be
accomplished by a controllable nonreciprocal frequency difference 4, = f, between both beams, because its corresponding
phasedifference is $nr = f m - nL/c.
The breakthrough for such a nonreciprocal "frequency" difference came by the proposal to stimulate the phasemodulator with an
increasing voltage ramp as indicated in Fig. 0 4 right, causing a linearly increasing phaseshift in both beams, with the one in beam
I time-delayed by n * L/c [Le 851. The phaseshift difference 4 of both beams is controllable by the ramp's inclination as
indicated above and can be used to compensate the Sagnac phaseshyh $S.
The steps superposed to the ramp serve to sense the Sagnac phaseshift as discussed with the phasemodulated FOG mentioned
above, i.e. their demodulated output is controlled to zero by the ramp's inclination as indicated in this figure.
The voltage ramp for increasing phaseshift has to be set to zero again at a certain limit. This is done when the phaseshift has
nominally reached 2 n as indicated in Fig. 0 4b. At that instant a pulse is released to the computer whose weight is:
It is identical in principle to the one of the ring laser gyro (RLG) discussed in the next section.
Differences between the actual phase release and its nominal value remain stored in the fiber and serve to stabilize this "closedloop" FOG scalefactor.
This closed-loop FOG (s. Fig. 0 Sb) has for the time being the best performance data, namely
scalefactor variation. As compared to the RLG it has the following advantages:
Though these advantages are of great importance for many applications, it does not seem likely that the FOG with conventional
dimensions (< 10 cm radius) will reach the performance of the RLG. Single pieces have been developped with bigger diameter
and superb performance as regards drift [Sc 921.
0 4 T h e Ring L a s e r Gyro (RLG)
The setup for the ring laser gyro (FUG)in Fig. 0 6 differs in principle from the one for the Sagnac ring interferometer in Fig. 0
1 in the following way. The light source - a gas laser - is mounted into the optical path replacing the exterior light source plus
beam splitter; the optical path layed down by mirrors M1,M2, M3 acts as a resonance cavity for the laser.
In this particular device the optical path is composed of three mirrors only. This is pursued at present by most of the
manufacturers with the exception of Litton, which selected four mirrors. The RLG used by St. Petersburg Electrotechnical
University for high accuracy goniometry has 4 prisms instead of mirrors [Fi 941.
In Fig. 0 6 the mirror (Ml) is partially transmitting and the prism (P) is part of the interference optics.
Like in the linear laser the ring laser is tuned to an oscillation with a wave length equal to an integer of the cavity length L. Due
to the Sagnac effect, the cavity length of both light beams I and I1 will apparently be displaced from L by an amount AL, = c' A t ,
and AL,, = c * At,,, or relative to each other by an amount AL (s. Eq. 0 1). This results in the frequency difference:
122
El, II = a exp j (2 n: vt
A
2rcx rt -$
cp )
+h
= - (I
2
Figure 0 3 The Interference of the 2 Light Beams and the Corresponding Light Intensity a s a Function of their Phase Shift
123
Phase-Modulation with
Changing Direction
lTl+
I
I
Cp nr
124
a)
Superluminiscend
Diode (SLD)
- I, sin (cp,
0s-0
U,
+ 6cp)
b)
Super1uminiscend
Diode (SLD)
Polarizer (Pol)
CP 2
Voltage Controlled
Amplifier
0
- -
/-
Demod.2
Control
Electr.2
-+
Reset-Ramp
Gene rator
Reset PulseSA4
Figure 0 5 Functional Diagrams for Fiber Optic Gyros with Two Kinds of Phase Modulation:
Square-Wave Modulation (a) and Digital Ramp Modulation (b)
125
photodiodes 1
plane mirror 3
cathode
wandering
Figure 0 7 Interference of the 2 Light Beams of the Ring Laser Gyro and Interference Pattern Readout
I26
Au[Hz]
A
L A
w[deg/s]
= 1,588
for a triangular path with a side length of 10 cm and A = 6.33 10-7 m (He-Ne laser).
This frequency difference causes a wandering of the interference pattern at the screen (SC) proportional to the angular rate with
respect to inertial space. This is indicated in Fig. 0 7.
Two photodiodes mounted on the screen (SC) will count the number of fringes that pass it and allow the definition of the sense of
rotation. Each fringe may then easily be converted into a pulse which indicates the angle increment of the sensor with respect to
inertial space. The number N of the pulses for the total input angle displacement:
defines the RLG nominal scale factor S, which for = 6.33 10-7111 and a triangular RLG of 10 cm side length has the following
magnitude:
=
Lh = 2.25 arc sec/pulse.
N
4 A
In Fig. 0 8 a setup is shown indicating the RLG characteristics. It seems as if the mirrors were passing alongside the space- fixed
light pattern [Sc 661. This setup indicates that the RLG is an integrating gyro with digital output and ideally suited for use as a
flight test sensor and in strapdown navigation systems.
(0 9)
s =
We will discuss in the following some design criteria and error sources common for all RLGs and compare them with those of the
FOGS, if possible.
Let u s first comment on the selection of the laser - gas laser or solid state laser.
In difference to the FOG h i c h operates at the fixed frequency of its exterior light source, the RLG operates at two frequencies
both of which have to be amplified inpendently in one laser. This can be accomplished in a gas laser only in which due to the
Doppler effect of its atoms the intensity of the amplified light as a function of resonator length or lasing frequency, respectively,
is bell- shaped with a bandwidth of 1500 MHz, approximately corresponding to 1 wave length A.
Gas flow within the laser tube caused by the voltage between anode and cathode (Langmuir flow) and temperature gradients
affects the lasing frequency (Fizeau effect). For its overcoming RLGs are always equipped with two anodes and one cathode, or
vice versa, mounted symmetrically within the tube, as indicated by Fig. 0 6. If only one anode were to be used, the result would be
an apparent rotation of the sensor proportional to a multiple of 100 deg/h [Po 681. The sensor may be biased to compensate for
some of these effects by adjustment of the high voltage (ca. 1500 V) in both branches: The number just quoted indicates that the
voltage should be properly controlled and temperature gradients should b e prevented.
The natural He-Ne laser wave length is A = 633 nm. The exact lasing wave length is adjusted due to the geometric path length,
and we may assume that its mean value for both beams varies linearly within one A-period. Within that path length range the
RLG scalefactor is insensitive to path length variations, since in Eqs. 0 7 to 0 9 the variations of nominator and denominator
cancel!
127
Airror2
rl
..~
........................
:.
controller for
minimizing
lock-in threshold
I
I
pathlength
controller
I
\
Figure 0 9 Control Loops for Stabilizing the Beam Geometry of a Ring Laser Gyro
For preventing the path length to swap the A-period and for scale factor stabilization, the RLG is firstly built of material with a
very low thermal expansion coefficient (Cer-Vit, Zerodur) and secondly is equipped with a path length control loop as indicated in
Fig 0 9. The input signal into this loop is the mean intensity of both beams measured at the backside of one of the mirrors (all of
them are partly transmitting). Its control to its relative maximum controls at the same time the path length to a constant value!
This is accomplished by positioning one of the remaining mirrors with a piezo element. The mean light intensity maximum
definition is done by dithering this piezo element with a frequency w and filtering out the 2w- term.
The path lenght control to the maximum of the mean light intensity makes any other temperature control of the sensor
unnecessary. We may thus state two essential advantages of the RLG over other gyroscopic sensors: digital output and
t e m p e r a t u r e insensitivity - at least in theory.
0 4 . 2 Error Source Common to all
A RLG incorporating the above design features will work satisfactorily for high input rates limited only by the readout electronics.
But the RLG has a lower limit on input rates of a few hundred degrees per hour called "lock-in" range (S. Fig 0 10). Above this
range its actual input-output relationship is approximated by (s. also Eq. 0 7):
(0 IO) A u
4 A
L A
[ 1
(wL/o)2
11'2
w,
The coupling of both light beams is caused primarily by the scattering of light at the mirror surfaces (s. Fig 0 11 top) and within
the laser tube. It cannot be completely overcome. Its reduction requires on the one hand mirrors with low backscattering and high
reflectivity. It requires on the other hand an additional control loop for the light beam geometry ( s . Fig. 0 9 ) , since wL is the
result of the superposition of the backscattering of all sources within the resonator, especially at the mirrors (S. Fig. 0 11
bottom). Due to the phase-relationship of all backscattered lightsources the superposition of all of them can be driven to a
minimum [Ro 921. For present RLGs of inertial quality and with a beam length of 10 to 15 cm wL is in the order of 100 deg/h.
The control loop for minimizing wL stabilizes this parameter at the same time, thus stabilizing the RLG scalefactor as well (S. Eq.
0 10 and [Ro 921).
The sensitivity threshold mentioned above is still too high for use in an inertial navigational system. Among the different
128
d)
x=y1
with dber
0.43 x 1 ~ - 9
-6
1.3~10
0.
2
I
I
without dither
II
I
w' 0
0L ,
W'
=--
U
'
- 300 deg/h
WOu
200.000. deg/h = 5 6 d q / s
Figure 0 10 The Lock-In Effect of the Ring Laser Gyro and Bias Techniques to Overcome it
129
Since this bias is applied periodically, the gym will enter tbe lock-in region twice per dither cycle and each beam aill loose the lock
of phasc to some extent The resulting noise accumulates in a so-called 'random walk' after integration of the mcasured rate to
an angle. The uncertainty of this crmr u p r c s c d as Iu band increases with the q u a r e mat of the elapsed time. This
is particularly serious d e n short measurement times are of interest as vith the INS alignment (E. Seetion 5 ) or with the extraction
of the sensor's drift.
Another ermr source with the dither bias is due to the scalefactor nonlinearity at input rates near the madmum dither rate (a.
Fig. 0 IOc). It arises from the fact that at this point the highly nonlinear maximum dither sine wave dives into the lock-in region.
This scalefactor nonlinearity show an almost square law dependence on the lock-in rate amounting to 50 ppm at a lock-in rate of
0.4 dcg/a. For its wcrmming the dither frequency in the order of 400 Hz and a few arc minutes amplitude arc
appm-ately
varied randomly.
Among the other bias techniques mentioned abwc the oncs h a d upon magnetism (magnetic mirrors. Faraday ccU) seem to open
the most elegant way to mpc with the lock-in effect. They arc hampered by the fact that both of them increase backscattering
within the resonator and from this point of view arc not promising for highquality sensors. For the time being dither bias is most
widely spread for inertial hystems of 1 NM/h performance. In spcfial syatem implementations as in inertial systems for
submarines we also find rate bias. These hystems have proven already navigation accuracies in the range of 1 NM/d [KO 901 and
seem to have a gmwth potential [Ro 921.
Corn
rciauy available RLGs have excellent performance data: <0.01 dcg/h drift, < 5 ppm scalefactor variation and < 0.001
d e g / r h random walk [U881.
130
@ Block Mdlon
Due to Dllher
Readoul
Mirror
Fringe Motion
Readout
Prism
Ddeciorr
Equlvalenl Readoul
@Mollon Due to Dllher
Figure 0 I 2 The lloneyvell GG 1342 hng Laser Gyro and 11s Optomeehanical Readout Compensation for Dither
131
Literature Appendix 0
[Fi 941 Filatov, Y.U. et al: "Laser Goniometric System for Measurment of Object Angular Position."
Proceedings of the 3rd International IMEKO Symposium on Laser Metrology for Precision Measurement and Inspection in
Industry, Heidelberg, March 1994,VDI-Report No. 1118
[Ha 121 Harres, F.: "Die Geschwindigkeit des Lichtes in bewegten Korpern."
Dissertation Universitat Jena, Erfurt (1912), no longer available
[KO901 Kohl, KW.: "A new High Accuracy Ship's Inertial Navigation System PIA1 MK4."
Proceedings Symposium Gyro Technology 1990, DGON and Universitaet Stuttgart, 1990
[Kr 681 Kroy, W., Mehnert, W.E.: "Anordnung zur Messung von Drehgeschwindigkeiten."
DBP Nr. 1 807 247, 1968
[Le 851 Lefevre, H.C. et al: Double Closed-Loop Hybrid Fiber Gyroscope Using Digital Phase Ramp."
Proceedings of the 3rd International Conference on Optical Fiber Sensors(0FS '85), San Diego, PDS 7.1-7.8, 1985
[Po 671 Post, E.J.: "Sagnac-Effekt."
Review of Modern Physics, Vol. 39, No. 2, (1967), pages 475 to 493
[Pe 821 Petermann, K,: "Intensity-Dependent Nonreciprocal Phase Shift in Fiber-optic Gyroscopes for Light Sources with Low
Coherence."
Optics Letters, Vol. 7, No. 12, pp 623-625, 1982
[Po 681 Podgorski, T.J.: "Langmuir Flow Effects in the Laser Gyro"
IEEE Journal of Quantum Electronics, Vol. QE-4, No. 1 pp 11-18, 1968
[Ro 851 Rodloff, R: "Der Laserkreisel - EinfluD der Ringlaser-Geometrie auf die Kreiseleigenschaften."
Laser und Optoelektronik Heft Nr. 2, 1985
[Ro 921 Rodloff, R: "Lasergyro - the Next Generation."
Proceedings Symposium Gyro Technology 1992, DGON and Universitaet Stuttgart, 1992
[Ro 931 Rodloff, R et al: "Hochaufloesendes Kreiselsystem zur Prazisions-Winkelmessung und
Deutsche Patentanmeldung P 42 31 935.8, Anmeldetag 18. 09.1992
- Navigation"
[Sc 661 Schulz-Du Bois, E.O.: " Alternative Interpretation of Rotation Rate Sensing by Ring Lasers."
IEEE Quantum Electronics. Vol QE-2,pp 299-305, 1966
[So 781 Sommerfeld, A.: "Optik."
Verlag Harri Deutsch, Thun, Frankfurt/M, 1978
132
133
LTNE
2.0
2.1
Principles of Operation of a
Doppler Radar
(1)
FLTGMT V
134
2.2
I)
X'
135
2.5
EV, = Tan
y o Ey
(5A)
V
X
where y o
Ey
VY
where a,,
2.4
Ea
Transmitter Freauencv
Considerations
&, =
vz
where
$0
E$
average uncertainty of U
(C)
Tan
$o%$
136
137
2.8
138
A fd=z(siny,) A y.
(6)
139
b.
2.10
C.
d.
140
1 1 I 1
CODEPER
CPI,
HYDROCIUI'IIIC BEAUVORT
OFFICE PUlt.60611
DOUGLAS
F
*
l
/
'
12
141
Nd
where
s =
(7)
Nd
2.11
W,
142
h = Transmitter wavelength
F =
=F
W
noise figure
=2
m sin 2 7c fm>
C
(12)
A fd = Doppler bandwidth
Afd=2J sin y o A y
Since
(6)
I43
(13)
VT = K,/ D
3.1
Fluctuation Error
Many applications use Doppler velocities to
144
Po
v2
Po = De,
x
(15)
3.2
(19)
or
=
-Tany.Ay.
(20)
fd
3.3
and all )I
145
146
3.6
Terrain Errors
3.8
Installation Errors
147
Radome Errors
148
149
4.2
150
151
References
1.
2.
3.
152
3. THEORETICAL OVERVIEW
Estimating errors in an INS trajectory by measurements
functionally related to the terrain profile beneath the
aircraft requires application of nonlinear estimation
theory. As shown in Figure 2, the sensed profile
obtained along the true ground track is compared to
DTEDderived profiles for possible horizontal locations
of the aircraft within a position uncertainty region and a
153
(1)
where
CEP is the circular error probable of the update (m)
is the standard deviation of the profile
measurement errors (m)
os is the standard deviation of local terrain slopes at
the measurement locations in both down-range
and cross-range directions (unitless)
N is the number of independent measurements
(3,
154
Sensed
profile/
/
/
TRUE
IkIC
I1
l
.
U
(2)
155
156
Key implementation issues are the balance between onboard processing versus preflight mission planning and
access to the stored DTED during flight. To minimize
requirements on flight systems, the DTED may be
formatted into a grid with constant horizontal postspacing. Data compression may be used to minimize the
amount of on-board storage at the expense of requiring
in-flight reconstruction of the DTED. Storing only the
DTED on the aircraft that may be used in a given
mission lowers the required DTED storage capacity at
the expense of requiring more pre-mission effort.
Trends are to store the DTED of large areas on the
aircraft and to use the DTED in the format in which it is
supplied by DMA. During flight the DTED of the area
being over flown are extracted from the large capacity
storage device and placed in a buffer where they can be
rapidly accessed by the TRN algorithm. How this is
done is often determined by DTED access requirements
of other system functions like lowemission TFmA. The
flight computer interfaces to the altimeter, INS,and
cockpit displays are not usually affected by TRN.
The primary determinants of incremental flight
computer resources needed to implement TRN beyond
accessing the DTED and placing it in a buffer are the
speed of the aircraft and the size of the largest
horizontal position errors that the system must
accommodate. Higher aircraft speeds q u i r e greater
computer throughput. The required maximum position
error depends primarily on the longest anticipated flight
without updates and INS quality.
5.
SYSTEM CONSIDERATIONS
157
158
SATELLITE NAVIGATION
Richard B. Langley
Geodetic Research Laboratory
Department of Geodesy and Geomatics Engineering
University of New Brunswick
Fredericton, N.B., E3B 5A3
CANADA
1. INTRODUCTION
Satellire navigation provides unprecedented accuracy and
world wide coverage to aerospace vehicle. This section
reviews in some detail the NAVSTAR Global Position
System (GPS) followed by a survey of other satellite
navigation systems:
2. SATELLITE NAVIGATION SYSTEMS
3.2 Satellites
When fully deployed by late 1993 or early 1994, the satellite
segment will consist of a constellation of 21 Block I1 or
second-generation satellites plus 3 in-orbit operating spares.
The satellites are arrayed in 6 orbital planes inclined 55" to the
equator. Each orbit is circular with a nominal altitude of 20
183 km. The corresponding orbital period is 12 sidereal hours,
one half of the earth's period of rotation.
The deployment of the Block I I satellites was preceded by a
program of testing using prototype, or Block I, satellites. The
Block I satellites were launched from Vandenburg Air Force
Base in California using Atlas F rockets. I O of these satellites
were successfully launched between February 1978 and
October 1985. They were placed in nominally circular orbits
with semimajor axes of about 26,560 km. The satellites were
positioned in two orbit planes with inclinations of about 64"to
provide maximum coverage for the main military testing area
for GPS, the Yuma Proving Grounds in Arizona.
Whereas the Block I satellites were launched using an
expendable launch vehicle, it was originally intended to launch
the Block II satellites, up to three at a time, using the Space
Transportation System - the Space Shuttle. But after the
Challenger accident, the decision was made to use an
expendable launch vehicle and a new rocket, the Delta 11, was
developed for this purpose. The Block I1 satellites are
launched from the Cape Canaveral Air Force Station next door
to the Kennedy Space Center.
-- Block IIA
-- Block IIR
-- Block Ill
The satellites achieve their final orbits i n steps. The first and
second stages of the rocket together with the nine solid-fuel
strap-on booster engines put the third stage of the rocket and
the attached satellite into an elliptical orbit with a perigee
height of about 180 km and an apogee height of about 870 km.
(The apogee is the point on the orbit furthest from the earth.)
The third stage, called a Payload Assist Module (PAM), is then
used to increase the apogee height of the orbit so that it
matches the height of the desired final orbit, about 20,200 km,
3.3 Signals
3.3.1 The Carriers. Each GPS satellite transmits signals
centred on two microwave radio frequencies, 1575.42 MHz,
referred to as Link 1 or simply LI, and 1227.60 MHz, referred
to as L2. These channels lie in a band of frequencies known as
the L band which starts just above the frequencies used by
cellular telephones. Within the L band, the International
Telecommunications Union, the radio regulation arm of the
United Nations, has set aside special sub-bands for satellitebased positioning systems. The LI and L2 frequencies lie
within these bands.
Such high frequencies are used for several reasons. The
signals, as we have said, consist of a number of components.
A bandwidth of about 20 MHz is required to transmit these
components. This bandwidth is equal to the whole FM
broadcast band! So a high, relatively uncluttered part of the
radio spectrum is required for GPS-type signals. The GPS
signals must provide a means for determining not only high
accuracy positions in real-time, but also velocities. Velocities
are determined by measuring the slight shift in the frequency of
the received signals due to the Doppler effect In order to
achieve velocities with centimetre-per-second accuracies,
centimetre wavelength (microwave) signals are required.
159
GPS signals, like most radio signals, start out in the satellites as
pure sinusoidal waves or carriers. But pure sinusoids cannot
be readily used to determine positions in real-time. Although
the phase of a particular cycle of a carrier wave can be
measured very accurately, each cycle in the wave looks like the
next so it is difficult to know exactly how many cycles lie
between the satellite and the receiver. This ambiguity can be
resolved using the differential technique pioneered by
surveyors [Wells and Kleusberg, 19901 but can be time
consuming.
In order for a user to obtain positions independently in realtime, the signals must be modulated; that is, the pure sinusoid
must be altered i n a fashion that time delay measurements can
be made. This is achieved by modulating the carriers with
pseudo-random noise (PRN)codes.
160
C/A-CODE
MESSAGE
L2 CARRIER
Figure 3.1 How the different components of the GPS signal are combined. Note that the various waveforms are
not to scale.
channel has to carry both the P-code and the C/A-code. This is
achieved by a clever technique known as phase quadrature.
The P-code signal is superimposed on the L1 carrier in the
same way as for the L2 carrier. To get the CIA-code signal on
the LI carrier, the unmodulated carrier is tapped off and this
tapped carrier is shifted in phase by 90". This quadrature
with the C/A-code signal and
carrier component is mixed
then combined with the P-code modulated in-phase component
before being transmitted by the spacecraft antenna.
3.3.6 GPS Time. The timing and frequency control for the
carriers, the PRN codes, and the message all comes from an
atomic oscillator on board the satellite. For redundancy each
Navstar GPS Block I1 satellite carriers four oscillators - two
cesium beams and two using rubidum vapour cells. One of the
oscillators is selected by the spacecraft controllers to provide
the frequency and timing requirements for generating the
satellite's signals.
The signals transmitted by the GPS satellites are referenced to
GPS (System) Time. Until June 1990, this was the time kept
by a single atomic clock at one of the monitor stations.
However, the practice now is to obtain GPS Time from a
composite or "paper" clock consisting of all operational
monitor station and satellite clocks.
161
GPS Time is steered over the long run to keep it within about 1
microsecond of UTC ignoring leap seconds. So, unlike UTC,
GPS Time has no leap second jumps. At the integer second
level, GPS Time was equal to UTC in 1980 but at the present
time, due to the leap seconds which have been inserted into
UTC, GPS Time is ahead of UTC by 7 seconds plus a fraction
of a microsecond that vanes day to day.
A particular epoch is identified in GPS Time as the number of
seconds that have elapsed since the previous Saturday / Sunday
midnight. Such a time measure is, of course, ambiguous so
that one must also indicate which week the epoch is in. GPS
weeks are numbered consecutively with week 0 starting on 6
January 1980. Epochs may also be identified by Julian Date
(JD), the number of days and fractional days elapsed since
noon UT on 1 January 4713 B.C., or the Modified Julian Date
(MJD) which is equal to JD minus 2400000.5 JD and MJD
are frequently used by astronomers, navigators, and others for
compactly and unambiguously identifying a particular epoch in
time.
I62
Eccentricity
'0
RO
Argument of perigee
MO
An
i-dot
R-dot
Cic, Cis
toe
163
Ib'
ephemeri
spanning
164
signals for
165
'
,'
/
I
167
But just how does the GPS receiver actually extract the
position coordinates and the clock offset from the
measurements? In the software embedded within the GPS
receiver is an algebraic model that describes the geometrical
arrangement we've just looked at. For each pseudorange
measurement, an equation can be written which relates the
measurement to the unknown quantities:
four measurements taken from the full set will produce slightly
different solutions. We say that the solution is inconsisten:.
What do we do? We could discard the extra observations but,
although expedient, that seems wasteful of data. The best
approach is to use a method that was devised in the early 1800s
by the great German mathematician and father of modern
geodesy, Karl Friedrich Gauss: the method ofleast squares. In
this method. we obtain a unique solution for the unknown
parameters which best fits all of the measurements. This
solution is the one which when substituted into the
pseudorange equations gives the smallest discrepancies with
respect to the measurements in a sum-squared sense. That is,
the sum of the squares of the discrepancies is a minimum.
Without going into the mathematical reasons for adopting this
criterion, we can see qualitatively that it assumes that positive
and negative discrepancies are equally likely to occur and that
smaller discrepancies are more likely to occur than larger ones.
3.6.2 The Pseudorange. Before discussing the pseudorange,
let's quickly review the smcture of the signals transmitted by
the GPS satellites Each GPS satellite transmits two signals for
positioning purposes: the L1 signal, centred on a carrier
frequency of 1575.42 MHz. and the L2 signal, centred on
1227.60 MHz. Modulated onto the LI carrier are two
pseudorandom noise (PRN) ranging codes: the 1 millisecondlong CIA-code with a chipping rate of about 1 MHz and a
week-long segment of the P-code with a chipping rate of about
10 MHz. Also superimposed on the carrier is the navigation
message, which among other items. includes the ephemeris
data describing the position of the satellite and predicted
satellite clock correction terms. The L2 carrier is modulated by
the P-code and the navigation message -- the CIAcode is not
present.
The PRN codes used by each GPS satellite are unique and have
the property that the correlation between any pair of codes is
very low. This characteristic allows all of the satellites to share
the same carrier frequencies.
The PRN codes transmitted by a satellite are used to determine
the pseudorange - a measure of the range, or distance, between
the satellite and the antenna feeding a GPS receiver. The
receiver makes this measurement by replicating the code being
generated by the satellite and determining the time offset
between the arrival of a particular transition in the code and
that same transition in the code replica. The time offset is
simply the time the signal takes to propagate from the satellite
to the receiver. The pseudorange is this time offset multiplied
by the speed of light. The reason the ohservable is called a
pseudorange is that it is biased by the lack of time
synchronization between the clock in the GPS satellite
governing the generation of the satellite signal and the clock in
the GPS receiver governing the generation of the code replica.
This synchronization error is determined by the receiver along
with its position coordinates from the pseudorange
measurements. The pseudorange is also biased by several
other effects including ionospheric and tropospheric delay,
multipath. and receiver noise. We can write an equation for the
pseudorange observable that relates the measurement and the
various biases:
p = p + c . (dt-dT) t dion+ dq
+
EP
I68
NYO
+dq
t E*
I
131
IS 4
1
I.
(I.
1.
W*rdTrn.h.L
I. 2
,I 4
I
(4
'
phase measurements.
169
approximatelytu scale.
170
SVAO=SVAp&'Mi,
+SVMtmp+Esv~e
171
172
If we forget about the height coordinate for the time being and
consider just the horizontal coordinates, we can construct the
two-dimensional analogue to the error ellipsoid: the error
ellipse. It is defined as the contour of equal probability density
in the two horizontal dimensions. There is a certain probability
that the true horizontal coordinates lie within the ellipse. For
the srundurd error ellipse, this probability is 39%. As with the
error ellipsoid, the semi-axes of the error ellipse are not in
general equal to the standard deviations. However, given the
standard deviations in the horizontal coordinates and their
correlation, the semimajor and semiminor axes of the ellipse
can be calculated.
The two-dimensional analogue of SEP is circular error
probable (CEP). CEP is the radius of a circle inside of which
the true horizontal coordinates of a position have a 50%
probability are being located.
Another accuracy measure frequently used in navigation is
twice the root-mean-square of the horizontal distance error or
2 dms for short. It is equal to twice the square root of the sum
of the squares of the semimajor and semiminor axes of the
error ellipse. A circle of radius 2 drms will contain the true
horizontal position with a certain probability. Unfortunately a
drawback of 2 drms as a measure of error is that it does not
correspond to a fixed value of probability for a given value of
error. The probability varies with the eccentricity of the error
ellipse, ranging from 95.4% (ellipse collapses to a line) to
98.2% (ellipse becomes a circle). Because of this variation in
probability, there is not a constant relationship between values
of 2 dms and CEP. The ratio of 2 drms to CEP varies with the
eccentricity of the error ellipse from 2.4 to 3.
Because of its wide use in navigation, 2 drms is used to specify
the designed level of horizontal positioning accuracy for the
GPS Standard and Precise Positioning Services. The latest
issue of the Federal Radionavigation Plan (FRP) states that
when GPS is declared operational, the horizontal accuracy for
SPS is planned to be 100 m 2 drms at 95% probability. This
means that 95% of all horizontal position fixes should be
within 100 m of the true position. But what about the other
5%? Theoretically, if the position errors due to the various
UEREs including SIA are from a Gaussian distribution, we
could occasionally get extremely large errors. However, the
Department of Defense will control SIA such that excursions
will not exceed 300 m 99.99% of the time. The corresponding
designed 2 dms (95%) horizontal accuracy for PPS is planned
to be 17.8 m.
The FRP describes the designed accuracy of the vertical
component of a GPS-derived position at the 20 level. As this
corresponds to a 95% probability level it is consistent with the
accuracy quoted for the horizontal position. For SPS, the
designed vertical 2a is 156111; for PPS it is 27.7m.
The FRP gives the designed accuracy of receiver clock
synchronization at the la level. For SPS, a t is planned to be
167 nanoseconds. For PPS, a t is given conservatively as 100
nanoseconds.
It should be pointed out that the stated PPS position and time
accuracies are designed estimates of GPS capabilities and
superior results have already been obtained in practice.
Significantly greater accuracies can be obtained for both PPS
and SPS users by operating in a differential mode with two or
I73
3.8.3 UTM.
The GPS receiver may also be able to project the ellipsoidal
coordinates onto a mapping plane, that is, a flat map. It is
impossible to project an ellipsoidal surface onto a flat surface
without some distortion taking place. However, projections
have been developed which minimize these distortions. One
such projection is the Universal Transverse Mercator (UTM).
The UTM projection, which can trace its lineage back to Karl
Friedrich Gauss, has been adopted by the IUGG, NATO and
other military organizations and many civil administrations
worldwide for their various mapping needs.
The UTM projection divides the world between 80"s and 84"N
into 60 zones each with a width of nominally 6 degrees of
longitude onto which is superimposed a grid. Each of these
zones, which constitutes a segment of a reference ellipsoid, is
projected onto a cylinder whose axis is parallel to the earth's
equator and whose radius is chosen to keep the scale errors of
the projection within acceptable limits. Coordinates of points
on the ellipsoid within a particular zone can then be
transformed to coordinates on the UTM grid. The UTM
coordinates are generally referred to as eastings and northings
and are expressed in metres. Eastings are reckoned from the
central meridian of a zone and have 500,000 m added to them
so that all coordinates remain positive. Northings are reckoned
from the equator which has a coordinate value of 0 m for work
in the northern hemisphere and 10,000,000m for work in the
southern hemisphere. An important property of the UTM
projection is that is uses a conformal mapping which means
that the magnitude and sense of angles measured on the
ellipsoid are preserved when coordinates are transformed to the
mapping plane.
The U.S. State Plane Coordinate System uses a transverse
Mercator projection or another conformal projection, the
Lambert conic map projection, in one or more zones, to map
each state of the Union, Puerto Rico and the US. Virgin
Islands, onto a plane rectangular coordinate system. (The
panhandle of Alaska is a unique case with its own special
projection.) The transformations from NAD 83 geodetic
coordinates to grid coordinates yield errors less than about 1
cm for points within the boundaries of the appropriate zone so
that either geodetic coordinates or the corresponding grid
coordinates of a point may be used depending on the
application.
4. OTHER SATELLITE NAVIGATION SYSTEMS
4.1 INTRODUCTION
The following discussion briefly summarizes the
characteristics of several other satellite navigation systems.
4.2 GLONASS
174
175
In the case of a Transit satellite (or any other satellite for that
matter), the position of a receiver can be established by
continuously recording the Doppler shift of the received signals
(or the number of cycles Of the Doppler frequency which is a
more Precisely obtained observable). Subsequently these data
are combined with accurate coordinates of the satellite to
determine the position of the receiver. As with the passage of a
train, a single satellite pass can provide at most O n l y
coordinates of the receivers position. Whereas this may be
satisfactory for navigation at sea where the height above the
reference ellipsoid is approximately known, three-dimensional
positioning requires observing multiple satellite passes.
-;
$)
4.4 ARGOS
Another satellite system which uses the Doppler effect for
positioning is Argos [Service Argos, 19841, a cooperative
project of the French Centre National dEtudes Spatiales
(CNES), NASA, and the U.S. National Oceanic and
Atmospheric Administration (NOAA). However, in contrast to
the Transit system, the transmitters are operated by the users
and the receivers are in the satellites. An Argos transmitter on
an instrumented platform of some sort (oceanographic or
navigation buoy, radiosonde balloon, remote weather station,
etc.), periodically emits a 401.65 MHz signal carrying
information from the platforms sensors. One of two passing
U.S. TIROS/N-class weather satellites picks up this signal and
records its Doppler shift along with the sensor data. These data
are subsequently played back when the satellite is in range of
one of three tracking stations: Wallops Island, Virginia;
Gilmore Creek, Alaska; or Lannion, France. The tracking
stations relay their data to NOAAs National Environmental
Satelliteand Data
Service in Suitland,Maryland,
where they are sorted and then passed on to the Argas Data
Processing Centre at cNES in Tou~ouse,France, CNES
computes the position of the platform from the recorded
~~~~l~~
This information along with the Sensor data
can be conveyed to the operator of the platform by a variety of
including packet switching data networks, telex, or
letter. The two-dimensional (latitude and longitude) positions
can be as accurate as f 1 5 0 m (Io). The actual accuracy
Of the
Obtained depends to a very large degree On the
users transmitter. A new Argos service is being planned that
would orovide even more accurate oositions. UD to 5000
platforms requiring location service can be handled by the
Argos system, assuming these are uniformly distributed over
the earths surface.
The Argos receiving system was first implemented on the
prototype TIROS/N spacecraft, orbitted in 1978. Subsequent
TIROSlN satellites, NOAA-6 through NOAA- IO, have also
carried the Argos Data Collection System.
Position determination from signals uplinked to a satellite is
also utilized i n the COSPAS-SARSAT search and rescue
system [McPherson, 1981; Elliot and Exter, 19871.
5. SUMMARY
176
Acknowledgements
Much of the information contained in this chapter is based on
material the author has written for GPS World magazine and
for the Guide to GPS Positioning published by Canadian GPS
Associates, Fredericton, Canada.
References
Ackroyd, N. and R. Lorimer (1990). Global Navigation, A
GPS User's Guide. Lloyd's of London, 202 pp.
Advisory Group for Aerospace Research and Development
(1988). The NAVSTAR GPS System. AGARD Lecture
Series 161. Neuilly-sur-Seine, France, September.
anon. (1967). GPS: NAVSTAR GPS Space Segment Navigation User Interface, Report ICD-GPS-200,
November.
anon. (1987). System Specifications for Navstar GPS Space
SegmentfNavigation Users Interface. Interface Control
Document - Global Positioning System - 200 (ICD-GPS200), 10 November.
ARlNC Research Corporation (1991). GPS Interface Control
Document. ICD-GPS-200,3 July, 115 pp.
Canadian GPS Associates (1993). GPS Biliography - July 93
edition.
177
AN OVERVIEW OF O m G A
RADIO NAVIGATION SYSTEM
by
D.F. LIANG
Directorate Research and Development Communications and Space
National Defence Headquarters
Ottawa, Ontario,
Canada K1A OK2
1.
SYSTEM DESCRIPTION
178
2.
LANE AMBIGUITY
receiver, it is essential to
carefully maintain a DR plot, and
count the number of lanes it crosses
in the course of a voyage. It must
be periodically compared to its
Omega position s o that any lane
ambiguities can be detected and
corrected. Unless the Omega
position is occasionally compared to
the position fix of another
navigation system or to a carefully
maintained DR plot, the possibility
of lane count error increases with
time and distance. However, two or
three - frequency receivers can be
used to reduce the position fix
ambiguity. Navigational frequencies
of 13.6 KHz and 10.2 KHz have a
frequency difference of 3.4 KHz, the
phase of which can be measured by
some receivers. 3.4 KHz LOPs
coincide with every third 10.2 KHz
one, which has exactly a lane width
of 8 nm to give a lane width of
24 nm. With this, the operator only
need to know the platform location
to within an accuracy of 12 nm along
the baseline without any ambiguity.
Having established the lane count,
it should then be possible to
determine its centilanes without
ambiguity.
The lane resolution process can be
further extended by using even lower
frequency differences. The
frequency difference between
11.33 KHz and 10.2 KHz is 1.13 KHz,
which can provide a lane width of
72 nm. The frequency difference
between 11.33 KHz and 11.05 M z can
be used to generate LOPs with a lane
width of 288 nm, which is 36 times
the normal lanes width of 10.2 KHz.
The use of the latter frequency
difference is aimed primarily at air
navigation where the high speed of
the platform makes the use of wider
lane width imperative.
179
3.
PROPAGATIONAL PERFORMANCE
3.1
Diurnal Variations
Modal Interference
180
4.
181
component used t o
represent errors in phase
propagation corrections;
c. A short time constant
Gauss-Markov process phase
error ;
d. A white noise representing
receiver dependent
measurement noise.
i
I
:
I
,1
1
!
I
1
I
I
DIFFERENTIAL OMEGA
182
I
I
I83
References :
[l]
E.R. Swanson and P.B. Morris, "New Coefficients for the Swanson Propagation
Correction Model," Proceedings of the Fifth Annual Meeting, International Omega
Association, Bergen, Norway, August 1980, pp. 26-1 to 26-4.
[2]
R.J. Wenzel etc, "The 1980 Omega PPC Model Time Term Should Not Be used,"
Proceedings of the Fifteen Annual Meeting, International Omega Association, Bali,
Indonesia, September 1990, pp. 10-1 to 10-10.
[3]
[4]
184
Figure 1.
185
Ionosphere D-layer
Figure 2.
TM Modes Propagation.
186
rn
14
14
c,
.rl
rn
k
0
k
k
aJ
..
m
aJ
k
(D
cv
++
187
ABSTRACT
This paper discusses modem Strapdown Astroinertial Navigation
( S A I N ) systems as autonomous navigators for manned aircraft,
ships, missiles, and remotely piloted vehicles. These systems,
which approach Global Positioning System (GPS) accuracy,do not
depend upon man-made electromagnetic radiating devices that
may be intentionally shut down,destroyed, or become unreliable
in ahostileenvironment. Thepaper analyzesthe gyroscopic accuracy, axtificial stellarimage stabilization, star density, sky visibility,
and sky background irradiance effects on system performance. It
concludes that a high-precision, reliable, low-cost stellar inertial
system can be achieved by eliminating gimbals and combining a
strapdown Inertial Navigation System ( I N S ) with an Optical WideAngle-Lens Staxtracker (OWLS).
1.0 INTRODUCTION
188
lAGNmC COMPASS-FLUX
1950
1960
1970
VALVE
GIMBALLEDINERTIAL
NAVIGATION
GYROCOMPASS-&b
DEAD RECKONING
1980
19pO
I
I DOWN
DOPPLER RADAR
4CREMENTAL CLOCK
b
b
HRONOMmA
RUBIDIUMTIME STANDARD
b
GIMBALLED
STRAPDOWN
NARROW FOV
WIDE F O V F
STAR TRACKER
STELLAR TRACKER
"r
1
I
VlSUAU
I
I
. M L
AIDS
TERMINAL SEEKER
MlLLlMfER
ACOUSTICAL(AIR)
PROCESSOR
9uI.121.I 7
UNAIDED STRAPDOWN
lNERTlAL,NAVlGATlON
100.ooo
10.ooo
bl
N
I ERTA
I TA
I
NAVIGATION
bPlTOTTUBVEM LOG
00
2000
,UNAIDED INERTIAL
NAVIGATION SYSTEM
'\
STRAPDOWN
'
PROJECTION OF NAVIGATION
SYSTEM PERFORMANCE FOR
GPS, ASTROINERTIAL, AND
UNAIDED INERTlAL
NAVIGATION SYSTEMS
FOR l(1HOUR FLIGHT
'\
'\
STELLAW
'. ',
1,000
2%
- --- -
100
4 HOUR COVERAGE
,o
-
43D24HOUR
COVERAGE
10
1950
1960
1970
1900
1990
2000
2010
92M-12141
I89
POSITION CORRECTIONS
VELOCllY
CORRECTIONS
2
A
2
GW
~LWT
ROLL
f = SPECIFIC FORCES
W =RATES
LT = BODY TO LEVEL TRANSFORMATION
LT E = EARTH TO LEVEL TRANSFORMATION
WE = EARTH RATE
Wg = BODY RATE
Wc = CRAFT RATE
G<>= GYROSCOPEFRAME
V =VELOCITY
B<>= BODY FRAME
f g = GRAVITY
L<>= LEVEL FRAME
WT =TOTAL INERTIAL RATE
R =EARTHRADIUS
A< = ACCELEROMETER FRAME
OZM.12191
GYROSCOPES
* DIRECTION COSINES
ACCELEROMETERS
ALTIMETER
CHRONOMETER
-4
INTEGRATION PROCESSOR
II
KALMAN FILTERS
EPHEMERIS, ETC.
OPTIMUM
ESTIMATED
NAVIGATION
SYSTEM OUTPUT
POSITION
VELOCITY
EULER ANGLES
ANGULAR RATES
--------
STELLAR
TERRESTRIAL
HORIZON
CORRELATOR
9
ENHANCERS. ETC.
Figure 3. Simplex Strapdown Stellar Inertial System Model with Terrestrial and Horizon Image Options
of the vectors of position, velocity, and Euler angles, as well as
gyroscopic errors, such as bias, scale factor, and misalignment, and
observable accelerometer errors.
After the inertial stellar observations are made, every additional
measurement continues to minimize the error vectors.
I90
Where:
I = Acceleratlon of Gravity
6 A = Acceleratlon Error
6 v = Velocity Error
6 = Posltlon Error
6 9 =Tilt Error
6 w = Angular Rate Error
Figure 4. Heuristic Astroinertial Error Model (the astroinertial system cannot compensate for some acceleration errors)
191
2500
2000
1500
E
AUGMENT WITH VELOCITY
REFERENCE AT T = 18 H
1000
500
0
16
20
18
22
24
26
HOURS
92M12l.CX
Figure 5. Simulated Results: Strategic Penetrator Position CEP of Inertial Navigator with Low-Rate Stellar
and Velocity Reference System Augmentation
9.9
10 CM RLGs
OR
RFOWIFOG
- 60000 FT
6.6 40000 FT
20 CM RLGs
30 CM RLGs
CM RLGs-
-40
3.3 20000 FT
STELLAR INERTIAL
0 - 0 FT
OSEC
20000SEC
40000SEC
60000SEC
HRS
5.5 HRS
11.1 HRS
16.6 HRS
-<1000FT
80000SEC
22.1 HRS
82M-121-06
Figure 6. Simulation Results: Astrotracker Inertial Augmentation Essentially Eliminated the RLG as a Dominant Error
Source (CEP vs Mission Time)
1.92
14000
INERTIALWITH ALTIMETER
AUGMENTATION
12000
10000
--
6000
z
P
8
nl
6000
4000
INERTIALWITH ALTIMETER
AND STELLARAUGMENTATION
2000
1000
500
0
0
10
12
14
16
MISSIONTIME IN HOURS
02M.12147
Figure 7. Strapdown Stellar Inertial System Performance--Strategic Penetrator Mission with 40 cm RLGs
(CEP vs Mission Time)
n n
30 AND 40 CM
12
16
Figure 8. Strategic Penetrator Strapdown Stellar Inertial System Performance: 10,20,30, and 40 cm RLGS or
RFOGAFOG (CEP vs Mission Time)
193
Aftertheimage snapshotistaken,thedataintheimagepmcessoris
transformed into stabilized coordinates with the aid of the inertial
navigators direction cosine matrices. The image data integration
for signal-to-noise enhancement, as shown in Figure 10,is a
complex process in which the shutter opening is operated at 100to
1,OOOps to prevent star image bluning. Thishigh-speed shuttering
of data is necessary even for vehicle attitude rates as low as 1 de&.
VEHICLE:
ROLL R1
PITCH P1
194
VEHICLE PIANE,
/*
INERTIALLY STABILIZED
FPA IMAGE
TRANSFORM
TO INERTIAL
/*
I
I
I
I
I
I
I
-------1
x 1.6-
-1.6
- 1.4
5.
T
L
- 1.2 4
U)
- 1.0 E
v)
0.2-
0
J
Wavelength (pm)
0
r
9261-121.11
Figure 11. A Typical Sky Background at Sea Level and 100,000 ft (Sun Zenith Angle 53 deg, Observer Angle 58
Sun-to-Observer Azimuth 90 deg)SEYRAY Electro-OpticalSystem Analysis, page 139, Pub.
"EO RESEARCH CO."(AFAL Report of NEMD)
195
100
90
80
70
YE r n
6o
540
30
20
10
0
0.3
0.5
0.4
0.6
0.7
0.8
1.1
1.0
0.9
1.2
1.3
Wavelength (pm)
9W-121-12
Figure 12. Atmospheric Tranmission for Various Air Masses or, Equivalently, From
the Ground to Space at Various Angles from the Normal; One Air Mass
Corresponds to the Amount of Air Through Which a Beam Must
Pass When Going Straight Up to Space (Courtesy RCA)
QW = J
where:
QSP
4%
.AA
AT
A,
TT
rl
4
Nf
NS
q
QBP
q5B
* A A * A , TT * FOV. t l * IT * Nf
N * 0,
where:
QBP
4B
FOV
N
0,
where:
=
=
=
=
=
QDP
ni
=
=
VE
(QSP
+ QSP + QDP)
QES
where:
QNP
&p
QDp
=
=
=
Qas
&p
SNR =
QSP
/,
(Qsp
+ Qsp + QDP)
QES
- Je,.e,
QSP
sNR
196
Stars.
Figure 16 shows the probability of seeing the sky from sea level.
Above 13.7 lun (45,000 ft) in altitude, the probability of having an
unobstructed view of the starsis essentially 100percent. Although
at an altitude of 13.7 km. an unaided observers view of the sky is
unobstructed by cloudcover, the sky background light will prevent
observing the starsin daylight. Yet at night, the unaided observers
view of the stars from that altitude is spectacular. Above 13.7 km,
the daytime sky background, not in the direct vicinity of the sun,
grows pmpssively darker with increases in altitude until it
essentially turns black and is indistinguishable from the nighttime
sky. Thus, at altitudes above 60miles, a startracker the size of an
eyeball provides sufficient signal to reset an inertial guidance
platform.
The quality orpureinertialperformanceof the gyroscopes needs to
be high when operating for sustained periods under cloud cover.
Under these conditions the gyroscopes may only get stellarupdates
a few times an hour. On the other hand, when operatingabove 13.7
km with a high-speed startracker, the system navigation
performance will be outstanding even with low cost, modest
performance gyroscopes. Furthermore. when operating at zero
velocity on the ground, while tracking stars, the stellar inertial
system can calibrate many of the inertial instrument errors
including the accelerometerbias. This featwe.reduces some at the
accelerometer long-term emor sources.
B Band
0.4 f 0.049~
Mr
R Band
0.70 f 0.11~
Densitv per Deg2
1
2
3
4
5
6
~~
0.0002
0.0006
0.0022
0.0075
0.0240
0.0710
0.0006
0.0022
0.0077
0.0250
0.0750
0.2300
197
A IAPERTURE AREA
12
TERRESTRIAL OWLS
A = 36 aq In.
E l1
3 lo
E
s 76
SPACE
MinKlWLS
A = 0.72 rq In.
0 3
z
U
2
1
bi
-p
-2
0.06
0.6
I-IER:brAL
60
600
6,000
60,000
ALTITUDE IN MILES
- & 3 P A C E MiniOW
IN DAYUGHT
9ucIII-14
198
1992 - Gimballed
4:l
Reduction
7
; in. w x 7
; in. H x 20 in. D
45 Ib
Satellite and Spacecrat System
120:1
Reduction
14in. W x 15 in. D x 2 0 in. H
Including Power Supply 8 Processor (165 Ib)
ngure 15. Comparison of Glmballed and Strapdown Stellar lnertlal Navigators for
Alrcrafi Along with a Spacecraft Stellar Inertial System
40
30
ALTITUDE
(FrXlO))
20
10
6
26
Rgure 16. Probabllity of Clear Llnes of Sight Over the Northern Hemisphere
for All Seasons Combined (72,000 Observatlons)
I99
5.0 CONCLUSIONS
Stellarinertialcapabilityis aprecisionautonomousnavigationstrategic asset. The technology encompasses gravity compensation
techniques, stellar catalog, telescope design, and inertial navigation. It provides the user with a unique surgical strike advantage in
an area where, for a host of reasons, radio navigation has been
eliminated or temporarily denied. The SAIN enables reducing the
cost, size,andreliabilitypenalty for autonomousprecision strike to
an affordable option in futurevehicles. When sensor fusion is taken into account, the low-cost stellar option provides in-& alignment regardless of the vehicles flight path or speed, and a level of
navigation redundancyto enhancemission success. Thus, as in the
past, modem man should depend on the stars for navigation.
3.
4.
5.
6.
BIBLIOGRAPHY
1.
2.
200
Donald L. Moore
Avionics Systems Engineering
Smiths Industries
Aerospace & Defense Systems Inc.
Grand Rapids Division
4141 Eastern Avenue, MS 240
Grand Rapids, Mi 49518
USA
Summary
This paper addresses the most m m o n system for pro
vidinganaircraftheadingreference: theme~~~ticheedng
r e f e m system. It begins brietly explaining the importanceof a magnetic heeding reference(section1). tl then
addresses the fundementel characteristics of the enrth's
megnetic field and exqlains the co(IoBp1of 'magnetic miatiorr'(section 2). Itdisarssestwo of the more common
slyles of magnetic heading 88nsors along with their inherent e m (section 3). After explaining how these b(terent compasses operab, the paper explains the dillerent
types of heading enom that occur. secoion 4 addresses
the in-flieht m,
Wle section 6 addressesthe magnetic
disturbances caused by the aircraft W .Section 6 discussescalibration techniques that providefor the curection against these ma~neticdisturbance induced mors.
Finally, this peper cardudes nrcth a Mef disarssion of fucuretmds(sectian7).
1 Introduction
Many pieces of information must be available to a navigator (either a person or an OlFbOard computer) to reliably
fly an aircraft from point A to point 8. Obviously, one very
useful piece of infomationis the correctdirection of niM
to eventually arrive at point B. But, before turning the aircraft in the desired direction, the navigator must know the
ament headingof the aircraft. The magnetic heading reference system providesthii uitical piece of information.
[a
20 I
W?mnpbuing a coufs~from pointA to point B,the navigator (which may be an on-board computer) determines
thedesiredheadingbasedon the earth's@ system. This
heading references the no& geographic pole, and is r e
fend to as the ?rue' heading (asopposed to 7nagnetic"
headq). Course plotting is usually performed using bue
heading, and course navigating is performed using magnetic heeding.
The dmencebetweenthe true heeding (which reterernes the geographic north pole) and the magnetic heading (vuhii references the magnetic nath pole) is know
as magnetk variation. Aeronautical cherts are aveileble
that povidetheeast~orwesterfymegneticvariationfor
any point on the eerth. These chertsareknowas 'Mag
neticVariation'charts and are p u M i i by the Defense
MepQine Asency H Y d m J m center PI. It
closes the gap between course plotting to true h e a d i
and navigating to magnetic heading. For erample, if the
plotted ooum is 210" tma heading, and the chart indicatesawesterlyvariationd 50, the rnlqnetic course tony
wDu(d be 215".
3 Magnetic Sensors
The mainfUnc(i0nof a magnetic heading referencesensor
is to provide the actual magnetic heading of the aircraft.
Sensors cepeble of providing this data are often refened
to as %agnetometers". Mqnetometersmust be capable
of detecting the direction of the horizontal component of
the earth's magnetic field. From this, they can derhre the
actual aircraftheeding. T w of the most m m o n methods
for determining this are the 'simple magnetic compasss
andtherluxgetestylempass'.
141.
cunpassare:
l.Theyarerdalhdyi-.
2. Theydonotrequireelecbicalpowertooperate.
202
I\ -.m7
PRIMARY
COIL
CORE
F ~ u r 3:
e flux Lbres UnsaturatedCore
0
CORE
I
I
PRIMARY
VSl
ERST
ew.1
Recall that the sensed heading from a flux-geUe me^netometer is a function of the horizontalcomponent ofthe
earth'smagnetic field. If the aircraft is banked, the sensed
horizontalcomponentof the field isnot of the same magnitude as whenthe einraA i
s
min a leml atbihrde. miis
due to the couplingofthe vertical field component and r
e
sub in an error in the calculationof the aircraft'sheading.
To correclthis wor,the compass keeps the 'axessin the
horizontalposition h unecceleratedflight by either placing
the unit in a 'gimbal", or by setting it in a fluid similar to
that used in the "lhiskey' compass. The VuW approach
poses the same damping problems as the 'vuhiskey'com
pass. Magnetometersthat are 'gimbaled" or set in fluid
are referredto 8s pendulous magnetometers.
4 In-Flight Errors
COIL
Inthe fluxgatingprinciplestyle justdescribed, two posSiMe headings exist for every current needed to saturate
We core. In the example given in figure 5, the current of
0.707 amps implies that the angle of the core relative to
the earth's magnetic field is either 45" or 315". To r e s o h
thii conflict, another core (with a primary and wumdary
coil) is offset such that the ambiguity can be resolved. The
number of additional cores,the physical placement of the
additional core(s), the type of materiel used as the core,
and the shape of the core is where the fluxgate magne-
203
4.1
m).
wv)
=??
5.1
W - M
4.2
Acceleration/Deceleration Errors
The geometry behind this error is the same as explained in the 'northerlyturning error" section. That is, the
error is at its greatest when the sensor tips in a direction
such that the perpendicular to the horizontal component
of the field is greatest. An acceleration/decelerationwhile
flying in an easterly or westerly direction causes this "perpendicular tip". This causes the heading indicator to show
that the aircraft is in a turn, even though it is in a straight
and level attitude.
.W
IW
zm
-v
204
5.4
DC Conductor Disturbance
6 Calibration Techniques
The aircraft magnetic disturbances, 88 Mned in the p f e
vious section,anect the detected direction of the horirontal component of the earth's magnetic field. To account
for these disturbances and prewnt an inbced am,the
compass must be 'calibrated'. T\ruo of the more common
methodsusedto calibrate the magneticheedingreference
sensor are 'manual swinging" and 'elecbicel swinging'.
Thesetwmdhodsprovidelheactuelenocceusedby
thealrcraftitaelf. Theactualmpensabjonoftheemus
canbeperformedby:
1. Installingdegaussingcoils or permanentmagnetsat
the location of the sensor to counterad the aircrefl
field.
2. Installing soft iron pieces in a position that will compensate the soft iron (2-cyde) ~ 0 1 s .
aircraft
aiterhandpro~asurveyedcompessroseforanactual
heeding reference.
205
[e] W. A. Shapiro and C. E. Roemer, 'A Strapdow Magnetic Azimuth Detector", Navigatim: Jorrmal of The
Imtitute of Navigation, Vol. 17, No. 4, Winter 19701971.
[9] D.Baker and M. Skaar, Maans Fur Compass Swim
ing wilhout Rotabng the Aimfl, Proceedings of
the IntemationalAirTrfuwportAssociationsSixt~
Technical conference,Miami, FL, April 1965.
7 Future Trends
The magnetometersdiscus& in this papware very r e
IlaMe, relatively inexpensive, and suffidentty accuramfor
most uses today. Some military a p p l i i , however, re
quire more acaracy, especielly during accelerated light
endaggressivetums. Developerahavethereforecmted
a magnetometer that is strapped down 88 opposed to
baled. To detect the rdl a@eofIhe eircraft, it u s e s a w
andehxqpte coil placed at an angle that sensesthe YBIticalcomponent of the enrth's magnetic field. Couplingthii
rollinfonnation with accelerationdatafrom anaccakometer, the magnetometer can then provide very eccurate
heerfing information under all n i t c o n d i i . W s 3
cuds sIrapdowmmagnetometer' [8] is already in use today
in m e aircraft, and shouldbecome more widely used in
the W e .
The most dramatic change vvith magnetometerswill
pobably be in the way they are calibrated. cunently,
oegmund manual swinging is the most common melhod
usedtoday and it takesat least 3 housto perform. The
timeusedforcalaxationusingthemaMlalswi~~technique
may 80011 be reduced to no mmOre than 10 minutes by including amparisonsagainst m inertialheading reference
such as an INS or Attitude Heading Reference System
(AHRS). Ether an on-board computer or a canyon canputer wdl cdlect and process the information duing the
swing and digiily relay the appropriate calibration coeffidents backto the unit for storage. A developmentalmodel
of such a system (an improved version d the U.S. Army's
ANIASN-43) calibrated a compass to 0.5" RMS witkin 6
minutes using 1975 tedmdogy.
References
[l] M. Kayton and W. R. Fried, Avionics NabigfdimSystern, John Wiley 8 Sons, Inc., New Y& 1969.
1983.
207
SECTION IV
SYSTEM ANALYSIS, DESIGN
AND SYNTHESIS METHODOLOGIES
THE INTRODUCTION
by
Dr. D.F Liang
Directorate Research and Development
Communications and Space
National Defence Headquarters
Ottawa, Ontario
Canada
K1A OK2
INTRODUCTION
208
209
210
21 1
3.1
212
b.
C.
d.
e.
f.
g.
3.2
213
4.1
Global Positioning System
(GPS) ,
214
8 V - p x 6R,
6 V - 0 2 8 R + 3 o2
S
(8R
R R + 8s.
-)-
- r r
r9
Ta
CHX,,
CGX,,
where
xg
xa
where
215
transformation matrix
relating inertial sensor
assembly reference frame
to the local-vertical
frame ,
coefficient matrix which
transforms the collection
of gyro errors into a net
angular rate error in the
sensor assembly frame,
coefficient matrix which
transforms the collection
of accelerometer error in
the sensor assembly frame.
In the event the IMU is strapdown in
nature, the transformation matric C
is defined to be the direction
cosine matrix relating the vehicle
body axes to the local-vertical
frame. When the IMU is of the
gimballed platform type, the matrix
C is an identity matrix, since the
inertial sensor assembly is at all
times coincide with the local
vertical reference frame.
4.1.2 IMU Simulation Model.
The IMU simulation model implements
the classic set of navigation
equations
gravity vector,
AL
vehicle nongravitational
acceleration,
[.I
skew-symmetric realization
of the enclosed vector.
G2 - drift coefficient,
Bias drift,
Scale factor error,
Input axis misalignment,
G - sensitive drift coefficient.
Accelerometer
Where,
Bias error,
Scale factor error,
IA misalignment,
Vibration induced Bias.
216
4.2
Doppler Radar.
Doppler radar measures the aircraft
velocity with respect to the fixedantenna coordinate system. The
errors include:
a.
b.
c.
d.
' -- - 1
vcn
T,
rlcn
and
1
where
Tc
rlcn
and
rl ce
217
v,
= 1.3
(v,)
Bij
-1
vwe
3 - I
V"
for which i
where
x , y, z .
VW
vm
magnitude of wind,
north surface wind
velocity,
and
VW,
4.3
GPS
GPS three dimensional position and
and
i-axis position
correlated error,
i-axis velocity
correlated error,
position error
correlation time,
where
true velocity along
i-axis,
velocity error
correlation time,
north-east-down to x-y-z
frame transformation
matrix,
i-axis position
correlated noise,
N, E, D.
218
b.
C.
d.
Instrument errors.
4.4
Magnetometer Model
The magnetometer provides a true
heading measurement referenced to
true north. The heading error can
be modeled as
where
true heading,
llrt
slowly varying
instrument bias error
with typical value of
0 . 5 - 2 degrees
*b
Ill
I3
I5
I2
I4
where
hb
correlated barometric
altitude error,
Tb
barometric altitude
correlation time which
equals to the correlation
distance divided by the
vehicle velocity.
Ib
two cycle
Gauss-Markov heading
errors with typical
RMS of 0 . 5 - 1.0
degree,
uncorrelated white
noise in the order of
0.1 degree.
4.5
A i r Data Model
The air data subsystem provides air
speed and barometric altitude
measurements. The barometric
219
vns
Vna
where
vna
northerly airspeed,
vea
easterly airspeed,
vha
v,,
lateral airspeed,
a.
The northerly and easterly airspeeds
are given by the equations.
vea=
Vet
(1
- 3 , v,, ha
ht
ha
0 . 2 nm;
b.
c.
d.
e.
Vea
and
where
h,
true altitude,
ha
v*s
Vea
4.7
220
dt
propagates according to
MARKOV
PERIOD
0
0
0
pz
03
L- J L
1/T2
22 1
5.
THE KALMAN FILTER DESIGN
The dynamics of the error state
vector
and
where
UDUT
222
5.1
5.3.2 Doppler
5.3.3 GPS
-
5.2
Elimination of Horizontal
Coriolis Acceleration
In most aircraft application, the
Coriolis acceleration error due to
the vertical velocity is
substantially less than the
uncertainty in gravity model. Such
an observation allows the Kalman
5.3.4 Omega
223
5.4
GPS Rate Aiding
The INS data can be used to rate aid
the GPS receiver. The aiding
permits narrower bandwidth code
tracking loops in the GPS receiver
to improve its anti-jamming
performance. It also reduces the
satellite acquisition time by using
a priori antenna velocity data to
account for Doppler shift of the
carrier frequency.
a.
an aircraft trajectory
generator which provides
nominal flight data,
b.
C.
7.
DESIGNER BEWARE
For any integrated system design, it
might be useful to consider some of
the following design tips.
a.
b.
224
C.
d.
e.
f.
Potential causes of
divergency:
Numerical error (negative
diag. P can be eliminated with
appropriate choice of P
propagation equation),
Programming error,
Nonlinearity,
Unmodelled error,
Optimistic noise level,
Incorrect model.
j.
k.
1.
m.
n.
Filter sub-optimization
(reduction of filter states to
improve efficiency while
increasing other noise levels
to absorb unmodelled errors),
a.
b.
C.
0.
d.
P.
q.
e.
f.
g.
h.
Verify simulation
all error sources
verify that there
unintended system
tool: set
to zero to
are no
errors when
9.
CONCLUSION
This paper has presented a brief
overview of the.design of a multisensor Generic Integrated Navigation
System (GINS). Lessons learned from
the development of a number of
integrated navigation systems have
been summarized to assist the
integrated system designer s o that
225
REFERENCES
Benson, D.O., "A comparison of
Two Approaches, to Pure
Inertial and Doppler-Inertial
Error Analysis," IEEE Trans on
Aerospace and Electronics
Systems, Vol. AES-11, No.4,
July 1 9 7 5 .
Bierman, G.J., "Factorization
Methods for Discrete
Sequential Estimation,"
Academic Press, N.Y., 1977
Windall, W.S. , "Alternate
Approaches for Stable Rate
Aiding of Jamming - Reistant
GPS Receivers, "National
Aerospace and Electronics
Conference, May 15-17 1 9 7 9 .
Dayton, Ohio.
Gelb, A., Applied Optimal
Estimation, MIT Press,
Cambridge, 1 9 7 4 .
226
.-
...................................................
- 1I
$5
a
...........................................
....................................................................................................
w
U
4-
.
f
ra
a
228
"i
* x
7,s
n
3
+-a
2
U
w
0
3U
0
0
229
2
r
3
m
d
d
c
\
m
0
U
CO
0
0
0
v)
>
0
Y
L
'
m
d
d
U)
v)
0
X
5
d
E
Q
N
0
v)
L
0
0
\t
VI
c
r
v)
0
m,
X
c
\
zl
VI
c
r
0
n
0
U)
L
0
0
c
VI
0
0
L
N
L
v0
c
\
m
- 4
M
0
VI
0
M
0
c
VI
0
0
d
o
N
o
em
o
c
3m
E
.-
0
0
F
0
0
Y
L
U)
.C
.-E
v)
i i
. x
v)
L
0
.C
230
.-U
m
al
c
.-
U)
L
0
2L
c
\
01
m
al
U
In
In
In
r
0
m
r
0
m
'
al
c'!
E
3
w
0
m
rn
r
v)
'c
E
3
m
m
m
m
C
0
L
0
\
v)
L
0
v)
al
m
\
m
v)
0.
c
In
v)
0)
v)
Pal
.-U
'
al
C
0
0
0
rr
In
v)
r.l
'
c c c
'
'
'
'c
w
0
0
s
L
'c
m
aI
m
Q
m
0
v)
v)
.-nm
E
L
a,
v)
I-
>.
.-r
C
m
.-
.-r
al
>
al
r
r
x
.-
.-
Pal
.-
U)
U)
m
m
m
m
C
0
C
0
Pal
Pal
U)
v)
.r
U)
v)
e
0
m
m
C
0
d
v)
23 I
INTRODUCTION
In recent past either adequate computational and data bus technologies did not exist or the mission did not require the deep
integration of information that the various sensors provided.
The sensor performance and the computational and data bus
capabilities have increased, and the mission requirements warranted some exchange of information outputs among the avionics black boxes. For example, INS velocity information was
provided to the synthetic aperture radar (SAR) to enhance its
motion compensation performance. These were the earlier
stages of integration and could be called limited integration or
output inregration. Numerous constraints limited the quality,
quantity, type, and other attributes of information in that limited
integration information exchange.
In addition to the various computational and data bus constraints, standardization constraints also affect avionics sensor
subsystem. For example, the USAF Standard INS has stringent
specifications for not only the required physical fit and function
but also for the digital output format, rate, and content, including the data word length, precision, structures, time tagging,
and other related parameters. The output specifications, which
were developed primarily to drive cockpit displays, are often
not suitable for deep integration. Some constraints are imposed
by the availability of technology, such as the speed limitation
(capacity) of the MILSTD 1553 data bus while others are driven
by the near-term focused specification process.
An early example of limited sensor integration is the central air
data computer (CADC) for aircraft applications. The CADC
combines several pitostatic and dynamic measurements of
atmospheric conditions with other information, and provides
altitude, airspeed, and rate-of-climb information corrected for
several nonlinear distorting effects. The integration exemplified
by the CADC is in combining of the dynamic and static atmospheric pressure-sensor information and enhancing it with relatively sophisticated, but open loop, compensation algorithms to
provide higher accuracy outputs than those possible from the
basic sensors. In other instruments the combining of information is nonexistent or limited. The GPS/INS integration,
described in a later section is an example of limited integration.
Of significance here is the fact that each sensor evolved primarily from the early necessity for stand-alone operation, that is
without the necessity for communication of information to or
from other sensors. Where information was needed to be
shared with other sensors, the format of that information was
typically constrained to that available at the post-processed output format specified by the primary sensor function. The more
recently developed sensors have imbedded in them powerful
computing capabilities which enhance sensors' output performance. In these cases, functional outputs from other sensors
may be combined to enhance this performance.
Continuing rapid advances in processors, processing, detectors,
networking, and other technologies are motivating the reexamination of the sensor information integration architectures and
the integration of navigation information with that from other
sensors. These advances in technology and rapid reduction in
component cost provide opportunities for integration at sensor
232
signal levels deeper (closer to the raw signals) than just recently
possible. This deeper integration is an unexplored area, especially when considered from a broader system level perspective.
where the system might contain a variety of sensors, including
those classically dedicated to navigation. While this assessment
is based on information available in the professional literature,
it is important to recognize that substantial work in this area has
likely been accomplished and not yet reported.
In many avionics sensors the output signal is a result of substantial processing of raw signals. An example of a raw signal in
this discussion might be the digitally coded radio frequency
(RF) in a communication system such as the phase shift keying
(PSK). Examples of raw measurements are: GPS receivers,
pseudo- and delta-range measurements derived from the binary
phase shift keying (BPSK) L, and/or L2RF signals, outputs of
gyros and accelerometers in inertial measurement, or pixel level
image elements in imaging devices. The acceptance of the GPS
as a prominent system for navigation and the explosion of the
receiver technologies, even before the full (24 space vehicle)
constellation is deployed in 1994, are first motivators for examining deep integration. Additionally, the rapid processing capability advances, with the simultaneous reduction in cost, are no
longer bamers to implementation of complex algorithms requiring substantial processing capacity.
Deep integration, for the purpose of this papes is defined as a
process which applies the system theory at integrated system
level to the ensemble of individual sensor raw measurements.
Essential ingredients of this deep integration process are proper
(adequate) modeling, system synthesis and simulation, error
analysis, and engineering trade-offs. A variety of approaches to
modeling and analysis are available. Most frequently useful, in
these types of analysis, are the error model approaches. One
critical step in this deep integration process is the access to (or
development of) validated truth error models. This truth error
model becomes the foundation of system level analysis. [ 1, 2, 3,
45.6.7, 8.91.
Linear algebra is a rich linear system toolbox well suited for
system level modeling, analysis, synthesis, and engineering
trade-off analysis [7, 10, 11, 12, 13, 141. In many system applications, linear system theory is widely used in the modelling,
analysis, and synthesis purposes. For nonlinear systems, where
linearization is practical, the same linear system tools are
applied. One of the profound impacts on system level integration is the development of the recursive linear estimation theory.
The most significant recent contribution to estimation theory is
the publication by R. E. Kalman, in early 1960s, of his work in
various articles, such as: A New Approach to Linear Filtering
and Prediction Problems [15]. This work in discrete-time
recursive estimation theory, combined with the advent of wider
use of digital computers, is known as the Kalman filter theory
and application. It has provided a powerful tool useful in system level integration. Although the Kalman filter is most
widely used, other methods of integration, or sensor fusion, are
used. This discussion is limited to linear estimation theory
applications.
Estimation theory is an essential ingredient for optimally
extracting the desired information given the random nature of
the measurement information received by the sensors and which
is inherent in processing of the information. The Kalman filter,
in its various forms, is the most useful estimation algorithm,
which is well suited for operation with linear systems tools [7,
16, 17, 181. In this endeavor, it is important to properly (adequately) characterize the dynamic and stochastic error behavior
of the sensor signals. Wherever possible, the least processed
(least correlated) information should be operated on by the estimation (integration) algorithm, because sound error modeling
becomes difficult for signals which have been modified with
various filtering and decision algorithms. Theoretically it is
possible to use processed (correlated) information, provided
that the processing, which had modified the basic signal, is
233
3 (2) = f ( X ,
U ,t )
(1)
y ( t ) = h (x, U , t )
(2)
The time-rate of change of state vector x(t). 3, is a vector valued functionf (not necessarily linear) of x, input U , and time t.
The system states may not all be physically meaningful quantities, but any physical quantity of interest can be obtained from a
linear combination of the states.
I ( t ) = A ( t ) x ( t )+ E ( t ) u ( t )
(3)
In many problems, the elements of the A and B matrices are
constants, implying that the system is time invariant in addition
to linear. Thii is not the case for the navigation systems considered in this paper. In particular, the elements of the A matrix are
a function of the position, velocity, and acceleration of the systems.
The biggest reason for using linear models to approximate real
world systems is the ability to solve the system of dynamic
equations using relatively simple linear algebra techniques, and
to achieve a closed form solution whose form does not depend
on the nature of the inputs or initial conditions (as is often the
case with nonlinear system models). For linear systems, the
output equation can be formulated as the matrix equation
are also easy to transform into discrete algorithms for microprocessor implementation. Computer programs to perform analysis for nonlinear systems are not as easy to use nor as simple to
implement. Performing parametric studies becomes extremely
challenging when nonlinear models are used.
2.2
0.00.
....................
."
xxI
- .......-........
-... ......................
i.
I
j
0.00)
.....................
x x x
'
xr*
% X U
..................I
...........................
.-c
0.w1
.-E
o.m,: .................................................................
x.
. . . . . . .
0 ;
Y ( t ) = C ( t ) x ( t )+ D ( t ) u ( t )
....................
.................................................
=+'.&z
. . .
(4)
"::
........................
.
63 = A ( t ) S x + B ( t ) S u + w
0.001
I;
xix
0.001-
'
I ;
......................
: x
!... ...........................................
...i
.........E." ..........j
x
;..................5 . . ...;
:
........................
(5)
1 :
(6)
0001-
4.001
.i......................
.o.m
I
rea?
0.002
1
t
0.00.
234
the systems under test. This information allows one to fully test
conditions that might otherwise be overlooked until too far into
the development cycle. A nonlinear system's stability is a much
more complicated issue and cannot be analyzed as easily. One
is often forced to talk about stability in the sense of Lyapunov
or bounded input bounded output stability. This is another reason to use a linear model whenever possible.
In addition to stability, one can easily compute the eigenvectors
of a linear system to gain geometric insights into the system
behavior. Eigenvectors form a basis vector set which spans the
n-dimensional state space. There is an eigenvector ( (t) associated with each eigenvalue hi, for i = l ,..., n. This, when coupled with Equations (3) and (4), yields insights into the
controllability and observability directions of a given system.
Knowledge of the eigenvectors coupled with the system matrices gives one insight into the limitations imposed by a given line a r model. One must realize that observability and
controllability are not physical properties of a system as are
eigenvalues and stability. Controllability and observability are
determined by the form of linear model chosen to represent the
physical system [13]. When using a Kalman filter, it is necessary to use a model where the states to be estimated are observable. States which are not observable cannot be estimated
accurately by the Kalman filter.
= H[sl-A]-'Bu
(s)
(9)
The matrix H[sl-A]-'B is the transfer function matrix of the system. Using Bode, Nyquist, or Nichols charts one can graphically evaluate items such as stability margins, bandwidth,
settling time, peak overshoot, and crossover frequency. These
issues are important when one starts to question how well a system performs in the presence of external disturbances, in various dynamic environments, and over frequency ranges of
interest. As an example, in a GPS receiver one must decide on
i = f ( x , U ,t ) + w ( t )
(10)
where w is an additive random driving noise vector which is a
zero-mean, white Gaussian noise process with covariance kernel [7, 16, 17, 181
E{w(r)wT(t+z)}= Q(t)6(z)
(1 1)
The measurement vector y, here in the discrete-time sampled
measurements form, follows the form of Equation (2)
y (ti) =
[x ( t i ) , til
+y (ti)
'
(12)
R ( t i ),ti = tj
0, ti f ti
Estimation Concepts
Whenever one attempts to integrate two or more navigation sensors, a choice must be made as to the type of integration algorithm to use. A Kalman filter is an optimal recursive algorithm
(estimator) that processes measurements from sensors in order
to compute a minimum error estimate (in a well defined statistical sense) of the state of a system. It does so by taking advantage of knowledge of systems dynamics, the statistics of the
system error sources and measurement errors, and available initial condition information. A Kalman filter can also be operated
in a batch mode, but recursive operation is the mode presented
2.4
235
2.5
6 i = A[x,u,t]6x+E[x,u,t]6u+Gw
(17)
6z = H [ x , t ] 6 x + D [ x , u , t ]( 6 u ) + Y
(18)
Using these linearized equations one can now apply linear filter
theory. The input measurement for such a filter is the difference
between the actual measurement and the nominal measurement.
The output of such a filter is an optimal estimate of 6x. To
establish an estimate of the state, one simply forms the total
state estimate as
E(r) = x , ( t ) + 6 E ( t )
(19)
This form of the Kalman filter is called a linearized Kalman filter [7]. It is computationally efficient compared to a nonlinear
filter, but it can experience large erron if the nominal state trajectory differs greatly from the true trajectory. This leads to the
use of an extended Kalman filter.
The basic idea of the extended Kalman filter is to evaluate the
Jacobian matrices about the last estimate once it is computed.
As soon as a new estimate is produced, a new,state trajectory is
computed and included in the estimation process. In this way
the validity of the small perturbation assumptions inherent to
the Taylor series approximation is maintained. The extended
Kalman filter is defined by the update equations given as follows [7]
= f ( r ; ) + K ( t , ) [zi-h[3(t;),tl]
(20)
P (ti' ) = P ( t ; ) - K ( t i ) H ( P , t j ) P ( t ; )
(21)
i ( f i + )
f = F [ f , t ] P + P F ' [ P , t ] +GQGT
(23)
236
2.6
Simulation Tools
the earth center, attitude with respect to the earth surface, and
the Greenwich Meridian Time (GMT). When two systems,
each represented by a geometric vector G,and G2respectively,
operate relative to each other, we can define a relative geometric vector AG
AG = G , - G ,
3.2
3. GEOMETRIC SENSORS AND ERROR MODELS
Among the avionics sensors aboard a typical aircraft, most contain common information in the geometric domain, that is these
sensors are geometrically related. Their measurements contain
some, or all, the elements of geometric information which is
defined as a set consisting of position vector ( r ) . orientation
(attitude) parameter array (g), and time scalar (t). The orientation of the vehicle can be represented in any of several orientation parameter sets; the direction cosine matrix (DCM),
quaternions, Euler angles, and rotation vecto2. Two most commonly used are the DCM and the quaternion because these offer
singularity-free representations [22]. The orientation array 9,
can represent any chosen orientation parameter set. These are
related and can be transformed between the sets. The rotation
vector is a useful geometric concept and is the choice for this
discussion. Thus the symbol (0)
- represents the rotation vector
in the following discussion. Temporal and/or spatial derivatives
of these information elements may also be directly or indirectly
available. For many applications it is convenient to use the
derivative of position, that is the velocity vector Y explicitly.
3.1
(25)
Most every sensor aboard an aerospace system, provides an output containing some or all elements of G or AG. For example,
an INS provides r. v, and 9. The GPS provides r, Y , and t, while
a crude approximation of 9 can be extracted for a receiver
which is not maneuvering rapidly. In another example, a modern aircraft radar system has the capability of providing various
forms of information accumulated along the line of sight, however the basic infomation available from most radar systems
consists of the LOS azimuth and elevation (@) and/or range R.
This information is derived from elements Ar and A$ of the
basic AG,where G, is that of the radar carrying platform and G2
is the target. The presence of G and/or AG components in these
sensors is the foundation for deep integration. Because these
sensors refer to the same physical geometric elements, the measurements that these sensors provide are thus spatially correlated.
The spatial correlation, between the various sensor outputs, discussed in Section 3.1 is mathematically modelable in the context of linear systems theory and a stochastic process. This
model can be processed in a context of a Kalman filter, where
the off-diagonal elements of the filter covariance matrix contain
the cross-correlations representing the spatial correlation. This
cross-correlation between the sensors is the cornerstone of deep
integration benefits. By proper modelling of all relationships
and processing in a single (joint3) Kalman filter, the optimal
(best possible) estimate of the cross-correlated errors is possible. This can be thought of as a mutual (cross-) calibration process of the various sensor errors which share the same physical
geometric domain (or have a known relationship with the same
geometric vector). Again, this cross-calibration is limited by
the quality of the dynamic and stochastic error models, the relative magnitudes of the uncorrelated noises among the sensors,
and the noise (both measurement and driving noises) magnitudes relative to the signal strengths. The truth model analysis
establishes the best possible cross-calibration performance.
The performance of the subsequently synthesized reduced-order
filter can be compared to that of the truth model. The next discussion presents key linear algebra tools and concepts in modeling of the sensors and their error behavior.
Although this array does not always satisfy all vector properties
as discussed above, it is referred to as the geometric vector G
and denotes the represented physical variables. To be useful in
mathematical and algorithmic calculations, this vector must be
coordinatized in some reference frame, such as body b-frame,
navigation n-frame, earth e-frame, inertial i-frame, etc. For
definitions and discussion of reference frames see [ 1.2, 3.4, 5,
6, 7, 8, 9, 231. Of significance, for this discussion, is the fact
that this geometric vector can be used as an absolute or a relative reference. An example of an absolute geometric vector
might be the position and velocity of a vehicle with respect to
2.
181.
231
3.3.1
I
Sensor errors can be characterized as random processes, representable in the context of system level models. If linearization
and Gaussian uncertainty model assumptions are valid, then linear estimation theory is applicable. When all of these sensors
are completely (adequately) modeled in their dynamic and stochastic domains, then these models can be assembled in a single, joint error model. This joint model then becomes a truth
model. Estimation theory is then applied at the truth model
level where Kalman filter is the tool of choice for linearhinearized error models. Various desirable outcomes are immediately
available.
First, the Kalman filter computes the joint estimate of the mean
2 and covariance matrix P which contains the cross-covariances
in the off-diagonal elements [7, 16, 17, 181. These off-diagonal
elements represent the statistically (and dynamically) derived
error dependencies among the various sensors. These crosscorrelations, through the sharing of the common geometric vector, produce in the filter the error estimates, or sensor cross-calibrations.
Second, the truth model system-level analysis provides the
baseline for the best possible system level performance. This is
useful for various trade-off studies, engineering designs, sensor
level parameter trade-offs, baselining of contributions of each
sensor to the system level solution. and other analyses.
Third, the truth model becomes the reference system infrastructure for suboptimal filter design. Various system level tradeoffs in the filter design, filter tuning, and other sensitivity studies are well performed at this level.
3.4
f =dr-g
= piv-g
where p is the time derivative operator, pfr is the acceleration
(second time derivative of position) with respect to inertial
frame i. Gravity g must be computed and subtracted from f in
order to extract the inertial acceleration. This satisfies the third
required function of an INS. With proper computations. information from the gyros provides the platform orientation, where
the platform can now be mechanized to represent a desired reference frame. Equation (26) is coordinatized in a selected reference frame, e.g. the navigation frame n, and solved for earth
referenced acceleration (rate of change of earth referenced
velocity) v
238
where
frame with respect to the computation c-frame, flyp is the skewsymmetric form of the angular velocity vector between the inertial i-frame and the platform p-frame coordinatized in the platform p-frame, and the C17c represents the angular velocity
between the computation and inertial frames [I]. Similar differential equations exist for the other orientation parameter sets.
For detailed discussion see any of the following: [I, 2, 3.4, 5 ,
6, 8, 91, with [I] providing the best analytic discussion with
complete error analysis methodology. Equations (27) and (28)
are in the nonlinear stochastic differential equation form of
Equation (10). These two vector differential equations form a
set of nonlinear, coupled, second and first order differential
equations, respectively, which are easily convertible to a set of
nine coupled, first order differential equations and form the
foundation of the INS relationships. The initialization of an
INS includes the initialization of the orientation parameter sets
through a self alignment process using the information provided
by the measurements of the gravity vector and the earth rotation
vector [I]. These equations, when integrated from a set of initial conditions, provide continuous navigation solution in the
desired reference frame. However due to errors in the initial
alignment, gyros and accelerometer, and other sources, the INS
errors are nonzero and grow in time.
3.4.2
Britting [ 11, and others [2, 3,4,5, 61, develop error models for
various INS mechanizations. The basic INS error model is represented by nine fundamental variables, three position, three
velocity, and three orientation (attitude) errors. The errors form
an intricately coupled set of nine, linear differential equations
which are characterized in their dynamic behavior be nine
eigenvalues, corresponding to the dynamic modes of the system. These error dynamics are the linearized representation
(the A(t) matrix of Equation ( 5 ) ) of the nonlinear, coupled differential Equations (27) and (28). The gyro, accelerometer,
instrument misalignments, component transients, and other
errors are added to the basic nine error equations.
When the full error truth model is assembled it can exceed 90
states. There exist various versions of error models, with primary differences resulting from the choices of the coordinate
frame. For additional discussion on the error model development see references such as [ I , 3, 231. The Litton Guidance
and Control Systems LN-93 INS error model is used in each
illustrative analysis described in later sections.
3.4.2.1 Litton LN-93 INS Error Model
239
3.4.3
Because the altimeter error affects many of the INS states, the
fidelity of the baro error model is important. The single baro
state included in the Litton error model is adequate to represent
only one of the major sources of baro altitude error. Other baro
altimeter error sources are statistically independent and should
be included in the truth model. The baro output error state, 6hB,
is directly coupled to four states in the INS dynamics equations,
and is indirectly coupled to several others. An adequate baro
altimeter error model, includes the timelposition varying bias
(function of atmospheric pressure-altitude spatial gradient and
vehicle speed) 6hpco.instrument dynamic lag 6h,, scale factor
error 6h,,, and an instrument bias 6h,.
3.5
3.5.2
Barometric Altimeter
Barometric altimeter provides an indication of altitude by measuring the static air pressure. Altimeter output is a robust
bounding signal to the INS vertical channel. Like most pressure
sensors, the altimeter transducer typically consists of an aneroid
bellows with mechanical linkages to a dial or drum display.
This sensor is rather inaccurate due to several factors. The relationship between the static air pressure and altitude depends on
current weather conditions. The altimeter must be compensated
with a bias input (altimeter setting). Transducer time lag,
instrument bias, and scale factor are significant error sources.
The pilot and aircraft system need for accurate air data (speed,
Mach number, altitude, rate of climb) drives the trend to use air
data computers.
3.5.1
atmospheric variation
inst
T~~ = SOOsec
T~~ =
I.Osec
true altitude h
. .
6hB = 6h,+6hb+h(6h,,) + v
(32)
3.6
240
(33)
'+ (ySv- Y , )
+ (zSv- z,)
(34)
respect to the GPS time. The signal from the SV traverses the
ionosphere which distorts the path and causes an apparent time
delay. When the signal traverses the troposphere, the fluid
retards the propagation. The accuracy with which the user generated code can be correlated to the received code is a function
of noise, code loop bandwidth, and code chip length. The
uncalibrated propagation delay through the receiver also adds to
this error. The antenna-to-receiver cable propagation calibration error causes additional measurement error. However, this
error is often indistinguishable from the user clock delay and is
lumped therein. The raw pseudo-range model consists of the
true range and various time delays (scaled by c )
RRP
'elk,"
(36)
The range domain variables are defined in Section 9 and the following paragraphs. The white Gaussian additive measurement
noise v statistical properties are in Equation (13).
3.6.1.3 Compensated Pseudo-range
6Rc/km
( R , + h ) coscpsinh
=
= [ [ R , ( l - e ; ) +h]sin.]'
(35)
( R , + h ) coscpcosh
24 1
(39)
sd,, =
:
i 9
40
'rr
-1
'11
--I
0 - 0
'IIr
-I
TI!
(47)
0 o;, 0 0
0 0 o;, 0
0 0 0 o;,
--I
where d,,
= 1.M. The driving noise q, = 0.004 f$/sec?.
E{w,,)
The GPS phase lock loop can be modeled as a first order lag
driven by white Gaussian noise, with a time constant of approximately I second [34]. Assuming that the user set has a separate channel for monitoring each of four SVs, and assuming no
correlation between channels, the dynamic pations for user
set code loop am (with z,= I sec)
=o
(49)
where :
o = I.Oj8, for i=3,4,5,6. The driving noise is
E{wcode} =
where qc = 0.5f?/seC?. The code-loop error stochastic differential equation is in the form of Equation (38). but with
w,,,, ( 1 ) f 0. Equations (44) and (45) describe the first and
(51)
Pi(to) = 0
second moments of the white Gaussian driving noise probability density function.
(52)
[o; 0 0 01
3.6.2.3 Uncompensated Tropospheric Range Error 6Rlr
0 o ; o 0
0 O o f O
10 0 0 oi
8 i
(53)
242
;r
with=,z
...
01
1500 sec
[o: 0 0 01
E{w,,1 = 0
where qs = O.Ofl/sec? for the truth model, and qs = I.OxlQ'o
f8/sec? for the filter model. The non-zero driving noise in the
Kalman filter is used to keep the filter gain, associated with this
set of variables, from approaching zero. The non-zero, but
small, value keeps the filter gain open to permit parameter variation, or other model inaccuracies from detracting from filter
performance. This is one of various filter tuning artifices discussed in various texts, such as [7,161.
3.6.2.6 Satellite Position Errors 6rs,
E{ws,(r)W,T,(t+T:)l
(64)
=
0
... 9,"
243
0
pa,, ( t o )
25ft2 0
0 25fr2
= R , + 6Rafm+ 6Rbr+ v
(66)
A difference of two measurements is useful. The first is the
RRS range measurement. The second is the range computed
from the INS-indicated and surveyed-transponder positions.
The INS and transponder positions are represented by vectors
expressed in the Litton ECEF frame. The calculated range from
the INS to the transponder is given by
This equation is linearized about the error variables 6x, and 6x,
in a Taylor series expansion truncated to first order [ 1,7]
6~ = RINS-RRRS
(69)
The true range present in each range measurement is cancelled
[ 1.73. Also note that the bracketed coefficients in the equation
above determine the Kalman filter's H matrix.
The RRS error state vector consists of 26 elements. The first
two states are zero mean random biases which model the airborne equipment range and range-rate calibration errors. The
initial covariances for these states are
These two states apply to all RRS measurements. There are two
error sources unique to each transponder. First is the error due
to R' transponder surveyed position uncertainty (x, y. z components in ECEF frame), and second is the error due to atmospheric propagation delays between the user and each
individual transponder. The three position error sources are
with o2=1Q'". Equations (71) and (72) are for a single transponder. Six RRS transponders are used in this model.
The Kalman filter combines range measurements with its predicted measurement to calculate an optimal estimate of the state
vector. The indicated positions of the transponder and user are
modeled by
= x, + 6x,
(73)
(74)
XJ
244
nating the ground with a radar signal and sampling the magnitude and phase of the return is repeated every T seconds for
consecutively overlapping areas on the ground. The result is a
two dimensional array of data which contains magnitude and
phase information of radar returns in both range and azimuth
directions.
.
R =
fd
(77)
q=q++q
(78)
<,
6q.
Orthogonalizing
about a small angle perturbation matrix
askprovides the required linearized error model.
(<),=
(1-a)q
(79)
where askis given by a skew-symmetric matrix representation
qY 44 1451
of the rotation error vector & =[b,
@*k
Ly;J
$z
-+,
(80)
is directly
aircraft
In the range-Doppler method, range and range-rates are measured and stored for each cell in the SAR image. In addition to
range and range-rate measurements, this method requires a
radar altitude measurement for computing the location of a
ground based target.
where d is the range-rate, and U is the line-of-sight (LOS) rotation rate. Range-rate can be expressed (using Equation (81),
uTu = 0,and uTu = 1)as
d
d
i = -r = - ( R u ) = R u + R u
dt
dt
R =
UTi
(82)
5. This problem is simplified by the assumption (when valid) that the longitudinal axis of the aircraft is aligned with the velocity vector.
245
(83)
RaI = -uzIia
t
3.8.4.I
SNR
CNR+0.1
(85)
Radar Measurement
As previously stated, the radar is capable of obtaining an indirect measurement of R and d . However, these measurement are
not perfect and therefore must be modeled as the sum of true
value and the measurement noise. R and R denote the radar
measurement, and may be modeled by
Ay =
D
-
2
respectively,where c is the speed of light, B is the bandwidth of the
transmitted pulse, z is the unmodulated pulse length, and D is the
antenna diameter. For a spotlight mode SAR, the range resolution
is the same as above and the azimuth resolution is expressed as
R = R+nR+vR
(93)
R = i i + nR. + vR.
(87)
model. The truth model simulates with higher fidelity the true
radar measurements.
The primary measurement noises observed in the range measurement include the target designation error and the clock
error. Other errors which may also be included are multi-path
and range glint errors. These are not modeled here because they
are not always present in the measurements.
The target designation error is often modeled as a function of four
parameters, namely clutter-to-noise ratio (CNR), signal-to-noise
ratio (SNR), signal-to-clutter-plus-noiseratio (SCNR),
and the resolution cell size. The CNR is computed to establish that the image
quality is sufficient for individual fixed targets to be designated.
with
=
a
10(2.16x10~')r
atmospheric loss
L, = 10 (5.4xIO')qr
rain attenuation
p, =: 0.1 ( A R ) ( A a z ) clutter cross-section
RD
(T
VD
= KAR
(94)
= KAv
(95)
1
2 (SCNR)
(97)
6VD =
(98)
w VD
where wR, and wyr, denote white Gaussian noises. The second
scenario consists of initially designating the target with a SAR
then tracking it with monopulse radar. The errors present in the
radar tracking mode are a direct result of the initial designation
errors. Consequently, in this scenario a random bias model is
appropriate for the designation error
6RD = 0
(99)
8jlD = 0
(100)
In the Kalman filter design, a weak white Gaussian pseudo-noise
is added to Equations (99) and (100) to compensate for possible
hardware failures and model uncertainties. The clock error 6T
contribution to the range measurement 6Rc,, is expressed by
246
6T= 0
(102)
Again a weak pseudo-noise is added in the Kalman filter to
compensate for model inaccuracies.
The primary error in the range-rate measurement is the rangerate ambiguity error. Other errors which may also be included
are the errors associated with surface wave motion when targeting is performed over bodies of water.
The range-rate ambiguity Aka,,,b represents the smallest difference between two range-rates that could be detected by the
radar and is characterized by
60 n - R V 0 ( u : ~ ) $,I ~+ v 0 6 4 - V06<
where V 0 is the gradient of
where z is the radar pulse length and fo is the frequency. As an
approximation, we assume that the error in range-rate 6Rambr
resulting from the range-rate ambiguity, is white Gaussian noise
with a standard deviation of Akamb
v0 =
(109)
e, and defined as
-- (U;) nT [ I - u : ,
Rsin (0)
(U:,)
where
(I .
6Ramb.
Use of this
Ram6
zR = R I - R s + n R + v R
T
= (U:,) (6r:
- 6ra") + nR+ vR
(105)
,nT
-ra
= -[ I - U : , U ; , ~ ] [ 6r: - 6r:]
+ nd + vi
(106)
= w-q,-v,
0 = O-qe-ve
where q, and qe denote colored measurement noises and where
v,,, and ve denote white Gaussian measurement noise. In reality,
measurement noises q,,,, qe, v,,,,and V e consist of a number of
physical error sources. Next follows a brief description of the
primary error sources for use in the Kalman filter truth model
design.
The primary error source for azimuth and elevation measurements include: target designation error, antenna boresight error,
radar-INS harmonization error, antenna servolpointing error,
and radome correction error. First consider the effects of the
designation error. In particular, consider the effects of an azimuth designation error on the azimuth angle. A similar development applies for the effects of range designation errors on the
azimuth angle as well as the effects of both an azimuth and
range designation errors on the elevation angle.
An azimuth designation error may be modeled as a vector
which points in the direction of the aircraft velocity vector at the
time that the image was formed. For detailed discussion the
reader is referred to [45]. The radar azimuth designation errors
are presented
6$,
= vVu:sVD
(1 13)
60, = veu:6ylD
(1 14)
I/
Clov"d PI-
The boresight, radar-INS harmonization, antenna servo/pointing. and radome refraction errors have both an azimuth and an
elevation component which directly affect the azimuth and elevation angles, respectively. The azimuth and elevation errors
consist of several physical components. With the exception of
the radome errors, each of the error sources is characterized as
random biases. In general, the radome errors are spatially
241
? - $ = - R V v u k- $ + V y 6 < - V v 6 r : + q v + v v
(117)
(I 18)
ze =
6 -9
all of the sensors modeled. This commonality, when represented in appropriate mathematical models suitable for Kalman
filter implementation, offers opportunities to jointly estimate
the errors that are geometrically related. This joint estimation
is the key to substantial sensor error calibration and registration
against some reference points, such as the illuminated target.
When combined with the GPS. for referencing within the GPSdefined framework, tremendous opportunities are opened for
relative registration on a global scale. This registration can be
in relative GPS, differential GPS, or absolute GPS domains.
Again the key to this precise, yet globally available, sensor calibration and registration is joint modeling and estimation with a
single Kalman filter.
248
Transponder ID I
Latitude
005
33 01 36.14
Longitude
-10608 20.74
I
1
Altitude
4339 ft
102
32 55 58.59
-106 08 50.33
4074
181
33 44 58.03
-106 22 14.63
7932
21 1
33 17 55.99
-106 31 44.31
8842
3247 16.41
I -10549 15.47 I
9202
32 42 12.23
-106 07 38.90
448 I
212
216
Results
4.5 Simulation
The system truth model is constructed from the LN-93 INS, the
RRS, and the GPS subsystem models embedded in the MSOFE
simulation routines. The truth model, along with PROFGEN
generated trajectory and the SV orbit calculation software, generates measurements as well as reference variables which are
used to test the performance of a full-order Kalman filter. This
constitutes a simulation environment in which a variety of full-
In Figure 8, latitude error is indicated by the solid trace and longitude error is depicted by the dashed trace. Addition of the
RRS measurements improved performance by roughly three
orders of magnitude when compared to the INS performance
aided by baro-altitude only. This is essentially the performance
currently experienced by CIRIS. In the final phase, the GPS
model is added to the 98-state INSlRRS model, bringing the
249
1
E
'0
o
-100
-200
2000
4000
(sec)
1ooa
ooa
1
-2ooo.
-2ooo.
3000
3000
(sec)
(sec)
In Figure 9, latitude error is indicated by the solid trace and longitude error by the dashed trace. Note the significantly reduced
1-0 magnitudes in this configuration compared to Figure 8. In
some flight regimes (notably those far from the transponder
sites, or those with depressed elevation angles between the user
and transponders) performance appears to have improved by an
order of magnitude compared to the INS performance achieved
with RRS aiding alone.
In final configuration, both RRS and GPS measurements are
used. For the alignment simulations, 10 Monte Carlo runs are
performed. Alignment results are similar to those obtained with
either GPS or RRS alone. The general trend is a slight reduction in the filter estimates of the overall error magnitudes during
the alignment phase. In order to facilitate a direct comparison
of the Kalman filter horizontal positions states between this,
previous, and subsequent configurations, Figure 10 is
included. In Figure 10, latitude error is indicated by the solid
trace and longitude error is depicted by the dashed trace. The 1a magnitudes in this configuration are further reduced compared to Figures 8 and 9.
2000
1000
3000
.8
o
-.s
-'
-1.8
2000
-00
6000 (Sec)
(sec)
(ft) 1-0
I
"
Fi
3
-rm
moo
4400
eo00
(sec)
-120
'
ZOO0
4000
(sec)
250
this simulation. The flight path extends far beyond the optimal
coverage areas for the fixed transponders, and only six transponders are used; many actual flights use twenty or more transponders. The other important conclusion is that combining
GPS and RRS measurements, in a joint Kalman filter, offers the
best overall performance.
5. GRACEFUL DEGRADATION OF GPSnNS WITH
FEWER THAN FOUR SATELLITES
This study examines the graceful degradation of a deep integration of GPS with INS and compared it to that of a federated filter architecture integration [50]. Precision first pass weapon
delivery with exceptionally accurate navigation are vital to the
operational survivability of attack aircraft. Systems such as the
GPS are currently being fielded and integrated with INS to support such a capability. It offers the potential for less costly
weapon targeting systems if target coordinates can be provided
relative to the GPS reference. The current standard military
GPS receivers requires simultaneous signals from 4 satellites
(with good geometry) to calculate and output useful position
and velocity information. However, signals from 4 satellites
may not always be available, especially in and around heavily
defended target areas protected by high power jammers. These
high power jammers, even when recognized and appropriately
nulled out by adaptive array GPS antenna, can result in large
sectors of the sky surrounding these jammers no longer being
monitored for any GPS satellite signals. This study examines
Kalman filter algorithms which provide graceful degradation of
aircraft navigation performance when only one, two, three, or
intermittent satellite signals are available, and quantifies the
level of relative performance expected for these conditions.
This study also analyzes the relative performance of various
Kalman filter mechanizations as a function of filter size.
The Standard GPS Receiver IIIA does not provide the pseudorange and delta-range data from the GPS satellites on the MILSTD 1553 data bus. The receiver only provides position and
velocity data as an output of its own internal Kalman filter.
This filter is based on a generic INS error model that is not optimized to any particular INS type or technology (it is crude in
accuracy). If an aircraft requires a navigation solution optimized to a particular INS or if other sensors are required in the
optimal navigation solution this GPS receiver output standard
limits the aircraft Kalman filter designer to a cascaded filter approach. Use of GPS filtered position and velocity outputs to
drive a separate aircraft Kalman filter can lead to filter instability, in part because the GPS and the INS position and velocity
data are time correlated. This potential problem is minimized
by processing GPS measurements in the aircraft filter at a
much slower rate than available from the GPS receiver. This
helps in reducing the GPS and INS measurement correlation.
A spacing of 10- 12 seconds is frequently considered sufficient
when 4 satellites with good geometry are available.
When fewer than 4 satellites are available, the GPS receiver filter outputs degrade and closely track the rapidly growing INS
errors. To avoid filter instability under these conditions the aircraft filter is designed to disregard inputs from the GPS receiver when fewer than 4 acceptable satellites are available. This
cascaded filter approach therefore results in the binary ordoff
incorporation of GPS information. However, if pseudo-range
and delta-range data were directly output, a single non-cascaded (joint) Kalman filter could be implemented. Such a filter
would facilitate graceful position and velocity performance
degradation when fewer than 4 satellites are available. One
concern for GPS signal availability is during, or near, the
weapon delivery time when jamming is likely to be present.
Use of even momentary measurements from single random satellites by such a filter during a high jamming period will provide significantly improved performance over the cascaded
filter approach. This discussion expands on the work presented
in [50]. It describes the sensitivity analysis of the filter perfor-
5.1
5.2
Filter Development
25 1
vals. During the first 2000 second flight segment these errors
are reset at 30 second intervals
A representative weapon delivery mission for a modem attack
aircraft is generated using PROFGEN. This mission flight trajectory is shown in Figure 14. The significant segments are the
take-off, cruise, and descent during the 0 - 2000 second segment into the simulation. The second significant segment,
from 2000 to 2800 seconds, is the ingress, pop-up maneuver,
weapon delivery, evasive maneuvers, and escape, shown as an
enlargement in the bottom of Figure 14 This segment is examined with various GPS satellite availabilities. The final segment, 2800 to 7295 seconds, is the return to home base.
Single-run Monte Carlo simulation is performed for each case
analyzed for relative filter performance comparisons
--
1
..os0
.......................................................................................................
.,-- ........................................................................................................
...........:.. ...........;.............;...........;...............;. ........................... i......
.1070 .............................................................................
:.. ................
.............i ......................... ;.. ............;.............;................:...............i......
-il
..........................................................................................................
,-
.....................................................................................................
..D7..
..o-o
I 0 0 0
s-00
1
-
e-
............. ...........p..f
1-
m-
-0-
-00
..............
....,......
-000
0-
-0-
-00
The final, 18-state, reduced-order filter error model is generated by deleting the following 5 states (see the Appendix).
a.
4 code loop error states
b.
1 user clock drvt
These 5 e m r states m the least signifcant of the 23 primary emor
contributors. Deletion of these states should only be considered under severe computational limitations. A significant amount of tuning noise must be added to insure filter stability, especially for the
conditions of reduced numbers of available satellite measurements.
The performance comparison of the 18-state. reduced-order filter is provided in the Section 5.3. The performance of the 18state filter is significantly lower than that of the other three filters. The projected performance of the joint, 18-state filter
promises to be better than the F-16 15-state cascaded filter performance demonstrated during recent F-16 GPSANS flight test
[53]. With four satellites available, the projected performance
of the joint 18-state filter is 10 feet compared to the demonstrated performance of 27 feet (9 meters) of the cascaded filter.
5.3
Filter Evaluation
Evasive
Low Altitude
....
252
40
30
500
1000
1500
200
I
I
51-State
18-State
40
30
--
lo
18-State
40
30
0.8
0.6
23-State
3020-
10-
wv
2000
2200
2400
2600
28Q
0.4
0.2
51-State
32-State
0.2
0.84
51-State
In the next case, only two satellite measurements are incorporated during this mission segment. Note that in all cases analyzed, the vertical channel model includes at least one state for
the barometric altimeter. and the associated atmospheric pressure variation errors modeled as first-order Markov processes.
The presence of this state appears to significantly enhance the
performance of each filter, including the 19-state filter. In the
two-satellite case the position error performance of the various
filters varies substantially. The 32- and 51-state filters perform
better than the 23- and 18-state filters. This is especially true
during the first 400 seconds of this flight segment.
253
3-State
175
32-state
25
175..
175
23-State
150
12 5
75
50
50
25
25
32-State
175
2000
2200
2400
2600
280
0.4..
0.2-
IWO
satellites
0.8T
+
51-State
0.8
l!:il
0.80.6.
:::: - - = = = = =
0.80.60.4.
0.2.
0.8.
0.6.
t
32-State
51-State
0.4-
0.84
32-State
254
.._
II14l
2 4'0 0
2600
255
6.
6.1
6.2 CIRIS
CIRIS is described in Section 4. Up to this point in time, CIRIS
has been considered more accurate than the test articles and has
formed the baseline for determining the performance of aircraft
INSs. Recently, state-of-the-art aircraft INSs have been developed (and many more in the design stage) approaching the
accuracy of CIRIS. Interestingly, many of these new INSs use
the Global Positioning System (GPS) to increase their accuracy.
In order to use CIRIS as a baseline against these new INSs,
CIRIS must be enhanced to provide an order of magnitude more
accurate navigation solution. By using DGPS measurements to
augment the navigation solution of CIRIS, it is possible to
increase the accuracy of CIRIS to produce an order of magnitude better estimate of the navigation solution.
6.3 Truth Models
The 89-state truth model used in this research is divided into 3
sub-models based on the 3 subsystems forming the ENRS. The
first sub-model contains a 41-state INS model consisting of 40
Litton LN-93 INS error-states and a single baro-altimeter errorstate. The second 26-state sub-model defines the error-states
associated with 6 transponders modeled in the RRS. The last
sub-model contains the 22 error-states associated with DGPS
measurements from 4 space vehicles (SVs).
256
GPS is designed to be an accurate, stand-alone navigation system. However, for this research, GPS is used as a subsystem to
improve the navigation solution of the ENRS. GPS navigation
information is obtained from EM signal propagation through
the media (space and atmosphere) between the user (ENRS)
and each of 4 SVs which the user locks into a reception channel
of the GPS receiver. In a stand-alone GPS receiver, navigation
information is obtained by receiving GPS SV ephemeris data
broadcast continuously from each active (locked-on)SV,correlating the phase of the signal with a matching signal in the GPS
receiver, and correcting for known error sources to produce an
accurate range estimate between the user and each SV which is
monitored.
In this research, uncorrected range measurements (known as
pseudo-range measurements) are channeled to a Kalman filter
which provides estimates of the error sources. Common GPS
error sources which are considered dominant in this research
include receiver clock bias and drift, ionospheric and tropospheric (atmospheric) propagation errors, SV clock, and SV
position errors. Other non-dominant errors are also present in a
true GPS signal, but are compensated for in this research in the
GPS pseudo-range measurement noise. As in the RRS, GPS
range measurements make refinements to the ENRS navigation
solution possible.
Intermetrics, Inc. is the government sponsored contractor
responsible for the DGPS reference station at CIGTF [57,
58].The following discussion of DGPS comes from interviews
with Mr. Darwin Abbey and Mr. Scott Dance of Intermetrics,
and the DGPS error model described is a combination of Intermetrics description and a course given by Navtech Seminars on
DGPS error models [57,58,59].
PR,DR
INS Output
Errors
257
P (to) =
i"'
0
E{w(t)}
01
Iff2
=o
( 124)
E{w(t)w(t+r)} = oBO.
L o
0 . d
Cft2/sec2)G(r) (125)
The sub-models described above for the INS, RRS, and DGPS
subsystems compose the state dynamics equations (with initial
conditions). These are entered into MSOFE simulation so that
true error-state values can be computed and analyzed against
the extended Kalman filter's estimated error-states. Now that all
the error-states used in the models have been described, the 3
types of measurement equations can be overviewed.
0.35ff2
P ( t ~=
)
0
O.35ff2
0
E{w(t)}
E{w(t)w'(t+r)} =
=o
- RDGPS
0.35ff2
Ixr ix 1
Lo
R,NS
(128)
C f t / s e c 2 ) G ( z )(129)
XXXJ
(131)
The terms ax,, 6y,, and 6zudirectly relate to the INS position
error terms (latitude, longitude, and altitude) while 6xs, Sy,, and
6z, are the SV position errors. The pseudo-range measurement
noise variance is 9ft' when DGPS pseudo-range measurements
occur every 10 seconds. The true whole-valued range (R,)formerly present is cancelled in the differencing operation. The
bracketed coefficients in the equation above appear in the EKF
update equations. The full derivation of this equation along
with the EKF update and propagation equations is found in
[ 5 5 ] . The DGPS error-state truth model and measurement
258
equations have now been shown, so now the two filter models
used in this research are described.
6.6
Filter Models
Results
5 -.-
-.
~
~
~
' rooo,.rrlT
~
~
-- _ _ _ ' ' . '~_ . '
igure 30. 89-State ENRS Filter, Latitude, Longitude,and
Altitude Errors
,000
I
-
-00
-000
-000
The 89-state full-order ENRS filter's position and velocity estimation error performance is shown in Table 2 along with the
current CIRIS and the CIRIS-46 filter. The north velocity error
results are not presented due to space considerations, but their
values are comparable to the east velocity error results. The
temporal average of the ensemble average simply means that
the true lo values for all 25 simulation runs are averaged
together at ten second intervals and then this average is averaged to give the number shown. As seen, the full-order filter
provides order of magnitude better position and velocity estimates than the current CIRIS filter and much better performance than CIRIS-46. The increase in velocity error estimation
is attributed to the fact that if the filter's position error estimation is increased, it can also estimate the velocity errors with
greater precision. It is easy to see the benefit that DGPS
pseudo-range measurements have on increasing the accuracy of
CIRIS.
The results of the performance analysis on the 48-state reducedorder ENRS EKF are also shown in Table 2. As a reminder, this
filter is composed of 20 INS, 26 RRS, and 2 DGPS error-states.
There is a slight decrease in position and velocity performance;
however, this filter performs much better than either CIRIS or
259
CIRIS
14.00
I
I
14.00
I
I
40.00
0.100
18.09
0.046
I
I
0.400
I CIRIS-46 I
3.12
ENRS-89
0.84
1.04
3.80
0.013
0.042
ENRS-48
0.90
1.32
3.05
0.027
0.044
6.84
0.100
7.2
Federated Architectures
The evolution and limitations presented by the federated architectures is described in the INTRODUCTION Section l. This
evolution, and federated architecture subsystem outputs resulted
in unintended constraints on deep integration. However, despite
some challenges in providing for multiple requirements, this
limited integration concept was successful in that performance
of some sensors was improved, to a lesser or greater degree, by
providing information from other sensors. Most of the information provided from other sensors was at the post-processed output level or in the domain of output integration. This postprocessing modifies the raw signal, available from the detector, in bandwidth, noise statistics, and other electronic compensation characteristics. Although theoretically it possible to
undo the output processing if the internal algorithms are
known, this is not practical due signal-to-noise losses, distortions, and typically high cost. The impact of this post-processing is that it limits the degree to which the information from
other Sensors can be utilized, where appropriate, to improve the
performance of other sensors. This federated architecture, with
its limitations, is the prevalent environment that the military
GPS user equipment is required to interface to.
Introduction
A multitude and variety of commercial and civil GPS applications are exploding, which in turn are fueling the explosion of
commercial GPS receiver hardware development. The interest
7.3
260
GPSlINS Integration
26 1
7.6 Conclusions
The challenge for the military research and development community is to vigorously exploit the simultaneous arrival of the
GPS, the explosion in computational capability, and availability
of the integrated and modular avionics architectures for weapon
systems. These factors offer unprecedented opportunities for
much greater exploitation of avionics sensor fusion. With
proper fusion of the multitude of information available from the
variety of sensors aboard a weapon system, much greater benetits can be derived from the information contained in the GPS
signal. This sensor fusion is a strong function of the avionics
architecture and the variety of forms of information readily
available to any of the fusion algorithms. In integrated and
well-fused sensor avionics architectures, in addition to significant increases in performance potential, the concepts of standardization, system failure, and mission capability require
redefinition. Entire sensor suites can then be revisited with the
question: are all of the current sensors required for military mission performance?
8. ACKNOWLEDGMENTS
The direct and indirect contributions to this paper are acknowledged. Dr. Jesse Ryles, Chief Scientist of Avionics Directorate
and Mr. John Anselmo, Delco Systems Operations have earned
our gratitude for their critical reviews. Particular tribute is to
the numerous AFIT graduate students, who through their thesis
research, contributed several of the modeling and simulation
results presented. Mr. Jeff Laynes technical report on SAR
forms the basis for SAR models.
9. LIST OF SYMBOLS
earths equatorial radius
aE
angular resolution
an*
A
system dynamics matrix
ABR
airborne receiver
AFIT Air Force Institute of Technology
B
system control distribution matrix
bits per second
bPS
BPSK binary phase shifr keying
CADC Central Air Data Computer
CIGTF Central Inertial Guidance and Test Facility
CIRIS Completely Integrated Reference Instrumentation
System
c: ( t ) direction cosine matrix relating e- to n-jirames
SA
SAR
SV
S
(.)sk
t
to
pjT
=aE/./compensated pseudo-range
raw pseudo-range
tropospheric delay
truerange
radiofrequency
ring laser gyroscope
rangekange-rate system
range-rate
selective availability
Synthetic Aperture Radar
space vehicle (GPS)
Laplace transform operator
skew-symmetric matrix
time
initial time
matrix transpose operator
262
TEC
U
uLos
V
V
[20] Carlson, N., and Musick, S., Users Manual for a Multimode Simulation for Optimal Filter Evaluation (MSOFE).
AFWAL-TR-88-1138, W-P AFB OH, AFWAUAAAN-2, Apr
1990.
[21] PROFGEN - A Computer Program for Generating Flight
Profiles, Avionics Laboratory, AFWAL/AARN-2, WrightPatterson AFB, OH, November 1976.
[22] Vander Velde, W.E., Strapped-Down Inertial Systems,
Course 16.43 Notes, Department of Aeronautics and Astronautics, MlT, 1983.
[23] Wrigley, W., and others, Gyroscopic Theory, Design and
Instrumentation, Cambridge, MA, MIT Press, 1969.
[24] Litton Guidance and Control Systems, Performance
Accuracy (Truth ModeYError Budget) Analysis for the LN-93
Inertial Navigation Unit. DID No. DI-S-2 1433 B/T:CDRL
No. 1002. Woodland Hills, CA, Jan 1985.
[25] Pearson, R.A., Advanced Reference System. Proceedings of the Twelfth Biennial Guidance Test Symposium, October 1985.
[26] Windall, W.S., and Grundy, P.A., Inertial Navigation System Error Models, Technical Report, AF-SWC TR 73-26,
Intermetrics Inc., Cambridge, MA, 11 May 1973.
263
[53] Flight Test Report for Performance Validation of the Global Positioning System on the F-16 Block 40 Aircraft, General
Dynamics Test Report Number 16PR8816.19 June 1990.
[54] Lewantowicz, Z.H., and Keen, D.W., GPS Aided Navigation Performance for Weapon Release with Fewer Than Four
Satellites, Joint Services Data Exchange, October 1990.
[55] Negast, W.J., Incorporation of Differential Global Positioning Measurements for Improved Reference System Performance. MS Thesis, AFIT/GE/91D-41, School of Engineering,
Air Force Institute of Technology, W-P AFB OH, Dec 1991.
264
Appendix
State
Name
1 ~ ~ ~1
I I I
fvx
fvz
I
I
160A
61A
fZX
Accel. Misalignment
63A
code h
p Errors (4)
SEZ
"
x,
v2
V?
32G
26
,
I33GI
20
S Q A ~ Accel S.F.Asymmetry
51A
33
SOAv
52A
34
19
71
44
41
15
48
49
16
I9
18
1 I I I
83
6Rclkz
84
6Rclk3
85
6x,2
11
11
87
88
6x,3
89
k V 4
90
6Ysvl
91
6Ysv2
92
6Y-3
93
94
k v l
95
7
23
18
28
14
38G
29
21
43
86
I
31G
41A
42
IO
45
I 1 1
69
46
6Rclkl
19
38
13
6RjOnl
25
37
65A
6Rcd3
w , 2
31G
36
12
6R,,l
I
I
64A
6Rcd2
&d4
SgY
I
I
62A
fZY
F1
I
I
I59AI
a. The LN-93 INS error state model actually contains 93 error states. 5 states
were added to complete the accelerometer misalignments and 3 vertical
channel states to account for the baro altimeter and pressure altitude errors.
From this total of 98 states, 30 least significant states were deleted to form
the error model in this table.
h. The GPS error model contains 30 error states, assuming five independent
receivers, ionospheric correction having been made using dual L, and L2 frequencies
265
SUMMARY
This paper describes federated filter applications to integrated, fault-tolerant navigation systems. The federated
filter is an optimal or near-optimal estimator for decentralized, multisensor data fusion. Its decentralized estimation
architecture is based on theoretically sound informationsharing principles. Federated filters consist of one or more
sensor-dedicated local filters, generally operating in parallel,
plus a master combining filter. The master filter periodically combines (fuses) the local filter solutions to form the
best total solution. Fusion generally occurs at a reduced
rate, relative to the local measurement rates. The method is
well suited to real-time system implementation, and can provide significant improvements in data throughput, fault tolerance, and system modularity. This paper discusses federated filter applications to integrated navigation systems in
terms of operating modes, accuracy, fault tolerance, computational efficiency (throughput), and real-time system features. Numerical simulation results are presented to demonstrate federated filter performance characteristics.
1. INTRODUCTION
266
Reference
.................................
............. .. .. .. .. .
...........
......................
......................
PM,m
SENSOR 2
vij
This last condition is crucial: measurement errors from dvferent sensors i and m are statistically independent. Disjoint sensor data sets permit the total estimation problem to
be divided into sensor-related partitions with independent
measurement processes, as described further in Section 4.
3. LIMITATIONS OF STANDARD KALMAN FILTERS
The primary limitations of standard Kalman filtering methods when applied to multisensor navigation systems and/or
systems with embedded local filters are these:
a) heavy computation loads, and potential inability
to keep up with high-rate sensor measurements;
.......
-7.
aj = HIj'
ues
zj +
vij
(51
261
.........
I
FaU
............
R-hW
......
.:.:.:mLTeR:q............
I:.:.,:_.:.: .''I
............. .. .. .. .. .. .
..... .. .. .. .. .. .. .. .. .. .
.. .. .. .. .. .. .. .. .. .. .. ..
.:_:.:.:.:.:.:.
... . . . . . . . ,...
..
..
..
iq 1;:
MSMT
RADAR
22
M s m t Rate
..
..
......
........... .. .. .. .. .......
........... .. .. .. .. .. .. .
........................
o increased measurement data throughput by parallel operation of local filters, and by data compression within local filters;
o enhanced system fault-tolerance by maintaining
multiple component solutions to improve fault
detection and recovery capabilities; and
o improved accuracy and stability of cascaded filter operations, via use of theoretically correct
estimation algorithms.
The basic concept of the information-sharing approach
o divide the total system information among several component (local) filters;
o perform local time propagation and measurement
processing, adding local sensor information;
o recombine the updated local information into a
new total sum.
The remainder of this section will illustrate how the federated filter applies information-sharing principles in its use of
the n local filters (LFs) and one master filter (MF) in Figure
1. The presentation here will be somewhat heuristic, to
emphasize the general concept. Appendices A and B provide implementation details and a more rigorous mathematical derivation of the federated method, respectively.
First, let the full, centralized filter solution be, represented
by the covariance matrix PFAand state vector xf; the local
filter #i solutionAby P I and x i ; and the master filter solution by PM and G . We will use index i = 1. .n for the
LFs alone, and k = 1. .n,m for the MF plus LFs, where
k = m represents the MF.
Now, if the LF and MF solutions are statistically independent, they can be optimally combined by the following additive information algorithm, where the inverse covariance
matrix P - I is known as the "information matrix":
The key to the new federated filtering method is to construct individual LF and MF solutions so they can be combined or recombined at any time by the above simple algorithm. In particular, the construction avoids the need to
maintain LF/LF or LF/MF cross-covariances. The procedure for doing so is the essence of the information-sharing
approach. (See Appendix A for equivalent algorithms that
simplify the P-' operations indicated above.)
Suppose we start with a full solution P F , &. Now, divide
that solution so that the k = 1. .n,m LFs plus MF each
receive fractions pk of the total information:
PP-'
= PM
PK-'
= PF
-1
-1
pk
P1
-1
or
..
PN
-1
P K = PF
(loa)
pk- 1
floc)
>x
fx
(111
k = 1. . n , m
E
k=l
pk=
pm+
n
E
i =1
pi=
(12)
268
GK QK GK
(131
PI;'
PI-'&
HIRI
-1 Zi
(17)
=
PF-I
n
E HIRI-'
i =1
It can be shown (Appendix B) that this minimum-LF structure still produces a globally optimal solution in some cases.
One case is when the M F retains all the fused information,
and the LFs are reset to zero information after every fusion
update (i.e., when pm = 1 and pi = 0 ) . However, for general values of s,,, and pi, the minimum-LF structure introduces a slight loss of information with a conservatively suboptimal result. In practice, the resultant estimation accuracy
is almost indistinguishable from that of the globally optimal
filter.
Second, the federated filter can perform fusion updates at a
reduced rate relative to the LF measurement rates, implying
data compression in some or all of the LFs (multiple LF
measurement sets are "compressed" into the latest LF statevector estimate). LF data compression does introduce a
small loss of global information, equivalent to neglecting a
vector measurement of common process noise dimension at
each interior step. This information loss is negligible when
Q << P over the fusion interval, as is the usual situation.
Last, the federated filter method has been described here in
conventional covariance (P) and information ( P - l ) terms.
However, as shown in [18], the federated filter can be implemented in square root (factored U-D) form to maximize
computational efficiency, numerical stability, and effective
precision. One can choose covariance square root form,
information square root form [7,8], or even a mix to best
suit any particular application.
5. FEDERATED CONFIGURATION OPTIONS
H 1 R I - l HIT
(16)
e+=
-1 *
PI+
sensor4 bias states. Hence the matrices PK, #K, GK, and
QK contain only the common and bias-k partitions of the full
matrices. The & fraction values apply only to the common
INS states, since only those states are shared among the LFs
and MF. Appendix A provides representative implementation equations. (The M F can also be implemented in a global or large form containing all of the sensor bias states;
then, each sensor bias-i partition is shared by the M F and
one LF, with corresponding & values of 1/2.)
HI^
PF-'
a+.
269
INS
. . ..................
...........
PF,Xf
Figures 3 to 6 illustrate four federated filter modes embodying different information-sharing strategies for this
system. In each case, the federated filter structure consists
of the M F and three LFs. Each LF processes measurements from one external sensor (GPS, TAN or SAR),
while all of the filters use common INS data. Each LF
provides a navigation solution of varying accuracy, depending on the inherent capabilities of its assigned sensor,
and on environmental factors such as visibility, relative
geometry, aircraft dynamics, and electronic interference.
The M F performs generic fusion operations, and generates
the best total solution from the three LF solutions.
Figure 4: Federated Fusion-Reset (FR) Mode
..... . . . . . . . .
INS
!::::Wj&rfEhj
..
.:....:.
......FlkTki:
.. .. .. .. .. .. .. I:..
...........
PF.xf
4
p;-.j
...........
..........
p p
Receiver
270
mode. Here, each LF passes some but not all of its information to the M F at each fusion update (the fraction m,),
and retains the remainder (the complementary faction ai,
= 1-mi).
With mi= 0.5, the MF accumulates and retains over half of the total system information, while the
LFs collectively retain the remainder. (The MF contains
1/2 of the LF's current-cycle information, 3/4 of the previous-cycle information, 7/8 of the next-previous, etc.) The
LF resets are relatively simple to mechanize: the LF rescales its common covariance partition by a factor of yi,
= l / a i , = 2, and retains its state vector as-is.
A useful way to characterize these different informationsharing strategies is as follows. In the NR and FR modes,
each LF tells the MF "what I know now," and the MF
combines those results to obtain "what we all know now."
Conversely, in the ZR Mode, each LF tells the MF "what
I have learned since my last report," and the MF adds that
new information to its total of "what we all know now."
The RS mode is similar to the ZR mode, except that the
LFs pass along what they have learned more gradually.
With regard to constrained filter applications, the NR mode
is best suited for use with existing LFs, since it requires no
additional software functions beyond standalone operations.
(The common process-noise multipliers I / @ , are often unnecessary, given conservative process noise models.) The
RS mode may also be usable with existing LFs, if they can
be modified to accommodate periodic rescaling of the covariance matrix. The ZR mode is not directly usable with
existing LFs, but may be approximated by restarting each
LF (at a large, initial covariance value) whenever a zeroreset is required. Last, the FR mode is not usable with
existing LFs, since resetting the LF state and covariance to
MF-supplied values is generally infeasible.
One final point should be noted here. These four federated
filter modes involve exactly the same mechanization equations for all operations except the MF and LF resets (see
Appendix A). They can all be implemented in a single
software package, with a code branch for each reset option. Even a centralized filter can be implemented with the
federated filter software [ 191, by assigning all the sensors
to a single LF or MF and turning off the other filters.
When maximum MF accuracy is not required, and a reduction in computation burden is desirable, the MF fusion rate
can be reduced to well below the LF measurement rates.
Thus, the relatively large fusion computation burden can be
reduced to, say, one-fifth or one-tenth of the fully optimal
burden. For example, if the TAN LF performs measurement updates twice a second, and GPS does so once a second, the MF might perform fusion updates only once every
ten seconds. In this way, the TAN LF compresses 20
measurements (20 x 1) into a single state vector, and the
GPS LF compresses 80 measurements (10 x 8) into a single
state vector, both used by the MF to obtain its fused
solution.
The Zero-Reset (ZR) and Rescale (RS) modes are most
flexible in this regard, since they permit fusionheset
processing to occur at different times for different LFs.
For example, in the ZR mode, an LF can "dump" its information to the MF and reset itself to zero information at
any time, regardless of when the other LFs do so. In contrast, the No-Reset (NR) and Fusion-Reset (FR) modes require all LF solutions to be propagated to the same time
point (a fairly simple control process), and then to be
passed to the MF where they are all combined to yield the
total solution. Since the total system information is distributed across the LFs, all of the LF solutions must be collected at the same time, to obtain the best total solution.
Another real-time software issue relates to resets from the
MF to the LFs. The NR mode is the simplest in this regard, for the obvious reason: there are no resets. The ZR
and RS modes are relatively simple, since each LF can
reset itself, after sending its solution to the MF, without
waiting for a response from the MF. The FR mode is the
most complex, since each LF has to wait for a reset solution from the MF, before it can continue its normal operations.
Next, consider processor fault tolerance -- the ability to
detect and recover from filter dropouts caused by processor
or bus failures. All of the federated filter modes provide
enhanced processor fault tolerance in a way not possible
with a single, centralized filter (provided the federated
filter components are running on separate processors.)
Each component sends out periodic status messages to the
other components, and monitors their status messages in
return. For example, if an LF disappears, due to a processor or bus failure, the federated controller (FC) detects
its absence almost immediately, via the missing LF status
message. The FC then modifies the information shares for
the remaining filters, and tells the MF to use only those
LFs in the fusion process. Thus, the federation gracefully
reconfigures to the remaining set of available LFs. If the
LF later reappears, the FC reconfigures the federation
again, to re-include the LF.
Finally, consider sensor fault tolerance -- the ability to
detect, isolate, and recover from sensor failures. Here, the
federated filter designs support sensor fault detection,
isolation and recovery (FDIR) at both the local and master
filter levels. For purposes of comparison, it is helpful to
begin by considering the sensor FDIR capabilities of a centralized filter (CF). The CF maintains a single, globally
optimal solution, and incorporates measurements from all
local sensors. It has good capability to detect and isolate
some local sensor failures via measurement residual tests.
27 1
212
CENTRALIZE0
ERRORS
2.5
it021
FEO/FR HF ERRORS
EPOSE
SIGPE
2.5
3021
EPOSE
SIGPE
-2.51
TIME (SI
1000
4000
EPOSE
SIGPE
FT
0.0
-2.51
1000
Y
TIME (SI
TIME (SI
4000
1000
4000
The same levels of agreement -- very similar error and sigma plots -- occur for the velocity and attitude states as well.
In each case, the errors and sigmas are relatively small while
GPS data is available. (Plotting these segments on an expanded scale shows virtually identical results for the three
filters.) The estimation errors grow during the GPS outages,
with periodic reductions due to the SAR position and velocity measurements. In between SAR updates, the filter errors
and sigmas increase somewhat, reflecting the reduced accuracy attainable from TAN radarherrain measurements.
While we could discuss the relative performance attributes of
the three navigation sensors at length here, the real point of
interest is this: the federated filter navigation pevormance
is virtually identical to that of the globally optimal centralizedfilter. Hence, these simulation results confirm the theoretical prediction that the federated filter is a near globally
optimal filter formulation. The federated Fusion-Reset results are nearly identical to the C F results. The federated
No-Reset results are slightly less accurate, as the theory
(Appendix B) predicts.
7.3 Federated Filter Component Performance
The results in this subsection were generated with the realtime Ada version of the federated filter, running in the
VAX-hosted DKF-Ada Testbed 1201. Each figure (10 to 14)
shows the east position estimation error and sigma (feet)
versus time (sec). The runs are for a relatively short 200sec segment of the previous trajectory, including the final
stage of descent, initial low-altitude penetration, and a few
horizontal jinking maneuvers. Only the GPS and TAN sensors (and not the SAR) were employed for these runs; hence
there were only two active LFs in the federated filter.
These real-time simulation results represent single-sample
monte carlo runs, with the same random number sequences
used for each case. The single-sample results are consistent
with the more general results obtained from multi-sample
monte carlo runs in the non-real-time DKF Simulator.
Figure 10 compares the globally optimal centralized filter
(CF) results with those of the federated master filter operating in the Fusion-Reset (FR) mode, with equal (50/50)
information-share fractions pi for the two LFs. Figure 11
makes a similar comparison of the C F with the federated M F
operating in the No-Reset (NR) mode, again with equal LF
share fractions. In both cases, the federated M F results are
nearly identical to those of the CF, and to each other. There
are small differences in fine structure between the MFs and
the CF, due to their different update rates. (The C F incorporates one GPS measurement set every 2 seconds, whereas
the MFs combine two or three GPS measurement sets, via
LF1, into one fusion update every 5 seconds.)
213
CENTRALIZEO
1.2
E+O2[
.
0
FEO/FR MFIL
1.2
r+021
EPOSE
SIGPE
.
0
L F l STO-ALN
EPOSE
SIGPE
LF2 STO-ALN
0.0
0.0
- 1O . 2 2160
2160
TIME
(SI
'
TIME IS1O
2360F
2360
2160
CENTRALIZEO
TIME (SI
TIME (SI
2160
2360
2360
EPOSE
1.2
3021
* EPOSE
SIGPE
EPOSE
EPOSE
SIGPE
* EPOSE
SIGPE
0.0
O
-1.21
.
2160
'
. . . . . . .
TIME (SI
P
.
'
-O
1 . 2 2160
'
TIME
(SI
O
2360
P
-1.6
2360
2160
TIME
(SI
2360
T I M E (51
2160
2360
~____
LF2 FEO/FR
EPOSE
SIGPE
EPOSE
1.2
Et021
SIGPE
i'
each other. They are also virtually identical to the corresponding M F results (Figure l l ) , except that the LF sigmas
are larger by a factor of 1.4, due to the l / p l = 2 fusionreset multipliers. We conclude that fusion resets dominate
the performance of the component LFs in the FR mode, at
least when the fusion interval is not much larger than the
primary measurement interval.
Likewise, Figure 14 shows results for LF1 and LF2 operating as components of the Fusion-Reset federated filter,
again with 50/50 information shares. In contrast to the NR
case, both LFs here show errors and sigmas significantly
different from their standalone results. Except for the tine
structure, the two sets of LF results are virtually identical to
2
-1
.-
2
-1
.2160
TIME (SI
2360
2160
TIME (SI
2360
274
GPS
oGPS
GPS
* GPS
it00
PRl
PR2
PR3
PR4
TAN L F l
ONE-SIG
ND
0.01
0 0
TIME
1500
3000
3000
GPS PAR1
o G P S PRR2
0 GPS PRR3
AGPS PAR4
* ONE-SIG
4.0.
Et00
TIME IS1
1500
3.0
Et02
EPOSE
EPOSN
EPOSV
SIGPE
* SIGPN
0 SIGPV
D
FT
0.0
1 .o
0.0
1500
A .
-3.0
TIME
3000
1500
.
TIME
(SI
MOO
bias shift of 0.5 ft/sec, starting at time 1,700 sec (late in the
high-altitude outbound cruise segment of the flight profile).
The clock frequency failure introduced an 0.5 ft/sec bias into
the subsequent pseudorange-rate measurements, and an 0.5
ft/sec ramp into the subsequent pseudorange measurements,
from the faulty satellite. This scenario represents a "soft"
(slowly-growing) failure in the most accurate navigation
sensor -- generally the most difficult type of failure to detect.
failure, the C F horizontal position estimates exhibit a steadily growing radial error that reaches 425 ft by time 3,000
sec (1,300 sec after the failure).
Figures 15 and 16 show the centralized filter (CF) rms measurement residuals for the GPS pseudorange (PR) and pseudorange-rate (PRR) measurements, over the period from
1,500 to 3,000 sec; the failure occurs at the A mark, 200 sec
after the initial time shown. These rms residuals are normalized, with an expected value of unity, and are smoothed via
a ten-point moving average, to make the trends more visible.
The PR residuals show no effect of the satellite #3 failure, in
spite of the ramp in PR #3. The smoothed PRR residuals for
satellite #3 rise to about 3.5 sigma, while the unsmoothed
PRR #3 residuals (not shown) rise to just over 5.0 sigma.
The CF rejects the PRR #3 measurements while their residuals exceed the specified 3 a threshold. However, the sequence of PRR #3 residuals peaks, then falls back down to
acceptable levels (due to filter covariance growth between
measurements). Thus, the CF loses its ability to detect the
failure, and from that point on, uses the faulty data with no
clear indication that it is bad.
The C F measurement residuals from the less accurate SAR
and TAN sensors likewise provide no clear indication of the
GPS failure. (One of the SAR measurements does eventually show a ramp in its residual sequence; however, the CF
then rejects those good SAR measurements.) After the
215
'
1,4 .......................................................................................................................
..........
11.2 ......................................................................................................................
.........
,4 ....................................................................................................................................................
...............................................................
..........................................
Filter
States
Operation
CF
Period
LF 1
18
Propagation
8 GPS msmts
2 sec
2 sec
LF2
17
Propagat ion
1 TAN msmt
1 sec
1 sec
LF3
23
Propagation
7 SAR msmts
5 sec
300 sec
MF
16
Propagation
Fusion (equiv
to 32 msmts)
10 sec
10 sec
CF
27
Propagation
1 TAN msmt
8 GPS msmts
7 SAR msmts
1 sec
1 sec
2 sec
300 sec
In these cases, the filter INS model had 16 states (it had 13
in the previous tests), the GPS model had 2, the SAR model
had 7, and the TAN model had 1. The MF implemented
only the 16 common INS states, since only common information was shared. The M F propagated only its state vector, since the propagated M F covariance is not needed when
the M F retains no information.
Figure 19 shows the peak-cycle execution times (sec) for
each of the filters -- the three LFs and the M F from the
federated filter, and the centralized filter (CF). Each total
time is subdivided into the major functions: propagation,
measurement processing, and fusion. Each of the federated
filter components requires considerably less processing time
for its peak cycle than the CF, ranging from approximately
29 to 56 percent of the C F peak cycle time. Thus, if implemented on separate, parallel processors, the federated filter
would provide approximately a 2: 1 advantage.
Figure 20 shows the average-cycle execution times (sec) for
each of the filters. Here the federated filter components provide an even greater speed advantage, with average computation times ranging from 7 to 40 percent of the CF average
time. Thus, the average per-processor computation loads of
the federated filter are significantly less than that of the CF.
Note that, even if the federated filter average times were
added together (as if they all ran on the same processor),
they would still sum to slightly less than the CF average
time.
These timing results are meant to be illustrative. The speed
CF
o theoretically correct partitioned estimation algorithms for cascaded systems with sensor-dedicated local filters (LFs);
o
216
The & fractions relate to initial information shares, processnoise shares, and fusion-reset shares (they can be in different
ratios for each operation). The ark, fractions relate only to
the fusion-input and reset operations of the Rescale mode.
The federated filter algorithms will be presented in five
steps: 1) the LF/MF initialization equations; 2) the LF/MF
time propagation equations; 3) the LF/MF measurement update equations; 4) the M F fusion equations; and 5 ) the MF
and LF reset equations for various reset modes. For each
step, we will first indicate the basic operation (marked by m)
in unpartitioned covariance form, then provide the partitioned implementation equations and/or the relevant partitioned
matrix factors. Note that, in Step 2, the prime refers to
values at the beginning of the propagation; in Step 3, superscript + refers to post-measurement values; in Step 4, superscript + refers to values after each LF #i fusion; and in Step
5 , the quote symbol " refers to values after the reset.
1) LF/MF Initialization:
(A-6)
(A-1)
PK =
pcc
"ck]
ILpKkc
(A-2)
PKkk]
Fcc
wc PK'
PK =
rn
where "bias-k" means the biases for sensor #k. The full or
global state vector xf contains all of the filter common and
sensor bias states. The filter #k state vector & and the full
state vector xf are related by a simple mapping matrix LK:
+~ GK~
OK G K ~ :
XA= @K xA'
(A-8)
(A-9)
0ckl
1
lo
L
'kk]
(A-10)
Lone
GK =
0nk,1
rGcc
lo
'kk]
1;
PK =
rPccYk
IL
1
'kk]
211
BK = P K H K ;
PK+ = PK
AK =
T
HK P K H K + RK
BK AK-'
B K ~
(A-lla)
(A-llb)
PM
(A-25)
PIccXii
(A-13)
p I i chi i
(A-26)
-1 T
+ P I ic P I ccPIic(Xii-l)
PIii
A
k=1
PFcc
Start:
= PMcc
(A-14)
= xm
xf
-C
(no change)
xi
(A-15)
-C
(A-27)
d ) Zero-Reset Mode:
Use Rescale mode (c) with
Xii
l/Ei
>> 1
(A-28)
Do for L F s i = 1..n:
AIcc
= PFcc
PIcchi
PF:c
= PFcc
xfc
-C
+ PFcc
5 ) MF/LF Fusion-Reset
rn
F AI,:
~ ~ P
= xf
=>
PF-'
( A - 16a )
-1
AIcc
xfc)
(xic
~( A - 16b)
(A-17)
("1:
n,m
E LK PIC"-'
k=l
LK~:
a ) No-Reset Mode:
xm"
-C
= Xfc
PI" = PI
A
(A-18)
Use between
fusion times,
then discard
A
J
(no change)
(A-20)
(no change)
(A-21)
b) Fusion-Reset Mode:
-1
-1 T
PKik = PICkk- PKkcPKcc(PKcc- PK;c)PKccPKkc
~<~-i
PF~~PM~:
PM" =
-1
LPM,cPMccPFcc
PM-
PMA
(A-29)
B. THEORETICAL FOUNDATION
This appendix presents a derivation of the federated filtering
method outlined in Section 4. We will formulate the optimal
estimation problem as a sequential, weighted least squares
problem. The full or global least-squares problem will be
partitioned into n local least-squares problems. Then, the
solutions of the n local problems will be combined, via another least-squares operation, to yield the total fused solution. Under certain conditions, this fused solution is globally optimal -- identical to the full, unpartitioned solution.
Under other, more practical conditions, it is near-optimal,
using most but not all of the available information.
Consider the sequential system dynamics and discrete measurement processes described by Eqs. (1) to (8) of Section 2.
First, define S , W and V as square roots of the state error,
process noise, and measurement noise covariance matrices:
S=P%;
c) Rescale Mode:
(A-19)
xA11 = x i
hi = l/(l-ei)
I
J
(A-24)
= PMm- P M m c P M ~ ~ ( P M c cPFcc)PMccP
mc
';
W = Q
V = R
(B-1)
278
T -T
B = W Z G S
(B-10)
2,
I,
= e x
j J-1
+ G u
j J
( j = 1..k) (B-3)
a,
zi
-3
= HI
z +
j
vi
-j
vi
&&-
A&
H I X_ = A&
HI
T A
H I (x_
TA
5) (B-11)
(8-12)
(j = l..k)(B-4)
HI
A & = & - H I
The valye of
that minimizes this cost function at step
k - 1 is
the computed estimate after step k - 1 . sk-lis
h:e covariance square root of the error in that value. Both
and sk-1 are assumed to have been propagated from
their initial values by recursive step-wise operations, as will
be outlined below for the step from k - 1 to k + .
Now, we can determine the best estimate of
after the
time propagation and before incorporating the measurement.
We use Eq. (B-3) to eliminate a-lin the first term of (B5), and then rearrange the elements of the first and second
terms to produce a new first term in a alone:
(B-14)
T XA_
x-+ = z +
JI CI
-1
(B-17)
A&
(B-18)
$+ =
$l+ +
..
+ $n+
$i+
(B-19)
i 11
(B-7)
B = W [I
F ( P F +S S
-T - I F I X
(B-9)
279
-?
i =1
A 2
- wall
llJAx_
^ 2
llawll
= hi S - ' ;
SI-'
(B-23)
IIBI-'[g
BI SI
-1
(xi A
x_)]1I2 ( 8 - 2 5 )
(B-26)
-1
SI-'
= Xi S
WI-I
= Xi W-';
EX:
= 1
2
EXi = 1
(Ai
= IXi)
(8-31)
(ri
= IXi)
(B-32)
RA-'
-T
VA
VA
-1
P
- + P-
A[(P
-1- -1
Q
P)
1 (B-34)
n
SFaTSF-'
SI-TSI-l
(B-27)
i =1
sF
-T - l A
sF xf =
n
I:
i =1
sr-Tsr-lk
(8-28)
280
(B-36)
5.
Castanon, D.A., and D. Teneketzis, "Distributed Estimation Algorithms for Nonlinear Systems," IEEE Transactions on Automatic Control, AC-30, May 1985.
6.
7.
8.
Bierman, G.J., and D.W. Porter, "Decentralized Tracking via New Square Root Information Filter (SRIF) Concepts," Business and Technological Systems, Inc. and
Bierman and Associates, May 1987.
9.
n
2
E h i = I
i =1
n
C
2
Aci
= 1;
i =1
(B-37)
REFERENCES
1.
2.
Chang, T.S., "Comments on 'Computation and Transmission Requirements for a Decentralized Linear-QuadraticGaussian Control', IEEE Transactions on Automatic
Control, AC-25:3, June 1980.
I'
3.
4.
12. Carlson, N.A., "Federated Filter for Fault-Tolerant Integrated Navigation Systems," Proceedings of Position
Location and Navigation Symposium, PLANS, Orlando,
FL, November 1988.
13. Loomis, P.V.W., N.A. Carlson, and M.P. Berarducci,
"Common Kalman Filter: Fault-Tolerant Navigation for
Next Generation Aircraft, " Proceedings of the Institute of
Navigation National Technical Meeting, Santa Barbara,
CA, January 1988.
14. Covino, J.M. and B.E. Griffiths, "A New Estimation
Architecture for Multisensor Data Fusion," Proceedings
of the International Symposium and Exhibition on Optical
Engineering and Photonics, Orlando, FL, April 1991.
15. Griffiths, B.E. and J.M. Covino, "Net Information Approach Phase I Final Report," Synetics Corp., Wakefield,
28 1
1. INTRODUCTION
me
The first applications of CPS/INS integration have been in military aviation. This isnot surprising because inertialnavigation has
been almost exclusively applied in military systems. One might
object that commercial airliners have carried inertial navigation
systems since the 1970s. Although this is hue, civil aviation
authorities have only recently granted approval to install CPS
receivers on aircraft and their use will be limited to provide a
supplemental navigation aid until at least the mid 1990s.
In contrast, military airborne applications emphasize the ability of
an integrated system to meet requirements for precision delivery
of weapons or materials on target, even during effective radio
countermeasures that cause outages in GPS availability. This
chapter will focus on the technical issues that arise in satisfying
those requirements. The key issues for civilian applications are
not yet as clear but the following are likely to be primary:
System Integrity - The use of internal or external signals and
measurements to immediately detect and prevent out-ofspecification measurements or data from corrupting the
navigation solution.
a)
b)
development (non-recurring)
life-cycle (recurring)
Installation Constraints
a) volume, weight, power consumption
b) interfaces
Performance
a) mission requirements/mission environment
b) reliability/graceful degradation
c) options for improvement
The following remarks will emphasize the performance considerations because that is the area where the benefits of GPSAnertial
integration are most evident. However, cost and installation
factors are often decisive. These are raised throughout the chapter
wherever they may be a significant differentiator between alternative integration techniques. Ultimately, the system designer must
justify his design as being the best way to satisfy the design
282
vative design, maximum error growth is calculated under worstcase conditions of vehicle dynamics.
Outages may be a concern even for UE that track more than four
satellites at a time. For example, a GPS antenna mounted on top
of an aircraft will only see a limited number of satellites during
a banked turn, and the Dilution of Precision (DOP) parameters
for that visible constellation may be unacceptably high. In more
extreme cases, a vehicle passing through a tunnel may see no
satellites for an extended period, and a military UE may be
jammed as it approaches its target.
Combining GPS with an independent navigation sensor (item c,
above) is aparticularly attractive means to maintain the quality of
the navigation service during a GPS outage. In effect, the
independent sensor can act like a flywheel to provide continuous high quality navigation outputs. Inertial navigators are commonly considered for this role because they are passive, selfcontained, widely available, and are not subject to the causes of
GPS outage. However, they are generally more expensive to buy
and integrate than other radio-navigation sensors such as LORAN
or Omega. Their use has generally been limited to military and
commercial aircraft. However, low-cost, low-performance inertial sensorsimplementedusing mass-production microelectronics
technology are emerging from research laboratories. These may
provide the technological basis for an economical solution to GPS
outages in civil aviation and commercial applications such as
bucks and automobiles. Ref.(15,16)
With respect to GPS/INS integration performance during outages,
the key questions are:
(1) What quality INS is required?
283
(2)
The tracking loop bandwidths can be reduced to the minimum amount required to track the errors in the INS aiding
signals.* (INS position errors are mostly low-frequency).
The net result of these actions is that the INS aided GPS receiver
can maintain lock and provide GPS measurements over a much
wider range of vehicle dynamics and radio-frequency interference
than the unaided, stand-alone receiver. In particular, there is
provision to operate both RCVR 3A and the MAGR in the INS
(aided mode), or the DRS (Doppler Aided Mode) when improvements in GPS availability at high levels of jamming or
dynamics arerequired. In the following remarks, weconsider only
the INS mode because there is almost no experience with operating any GPS receiver in the Doppler mode. Operation in the INS
mode provides three benefits to a GPS receiver.
(1) The INS velocity output can be used to aid the MAGR codetracking loop when the carrier loop has lost lock. This in turn
means that the code loop tracks only the errors in the INS aiding.
The bandwidth of these errors is much less than the bandwidth of
* This
284
(P,V,T,e)s
A) STAND-ALONE MODE
AIDING
SENSOR
INTEGRATION
PROCESSOW
ENSOR
285
In the tightly coupled mode, there is only one feedback from the
navigation processor. Figure 3-lc illustrates the use of velocity
aiding to the GPS tracking loops. Acceleration aiding could also
be effectively used, but we are not aware of any particular
mechanization using other than velocity aiding. The other paths
used in loosely coupled architectures are not needed here because
all computations involved in navigation processing are now internal to one processor.
The concept of tightly coupled integration is often raised in
connection with embedded GPS receivers. These are not
necessarily synonymous. However, it is reasonable that one
would choose to mechanize a tightly coupled integration algorithm if one had already taken the effort to design a GPS receiver
that is physically and electrically integrated with an inertial sensor
or with a powerful navigation processor. We return to this point
in Section 3.3.
As of January 1993, it was uncertain whether the option to
implement deeplycoupled integraton would be denied to authorized GPS users. Plans to develop tightly-coupled systems such as
the GPS Guidance Package and the HoneywelWexas Instruments
Model 764-C3 were well underway when the GPS Joint Program
Office introduced a new GPS security implementation called the
SAASM (Selective Availability, Anti-spoofing Module). Comments from industry were due in January; there was a widespread
concern that the amount of integration processing (e.g. Kalman
Filtering) that could be supported by a prospective SAASM
mechanization would not be adequate to achieve the full benefits
attributable to deep integration using tightly coupled sensor outputs. The jury is still out on this issue.
The general filtering problem involves trying to estimate timevarying states whose evolution is characterized by known laws
of propagation, which are usually taken to be a coupled system of
linear differential equations driven by white noise.
States cannot usually be measured directly but are inferred from
measurable quantities to which they are related. These measurements may be made simultaneously, or sequentially at a series of
distinct points in time. The filter will generally incorporate
knowledge of the statistics of the measurements.
Knowledge of the way the states change (propagate) in time,
knowledge of the way the measurements are related to the states,
measurement statistics and measurement data are all used in each
state update. The most common update algorithms use linear
filters, e.g.. ones in which the updated state is a linearly weighted
s u m of the measurements and the previous state value.
Position and velocity of an aircraft are examples of quantities that
may be chosen as states in a filter (these are referred to as wholevalue filter states). For whole-value position and velocity states,
the propagation equations are simply the equations of motion of
the aircraft. To make the whole-value filter propagation equations
a better reflection of the real world, acceleration states could be
added (otherwise, by its omission, acceleration must be treated as
noise, driving the derivative of velocity). GPS indicated position and velocity are examples of memuremetus that might be
processed by an integration filter with whole-value states. At one
extreme, the integration filter could ignore everything except
the GPS receiver position and use this as the integrated position.
This degenerate case is the selection mode cited above in which the
state propagation equations and any other availablemeasurements
would be ignored. In general, some rule must be used in order to
determine how much weight should be put on a measurement and
how much weight should be put on the propagated states. For the
above degenerate case, the weight on the GPS UE position is one
and the weight on the propagated state is zero. The weight on the
measurement is referred to as the filter gain.
33.1 Selection
A selection algorithm chooses the GPS indicated (P,V,T) as the
system navigation solution whenever the GPS UE indicates that
For a GPS/NS integration filter with INS error states, the measurements would actually be the differences between GPS position and INS position and the differences between GPS velocity
and INS velocity. As with the case of whole-value states, some
286
capabilities available to avionics integrators, questions of computational feasibility should be reconsidered every few years.
333.3 Custom Tuning the GPS Internal Navigation Filter
Custom tuning is an action that can be taken internal to the GPS
UE. It does not require an external integration filter to derive some
degree of more robust performance in the presence ofhighvehicle
dynamics or jamming.
281
The tightly coupled mechanization does avoid one problem commonly attributed to loosely coupled integration, namely the possibility of instability (in state estimates) arising when the GPS
navigation errors become highly correlated with INS navigation
errors. This situation may occur at low input signal to noise ratios
when GPS code loops remain in lock only because inertial aiding
allows the loop bandwidth to be reduced thereby reducing the
effective levels of noise and interference. Now, the narrower the
loop bandwidth, the more the loop error approximates the error of
the aiding signals so that the correlation cited above becomes
significant. See References 3 1and 32 for further discussion of this
point.
3 3 Embedded Systems
As GPS approaches its operational status, therehasbeen amassive
increase in investment in civil GPS technology which has led to
smaller, lower power consuming, higher performance UE than
were dreamed of as recently as the late 1980s. One consequence
of this trend is that GPS UE can be packaged on a single card that
can be embedded in other systems. As noted in Section 3.1. the
concept of GPS embedded in an INS is one such application that
is being prominently discussed at present, with several efforts
underway to demonstrate the concept. Ref. (33-36)
Setting aside the valid claims of savings in size,power weight that
a m e from embedding, it is reasonable to ask whether there is any
functional or performance payoff directly attributable to embedding. The answer is a qualified yes. There are potential performance improvements, but the system may be vulnerable to a
single-point failure, such as a power supply or the processor.
33.1 Tight Coupling
There is no inherent reason to claim that embedding implies tightcoupled integration. An embedded receiver could be stand-alone,
loosely-coupled or tightly coupled. However, developers of
embedded systems have tended to mechanize tight coupling as a
performance feature.
3 3 2 Carrier Loop Aiding
Standard military UE use inertial aiding only for code loops, and
only after carrier loops have lost lock. The decision to limit the
INS aiding goes back to the late 1970swhen it was argued that the
latency (time delay) between the sensing of inertial velocity and its
receipt at a GPS receiver could be as large as tens of milliseconds,
even with the high speed data busses that were available. With this
much delay, it was argued that errors in the aiding signal during
accelerations or turns could be large enough to drive the carrier
loop out of lock.
There are at least two ways to mitigate this concern in an embedded system. The most common approach is to customize the data
link between the INS and the GPS carrier loop to reduce the
latency to a few tens of microseconds and to minimize the
uncertainty in the latency. With that small a delay, the maximum
error of the aiding signal is negligible even for an aircraft rolling
as fast as 1 rev/s. and moving towards a satellite with a relative
velocity of 2000 fdsecond. Under those conditions the error
caused by a 20 ps delay in attitude indication would be approximately VE, where
288
mounted at righi angles), and tilting the plane to null the accelerometer outputs* The perpendicular to this plane defines UPin
an East, North. Up coordinate system.
The error signal that drives the leveling loop is proportional to the
instantaneous value of the tilt error, i.e., to approximately 1.0 g
times the alignment error (in radians). In mathematical notation.
A
g=(l+s,)ge,+b
where
g is the magnitude of the local gravity vector
b)
9, where
- 150prudian = 30arcsec
(4.1)
North Seeking
North Seeking is the process of establishing a reference direction
(azimuth) in the leveled plane containing the east and north,
accelerometers. The most widely used scheme for self-alignment
of the platform is gyrocompassing.
Gyrocompassing exploits the following properties of gyroscopes.
for a local level north-oriented system at latitude 1:
(I)
(n)
289
where
8,
8,
(radians)
(4.2)
From Eq. 4.2 we see that for gyrocompassing to convert a
misalignment error
8,
Standard Takeoff
(1) Accelerate at 0.3 g to 160 knots indicated airspeed (KIAS)
using MIL (standard) acceleration.
t o
==
days = 5.4hours
(4.3)
In practice, the requirement for alignment accuracy is substantially less than the requirement on leveling accuracy, and this
allows the alignment to proceed faster than indicated by Eq. (4.3).
We can estimate this speedup using the approximation that the
standard deviation of leveling errors is inversely proportional to
the time spent in leveling. For medium accuracy inertial sets that
are found in contemporary aircraft the random noise in leveling is
on the order of a few arcseconds. and the uncertainty in azimuth
alignment after gyrocompassing is on the order of 160-200
arcseconds. The ratio of these standard deviations is about 50.
Substituting 8, = 50 8, in Eq. (4.2) yields to = b /50. which is
approximately 7 minutes. This estimate is consistent with Air
Force specifications for the time to achieve standard accuracy
alignment by gyrocompassing under favorable conditions. Ref.
(37)
4.1.2 GPS AidedAlignment
(2)
(3)
(4)
(3)
(4)
Navigation for standard takeoff assumes that the INS has been
aligned by gyrocompassing and that GPS is continually available.
Navigation for alert takeoff assumes that the INS is aligned by
astored heading reference, and that GPS is not available until five
minutes after takeoff. In both cases, different turn, climb, and dive
maneuvers after takeoff were considered for their effectiveness in
reducing alignment errors after takeoff.
The values cited in Table 4-1 were used to characterize the
standard errors (1 - s levels) remaining after gyrocompassing and
stored heading alignment respectively. These are the initial
conditions for subsequent Kalman filtering of GPS plus inertial
sensor outputs.
290
Table 4-1. Alignment Errors at Takeoff (arcseconds)
Stored Heading
Gyrocompassing
Level
40
37
Azimuth
450
225
Three individual test cases are presented here. These are listed in
Table 4-2.
Table 4-2. Test Cases for lnfllght Alignment Studies
Case
1
2
3
Takeoff
Mode
standard
alert
alert
Alignment
Mode
gyrocompass
stored heading
stored heading
GPS
OnAt
0s
300 s
300 s
Alignment
Maneuver
2/39 turn
1 g turn
2 g S-turn
Case I
Case 1 illustrates the potential benefits of using GPS aided
alignment in a standard mission, where the INS is gyrocompassed
prior to takeoff. and GPS is available throughout takeoff. A 2/3g turn that produces a 45 heading change beginning at t = 495
seconds is included to illustrate the additional improvement available from in-flight maneuvers.
423 Discussion
The simulations reported above support the following performance conclusions:
Inflight GPS measurements during periods in which lateral
acceleration is on the order of l g can be used to reduce
azimuthal alignment errors to the same magnitude as level
errors. Larger accelerations lead to smaller errors.
Even in the absence of lateral acceleration the availability of
GPS measurements can be used to reduce the errors of a
stored-heading alignment to the level of gyrocompassing.
This reduction exploits the correlation between INS alignment errors and the INS navigation errors that are uncovered by comparison with GPS observations.
Simple maneuvers such as l g coordinated turns over as little
as45, andlastingfornomorethan30secondsareadequate
for realizing the benefits of inflight alignment.
29 1
and trajectory. Five minutes after the loss of GPS, the east
component of horizontalpositionerrorshas grown to 80 feet (24.4
meters rms), exclusive of the low-frequencyGPS bias. Figure 45 shows the contribution of various error sources to the net
navigation error. For at least ten minutes, the accelerometer and
gravity disturbance terms are dominant. Gyro errors do not
become dominantuntil more than aquarter of a Schuler period (22
minutes) after the outage.
Figure 4-4b illustrates the growth in east errors for a suboptimum21-statefiiter,whosestatesarelistedinTable4-5. These
results are almost indistinguishable from Figure 4 4 % for the
optimum filter. Finally, Figure 4 4 c gives the east error for a
15-state horizontal filter whose states are listed in Table 4-4.
These results too are nearly indistinguishablefrom optimum for
about the first 420 seconds of GPS outage.
Table 4-3. Truth Model States
Description
State #
Horizontalposition error
12
3
Wander angle error
Platform misalignment
456
7,8,9
10
11-13
14-16
17-18
1.
2.
19
21-23
24-26
27-29
30-32
33-35
36-41
42-44
45-47
48-50
51-53
54-56
57-59
60-65
66-71
72
73
Comment
100 arcsec initial horizontal; 6 degree initial vertical
Velocity error
Vertical position error
Auxiliary baro-inertial states Used in describing barcinertial loop
,002 degreelhr rms horiMarkov gyro bias
zontal .005 degree/hr rms
vertical; Correlationtime =
5 minutes
Markov accelerometer bias 3 microg rms; 10 minute
correlation time
100 feet rms
Markov bar0 bias
35 microg rms; 20 nautiGravity disturbance
cal mile; correlation distance
.01 degreelhrrmshorizonGyro bias
tal; .022degree/hrrmsvertical
0.0002 rms
Gyro scale factor error
Gyro misalignments about
3.3 arcsec rms
spin axes
Remaining gyro
20 arcsec rms
misalignments
.015 degree/hr/ rms
Gyro g-sensitivity
Gyro g-squared-sensitivity .02 degree/hr/g rms
150 microg rms
Accelerometer bias
0.0002 rms
Acc. scale factor error
Acc. scale factor asymmetry 0.0001 rms
Acc. nonlinear scale factor
IO microg/g2rms
asymmetry
Accelerometer non linearity IO micro-g/g*rms
Accelerometer orthogonal
30 micro-g/g2rms
g-squared sensitivity
Accelerometer
20 arcsecond 4ms
misalignments
300 feet rms
Baroaltimeter bias
Baroaltimeter scale factor
.04 rms
error
292
TOTAL
490-540
540-840
m.0-1
/ /
840-1020
am.0
zmoa
.
z100.0
m m
2900.00
moon
sio0.oo
TlYE
SECOND8
Description
Horizontalposition error
Wander angle error
Platform misalignment
Horizontalvelocity error
Plantnoiseof9.4E-l7rab/
2918-3226 Low altitude combat, 300 to 2700 feet, 485 to 655 f/s.
Comment
16 rad%ec (vertical)used
to account for unmodelled
gyro errors
Plant noise of 9.4E-12 ft2/
sec3 used to account for
unmodelledaccelerometer
errors
Gyro bias
Horizontalgravity
disturbance (also absorbs
other accelerometer errors)
Accelerometer scale
factor error
In an actual implementation, wander angle error would be combined into a single state with vertical misalignment.
5.0 CONCLUSIONS
SGUA b t m.0-
(FEW
m.01a.o-
zsno.0
2ma z100.0
morn
zso0.m
1.
2.
3.
4.
m a a1m.m
TIME
SECONDS
Figure 4-4. RMS East Position Error vs. T h e : GPS measurements Stop at 2550 seconds.
293
All four benefits are available to GPS users who are authorized to
obtain the GPS Precise Positioning Service (PPS). Only the f i s t
and third are guaranteed to GPS users who are vulnerable to the
selective availability clock dither that corrupts the GPS Standard
Positioning Service (SPS). Clock dither prevents the tracking
loop bandwidths from being reduced to the bandwidth of the INS
errors, and corrupts the use of GPS measurements to calibrate the
INS error states.
GPS receiver technology is evolving rapidly in response to pressure from the civilian market. This trend is evident in the
miniaturization of full-capability receivers that can be physically
embedded in a host system such as an INS or a mission computer.
This in turn makes it practical to obtain even higher performance
levels by treating both GPS and the INS as sensors that produce
measurements to be optimally combined by anavigation filter into
an optimum navigation solution.
REFERENCES
1.
Brown, R.Grover,ABaselineGPS RAIM Scheme,NAVICATION, Vol. 39, NO. 3, Fall 1992, pp. 301-314.
2.
3.
4.
5.
6.
7.
8.
9.
10. Eller, D., GPS/IMU Navigation in a High Dynamics Environment, Proceedings, First International Symposium on
Precise Positioning with GPS, April 15-19,1985. Rockville,
MD. pp. 773-782.
11. Bridges. P. D., Influence of Satellite Geometry Range, Clock
and Altimeter Errors, on Two-Satellite GPS Navigation,
Proceedings, ION GPS 88. Colorado Springs, CO, September 19-23, 1988, pp. 139-146.
294
12. Kalafus, R. M., and Knable, N., Clock Coasting and Altimeter Error Analysis for GPS. NAVIGATION, Vol. 3 1, No. 4,
Winter 1984-85.pp, 289-302.
13. Bartholomew. R. G..et al. Software Architecture of the
Family of DoD Standard GPS Receivers. Proceedings First
Technical Meeting of ION Satellite Division, Colorado
Springs, September 1987, pp. 23-24.
14. Dellicker. S. H. and Henckel, D., F-l6/GPS Integration
Test, Proceedings of ION GPS-89, Colorado Springs, September, 1989, pp. 295-303.
15. Bar~ur,Neil.etal,InertialInstruments-WheretoNow7,
Proceedings AIAA GN&C Conference, Hilton Head, S.C.,
10-12 August 1992. AIAA-92-4414-CP.
16. Boxenhorn. B., et al, The Micromechanical Inertial Guidance System and its Application, Proceedings Fourteenth
Biennial Guidance Test Symposium, Holloman AFB, New
Mexico, 3-5 October 1989, pp. 97-112.
17. Ward, P., Rath, J., Attitude Estimation Using GPS, Proceedings, ION National Technical Conference, San Mateo, CA,
23-26 January 1984, pp. 169-178.
18. Kruczynski, L. R., and Li, P. C.. Using GPS to Determine
Vehicle Attitude. Proceedings, ION GPS 88. Colorado
Springs, CO, September 19-23.1988. pp. 139-146.
295
1.
INTRODUCTION
2.
DESCR1J"I'ION
2.1 sensors
A functional block diagram of a S A R motion compensation
system (SARMCS) that utilizes a TOA Kalman filter is
shown in Figure. 1.
296
Characteristic
Performance
150 ppm (lo)
0.2 Olhr (lo)
0.2 "lhrlg (lo)
Characteristic
Performance
3.
3.1 Statevector
The state vector in the optimal TOA Kalman filter design
contains 26 states, representing all significant t i m e
correlated errors. The state vector can be expressed as
5 PPm (lo)
0.01 "lhr (lo)
0.003"1d hr (lo)
Performance
Characteristic
Scale factor repeatability
Bias repeatability
Performance
50 ppm (lo)
50 Pg (10)
Po= EIZoZ: 1 ,
E,
as
291
-,.
I o "I o - I o
where
PM,= E[iM,i:
-T
PLNh
= E [ ~ L N s1 a ~ ~ ~
9
Ps,= E[isagl 1 ,
P
,
Subvector
State
-
'DVS
XS
X~~~
1
2
E[i,,i,T ]
Description
Coordinate Frame
Wander Azimuth'
G%
G
G Z
Aircraft Body'
6S
Aircraft Body
AMX
x~~~
(3)
Wander Azimuth
IMU Body3
298
a:,o
O u : , O
0
0
0
0
0
0
0
O u : , O
o u : , o
0
0
&
O
u
02, o
0
0
o u : , o
0
0
o u h o
0
0
0
0
0
0
0
0
O
0
0
0
0
O U L h
0
0
0
0
o u g
&, -
U+ ;
U
:
,
0
0
0
Pmh= 0
0
U$
#MZ
0
0
0 0
ULn
.LE
U L n
o u : , o
Wz
Pm=
0
0
0
0
0
0
0 0
U&
0
0
U L E
ULE
(15)
(16)
, i = X,Y
SV =-SV, , i = X,Y
SR = SR,
si
(12)
#sl=#MZ
P%=
~
u
o
o
o o o
o
o
o u ; + o
o u : +
U:,
0 U i h
specified in Table 2,
U
f-
LE-
&, -
f-
299
i ( f ) = F(t)X(t) + ~ ( t )
This yields
(18)
In the above equation, WO) is a 26 element vector of zeromean white noise processes. This noise vector has the same
structure as the state vector, namely
0 0
R,
0
F,
4,
4
41
4,
41
0
--vz
R,
IgZ
R,
--vz
f,
-f,
--l
--@ffiz
-a,
.a*
R,
a
nvx
a*
f,
RX
-fz
-hffiz
--
%ffiz
affiz
-ow
am,
-aI"X
ffiz
rFM
FMIINS
F= 0
Fms
0
0
0
FDVS0
(20)
with
0 Fs F,,
O O F ,
,
where F, and Fs are 7x7 matrices, F,,,
is a 7x5 matrix,
FsnMUis a 7x5 matrix, F,, is a 5x5 matrix, FIMU
is a 5x5
matnx, and FDW is a 2x2 matrix. Using the expressions
from Eqs.(l), (19) and (20) in Eq.(l8), the system dynamics
can be expressed in terms of the state subvectors as
XM
FMX, + F",sxmS
+ WM
>
(21)
Rx=rx+h ,
XDVS
X, =
F, xS + Fw, , X
FDVS 'DVS
X,=F,X,+W,
wDVS
(23)
RT=rT+h
+ W,
(25)
Vx, V,V,-
fx,frfi -
aE., aEy,aEg
rwl
(24)
@IwX*%#y"Iw;
h-
rx, r y -
300
Vertical channel error states for the master INS are not
modelled in the Kalman filter because vertical channel
errors are controlled with a third order ftxed-gain damping
loop implemented internally in the INS.
The elements of Fs have exactly the same form as that
expressed in Eq.(26) for F,, except that the wander azimuth
frame of interest has its origin at the strapdown IMU, and h,
V, and f apply to the strapdown IMU rather than the master
INS.
The submatrix F,
has the standard expression for a
strapdown mechanization:
0
0
Cll
0
0
CIZ
cz, czz
0
0
0
0
0
0
0
0
0
0
0
0
FINS
0
0
(27)
-ell -clz-c13
-c1, -czz-c1,
Fm
-8,
0
0
-8,
0
0
-BsorI
0
0
-P,
-c,, -qz-q3-
where C,,is the element in the ith row andjth column of the
direction cosine matrix
which expresses the
transformation from the aircraft body frame to the master
INS wander azimuth frame. The aircraft body frame is
defined in Table 3.
is computed as
-cosPcosR
(31)
with
A=a+H ,
and the variables defined as:
R - aircraft roll,
P - aircraft pitch,
P,= ~ w ( ~ ) w ( T ) Q~ (]f =) S ( f - 7 )
(32)
enw
which describes
elements of the direction cosine matrix
the transformation from the strapdown IMU body frame to
the wander azimuth frame centered at the IMU. The
enw
(33)
30 1
qm+
qw+
qyoN
Qs
Q,
qlurr
qM.4sr
(34)
%Df
qm+
o q , , o
oq,,
4SGr
qSGr
0
0
q~lw'
QJarr
QVON
d,
a jD
aa
the expressions:
aircraftgroundspeed,
magnitude of the aircraft acceleration vector,
(39)
&, -
302
,
I
Q,,(f>S
(t-
7 )
E[~,(t)w,(~)~l
(41)
and is given by
Q,,=
o q , , o
0
0
0
0
0
0
0
0
0
0
0
0
qvD 0
0
0
0
0
0
0
0
0
0
0
0
0
(42)
are
(45)
3.4 Measurements
Two different sets of measurements are constructed for use
in the Kalman filter. One set is a velocity matching
measurement ~0 between the DVS and the master INS. This
303
v,"
v; a;
d; -
components of z t .
Also, the master INS/Doppler
measurements are processed only during nominally straight
and level flight to avoid additional inaccuracies in the DVS
that result when the aircraft is steeply rolled o r pitched. The
measurement vector z that is processed by the filter is then
written as
d: -
- the direction
The matrix
is computed by
cz
CZC,., ,
(54)
z=Hx+v ,
(57)
304
.;R
The submatrices H,
%V
IS
H,
(58)
U;
Dy
I,
5DX
y,
V ,V -
V ,V -
Mx
Mx
MY
My
v; = y v ,
The submatrices HvMand Hvs, both of dimension 2x7, are
given below:
0 0 - 1 0 0 0 0
H,.=[
0 0 0 - 1 0 0 0
0 0 C,
%=[
0 0
c;,
c;,
0 0 0
c;, 0
0 0
c.
(63)
R = E [ v v ~=]
h-
OX
305
'k+I
@kXk +
w,
(65)
a1= eXp(FjAf,)
=
where
Af,
At,
I + RjAf, + -F,2(At,)2
1+ -Fj3(Af,)3+...
12
6
is the propagation
Fj
interval
,(66)
defined by
1
-63
43
-84
'k
ajt4aj+3aj+2aj+1aj
(67)
'
-81
-80
-60
-82
LONGITUDE (deg)
TIME
-
DESCRIPTION OF MANOEUVRE
(8)
Q,
p"
e'~*~Q(7
d7
(68)
75
116
173
330
392
500
562
870
891
941
Start S-manoeuvre
1067
3400
Start S-manoeuvre
3506
4500
Complete profile
306
1000
2000
3000
TIME ( 8 )
4000
5' 10
TIME (s)
TIME
(8)
307
4.
4.1 StateDecoupling
If certain parts of a system state vector are only weakly
coupled, it is often possible to split the one Kalman filter
into two o r more lower order filters. This can reduce the
computational burden by a significant amount since the
number of multiplications required to perform the most
intensive filter task - the solution of the error covariance
equations - varies roughly as the third power of the number
of states.
In this section, it is shown that the optimal TOA Kalman
filter described in Section 3 can effectively be split into two
filters.
The Doppler damping of the master INS is
performed in one filter, while the transfer of alignment from
the master INS to the strapdown navigator is performed in a
second filter which is mathematically decoupled from the
first.
The means by which the original Kalman filter can be
decoupled becomes more apparent if one considers an
alternate filter formulation for which the differences between
the absolute errors in the master INS and strapdown
navigator are modelled, instead of the absolute strapdown
navigator errors themselves. Such a filter formulation is
based on the fundamental insight that measurements
constructed by comparing equivalent information from two
systems with the same error dynamics will only allow
differences between the two systems to be observable,
rather than the absolute errors in each system. Thus the
velocity matching measurement between the master INS and
strapdown navigator provides direct observability only for
x; where
I yields
(73)
The form of the above equation clearly c o n f m s that only
(74)
x;=xs-x
(69)
Eq.(24) to give
(70)
where
Wb=Ws-W,
(71)
308
i, = F,x,+ W , ,
i , =F,x,+ W, ,
where
F, =
and
0
0
0
0
0
0
0
0
0
0 -4-,
0
0
0
0
0
0
1 0
0
0
0
0
0
0
0
-4-,
0
0
0
0
0
-qMGN
0
0
0
0
0
0
0
0
0
(75)
The initial cross-covariance matrix between x1 and 5 is
expressed as
-qMGN
-qmNJ
Qi =
+ QS-zQM,
0
0
0
0
0
0
0 q.%.W+
0
4 ,
0
0
qsw+
0
0
0
0
%Mu+
4WsF
(76)
77)
qMGN
4sonnr+
qUGN
(81)
0
0
PIS = E[%6%'4 ] =
1
~[%ms~%&
I~
E[iDmaf&
1
H%Ma%&
which yields
1
H%msa%LaT
I
4'Dm,'LaT
1
E['Ma';aT
14
Consequently, it can be
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0
0 -ut
0 0
0
0
0
0
0
0
0
-U&
0
0
0
0
0
0
0
(82)
U:,
This
309
x s = x M + x;
(83)
0.02
e:
0
K
is needed as
0.03
et
e:
0.01
z
0
3E
0.00
w
rn
9 -0.01
m
0
* -0.02
K
x
-0.03
10
0.03
f
\
t
z
0.02
3K
K
0.01
z
0
ljc
0.00
B
v)
f -0.01
U -0.02
a;+@)=
ULBf 2 .
(84)
;p = qmB
(85)
-0.03
0.03
U;+
0.02
e:
aLBT2=qWBT,
5s
w 0.01
(86)
which yields
qWB=ULBT
(87)
rn
9 -0.01
m
0
K
*0 -0.02
N
-0.03
3 10
5. CONCLUSIONS
The process of designing a suboptimal transfer-of-alignment
(TOA) Kalman filter for a S A R motion compensation
application has been detailed at some length. While a
6. REFERENCES
1. J.J.Kovaly, Synthetic Aperture Radar, Artech House
Inc., Dedham, Massachusetts, 1976.
2. M.I.Skolnik, ed., Radar Handbook, Chapter 23,
McGraw-Hill Book Company, New York, 1970.
3. D.J.DiFilippo,
G.E.Haslam,
and
W.S.Widnall,
"Evaluation of a Kalman Filter for S A R Motion
Compensation", proceedings of PLANS 88, Orlando,
Florida, Nov.29-Dec.2, 1988.
4. R.E.Kalman, "A New Approach to Linear Filtering and
Prediction Problems", J. Basic Eng., March 1960, pp.35-
46.
5 . R.E.Kalman and R.S.Bucy, "New Results in Linear
31 1
TIME
(8)
IO
312
J . Stanley Ausman
Litton Guidance and Control Systems Division
5500 Canoga Avenue
Woodland Hills, CA 91367-6698
USA
1.
Introduction
313
314
Conventional Baro-Inertial
Loops.
315
(1)
+ DO2)
(21
316
317
318
LOOP Corrections.
319
320
321
Analysis
State Equations.
As suggested in Ref 13, we will use
hii = cvz
r
=
Fa, + 2(g/a,)hi
[a; -10'~6az
(6)
k;, = -10" (0.5 + v,,/vo)k,
=
(0.5
Vh/vo) fhb
/Vz
where
a, = Earth's Astronomic Radius
in feet
g = Gravity in ft/sec2
vh = Magnitude of aircraft horizontal
velocity in fps
Vo = 500 fps
In Eq (6), the term 2(g/a,)hi is the
positive feedback term due to the
altitude-dependent portion of the
gravity compensation. Eq (6) models
322
chi
(7)
+ ch,,
(8)
Measurement Noise.
h,=~hi-h,(1-h,/2ho)ko-~hb
(9)
(10)
323
b.
C.
d.
e.
f.
Baro-altimeter resolution of
2 . 5 ft
Simulations
Baro-scale factor
nonlinearity with altitude
per Figure 13.
h.
Description of Simulation Proqram.
Figure 11 shows an overall block
diagram of the simulation program
used to simulate the Kalman filter
vertical channel. A desktop
computer was used to perform the
simulations. The Kalman filter
update interval was one update every
8 seconds, although some runs were
made with 4-second and 2-second
update intervals. Figure 12 shows
little difference in vertical
velocity accuracy as a function of
update rate, and for that reason we
chose the slowest of the three rates
for the remaining simulations.
To initialize the filter, we had it
perform absolute altitude updates
for the first 98 sec and then switch
to barometric altitude updates. The
absolute altitude updates employ the
same Kalman filter except that the
H-Matrix, observation error signal,
and measurement noise are changed
to:
= h, (1
h,/2h0)
H = [ 1 0 0 0 0 ]
E = hi - h,
R = (10 ft)2
This procedure simulates turning the
system on when the aircraft is on
the ground at a known elevation
above sea level
Truth Model.
The simulation truth models included
the following:
a.
(14)
dht
,o
+f
clhf
._L
=(KO t +.8(3/h,)
(16)
4 ht
A plot of Eq (16) vs altitude
appears in Figure 13.
Simulation Results.
The above error model was subjected
to several different vertical
maneuvers and barometric anomalies.
324
325
326
6.
7.
Nomenclature.
AB 2
term
AFB
term
a or a,
a,
C
DVZ
DHBO
Acceleration feedback
Altitude rate feedback
Earth's radius
Vertical accelerometer
bias error
Covariance matrix
Vertical Velocity
increments from
vertical acceleromleter
Difference between
filtered bar0 and
filtered inertial
altitudes
Error signal, hi-hp
E
F
Dynamics matrix
Gravity
9
Gravity at sea level on
go
the equator
H
Inertial altitude in
conventional filter.
Observation matrix in
Kalman filter.
Hdot or l!l
Time rate of change of
H
HB
Filtered bar0 altitude
Hbdot or Hb Time rate of change of
HB
HBR or h,
Raw bar0 altitude input
Inertial altitude in
hi
Kalman filter
Filtered inertial
HL
altitude
Isopycnic level, 26,000
h0
ft
Pressure
altitude ft
hP
True altitude ft
h,
k
Bar0 scale factor error
Value of k at sea level
k0
K
Gain changing parameter
=1 - KB5
K1
2 go
0.005302
K2
KB2
Velocity feedback gain
KB3
Acceleration feedback
gain
KB4
Integral acceleration
feedback gain
KB5
Gain change parameter
computed as
=v,/ (Vz2+DOZ)
1 sec"
KF
Plant noise matrix
Q
R
Measurement noise
S
Laplace operator. S
signifies
differentiation;
1/S signifies
integration.
Represents state
vector in Kalman
filter.
s2
Feedback error signal
t
Time
Time between Kalman
updates
Nominal loop time
T"
constant =20 sec during
alignment and 100 sec
thereafter
Magnitude of aircraft
horizontal velocity
500 fps
Inertial vertical
321
vz
velocity
Change in vertical
velocity between Kalman
1-3
8. References.
329
SECTION V
REPRESENTATIVE VEHICLE IMPLEMENTATIONS
INTRODUCTION
DR. JOHN NIEMELA
330
Introduction
The purpose of this paper is fourfold, (1) to
provide the reader with a status report on the
state-of-the-art of navigation system technology as applied to fixed wing aircraft, (2)
recommend a disciplined systems engineering process to be used in determining navigation system requirements as they relate to
navigation, sensor cueing and targeting as
well as weapon requirements (3) examples
of how to functionally decompose each aircraft and analyze its mission requirements
into the navigation system requirements and
(4) A typical set of requirements for a fixed
wing aircraft. The results will allow the
navigation systems designer to have a
process he can follow in determining or verifying the requirements of a particular application as well as a baseline set of
requirements..
33 1
Parameter
SuppllerA
Supplier B
0.005
5
0.003
15.24
0.003
5
0.0015
18.4
16
45
Dithered
0.8
2.5
None
7x7~11
$75k
4000+
19
22
Bias
Scale Factor
Random Walk
Path Length
System Wieght
System Power
Type
Nav Performance
Velocity
Cooling Air
(Ib)
(w)
(nmhr)
(Wsecrms
Slze
(W
cost
(1990 Dollars)
MTBF
Hours
Global Positioning System
'Alr Data Capability
Radar Altimeter Capability
Common Module Maintainabllity
Yes
Yes
Yes
Yes
Multloscillator
0.8
2.5
None
7x7~10
$75k
4000+
Yes
Yes
Yes
Yes
Referenced
Navigation
332
CORE PROCESSOR #2
INS #l
40 Hz
CbsedLoopKFUl
GC. CV, IFA, NAV NO&
Portomuna0.8 nnJhr
Positin. Velocily
Alltude. AlIitude.
i
Open Loop Kalman Fitter U1
N w l g a t b n Aldlng
C o n s c t b n A)gor(thms
Performance
Need separate Open Loop Kalman Filters for each INS to Properly Model
Correlations Built up during Independent Alignment Functions
Figure 1.0-3 Dual INS Performance is Improved Over Single System
The current generation of military aircraft
now under development will be using common modules as building blocks of even
more integrated and interdependent navigation system architectures as shown in Figure
1.0-2. The design and development of fixed
wing aerospace navigation systems is based
on operational requirements of the vehicle,
mission scenarios, sensor suites, weapons
suites, reliability and maintainability requirements. Because of the high degree of
integration of current and future systems, it
is imperative that this design and development follow a rigorous analytic process in
order that the establishment of the required
accuracy, signal characteristics, interface requirements, noise, bandwidth, reliability,
physical characteristics and cost of the system be well defined.
The system engineering process allows the
designer to perform trade studies in order to
optimize system design (References 2 , 5 and
6). For example, it may be more cost effective to achieve higher system performance
by using lower cost inertial navigation systems aided by aircraft sensors performing
velocity and position updates. Another ex-
ample could be a configuration using averaged dual medium accuracy INS'S to achieve
high accuracy and higher mission reliability
instead of single high accuracy fault tolerant
INS as illustrated in Figure 1.0-3. A dual
INS installation would also allow placement
of one system at the Radar antenna for better
motion compensation and the other system
at a structurally benign position for flight
controVautopilot reference or located at another sensor. Section 2.0 will describe a
recommended approach for this process.
1.0.1 Definitions
From the previous discussion it can be seen
that significant changes have taken place in
the field of aerospace navigation systems.
This paper uses the definition of navigation
as defined in Reference 4, "the process of
directing the movements of a craft from one
point to another", and will deal primarily
with fixed wing military aircraft such as
fighters, attack, strategic and transports. It
will deal with three main missions, the tactical, the strategic and the transport. At this
point it is necessary to define some new
concepts and terms used in today's aerospace
vehicles. As shown in Figure 1.0.1-1
333
0
Mission
Functions
0
Vehicle
Functions
............................
WIIU..
COntml
Conbol Interlace
334
systm
Englrwerlng Process
Air Vehicle Level
. .. ..... ...
2.
3.
MIL-STD-499A defines Systems Engineering as, "the application of scientific and engineering efforts to (a) transform an operational need into a description of system performance parameters and a system configuration, through the use of an iterative process of definition, synthesis, analysis, design, test, and evaluation; (b) integrate related technical parameters and ensure compatibility of all physical, functional, and
program interfaces in a manner that optimizes the total system definition and design;
and (c) integrate reliability, maintainability,
safety, survivability, human engineering,
and other such factors into the total engineering effort to meet cost, schedule, supportability, and technical performance objectives".
The requirement to use systems engineering
is invoked by DoD DIR 5000.1 Part I, Paragraph C.1.b dated 23 February 1991. It
specifies that, "Program plans must provide
for a systems engineering approach to the
simultaneous design of the product and its
manufacturing, test, and support processes.
As shown in Figure 2.0-2, systems engineering comprises five major activities, some of
which have been decomposed into smaller
tasks. The output of the system engineering
process is documentation including specifications, plans, functional flow block diagrams, and trade study reports. The
approach is to apply the process of Figure
2.0-2 at each level as outline in Figure 2.0-1.
The first step at each level is to determine
the customer needs as shown in step 1, convert those to mission requirements of step 2,
perform a functional analysis as shown in
step 3 and then allocate the requirements as
shown in step 4. Steps 2.3, and 4 constitute
the system functional analysis which is then
used in step 5 to perform the design synthesis and system integration. The next step is
to define the system for specifications, interfaces, development plans and logistics as
shown in step 6 which results in a description of the system elements. If the design is
still not complete, step 7 is performed in order to optimize the design by performing
trade studies and effectiveness analysis, as
well as other related analyses. This final
step is the evaluation and decision step.
This step may result in further iterations
through steps 1 to 5 until the decision path in
6 is that the design is complete. Section 3.0
will perform some examples of Step 1, input
requirements, step 2, mission requirements
analysis and step 3, functional analysis and
Step 4,requirements allocations in order to
give the reader a methodology to follow and
some results that may be useful in his applications. Section 3.2 will present a table of
typical requirements allocations for a modem fixed wing tactical aircraft that can be
used as a basline as it would be difficult to
define all possible requirements without performing an analysis for all aerospace vehicles. To define all possible requirements
could also result in overspecifing the system
and increased cost, weight and maintenance.
336
ixed W-rcraft
(S~QS
l-tLmuu
This section will examine a top level functional decomposition of possible areas of
coverage for navigation systems in fixed
wing aircraft in order to establish major
baseline functions that may be required
which in turn can be decomposed into sub
functions. The purpose of this section will
be to define the possible functions of the
navigation system which will then be later
used to relate them to aircraft requirements,
vehicle functions, mission functions, mission tasks, sensor suites, weapons suites,
survivability, reliability and maintainability.
Figure 3.0-1 shows the first step in the decomposition of aircraft requirements which
simply shows how mission and aircraft requirements can be mapped into the three
major system requirements.
Vehicle
337
..
Missions
T
v
D
i
p
Peauirements
A tactical aircraft must be capable of rapid
deployment on both air-to-air and air-toground missions and offer affordability,
availability, survivability, and lethality..
Typical aircraft performance requirements
I
Tactical
Strategic
Air-to-Ground
Air-to-Air
Transport
338
combat
combat
(2) AIM*
20 mm (1,ooo Rouna)
0.9 M&h
(4) AIM-120IAMRAAM)
Combat
0.8 0.9 Mach
0.9 Mseh
all
Battlefield
Air
interdiction
1. We-mission Planning
2. Pre-flight and Pre-takeoff
3. Takeoff
4. Departure
5. Cruise (haven)
6. Let Down toTerrain Following
7. Ground Target Acquisition and Attack
8. PostAttack
9. Return to Base
10. Penetration / Approach
11. Land
12. Turnaround
Takeoff I
ingress
Air-to-Ground
Attack
Egress I
Landing
Service and
Maintenance
Figure 3.0.2-2Battlefield Air Interdiction Mission Phases and Segments
dvnamic resuonE. The equipment shall be capable of functioning and
maintaining alignment such that overall
system perf&n&ce will not be degraded by
aircraft maneuvers up to the following limits:
(a)
(b)
339
porating a low-observable phased-array antenna, an extremely accurate inertial navigation system, a strategic Doppler radar altimeter, and a star tracker. Its defensive
avionics are built around the AN/ALQ- 161
electronic counter measures system, with
extended frequency coverage, and includes a
tail warning radar and expendable decoys
such as chaff and flares.
It has three internal weapons bays with the
capacity to carry up to eight AGM-86B airlaunched cruise missiles (ALCMs) and
twenty-four short-range attack missiles
(SRAMs). In a conventional, non-nuclear
role, it can carry up to eighty-four 500
auirements
The strategic aircraft selected as an example
is representative of the B-1B and B-2
bombers. The strategic aircraft is a long
range, multi-role strategic bomber and the
mission/sensor/weapons are considered to be
representative of advanced bombers. It is
capable of carrying, in three weapons bays,
varying combinations of nuclear air-toground missiles, conventional or nuclear
free-fall bombs, and auxiliary fuel. In addition it has electronic jamming equipment, infrared countermeasures, radar location and
warning systems, other advanced avionics
and low observable technology.
The strategic aircraft, shown in Figure 3.0.31, has a maximum gross weight of 477,000
pounds and is capable of supersonic flight at
speeds approaching Mach 2.0. Its primary
role will be high subsonic, low-altitude penetration to the target area. Its variable-geometry wing permits operation from shorter
runways in the upswept position and supersonic flight in the fully swept position. The
avionics systems include advanced forwardlooking and terrain following radars incor-
340
The non-nuclear mission profile is a high altitude profile for the entire mission thus surGreat
Circle
Strategic Alrcrafl
Crulse Mlssle
(1) Takeoff
(2) INS Air Start'
(3) Start Ovenvater
Flight (8 hr)
to Missle Launch
Missle Launch
(5) Launch
(6) Landfall
(7) Update (Option)
(8) At Target
35
Attitude
1,000 ft
9
10
Flight Time - hr
(7) (8)
I
11
12
13
I
14
1
15
tttrttt t t t t t t
* Doppler updatesevery 30 seam& during overfandflight
L+v
** Each stellnr update consists of 3 star lixes
6 Position Fixes
Stellar Updates''
CC24-0157-33-D
face-to-air and enemy air threats are not significant factors. Carpet bombing is accomplished by taking advantage of the large
numbers of conventional weapons, (MK-82
or MK-84 low drag general purpose bombs),
that can be carried on the strategic aircraft.
34 1
Covert operation
Combat zone
Austere basing
Low level (below 200 ft.) flight
All weather / night operation
Long / extended range
Cooperative tactics
Aerial delivery
Medical evacuation
Transport Aircraft Mission Requirements
1 Pre-mission Planning
2 a Preflight and Pre-takeoff
3. Takeoff
4. Departure/Cruise
5 a Medium Altitude Airdrop
6 a Outbound Flight
7 a Rendezvous
8. Returning Flight
9. Low Altitude Parachute Extraction
l o a Return To Base
I 1 Descent And Land
12. Turnaround
a
342
3.1
-F
Error Source
Allocated Emw
1. Gyro WRN
0.36
2. Gyro Bias
0.13
0.0015"hr
3.Vel Disturbance
0.13
0.02 ftlsec
4. All Other E r r m
0.03
mrads
IFigure 3.1-1 Typical Allocation
of Error
0.41
rl
&=
___-_.-_-__-_--__1_1___
RxSqrt(T)xCosO.)
where,
E = heading error allocated to wide band random noise
q = gyro wide band random noise specification
12 = earth rate (15.04"hr) (sidereal time)
h = latitude
T = alignment time
Figure 3.1-2 Random Wide Band Noise and Alignment Error
343
344
Inertial altitude and vertical velocity are required to supplement the altimeter during
large variations in altitude. Pressure-altitude
can be invalid during and after steep dives or
climbs. Short-term inertial vertical velocity
is required to be accurate to 2 ft/sec (1
sigma) during this period primarily to provide accurate velocity vector calculations.
The long-term inertial altitude is required to
track the pressure-altitude within 2 feet (1
sigma) during steady state conditions and to
track true altitude within 150 feet during
maneuvers. Range required is - 1000 feet to
+75,0000 feet for altitude and + 1500 ft/sec
for vertical velocity.
Altitude and vertical velocity fault tolerance
and survivability are required due to the requirement for valid velocity vector display
during landing. Fail-op inertial outputs will
be provided to increase availability and
safety during large altitude variations.
Sensor Management Analysis The navigation system must provide present position
and attitude on data with sufficient accuracy
to ensure that the way point or target is
within the sensor field of view (FOV) or
mapped area when expected.
The INS position and position drift requirements to support sensor cueing in this example will be based on the air interdiction
mission discussed in section 3.0. The position error allowed for successful cueing is
based on a cueing probability of 0.99. The
cueing probability is a function of the way
point or target location within the sensor
FOV or mapped area is calculated as shown
in Figure 3.1-3. The major contributors to
way point or target position error within the
sensor FOV or mapped area are the target
location uncertainty and the aircraft position
error.
345
-1
Line
-3
-2
-1
0
X
-3
-2
-1
3
CC24-0157-87-D
346
1. Perform
Velocity
Update
2. Create
A
SAR
Map
3. Designate
Way point
cc240157-83-0
1.o
Patch Size
3.34 x 3.34 NM
0.8
0.6
Probability
Waypoint in
SAR Patch
0.4
1 . 3 4 ~1.34 NM
0.2
0.67 x 0.67 NM
2,000
4,000
6,000
347
Map Size
(NM x NM)
Target Location
Uncertainty
(Note)
(ft, CEP)
Aircraft Present
Positio n Uncertainty
(ft, CEP)
0.67 x 0.67
850
295
800
1.34 x 1.34
1705
295
1680
3.34 x 3.34
4250
295
4240
4.67 x 4.67
5945
295
5935
10 x 10
12.7k
295
12.7k
20 x 20
25.5k
295
25.5k
40 x 40
50.9k
295
50.9k
80 x 80
102k
295
102k
CC24-0157-65-D
Figure 3.1-6. Position Error Allowed for Cueing Radar with P=0.99
to 5,000 ft
Altitude
L-Detect
Range
_I
CC24-0157-66-0
348
Ground
Range - NM
1.o
20
15
0.8
10
0.6
Probability
Waypoint in
FLlR FOV
0.4
0.2
1,000
2,000
3,000
0.8
0.6
Probability
Waypoint in
FLlR FOV
0.4
0.2
0
0
3,000
1,000
2,000
Position Error - ft, CEP
CC24-0157-68-D
349
Wide
2427
1822
1217
614
377
5x5
295
295
295
295
295
2409
1797
1180
539
235
295
295
295
295
295
530
347
73
20
15
10
5
3
Narrow
1.25 x 1.25
606
455
304
154
94
Mlsslon
I
Mechanization
Equations
Preliminary
Error Budget
Determine Sensitivity
Equations by Differentiating
Equations wrt Error Sources
Individual
Errors
Aircraft Velocity
Range to Target
Height Above Target
Designation Error
Requirement
(From Update or
Weapon Delivery
Requirements)
Equipment Specs
Established
CC240157-88-D
350
Rs = Slant Range
q = Sensor Field of View
35 1
lt
1P-
Angle
Aircraft
7-l
Aircraft
Depression
Height
. _.a - -
Ground Range
CC24-0157-70-0
Figure 3.1-12. Radar SAR Map Geometry for Designation Error Determination
Sensitivity Equations
Error Source
Operator Designation
Cursor Related Ranging
Doppler Process
Aircraft Altitude
Velocity - x
Cross LOS
Along LOS
dR*Npd
*Ah
R S C W
TncosO *AVx
dA
Npd
Ah
R,tanQcos'@
1 [&
+ TnsinO]
AVx
Velocity y
Velocity - z
V sin0 cos@
R,
AVz
AV
Rs = Slant Range
v = Azimuth Angle
dR = Range Resolution
h = Height
T, = Nav Time
e = Squint Angle
V = Aircraft Velocity
$I = Depression Angle
CC24-0157-71-D
352
Error Source
Units
Operator Designation
Cursor Related
Ranging - Doppler Process
Aircraft AItitude
Velocity - x
Velocity - y
Velocity - z
Heading
REP
DEP
Standard
Deviation
1.50
2.10
0.30
100
0.80
0.80
2.00
0.96
Along
LOS
ft
Cross
LOS
ft
12.8
18.0
2.5
5.2
8.5
0.5
0.0
0.0
17.0
12.8
18.0
2.5
5.2
94.8
77.8
16.0
87.5
104
105 ft
CC24-0157-72-D
Error Source
Units
Standard
Deviation
Operator Designation
Cursor Related
Ranging - Doppler Process
Aircraft Altitude
Velocity - x
Velocity - y
Velocity - z
Heading
REP
DEP
Circular Error Probable
Conditions: 15 nmi grd range, 4,800 ft alt, 500 kts,
45" squint, 15 sec nav, 127 ft resolution
1S O
2.10
0.30
100
0.80
0.80
2.00
0.96
Along
LOS
ft
Cross
LOS
ft
190.5
266.7
38.1
5.2
8.5
8.5
0.0
0.0
190.5
266.7
38.1
5.2
94.8
77.0
16.0
87.5
330
363
408 ft
CC24-0157-73-D
353
10
15
25
20
30
I
AI I
300
250
200
150
100
50
0
GPS
PVU
3
Autonomous INS
354
CC244157-76D
Error Source
Along
LOS
Cros8
LOS
Height
cos$ ARS
sin$ ARs
V cosy co2g At
Laser Alignment
Rs cos$ cote AQ
Rs cos) Ai$
Laser Range
~sin%*At
Gimbal Readout
Tracking Loop
Gimbal Boresight
FLlR Boresight
Flexure Uncertainty
Rs sine A@
Rs A y
Rs cos$ A$
Azimuth Reference
Rs cos$ AV
Elevation Reference
Rs sin@ ABp
Rs cos$ ABp
RS = Slant range
y l = Azimuth angle
$
I = Depressionangle
V sin4 cos$ At
\ = Aircraft velocity
A I = Timing uncertainty
CC240157-770
355
Level, 1,000 ft
Error Source
Unlts
Laser Range
Laser Range Timing
Laser Alignment
Gimbal Readout Timing
Gimbal Readout
Tracking Loop
Gimbal Boresight
FLlR Boresight
Flexure Uncertainty
Azimuth Reference
Elevation Reference
ft
ms
mr
ms
mr
mr
mr
mr
mr
mr
mr
Standard
Deviation
15
33.7
0.15
9.6
0.985
0.141
0.1
0.37
0.33
0.96
0.71
Along
Track
ft
Cross
Track
ft
14.9
28.3
22.1
0.1
1.o
0.1
0.1
0.4
0.3
0.0
0.7
38.9
0.0
Helght
ft
1.3
2.4
1.8
0.7
11.8
1.7
1.2
4.5
4.0
0.0
8.4
16.2
0.0
0.0
0.0
11.8
1.7
1.2
4.5
4.0
11.5
0.0
17.7
33.4
CC24-0157-780
160
Update
Accuracy
CEP
120
ft
80 H = 1,000ft
12
16
20
CC24-0157-70-0
356
I
I
A typical SAR error budget is shown in Figures 3.1-14 and 3.1-15 for two different map
resolutions. (All error contributors discussed
in this section are 1 sigma values.) The dependence of position update accuracy on
map resolution and update range shown in
Figure 3.1-16. The parametric curve shown
in Figure 3.1-17 shows the dependence of
S A R map designation errors on INS velocity
error. Even at 0.8 ft/s velocity error the
designation error is increased significantly
over what it would be if no horizontal velocity error was present. A typical INS velocity
specification of 2.5 ft/s would more than
double the designation error with 0.8 ft/s velocity errors. This dependence explains the
need for performing a precision velocity update (typically a radar mode) immediately
prior to construction of a S A R map or the
use of GPS velocities to update the INS.
tem.
The sensitivity equations for the laser designator system for along LOS, cross LOS, and
height are shown in Figure 3.1-19. A typical
error budget for this system is shown in Figure 3.1-20. The parametric curve in Figure
3.1-21 shows the dependence of position
update accuracy on slant range to target and
altitude. (These update accuracy do not include any way point location uncertainties.)
357
@ 125 NM to Target
TRN Data Base not Availabl
@BlindCue
Bomb
Radar
Target
to 7
CC24-0157-86D
3
Radar 10 x 10 NM Patch
(1 27 ft Resolution) 2-
1
Radar 4.67 x 4.67 NM Patch a
Radar 3.34 x 3.34 NM Patch
F L l R 5 ~ 5 ~ 0 2 0 N+
M
2
3
Time Since Last Update - hr
(Last Update Accuracy = 150 ft, CEP)
5
CC24-015741-D
358
Cueing Requirements
0 (99%) Prob
2,000
F L l R 5 x 5 " Q 15NM
Radar 1.34 x 1.34 NM Patch
1,500
Position Error
( f l l CEP)
I
I
359
Last Update
with TRN,
150 ft, CEP
Acquire Target
- Cue FLlR to Target at 5 nmi
- Use 5 O x 5 FOV
- See Weapon Delivery
Analysis for CEP Achieved
CC24-0157-82-D
FLlR5x5"O 10NM1,OO(
10
15
Time Since Last Update - min
(Last Update Accuracy = 150 ft, CEP)
20
CC260157-84-D
360
Map; 8.5 ft, 10 NM 45' Squlnt, Release; 540 kts, 1,000 R Level
Error Source
Unit.
Standard
Devlatlon
1 Operator
2 Cursor
Pix
1.5
2.1
3 RangeDoppler
pix
0.29
11
100
Pix
4 Altitude
5 Radar Velocity x
6
Radar Velocity - y
11s
11s
11s
11s
11s
INSVelociy-x
INS Velocity y
8 INS Velociy Vertical
9 Attitude Angle Reference (El)
7
mr
mr
X
mr
(Az:
Radar Slant Range
Beam LOS Position
TrueArspeed
Pilot Steering
14 Bomb EjedionVelocity
I5 Bomb Release Time Dday
I B o m b Dispersion
I7 Ballistic Fa
IC
I1
12
I?
0.8
3.0
mr
mr
1
R
R
2.0
0.33
12.75
18.00
2.45
5.23
92.51
14.16
12.79
5.28
9.87
0.18
10.27
43.48
3.3
ms
Track
ft
0.96
mr
lh
Croea
12.75
18.00
2.45
5.23
39.17
39.17
9.04
9.04
53.91
17.39
0.8
2.5
2.5
2.0
0.713
1.78
1.69
2.50
1.15
11s
:zE
0.38
30.76
2.73
51.27
3.47
REP = 78
17.63
14.24
DEP = 66
CEP = 126
Level, 1,000 ft
Error Source
Aircraft Position at Release
Slant Range
Ranger Boresight
FLlR El Angle
FLlR Az Angle
Pilot fiz Steering
Weapon Range
Bomb Ejt Velocity
Units
Standard
Deviation
!:;
Cross
Track
ft
21
0.2
1.2
1.3
3.0
10.01
14.00
27.90
0.00
0.00
0.0
0.0
8.7
20.4
fps
2.0
52.50
0.0
ms
10.0
3.0
3.0B.O
2.0
1.5
1.5
2.7
1.5
0.33
9.10
75.40
22.80
52.90
38.20
38.20
0.47
0.00
15.50
0.0
20.6
22.8
0.0
0.0
0.0
0.0
0.1
0.0
126.80
37.9
mr
rnr
mr
rnr
mr
fps
fps
mr
rnr
kcs
mr
mr
ft
0.0
36 1
CC240157-81-D
Standard
Devlatlon
~~
~~
mr
mr
mrh
FCS Roll Ref
INS Angle Ref
Pilot A2 steering
Neapon Range
Bomb E# Velocity
Release Time Delay
Bomb Dispersion
INS Velocity Reference
INS Vert Vebdty
INS Boresight
True Airspeed/AOA
AOA Boresighl
Ballistics R
rad 1 Sigma ~ n w
mrls
mr
mr
mr
fps
ms
mr
fps
fps
mr
ldslmr
mr
mr
1.Y1.5
7.Y1Sll.5
0.2
0.1
10.0
1.4Y1AY1.45
3.0
7.7
7.7
30.9
0.0
0.o
3.2
0.0
2.0
10.0
3.0
3.0B.O
2.0
3.011SJl.5
2.7141
2.1
0.33
50.7
9.4
71.1
12.3
0.0
3.3
11.8
5.9
15.5
96.8
0.07
7.8
0.0
5.0
10.4
0.2
20.5
0.1
o..o
20.5
0.8
0.0
2.8
0.8
0.0
0.0
32.3
~~
74.3 ft
022441677-02
362
363
gation system supporting the sensor. The error budgets in Figures 3.1-28 and 3.1-30
show that the relative impact of navigation
system velocity error on the ARB system is
less than for conventional bombing.
Vehicle Management System (VMS)
Analysis Basic Flight Overall, the basic
flight functions do not require highly accurate inertial state vector information. The
inertial sensing requirements can be readily
met with an Attitude Heading Reference
System (AHRS). Pilot relief modes also require velocity information which can be
supplied by the reference INS. However,
inertial data must be provided with enough
fault tolerance and redundancy to must meet
safety-of-flight issues (Reference 5).
364
5.120fi
Steering
Required
at Breakout
Point
/ //
/
1. Velocity
Update
. Fly to
Breakout Point
(200 ft Ceiling)
3. Designate
Touch Down
Point
CC240157-84-0
13
13
18
18
44
78
98
-----.
11
Same
Same
Same
Same
22
--------- ----- - - - - - ----11
22
22
44
44
11
11
22
22
44
44
18
36
117
122
141
365
Error Source
Units
Refresh Rate
deg/sec
ft/sec/sec
deg
deg
knots
deg
ft/sec
ft/sec
ft/sec/s ec
200 Hz
200 Hz
200 Hz
200 Hz
50 Hz
50 Hz
200 Hz
50 Hz
50 Hz
system was assumed to the most cost-effective means for satisfying flight safety requirements. The VMS must provide aircraft
stability and performance which satisfy the
requirements of MIL-F-8785 and MIL-F9490D for Class IV aircraft with Level I flying qualities in the A, B, and C flight phase
categories. Aircraft body rates and acceleration sensing must be fail-op/fail-op, survivable, and have a mission reliability of 1.0
E-10. Typical flight control data are shown
in Figure 3.2- 1.
366
CC240157-I0 5 C
>=I
[(Wander Angle
=d
361
Mission Related
Events &Tasks
Flight Related
Vehicle Management Functions
Position
I FPC
Integrated Modes
0 Aided Inertial
Horizontal Vertical
Altitude velocity
Velocity
2000 ft CEP
CC24-0157-108-D
-+200 deglsec
Zero Offset
Threshold
Resolution
Hysteresis
Natural Frequ-ncy
Damping
Cross-Axis Sensitivity
Residual Oscillation
and Noise
0.10 deglsec
0.02 deglsec
0.02 deglsec
0.05 deglsec
>30Hz
0.5 to 1.O (-20 to +160 OF)
0.05 deglsecldeglsec
Scaling Tolerances
Linearity is defined as deviation of actual output at any point from the least
square straight line fit of measured input/out relationship
CC24-0157-58-D
368
Range
Linearity*
Zero Offset
Threshold
Resolution
Hysteresis
Natural Frequency
Damping
Cross-Axis Sensitivity
Residual Oscillation
and Noise
Scaling Tolerances
+300 deg/sec
2 . 5 % Full Scale (0-50% Full Scale)
+2.0% Full Scale (50400% Full Scale)
0.80 deg/sec
0.02 deg/sec
0.02 deg/sec
0.30 deg/sec
>30 Hz
0.5 to 1.0 (-20 to +160 OF)
0.05 deg/sec/deg/sec
0.05 deg/sec (0-5 Hz)
0.1 0 deg/sec (5-20 Hz)
+5%
Linearity is defined as deviation of actual output at any point from the least
square straight line fit of measured input/out relationship
CC24-0157-59-0
Table 3.2-3: Flight Control Lateral and Longitudinal Accelerometer Performance Allocations
Range
Linearity*
Zero Offset
Threshold
Resolution
Hysteresis
Natural Frequency
Damping
Cross-Axis Sensitivity
Residual Oscillation and Noise
Scaling To1erances
k3G
+1% Full Scale
0.01 G
0.001 G
0.001 G
0.001 G
>30 Hz
0.5 to 1.O
0.002 G/G
0.004G
+2.5%
Linearity is defined as deviation of actual output at any point from the least square
straight line fit of measured inputlout relationship
CC24-0157-60-D
369
Range
Linearity*
Zero Offset
Threshold
Resolution
Hysteresis
Natural Frequency
Damping
Cross-Axis Sensitivity
Residual Oscillation and Noise
Scaling Tolerances
k12G
+1% Full Scale
0.05G
0.005G
0.005G
0.005G
>30 Hz
0.5to 1 .O
0.002G/G
0.002G
+2.5%
Linearity is defined as deviation of actual output at any point from the least square
straight line fit of measured inputlout relationship
CC24-0157-61-D
Attitude
Horizontal
Velocities
I
I
I
Units
degs, RMS
degdhour,
RMS
degs, RMS
fDs.RMS
. .
I
I
Requirement
with Aiding
0.25
ria
I Requirement I
I withoh Aiding *+
I 0.25 Initial
1
3
1.5
16
370
Inertial Senslng
Functional Requlrements
Attitude (1:
Mlsdlgnment
Compensation
CC24-0157-1090
Notes:
(1) Flexure Results from Changes in the Aircraft's Reference Frame (Rigid Body) Caused by Factors such as
Maneuvers, Structural Bending Modes and High Frequency Vibration Effects
(2) Static Boresight Improves Manufacturing Boresight Tolerances
(3)Quasi-Steady State Flexure Bandwidth (0.01 - 1 Hz), Vibration Flexure Bandwidth (> 1 Hz)
(4) Transfer Alignment Requires an Inertial Reference Source, Alignment is with Respect to Inertial Navigation Frame
(Weapons Include: AGM-65 MMW Maverick, JDAM, JSOW, SLAM, AGM-86, ALCM, AIM-120 AMRAAM)
(5) Misalignment is Taken with Respect to Aircraft Rigid Body Axis (.i.e. Local Attitude = N C Attitude + AAttitude)
(6) Collocatedon Airframe
(7) Weapon Attachment Tolerances are 0.5Deg in Pitch and Yaw, 1.0 deg in Roll
(8) Vibration Stabilizedvia Local Gimbal Platform
(9) N C c.g. State Estimation (Reference Nav) Vector Definesthe Aircraft Rigid Body Axis Reference Frame
CC24-0157-110.0
371
Latitude
Longitude
Baro-Inertial Altitude
I
I
deg
deg
ft
I+/-
180
I+/-180
I - l k t075k
25 Hz
25 Hz
50 Hz
50 Hz
AuL
-
. . .
notspecified
[ 6
notsnecifiad I
50 Hz
50 Hz
50 Hz
50 Hz
200 Hz
200 Hz
3Q.k
0.5
0.5
0.49
0.49
0.49
0.5
50
0.5
f9ll
0.0078
0.0078
0 0156
50
200 Hz
200 Hz
200 Hz
50Hz
50 Hz
50Hz
200Hz
23msec23msec
,
I
38-
notspecified
8
8
8
I 8
l e
Notes:
(1) Different vendors and motion compensation techniques require different inertial requirements, therefore some parameters
show a range of values rather than values for a particular mechanization
(2) All values are RMS except as noted
(3) Precision Velocity Updates (PVU) improves horizontal velocity accuracy to 0.5 Wsec. 1.0 Wsec needed for High Resolution
Mapping (HRM). GPS improves velocity to 0.3 Wsec. Accurate velocity reference improves SAR resolution by reducing
pointing errors under acceleration and the along track error.
(4) Accuracy = square root ( mean accuracy2 + jitter2)
(5) Requirements translate into accelerometer accuracy: 100 pg bias, 200 ppm scale factor
(6) Required for cueing
(7) Required for designation
CC249157-115-D
(8) Required for motion compensation
(9) Also known as radar harmonization
372
Notes:
(1)
. . Different vendors and stabilization techniques require different inertial requirements, therefore some parameters show a range of
313
(3)Misalignment is represented as a A pitch, A roll and A yaw taken with respect to aircraft rigid body axis
(.i.e. local attitude = A/C attitude + A attitude)
(4) Data rates, data latency, bandwidth are driven by weapon/sensor location, compensation technique
and overall system implementation. Simulation/analysis will update parameters.
(5) Static boresight is a constant by definition and only needs to be estimated once at power on
(6) Does not require static boresight compensation
CC24-0157-112-0
314
375
Initialization
Final Checkpoint
Master System
(Position Drift)
Transfer Alignment
Measurement Noise
Master System
(Attitude and Velocity
Errors)
Missile System
- Position Uncertainty
Between
Aircraft and Missile IMU Due to Flexure
- Attitude and Velocity Errors Transferred
From Aircraft to Missile IMU
External
Gravity Anomaly
Mapping
- Vertical Deflection
- Taraet to Identification Point Uncertaintv
CC24-0157-15643
are mature with extensive research and successful applications. Exceptions to aligning
the IMU prior to launch include weapon systems with Global Positioning System (GPS)
which allow an inflight alignment capability.
However, weapons with GPS still require
coarse initialization to ensure quick acquisition of satellites. Table 3.2-6 shows other
error contributors to weapon IMU position
errors.
376
Radar Velocity
Radar Position
Generalized Velocity
Generalized Position
Other Capabilities
Reasonableness Checks (i.e. Chi-Squared)
Adaptable/Flexible to Allow Cost-Effective Integration of New Sensors or Upgrades
CC24-0157-127-0
Updating Modes
Update Accuracy
Advantages
Disadvantages
105ftCEP (6)
0.5Wsec CI)
Emissions Required
FLlR Update
33ftCEP
Good Accuracy, No RF
Emissions, Autonomous
Global Positioning
System (GPS)
30 ft CEP
0.3 Wsec
(6)
~~
Terrain Referenced
Navigation
150to300ft
TACAN
1.3Kft CEP 0 10 NM
llKftCEP0100NM
Autonomous
Widely Deployed, Available for
Rendezvous
Available in Enemy Terriiory
97ftCEP
(6)
resolution
CC244157-12&0
371
Navigation Updating Allocations Navigation aiding sensors include Global Positioning System (GPS), pressure altimeter,
S A R , Targeting FLIR, Tactical Air Navigation (TACAN), Head-Up Display (HUD),
and a terrain referenced navigation with a
digital map such as SITAN (Sandia Inertial
Terrain-Aided Navigation) or TERPROM
(Terrain Profile Matching).
Navigation "fusion" updating consists of integrating information from multiple navigation sensors in a statistically optimum way.
This is accomplished by a Kalman filter.
Although it is a filter in the digital processing sense, it may more fundamentally be
considered a statistical algorithm which
provides an optimum estimate of the values
of certain parameters associated with a dynamic process. In a navigation system, these
parameters (or "states" of the system) consist
of various navigation errors, so that the filter
provides an optimum, ongoing estimate of
such errors, which are then used to correct
the navigation system outputs. Historically,
the software and processor for accomplishing this has resided in the INS and has been
provided by the supplier as part of the system. As navigation becomes more dependent on information from multiple sensors,
and as other systems become more integrated with the INS, it is not obvious that
this location will continue to be appropriate
for the Kalman filter.
The navigation system updating functional
allocations are shown in Figure 3.2-9. The
ability to obtain periodic navigation system
updates during the course of the mission is
extremely important to overall mission
effectiveness. However, mission scenario
and crew workload considerations may place
constraints on the frequency and quality of
the navigation update. Several update
modes have been quantified in terms of
accuracies, advantages and disadvantages as
shown in Figure 3.2-10.
4.0 Conclusions
This paper has reviewed the current state-ofthe-art of navigation system technology for
fixed wing aircraft, suggested a
methodology to decompose the mission of
378
Definitions
Several error measurement terms are used in this paper for specifying accuracy requirements
and/or bombing errors. Definitions of each are given below. The error distribution is assumed to
be linear and normal (References 1,4,9, 10 and 17).
Standard Deviation (Sigma): The square root of the mean of the squares of the deviations (68.27% of all errors occur within the standard deviation limits of + or - 1 sigma for
a normal distribution).
Mean Deviation or Probable Error (PE): The sum of the absolute deviations divided
by their number. There is equal probability that the error will be either larger or smaller
than this value(50% of all errors will not exceed this value). Probable error is commonly
used to express weapon impact error.
Range Error Probable: The probable error measured along the range axis (along the
weapons flight path).
Deflection Error Probable: The probable error measured perpendicular to the weapons
flight path (cross axis).
Circular Error Probable: A two dimensional measurement of error defined as the radius of the circle for which 50% of the errors fall within its boundary. In practice, the
circle is centered at the true position of the target, which is equal to the mean in the absence of systematic errors.
319
References
1. Kayton, Myron and Fried, Walton, "Avionics Navigation Systems", John Wiley and Sons
Inc., New York, NY. 1969
2. Thompson, Dan and Schrank Michael, "Advanced Vehicle Management System Architectures Study", Digital Avionics Conference, October 1991, IEEE Proceedings.
3. Kelley, Ronald, "Integrated Inertial Networks", Joint Services Data Exchange Conference,
October 1992, JSDE Proceedings.
4. US Naval Oceanographic Office, "Navigation Dictionary", Pub. No 220, Washington, DC.,
1956.
5. Gault, Kenneth, et al, "Advanced Vehicle Management System Architecture Studies Final Re-
8. Bevington, J. E. and Marttila, C. A., "Precision Aided Inertial Using S A R and Digital Map
Data", IEEE Position Location and Navigation Symposium, IEEE Proceedings, 1990.
9. Greenwalt, C. R., "Principles of Error Theory and Cartographic Applications", Aeronautical
Chart and Information Center Technical Report No. 96, Feb. 1962.
10. Kelley, Ronald et al, "Integrated Inertial Network", WL-TR-94-1012, Volume 1, Final
Report, January 1994.
11. Martin, E. H., "GPS User Equipment Error Models," Journal of the Institute of Navigation, Vol. 25, No. 2, 1978.
12. SS-GPS-300, "System Specification for the NAVSTAR Global Positioning System"
13. SNU 84-1, "Specification for USAF Standard Form, Fit and Function Medium
Accuracy Inertial Navigation Unit", Aeronautical Systems Division, Air Force
Systems Command, Wright-Patterson AFB, OH, 28 February 1986.
17. Beck, G. R., et al, "GPS Exploitation for Precision Targeting Study Final Report"', WL-TR94-1068.
380
18. "Specification for Global Positioning System Integrated Navigation Assembly (GINA)",
Naval Command, Control and Ocean Surveillance Center, Warminster, PA.
19. SME-EGI-92, "Systems Requirements Document for an Embedded Global Positioning
System Receiver in an Inertial Navigation System (EGI)",Rev-2,20 January, 1994.
38 1
JOHN NIEMELA
DAVID F. LIANG
U.S.
OTTAWA, ONTARIO
FORT MONMOUTH, NJ
CANADA
USA
1. INTRODUCTION
Rotary wing aircraft have seen an ever expanding role in
support of land and sea military operations including:
search and rescue, scout, attack, troop transport, antisubmarine warfare, anti-surface ship targeting, cargo and
electronic warfare. They are ideally suited for operation
in confined and unprepared areas where no other form of
aerial transport is suitable.
382
3.0 fi/sec
383
6. ARCHITECTURE
384
interrupted o r lost.
In the complete absence of GPS, the INS performance
can be aided using Doppler velocity subsystem.
However, the INSlDoppler performance over the sea
depends on initial alignment; sea bias effects calibration;
as well as on the surface wind effects compensation.
For maritime military helicopter applications, the hybrid
navigation systems can provide the following additional
alignment capabilities:
385
8. CONCLUSION:
386
REFERENCES
[l] Coffee, J. N. "GPS - INS Integration Requirements
for Robust NOE Helicopter Navigation: american
Helicopter Society 47th Annual Forum, 6 8 May 1991.
387
Nap-of -the-Earth
Flight
Area
-5
i
-5
15
10
20
2s
f
-IZr - 3
N'--l
N
CPF
f
/
FIGURE 2:
388
N4-
I
I
I
-- -
- - - - ~ub-rurlaceContact Course
4
FIGURE 3:
Sonobouy
NM
Naullcal MI19
c=]
FIGURE 4 :
389
21
\ \
e 1.2
Z
l - 1
;0.8
LL
5 0.6
W
0.2
----.-
\ E/
1 '
VELOClTY
SITUATION
SENSOR
E+
VERTICAL
SITUATION
HDG REF
INDICATOR
POSITION
COWL
DATA LOADER
DlGlTAL DATA BASE
DISPLAY
ON/OFF
MOOING
RAD ALT
SENSORS
FIGURE 6:
PRDCESSlNG
390
1. S U M M A R Y
Spacecraftoperation depends upon knowledge of vehicular position and, consequently, navigational support has
been required for all such systems. Technical requirements for different mission trajectories and orbits are
addressed with considerationgiven to the varioustradeoffs
which may need to be considered. The broad spectrum of
spacecraft are considered with emphasis upon those of
greater military significance (i.e., near earth orbiting satellites.) Technical requirements include, but are not
limitedto,accwacy;physicalcharacteristicssuchas
weight
and volume; support requirementssuchaselecmcalpower
and ground support; and system integrity. Generic navigation suites for spacecraft applications are described. It
is shown that operational spacecraft rely primarily upon
ground-based tracking and computational centers with
little or no navigational function allocated to the vehicle,
while technology development efforts have been and
continue to be directed primarily toward onboard navigation suites. The military significance of onboard navigators is shown to both improve spacecraftsurvivabilityand
performance (accuracy).
2. INTRODUCTION
The diversity of space missions and spacecraft presents a
wide range of technical requirements, and it is useful to
consider requirements in terms of spacecraft types. After
a brief description of the space environment, spacecraft
will be categorized by mission characteristics and flight
regime. Flight trajectories are typically comprised of
some combination of powered flight, coast, and aerodynamic flight segments. Technical requirements fordifferent mission orbits will be presented and applicable navigation suites identified. A brief discussion of orbital
mechanics is included to introduce concepts and riomenclature related to orbital navigation.
Following a description of spacecraft classes and missions, technical requirements and figures of merit for
requirements specification are presented. With an understanding of the space environment, vehicle classes designed to operate within that environment, and technical
requirements, we will then be in a position to describe
state-of-the-artgeneric navigation suites for spacecraft
Finally, the relationship betwcen technical requirements
and generic navigation suites is characterized with tradeoffs considered.
3. SPACECRAFT
For most space missions, the spacecraft physical configuration changes at discrete time intervals during the mission as hardware is separated and jettisoned. Using an
example of boosting a surveillance sensor (the payload)
into earth orbit aboard a satellite, the final spacecraft
configuration consists of sensor and spacecraftbus where
the spacecraft bus provides support such as attitude con-
trol and electrical power for the payload. Initially, however, the spacecraft configuration as erected at the launch
pad is a stack consisting of launch vehicle, upper stage,
spacecraft bus, and payload. While the launch vehicle is
active, its effective payload consists of the upper stage,
spacecraft bus, and sensor. Similarly,afterlaunch vehicle
scparation and upper stage activation, the effective payload is spacecraft bus and sensor. Therefore, in this
example there are three vehicle configurations involved
with support of this single payload and, as we shall see,
navigation requirements and suites are considerably different among these vehicles. Prior to considering technical requirements and navigation suites for spacecraft, it is
useful to characterizethe space environment and vehicles
designed for space operation.
3.1 The Space Environment
39 1
During ascent, three redundant gimballed inenial measurement units (IMU) are used for navigation. Theat are
two orbital navigation methods depending upon whether
vehicle operation is powered flight or orbital coast. During coast, a ground uplinked state vector is propagated
forward in time with force models for gravity, aerodynamic drag, reaction control system jet firings, and waste
vents. In the presence of thrust, the navigation method is
switched to propagate the trajectory using accelerometer
data and a less sophisticated gravity model. Since aII state
vector data are derived from the IMU,disturbing acceleration models, and propagating the initial conditions, position accuracy degrades over time and groundderived
state vector data must be uplinked periodically. Scheduling of these uplinks depends upon the accuracy needed to
support the mission timeline and flight operations.
The reentry navigation suite consists of IMU,tactical air
navigation (TACAN). microwave scan beam landing system (MSBLS), and radar altimeter. Navigation aid usage
during descent and landing is shown by Figure 2. Shuttle
flight test has demonstrated an ability to detect TACAN
from low altitude orbit, and on-orbit navigation software
could be modified to incorporate this measurement type
onboard. There is also interest in integrating a Global
Positioning System (GPS)receiveronbaardShuttlewhich
could be used during both on-orbit and descent mission
phases.
SOURCE: Van Leeuwen. A. Rosen E.,and Carrkr L he Global IbsLtlOnSystem and Its
Appflcatbn fn SpQcecmj N a u Q a t W Navlgatlon. ION Global PoslUonlng System Papers. Vol. 1.
392
L-band
C-burd
15
10
Ku-band
I
20
I5
A l l i l U d s @In)
SOURCE:
ShutUo A "Ionla s
r.N A S A SP-504. 19BS.
J4;
SOURCE:
-&
Hock 5D-2*tern
Anatysh & p a t
RCA b h - E k r h h . May
1883.
393
P * a M
CIANRIEI
I wwunmu8
394
The enormous technological evolution in inertial navigation for aircraft. missile, and naval systems over the past
twenty-five years has had limited impact upon satellite
navigation because the orbital navigation problem is inherently different from these other navigation problems.
The basic goal of all non-orbital navigation problems is to
measure specific force (the non-gravitational accelerations) which is compensated for gravity effects and then
integratedto obtain velocity and integrated again to oblain
position. In the orbital navigation problem there are
essentially no specific forces acting on the vehicle (aunospheric drag, solar radiation pressure, and spacecraftgenerated effects are typically five orders of magnitude
smaller than gravitational effects), and the primary requirement is to characterize the complex gravitational
field including the effects of a non-spherical earth and
multi-body (e.g., earth, sun, and moon) interactions. In
their simplest forms, non-orbital navigation is a problem
of measurement whereas orbital navigation is a problem
of modeling. Hence, the need for significant digital
computationalresources is driven by the need for complex
onboard models.
Interplanetary spacecraft escape the earth gravity field
and travel into deep space for encounter with other planets
in the solar system. These vehicles are characterized by
extremely long mission durations which may exceed ten
years of continuous, non-serviceable operation at distances from the earth which can result in round trip
communication time delays measured in hours. During
the long interplanetary coast period, spacecraft orbital
dynamics are extremely low and ground-based tracking,
orbit determination/prediclion techniques are employed
using the Deep SpaceNetwork(DSN). From Figure6, the
DSN consistsof three complexesof tracking sites located
approximately 120 degrees of longitude apart to provide
worldwide tracking coverage. Spacecraftdesigns to date
have employed celestial, fixed attitude hold during interplanetary coast and inertial equipment used during other
mission phases such as descent and landing has been
turned off to conserveelectricalpower and extend operating life times. The purpose of the interplanetary missions
which have flown to date has been to acquire basic
scientific knowledgeoftheuniverseandthesevehiclesare
not directly relevant for military missions.
Descenf Md landing vehicles perform controlled de-orbit
from space and land on a planet or moon surface. These
vehicles use propulsion and aerodynamic surfaces to
control the descent trajectory during a combination of
maneuvering and coasting periods. Typically, these vehicles navigate with inertial navigation systems and radar
altimeters. Probably the most well known of this class of
vehicle is the Apollo Lunar Module. The mission profile
for the more recent landing of Viking on the surface of
Mars is shown by Figure 7.
Spacecraft return into the earth atmosphere at a known
time is sometimesreferred to as reentry. The reentry time
is noted and the vehicle will either impact theearth or burn
up in the atmosphere. Physical retrieval of a spacecraft
which has reentered and landed on the earth surface is
sometimes termed recovery.
U'
Descent Sequence
24
I
-.
48
226
40
47
46
395
3 3 Mission Orbits
Satellites operate in mission orbits selected to establish
and maintain an acceptable environment for the payload.
Orbital payloads perform data collection or data relay
missions. Meteorology, surveillance, and scientific mission payloads observe and collect data then transmit the
data to the ground segment for processing and analysis.
Payload data analysis and post-processing may require
precise orbit reconstruction using tracking data,extensive
force models, and more sophisticatet! data reduction techniques than those applied during the original orbit determination process used for prediction. For example, The
Ocean Topography Experiment (TOPEX) satellite mission (1334 km altitude and 63.1 degree inclination) will
carry a radar altimeter with subdecimeter accuracy. As a
goal, the precision orbit determinationprocess will incorporate data from global GPS ground terminals and an
onboard receiverwhich will be edited,calibrated,archived,
and processed to generate precision orbits using techniques such as tuning the gravity model U, fit the observation data.
receiver.
Figure 8 indicates orbits of interest for space missions.
Low earth orbit (LEO) is typically of low eccentricity,
high inclination, and altitudes less than lo00 km. Mid
Earth Orbit @EO) is usually with low eccentricity, mid
inclination,and altitudes between 10,000and20.000km.
GeosynchronousEarth Orbit (GEO) is nearly circular (ec
0.1, typically), low inclination (ic10 degree, usually and
often zero), approximately 40,OOO km altitude, and an
orbital period approximating one mean sidereal day (0.9
revolution/day In l 1.I revolution/day usually.) Molniya
orbits are typically highly elliptical orbits at mid-inclinations. Super SynchronousOrbits (SSO)are those above
40,000km and typically to 200,000 km. Earth escape
requires velocity in excess of 11.2 k d s . Of these, orbits
of military interest are primarily LEO,MEO,GEO,and
SSO.We introduce these orbits because both navigation
requirements and genericnavigation suites are sensitiveto
orbit characteristics.
396
3. ORBIT MECHANICS
Orbital mechanics is the study of trajectoriesand orbits of
space vehicles. Numerous books on the subject of orbital
mechanics have been published [e.g., Refs. 2-51 and
should be consulted for comprehensive development of
the topic including the derivation of equations. This
section is intended to introduce the basic kinematics of
elliptical trajectoriesas applied to satellites in Earth orbit
The ellipse orientation relative to an earth-centeredreferewe system can be specified with three angles (a,w, i) as
shown in Figure 9. These angles are the longitude of the
ascending node (a),
argumentof perigee (w), and inclination (i). Specification of three additionalconstantsrelated
to the size and shape of the ellipse and time provide a set
of six elements which completely specify the Keplerian
motion. Theseconstantsaresemimajoraxis(a,orbit size),
eccentricity (e, shape), and time of perigee passage (7).
r=
l+ecosf
M =n (t
-7)
= E - e sin E
tan(
i)=
i E t a n ( 5)
391
Wedefineperformanceparameletsasacc~y,operating
life, and computational loading. Accuracy is dependent
upon the functions which use the navigation state data.
For satelliles, navigation state data generally supports
functions which do not impose stringent accuracyrequirements such as magnetic momentum management, solar
array pointing, and mission data annotation. Table 2
illustrates functions which utilize satellite navigational
data in terms of both current functions performed by the
ground and space segmenu as well as future functions
which could be performed onboard. A wide range of
operating life exists for spacecraft. Launch vehicles may
operale for 10minutes while satelliteswith S-yearoperating life must function continuously for 43,830 hours, and
interplanetary spacecraft with a 10-year mission operate
for 87,660 hours.
S m t e l I I i ~collwm
-y
HL..lon &U
-- .
h l c n n a panlln#
UJUUnUldmd&.u
newly-launched
Design life
(NiCd)
160 w-hrkg
200 w-hr/kg
2 Y3 Y-
80 W-hr/kg (GEO)
15 W-hr/kg (GEO)
5 W -hr& (LEO)
30 W-hr/kg (GEO)
25 W-hr/kg (LEO)
5 Y-
(LEO)
2 Y W (LEO)
Fuel Cells
primary
-SUllOnLCpl~
- c-it
nycal
-- nenduvow
t n s l v c nuncuvrn
Specific power
110 W k g
Radiothermal generators (RTG)
Specific power
5 w/kg
Loaplum roorm.r1oa-
flfiw
Rsdtn U I C I I I l e
mentry locaitm
De-
L.LM
Secondary baueries
Energy density
(LiX, NAX)
(NiCd)
(Niw
lk m-um
M d m r ulcIIl18
hulth and S U t U .
Primary batteries
Energy density
(Agnn)
(LiSOCL2)
Design life
(Agnn)
(LiSOCL2)
lllh platform8
- Won-coopcraoVc
;
C
SOURCE:
R
C
~
NO!=:
1. LEO Low Eaflh O M
POWER SOURCE
Solar arrays
Specific power
Design life
CAPABILITY
2. Mass in kibgrane
3. Varklbm due lo wtit anitude and indinal'im
36 W/kg
IO years (GEO)
398
The natural environment imposes requirementson elecmnics and surfaces to withstand space radiation effects,
thermal extremes, and the vacuum of space. Space radiation imposes hardening (i.e. promtion of electronics
against radiation effects which can result in tempomy or
permanent device failure) requirements against total and
maximum dose exposures. Repeating sunlit and eclipse
conditions to which the satellite is exposed result in
significant temperature variations which must be accommodated Materials and coatings are effected by space
vacuum conditions.
The navigation suite must withstand the operating environment from launch through orbital operations. Launch
operationintroducessubstantialforcesandvibrationwhile
steady-stateorbital operations may impose field-of-view
and angular rate constmints on strapdown optical sensors
thus influencing device performance characteristics,
mounting location, and shading devices. Laslly, remote
satellite operation precludes repair and maintenance opportunity for all but a fraction of satelliteorbits limited by
the "reach-ability"of the Shuule.
Although requirements m y widely among missions and
vehicles, a set of ideal technical requirements for an
advanced,earth-viewingsatellite are postulated by Figure
I
I
12.
w
loo
POSITION ACCURACY
POWER
<
meters
< 20 warn
IO kilograms
<IO00 cu. in.
> I years
-5 10 45 deg C
> 10' rad-Si
MASS
VOLUME
LIFE EXPECTANCY
TEMPERATURE
RADIATION
GROUhT) SUPPORT
5 1 updaiehno.
navigation.
from routine orbit adjustment maneuvers (e.g., drag compensation, stationkeeping) to t i m e 4tical, responsive
maneuvers for threat evasion and collision avoidancemay
be required. Autonomous return U, normal operating
conditions following maneuver completion has implications on response time requirements to damp out the
maneuver effects on satellite attitude and rate.
(c) Intra-constellationdata-sharingmay be required. As
indicated earlier, this trend has been initiated by the U.S.
DoD GPS Block IIR program which intends to crosslink
navigation data among the satellites to enhance survivability.
(d) Navigation accuracy may have to be maintained
through conflict. This has historically been of concern for
satellites supporting strategic missions but as the boundary between strategic and tactical becomes less distinguishable, satellites supporting tactical missions may expect to encounter sophisticated threats during regional
conflicts.
399
4 3 Crew Requirements
400
AUTONOMOUS NAVIGATION
An orbital navigator is considered autonomous under the
following conditions:
earth,moon, and planets in the solar system. The ephemeris second is fixed by definition so ephemeris time is
theoretically uniform. The relationship between ephemeris and universal time is given as:
E.T. = U.T. + AT
where AT is a yearly increment provided in Reference 9.
Thus, the relationship between ephemeris time and sidereaVuniversal time must be determined empirically. Reduction formulae for conversions among these time systems are included in detail in Reference 10.
7. NAVIGATION SUITES
The two primary components of navigation suites are the
sensor complement and computationalprocessor. Generally, for ground-based navigation, both components are
located on the ground and similarly, for onboard navigation both are physically located onboard the satellite. One
exception is ground-based processing of optical data from
interplanetary spacecraft. As interplanetary spacecraft
approach a planet, optical sensors can image the planet
against the stellar background. This data is processed on
theground to estimate spacecraft flight path relative to the
planet.
The type of observation measured by the sensor is sometimes used to classify an onboard system as either autonomous or aided. Autonomous navigation relies upon measurement of naturally occurring phenomena such as lineof-sightto astronomical bodies. Aided navigatorsprocess
measurements from artificial sources such as GPS and
ground beacons. This concept has evolved primarily from
concerns of measurement denial and corruption which
could adversely effect navigation system integrity. A
formal definition for autonomous navigation is given by
Figure 14. Conceptually, the space to ground interfaces
among these techniques are shown by Figure 15. The
aided navigator shown in the figure assumes a navigation
satellite.
40 1
7.1.4 UplinkJDownlink
The ground system uplinks the predicted satellite navigational slateasatime-taggedstatevectororeqhemeris. The
frequency with which this must be performed is ondemand and depends upon the accuracy required so may
occur as often as several times per day or as infrequently
as once per month. For satellites with short passes over
transmitting ground stations, it may be necessary to limit
the amount of uplink data and ephemeris compression
techniques may beemployed. Additionally, commands to
fire thrusters may be uplinked to effect orbit maneuvers
such as drag adjustment and stationkeeping.
Onboard navigators estimate satellite position and velocity vectors in real-time based upon a set of initial conditions, an apriori system model, and a sequenceof external
observations of the navigation state. Conceptually, the
navigator consistsof two basic elements: state propagator
and measurementprocessor. Navigator inputs are a set of
initial conditions and sequence of measurements which
relate to the navigation state. The current estimate of the
state vector is the primary navigator output The basic
structure for the onboard satellite navigator is depicted by
Figure 17 Wef. 121.
--
750
LEO
YE0
GEO
7.13 Clocks
402
There are three existing satellite systems with navigational missions which provide radiometric measurements.
GPS provides one-way range and range-rate data and
broadcasts ephemeris data. TRANSIT provides rangerate data and broadcasts orbilal elements. These spacebased navigation systems were developed for terrestrialbased users, and transmitting antennas point toward the
earth. Therefore, these systems provide measurement
coverage for lower altitude satellites (h <20,000 km for
GPS and <loo0 km for TRANSIT). Past studies have
consideredGPSforsatellitesataltitudesabove20,000km
by receiving signals from satellites on the far side of the
earth as shown by Figure 18. The GPS signal structure
was developed to be tolerant of intentional and nonintentional interference,and signal features appear in the
literature Ref. 131. The DoD policy to phase in GPS as the
primary navigation aid and phase out TRANSIT and
TACAN systems discourage development of satellite
navigators dependent upon these systems.
403
Satellite navigation state is typically defined as inertiallyreference Cartesian position and velocity vectors. Although this particular state vector has a convenient interpretation in termsof the physical quantitiesof interest. the
state vector elements suffer from a wide dynamic range
due primarily to the central force gravity term. A satellite
at a IO00 km orbital altitude around the equator of a
sphericalearth will experience a variation off 7378 km in
position over the 100 minute orbital period and, correspondingly approximately f7.4 k d s in velocity. This
large dynamic range imposes a significant computational
burden on the state propagation technique by requiring
extremely small integration step sizes and a high level of
numerical accuracy.
The constrained natureof the on-orbit navigation problem
suggests the use of a state vector which is time-invariant
for undisturbed two-body motion. A set of six orbital
parametersdefinesthe motion of a satellite in its orbit. For
the special case of a true Keplerianorbit, these parameters
will be constants. In general, these time-varying orbital
parameters are functions of the perturbing accelerations.
8. TRADE-OFFS
The first trade-offinvolves determining whether naviga-
tional statedataisrequuedonboardthesatellite,and,ifso,
whether the data should be provided to the vehicle by
ground-based orbit determination techniques or onboard
navigation. Ground-based techniques offer advantages
for vehicle weight, power, volume, and complexity.
Onboard approaches offer advantages of autonomy, SUIvivability, and accuracy. Figure 19 [Ref. 1, Paper No. 241
shows the potential accuracy improvement with onboard
GPS navigation as compared with ground-based orbit
determination. This figure illustrates that ground-based
techniques achieve best performance in the 2,000 to
20,000km altituderegion. At loweraltitudesthecoverage
achievableby ground stations is limited and atmospheric
drag effects are most severe. At higher altitudes, there is
little change in geometry between the satellite and ground
stations.
Source: AGARD Tarsid *pplicetkmr
mc
SATELLITE W S I T O N
ACCURACY ACHIEVABLE
ON THE GROUND
BY SCN WITHIN THE
NEXTONE ORBIT
(ammaUy in the
in tradr direction)
MO
400
lo00 xxM3ooo
10.o00m,ooo40.o00
SATELLITE ORBIT ALTITUDE. km
404
I
I
References
1. AGARD Tactical Applications of Space Systems,
AGARD CP-460, October 1989.
2. Jerardi, T. W., Orbital Mechanics, Anthology, (undated).
405
407
SECTION VI
TEST METHODOLOGY
Coy L. Hunt
46th Test SquadrodEGTN
1644 Vandergrift Road
Holloman AFB NM 88330-7850
USA
6. TEST METHODOLOGY
6.1 Introduction
This section of the document describes the various methods
employed to evaluate the performance of aerospace navigation
systems. Included are discussions regarding test equipment, test
data, reference systems, environmental conditions, laboratory
tests, flight test profiles and procedures, and statistical methods
used to measure system performance. The test methods detailed in
this document are somewhat specific and may need to be adapted
to particular systems and their specifications.
6.1.1 Test System
The basic component of the test system is an inertial navigation
unit (WU) and may be integrated into a system utilizing a
multi-sensor configuration. All sensor components should include
their own monitoring units to facilitate real-time validation of
operational performance.
6.1.2 Data Acquisition System
The data acquisition equipment should be capable of recording
the necessary parameters output by the integrated system as well
as the navigation parameters from the individual sensors. The
required data parameters, sample rates, and timing requirements
are specified in Section 6.2.
6.1.3 Reference System
The requirements for reference system data acquisition equipment
are quite similar to those in Section 6.2.2 above. Additional
discussion related to the reference system is presented in Section
6.3.
6.1.4 Laboratory Test Equipment
The required laboratory test equipment includes test tables
capable of positioning the test system in any number of specific
orientations. Equipment capable of subjecting the test system to
various environmental conditions (vibration, heat, cold, humidity,
etc.) will also be required. Additionally, equipment for testing
Electromagnetic Interference (EMI) should be available.
6.2 Test Data
Test log data should include complete identification of the test
article and all test equipment and accessories as well as basic data
accuracies. The log data should include the actual test sequence
used, ambient test conditions recorded periodically during the test,
and performance data recorded periodically during the test.
Laboratory data should include as a minimum: ambient
temperature, humidity, latitude, longitude, altitude, cooling air
temperature, cooling air flow rates, and power. It is recommended
that aircraft data on temperature, humidity, vibration, cooling air
temperature, cooling air flow rates, and power be included to help
isolate system performance problems or anomalies. Performance
data should include, as a minimum, indicated position and
velocity components. As a minimum, the data recording rate for
408
Duration (minutes)
28
24
10
28
25
10
28
26
10
28
27
10
28
29
10
28
30
10
28
Duration (Seconds)
122
132
122
2.0
122
152
122
0.8
122
180
122
0.1
104
104
2.0
409
Frequency
Field
Modulation
10 kHz-25 MHz
Vertical
AM
25 - 200 MHz
Vertical
Pulse
25 - 200 MHz
Horizontal
Pulse
1 - 2 GHz
Horizontal-Vertical
Pulse
2 - 4 GHz
Vertical-Horizontal
Pulse
4 - 8 GHz
Horizontal-Vertical
Pulse
8 - 10 GHz
Vertical-Horizontal
Pulse
500MHz-1GHz
Horizontal
Pulse
Vertical-Horizontal
Pulse
Fore
Aft
Aft
Fore
Fore
Fore
Aft
Aft
410
Temperature
Soak (deg C)
Type Cycle
Relative
Humidity
71
Desert
0 - 50%
50
Desert
0 - 50%
50
Tropic
-40
Arctic
0 - 50%
Arctic
0 - 50%
91-100%
For each simulated flight, the system will be precision aligned and
placed in the navigation mode. The profiles for temperature,
altitude, relative humidity (tropic only), and vibration are shown
in figures 2 and 3. A tabulated description of the profiles is
provided in table 1. For each test, the system shall be provided
with cooling air at laboratory room ambient temperature (23
pludminus 10 degrees C). Cooling air will be turned on just prior
to system turn-on and turned off immediately after the system is
turned off.
65.7 Moving Base Alignment
This test will be performed to measure the effects of base motion
during gyrocompass alignment and the resulting effects on
navigation accuracy. The system will be mounted on a single axis
vibration table, temperature stabilized for 2 hours, and
gyrocompass aligned with a north heading. While in the
alignment mode, the table will be driven in the east-west direction
at a 1 Hz,2.54 cm peak-to-peak (equivalent to 0.05 g
(zero-to-peak) rate. An additional motion, a 2 cm step in 0.5
seconds, will be added 5 seconds prior to the completion of
alignment. At the completion of the alignment, the system will be
placed in the navigation mode for a period of 60 minutes. This
test will be repeated with an initial alignment heading of 180
degrees.
6.6 Flight Tests
6.6.1 Discussion
The goal of flight testing is to subject the test navigation system to
the type of flight environment which will be experienced when
the system becomes operational. This involves testing the system
in the various aircraft (cargo, fighter, helicopter) in which the
system is designed to be flown and in a manner which will
provide a meaningful indication of the systems performance
capabilities in both benign and dynamic flight environments. The
flight profiles and procedures detailed in the next four sections are
designed to determine the systems performance while being
subjected to realistic operational conditions.
6.6.2 Cargo Aircraji Flight Tests
The purpose of these tests is to determine navigation system
performance in both the aided and unaided modes of operation
during benign and dynamic flights. To satisfy the objectives, a
flight profile composed of medium (less than 5 gs) and low
dynamic (less than 2 gs) maneuvers will be used. This profile will
include maneuvers such as tight turns with changes in altitude and
benign straight-and-level flying. This flight test profile will begin
1.5
Hours
3.0
Hours
4.0
Hours
I. . . Aided
. . . . . .I. . . .Unaided
. . . . . . . .I . . . .Aided
..... I
I Maneuvers I CardinalHdg I Cardinal Hdg I
Land
41 1
412
6.8.2 Dejnitions
The statistical parameters most frequently used to quantify a
systems radial position and velocity errors are mean, standard
deviation, root-mean-square (RMS), geometric mean (GM), 50th
percentile (Circular Error Probable, CEP), and the 95th percentile.
The mean, standard deviation, RMS, and GM are computed using
simple algorithms. These are defined as follows:
T R i
Mean
i= 1
R =N
(1 1
413
c,
0
\
m
U
(D
0
0
0
cv
0
0
0
uj
Q,
>
Q,
-I
c
0
*
0
.-
c
a>
3
0
L
a,
LI
0
r
T-
O
0
0
>
0
U
I
(d
414
60
--
35
--
Arnbien?
--
ala
-U 0)
3LL
-0
U 0
12
-0
a -X
71
50
1 2
11 6 7 8
IO
I
T I M E (HINUTES)
+.. . . ..
I
U
0
al
I
3
U
al
c
E
al
I-
-25
Desert o r T r o p i c
- - - - - Arctic
. . . . . . . . .- Extreme
*Tropic Only
+
Uncontrol l e d
.>
0.02
d
-
-1
--
415
>
I-
rn
.04
Z
W
n
J
a~
= I
.02
t j xl'
w z n
v)
za
lo
-6 dB/OCT
-6 dB/OCT
15
1000
2000
Frequency (Hz)
T h i s l e v e l l e to b e r u n d u r i n g a l l v i b r a t i o n - o n t i m e s e x c e p t
T h i s level i s to b e r u n f o r f i v e m i n u t e s d u r i n g e a c h 5 , 0 0 0
ft. altitude segment of the flight profile (total test time
i s ten m i n u t e s f o r e a c h 8 - h o u r c y c l e .
416
Maneuver C h e c k p o i n t L o c a t i o n s
Checkpoint
6oooa
Longitude
Latitude
-106 15.8
-106 05.6
-106 05.6
-106 15.8
-106 09.8
-106 09.8
-106 12.0
-106 12.3
-106 12.0
-106.11-5
33
33
33
33
33
33
33
33
33
33
soooa
5
40000
moos
2000c
l00OC
- 1000(
I
-20000
I
- 10000
10000
20000
Meters
Figure 4 .
C a r g o M a n e u v e r Profile
13.8
13.8
00.0
00.0
13.8
00.0
12.3
08.5
05.2
02.0
417
2.8
.................. .....................................
...........
................... ......
2.4
.............. ...........
.................. .....................................
.........
280
................
-95%
.................. ..................................
......
.............................................
....................................p.v90g....... >.;
.....
................... ....................
.....................................
1.2
...........................................
. . . . . . . . .. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
.....
0.8
I
.... I
(
.....:................
.................. .....................................
.....
.......................
1
0,4
...........
. . . .i . . . .; . . .
......... ...................
1,6
....... ......
..................
..
...................
080
3
0.2
0.'4
0.6
0,'s
1 :o
GM/RMS
R A D I A L ERROR
1:2
418
419
Table 2.
TRK
POS
TRK A LT
DEG M S L
LONGITUDE
LATITUDE
KTAS MANEUVER
1A
153
-106 15.8
33 13.8
350
2A
180
150
-1 06 05.6
33 13.8
350
END TURN
3A
180
150
-106 05.6
33 00.0
350
4A
150
-106 15.8
33 00.0
350
END TURN
1B
150
-106 15.8
33 13.8
350
SA
180
150
-106 09.8
33 13.8
350
END TURN
6A
180
150
-106 OS.8
33 00.0
350
48
150
-106 15.8
33 00.0
350
1c
150
-106 15.8
33 13.8
325
58
180
150
-1C6 09.8
33 13.8
325
7A
270
150 *
-1 06 12.0
33 12.3
325
8A
90
1sO@
-106 12.3
33 0 8 5
300
9A
270
170
-1 06 12.0
33 05.2
275
10A
90
16043
-106 11.5
33 02.0
300
6B
180
150
-106 09.8
33 00.0
325
4c
150
-106 15.8
33 13.2
350
1D
Iso@
-106 15.8
33 13.8
353
28
180
17-
-1 06 05.6
.33 1 x 8
350
END TURN
38
180
18043
-1 06 05.6
33 00.0
350
4D
1go@
-1 06 15.8
33 00.0
350
END TURN
1E
200
-1 06 15.8
33 13.8
350
5C
180
200
-106 09.8
33 13.8
350
END TURN
6C
180
200
-1 06 09.8
33 00.0
350
4E
200
-106 15.8
33 00.0
350
1F
200
-1OG 15.8
33 13.8
325
5D
180
200
-106 09.8
33 13.8
325
78
270
200
-1 06 12.0
33 12.3
325
8B
90
2100
-106 12.3
33 08.5
300
9B
270
220
-106 12.0
33 05.2
275
420
Table 2.
TRK
POS
TRK ALT
DEG M S L
LONGITUDE
LATITUDE
KTAS MANEUVER
2100
-106 11.5
33 02.0
300
180
200
-106 09.8
33 00.0
325
4E
200
-106 15.8
33 13.2
350
1G
2 1 0
-106 15.8
33 13.8
350
2c
180
220@
-1 06 05.6
33 13.8
350
END TURN
3c
180
2 3 0
-1 06 05.6
33 00.0
350
4F
24w
-106 15.8
33 00.0
350
END TURN
1H
250
-106 15.8
33 13.8
350
5E
180
250
-106 09.8
33 13.8
350
END TURN
6E
180
250
-106 09.8
33 00.0
350
4G
250
-106 15.8
33 00.0
350
11
250
-106 15.8
33 13.8
325
5F
180
250
-1 06 09.8
33 13.8
325
7C 270
250
-106 12.0
33 12.3
325
8C
90
26-
-10612.3
33 08.5
300
9C
270
270
-106 12.0
33 05.2
275
1oc
90
26-
-10611.5
33 c2.0
300
6F
180
250
-10609.8
33 00.0
325
4H
250
-106 15.8
33 13.2
350
END TURN
1OB
90
6D
42 1
6.9 References
1. Mason, F.J. and Bodwell, C.A. Maximum Likelihood
Estimation of the Distribution of Radial Errors, Directorateof
Guidance Test, Air Force Missile Development Center,
Holloman Air Force Base, New Mexico, Working Paper
WP-MDSGA45-4, Rev 1 , l Oct 1969, DTlC &A950
316.
2. Air STD 53/16A, The Specification for Evaluation of the
Accuracy of Hybrid Navigation Systems, Air Standardization
Coordinating Committee, 6 April 1988.
1. Recipients Reference
2. Originators Reference
AGARD-AG-33 1
5. Originator
3. Further Reference
4. Security Classification
of Document
UNCLASSIFIED/
UNLIMITED
6. Title
9. Date
June 1995
various
10. AuthorsEditors Address
11. Pages
432
various
12. Distribution Statement
13. KeyworddDescriptors
Air navigation
Inertial navigation
Satellite navigation
Radar navigation
Multisensors
Rotary wing aircraft
Spacecraft
Space navigation
Doppler navigation
Magnetic navigation
Global positioning system
Integrated systems
Fixed wing aircraft
Kalman filtering
14. Abstract
The need for an up to date, comprehensive treatise on aerospace navigation systems has been
recognized by the navigation community. Such a document will serve as a lasting reference as did
previously published material prepared in the late 60s and early 70s. These earlier documents,
though remarkably prescient in their technical forecasts, have been overtaken by very rapidly
advancing technology.
It is anticipated that the target reader of this AGARDograph will be an individual who has
responsibility for the integration of navigation equipment aboard an aerospace vehicle. He may not
have, but is desirous of obtaining, an experts perspective on the capabilities and limitations of the
various navigation sensor and integration techniques.
The AGARDograph is organized into six sections with the initial section providing the motivation for
establishing the requirements to assure that the development of an aerospace navigation system will
meet its operational requirement. The second section of this document reviews navigation coordinate
frames with a discussion of inertial, terrestrial and geodetic coordinate systems. The third section of
the document describes the navigation sensor technologies that are employed in modem aerospace
navigation systems.
The fourth section of this document addresses system analysis and synthesis methods. Examination
and trade-off of the technology, for each sensing, processing and control and display element,
generates alternative preliminary designs. The fifth section of the document describes representative
state-of-the-art navigation system implementations in fixed wing, rotary wing aircraft and spacecraft.
The sixth and concluding section of the document describes the various test methods employed to
verify the performance of aerospace navigation systems used by NATO countries.
NATO
- @ ~OTAN
DIFFUSION
DES PUBLICATIONS
owl
AGENCES DE VENTE
NASA Center for
ESAnnformation Retrieval Service
The British Libran,
Aerospace Information (CASI)
European Space Agency
Vocumenl Suppl) 'Dnisiun
800 Elkridge Landing Road
IO, N e Mario Nikis
Boston Spa, Wctherby
Linthicum Heights, MD 21090-2934
75015 Paris
Wesl Yorkshire LS23 7BQ
Etats-Unis
France
Royaume-Uni
Les demandes de microfiches ou de photocopies de documents AGARD (y compris les d e m d e s faites aupks du C A S ) doivent
componer la dknomination AGARD, aiusi que le numtro de s6rie d'AGARD (par exemple AGARD-AG-315). Des informations
analogues, telles que le titre et la date de publication sont souhaitables. Veuiller noter qu'il y a lieu de specifier AGARD-R-nnn et
AGARD-AR-nnn lors de la commande des rapports AGARD et des rapports consultatifs AGARD respectivement. Des rftnnces
bibliographiqnes completes ainsi que des risumts des publications AGARD figurent dans les jouruaux suivants:
Scientific and Technical Aerospace Reports (STAR)
Government Repons Announcements and Index (GRAM)
publie par la NASA Scientific and Technical
publit par le National Technical Information Service
Information Division
Springfield
NASA Headquarters (JlT)
Virginia 22161
Washington D.C. 20546
Etats-Unis
Etats-Unis
(accessible Cgalement en mode interactif dans la base de
donnks bibliographiques en lime du NTIS, et sur CD-ROM)
~~~
~~~~~~
7 RUE ANCELLE
g22oo
NEUIC
FRANCE
AAG-
AGARD PUBLICATIONS
a tclefax to !
baddress giVfQ rbovs.
BELGIUM
coonlonnatmr AGARD-VSL.
de la Face aedieme
QuutiaRsiasBLislbcth
Rue dBvao.1140 Bm~.llea
!&t-lmjor
CANADA
Dirsctm Sdmitic Informston Suvias
Dqlf of N a t i d WulW
Ottawa, Ontario KIA OK2
DENMAXK
D.aisbDefsaoeRcscuchHstsblisbmnt
Es%t&Xt
P.O. Box 25
N-2Ol Kjellcr
!%%%%:
DK-2100 Copmhagsn 0
FR4NcE
ON.E&A. @inctiop!
29 Avmnc de la D i w m Lcdcn:
923aZchntilIon~
PORTUGAL
Foqa A k a Pmgncsa
SPAIN
INTA (AGARD Publications)
pintorRoslllcs34
21uylg Madrid
l1l1l