An Innovative Navigation Strategy for Autonomous Underwater Vehicles: An Unscented Kalman Filter Based Approach

Developing reliable navigation strategies is mandatory in the field of Underwater Robotics and in particular for Autonomous Underwater Vehicles (AUVs) to ensure the correct achievement of a mission. Underwater navigation is still nowadays critical, e.g. due to lack of access to satellite navigation systems (e.g. the Global Positioning System, GPS): an AUV typically proceeds for long time intervals only relying on the measurements of its on-board sensors, without any communication with the outside environment. In this context, the filtering algorithm for the estimation of the AUV state is a key factor for the performance of the system; i.e. the filtering algorithm used to estimate the state of the AUV has to guarantee a satisfactory underwater navigation accuracy. In this paper, the authors present an underwater navigation system which exploits measurements from an Inertial Measurement Unit (IMU), Doppler Velocity Log (DVL) and a Pressure Sensor (PS) for the depth, and relies on either an Extended Kalman Filter (EKF) or an Unscented Kalman Filter (UKF) for state estimation. A comparison between the EKF approach, classically adopted in the field of underwater robotics and the UKF is given. These navigation algorithms have been experimentally validated through the data related to some sea tests with the Typhoon class AUVs, designed and assembled by the Department of Industrial Engineering of the Florence University (DIEF) for exploration and surveillance of underwater archaeological sites in the framework of the THESAURUS and European ARROWS projects. The comparison results are significant as the two filtering strategies are based on the same process and sensors models. At this initial stage of the research activity, the navigation algorithms have been tested offline. The presented results rely on the experimental navigation data acquired during two different sea missions: in the first one, Typhoon AUV #1 navigated in a Remotely Operated Vehicle (ROV) mode near Livorno, Italy, during the final demo of THESAURUS project (held in August 2013); in the latter Typhoon AUV #2 autonomously navigated near La Spezia in the framework of the NATO CommsNet13 experiment, Italy (held in September 2013). The achieved results demonstrate the effectiveness of both navigation algorithms and the superiority of the UKF without increasing the computational load. The algorithms are both affordable for online on-board AUV implementation and new tests at sea are planned for spring 2015.