Consistency of the EKF-SLAM Algorithm
A solution to the simultaneous localization and map building (SLAM) problem