초록
Increased usage of AUVs has led to the development of alternative navigational methods that use the acoustic beacons and dead reckoning. This paper describes a concurrent mapping and localization (CML) scheme that uses range sonars mounted on SNUUVI, which is a small test AUV developed by Seoul National University. The CML is one of such alternative navigation methods for measuring the environment that the vehicle is passing through. In addition, it is intended to provide relative position of AUV by processing the data from sonar measurements. A technique for CML algorithm which uses several ranging sonars is presented. This technique utilizes an extended Kalman filter to estimate the location of the AUV. In order for the algorithm to work efficiently, the nearest neighbor standard filter is introduced as the algorithm of data association in the CML for associating the stored targets the sonar returns at each time step. The proposed CML algorithm is tested by simulations under various conditions. Experiments in a towing tank for one dimensional navigation are conducted and the results are presented. The results of the simulation and experiment show that the proposed CML algorithm is capable of estimating the position of the vehicle and the object and demonstrates that the algorithm will perform well in the real environment.