This work develops a sliding window filter for incremental simultaneous localization and mapping (SLAM) that focuses computational resources on accurately estimating the immediate spatial surroundings using a sliding time window of the most recent sensor measurements. Ideally, we would like a constant time algorithm that closely approximates the all-time maximum-likelihood estimate as well as the minimum variance Cramer Rao lower bound (CRLB) - that is we would like an estimator that achieves some notion of statistical optimality (quickly converges), efficiency (quickly reduces uncertainty) and consistency (avoids over-confidence). To this end we give a derivation of the SLAM problem from the Gaussian non-linear least squares optimization perspective.We find that this results in a simple, yet general, take on the SLAM problem; we think this is a useful contribution.
Our approach is inspired by the results from the photogrammetry community, dating back to the late 1950’s [1], and later derivatives like Mikhail’s least squares treatment [6], the Variable state dimension filter(VSDF) [5], visual odometry( VO) [4], modern bundle adjustment(BA) [10, 3] and of course extended Kalman filter (EKF) SLAM [9].
We apply the sliding window filter to SLAM with stereo vision and inertial measurements. Experiments show that the best approximate method comes close to matching the performance of the optimal estimator while attaining constant time complexity - empirically, it is often the case that the difference in their performance is indistinguishable.
Access provided by Autonomous University of Puebla. Download to read the full chapter text
Chapter PDF
Similar content being viewed by others
Keywords
These keywords were added by machine and not by the authors. This process is experimental and the keywords may be updated as the learning algorithm improves.
References
Brown, D.: A solution to the general problem of multiple station analytical stereotriangulation. Tech. rep., RCP-MTP Data Reduction Technical Report No. 43, Patrick Air Force Base, Flordia (also designated as AFMTC 58-8) (1958)
Dennis, J.J., Schnabel, R.B.: Numerical Methods for Unconstrained Optimization and Nonlinear Equations. Society for Industrial & Applied Mathematics (1996)
Engels, C., Stewenius, H., Nister, D.: Bundle adjustment rules. In: Photogrammetric Computer Vision (2006)
Matthies, L., Shafer, S.: Error modelling in stereo navigation. IEEE Journal of Robotics and Automation 3(3), 239-248 (1987)
McLauchlan, P.F.: The variable state dimension filter applied to surface-based structure from motion. Tech. rep., University of Surrey (1999)
Mikhail, E.M.: Observations and Least Squares. Rowman & Littlefield (1983)
Nister, D., Naroditsky, O., Bergen, J.: Visual odometry. In: Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition, pp. 652-659. Washington, DC (2004)
Olson, C.F., Matthies, L.H., Schoppers, M., Maimone, M.W.: Stereo ego-motion improvements for robust rover navigation. In: Proceedings of the IEEE Conference on Robotics and Automation, pp. 1099-1104. Washington, DC (2001)
Smith, R.C., Self, M., Cheeseman, P.: Estimating uncertain spatial relationships in robotics. In: I.J. Cox, G.T. Wilfong (eds.) Autonomous Robot Vehicles, pp. 167-193. Springer-Verlag (1990)
Triggs, B., McLauchlan, P., Hartley, R., Fitzgibbon, A.: Bundle adjustment - A modern synthesis. In: W. Triggs, A. Zisserman, R. Szeliski (eds.) Vision Algorithms: Theory and Practice, LNCS, pp. 298-375. Springer Verlag (2000)
Author information
Authors and Affiliations
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2008 Springer Science+Business Media, LLC
About this chapter
Cite this chapter
Sibley, G., Matthies, L., Sukhatme, G. (2008). A Sliding Window Filter for Incremental SLAM. In: Kragic, D., Kyrki, V. (eds) Unifying Perspectives in Computational and Robot Vision. Lecture Notes in Electrical Engineering, vol 8. Springer, Boston, MA. https://doi.org/10.1007/978-0-387-75523-6_7
Download citation
DOI: https://doi.org/10.1007/978-0-387-75523-6_7
Publisher Name: Springer, Boston, MA
Print ISBN: 978-0-387-75521-2
Online ISBN: 978-0-387-75523-6
eBook Packages: Computer ScienceComputer Science (R0)