Position USBL/DVL Sensor-based Navigation Filter in the presence of Unknown Ocean Currents

M. Morgado,P. Batista,P. Oliveira,C. Silvestre

DOI: https://doi.org/10.48550/arXiv.1008.4536

2010-09-11

Abstract:This paper presents a novel approach to the design of globally asymptotically stable (GAS) position filters for Autonomous Underwater Vehicles (AUVs) based directly on the nonlinear sensor readings of an Ultra-short Baseline (USBL) and a Doppler Velocity Log (DVL). Central to the proposed solution is the derivation of a linear time-varying (LTV) system that fully captures the dynamics of the nonlinear system, allowing for the use of powerful linear system analysis and filtering design tools that yield GAS filter error dynamics. Simulation results reveal that the proposed filter is able to achieve the same level of performance of more traditional solutions, such as the Extended Kalman Filter (EKF), while providing, at the same time, GAS guarantees, which are absent for the EKF.

Optimization and Control

What problem does this paper attempt to address?

The problem that this paper attempts to solve is to design a globally asymptotically stable (GAS) position filter for the navigation system of autonomous underwater vehicles (AUVs) based on the nonlinear readings of the ultra - short baseline (USBL) and Doppler velocity log (DVL) sensors in the presence of unknown ocean currents. Specifically, the objectives of the paper are:

1. **Avoid the limitations of traditional methods**: Traditional solutions usually use the extended Kalman filter (EKF) or the particle filter (PF), which lack global asymptotic stability (GAS). In addition, some methods rely on pre - calculated position fixed values of USBL devices, which are usually based on the plane - wave approximation, resulting in errors that cannot converge to zero.

2. **Directly utilize nonlinear sensor readings**: The method proposed in the paper directly embeds range measurements, avoiding the plane - wave approximation, thereby improving the accuracy and stability of the filter.

3. **Handle the influence of unknown ocean currents**: In practical applications, ocean currents can cause deviations in DVL readings. The method proposed in the paper can estimate these unknown ocean currents, thereby improving the accuracy of position estimation.

4. **Implement a globally asymptotically stable filter**: By converting the nonlinear system into a linear time - varying (LTV) system and using the state augmentation technique, the paper designs a filter with global asymptotic stability, ensuring the global asymptotic stability of the filter error dynamics.

In summary, the main contribution of this paper lies in the design of a new filter that can provide globally asymptotically stable position estimates based on the nonlinear sensor readings of USBL and DVL in the presence of unknown ocean currents, thereby improving the performance and reliability of the autonomous underwater vehicle navigation system.