Exactly sparse delayed-state filters for view-based SLAM

IEEE Transactions on Robotics

Volumn 22, Issue 6, 2006, Pages 1100-1114

  Eustice, Ryan M ^a,b,c   Singh, Hanumant ^b   Leonard, John J ^d  

^a MASSACHUSETTS INSTITUTE OF TECHNOLOGY   (United States)

^b WOODS HOLE OCEANOGRAPHIC INSTITUTION   (United States)

^c UNIVERSITY OF MICHIGAN   (United States)

^d Massachusetts Institute of Technology   (United States)

Author keywords

Information filters; Kalman filtering; Machine vision; Mobile robot motion planning; Mobile robots; Recursive estimation; Robot vision systems; Simultaneous localization and mapping (SLAM); Underwater vehicles

Indexed keywords

ALGORITHMS; APPROXIMATION THEORY; COMPUTER VISION; KALMAN FILTERING; MAPPING; MATRIX ALGEBRA; MOTION PLANNING;

INFORMATION FILTERS; MOBILE ROBOT MOTION PLANNING; RECURSIVE ESTIMATION; ROBOT VISION SYSTEMS; SIMULTANEOUS LOCALIZATION AND MAPPING (SLAM); UNDERWATER VEHICLES;

MOBILE ROBOTS;

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

References (72)

1. J. Reynolds, R. Highsmith, B. Konar, C. Wheat, and D. Doudna, "Fisheries and fisheries habitat investigations using undersea technology," in Proc. IEEE/MTS OCEANS Conf. Exhib., Honolulu, HI, Nov. 2001, vol. 2, pp. 812-820.
2. H. Singh, R. Armstrong, F. Gilbes, R. Eustice, C. Roman, O. Pizarro, and J. Torres, "Imaging coral I: Imaging coral habitats with the SeaBED AUV," J. Subsurface Sensing Tech. Appls., vol. 5, no. 1, pp. 25-42, Jan. 2004.
3. B. Fletcher, "Chemical plume mapping with an autonomous underwater vehicle," in Proc. IEEE/MTS OCEANS Conf. Exhib., Honolulu, HI, Nov. 2001, vol. 1, pp. 508-512.
4. C. German, D. Connelly, R. Prien, D. Yoerger, M. Jakuba, A. Bradley, T. Shank, H. Edmonds, and C. Langmuir, "New techniques for hydrothermal exploration: In situ chemical sensors on AUVs - Preliminary results from the Lau Basin," in EOS: Trans. Amer. Geophys. Union Fall Meet. Supplement, Dec. 2004, p. A190+, Abstract.
5. M. Jakuba, D. Yoerger, A. Bradley, C. German, C. Langmuir, and T. Shank, "Multiscale, multimodal AUV surveys for hydrothermal vent localization," in Proc. Int. Symp. Unmanned Untethered Subm. Technol., Durham, NH, 2005, to be published.
6. D. Yoerger, A. Bradley, B. Walden, H. Singh, and R. Bachmayer, "Surveying a subsea lava flow using the Autonomous Benthic Explorer (ABE)," Int. J. Syst. Sci., vol. 29, no. 10, pp. 1031-1044, Oct. 1998.
7. D. Yoerger, A. Bradley, M. Cormier, W. Ryan, and B. Walden, "High resolution mapping of a fast spreading mid-ocean ridge with the autonomous benthic explorer," in Proc. Int. Symp. Unmanned Untethered Subm. Technol., Durham, NH, Aug. 1999, CD-ROM.
8. D. Yoerger, D. Kelley, and J. Delaney, "Fine-scale three-dimensional mapping of a deep-sea hydrothermal cent site using the Jason ROV system," Int. J. Robot. Res., vol. 19, no. 11, pp. 1000-1014, Nov. 2000.
9. D. Yoerger, H. Singh, L. Whitcomb, J. Catteau, J. Adams, B. Foley, and D. Mindell, "High resolution mapping for deep water archeology," in Proc. Annu. Meet. Soc. Historical Archaeol., 1998, CD-ROM.
10. H. Singh, J. Adams, D. Mindell, and B. Foley, "Imaging underwater for archeology," Amer. J. Field Archaeol., vol. 27, no. 3, pp. 319-328, 2000.
11. R. Ballard, L. Stager, D. Master, D. Yoerger, D. Mindell, L. Whitcomb, H. Singh, and D. Piechota, "Iron age shipwrecks in deep water off Ashkelon, Israel," Amer. J. Archaeol., vol. 106, no. 2, pp. 151-168, Apr. 2002.
12. M. Hunt, W. Marquet, D. Moller, K. Peal, W. Smith, and R. Spindel, "An acoustic navigation system," Woods Hole Oceanogr. Inst., Tech. Rep. WHOI-74-6, Dec. 1974.
13. P. Milne, Underwater acoustic positioning systems. Houston, TX: Gulf, 1983.
14. Acoustic Doppler Current Profiler: Principles of Operation a Practical Primer, 2nd ed. San Diego, CA: RD Instruments, Jan. 1996.
15. T. Gaiffe, "U-Phins: A FOG-based inertial navigation system developed specifically for AUV navigation and control," in Proc. Int. Conf. Underwater Intervention, New Orleans, LA, Feb. 2002, CD-ROM.
16. L. Whitcomb, D. Yoerger, and H. Singh, "Advances in Doppler-based navigation of underwater robotic vehicles," in Proc. IEEE Int. Conf. Robot. Autom., 1999, vol. 1, pp. 399-406.
17. R. Eustice, O. Pizarro, and H. Singh, "Visually augmented navigation in an unstructured environment using a delayed state history," in Proc. IEEE Int. Conf. Robot. Autom., New Orleans, LA, Apr. 2004, vol. 1, pp. 25-32.
18. F. Lu and E. Milios, "Globally consistent range scan alignment for environment mapping," Auton. Robots, vol. 4, pp. 333-349, Apr. 1997.
19. J. Leonard and R. Rikoski, "Incorporation of delayed decision making into stochastic mapping," in Experimental Robotics VII, ser. Lecture Notes in Control and Information Sciences. New York: Springer-Verlag, 2001, vol. 271, pp. 533-542.
20. S. Fleischer, "Bounded-error vision-based navigation of autonomous underwater vehicles," Ph.D. dissertation, Stanford Univ., Stanford, CA, May 2000.
21. P. McLauchlan, "A batch/recursive algorithm for 3D scene reconstruction," in Proc. IEEE Conf. Comput. Vis. Pattern Recog., Hilton Head, SC, 2000, vol. 2, pp. 738-743.
22. R. Smith, M. Self, and P. Cheeseman, "A stochastic map for uncertain spatial relationships," in Proc. Int. Symp. Robot. Res., 1988, pp. 467-474.
23. R. Smith, M. Self, and P. Cheeseman, "Estimating uncertain spatial relationships in robotics," in Autonomous Robot VehiclesI. Cox and G. Wilfong, Eds. New York: Springer-Verlag, 1990, pp. 167-193.
24. P. Moutarlier and R. Chatila, "An experimental system for incremental environment modeling by an autonomous mobile robot," in Proc. Int. Symp. Exp. Robot., Montreal, QC, Canada, Jun. 1989, pp. 327-346.
25. J. Leonard and H. Feder, "Decoupled stochastic mapping," IEEE J. Ocean. Eng., vol. 26, no. 4, pp. 561-571, Oct. 2001.
26. M. Bosse, P. Newman, J. Leonard, and S. Teller, "An Atlas framework for scalable mapping," Int. J. Robot. Res., vol. 23, pp. 1113-1139, Dec. 2004.
27. J. Leonard and P. Newman, "Consistent, convergent, and constant-time SLAM," in Proc. Int. Joint Conf. Artif. Intell., Acapulco, Mexico, Aug. 2003, pp. 1143-1190.
28. A. Davison, "Mobile robot navigation using active vision," Ph.D. dissertation, Univ. Oxford, Oxford, U.K., 1999.
29. S. Williams, "Efficient solutions to autonomous mapping and navigation problems," Ph.D. dissertation, Univ. Sydney, Sydney, Australia, 2001.
30. J. Guivant and E. 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, Jun. 2001.
31. M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, "FastSLAM: A factored solution to the simultaneous localization and mapping problem," in Proc. AAAI Nat. Conf. Artif. Intell., Edmonton, AB, Canada, 2002, pp. 593-598.
32. M. Montemerlo, "FastSLAM: A factored solution to the simultaneous localization and mapping problem with unknown data association," Ph.D. dissertation, Carnegie Mellon Univ., Pittsburgh, PA, Jun. 2003.
33. S. Julier and J. Uhlmann, "Building a million beacon map," in Proc. SPIE Sensor Fusion, Decentralized Control Robot. Syst. IV, G. McKee and P. Schenker, Eds., Oct. 2001, vol. 4571, pp. 10-21.
34. S. Thrun, Y. Liu, D. Koller, A. 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, Jul.-Aug. 2004.
35. M. Paskin, "Thin junction tree filters for simultaneous localization and mapping," in Proc. Int. Joint Conf. Artif. Intell., San Francisco, CA, 2003, pp. 1157-1164.
36. U. Frese and G. Hirzinger, "Simultaneous localization and mapping - A discussion," in Proc. IJCAI Workshop: Reasoning with Uncertainty in Robot., Seattle, WA, 2001, pp. 17-26.
37. U. Frese, "Treemap: An O(Log N) algorithm for simultaneous localization and mapping," in Spatial Cognition IV, C. Freksa, Ed. New York: Springer-Verlag, 2004.
38. R. Eustice, H. Singh, and J. Leonard, "Exactly sparse delayed-state filters," in Proc. IEEE Int. Conf. Robot. Autom., Barcelona, Spain, 2005, pp. 2428-2435.
39. P. McLauchlan and D. Murray, "A unifying framework for structure and motion recovery from image sequences," in Proc. IEEE Int. Conf. Comput. Vis., Boston, MA, 1995, pp. 314-320.
40. U. Frese, "A proof for the approximate sparsity of SLAM information matrices," in Proc. IEEE Int. Conf. Robot. Autom., Barcelona, Spain, 2005, pp. 331-337.
41. R. Eustice, M. Walter, and J. Leonard, "Sparse extended information filters: Insights into sparsification," in Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst., 2005, pp. 641-648.
42. M. Walter, R. Eustice, and J. Leonard, "A provably consistent method for imposing sparsity in feature-based SLAM information filters," in Proc. Int. Symp. Robot. Res., San Francisco, CA, Oct. 2005, CD-ROM.
43. F. Dellaert, "Square root SAM," in Proc. Robot.: Sci. Syst., Cambridge, MA, Jun. 2005, pp. 177-184.
44. Y. Bar-Shalom, X. Rong Li, and T. Kirubarajan, Estimation With Applications to Tracking and Navigation. New York: Wiley, 2001.
45. J. Pearl, Probabilistic Reasoning in Intelligent Systems: Networks of Plausible Inference. San Mateo, CA: Morgan Kaufmann, 1988.
46. Y. Weiss and W. Freeman, "Correctness of belief propagation in Gaussian graphical models of arbitrary topology," Neural Comput., vol. 13, no. 10, pp. 2173-2200, 2001.
47. K. Murphy, "Bayesian map learning in dynamic environments," in Advances in Neural Information Processing Systems. Cambridge, MA: MIT Press, 1999.
48. J. Gutmann and K. Konolige, "Incremental mapping of large cyclic environments," in Proc. IEEE Int. Symp. Comput. Intell. Robot. Autom., Monterey, CA, Nov. 1999, pp. 318-325.
49. R. Eustice, "Large-area visually augmented navigation for autonomous underwater vehicles," Ph.D. dissertation, Mass. Inst. Technol./Woods Hole Oceanogr. Inst. Joint Prog., Woods Hole, MA, Jun. 2005.
50. J. Shewchuk, "An introduction to the conjugate gradient method without the agonizing pain," Carnegie Mellon Univ., Pittsburgh, PA, Tech. Rep. CMU-CS-94-125, Aug. 1994.
51. K. Konolige, "Large-scale map-making," in Proc. AAAI Nat. Conf. Artif. Intell., San Jose, CA, 2004, pp. 457-463.
52. T. Duckett, S. Marsland, and J. Shapiro, "Learning globally consistent maps by relaxation," in Proc. IEEE Int. Conf. Robot. Autom., San Francisco, CA, Apr. 2000, pp. 3841-3846.
53. W. Press, S. Teukolsky, W. Vetterling, and B. Flannery, Numerical Recipes in C: The Art of Scientific Computing, 2nd ed. Cambridge, U.K.: Cambridge Univ. Press, 1992.
54. U. Frese, P. Larsson, and T. Duckett, "A multilevel relaxation algorithm for simultaneous localization and mapping," IEEE Trans. Robot., vol. 21, no. 2, pp. 1-12, Apr. 2005.
55. A. Brandt, "Multi-level adaptive solutions to boundary-value problems," Math. Comput., vol. 31, pp. 333-390, 1977.
56. M. Dissanayake, P. Newman, S. Clark, H. 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.
57. Y. Liu and S. Thrun, "Results for outdoor-SLAM using sparse extended information filters," in Proc. IEEE Int. Conf. Robot. Autom., Sep. 2003, vol. 1, pp. 1227-1233.
58. R. Eustice, H. Singh, J. Leonard, M. Walter, and R. Ballard, "Visually navigating the RMS Titanic with SLAM information filters," in Proc. Robot.: Sci. Syst., Cambridge, MA, Jun. 2005, pp. 57-64.
59. B. Triggs, P. McLauchlan, R. Hartley, and A. Fitzgibbon, "Bundle adjustment - A modern synthesis," in Vision Algorithms: Theory and Practice, W. Triggs, A. Zisserman, and R. Szeliski, Eds. New York: Springer-Verlag, 2000, pp. 298-375.
60. C. Stachniss, G. Grisetti, and W. Burgard, "Recovering particle diversity in a Rao-Blackwellized particle filter for SLAM after actively closing loops," in Proc. IEEE Int. Conf. Robot. Autom., Barcelona, Spain, Apr. 2005, pp. 655-660.
61. Z. Zhang and Y. Shan, "Incremental motion estimation through local bundle adjustment," Microsoft Res., Tech. Rep. MSR-TR-01-54, May 2001.
62. R. Hartley and A. Zisserman, Multiple View Geometry in Computer Vision. Cambridge, U.K.: Cambridge Univ. Press, 2000.
63. C. Harris and M. Stephens, "A combined corner and edge detector," Proc. 4th Alvey Vis. Conf., Manchester, U.K., 1988, pp. 147-151.
64. D. Lowe, "Distinctive image features from scale-invariant keypoints," Int. J. Comput. Vis., vol. 60, no. 2, pp. 91-110, 2004.
65. O. Pizarro, "Large scale structure from motion for autonomous underwater vehicle surveys," Ph.D. dissertation, Mass. Inst. Technol./ Woods Hole Oceanogr. Inst. Joint Prog., Woods Hole, MA, Sep. 2004.
66. P. Rousseeuw and A. Leroy, Robust Regression and Outlier Detection. New York: Wiley, 1987.
67. Z. Zhang, "Determining the epipolar geometry and its uncertainty: review," Int. J. Comput. Vis., vol. 27, no. 2, pp. 161-198, 1998.
68. O. Pizarro, R. Eustice, and H. Singh, "Relative pose estimation for instrumented, calibrated imaging platforms," in Proc. Digital Image Comput. Appls., Sydney, Australia, Dec. 2003, pp. 601-612.
69. B. Horn, "Relative orientation," Int. J. Comput. Vis., vol. 4, no. 1, pp. 59-78, Jan. 1990.
70. J. Kinsey, D. Smallwood, and L. Whitcomb, "A new hydrodynamics test facility for UUV dynamics and control research," in Proc. IEEE/MTS OCEANS Conf. Exhib., Sep. 2003, vol. 1, pp. 356-361.
71. D. Smallwood, R. Bachmayer, and L. Whitcomb, "A new remotely operated underwater vehicle for dynamics and control research," in Proc. Int. Symp. Unmanned Untethered Subm. Technol., Durham, NH, 1999, pp. 370-377.
72. D. Coleman, R. Ballard, and T. Gregory, "Marine archaeological exploration of the Black Sea," in Proc. IEEE/MTS OCEANS Conf. Exhib., Sep. 2003, vol. 3, pp. 1287-1291.