In this paper the localization and environmentfeature estimation problems are formulated in a stochastic setting, and an Extended Kalman Filtering (EKF) 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 sensory data fusion aimed at increasing the environment knowledge is considered.
展开▼