Sensor Fusion for Underwater Vehicle Navigation Compensating Misalignment Using Lie Theory

This paper presents a sensor fusion method for navigation of unmanned underwater vehicles. The method combines Lie theory into Kalman filter to estimate and compensate for the misalignment between the sensors: inertial navigation system and Doppler Velocity Log (DVL). In the process and measurement model equations, a 3-dimensional Euclidean group (SE(3)) and 3-sphere space (S3) are used to express the pose (position and attitude) and misalignment, respectively. SE(3) contains position and attitude transformation matrices, and S3 comprises unit quaternions. The increments in pose and misalignment are represented in the Lie algebra, which is a linear space. The use of Lie algebra facilitates the application of an extended Kalman filter (EKF). The previous EKF approach without Lie theory is based on the assumption that a non-differentiable space can be approximated as a differentiable space when the increments are sufficiently small. On the contrary, the proposed Lie theory approach enables exact differentiation in a differentiable space, thus enhances the accuracy of the navigation. Furthermore, the convergence and stability of the internal parameters, such as the Kalman gain and measurement innovation, are improved.

Design of Piezoelectric Acoustic Transducers for Underwater Applications

Interest in underwater transducers has persisted since the mid-1900s. Underwater transducers are designed in various shapes using various materials depending on the purpose of use, such as to achieve high power, improve broadband, and enhance beam steering. Therefore, in this study, an analysis is conducted according to the structural shape of the transducer, exterior material, and active material. By classifying transducers by structure, the transducer design trends and possible design issues can be identified. Researchers have constantly attempted new methods to improve the performance of transducers. In addition, a methodology to overcome this problem is presented. Finally, this review covers old and new research, and will serve as a reference for designers of underwater transducer.

Genetic Algorithm to Solve Optimal Sensor Placement for Underwater Vehicle Localization with Range Dependent Noises

In source localization problems, the relative geometry between sensors and source will influence the localization performance. The optimum configuration of sensors depends on the measurements used for the source location estimation, how these measurements are affected by noise, the positions of the source, and the criteria used to evaluate the localization performance. This paper addresses the problem of optimum sensor placement in a plane for the localization of an underwater vehicle moving in 3D. We consider sets of sensors that measure the distance to the vehicle and model the measurement noises with distance dependent covariances. We develop a genetic algorithm and analyze both single and multi-objective problems. In the former, we consider as the evaluation metric the arithmetic average along the vehicle trajectory of the maximum eigenvalue of the inverse of the Fisher information matrix. In the latter, we estimate the Pareto front of pairs of common criteria based on the Fisher information matrix and analyze the evolution of the sensor positioning for the different criteria. To validate the algorithm, we initially compare results with a case with a known optimal solution and constant measurement covariances, obtaining deviations from the optimal less than 0.1%. Posterior, we present results for an underwater vehicle performing a lawn-mower maneuver and a spiral descent maneuver. We also present results restricting the allowed positions for the sensors.

Underwater Vehicle Positioning by Correntropy-Based Fuzzy Multi-Sensor Fusion

The ability of the underwater vehicle to determine its precise position is vital to completing a mission successfully. Multi-sensor fusion methods for underwater vehicle positioning are commonly based on Kalman filtering, which requires the knowledge of process and measurement noise covariance. As the underwater conditions are continuously changing, incorrect process and measurement noise covariance affect the accuracy of position estimation and sometimes cause divergence. Furthermore, the underwater multi-path effect and nonlinearity cause outliers that have a significant impact on positional accuracy. These non-Gaussian outliers are difficult to handle with conventional Kalman-based methods and their fuzzy variants. To address these issues, this paper presents a new and improved adaptive multi-sensor fusion method by using information-theoretic, learning-based fuzzy rules for Kalman filter covariance adaptation in the presence of outliers. Two novel metrics are proposed by utilizing correntropy Gaussian and Versoria kernels for matching theoretical and actual covariance. Using correntropy-based metrics and fuzzy logic together makes the algorithm robust against outliers in nonlinear dynamic underwater conditions. The performance of the proposed sensor fusion technique is compared and evaluated using Monte-Carlo simulations, and substantial improvements in underwater position estimation are obtained.

Bounded Cost Path Planning for Underwater Vehicles Assisted by a Time-Invariant Partitioned Flow Field Model

A bounded cost path planning method is developed for underwater vehicles assisted by a data-driven flow modeling method. The modeled flow field is partitioned as a set of cells of piece-wise constant flow speed. A flow partition algorithm and a parameter estimation algorithm are proposed to learn the flow field structure and parameters with justified convergence. A bounded cost path planning algorithm is developed taking advantage of the partitioned flow model. An extended potential search method is proposed to determine the sequence of partitions that the optimal path crosses. The optimal path within each partition is then determined by solving a constrained optimization problem. Theoretical justification is provided for the proposed extended potential search method generating the optimal solution. The path planned has the highest probability to satisfy the bounded cost constraint. The performance of the algorithms is demonstrated with experimental and simulation results, which show that the proposed method is more computationally efficient than some of the existing methods.

Multi-Sensor Fusion for Underwater Vehicle Localization by Augmentation of RBF Neural Network and Error-State Kalman Filter

The Kalman filter variants extended Kalman filter (EKF) and error-state Kalman filter (ESKF) are widely used in underwater multi-sensor fusion applications for localization and navigation. Since these filters are designed by employing first-order Taylor series approximation in the error covariance matrix, they result in a decrease in estimation accuracy under high nonlinearity. In order to address this problem, we proposed a novel multi-sensor fusion algorithm for underwater vehicle localization that improves state estimation by augmentation of the radial basis function (RBF) neural network with ESKF. In the proposed algorithm, the RBF neural network is utilized to compensate the lack of ESKF performance by improving the innovation error term. The weights and centers of the RBF neural network are designed by minimizing the estimation mean square error (MSE) using the steepest descent optimization approach. To test the performance, the proposed RBF-augmented ESKF multi-sensor fusion was compared with the conventional ESKF under three different realistic scenarios using Monte Carlo simulations. We found that our proposed method provides better navigation and localization results despite high nonlinearity, modeling uncertainty, and external disturbances.

Robust Position Control of an Over-actuated Underwater Vehicle under Model Uncertainties and Ocean Current Effects Using Dynamic Sliding Mode Surface and Optimal Allocation Control

Underwater vehicles (UVs) are subjected to various environmental disturbances due to ocean currents, propulsion systems, and un-modeled disturbances. In practice, it is very challenging to design a control system to maintain UVs stayed at the desired static position permanently under these conditions. Therefore, in this study, a nonlinear dynamics and robust positioning control of the over-actuated autonomous underwater vehicle (AUV) under the effects of ocean current and model uncertainties are presented. First, a motion equation of the over-actuated AUV under the effects of ocean current disturbances is established, and a trajectory generation of the over-actuated AUV heading angle is constructed based on the line of sight (LOS) algorithm. Second, a dynamic positioning (DP) control system based on motion control and an allocation control is proposed. For this, motion control of the over-actuated AUV based on the dynamic sliding mode control (DSMC) theory is adopted to improve the system robustness under the effects of the ocean current and model uncertainties. In addition, the stability of the system is proved based on Lyapunov criteria. Then, using the generalized forces generated from the motion control module, two different methods for optimal allocation control module: the least square (LS) method and quadratic programming (QP) method are developed to distribute a proper thrust to each thruster of the over-actuated AUV. Simulation studies are conducted to examine the effectiveness and robustness of the proposed DP controller. The results show that the proposed DP controller using the QP algorithm provides higher stability with smaller steady-state error and stronger robustness.

Solving Gravity Anomaly Matching Problem Under Large Initial Errors in Gravity Aided Navigation by Using an Affine Transformation Based Artificial Bee Colony Algorithm

Gravity aided inertial navigation system (GAINS), which uses earth gravitational anomaly field for navigation, holds strong potential as an underwater navigation system. The gravity matching algorithm is one of the key factors in GAINS. Existing matching algorithms cannot guarantee the matching accuracy in the matching algorithms based gravity aided navigation when the initial errors are large. Evolutionary algorithms, which are mostly have the ability of global optimality and fast convergence, can be used to solve the gravity matching problem under large initial errors. However, simply applying evolutionary algorithms to GAINS may lead to false matching. Therefore, in order to deal with the underwater gravity matching problem, it is necessary to improve the traditional evolutionary algorithms. In this paper, an affine transformation based artificial bee colony (ABC) algorithm, which can greatly improve the positioning precision under large initial errors condition, is developed. The proposed algorithm introduces affine transformation to both initialization process and evolutionary process of ABC algorithm. The single-point matching strategy is replaced by the strategy of matching a sequence of several consecutive position vectors. In addition, several constraints are introduced to the process of evolution by using the output characteristics of the inertial navigation system (INS). Simulations based on the actual gravity anomaly base map have been performed for the validation of the proposed algorithm.

Sine Rotation Vector Method for Attitude Estimation of an Underwater Robot

This paper describes a method for estimating the attitude of an underwater robot. The method employs a new concept of sine rotation vector and uses both an attitude heading and reference system (AHRS) and a Doppler velocity log (DVL) for the purpose of measurement. First, the acceleration and magnetic-field measurements are transformed into sine rotation vectors and combined. The combined sine rotation vector is then transformed into the differences between the Euler angles of the measured attitude and the predicted attitude; the differences are used to correct the predicted attitude. The method was evaluated according to field-test data and simulation data and compared to existing methods that calculate angular differences directly without a preceding sine rotation vector transformation. The comparison verifies that the proposed method improves the attitude estimation performance.