Video data validation by sonar measures for robot localization and environment feature estimation

In this paper, the robust robot localization problem with respect to uncertainties on environment features is formulated in a stochastic setting, and an extended Kalman filtering approach is proposed for the integration of odometric, video camera, and sonar measures. The environment is supposed to be only partially known, and a probabilistic method for sensor data fusion aimed at increasing the environment knowledge is considered.