A Simulation for Robust SLAM to the Error of Heading in Towing Tank

Unscented Kalman Filter을 이용한 Simultaneous Localization and Mapping 기법 적용

Increased usage of autonomous underwater vehicle (AUV) has led to the development of alternative navigational methods that do not employ the acoustic beacons and dead reckoning sensors. This paper describes a simultaneous localization and mapping (SLAM) scheme that uses range sonars mounted on a small AUV. The SLAM is one of such alternative navigation methods for measuring the environment that the vehicle is passing through and providing relative position of AUV by processing the data from sonar measurements. A technique for SLAM algorithm which uses several ranging sonars is presented. This technique utilizes an unscented Kalman filter to estimate the locations of the AUV and objects. In order for the algorithm to work efficiently, the nearest neighbor standard filter is introduced as the algorithm of data association in the SLAM for associating the stored targets the sonar returns at each time step. The proposed SLAM algorithm is tested by simulations under various conditions. The results of the simulation show that the proposed SLAM algorithm is capable of estimating the position of the AUV and the object and demonstrates that the algorithm will perform well in various environments.