We consider the problem of simultaneously locating an observer and a set of environmental landmarks with respect to an inertial coordinate system, when both the observer position and the landmark positions are initially uncertain. For solving this problem, a new state estimator is introduced, which allows the problem to be consistently solved locally.
展开▼