The underwater domain is a challenging environment for robotics because widely used electromagnetic devices must be substituted by acoustic equivalents, much slower and noisier. In this paper a two‐dimensional pose simultaneous localization and mapping (SLAM) system for an Autonomous Underwater Vehicle based on inertial sensors and a mechanical profiling sonar is presented. Two main systems are specially designed. On the one hand, a dead reckoning system based on Lie Theory is presented to track integrated pose uncertainty. On the other hand, a rigid scan matching technique specialized for acoustic data is proposed, which allows one to estimate the uncertainty of the matching result. Moreover, Bayesian–Gaussian mixtures models are introduced to the scan matching problem and the registration problem is solved by an optimization in Lie groups. The SLAM system is tested on real data and executed in real time with the robotic application. Using this system, section maps at constant depth can be obtained from a three‐dimensional underwater domain. The presented SLAM system constitutes the first achievement towards an underwater Active SLAM application.
Most existing algorithms in mobile robotics consider a kinematic robot model for the the Simultaneous Localization and Mapping (SLAM) problem. However, in the case of autonomous vehicles, because of the increase in the mass and velocities, a kinematic model is not enough to characterize some physical effects as, e.g., the slip angle. For this reason, when applying SLAM to autonomous vehicles, the model used should be augmented considering both kinematic and dynamic behaviours. The inclusion of dynamic behaviour implies that nonlinearities of the vehicle model are most important. For this reason, classical observation techniques based on the the linearization of the system model around the operation point, such as the well known Extended Kalman Filter (EKF), should be improved. Consequently, new techniques of advanced control must be introduced to more efficiently treat the nonlinearities of the involved models. The Linear Parameter Varying (LPV) technique allows working with nonlinear models, making a pseudolinear representation, and establishing systematic methodologies to design state estimation schemes applying several specifications. In recent years, it has been proved in many applications that this advanced technique is very useful in real applications, and it has been already implemented in a wide variety of application fields. In this article, we present a SLAM-based localization system for an autonomous vehicle considering the dynamic behaviour using LPV techniques. Comparison results are provided to show how our proposal outperforms classical observation techniques based on model linearization.
Robot localization is a fundamental task in achieving true autonomy. Recently, many graph-based navigators have been proposed that combine an inertial measurement unit (IMU) with an exteroceptive sensor applying IMU preintegration to synchronize both sensors. IMUs are affected by biases that also have to be estimated. To increase the navigator robustness when faults appear on the perception system, IMU preintegration can be complemented with linear velocity measurements obtained from visual odometry, leg odometry, or a Doppler Velocity Log (DVL), depending on the robotic application. Moreover, higher grade IMUs are sensitive to the Earth rotation rate, which must be compensated in the preintegrated measurements. In this paper, we propose a general purpose preintegration methodology formulated on a compact Lie group to set motion constraints on Graph SLAM problems considering the Earth rotation effect. We introduce the SE $_{N}(3)$ group to jointly preintegrate IMU data and linear velocity measurements to preserve all the existing correlation within the preintegrated quantity. Field experiments using an Autonomous Underwater Vehicle (AUV) equipped with a DVL and a navigational grade IMU are provided and results are benchmarked against a commercial filter-based Inertial Navigation System (INS) to prove the effectiveness of our methodology.
23 September 2025 in Journal of Ocean Engineering and Science
This work was developed under the need for an acoustic localization system to monitor marine protected areas (MPAs) with the help of autonomous underwater vehicles (AUVs). Although the use of acoustic signals for underwater localization has been previously studied, most of the solutions rely on filter-based optimization, which is prone to linearization problems in long-term applications. Instead, we implemented a Modular Acoustic Graph Simultaneous Localization and Mapping (SLAM) algorithm that, using a factor graph framework, tracks acoustic beacons with either ranges or bearings. In addition, we developed several novel methods, like a delayed-position update for ultra-short baseline (USBL) position factor integration process, an initialization algorithm for acoustic landmarks, and the creation of a new 3D bearing factor that combines two angles. After developing the algorithm, field experiments were carried out in different areas on the coast of Catalonia. Besides the localization, some monitoring tasks were also tested, such as visual mapping of localized landmarks or optical transmission of data with seafloor stations, which helped validate the accuracy of the acoustic localization system. The results of such experiments are presented and discussed.