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.

Improved In-Flight Estimation of Inertial Biases through CDGNSS/Vision Based Cooperative Navigation

This paper discusses the exploitation of a cooperative navigation strategy for improved in-flight estimation of inertial sensors biases on board unmanned aerial vehicles. The proposed multi-vehicle technique is conceived for a “chief” Unmanned Aerial Vehicle (UAV) and relies on one or more deputy aircrafts equipped with Global Navigation Satellite System (GNSS) antennas for differential positioning which also act as features for visual tracking. Combining carrier-phase differential GNSS and visual estimates, it is possible to retrieve accurate inertial-independent attitude information, thus potentially enabling improved bias estimation. Camera and carrier-phase differential GNSS measurements are integrated within a 15 states extended Kalman filter. Exploiting an ad hoc developed numerical environment, the paper analyzes the performance of the cooperative approach for inertial biases estimation as a function of number of deputies, formation geometry and distances, and absolute and relative dynamics. It is shown that exploiting two deputies it is possible to improve biases estimation, while a single deputy can be effective if changes of relative geometry and dynamics are also considered. Experimental proofs of concept based on two multi-rotors flying in formation are presented and discussed. The proposed framework is applicable beyond the domain of small UAVs.

ANALYTICAL EXPRESSION FOR UNCERTAINTY PROPAGATION OF AERIAL COOPERATIVE NAVIGATION

In this paper, the propagation of uncertainty in a cooperative navigation algorithm (CNA) for a group of flying robots (FRs) is investigated. Each FR is equipped with an inertial measurement unit (IMU) and range-bearing sensors to measure the relative distance and bearing angles between the agents. In this regard, an extended Kalman filter (EKF) is implemented to estimate the position and rotation angles of all the agents. For further studies, a relaxed analytical performance index through a closed-form solution is derived. Moreover, the effects of the sensors noise covariance and the number of FRs on the growth rate of the position error covariance is investigated. Analytically, it is shown that the covariance of position error in the vehicles equipped with the IMU is proportional to the cube of time. However, the growth rate of the navigation error is, considerably more rapid compared to a mobile robot group. Furthermore, the covariance of position error is independent of the path and noise resulting from the relative position measurements. Further, it merely depends on both the size of the group and noise characteristics of the accelerometers. Lastly, the analytical results are validated through comprehensive Guidance, Navigation, and Control (GNC) in-the-loop simulations.