A FastSLAM-based algorithm for omnidirectional cameras

Cristina Gamallo Solórzano, Manuel Mucientes Molina, Carlos Vázquez Regueiro

Abstract

Environments with a low density of landmarks are difficult for vision-based Simultaneous Localization and Mapping (SLAM) algorithms. The use of omnidirectional cameras, which have a wide field of view, is specially interesting in these environments as several landmarks are usually detected in each image. A typical example of this kind of situation happens in indoor environments when the lights placed on the ceiling are the landmarks. The use of omnivision combined with this type of landmarks presents two challenges: the data association and the initialization of the landmarks with a bearing-only sensor. In this paper we present a SLAM algorithm based on the wellknown FastSLAM approach. The proposal includes a novel hierarchical data association method based on the Hungarian algorithm, and a delayed initialization of the landmarks. The approach has been tested on a real environment with a Pioneer 3-DX robot.

Keywords

Simultaneous localization and mapping; FastSLAM; Omnidirectional camera; Hungarian association

References


M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, “FastSLAM: A Factored Solution to the Simultaneous Localization and Mapping Problem,” in Proceedings of the AAAI National Conference on Artificial Intelligence, Edmonton, Canada, 2002.

S. Thrun, W. Burgard, and D. Fox, “A Probabilistic Approach to Concurrent Mapping and Localization for Mobile Robots,” Autonomous Robots, vol. 5, pp. 253–271, 1998.

J. A. Castellanos and J. D. Tard´os, “Mobile Robot Localization and Map Building: A Multisensor Fusion Approach,” in Proceedings of the International Symposium on Experimental Robotics, 1999, pp. 173–178.

J. J. Leonard and H. F. Durrant-White, “Simultaneous map building and localization for an autonomous mobile robot,” in Proceedings of the IEEE/RSJ International on Intelligent Robots and Systems (IROS), Workshop on Intelligence for Mechanical Systems, Osaka, Japan, 1991, pp. 1442–1447.

J. D. Tardos, J. Neira, P. M. Newman, and J. J. Leonard, “Robust Mapping and Localization in Indoor Environments Using Sonar Data,” The International Journal of Robotics Research, vol. 21, no. 4, pp. 311–330, 2002.

A. J. Davison and D. W. Murray, “Mobile Robot Localisation using Active Visual Sensing,” in Proceedings of the Fifth European Conference on Computer Vision, 1998, pp. 809–825.

A. J. Davison and D. W. Murray, “Simultaneous localization and mapbuilding using active vision,” IEEE Transactions on Pattern Analysis and Machine Intelligence, vol. 24, no. 7, pp. 865–880, 2002.

N. Karlsson, E. di Bernardo, J. Ostrowski, L. Goncalves, P. Pirjanian, and M. E. Munich, “The vSLAM Algorithm for Robust Localization and Mapping,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), 2005, pp. 24–29.

P. Furgale and T. D. Barfoot, “Visual teach and repeat for long-range rover autonomy,” Journal of Field Robotics, vol. 27, no. 2006, pp. 534–560, 2010.

S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics. MIT Press, 2003.

H. Andreasson, T. Duckett, and A. Lilienthal, “Mini-SLAM: Minimalistic Visual SLAM in Large-Scale Environments Based on a New Interpretation of Image Similarity,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), 2007, pp. 4096–4101.

E. Eade and T. Drummond, “Scalable Monocular SLAM,” in Proceedings of the IEEE Conference on Computer Vision and Pattern Recognition (CVPR), vol. 1, 2006, pp. 469–476.

J. Nieto, J. Guivant, E. Nebot, and S. Thrun, “Real time data association for fastslam,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), sept. 2003, pp. 412–418.

M. Montemerlo and S. Thrun, FastSLAM: A Scalable Method for the Simultaneous Localization and Mapping Problem in Robotics. Springer, 2007.

H. W. Kuhn, “The Hungarian method for the assignment problem,” Naval Research Logistics Quarterly, vol. 2, no. 1-2, pp. 83–97, 1955.

J. Neira and J. Tard´os, “Data association in stochastic mapping using the joint compatibility test,” IEEE Transactions on Robotics and Automation, vol. 17, no. 6, pp. 890–897, 2001.

J. S. I. Ortega, T. Lemaire, M. Devy, S. Lacroix, and A. Monin, “Delayed vs undelayed landmark initialization for bearing-only SLAM,” in Proceedings of the IEEE Internacional Conference on Robotics and Automation (ICRA), Workshop on SLAM, 2005.

N. Kwok and G. Dissanayake, “An Efficient Multiple Hypothesis Filter for Bearing-Only SLAM,” in Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2004, pp. 736–741.

T. Lemaire and S. Lacroix, “SLAM with Panoramic Vision,” Journal of Field Robotics, vol. 24, no. 1-2, pp. 91–111, 2007.

A. J. Davison, “Real-time simultaneous localisation and mapping with a single camera,” in Proceedings of the Ninth IEEE International Conference on Computer Vision (ICCV), 2003, pp. 1403–1410.

M. Deans and M. Hebert, “Invariant filtering for simultaneous localization and mapping,” in Proceedings of the IEEE International Conference onRobotics and Automation (ICRA), 2000, pp. 1042–1047.

C. Schlegel and S. Hochdorfer, “Bearing-Only SLAM with an Omnicam: An Experimental Evaluation for Service Robotics Applications,” Autonome Mobile Systeme, pp. 99–106, 2005.

J. Civera, A. J. Davison, and J. M. M. Montiel, “Inverse Depth to Depth Conversion for Monocular SLAM,” in Proceedings of the IEEE International Conference on Robotics and Automation (ICRA), 2007, pp. 2778–2783.

C. Gamallo, C. V. Regueiro, P. Quint´ıa, and M. Mucientes, “Omnivisionbased KLD-Monte Carlo Localization,” Robotics and Autonomous Systems, vol. 58, no. 3, pp. 295–305, 2010.

H. Bakstein and T. Pajdla, “Panoramic Mosaicing with a 180 field of view lens,” in Proceedings of the Third workshop on Omnidirectional Vision, 2002, pp. 60–67.

C. Gamallo, C. V. Regueiro, and M. Mucientes, “A FastSLAM Algorithm for Omnivision,” in Proceedings of the XIII Workshop of Physical Agents, 2012, pp. 7–14.




DOI: https://doi.org/10.14198/JoPha.2013.7.1.03