Divide and conquer: EKF SLAM in O(n)

IEEE Transactions on Robotics

Volumn 24, Issue 5, 2008, Pages 1107-1120

  Paz, Lina M ^a   Tardós, Juan D ^a   Neira, José ^a  

^a UNIVERSITY OF ZARAGOZA   (Spain)

Author keywords

Computational complexity; Consistency; Linear time; Precision; Simultaneous localization and mapping (SLAM)

Indexed keywords

APPROXIMATION ALGORITHMS; CELLULAR RADIO SYSTEMS; CONFORMAL MAPPING; CONTROL THEORY; ERRORS; EXTENDED KALMAN FILTERS; LINEARIZATION; MAPS; MATHEMATICAL TECHNIQUES;

ALGORITHM COMPUTES; ANGULAR ERRORS; CONSISTENCY; DATA ASSOCIATIONS; DIVIDE AND CONQUER; LINEAR TIME; LINEARIZATION ERRORS; LOCAL MAPS; PRECISION; REAL ERRORS; SIMULATED EXPERIMENTS; SIMULTANEOUS LOCALIZATION AND MAPPING (SLAM); SIMULTANEOUS LOCALIZATION AND MAPPINGS; SLAM ALGORITHMS; TOTAL COSTS; TRUE VALUES;

COMPUTATIONAL COMPLEXITY;

EID: 56049097643     PISSN: 15523098     EISSN: None     Source Type: Journal    
DOI: 10.1109/TRO.2008.2004639     Document Type: Article

References (43)

1. L. M. Paz, P. Jensfelt, J. D. Tardós, and J. Neira, "EKF SLAM updates in O(n) with divide and conquer SLAM," in Proc. IEEE Int. Conf. Robot. Autom., Rome, Italy, Apr. 2007, pp. 1657-1663.
2. L. M. Paz, J. Guivant, J. D. Tardós, and J. Neira, "Data association in O(n) for divide and conquer SLAM," presented at the Robot. Sci. Syst. Conf., Atlanta, GA, Jun. 2007.
3. H. Durrant-Whyte and T. Bailey, "Simultaneous localization and mapping: Part I," IEEE Robot. Autom. Mag., vol. 13, no. 2, pp. 99-110, Jun. 2006.
4. T. Bailey and H. Durrant-Whyte, "Simultaneous localization and mapping (SLAM): Part II," IEEE Robot. Autom. Mag., vol. 13, no. 3, pp. 108-117, Sep. 2006.
5. R. Chatila and J. Laumond, "Position referencing and consistent world modeling for mobile robots," in Proc. IEEE Int. Conf. Robot. Autom. 1985, vol. 2, pp. 138-145.
6. R. C. Smith and P. Cheeseman, "On the representation and estimation of spatial uncertainty," Int. J. Robot. Res., vol. 5, no. 4, pp. 56-68, 1986.
7. R. Smith, M. Self, and P. Cheeseman, "A Stochastic map for uncertain Spatial relationships," in Robotics Res., 4th Int. Symp., O. Faugeras and G. Giralt, Eds. Cambridge, MA: MIT Press, 1988, pp. 467-474.
8. J. Leonard and H. Durrant-Whyte, "Simultaneous map building and localization for an autonomous mobile robot," in Proc. IEEE/RJS Int. Conf. Intell. Robots Syst., Osaka, Japan, 1991, pp. 1442-1447.
9. J. A. Castellanos and J. D. Tardós, Mobile Robot Localization and Map Building: A Multisensor Fusion Approach. Boston, MA: Kluwer, 1999.
10. J. E. Guivant and E. M. Nebot, "Optimization of the simultaneous localization and map-building algorithm for real-time implementation," IEEE Trans. Robot. Autom., vol. 17, no. 3, pp. 242-257, May 2001.
11. J. Knight, A. Davison, and I. Reid, "Toward constant time SLAM using postponement," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Maui, HI, 2001, pp. 406-412.
12. S. J. Julier, "A Sparse weight kalman filter approach to simultaneous localization and map building," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Maui, HI, Oct. 2001, vol. 1, pp. 1251-1256.
13. J. D. Tardós, J. Neira, P. M. Newman, and J. J. Leonard, "Robust mapping and localization in indoor environments using Sonar data," Int. J. Robot. Res., vol. 21, no. 4, pp. 311-330, 2002.
14. L. M. Paz and J. Neira, "Optimal local map size for EKF-based SLAM," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Beijing, China, Oct. 2006, pp. 5019-5025.
15. S. Thrun, Y. Liu, D. Koller, A. Y. Ng, Z. Ghahramani, and H. Durrant-Whyte, "Simultaneous localization and mapping with sparse extended information filters," Int. J. Robot. Res., vol. 23, no. 7/8, pp. 693-716, 2004.
16. R. Eustice, M. Walter, and J. Leonard, "Sparse extended information filters: Insights into sparsification," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Edmonton, AB, Canada, Aug. 2005, pp. 3281-3288.
17. M. R. Walter, R. M. Eustice, and J. J. Leonard, "Exactly sparse extended information filters for feature-based SLAM," Int. J. Robot. Res., vol. 26, no. 4, pp. 335-359, 2007.
18. M. A. Paskin, "Thin junction tree filters for simultaneous localization and mapping," in Proc. Int. Joint Conf. Artif. Intell., San Francisco, CA, 2003, pp. 1157-1164.
19. U. Frese, "Treemap: An O(log n) algorithm for indoor simultaneous localization and mapping," Auton. Robots, vol. 21, no. 2, pp. 103-122, Sep. 2006.
20. R. M. Eustice, H. Singh, and J. J. Leonard, "Exactly sparse delayed-state filters for view-based SLAM," IEEE Trans. Robot., vol. 22, no. 6, pp. 1100-1114, Dec. 2006.
21. F. Dellaert and M. Kaess, "square root SAM: Simultaneous localization and mapping via square root information smoothing," Int. J. Robot. Res., vol. 25, no. 12, pp. 1181-1203, Dec. 2006.
22. K. Ni, D. Steedly, and F. Dellaert, "Tectonic SAM: Exact, out-of-core, submap-based SLAM," in Proc. IEEE Int. Conf. Robot. Autom., Rome, Italy, Apr. 2007, pp. 1678-1685.
23. M. Kaess, A. Ranganathan, and F. Dellaert, "iSAM: Fast incremental smoothing and mapping with efficient data association," in Proc. IEEE Int. Conf. Robot. Autom. (ICRA), Rome, Italy, Apr. 2007, pp. 1670-1677.
24. S. J. Julier and J. K. Uhlmann, "A counter example to the theory of simultaneous localization and map building," in Proc. IEEE Int. Conf. Robot. Autom., Seoul, Korea, 2001, pp. 4238-4243.
25. J. A. Castellanos, J. Neira, and J. D. Tardós, "Limits to the consistency of EKF-based SLAM," presented at the 5th IFAC Symp. Intell. Auton. Vehicles, Lisbon, Portugal, 2004.
26. T. Bailey, J. Nieto, J. Guivant, M. Stevens, and E. Nebot, "Consistency of the EKF-SLAM algorithm," in Proc. IEEE/RJS Int. Conf. Intell. Robots Syst., Beijing, China, 2006, pp. 3562-3568.
27. S. Julier and J. Uhlmann, "A new extension of the kalman filter to nonlinear systems," in Proc. Int. Symp. Aerosp./Defense Sens., Simulate Controls, Orlando, FL, 1997, pp. 182-193.
28. R. Martinez-Cantin and J. A. Castellanos, "Unscented SLAM for largescale outdoor environments," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., Edmonton, AB, Canada, 2005, pp. 328-333.
29. M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, "Fastslam 2.0: An improved particle filtering algorithm for simultaneous localization and mapping that provably converges," in Proc. Int. Joint Conf. Artif. Intell., 2003, pp. 1151-1156.
30. S. Huang and G. Dissanayake, "Convergence and consistency analysis for extended Kalman filter-based SLAM," IEEE Trans. Robot., vol. 23, no. 5, pp. 1036-1049, Oct. 2007.
31. M. W. M. G. Dissanayake, P. Newman, S. Clark, H. F. Durrant-Whyte, and M. Csorba, "A solution to the simultaneous localization and map building (SLAM) problem," IEEE Trans. Robot. Autom., vol. 17, no. 3, pp. 229-241, Jun. 2001.
32. J. Leonard and H. Feder, "Decoupled stochastic mapping," IEEE J. Ocean. Eng., vol. 26, no. 4, pp. 561-571, Oct. 2001.
33. J. Leonard and P. Newman, "Consistent, convergent, and constant-time SLAM," in Proc. Int. Joint Conf. Artif. Intell., Acapulco, Mexico, Aug. 2003, pp. 1143-1150.
34. M. Bosse, P. M. Newman, J. J. Leonard, and S. Teller, "SLAM in largescale cyclic environments using the atlas framework," Int. J. Robot. Res., vol. 23, no. 12, pp. 1113-1139, Dec. 2004.
35. C. Estrada, J. Neira, and J. D. Tardós, "Hierarchical SLAM: Real-time accurate mapping of large environments," IEEE Trans. Robot., vol. 21, no. 4, pp. 588-596, Aug. 2005.
36. S. B. Williams, "Efficient solutions to autonomous mapping and navigation problems," Ph.D. dissertation, Australian Centre Field Robot., Univ. Sydney, Sydney, Australia, Sep. 2001.
37. W. E. L. Grimson, Object Recognition by Computer: The Role of Geometric Constraints. Cambridge, MA: MIT Press, 1990.
38. Y. Bar-Shalom and T. E. Fortmann, Tracking and Data Association. New York: Academic, 1988.
39. J. Neira and J. D. Tardós, "Data association in Stochastic mapping using the joint compatibility test," IEEE Trans. Robot. Autom., vol. 17, no. 6, pp. 890-897, Dec. 2001.
40. L. Clemente, A. J. Davison, I. D. Reid, J. Neira, and J.D. Tardós, "Mapping large loops with a single hand-held camera," presented at the Robot. Sci. Syst. Conf., Atlanta, GA, Jun. 2007.
41. J. Uhlmann, "Introduction to the algorithmics of data association in multiple-target tracking," in Handbook of Multisensor Data Fusion Boca Raton, FL: CRC, 2001.
42. J. Neira, J. D. Tardós, and J. A. Castellanos, "Linear time vehicle relocation in SLAM," in Proc. IEEE Int. Conf.Robot.Autom., Taipei, Taiwan, R.O.C., Sep. 2003, pp. 427-433.
43. R. Hartley and A. Zisserman, Multiple View Geometry in Computer Vision. Cambridge, U.K.: Cambridge Univ. Press, 2000.