The Community for Technology Leaders
Green Image
Issue No. 07 - July (2009 vol. 31)
ISSN: 0162-8828
pp: 1251-1263
Steven A. Holmes , University of Oxford, Oxford
David W. Murray , University of Oxford, Oxford
Georg Klein , University of Oxford, Oxford
ABSTRACT
This paper develops a Square Root Unscented Kalman Filter (SRUKF) for performing video-rate visual simultaneous localization and mapping (SLAM) using a single camera. The conventional UKF has been proposed previously for SLAM, improving the handling of nonlinearities compared with the more widely used Extended Kalman Filter (EKF). However, no account was taken of the comparative complexity of the algorithms: In SLAM, the UKF scales as O(N^{3}) in the state length, compared to the EKF's O(N^{2}), making it unsuitable for video-rate applications with other than unrealistically few scene points. Here, it is shown that the SRUKF provides the same results as the UKF to within machine accuracy and that it can be reposed with complexity O(N^{2}) for state estimation in visual SLAM. This paper presents results from video-rate experiments on live imagery. Trials using synthesized data show that the consistency of the SRUKF is routinely better than that of the EKF, but that its overall cost settles at an order of magnitude greater than the EKF for large scenes.
INDEX TERMS
Structure from motion, simultaneous localization and mapping, unscented Kalman filter.
CITATION
Steven A. Holmes, David W. Murray, Georg Klein, "An O(N²) Square Root Unscented Kalman Filter for Visual Simultaneous Localization and Mapping", IEEE Transactions on Pattern Analysis & Machine Intelligence, vol. 31, no. , pp. 1251-1263, July 2009, doi:10.1109/TPAMI.2008.189
92 ms
(Ver )