Abstract
This article presents a navigation method for an autonomous underwater vehicle being recovered by a human-occupied vehicle. The autonomous underwater vehicle is considered to carry underwater navigation sensors such as ultra-short baseline, Doppler velocity log, and inertial navigation system. Using these sensors’ information, a navigation module combining the ultra-short baseline positioning and inertial positioning is established. In this study, there is assumed to be no communication between the autonomous underwater vehicle and human-occupied vehicle; thus, to obtain the autonomous underwater vehicle position in the inertial coordinate, a conjecture method to obtain the human-occupied vehicle coordinates is proposed. To reduce the error accumulation of autonomous underwater vehicle navigation, a method called one-step dead reckoning positioning is proposed, and the one-step dead reckoning positioning is treated as a correction to combine with ultra-short baseline positioning by a data fusion algorithm. One-step dead reckoning positioning is a positioning method based on the previous time-step coordinates of the autonomous underwater vehicle.
Keywords
Introduction
Currently, autonomous underwater vehicles (AUVs) are used to perform many ocean missions. Typically, AUVs perform missions that can last between 16 h and 24 h. Human-occupied vehicles (HOVs) have the ability to operate for a long time in standby in the open ocean and have a large capacity for carrying several AUVs; however, they are not suitable for long-range ocean exploration operations. In contrast, AUVs are suited for scouting in littoral seas. AUVs can perform some tasks that surface ships and HOVs cannot carry out conveniently and safely. The RAND company recommended the following seven mission categories for AUVs in a report in 2009 1 : mine countermeasures, missions to deploy leave-behind surveillance sensors or sensor arrays, near-land and harbor monitoring missions, oceanography missions, monitoring of undersea infrastructure, anti-submarine warfare tracking missions, and inspection/identification missions. A large-scale HOV equipped with AUV can carry out scientific inspection operations in a wider range and with higher efficiency, and it is of great significance for the detection of unknown hazards. An HOV can improve its overall capability by carrying AUVs; this has become a trend in HOV mission modes.
Rendezvous and docking between an AUV and HOV is the key technology for HOVs carrying AUVs. Many methods to recover AUVs and dock them with an HOV have been proposed, such as Watt et al.’s proposed method of an active dock robotic manipulator system (a quasi-independent third body). 2,3 Hardy and Barlow proposed a dry deck shelter recovery method. 4 Moody designed a recovery device in the torpedo tube of the submarine. 5 General Dynamics Electric Boat designed an SSGN Universal Launch and Recovery Module in the launch tube. 6 Kimball et al. demonstrated the applicability of autonomous docking in robotic exploration of sub-ice oceans; the vehicle can approach the dock from any direction. 7 Piskura et al. designed a line capture line recovery system, one of the key technologies in digital ultra-short baseline (DUSBL) navigation and homing. 8 Plueddemann et al. used the USBL navigation system during the recovery of an AUV in sea ice. 9
The navigation and location of an AUV is an important factor in the rendezvous and docking process, especially under the limiting conditions of underwater observation. Therefore, it is meaningful to consider accurate navigation methods during the rendezvous and docking process.
The different methods that are currently used for AUV navigation during the recovery process can be grouped into three categories: Inertial navigation: Inertial navigation uses gyroscopic sensors to detect the acceleration of the AUV, and it can be combined to obtain the Doppler velocity log to obtain a more accurate measurement. Combining this information with the attitude information measured by compass is an integral operation to obtain the vehicle’s track.
10,11
A problem with inertial navigation is that the navigation errors are accumulated. Acoustic navigation: Acoustic navigation uses acoustic transponder beacons to allow the AUV to determine its position. Acoustic navigation systems are generally classified by the length of the baseline, that is, the distance between the active sensing transponders. The most common acoustic navigation systems for AUV navigation are long baseline, which uses at least two widely separated transponders, and USBL.
10
Taking USBL positioning as an example, the AUV is equipped with a transducer that transmits a pulse interrogation signal to a transponder deployed in the HOV. The transponder, after receiving the interrogation pulse signal, transmits a reply pulse signal different from the interrogation signal. The calculation of the position within the system is based on the distance and azimuth of the transponder and the coordinates of the AUV relative to the position of the HOV in three dimensions. Batista et al. installed USBL on the nose of the AUV, and a sensor-based integrated guidance and control is proposed using the USBL positioning system.
12
Visual navigation: Visual navigation is divided into two methods. One is feature detection and image analysis, which exhibits high accuracy and successful detection of the sought points. However, the camera is also sensitive to many factors (turbidity, level of light), and the target should be in a line-of-sight condition. The other method is photocell light sensing, which also has a high accuracy but only in limited directions. The system is less complicated than feature detection and image analysis but also sensitive to similar factors.
13,14
However, each navigation method has its own inherent limitations, and so a single sensor may not be sufficient to provide a suitable navigation system. Therefore, it is preferable to use a number of sensors and combine their information to provide the necessary navigational capability. To achieve this, a multi-sensor data fusion (MSDF) approach can be used. MSDF is an information processing technology that has been rapidly developed in recent years. It integrates multi-sensor or multi-source information and data, resulting in more accurate and reliable conclusions. Khan et al. fused the USBL data with a particle filter estimate of dead reckoning, and the simulation and field experiments verify the performance of MSDF. 15
In general, MSDF provides significant benefits over single source data. The application of this technology can improve both the accuracy and robustness of the AUV navigation system and shorten the system response time. In data fusion, the weighted fusion algorithm is a mature fusion algorithm. Its optimality, unbiasedness, and minimum mean-square error have been proved in many research results. The problem with the weighted fusion algorithm is how to determine the weight, and the choice of weight directly affects the fusion result.
The article is organized as follows: The second section introduces the process of AUV recovery and navigation positioning. A method for conjecturing the velocity and heading of an HOV is presented in the third section. The fourth section presents a detailed description of the design of the navigation filter. The fifth section presents inertial navigation positioning based on the position of the previous moment fused with the USBL positioning data. The last part introduces the simulation experiment.
The process of docking and location
Generally, in order to simplify a docking mission, it is assumed that the HOV is traveling in a race track at a low velocity during the rendezvous process, which consists of two long straight track legs and two semicircle track legs as shown in Figure 1. Recovery can be thought of as taking place in three stages
16
: Initial stage. When the AUV reaches around the recovery area (at position A), it broadcasts the acoustic signals by the transducer. While the HOV receives the signal, it will travel along a fixed heading, and the execution stage is started. Execution stage. The AUV is moving from position A to A′. During this stage, the AUV captures the HOV position and uses the navigation data to control itself, thus reducing the distance between AUV and HOV by adjusting the proper position, speed, and attitude conditions for the recovery stage. Recovery stage. The AUV is moving from position A′ to B′. During this stage, the recovery operation is complete. This part is not in the scope of the research content of this letter.

Three stages of AUV underwater mobile recovery. AUV: autonomous underwater vehicle.
This study investigated the positioning method of stage 2, which is outside the range of vision location. Therefore, the positioning method should be selected between acoustic positioning and inertial positioning.
The principle of positioning is to measure the position of something relative to a certain point. In other words, we need to know at least two coordinates. With static repositioning as an example, generally, in the stationary docking process, the AUV locates itself through the USBL positioning system. The AUV position can be calculated by
where
The coordinates of the docking station are fixed values and are usually set as the origin of the coordinate system. The relative distance between the docking station and the AUV can be obtained through the USBL ranging system, so that the positioning of the AUV can be realized. However, in the process of an HOV recovering an AUV, it is not sufficient to measure the relative distance of them. The navigation system should acquire the position of the HOV to realize the positioning of the AUV. That means
In other words, the recovery process requires the AUV to obtain the coordinates of the AUV and the HOV at the same time. Underwater communication is not conducive to HOV concealment, and frequent underwater communication will increase the chance of HOV exposure. Therefore, this study was based on an assumption that during the recovery process, there is no communication between the HOV and AUV.
Equation (2) places the requirements of the position of the HOV; a new method is proposed to replace the underwater communication to obtain the HOV positions. As shown in Figure 1, during the docking process, the HOV undergoes uniform linear motion at a fixed depth. If the AUV knows the velocity and the heading of the HOV, the coordinate of the HOV could be obtained at any time step.
The process of obtaining the velocity and heading of an HOV is called a conjecture process; the details are described in the following sections.
The flowchart in Figure 2 illustrates the location process: The AUV arrives at the grounding point at the appointed time and receives a signal from the HOV’s single beacon (dock connection) to establish a temporary coordinate system. The conjecture process is started and the speed and heading of the HOV are calculated on the basis of the single beacon signal. After the calculated speed and heading are stable, the conjecture process is completed. The origin of the coordinate system is translated to the current AUV position (updated AUV coordinates) and the current position of the HOV is measured via USBL. One-step dead reckoning (OSDR) positioning is combined with the UBSL positioning method. After every 25 s, the speed and heading of the HOV are updated.

Flowchart of the location method process.
The conjecture process, USBL positioning, and OSDR correction are explained in detail in the following sections.
The conjecture process
The conjecture process is started at the same time as the execution stage. The AUV is equipped with a transducer that transmits a pulse interrogation signal to a transponder deployed in the HOV. The transponder, after receiving the interrogation pulse signal, transmits a reply pulse signal different from the interrogation signal. The coordinates of the AUV relative to the HOV are calculated at each cycle.
In the first conjecture process, an inertial coordinate
Under the coordinate system
Then, the heading of the HOV can be calculated by 17
where ηi and ξi are the coordinates of the HOV at ti and ψ is the heading of the HOV.
Then, the velocity of the HOV
Navigation filter
The location system implemented in this study was a combination of two independent Kalman filters (KFs) and a data fusion module, as shown in Figure 3. The USBL KF (referred to by the letter a) is responsible for estimating the position of the AUV

Proposed scheme of sensor fusion and sensor information.
After obtaining the AUV position by the UBSL positioning system, the obtained data should be filtered. In this study, considering the motion model of the AUV and HOV during recovery, a KF based on a simplified motion model is proposed. 18
As shown in the preceding discussion, in the recovery process, the HOV is constrained in a plane and moves in a straight line. In one pulse repetition period of the USBL positioning system, the AUV is considered to be at a constant speed. From the preceding conventions and assumptions, the relative motion between the AUV and HOV can be simplified to
where
The state vector is taken as
The corresponding covariance matrix is denoted as Pa.
The sensor input
From the state at time k − 1, the KF uses a vehicle model to predict the states at time k
where the state transition matrix
The time update of the equation of state is
Comparing the noise provided by the sensor
where
By processing the data of the compasses, gyro, and other sensors, and then converting the coordinates, the KF-b receives the position variation of the AUV, and it performs data processing to obtain a more accurate position variation.
The second KF has the same structure as that described previously, but with the superscript a replaced with b. The state vector is taken as
The corresponding covariance matrix is denoted as Pb and
The sensor input
OSDR correction
The OSDR correction improves the positioning accuracy by introducing the inertial correction data into USBL positioning. As shown in Figure 4, it is a data fusion process between USBL data and inertial correction data. However, the inertial correction data are not equal to those of the inertial navigation system. The OSDR is based on the fusion data, which is the AUV position at t − 1
where

Schematic diagram of OSDR. OSDR: one-step dead reckoning.
At time k, the AUV uses l sets of different sensors to measure independently and obtain l sets of measurement vectors
The measurement of variance matrix is
Then,
where
Before applying this method, the system and sensor should be analyzed in detail to obtain the correct weights. From equation (18), it is shown that weight and variance have a corresponding relationship in data fusion. However, the variance of dead reckoning is not a fixed value; according to the variance of the choice of different weights, a suitable variance model was established in this study.
The error of the USBL positioning is approximately 0.5–1.5% of its slant distance, and the dead reckoning error is approximately 0.7–1.3% of the vehicle voyage. 20 Thus, the error of the OSDR positioning is related to the dead reckoning error and the error of the previous fused data. Therefore, the variance model is shown as follows
where
According to the variance model
Simulations
This study carried out simulation verification through MATLAB and hardware-in-the-loop (HIL) simulation platform. Figure 5 shows the hardware architecture of the AUV HIL simulation platform. The planning-control computer, the USBL acoustic information processor computer, and the dead reckoning computer are the PC104 bus embedded multi-board system. The monitoring computer and dynamics simulation computer are PCs, which use Windows operating system, and receive and record the state information of AUV through network protocol and serial port protocol. Using microsoft foundation classes (MFC) as the development environment for the AUV recovery simulation system, the program of VEGA is embedded in the MFC document application framework. The visual simulation of HIL simulation is shown in Figure 6.

Architecture of the AUV hardware-in-the-loop simulation platform. AUV: autonomous underwater vehicle.

The interface of visual simulation.
In the MATLAB and HIL simulation, the algorithms and AUV model are same. The difference is that the time-step size of the MATLAB simulation is 0.5 s, and considering the computing power of embedded computer, the time-step size of the HIL simulation is set as 2 s. And the recovery path in simulation is shown in Figure 7. The coordinate system

AUV motion trajectory diagram. AUV: autonomous underwater vehicle.

AUV trajectory under different filtering methods: (a) AUV trajectory at axis ξ, (b) AUV trajectory at axis η, and (c) AUV trajectory at axis ζ. The blue line illustrates the true AUV position, the red line shows the KF of USBL positioning, the yellow line is the OSDR correction position, and the purple dotted line shows the data fusion of USBL and traditional inertial positioning. AUV: autonomous underwater vehicle; KF: Kalman filter; USBL: ultra-short baseline; OSDR: one-step dead reckoning.
The error of the OSDR correction method and that of USBL positioning and inertial positioning in MATLAB and HIL simulation are shown in Figure 9. The mean errors of each method in MATLAB and HIL simulation are shown in Table 1.

Error of different filtering methods: (a) the MATLAB simulation results and (b) the HIL simulation results. The blue line is the OSDR correction positioning error, the red line shows the error of the data fusion of USBL and traditional inertial positioning, the yellow line illustrates the KF of USBL positioning, and the purple dotted line shows the measurement error. KF: Kalman filter; USBL: ultra-short baseline; OSDR: one-step dead reckoning; HIL: hardware-in-the-loop.
Mean error and the percentage of different filter methods in MATLAB and HIL.
HIL: hardware-in-the-loop.
Conclusions and future research
In this article, we propose a method to conjecture the position of an HOV without communication between the AUV and HOV. The OSDR inertial positioning method is considered as a correction of the USBL position method, and their combination algorithm shows better navigation effects. The simulation showed that the accuracy of OSDR correction is better than using USBL positioning alone, and the mean error of OSDR correction is approximately 70.48% of the USBL positioning error. It is also better than the fusion of traditional inertial dead reckoning data with USBL positioning data. The error is approximately 77.05% of that of the fusion inertial positioning.
In future research, we aim to investigate some more complex scenarios involving time delay and a temporary loss of acoustic signal. Future work will also set a more realistic underwater acoustic noise model and compare the filter architecture suggested in this article with other architectures based on the extended kalman filter and particle filter.
Footnotes
Declaration of conflicting interests
The author(s) declared no potential conflicts of interest with respect to the research, authorship, and/or publication of this article.
Funding
The author(s) disclosed receipt of the following financial support for the research, authorship, and/or publication of this article: This work was financially supported by the National Natural Science Foundation of China (5160090347 and 51609047), National Key Research and Development Project (2017YFC0305700), Fundamental Research Funding of Harbin Engineering University (HEUCFM170106 and HEUCFJ180106), Qingdao National Laboratory for Marine Science and Technology (QNLM2016ORP0406), Postdoctoral Funding of China (2017M621250) and National Natural Science Foundation of China (51809064).
