Simultaneous Localization and Mapping (SLAM) is perhaps the most fundamental problem to solve in robotics in order to build truly autonomous mobile robots. The sensors have a large impact on the algorithm used for SLAM. Early SLAM approaches focused on the use of range sensors as sonar rings or lasers. However, cameras have become more and more used, because they yield a lot of information and are well adapted for embedded systems: they are light, cheap and power saving. Unlike range sensors which provide range and angular information, a camera is a projective sensor which measures the bearing of images features. Therefore depth information (range) cannot be obtained in a single step. This fact has propitiated the emergence of a new family of SLAM algorithms: the Bearing-Only SLAM methods, which mainly rely in especial techniques for features system-initialization in order to enable the use of bearing sensors (as cameras) in SLAM systems. In this work a novel and robust method, called Concurrent Initialization, is presented which is inspired by having the complementary advantages of the Undelayed and Delayed methods that represent the most common approaches for addressing the problem. The key is to use concurrently two kinds of feature representations for both undelayed and delayed stages of the estimation. The simulations results show that the proposed method surpasses the performance of previous schemes.
References
[1]
Vázquez-Martín, R.; Nú？ez, P.; Bandera, A.; Sandoval, F. Curvature-based environment description for robot navigation using laser range sensors. Sensors？2009, 9, 5894–5918, doi:10.3390/s90805894. 22461732
[2]
Durrant-Whyte, H.; Bailey, T. Simultaneous localization and mapping: part I. IEEE Rob. Autom. Mag？2006, 13, 99–110.
[3]
Bailey, T.; Durrant-Whyte, H. Simultaneous localization and mapping: part II. IEEE Rob. Autom. Mag？2006, 13, 108–117, doi:10.1109/MRA.2006.1678144.
[4]
Davison, A. Real-time simultaneous localization and mapping with a single camera. Proceedings of the ICCV’03, Nice, France, October 13–16, 2003.
[5]
Munguía, R.; Grau, A. Single sound source SLAM. In Lecture Notes in Computer Science; Springer: Berlin, Germany, 2008; Volume 5197, pp. 70–77.
[6]
Williams, G.; Klein, G.; Reid, D. Real-time SLAM relocalisation. Proceedings of the ICCV’07, Rio de Janeiro, Brazil, October 14–20, 2007.
[7]
Chekhlov, D.; Pupilli, M.; Mayol-Cuevas, W.; Calway, A. Real-time and robust monocular SLAM using predictive multi-resolution descriptors. In Advances in Visual Computing; Springer Berlin/Heidelberg: Berlin, Germany, 2006; pp. 276–285.
[8]
Munguía, R.; Grau, A. Closing loops with a virtual sensor based on monocular SLAM. IEEE Trans. Instrum. Measure？2009, 58, 2377–2385, doi:10.1109/TIM.2009.2016377.
[9]
Deans, H.; Martial, M. Experimental comparison of techniques for localization and mapping using a bearing-only sensor. Proceedings of International Symposium on Experimental Robotic, Waikiki, HI, USA, December 11–13, 2000.
[10]
Strelow, S.; Sanjiv, D. Online motion estimation from image and inertial measurements. Proceedings of Workshop on Integration of Vision and Inertial Sensors (INERVIS’03), Coimbra, Portugal, June 2003.
[11]
Bailey, T. Constrained initialisation for Bearing-Only SLAM. Proceedings of IEEE International Conference on Robotics and Automation (ICRA’03), Taipei, Taiwan, September 14–19, 2003.
[12]
Kwok, N.M.; Dissanayake, G. Bearing-only SLAM in indoor environments. Proceedings of Australasian Conference on Robotics and Automation, Brisbane, Australia, December 1–3, 2003.
[13]
Kwok, N.M.; Dissanayake, G. An efficient multiple hypotheses filter for bearing-only SLAM. Proceedings of International Conference on Intelligent Robots and Systems (IROS’04), Sendai, Japan, September 28–October 2, 2004.
[14]
Kwok, N.M.; Dissanayake, G. Bearing-only SLAM using a SPRT based gaussian sum filter. Proceedings of IEEE International Conference on Robotics and Automation (ICRA’05), Barcelona, Spain, April 18–22, 2005.
[15]
Peach, N. Bearing-only tracking using a set of range-parametrised extended Kalman filters. IEE Proc. Control Theory Appl？1995, 142, 21–80.
[16]
Davison, A.; Gonzalez, Y.; Kita, N. Real-Time 3D SLAM with wide-angle vision. Proceedings of IFAC Symposium on Intelligent Autonomous Vehicles, Lisbon, Portugal, July 5–7, 2004.
[17]
Jensfelt, P.; Folkesson, J.; Kragic, D.; Christensen, H. Exploiting distinguishable image features in robotics mapping and localization. Proceedings of European Robotics Symposium, Palermo, Italy, March 16–17, 2006.
[18]
Sola, J.; Devy, M.; Monin, A.; Lemaire, T. Undelayed initialization in bearing only SLAM. Proceedings of IEEE International Conference on Intelligent Robots and Systems, Edmonton, Canada, August 2–6, 2005.
[19]
Lemaire, T.; Lacroix, S.; Sola, J. A practical bearing-only SLAM algorithm. Proceedings of IEEE International Conference on Intelligent Robots and Systems, Edmonton, Canada, August 2–6, 2005.
[20]
Eade, E.; Drummond, T. Scalable monocular SLAM. Proceedings of IEEE Computer Vision and Pattern Recognition, New York, NY, USA, June 17–22, 2006.
[21]
Montemerlo, M.; Thrun, S.; Koller, D.; Wegbreit, B. FastSLAM: Factored solution to the simultaneous localization and mapping problem. Proceedings of National Conference on Artificial Intelligence, Edmonton, AB, Canada, July 28–29, 2002.
[22]
Montiel, J.M.M.; Civera, J.; Davison, A. Unified inverse depth parametrization for monocular SLAM. Proceedings of Robotics: Science and Systems Conference, Philadelphia, PA, USA, August 16–19, 2006.
[23]
Munguía, R.; Grau, A. Delayed inverse depth monocular SLAM. Proceedings of the 17th IFAC World Congress, Coex, Seoul, Korea, July 6–11, 2008.
[24]
Andrade-Cetto, J.; Sanfeliu, A. Environment Learning for Indoor Mobile Robots. A Stochastic State Estimation Approach to Simultaneous Localization and Map Building (Springer Tracts in Advanced Robotics); Springer: Berlin, Germany, 2006; Volume 23.
[25]
Montiel, J.M.M.; Davison, A. Visual compass based on SLAM. Proceedings of IEEE International Conference on Robotics and Automation, Orlando, FL, USA, May 15–19, 2006.
[26]
Bar-Shalom, Y.; Li, X.R.; Kirubarajan, T. Estimation with Applications to Tracking and Navigation; John Wiley & Sons: Hoboken, NJ, USA, 2001.
[27]
Bailey, T.; Nieto, J.; Guivant, J.; Stevens, M.; Nebot, E. Consistency of the ekf-slam algorithm. Proceedings of IEEE International Conference on Intelligent Robots and Systems, Beijing, China, December 4–6, 2006.
