Simultaneous localization and map building for a team of cooperating robots: a set membership approach

Abstract

The problem of simultaneous localization and map building for a team of cooperating robots moving in an unknown environment is addressed. The robots have to estimate the position of distinguishable static landmarks, and then localize themselves with respect to other robots and landmarks, exploiting distance and angle measurements. A novel set theoretic approach to this problem is presented. The proposed localization algorithm provides position estimates and guaranteed uncertainty regions for all robots and landmarks in the environment.