Image feature-based localization and mapping applications useful in field robotics are considered in this paper. Exploiting the continuity of image features and building upon the tracking algorithms that use point correspondences to provide an instantaneous localization solution, an extended Kalman filtering (EKF) approach is formulated for estimation of the rigid body motion of the camera coordinates with respect to the world coordinate system. Recent results by the authors in quantifying uncertainties associated with the feature tracking methods form the basis for deriving scene-dependent measurement error statistics that drive the optimal estimation approach. It is shown that the use of certain relative motion models between a static scene and the moving target can be recast as a recursive least squares problem and admits an efficient solution to the relative motion estimation problem that is amenable to real-time implementations on board mobile computing platforms with computational constraints. The utility of the estimation approaches developed in the paper is demonstrated using stereoscopic terrain mapping experiments carried out using mobile robots. The map uncertainties estimated by the filter are utilized to establish the registration of the local maps into the global coordinate system.
Extended Kalman Filter for Stereo Vision-Based Localization and Mapping Applications
Contributed by the Dynamic Systems Division of ASME for publication in the JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL. Manuscript received February 22, 2017; final manuscript received August 4, 2017; published online November 8, 2017. Assoc. Editor: Puneet Singla.
- Views Icon Views
- Share Icon Share
- Search Site
Wong, X. I., and Majji, M. (November 8, 2017). "Extended Kalman Filter for Stereo Vision-Based Localization and Mapping Applications." ASME. J. Dyn. Sys., Meas., Control. March 2018; 140(3): 030908. https://doi.org/10.1115/1.4037784
Download citation file: