Fast 3D Pose Estimation With Out-of-Sequence Measurements
Download: PDF.
“Fast 3D Pose Estimation With Out-of-Sequence Measurements” by A. Ranganathan, M. Kaess, and F. Dellaert. In IEEE/RSJ Intl. Conf. on Intelligent Robots and Systems, IROS, (San Diego, CA), Oct. 2007, pp. 2486-2493.
Abstract
We present an algorithm for pose estimation using fixed-lag smoothing. We show that fixed-lag smoothing enables inclusion of measurements from multiple asynchronous measurement sources in an optimal manner. Since robots usually have a plurality of uncoordinated sensors, our algorithm has an advantage over filtering-based estimation algorithms, which cannot incorporate delayed measurements optimally. We provide an implementation of the general fixed-lag smoothing algorithm using square root smoothing, a technique that has recently become prominent. Square root smoothing uses fast sparse matrix factorization and enables our fixed-lag pose estimation algorithm to run at upwards of 20 Hz. Our algorithm has been extensively tested over hundreds of hours of operation on a robot operating in outdoor environments. We present results based on these tests that verify our claims using wheel encoders, visual odometry, and GPS as sensors.
Download: PDF.
BibTeX entry:
@inproceedings{Ranganathan07iros,
author = {A. Ranganathan and M. Kaess and F. Dellaert},
title = {Fast 3{D} Pose Estimation With Out-of-Sequence Measurements},
booktitle = {IEEE/RSJ Intl. Conf. on Intelligent Robots and Systems, IROS},
pages = {2486-2493},
address = {San Diego, CA},
month = {Oct},
year = {2007}
}