SIMULTANEOUS COOPERATIVE LOCALIZATION FOR AUVs USING RANGE-ONLY SENSORS

摘要

The absence of GPS underwater makes navigation for autonomous underwater vehicles (AUVs) a challenge. Moreover, the use of static beacons in the form of a long baseline (LBL) array limits the operation area to a few square kilometers and requires substantial deployment effort before operations. In this paper, an algorithm for cooperative localization of AUVs is proposed. We describe a form of cooperative Simultaneous Localization and Mapping (SLAM). Each of the robots in the group is equipped with an Inertial Measurement Unit (IMU) and some of them have a range-only sonar sensor that can determine the relative distance to the others. Two estimators, in the form of a Kalman filter, process the available position information from all the members of the team and produce a pose estimate for every one of them. Simulation results are presented for a typical localization example of three AUVs formation in a large environment and indirect trajectory. The results show that our proposed method offers good localization accuracy, although a small number of low-cost sensors are needed for each vehicle, which validates that it is an economical and practical localization approach.