Sensor-based globally exponentially stable range-only simultaneous localization and mapping

• A novel filter for range-only SLAM is proposed.
• Sensor-based formulation of SLAM and state augmentation allow LTV Kalman filtering.
• The error dynamics of the filter are globally exponentially stable.
• Global convergence of undelayed initial guesses is guaranteed.

This paper proposes the design, analysis, and validation of a globally exponentially stable (GES) filter for tridimensional (3-D) range-only simultaneous localization and mapping. For observability analysis purposes, a nonlinear sensor-based dynamical system is formulated resorting only to exact linear and angular kinematics and a state augmentation is exploited that allows the proposed formulation to be considered as linear time-varying without linearizing the original nonlinear system. Constructive observability results can then be established, leading naturally to the design of a Kalman Filter with GES error dynamics. These results also provide valuable insight on the motion planning of the vehicle. Experimental results demonstrate the good performance of the algorithm and help validate the theoretical results presented. For completeness and to illustrate the necessity of a proper trajectory, simulation data are included as well.