An USBL-aided multisensor navigation system for field AUVs

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.