Augmented state Kalman filtering for AUV navigation

This paper addresses the problem of estimating the motion of an Autonomous Underwater Vehicle (AUV), while it constructs a visual map (“mosaic ” image) of the ocean floor. The vehicle is equipped with a down-looking camera which is used to compute its motion with respect to the seafloor. As the mosaic increases in size, a systematic bias is introduced in the alignment of the images which form the mosaic. Therefore, this accumulative error produces a drift in the estimation of the position of the vehicle. When the arbitrary trajectory of the AUV crosses over itself, it is possible to reduce this propagation of image alignment errors within the mosaic. A Kalman filter with augmented state is proposed to optimally estimate both the visual map and the vehicle position.

6-DoF Navigation Systems for Autonomous Underwater Vehicles

Austri

An Underwater SLAM System using Sonar, Visual, Inertial, and Depth Sensor

This paper presents a novel tightly-coupled keyframe-based Simultaneous Localization and Mapping (SLAM) system with loop-closing and relocalization capabilities targeted for the underwater domain. Our previous work, SVIn, augmented the state-of-the-art visual-inertial state estimation package OKVIS to accommodate acoustic data from sonar in a non-linear optimization-based framework. This paper addresses drift and loss of localization -- one of the main problems affecting other packages in underwater domain -- by providing the following main contributions: a robust initialization method to refine scale using depth measurements, a fast preprocessing step to enhance the image quality, and a real-time loop-closing and relocalization method using bag of words (BoW). An additional contribution is the addition of depth measurements from a pressure sensor to the tightly-coupled optimization formulation. Experimental results on datasets collected with a custom-made underwater sensor suite and an autonomous underwater vehicle from challenging underwater environments with poor visibility demonstrate performance never achieved before in terms of accuracy and robustness

An Underwater Vehicle Navigation System Using Acoustic and Inertial Sensors

Unmanned Underwater Vehicles (UUVs) have become an essential tool for different underwater tasks. Compared with other unmanned systems, the navigation and localization for UUVs are particularly challenging due to the unavailability of Global Positioning System (GPS) signals underwater and the complexity of the unstable environment. Alternative methods such as acoustic positioning systems, Inertial Navigation Systems (INS), and the geophysical navigation approach are used for UUV navigation. Acoustic positioning systems utilize the characteristics of acoustic signals that have a lower absorption rate and a more extended propagation distance than electromagnetic signals underwater. The significant disadvantage of the INS is the “drift,” the unbounded error growth over time in the outputs. This thesis is aimed to study and test a combined UUV navigation system that fuses measurements from the INS, Doppler Velocity Log (DVL), and Short Baseline (SBL) acoustic positioning system to reduce the drift. Two Kalman filters are used to do the fusion: the Extended Kalman Filter (EKF) and the Unscented Kalman Filter (UKF). After conducting the experiments and simulation, the results illustrated the INS/SBL fusion navigation approach was able to reduce the drift problems in the INS. Moreover, UKF showed a better performance than the EKF in the INS

Towards Autonomous Localization of an Underwater Drone

Autonomous vehicle navigation is a complex and challenging task. Land and aerial vehicles often use highly accurate GPS sensors to localize themselves in their environments. These sensors are ineffective in underwater environments due to signal attenuation. Autonomous underwater vehicles utilize one or more of the following approaches for successful localization and navigation: inertial/dead-reckoning, acoustic signals, and geophysical data. This thesis examines autonomous localization in a simulated environment for an OpenROV Underwater Drone using a Kalman Filter. This filter performs state estimation for a dead reckoning system exhibiting an additive error in location measurements. We evaluate the accuracy of this Kalman Filter by analyzing the effect each parameter has on accuracy, then choosing the best combination of parameter values to assess the overall accuracy of the Kalman Filter. We find that the two parameters with the greatest effects on the system are the constant acceleration and the measurement uncertainty of the system. We find the filter employing the best combination of parameters can greatly reduce measurement error and improve accuracy under typical operating conditions

Closed‐loop one‐way‐travel‐time navigation using low‐grade odometry for autonomous underwater vehicles

© The Author(s), 2017. This article is distributed under the terms of the Creative Commons Attribution License. The definitive version was published in Journal of FIeld Robotics 35 (2018): 421-434, doi:10.1002/rob.21746.This paper extends the progress of single beacon one‐way‐travel‐time (OWTT) range measurements for constraining XY position for autonomous underwater vehicles (AUV). Traditional navigation algorithms have used OWTT measurements to constrain an inertial navigation system aided by a Doppler Velocity Log (DVL). These methodologies limit AUV applications to where DVL bottom‐lock is available as well as the necessity for expensive strap‐down sensors, such as the DVL. Thus, deep water, mid‐water column research has mostly been left untouched, and vehicles that need expensive strap‐down sensors restrict the possibility of using multiple AUVs to explore a certain area. This work presents a solution for accurate navigation and localization using a vehicle's odometry determined by its dynamic model velocity and constrained by OWTT range measurements from a topside source beacon as well as other AUVs operating in proximity. We present a comparison of two navigation algorithms: an Extended Kalman Filter (EKF) and a Particle Filter(PF). Both of these algorithms also incorporate a water velocity bias estimator that further enhances the navigation accuracy and localization. Closed‐loop online field results on local waters as well as a real‐time implementation of two days field trials operating in Monterey Bay, California during the Keck Institute for Space Studies oceanographic research project prove the accuracy of this methodology with a root mean square error on the order of tens of meters compared to GPS position over a distance traveled of multiple kilometers.This work was supported in part through funding from the Weston Howland Jr. Postdoctoral Scholar Award (BCC), the U.S. Navy's Civilian Institution program via the MIT/WHOI Joint Program (JHK),W. M. Keck Institute for Space Studies, and theWoods Hole Oceanographic Institution

Autonomous navigation with constrained consistency for C-Ranger

Autonomous underwater vehicles (AUVs) have become the most widely used tools for undertaking complex exploration tasks in marine environments. Their synthetic ability to carry out localization autonomously and build an environmental map concurrently, in other words, simultaneous localization and mapping (SLAM), are considered to be pivotal requirements for AUVs to have truly autonomous navigation. However, the consistency problem of the SLAM system has been greatly ignored during the past decades. In this paper, a consistency constrained extended Kalman filter (EKF) SLAM algorithm, applying the idea of local consistency, is proposed and applied to the autonomous navigation of the C-Ranger AUV, which is developed as our experimental platform. The concept of local consistency (LC) is introduced after an explicit theoretical derivation of the EKF-SLAM system. Then, we present a locally consistency-constrained EKF-SLAM design, LC-EKF, in which the landmark estimates used for linearization are fixed at the beginning of each local time period, rather than evaluated at the latest landmark estimates. Finally, our proposed LC-EKF algorithm is experimentally verified, both in simulations and sea trials. The experimental results show that the LC-EKF performs well with regard to consistency, accuracy and computational efficiency