This paper presents the design, analysis, and experimental validation of a globally asymptotically stable (GAS) filter for simultaneous localization and mapping (SLAM) with application to unmanned aerial vehicles. The main contributions of this paper are the results of global convergence and stability for SLAM in tridimensional (3-D) environments. The SLAM problem is formulated in a sensor-based framework and modified in such a way that the structure may be regarded as linear time-varying for observability purposes, from which a Kalman filter with GAS error dynamics follows naturally. The proposed solution includes the estimation of both body-fixed linear velocity and rate B Pedro Lourenço gyro measurement biases. Experimental results from several runs, using an instrumented quadrotor equipped with a RGB-D camera, are included in the paper to illustrate the performance of the algorithm under realistic conditions.
scite is a Brooklyn-based organization that helps researchers better discover and understand research articles through Smart Citations–citations that display the context of the citation and describe whether the article provides supporting or contrasting evidence. scite is used by students and researchers from around the world and is funded in part by the National Science Foundation and the National Institute on Drug Abuse of the National Institutes of Health.