Maximum A Posteriori estimation for AUV localization with USBL measurements

This paper presents the integration of an Ultra Short Base Line (USBL) acoustic modem and positioning device in a two-parallel Extended Kalman Filter (EKF) multisensor navigation schema for an Autonomous Underwater Vehicle (AUV). The system consists of a first odometric EKF position estimator fed with the measurements provided by an Inertial Measurement Unit (IMU), a Doppler Velocity Log (DVL), a visual tracker and a pressure sensor, and a second corrective EKF that fuses the previous sensors with the Global Positioning System (GPS) and the corrected delayed-state Ultra Short Base Line (USBL) position data. The first filter is aimed to compute a highly reliable vehicle position estimation from the sensor suit that produces high frequency relative navigation data. This estimation is essential to correct the delay of the USBL position measurements. The objective of the second filter is to give the vehicle a global pose, eliminating the drift inherent to dead-reckoning sensors by integrating absolute positions (GPS and USBL) provided at low frequencies. The effects of the USBL integration in the global localization module are evaluated in a simulated environment, and compared to a ground truth trajectory with the pose estimates given by the first EKF, the USBL raw data and the output of the second EKF, showing an effective reduction of the trajectory error.

This paper presents an acoustic localization system for small and low-cost autonomous underwater vehicles (AUVs). Accurate and robust localization for low-cost AUVs would lower the barrier toward multi-AUV research in river and ocean environments. However, these AUVs introduce size, power, and cost constraints that prevent the use of conventional AUV sensors and acoustic positioning systems, adding great difficulty to the problem of underwater localization. Our system uses a single acoustic transmitter placed at a reference point and is acoustically passive on the AUV, reducing cost and power use, and enabling multi-AUV localization. The AUV has an ultra-short baseline (USBL) receiver array that uses one-way travel-time (OWTT) and phased-array beamforming to calculate range, azimuth, and inclination to the transmitter, providing an instantaneous estimate of the vehicle location. This estimate is fed to a particle filter and graph-based smoothing algorithm to generate a consistent AUV trajectory. We describe the complete processing pipeline of our system, and present results based on experiments using a low-cost AUV. To the authors' knowledge, this work constitutes the first practical demonstration of the feasibility of OWTT inverted USBL navigation for AUVs.

Autonomous underwater vehicle (AUV) navigation and localization in underwater environments is particularly challenging due to the rapid attenuation of Global Positioning System (GPS) and radio-frequency signals. Underwater communications are low bandwidth and unreliable, and there is no access to a global positioning system. Past approaches to solve the AUV localization problem have employed expensive inertial sensors, used installed beacons in the region of interest, or required periodic surfacing of the AUV. While these methods are useful, their performance is fundamentally limited. Advances in underwater communications and the application of simultaneous localization and mapping (SLAM) technology to the underwater realm have yielded new possibilities in the field. This paper presents a review of the state of the art of AUV navigation and localization, as well as a description of some of the more commonly used methods. In addition, we highlight areas of future research potential.

Autonomous underwater vehicle (AUV) navigation and localization is crucial and challenging in Global Positioning System-denied environments. AUV carrying synthetic aperture sonars (SASs) can provide precise motion estimation of the platforms. This study focuses on enhancing the performance of AUV localization using dual-sided SASs. The two-dimensional velocities of AUV are estimated using dual-sided SAS echoes. An extended Kalman filter (EKF) is then adopted for dead reckoning using the estimated velocities. The experimental results demonstrate that the proposed method has better localization accuracy than that of the Doppler velocity log (DVL).

The primary objective of this work is to solve the problem that the long baseline (LBL) positioning system has poor real-time positioning results during the navigation for autonomous underwater vehicles (AUVs). In this paper, it is proposed to use the unscented Kalman filter (UKF) to enhance the navigation and positioning accuracy of the AUV, using the speed information measured by the Doppler Velocity Log (DVL) and the ranging information obtained by the acoustic beacons. Utilizing the unscented transformation to perform integrated navigation, it can avoid linearization truncation errors and Jacobi matrix computation compared with extended Kalman filtering (EKF). The experimental results verify that in the multi-beacon aided AUV integrated navigation system, compared with the conventional LBL and EKF, UKF provides more stable and accurate position information in real time.

The carrier and code phases tracking is the central work of Global Position System (GPS) receivers. A number of algorithms have been developed to improve the performance of the receivers in tracking the carrier and code phase in challenging environments, such as the Extended Kalman Filter (EKF) and the Unscented Kalman Filter (UKF). This paper uses GPS software receiver to implement the algorithms, provides details about the implementation, deeply compares the two different methods and takes into consideration different numbers of measurements. To evaluate the performance effectively, some criterions to compare these two algorithms are proposed. The results show although both algorithms have satisfying performance in tracking weak signals, the UKF exceeds in some aspects. The results also indicate that algorithms with more measurements in the measurement model could track the signals more accurately, but the outperformance becomes less obvious when the number of measurements surpasses certain threshold.

High dynamic aircraft is a very attractive new generation vehicles, in which provides near space aviation with large flight envelope both speed and altitude, for example the hypersonic vehicles. The complex flight environments for high dynamic vehicles require high accuracy and stability navigation scheme. Since the conventional Strapdown Inertial Navigation System (SINS) and Global Position System (GPS) federal integrated scheme based on EKF (Extended Kalman Filter) is invalidation in GPS single blackout situation because of high speed flight, a new high precision and stability integrated navigation approach is presented in this paper, in which the SINS, GPS and Celestial Navigation System (CNS) is combined as a federal information fusion configuration based on nonlinear Unscented Kalman Filter (UKF) algorithm. Firstly, the new integrated system state error is modeled. According to this error model, the SINS system is used as the navigation solution mathematic platform. The SINS combine with GPS constitute one error estimation filter subsystem based on UKF to obtain local optimal estimation, and the SINS combine with CNS constitute another error estimation subsystem. A non-reset federated configuration filter based on partial information is proposed to fuse two local optimal estimations to get global optimal error estimation, and the global optimal estimation is used to correct the SINS navigation solution. The χ 2 fault detection method is used to detect the subsystem fault, and the fault subsystem is isolation through fault interval to protect system away from the divergence. The integrated system takes advantages of SINS, GPS and CNS to an immense improvement for high accuracy and reliably high dynamic navigation application. Simulation result shows that federated fusion of using GPS and CNS to revise SINS solution is reasonable and availably with good estimation performance, which are satisfied with the demands of high dynamic flight navigation. The UKF is superior than EKF based integrated scheme, in which has smaller estimation error and quickly convergence rate.

The extended Kalman filter (EKF) has been used widely in Global Position System (GPS) and Strapdown Inertial Navigation Systems (SINS) integrated navigation systems,which simply linearizes all nonlinear models.However, careful treatment of the nonlinearity of the system models is particularly critical when the integrated systems use low cost micro-electro-mechanical (MEMS) inertial sensors. Hence application of the EKF in MEMS inertial sensor-based integrated navigation systems will likely lead to inaccurate results. To overcome the shortcomings of the EKF, the unscented Kalman filter (UKF) has been proposed.The UKF does not require the linearization of the system models. Alternatively it uses a set of deterministically selected "sigma-points",which completely capture the true mean and covariance of the original random vector. Then these sigma-points are propagated through the nonlinear models.This captures the mean and covariance to second order accuracy for arbitrary nonlinear functions. In this paper the EKF and UKF are applied in GPS/SINS integrated systems respectively. Simulation result demonstrates that the performance of the UKF is better than the EKF in MEMS inertial sensor-based SINS/GPS integrated systems.

Achieving accurate navigation and localization is crucial for Autonomous Underwater Vehicle (AUV). Traditional navigation algorithms, such as Extended Kalman Filter (EKF) and Unscented Kalman Filter (UKF), require the system model and measurement model for state estimation to obtain the AUV position. However, this may introduce modeling errors and state estimation errors which will affect the final precision of AUV navigation system to a certain extent. To avoid these problems, in this paper, we proposed a deep framework - NavNet - by taking AUV navigation as a deep sequential learning problem. Firstly, the proposed NavNet can take raw sensor data at different frequencies as input, which benefits from the sequential learning capability of Recurrent Neural Network (RNN). Secondly, NavNet takes advantage of a simplified attention mechanism and Fully Connected (FC) layers to output AUV displacements per unit time, which accomplishes low-frequency AUV navigation by accumulation of it. More importantly, there is no need for the model building and state estimation with NavNet, which avoids the import of relevant errors. We compare the performance of NavNet to EKF and UKF using collected data by running Sailfish in the sea. Experimental results show that NavNet has an excellent performance in terms of both the navigation accuracy and fault tolerance. In addition, a reliable fusion strategy of NavNet and conventional method is applied to achieve high-frequency AUV navigation. The experimental results show that the proposed architecture can be a reliable supplement to limit the error growth of conventional algorithms.

Hybrid model navigation method for autonomous underwater vehicle

Research on position correction method for AUV large depth navigation based on ranging positioning

In underwater navigation, the global positioning system is unavailable; hence, other solutions must be pursued in the development of navigation systems. In this paper, filters for the position, linear velocity, and acceleration of underwater vehicles are derived by combining a long baseline acoustic positioning system with an inertial navigation system. A dynamic model is devised via state augmentation, including the bias of the pseudo-ranges, which accounts for the effect of the unknown offset between the emitters’ and receivers’ clocks. With this technique, the resulting dynamics are linear, in spite of the original nonlinear nature of the problem. The proposed solution, which includes the explicit dynamic estimation of the bias of the pseudo-ranges, is a linear Kalman filter. The observability of the system is assessed, which allows to establish globally exponentially stable error dynamics. The performance of the solution is evaluated with realistic simulation results, considering sensor noise and discrete-time measurements. Finally, the comparison with the extended Kalman filter (EKF), the unscented Kalman filter (UKF), and the Bayesian Cramer–Rao bound is presented, including Monte Carlo simulations. This comparison shows the goodness of the proposed solution, which converges for all initial conditions and exhibits performance comparable to the EKF and the UKF, whereas the EKF and UKF are shown to lack global convergence.

The absence of global positioning system (GPS) signals and the influence of ocean currents are two of the main challenges facing the autonomy of autonomous underwater vehicles (AUVs). This paper proposes an acoustic localization-based tracking control method for AUVs. Particularly, three buoys that emit acoustic signals periodically are deployed over the surface. Times of arrivals of these acoustic signals at the AUV are then obtained and used to calculate an estimated position of the AUV. Moreover, the uncertainties involved in the localization and ocean currents are handled together in the framework of the extended Kalman filter. To deal with system physical constraints, model predictive control relying on online repetitive optimizations is applied in the tracking controller design. Furthermore, due to the different sampling times between localization and control, the dead-reckoning technique is utilized considering detailed AUV dynamics. To avoid using the highly nonlinear and complicated AUV dynamics in the online optimizations, successive linearizations are employed to achieve a trade-off between computational complexity and control performance. Simulation results show that the proposed algorithms are effective and can achieve the AUV tracking control goals.

Traffic state estimation problems must deal with imperfect information. Imperfect information may occur as a result of misalignments between reality and the assumptions or simplifications made when developing the models as well as incomplete or corrupted data. One of the well-known methods of handling imperfect information is the Kalman filter algorithm and its variations, such as the extended Kalman filter and the unscented Kalman filter. While the standard Kalman filter and the extended Kalman filter have been widely applied to the state estimation of linear systems, the unscented Kalman filter has been reported the better choice in the multiclass traffic state estimation. In many applications of Kalman filters to traffic estimation problems, the model and measurement noise covariance matrices are normally estimated. When there is a mismatch between the true and the assumed noise distribution, however, the filter often suffers from performance degradation and even divergence in certain situations. To this end, this paper presents a more efficient and accurate algorithm embedded in the unscented Kalman filter to simultaneously estimate the traffic state and the model noise distribution statistics. The proposed method is facilitated through a simultaneous update of the model noise covariance matrix in the predicted covariance equations of the unscented Kalman filter algorithm. It is found through simulation that the proposed algorithm may improve the model performance over the standard algorithm.

The UK Natural Environment Research Council (NERC) is developing an autonomous underwater vehicle (AUV) capable of measuring, storing and transmitting full-depth oceanographic data over basin-wide tracks. An important feature of this AUV (known as Autosub) is that it will surface periodically for short periods in order to communicate with its base and to determine its position. The satellite-based global positioning system (GPS) has been chosen as the prime candidate for this latter requirement. However, GPS suffers from a number of significant disadvantages in the wet environment of an AUV. The one discussed is the difficulty of acquiring fresh satellite orbital parameters (the ephemeris) in the presence of periodic wave wash-over of the GPS antenna. A collaborative programme involving members of the Autosub team based at the NERC Dunstaffnage Marine Laboratory (DML) and GPS specialists at Navstar Systems Ltd is addressing this problem in two stages. Firstly, the dynamics of the AUV and the consequent antenna masking and interaction with the GPS carrier and code tracking loops have been simulated, leading to the development and validation of a new algorithm for reconstruction of the satellite message. A later stage, not discussed in detail in the present paper, will embed the algorithm in the firmware of a production GPS receiver and test it under practical conditions of signal disruption. The results of the simulation stage are discussed. Some initial work on the development of a simple GPS antenna capable of withstanding immersion to full ocean depth is also presented.