Documente Academic
Documente Profesional
Documente Cultură
Submarine Navigation
John Moryl, Hugh Rice, and Stanley Shinners
Lockheed Martin Federal Systems, Inc.
Navigation and Gravity Systems
365 Lakeville Road, Great Neck NY 11020-1696
324
0-78034330-1/98/ $10.00 0 1998 IEEE
SYSTEMOVERVIEW required accuracy without the need for external “fixes”.
The interface with the ship navigation system can be
A typical submarine UGM configuration is shown in implemented using any existing high speed digital
Figure 1. As indicated, the UGM provides two primary interface, such as NTDS.
outputs: 1) Passive Navigation corrections to the ship’s
Inertial Navigation System (INS) for improved navigation The Terrain Estimation algorithm generates terrain data
accuracy, and 2) Terrain displays to an operator for ship which is sent to the UGM workstation for display. The
control and terrain avoidance. Inputs to the UGM include: UGM workstation provides the operator interface for
1) Navigation data from the ship navigation system, and displaying the terrain and for UGM control. The
2) UGM control/display commands from an operator. workstation can be dedicated to the UGM function or it
can be an existing workstation where the terrain displays
and operator controls are integrated with other submarine
UGM command and control functions. With the present UGM
design, an FDDI interface is utilized between the
workstation and the UGM electronics. However, other
interface types could easily be implemented in the interest
of compatibility with existing ship interfaces.
Navigation
Data GRAVITY
SENSOR
DESCRIPTION
---
As shown in the figure, the UGM equipment consists of a where i , j , k are unit vectors along the x, y, z axes,
gravity platform, an electronics cabinet, and a workstation respectively. Each component of the gravity vector , in
for operator inputs and terrain displays. The gravity turn, has a gradient:
platform contains the gravity sensors that provide the basic
data used for Passive Navigation and Terrain Estimation.
The gravity sensors are maintained in a local level
orientation by means of a three gimbal, gyro stabilized
platform. The UGM electronics cabinet contains data - - -
processors and other electronics for controlling the for n = x, y, z. The coefficients of the i , j , k vectors
platform gimbal motors and gravity sensors. The data constitute the nine element “gradient tensor”, where the
processors are used to: 1) compute gyro torquing signals tensor element rn, is the derivative of the nth component
for platform leveling; 2) compute gravity anomalies and
gravity gradients from the gravity sensor data; 3) perform of with respect to displacement in the mth direction.
the passive navigation and terrain estimation algorithms;
4) execute operator commands received from the UGM The gravimeter contains a high accuracy, vertically
workstation; and 5) support the digital interfaces with the mounted accelerometer which measures the specific force
ship navigation system, the gravity platform and the UGM along the vertical ( z ) axis. The accelerometer output is
workstation. first low pass filtered to remove the effects of sea state
motion. Instrument errors (e.g., biases, scalefactors,
The Passive Navigation algorithm generates estimates of misalignments) are then compensated for, based on prior
ship navigation errors which are sent to the ship navigation calibration data. A gravity measurement at mean sea level
system to correct the navigator. By providing continuous is then determined by applying compensations for the
corrections, the UGM allows the navigator to maintain effects of vertical coriolis (the Eotvos effect), submarine
325
depth offset from mean sea level, and low frequency platform, separated by 120 degrees when projected onto
vertical accelerations due to submarine depth changes. the horizontal plane. The local level platform (or inner
Compensation for the latter effect is achieved by filtering gimbal) is carouseled at a constant rate of 500 degkr in
and doubly differentiating depth gauge data. The gravity order to modulate accelerometer instrument errors. This
anomaly measurement is then determined by subtracting modulation allows separation of instrument errors from the
the ellipsoidal earth model gravity from the measured actual gradient signals which are slowly varying.
gravity . Gradients in the geographic frame (N,E,D) are derived
from the gradients in the instrument frame by appropriate
As shown in Figure 2, the gravity gradiometer [5] consists transformations.
of four accelerometers mounted on a wheel rotating at 1/4
hertz, with each accelerometer input axis tangential to the ALGORITHM
PASSIVENAVIGATION
wheel in the plane of rotation. The four accelerometers
are spaced at 90 degree intervals with an equidistant radius The Passive Navigation algorithm generates estimates of
( R ) from the axis of rotation. By suitable summing and ship navigator error by using gravity measurements,
differencing of the accelerometer signals, common linear digitally stored gravity maps, and data from the navigator
accelerations are canceled out, leaving gradients of gravity itself. These estimates are then used to correct the inertial
along the baselines of accelerometer pairs. In particular, it navigator on a continuous basis in order to bound
can be shown that the gradiometer output 6 is the navigation errors without the need for periodic external
following: fixes. The corrections can be applied in an open loop or
closed loop fashion. An illustration of the closed loop
configuration is shown in Figure 3. Here, the corrections
6 = (A, + A 3 )- ( A 2 + A 4 ) are used to continuously “reset” the navigator to maintain
required navigation accuracy. In the open loop
o = a[(r~~irn )sin 2e + rxycos 2e
1 configuration, corrections are only applied to the navigator
outputs. The open loop configuration has the advantage of
simplicity. However, the closed loop configuration takes
full advantage of the UGM capability by not only
With appropriate scaling and demodulation at the wheel bounding output errors, but also continuously estimating
rotation frequency, two gradient elements in a plane inertial instrument errors. In this case, a fully calibrated
perpendicular to the wheel axis of rotation (known as the navigator would be available in the event of a UGM
in-line and cross gradients) are generated by each equipment failure.
gradiometer.
Y
Sensor
Data Nav
Passive
- -
r
Navigation Inertial
Algorithm Navigator
326
observation is processed external to the Kalman filter with where r N D , r E D are the measured north, east components
the resultant corrections applied directly to the Kalman of gravity gradient with respect to the vertical and VN,VE
filter state vector. are the estimated north, east velocities. A Kalman filter
measurement is then computed as the difference between
The first observation type implements a gravity anomaly GD and the gravity anomaly measurement from the
map matching process. In this case, the observable is gravimeter. This difference contains the Eotvos error
expressed as
If gradient maps are available, a second type of The terrain estimation algorithm utilizes the gradient data
measurement can be used to implement map matching from the gradiometers, which are able to detect the gravity
using gradiometer data rather than gravimeter data. The field variations due to local terrain. By suitable processing
observables in this case are as follows of these signals, the TE algorithm generates a three
dimensional display of the terrain in the vicinity of the
submarine without active emissions. The gradiometers
measure the total gravitational gradient plus vehicle self
gradient and centripetal gradient due to inertial angular
rates of the platform carrying the instruments. Since the
where fiLjand rcRj are the measured in-line and cross self gradient and centripetal gradients are known to high
gradients, respectively, for the jth gradiometer and f i m j accuracy, they can be subtracted. The normal (ellipsoidal)
and r C R M j are the corresponding map derived quantities. earth gradients are also subtracted, leaving the anomalous
gradient due to terrain variations.
Gradient map data, which would normally be in
geographic coordinates, is converted into the gradiometer
instrument frame by appropriate transformation. Kalman In describing the algorithm, it is significant to note that the
filter modeling of this measurement is similar to the gravity gradients at a given position relative to known
method employed for measurement y l . terrain and geological variations can be computed
mathematically. Although these relationships are non-
A third observation type utilizes the fact that the linear, linear approximations can be used to high accuracy.
gravimeter signal contains vertical Coriolis acceleration This being the case, a Kalman filter implementation can be
(the Eotvos effect) while the gradiometer signals are free utilized, where the modeled states represent errors in the
of this effect. In this case, a gravity anomaly measurement estimated terrain. Inputs to the Kalman filter include
is first derived from gradiometer data as follows: gradient innovations, computed as the difference between
the measured gradient of the actual terrain and the
GD= /& v ~ d ti- / T E D v ~ d t predicted gradient at the vehicle position based on the
327
estimated terrain. A terrain estimate is continually dimensional Algebraic Gravity Model [6]) has been found
updated based on the error estimates generated by the to be appropriate for the points in each shell:
Kalman Filter. An illustration of this algorithm is
provided in Figure 4.
Measured V D’
where:
E(hl,hz) = Cross covariance of terrain height at
points 1 and 2
vh = Variance of the terrain height
DN,DE = North, East distances between points
1 and 2
D = Correlation distance for terrain.
328
the Passive Navigation algorithm and to record test results. ESGN navigator configuration described previously.
Gravity maps derived from NAVOCEANO survey data
with one nautical mile grid spacing were utilized. In order Position errors for a typical 200-hour run obtained with the
to avoid affecting tactical operations, all testing was GPN on the USNS Vanguard are shown in Figure 5.
conducted using an open loop configuration with no Performance with and without the Passive Navigation
feedback of Passive Navigation algorithm corrections to algorithm applied is shown for comparison. The inertial
the ESGN. Performance was evaluated by comparing the system was calibrated and aligned dockside prior to the
velocity outputs to those obtained from GPS and sonar start of the run. Since the data is classified, results are
fixes. Testing of this configuration was performed on the expressed as a percentage of the 14 day SSN navigation
USNS Vanguard Navigation Test Vehicle (NTV) and on requirement. As shown in the figure, position errors
two SSBNs. The results shown are a composite of four without passive navigation corrections applied quickly
NTV test periods and four SSBN test periods. Tests were build up to levels that exceed the SSN requirement, while
conducted in areas having gravity features ranging from the errors are bounded continually at levels well below the
benign to active. A significant improvement in velocity SSN requirement with passive navigation. The ship's
performance is shown, with east velocity showing the track for this test covered both benign and active gravity
most improvement. regions. The rms velocity error during this test was
reduced from a level of 85 % of the SSN requirement to
Test North East about 50 % of this requirement. The improvement in
Vehicle Velocity Velocity latitude performance is primarily attributed to observation
NTV I 0.73 I 0.62 type 1 while the improvement in longitude is due to a
SSBN I 0.91 I 0.77 combination of observation types 1 and 3. Velocity errors
are reduced by a combination of observation types 1 , 3 and
Table 1. Passive Navigation Velocity Error Reduction 4.
for ESGN Navigator
329
Meters
25.8
SUMMARY
The authors wish to thank Mr. Ken Savage, Mr. John 25.4
Schaefer, Mr. Warren Diamond and Mr. Philip Schachter
of SP24AJS.N for their support and assistance in
facilitating the development and test of the UGM as well
as sponsorship of earlier gravity based programs.
-77.6 -77.4 -77.2 -77.0
Longitude Eleuthera
Figure 7. Terrain Estimation for Northeast
Providence Channel
330
REFERENCES [4] White, J. and Jircitano, A., “Gradiometer Based
Terrain Estimation,” U.S. Patent No. 5,402,340,
[ 13 Moryl, J. “Advanced Submarine Navigation March 1995
Systems,” Sea Technology, Vol. 37, No. 11, [5] Hofmeyer, G. and Affleck, A., “Rotating
November 1996 Accelerometer Gradiometer”, U.S. Patent No.
[2] Metzger, Ernest H., “Development Experience of 5,357,802, October 1994
Gravity Gradiometer System,” IEEE PLANS 82 161 Moonan, P. J., “A Stochastic Model For Anomalous
Symposium Proceedings, December 1982 Gravity With Application To Gradiometer-Aided
[3] Jircitano, A. and Dosch, D., “Gravity Aided Inertial Navigation Systems And Trajectory Analysis”, AIAA
Navigation System (GAINS),” ION 47* Annual Guidance and Control Conference, August 1980
Meeting Proceedings, June 1991
331