Aided Inertial Navigation in GPS

Aided Inertial Navigation in GPS-denied
Environments Using Synthetic Aperture
Processing
Prepared by:
J. Dillon
National Research Council Canada, Flight Research – Aerospace Portfolio
1200 Montreal Road, U-61, Ottawa, ON K1A 0R6
NRC MOU Annex Number: DND/NRC/AERO/2015-13
Technical Authority: Vince Myers, Defence Scientist
The scientific or technical validity of this Contract Report is entirely the responsibility of the Contractor and the contents do
not necessarily have the approval or endorsement of the Department of National Defence of Canada.
Contract Report
DRDC-RDDC-2016-C200
March 2016
© Her Majesty the Queen in Right of Canada, as represented by the Minister of National Defence, 2016
© Sa Majesté la Reine (en droit du Canada), telle que représentée par le ministre de la Défense nationale,
2016
Flight Research – Aerospace Portfolio
Aided Inertial Navigation in GPS-denied
Environments Using Synthetic Aperture
Processing
CR-FRL-2016-0034
March 2016
Authors/Auteurs : J. Dillon
FLIGHT RESEARCH LABORATORY
Aided Inertial Navigation in GPS-Denied
Environments Using Synthetic Aperture
Processing
Report No.: CR-FRL-2016-0034
Date: March 2016
Authors/Auteurs:
Classification :
For:
J. Dillon
Unclassified
DRDC Atlantic
Distribution :
Limited / Limitée
Reference:
Submitted by:
Approved by:
Jerzy Komorowski, General Manager
Pages :
23
13
Fig. :
Copy No :
Diagrams :
This Report May Not Be Published Wholly Or In Part Without The Written Consent Of NRC Aerospace Portfolio
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
ABSTRACT
The focusing of a Synthetic Aperture Radar or Sonar (SAR/SAS) provides a precise measurement of the
trajectory of the host platform over the length of the synthetic aperture. Although GPS is a widely used
navigation sensor for unmanned systems, many operations either occur or could potentially occur in GPSdenied environments such as hostile airspace or covert underwater operations. In this report, the position
measurement from an Inertial Navigation System (INS) is corrected using the integrated pulse-to-pulse
displacement from synthetic aperture correlation processing. Results were obtained using data collected
from a DRDC autonomous underwater vehicle operating in the Arctic during the 2014 Victoria Strait
Expedition. The performance of the SAS was compared with conventional Doppler velocity aiding to
evaluate the accuracy improvement of synthetic aperture aided navigation. While the motion estimate is
ideal for focusing an image over the length of the synthetic aperture (on the order of 10 m for SAS), this
precision does not necessarily translate into an improvement in long term navigation accuracy unless the
sensors are carefully aligned and calibrated.
CLASSIFICATION: LIMITED
NRC-CNRC
4
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
RÉSUMÉ
La focalisation d’un radar à synthèse d’ouverture ou sonar (SAR/SAS) fournit une mesure précise de la
trajectoire de la plateforme hôte sur toute la longueur de l’ouverture synthétique. Bien que le GPS
constitue un capteur de navigation largement utilisé pour les systèmes sans pilote, plusieurs opérations
sont menées ou pourraient prendre place dans des environnements sans service GPS, tel qu’un espace
aérien ennemi ou lors d’opérations sous-marines secrètes. Dans ce rapport, les mesures de positionnement
provenant du système de navigation par inertie (INS) ont été corrigées à l’aide du déplacement à
impulsions intégré résultant du traitement par corrélation des mesures d’ouverture synthétique. Les
résultats s’appuient sur les données recueillies à l’aide d’un véhicule sous-marin autonome de RDDC en
activité dans l’Arctique durant l’expédition dans le détroit de Victoria de 2014. La performance du SAS a
été comparée à celle d’un détecteur de vitesse Doppler conventionnel pour évaluer l’amélioration de
l’exactitude de la navigation avec un dispositif à ouverture synthétique. Bien que l’estimation du
mouvement demeure idéale pour focaliser une image sur toute la longueur de l’ouverture synthétique (de
l’ordre de 10 m pour le SAS), cette précision n’entraîne pas automatiquement une amélioration à long
terme de l’exactitude de la navigation, à moins que les capteurs ne soient soigneusement alignés et
étalonnés.
CLASSIFICATION: LIMITED
NRC-CNRC
5
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
Table of Contents
1.0
INTRODUCTION........................................................................................................................... 9
2.0
THEORY ....................................................................................................................................... 10
2.1
Principles of acoustic velocity logs ............................................................................................. 10
2.2
Sources of error ........................................................................................................................... 11
2.3
SAS motion estimation ............................................................................................................... 12
3.0
EXPERIMENT ............................................................................................................................. 13
3.1
2014 Victoria Strait Expedition .................................................................................................. 13
3.2
Arctic Explorer AUV .................................................................................................................. 14
3.3
AquaPix InSAS ........................................................................................................................... 14
4.0
RESULTS ...................................................................................................................................... 15
4.1
AUV deployment ........................................................................................................................ 15
4.2
DVL aiding ................................................................................................................................. 16
4.3
SAS aiding .................................................................................................................................. 17
4.4
Velocity integration .................................................................................................................... 18
5.0
DISCUSSION ................................................................................................................................ 19
6.0
CONCLUSION ............................................................................................................................. 21
REFERENCES .......................................................................................................................................... 21
CLASSIFICATION: LIMITED
NRC-CNRC
6
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
List of Figures
Figure 1: Displaced phase centre antenna. (Source: [13]) .......................................................................... 12
Figure 2: 2014 Victoria Strait Expedition search areas. (Map: Thomas Herbreteau/Canadian Geographic.
Source: G. Hobson [16]) ............................................................................................................................. 13
Figure 3: Deployment of the Arctic Explorer AUV during the 2014 Victoria Strait Expedition. (Photo:
Nick Walker [18]) ....................................................................................................................................... 14
Figure 4: AquaPix interferometric SAS with dual-row design for multipath suppression. (Source: [24]) . 15
Figure 5: Vehicle survey track relative to the dive location of N 6927’05” W 9933’18”. Approximately
10 minutes of pre-dive and post-surfacing motion are also shown. ............................................................ 16
Figure 6: Example SAS image from outbound survey leg showing a scour mark across an otherwise flat
sandy bottom. The actual seabed image is reversed left-to-right since the image was acquired from the
sonar array on the port side of the vehicle. ................................................................................................. 16
Figure 7: Latitude correction from GPS position measurement when vehicle surfaces after completing
mission plan with DVL-aided inertial navigation. The magnitude of the latitude correction was 16.3 m. 17
Figure 8: Longitude correction from GPS position measurement when vehicle surfaces after completing
mission plan with DVL-aided inertial navigation. The magnitude of the longitude correction was 24.6 m.
.................................................................................................................................................................... 17
Figure 9: Comparison of SAS and INS+DVL velocity time series during outbound survey leg. .............. 18
Figure 10: Comparison of SAS and INS+DVL velocity time series during return survey leg. .................. 18
Figure 11: Integration of velocity error in the body frame during the outbound survey leg. ...................... 19
Figure 12: Integration of velocity error in the body frame during the return survey leg. ........................... 19
Figure 13: Integration of velocity error in the body frame during the outbound and return survey legs. ... 20
CLASSIFICATION: LIMITED
NRC-CNRC
7
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
List of Tables
Table 1: RDI Workhorse Navigator 300 kHz DVL specifications ............................................................. 10
CLASSIFICATION: LIMITED
NRC-CNRC
8
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
1.0 INTRODUCTION
GPS and other satellite-based systems have been widely used for navigation due to their accuracy, low
cost of receiver equipment, and global coverage. Here, we use the generic term GPS to refer to global
satellite-based navigation systems such as NAVSTAR (USA), GLONASS (Russia) and Galileo
(European Union) [1]. However, these technologies are vulnerable to disruption by electromagnetic
interference and they are also ineffective for underwater navigation because electromagnetic waves are
strongly attenuated by seawater. For both civilian and military applications, one must therefore consider
the problem of navigation in a GPS-denied environment such as scenarios due to hostile actions
(intentional jamming, spoofing), inadvertent interference (unintentional jamming), signal blockage (inside
buildings) or operation of Autonomous Underwater Vehicles (AUVs) and submarines where GPS is
unavailable below the sea surface. Inertial sensing is another widely used technology for navigation
which has the advantage of being self-contained in the sense that no radio-navigation aids are required.
However, the position error of an INS tends to drift in the absence of input from an aiding sensor. For
inertial navigation to be effective without aiding measurements, the sensor must either be of an extremely
high quality, such as those used in nuclear-powered submarines where long-term covert operation is
essential, or the duration of navigation must be sufficiently short for accumulated errors to remain
acceptably small, as is the case with some types of missiles and guided weapons.
Several alternatives to GPS exist. For instance, the precursors to GPS navigation include aviation radionavigation aids such as beacons (VOR/DME) and LORAN, which require an extensive infrastructure
network and lack global coverage. Many vision-based or optical sensors are also in development,
especially for land vehicle and aerial applications [2]. However, optical systems tend to lack the allweather day/night coverage of GPS and other radio signals. Also, optical systems tend to have extremely
limited range in the ocean, even in the case where the vehicle provides its own illumination of the
environment in the form of lighting or laser scanning. For underwater applications, there are acoustic
positioning systems that consist of either a network of beacons on the ocean or a surface vessel that
transmits an acoustic signal to a vehicle below the surface. These systems effectively extend the range of
GPS by taking position measurements at the surface and relaying them to a receiver below the surface
using time-of-flight or time-difference-of-arrival techniques for localization [3]. However, there is a cost
associated with the time required to deploy and recover the beacons (or a cost of operating the support
vessel). The most successful combination for underwater navigation has therefore been to combine
inertial sensing with velocity measurement from an acoustic velocity sensor that measures speed from
echoes reflected from the seafloor [4].
Velocity sensors exploiting the Doppler principle have been widely used for both aviation (Doppler radar)
and underwater applications using a Doppler Velocity Log (DVL). For inertial navigation, position is
obtained by twice integrating the signals from linear accelerometers. An accelerometer bias therefore
causes a position error that grows quadratically with time. With velocity aiding, the position error growth
is reduced to a linear function. In other words, velocity aiding provides a navigation improvement but it
does not completely solve the problem of accurate navigation for missions of long duration.
The mission for many AUVs and Unmanned Air Vehicles (UAVs) consists of mapping the environment
using a high resolution sensor such as Synthetic Aperture Radar (SAR) or Synthetic Aperture Sonar
(SAS) [5]. The focusing of a SAR or SAS provides a precise measurement of the trajectory of the host
platform over the length of the synthetic aperture. In previous work, the synthetic aperture motion
estimate has been combined with inertial sensing to improve image focusing, especially for low frequency
systems with relatively long wavelengths [6], [7]. However, the synthetic aperture correction can also be
fed back to the vehicle navigation system in post-processing to improve the position measurement used
for image georeferencing [8]. In this report, the motion estimate from a high frequency synthetic aperture
CLASSIFICATION: LIMITED
NRC-CNRC
9
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
sonar is compared with data from a DVL-aided INS for an AUV operating below the surface in the
absence of GPS. The principles of acoustic velocity sensing and SAS motion estimation are outlined in
Section 2.0, followed by a description of the data collection in Section 3.0. Results are presented in
Section 4.0 followed by a detailed discussion in Section 5.0.
2.0 THEORY
2.1 Principles of acoustic velocity logs
Acoustic velocity sensors exploit the principle that seabed echoes from successive pulses are correlated
when two or more closely spaced pulses are transmitted. The majority of in-service acoustic velocity logs
exploit the Doppler principle, which is the frequency shift of the seabed or seawater echoes due to the
relative motion of the sonar. A typical DVL consists of four narrow beams steered in the fore/aft and
port/starboard directions to estimate the 3D velocity vector from Doppler shifts associated with each
beam. The beams are steered downward approximately 30 from vertical in a compromise between
operating near nadir to maximize seabed echo strength, while also requiring a non-zero Doppler shift
when measuring the horizontal component of velocity.
Another acoustic technology for underwater velocity measurement is known as the Correlation Velocity
Log (CVL). Originally proposed in the 1950s for use with radar, it was used with sonar with some
success in the 1970s. The fundamental concept is still best described in the words of the pioneers Dickey
and Edward [9]: “The objective, in the correlation system, is to transmit two identical signals separated by
a known time interval and then to search for a separation vector and a time delay for which the correlation
(of the received signal) is a maximum.”
A CVL transmits pulses vertically downward with a much broader beam than used for DVLs. The
reflected signal is recorded by two or more receivers separated by a few centimeters. Two variations
exist: a temporal log searches for the time delay that maximizes the correlation between a pair of
receivers, whereas a spatial log finds a receiver pair that maximizes the correlation for a fixed time delay
(typically the time interval between successive pulses). In either case, the velocity estimate is found by
dividing the known distance between receiver elements by the correlation time delay.
An important advantage of the CVL over the DVL is that the measurement of velocity in the plane of the
array (i.e., the horizontal component, in the absence of pitch or roll) does not depend on the speed of
sound [10]. By its principle of operation, a CVL measures a 2D displacement vector between two receiver
channels for successive pulses, so that the corresponding velocity measurement is given simply by the
displacement divided by the time interval between pulses, with no need for a sound speed measurement.
Table 1: RDI Workhorse Navigator 300 kHz DVL specifications
Bottom Velocity
Standard deviation at 1 m/s
Standard deviation at 3 m/s
Standard deviation at 5 m/s
Velocity bias
Long term accuracy
CLASSIFICATION: LIMITED
Value
0.4 cm/s
0.7 cm/s
0.9 cm/s
±0.2 cm/s
±0.4%
NRC-CNRC
10
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
2.2 Sources of error
The measurement from an acoustic velocity sensor consists of the true sonar velocity plus a measurement
error that is best modeled as a random variable. For example, the presence of electrical noise at the
receiver input introduces a random component in the echoes from successive pulses. In the ocean, there
can also be environmental noise in the frequency band of the sonar which can either be uncorrelated from
pulse to pulse, or correlated with a different time delay than the seabed echoes. At the relatively high
frequencies used by DVLs (>100 kHz), environmental noise is primarily due to thermal fluctuations in
the water column at the molecular scale [11]. Another source of error is due to the random distribution of
scatterers within the beam footprint. When the sonar is moving, the seabed echoes are recorded from
different spatial locations. Since the seabed echo is the sum of contributions from many scatterers within
the beam footprint, there is a pulse-to-pulse decorrelation that is well described by the van Cittert-Zernike
theorem from statistical optics [12]. Therefore, even in the limit of perfect receiver electronics, it is not
possible to eliminate the random nature of acoustic velocity measurements.
The statistics of the velocity error are usually described by specifying a single ping standard deviation
(e.g. assuming a zero-mean Gaussian distribution), a bias velocity, and a long term drift as a percent of
distance travelled. It should be noted that this description does not fully characterize the error distribution
because the bias and long term drift are typically time-varying with a mixture of random and deterministic
components. For example, one could specify a correlation time to model slowly varying errors as random
walks, or describe the power spectrum of velocity error by specifying standard deviations in a series of
frequency bands, or include directional information such as comparing the magnitudes of along track and
across track errors.
The measurement errors for a widely used DVL are specified by the manufacturer as shown in Table 1
[14]. If the velocity measurements were integrated directly (i.e., without an INS), the integration of the
single ping random error would result in a random walk position error that grows as the square root of the
integration time. However, in an aided INS, it is the accelerometer and rate gyroscope outputs of the
inertial sensor that are integrated to give position, velocity, and attitude, while the aiding measurement is
processed by a Kalman filter to correct the offsets of the inertial sensors. The single ping standard
deviation of the velocity aid therefore only affects the tuning and rate of convergence of the Kalman filter,
whereas the bias velocity and long term drift determine the position accuracy of the integrated navigation
system. For a vehicle travelling at 1.5 m/s, an accuracy of 0.4% of distance travelled corresponds to a
velocity error of 0.6 cm/s.
The bias velocity causes a position error that grows linearly with time independent of the motion of the
vehicle. The effect of the velocity bias can therefore be minimized by travelling quickly to make the bias
small relative to the vehicle speed. However, in practice, it is the long term error (percent of distance
travelled) that is the dominant effect. For example, using values in Table 1 for an eight hour mission, the
position error due to the bias velocity is 58 m. For comparison, if the vehicle speed is 3 knots, the long
term error as a percentage of distance travelled is 174 m. Therefore, for AUV survey missions, there is
only a small improvement in navigation accuracy when the survey speed is increased. The choice of
survey speed is dictated by hydrodynamic efficiency and operational requirements.
The long term error specified in terms of percent of distance travelled is typical of error sources that affect
the scale factor of the measurement. For DVLs, these include errors in the sound speed measurement,
uncertainty in the DVL beam angle, a bias caused by sloping terrain, and clock drift in the receiver
electronics [15]. Another source of across track scale factor error is a misalignment angle between the
INS and DVL, which is not a DVL error per se, but affects the position accuracy nonetheless. If the
misalignment angle 𝛿𝜓 is small, then the along track velocity error is proportional to (1 − cos 𝛿𝜓 ) ≈ 0,
whereas the across track error is V𝛿𝜓 where V is the vehicle forward speed. When integrated over time T,
CLASSIFICATION: LIMITED
NRC-CNRC
11
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
the across track error is VT𝛿𝜓 . In other words, the misalignment angle in radians translates directly into a
position error as a percentage of distance travelled.
Acoustic velocity sensors measure velocity in the body frame, e.g. along the forward and lateral axes of
the vehicle, whereas positioning is performed in a navigation frame such as North/East/Vertical or the
XYZ axes of an Earth-centered Earth-fixed frame. Therefore, velocity aiding relies on a heading
measurement from the INS to transform measurements between the body and navigation frame. The
navigation error due to heading is similar to the misalignment error described above. Heading error results
in an across track error that is proportional to distance travelled. Heading error is observable by the
Kalman filter when the vehicle is maneuvering with measurements available in the navigation frame (e.g.
with GPS) [1]; however, the heading error is unobservable when aiding is performed using body axis
velocity measurements only.
2.3 SAS motion estimation
The major challenge in synthetic aperture imaging is to estimate the platform trajectory with subwavelength accuracy (on the order of 0.1 mm for high resolution sonar). This accuracy requirement is
generally beyond the capabilities of inertial measurement technologies. The most effective technique for
SAS has been a data-driven approach based on the Displaced Phase Centre Antenna (DPCA) principle
[13]. The image is divided into a series of range segments and the Line Of Sight (LOS) displacement is
estimated from cross-correlation of the received echoes using overlapping phase centres from subsequent
pings, as illustrated in Figure 1. The figure illustrates ping-to-ping surge, sway and rotation of a SAS
array in the slant range plane with overlapping phase centres indicated by the shaded regions. Ping-toping rotation is measured by an angular rate sensor, and the LOS direction can either be determined from
platform altitude (assuming a flat seabed) or from an angle of elevation measurement using two vertically
displaced receiver arrays. The projection of the rotation vector in the LOS plane determines a
displacement correction that is required to accurately focus the image.
Figure 1: Displaced phase centre antenna. (Source: [13])
In DPCA processing, only the LOS displacement is sensed in each range window rather than resolving
both sway and heave because it is only the LOS displacement that is required for focusing the SAS image.
Dual-sided navigation allows sway and heave to be resolved using a simple geometric technique [19].
Kalman filtering has also been applied to DPCA measurements to improve the robustness of image
focusing [20]. A different approach is taken in the INSIGHT SAS processing software from Kraken Sonar
Systems [21] which uses an interferometric technique to sense the seabed slope in both along track and
CLASSIFICATION: LIMITED
NRC-CNRC
12
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
across track directions. The filter combines displacements, angular rate measurements, and seabed slope
information to derive a 3D velocity vector using the principles of Kalman smoothing [22]. Velocity
estimation is possible using a single-sided sonar configuration, which allows for real-time processing
where port and starboard data streams are processed independently. The velocity output from the SAS
provides a measurement that can potentially improve the accuracy of the platform navigation system.
For example, the Cramér-Rao lower bound of the DPCA sway measurement is given in [17]. Assuming
one overlapping phase centre (the minimum for ping-to-ping correlation), the velocity standard deviation
is
𝜎𝑣 =
𝜆
1
1
1
√ + 2
4𝜋𝑇 √𝐵𝑊 𝜌 2𝜌
(1)
where  is the acoustic wavelength, T is the pulse repetition interval, B is the bandwidth of the transmit
pulse, W is the sum of the durations (in seconds) of the DPCA range windows, and  is the signal-to-noise
ratio. For typical values of a 300 kHz SAS, (1) gives a velocity standard deviation of 0.002 cm/s, which is
more than two orders of magnitude more precise than the corresponding values for a 300 kHz DVL in
Table 1. It should be noted that the sway measurement of a SAS depends on a sound speed measurement,
e.g. through the acoustic wavelength 𝜆 = 𝐶 ⁄𝑓0 in (1), where C is the sound speed and 𝑓0 is the centre
frequency of the transmit pulse.
A SAS array can also be used to measure the along track ping-to-ping displacement [23]. The procedure
is entirely analogous to a one dimensional CVL array with a fully populated (non-sparse) array. The surge
displacement is obtained by cross-correlating overlapping phase centres and applying peak fitting
techniques (e.g. parabolic interpolation) to refine the estimate of the correlation peak location. As with a
CVL, the surge velocity measurement is independent of sound speed because velocity is calculated by
dividing a displacement along the array by the known pulse repetition interval.
3.0 EXPERIMENT
3.1 2014 Victoria Strait Expedition
Beginning in 2007, Parks Canada initiated a series of annual search expeditions that culminated in the
discovery of the wreck of HMS Erebus in September 2014. The 2014 Victoria Strait Expedition included
several Government of Canada departments and private organizations while showcasing the latest
technologies such as AUVs and synthetic aperture sonar. The 2014 search areas are indicated in Figure 2.
Figure 2: 2014 Victoria Strait Expedition search areas.
(Map: Thomas Herbreteau/Canadian Geographic. Source: G. Hobson [16])
CLASSIFICATION: LIMITED
NRC-CNRC
13
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
3.2 Arctic Explorer AUV
The Arctic Explorer is a 7.4 m long AUV manufactured by International Submarine Engineering in Port
Coquitlam, BC. Two vehicles were acquired by the Government of Canada for Project Cornerstone, a
Canadian effort to map the Arctic continental shelf under the auspices of the United Nations Convention
on the Law of the Sea (UNCLOS) [25].
The vehicle navigation payload consists of an iXSEA PHINS III inertial navigation system, a Teledyne
RDI Workhorse Navigator 300 kHz DVL, a Sound Ocean Systems GPS receiver (L1 band), a
Paroscientific depth sensor, and a Sonardyne ultra-short baseline (USBL) acoustic positioning system.
The USBL system was not used during the 2014 Victoria Strait Expedition. Therefore, on the surface,
position measurements were obtained from GPS, whereas while submerged, the positioning system
consisted of a DVL-aided INS. The PHINS unit includes a navigation Kalman filter to incorporate GPS
and DVL aiding measurements in real-time. Heading accuracy of the PHINS is specified as 0.02 secant
latitude while submerged, which equals 0.06 uncertainty at a latitude of 70.
Figure 3: Deployment of the Arctic Explorer AUV during the 2014 Victoria Strait Expedition.
(Photo: Nick Walker [18])
The Arctic Explorer vehicles are operated by the Atlantic research lab of Defence Research and
Development Canada (DRDC) on behalf of the Government of Canada. During the 2014 Victoria Strait
Expedition, the AUV was deployed from the polar research vessel One Ocean Voyager (registered name
Akademik Sergey Vavilov) as shown in Figure 3.
3.3 AquaPix InSAS
AquaPix is a wideband 300 kHz Interferometric SAS (InSAS) manufactured by Kraken Sonar Systems
featuring a dual-row design for multipath suppression [26]. A dual-sided AquaPix InSAS system was
purchased by DRDC and integrated into one of the Arctic Explorer vehicles. In Figure 3, the black
rectangle aft of the vehicle nose is the port-side InSAS installed in a free-flooding payload section, with a
second identical InSAS system installed on the starboard side. Prior to the 2014 Victoria Strait
Expedition, the vehicle and sonar were extensively tested during deployments from a jetty at the Bedford
Institute of Oceanography for a research project on repeat-pass interferometry [27], [28].
Each side of the InSAS consists of one transmitter module and four receiver modules, as shown in Figure
4. Each receiver module has a length of 53.3 cm, which is divided into 16 acoustic elements along track.
Included in each module (both transmitter and receivers) are two rows of ceramic elements that are
operated in distinct frequency bands. The short row (labelled “High Frequency” in Figure 4 is angled
down at a depression angle of 17.5 relative to horizontal, whereas the taller row (“Low Frequency”) has
a depression angle of 5.7. Each row surveys roughly half of the range swath of the sonar, with the short
CLASSIFICATION: LIMITED
NRC-CNRC
14
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
row covering a range of 2 to 5 times altitude and the tall row covering a range of 5 to 10 times altitude.
The centre frequency and bandwidth for each row are programmable in software. The bandwidth is
typically set to 40 kHz, resulting in a nominal range resolution of 1.9 cm. The short and tall rows are
operated at centre frequencies of 337 and 240 kHz, respectively, to ensure that seabed echoes from each
row do not interfere.
Figure 4: AquaPix interferometric SAS with dual-row design for multipath suppression. (Source: [24])
As shown in Figure 4, the four receiver modules are arranged in two rows of two modules. The vertically
separated modules form an interferometer that provides a precise measurement of the angle of arrival of
seabed echoes in the vertical plane. For example, cross-correlating the complex SAS images from each
row of modules results in measurements of seabed bathymetry.
4.0 RESULTS
4.1 AUV deployment
The Arctic Explorer AUV was deployed by crane from the deck of One Ocean Expedition as shown in
Figure 3 during the 2014 Victoria Strait Expedition. The mission chosen for analysis consists of AUV and
SAS data collected on September 5, 2014. Data recording for the SAS was initiated over a WiFi link
while the vehicle was on the surface. The vehicle track is shown in Figure 5, which consists of some
surface motion during mission configuration, a dive to an altitude of 25 m above the seabed (in water
depth of 38 m), an outbound linear segment of length 4 km, two 90 left turns, and a return linear segment
followed by surfacing. While submerged, the vehicle speed was 1.44 m/s. The outbound and return legs
were along true headings of 85 and 263, respectively.
The SAS data acquisition system logged sonar data continuously for the duration of the mission while
navigation data was recorded onboard the AUV. The sonar and vehicle systems operate asynchronously.
However, clocks were synchronized to within approximately 10 ms using an NTP time server onboard the
vehicle. Also, the DVL transmit pulse was triggered by the SAS to prevent interference (the 300 kHz
DVL is sufficiently broadband that DVL pulses would otherwise appear in the SAS data at 240 and 337
kHz). An example SAS seabed image is shown in Figure 6.
Measurements from sensors onboard the vehicle indicated a water temperature of -0.6C and a sound
speed of 1436 m/s. The sonar was programmed to transmit linear frequency-modulated pulses of duration
5 ms and bandwidth 40 kHz simultaneously from short and tall rows with centre frequencies of 337 and
240 kHz. A pulse repetition interval of 0.34 s resulted in a theoretical maximum range of 240 m.
CLASSIFICATION: LIMITED
NRC-CNRC
15
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
Figure 5: Vehicle survey track relative to the dive location of N 6927’05” W 9933’18”. Approximately
10 minutes of pre-dive and post-surfacing motion are also shown.
Figure 6: Example SAS image from outbound survey leg showing a scour mark across an otherwise flat
sandy bottom. The actual seabed image is reversed left-to-right since the image was acquired from the sonar
array on the port side of the vehicle.
4.2 DVL aiding
The PHINS inertial navigation system accepts and processes GPS and DVL measurements in real-time.
Navigation data recorded onboard the AUV therefore consisted of the aided INS outputs including
position, body velocity components, Euler angles and angular rates at a sample rate of 10 Hz. GPS
position measurements were also recorded at 10 Hz although position is only updated at 1 Hz by the GPS
receiver. Raw acceleration and DVL measurements were not available. While the vehicle is at the ocean
surface, GPS signals are received by an antenna located on a mast that protrudes above the water.
However, GPS availability is lost immediately when the vehicle dives below the surface.
During the submerged mission, the vehicle follows a pre-programmed set of waypoints using the DVLaided INS for navigation. When the vehicle surfaces at the completion of the mission, GPS reception is
regained and the navigation Kalman filter updates its position and error states based on the position error
between GPS and the inertial position, which may have drifted during the mission. The GPS
measurements and corresponding INS position correction during surfacing are shown in Figure 7 and
Figure 8. The time axis in Figure 7 and subsequent figures refers to the number of seconds since the time
when the vehicle dove to begin the mission.
CLASSIFICATION: LIMITED
NRC-CNRC
16
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
Figure 7: Latitude correction from GPS position measurement when vehicle surfaces after completing
mission plan with DVL-aided inertial navigation. The magnitude of the latitude correction was 16.3 m.
Figure 8: Longitude correction from GPS position measurement when vehicle surfaces after completing
mission plan with DVL-aided inertial navigation. The magnitude of the longitude correction was 24.6 m.
4.3 SAS aiding
SAS processing was performed for the port side data of the outbound and return linear segments resulting
in a sequence of images where each image covers an along track distance of approximately 50 m, as
shown in Figure 6. During processing, the images were focused using the DPCA principles outlined in
Section 2.3 with a three-dimensional velocity vector output for each ping. The DVL-aided inertial
velocities and SAS velocity components are compared in Figure 9 and Figure 10 for the outbound and
return legs, respectively. Surge refers to the forward component of the body velocity vector whereas sway
refers to the lateral component. The INS and SAS data sets are well synchronized and both sensors
measure similar vehicle dynamics. However, a small bias on the order of 1 cm/s is evident for both the
outbound and return legs.
CLASSIFICATION: LIMITED
NRC-CNRC
17
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
Figure 9: Comparison of SAS and INS+DVL velocity time series during outbound survey leg.
Figure 10: Comparison of SAS and INS+DVL velocity time series during return survey leg.
4.4 Velocity integration
In Figure 11 and Figure 12, the INS velocity data was interpolated to match the sample times of the SAS
velocity output. The resulting velocity error (SAS velocity minus INS velocity) was then integrated in
both the along track (surge) and across track (sway) directions. For both legs, the integrated sway error
was approximately linear with a slope of 0.8 cm/s for the outbound leg and 1.2 cm/s for the return leg.
In Figure 13, the integrated velocity error for each leg is transformed into the geographic frame using the
outbound and return heading angles as measured by the INS. For comparison, the GPS position correction
during surfacing (from Figure 7 and Figure 8) is also shown.
CLASSIFICATION: LIMITED
NRC-CNRC
18
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
Figure 11: Integration of velocity error in the body frame during the outbound survey leg.
Figure 12: Integration of velocity error in the body frame during the return survey leg.
5.0 DISCUSSION
The first observation to make is that the SAS data collected on September 5, 2014 was generally of a very
high quality. Due to the cold Arctic water temperatures, acoustic absorption was low, resulting in a high
signal-to-noise ratio across the entire swath. During the outbound and return segments, the vehicle motion
was stable, as expected for a large AUV operating below the surface. As a result, all of the SAS images
such as Figure 6 were well focused, which implies that the SAS motion estimation was measuring pingto-ping displacements with sub-wavelength precision.
The second observation is that the SAS velocity has exceptionally low measurement noise, as predicted
by the theoretical calculation in Section 2.3. Typically, the velocity measurement from a DVL or GPS
receiver is much noisier than the inertial velocity that is obtained by integrating the accelerometer and rate
gyroscope outputs. However, the inertial velocity tends to drift with time because of the unknown biases
on the accelerometer and gyroscope outputs. A navigation-grade INS such as the iXSEA PHINS would
typically have sensor biases on the order of 100 µg and 0.01/h for linear acceleration and angular rates,
respectively [1]. The navigation Kalman filter is therefore tuned to act like a complementary filter where
CLASSIFICATION: LIMITED
NRC-CNRC
19
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
the inertial measurement provides high frequency information and the aiding sensor supplies the low
frequency content. The Kalman filter tracks errors with a relatively slow time constant by making small
updates to the error states for each new aiding measurement that is processed [1]. The results of Section
4.2 demonstrate that if aiding information was supplied by the SAS, it would be possible to tune the
Kalman filter for faster convergence because each velocity measurement from the SAS has less noise than
the corresponding DVL measurement.
Figure 13: Integration of velocity error in the body frame during the outbound and return survey legs.
The time series of INS+DVL and SAS velocity in Section 4.3 show that the data sets are synchronized
and both sensors capture the oscillations in the vehicle dynamics. Small biases on the order of 1 cm/s
were observed between the SAS and the DVL-aided INS. When the velocity error was integrated, the
position correction did not move toward the GPS position correction when the vehicle surfaced. In fact,
integrating the SAS velocity actually moved the position 10 m away as shown in Figure 13. There are
several possible explanations.
The GPS update upon surfacing represents a correction to the errors accumulated during the entire
mission. In addition to the two survey legs, errors also accumulate during the dive, the two 90 turns, and
the surfacing maneuver, whereas the SAS processing only occurs during the straight survey legs. If the
raw inertial and DVL measurements were available, a more thorough analysis could be obtained by
reprocessing the data with a Kalman smoother [22] and propagating the effect of SAS velocity aiding
through the turning and surfacing maneuvers.
The GPS correction also includes an error due to the GPS measurement itself. At high latitudes, GPS
receivers suffer from dilution of precision due a reduced number of visible satellites. The effect of GPS
uncertainty could be reduced by using a GPS+GLONASS receiver, especially since the GLONASS
constellation is well suited for high latitudes. Also, the use of a dual-frequency L1/L2 receiver would
reduce the position error arising from the unknown propagation delay through the ionosphere [1].
Differential GPS processing using a fixed ground station would further improve the accuracy. With
carrier phase processing and dual-frequency receivers, accuracies on the order of 1 cm are typical.
In Figure 11 and Figure 12, the sway error is consistently negative and larger than the surge error. This
suggests misalignment of the SAS as a possible error source. When the vehicle is assembled, the INS and
DVL are carefully aligned by mounting both units in close proximity using a common structural element.
By comparison, the SAS is located several metres away from the INS using a mounting frame that is only
CLASSIFICATION: LIMITED
NRC-CNRC
20
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
linked to the INS via the fibreglass hull of the payload section. The average sway velocity error of 1 cm/s
would be induced by a misalignment angle of 0.4. DVLs are typically mechanically aligned to within
about 0.1 using alignment pins and the residual misalignment is estimated and corrected in postprocessing [15]. A calibration of the SAS alignment could be performed by surveying a common seabed
area from opposite directions and using image co-registration techniques to estimate the heading
misalignment. Calibration would also improve the accuracy of georeferencing when SAS pixels are
mapped to geographic coordinates during image post-processing.
In Figure 13, it is seen that the outbound and return errors tend to cancel because of the change in
direction of the vehicle body frame. In fact, this is one advantage of performing “lawnmower” survey
patterns. However, for the purpose of evaluating navigation accuracy, the ideal mission would consist of
long straight segments with surfacing for a GPS update at the end of each leg. The inertial data could be
reprocessed to simulate one long submerged mission by only applying initial and terminal GPS updates,
with the intermediate GPS measurements used to measure the rate of position error growth. A longer
mission results in a larger inertial position drift, so the effect of GPS position error becomes relatively
less significant.
As presently implemented, the SAS processor produces a velocity time series for each image, or roughly
every 30 seconds for a vehicle travelling at 3 knots. The main challenge for ping-to-ping processing is to
unwrap the phase of the DPCA correlation, which can be done robustly when an entire image is processed
at once. However, the results from DPCA ping-to-ping correlation could in principle be output as each
new ping is acquired, producing a velocity update with a latency of about 0.3 seconds for real-time
navigation.
6.0 CONCLUSION
The results of this study show that SAS processing produces a velocity time series with measurement
noise roughly two orders of magnitude lower than a DVL operating at a similar frequency. While the
DPCA motion estimate is ideal for focusing an image over the length of the synthetic aperture (on the
order of 10 m for SAS), this precision does not necessarily translate to an improvement in long term
navigation accuracy. To realize the full potential for SAS-aided navigation, sensor alignment and
calibration must be at least as accurate as the INS/DVL alignment. Recommendations for future work
include recording raw inertial measurements for post-processing and analysis, conducting long straight
survey legs with surfacing for a GPS update at the end of each leg, and developing robust ping-to-ping
DPCA software for real-time SAS-aided navigation.
REFERENCES
[1]
P. D. Groves, Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems.
Boston, MA: Artech House, 2008.
[2]
J. Collier et al., “Autonomous navigation and mapping in GPS-denied environments at Defence
R&D Canada,” Defence Research and Development Canada, Medicine Hat, AB, Canada, Tech.
Rep. NATO RTO-MP-SET-168, 2012.
[3]
B. Jalving and K. Gade, “Positioning accuracy for the HUGIN detailed seabed mapping UUV,” in
Proc. IEEE OCEANS, vol. 1, Nice, France, Sep. 1998, pp. 108–112.
[4]
H. J. Callow, P. E. Hagen, R. E. Hansen, T. O. Sæbø, and R. B. Pedersen, “A new approach to
high-resolution seafloor mapping,” J. Ocean Technology, vol. 7, no. 2, pp. 13–22, 2012.
CLASSIFICATION: LIMITED
NRC-CNRC
21
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
[5]
M. P. Hayes and P. T. Gough, “Synthetic aperture sonar: A review of current status,” IEEE J.
Ocean. Eng., vol. 34, no. 3, pp. 207–224, 2009.
[6]
M. Legris, M. Amate, and A. Hétet, “Navigation data fusion for low frequency synthetic aperture
sonar focusing,” in Proc. 7th Workshop on Underwater Acoustics (JASM’04), Brest, France, Oct.
2004, pp. 1–8.
[7]
W. Xu, F. Sun, and J. Li, “Integrated navigation for an autonomous underwater vehicle carrying
synthetic aperture sonar,” IET Radar Sonar Navig., vol. 6, no. 9, pp. 905–912, 2002.
[8]
R. E. Hansen, H. J. Callow, T. O. Sæbø, and S. A. V. Synnes, “Challenges in seafloor imaging and
mapping with synthetic aperture sonar,” IEEE Trans. Geosci. Remote Sens., vol. 49, no. 10, pp.
3677–3687, 2011.
[9]
F. R. Dickey and J. A. Edward, “Velocity measurement using correlation sonar,” in Proc. IEEE
Conference on Position, Location and Navigation, vol. 255, San Diego, CA, USA, Nov. 1978, p.
264.
[10] P. N. Denbigh, “Ship velocity determination by Doppler and correlation techniques,” IEE
Proceedings Part F, vol. 131, no. 3, pp. 315–326, 1984.
[11] G. M. Wenz, “Acoustic ambient noise in the ocean: Spectra and sources,” J. Acoust. Soc. Am., vol.
34, no. 12, pp. 1936–1956, 1962.
[12] R. Mallart and M. Fink, “The van Cittert-Zernike theorem in pulse echo measurements,” J. Acoust.
Soc. Am., vol. 90, no. 5, pp. 2718–2727, 1991.
[13] A. Bellettini, M. Pinto, L. Wang, and R. Hollett, “Synthetic aperture sonar micronavigation using a
gyrostabilized displaced phase center antenna,” NATO SACLANTCEN, La Spezia, Italy, Tech.
Rep. SR-378, 2004.
[14] Teledyne RD Instruments. (2013) Workhorse Navigator Doppler Velocity Log (DVL). [Online].
Available: http://www.rdinstruments.com/product/dvl/workhorse-navigator-dvl
[15] B. Jalving, K. Gade, K. Svartveit, A. Willumsen, and R. Sørhagen, “DVL velocity aiding in the
HUGIN 1000 integrated inertial navigation system,” Modeling, Identification and Control, vol. 25,
no. 4, pp. 223–236, 2004.
[16] T. Herbreteau. (2014) Victoria Strait Expedition search areas. [Online]. Available:
http://www.canadiangeographic.ca/franklin-expedition/assets/victoriastrait-expedition-map
[17] A. Bellettini and M. Pinto, “Theoretical accuracy of synthetic aperture sonar micronavigation using
a displaced phase-center antenna,” IEEE J. Ocean. Eng., vol. 27, no. 4, pp. 780–789, 2002.
[18] N. Walker. (2014) The Voyager crane lifts the AUV into the water on a four-hour test mission.
[Online]. Available: http://www.canadiangeographic.ca/franklin-expedition/search-focus-on-queenmaud-gulf-article.asp
[19] H. Schmaljohann, J. Groen, U. Hölscher-Höbing, and W. Jans, “Dual-sided micronavigation for
synthetic aperture sonar,” in Proc. Underwater Acoustics, Corfu, Greece, Jun. 2013, pp. 119–126.
CLASSIFICATION: LIMITED
NRC-CNRC
22
CR-FRL-2016-0034
Aided Inertial Navigation in GPS-denied Environments Using Synthetic Aperture Processing
[20] J. D. Campbell and J. R. Pearson, “A synthetic aperture sonar micronavigation Kalman filter,” in
Proc. Inst. Acoust. Int. Conf. SAS/SAR, vol. 28, no. 5, Lerici, Italy, Sep. 2006, pp. 183–190.
[21] D. Shea, D. Dawe, J. Dillon, and S. Chapman, “Real-time SAS processing for high-Arctic AUV
surveys,” in Proc. IEEE/OES Autonomous Underwater Vehicles (AUV 2014), Oxford, MS, USA,
Oct. 2014, pp. 1–5.
[22] A. Gelb, Ed., Applied Optimal Estimation. Cambridge, MA: The MIT Press, 1974.
[23] J. W. Oeschger, “Estimating along-track displacement using redundant phase centers,” in Proc.
Inst. Acoust. Int. Conf. SAS/SAR, vol. 28, no. 5, Lerici, Italy, Sep. 2006, pp. 160–167.
[24] A. N. Mirkin, J. DiCecco, and T. A. Merchant, “Operation of a synthetic aperture sonar from a
REMUS 600 autonomous underwater vehicle,” Naval Undersea Warfare Center, Newport, RI,
Tech. Rep. NUWC-NPT 13-013, 2013.
[25] T. Crees et al., “UNCLOS under ice survey – An historic AUV deployment in the Canadian high
Arctic,” in Proc. IEEE OCEANS, Seattle, WA USA, Sep. 2010, pp. 1–8.
[26] M. Pinto, “Interferometric synthetic aperture sonar design optimized for high area coverage
shallow water bathymetric survey,” in Proc. Underwater Acoustic Measurements, Kos, Greece,
Jun. 2010, pp. 1–7.
[27] J. Dillon and V. Myers, “Baseline estimation for repeat-pass interferometric synthetic aperture
sonar,” in Proc. 10th European Conference on Synthetic Aperture Radar (EUSAR 2014), Berlin,
Germany, Jun. 2014, pp. 1–4.
[28] J. Dillon and V. Myers, “Coherence estimation for repeat-pass interferometry,” in Proc. IEEE
OCEANS, St. John’s, Canada, Sep. 2014, pp. 1–5.
CLASSIFICATION: LIMITED
NRC-CNRC
23