A multi-AUV cooperative navigation method

Cooperative navigation is one of the key methods for multiple autonomous underwater vehicles (AUVs) to obtain accurate positions when performing tasks underwater. In the realistic state-space model of the multi-AUV cooperative navigation system, where the system noise does not satisfy the additivity, it is necessary to augment the dimension of the state variables before nonlinear filtering. Aiming at the problem that the error of traditional algorithms increases linearly with the dimension of state-space, a cooperative navigation method based on Augmented Embedded Cubature Kalman filter (AECKF) algorithm is proposed. The experiment results show that the AECKF cooperative navigation algorithm has better positioning accuracy and stability than the traditional algorithm.