Ant system based state estimation approach to SLAM

Abstract

This paper proposes an ant system based state estimation approach for simultaneous localization and mapping (SLAM) in the case of ambiguities both in the feature number and data correspondence. Inspired by the random finite sets (RFS) and its derivative, i.e., probability hypothesis density (PHD), an ant-PHD filtering is proposed to jointly estimate the locations and number of features, moreover, a fast moving ant estimator (F-MAE) is developed for estimating maneuvering vehicle trajectory. In contrast to the state-of-the-art approaches, our algorithm employs the artificial ants instead of simple particles to cluster around their favored regions through ants' positive feedback search mechanism, and also builds a seamless from the filter itself to implementation. Simulated results demonstrate the merits of the proposed approach, which outperforms both the Fast-SLAM and the PHD-SLAM by providing a more accurate map as well as an improved estimate accuracy of the vehicle's trajectory.