A cooperative navigation algorithm for a group of autonomous underwater vehicles is proposed on the basis of motion radius vector estimation.Combined the dead reckoning data with the mutual range data through an acoustic communication network among the group members, the relative positioning problem can be solved. A novel approach for solving the relative positioning is presented by using a recursive trigonometry technique and extended Kalman filter(EKF). Simulation results verify the correctness and effectiveness of this navigation method.
展开▼