Autonomous Robots

, Volume 24, Issue 1, pp 13–27 | Cite as

A line feature based SLAM with low grade range sensors using geometric constraints and active exploration for mobile robot



This paper describes a geometrically constrained Extended Kalman Filter (EKF) framework for a line feature based SLAM, which is applicable to a rectangular indoor environment. Its focus is on how to handle sparse and noisy sensor data, such as PSD infrared sensors with limited range and limited number, in order to develop a low-cost navigation system. It has been applied to a vacuum cleaning robot in our research. In order to meet the real-time objective with low computing power, we develop an efficient line feature extraction algorithm based upon an iterative end point fit (IEPF) technique assisted by our constrained version of the Hough transform. It uses a geometric constraint that every line is orthogonal or parallel to each other because in a general indoor setting, most furniture and walls satisfy this constraint. By adding this constraint to the measurement model of EKF, we build a geometrically constrained EKF framework which can estimate line feature positions more accurately as well as allow their covariance matrices to converge more rapidly when compared to the case of an unconstrained EKF. The experimental results demonstrate the accuracy and robustness to the presence of sensor noise and errors in an actual indoor environment.


Line feature SLAM EKF Geometric constraint Environmental modeling 


Unable to display preview. Download preview PDF.

Unable to display preview. Download preview PDF.


  1. Burguera, A. et al. (2005). Robust scan matching localization using sonar range finders. In Proceedings of IROS ’05 (pp. 1367–1372), Alberta, Canada. Google Scholar
  2. Choi, Y., & Oh, S. (2006). Grid-based visual SLAM in complex environment. In Proceedings of IROS ’06 (pp. 2563–2569), Beijing, China. Google Scholar
  3. Crowley, J. L. (1989). World modeling and position estimation for a mobile robot using ultrasonic ranging. In Proceedings of ICRA ’89 (pp. 674–680), Scottsdale, AZ, USA Google Scholar
  4. Davison, A. J. (2003). Real-time simultaneous localization and mapping with a single camera. In Proceedings of ICCV ’03 (pp. 1403–1410), Nice, France. Google Scholar
  5. Diosi, A., & Kleeman, L. (2005). Laser scan matching in polar coordinates with application to SLAM. In Proceedings of IROS ’05 (pp. 1439–1444), Canada. Google Scholar
  6. Duda, R. O., & Hart, P. E. (1973). Pattern classification and scene analysis. New York: Wiley. MATHGoogle Scholar
  7. Frese, U. (2006). A discussion of simultaneous and mapping. Autonomous Robots, 20(0), 25–42. CrossRefGoogle Scholar
  8. Großmann, A., & Poli, R. (1999). Robust mobile robot localisation from sparse and noisy proximity readings. In Proceedings of IJCAI ’99 workshop on reasoning with uncertainty in robot navigation (RUR-99). Google Scholar
  9. Hähne, D., Burgard, W., Fox, D., & Thrun, S. (2003). An efficient fastslam algorithm for generating maps of large-scale cyclic environments from raw laser range measurements. In Proceedings of IROS ’03 (pp. 206–211), Las Vegas, Nevada. Google Scholar
  10. Kleeman, L. (2003). Advanced sonar and odometry error modeling for simultaneous localisation and map building. In Proceedings of IROS ’03 (pp. 699–704), Las Vegas, Nevada. Google Scholar
  11. Lowe, D. G. (2004). Distinctive image features from scale-invariant keypoints. International Journal of Computer Vision, 60(2), 91–110. CrossRefGoogle Scholar
  12. Murray, D., & Jennings, C. (1998). Stereo vision based mapping and navigation for mobile robots. In Proceedings of ICRA ’98, (pp. 1694–1699), Leuven, Belgium. Google Scholar
  13. Nguyen, V., Martinelli, A., Tomatis, N., & Siegwart, R. (2005). A comparison of line extraction algorithms using 2d laser rangefinder for indoor mobile robotics. In Proceedings of IROS ’05 (pp. 1768–1773), Edmonton, Canada. Google Scholar
  14. Nguyen, V., Harati, A., Martinelli, A., & Seigwart, R. (2006). Orthogonal SLAM: a step toward lightweight indoor autonomous navigation. In Proceedings of IROS ’06 (pp. 5007–5012), Beijing, China. Google Scholar
  15. Tardos, J. D., Neira, J., Newman, P. M., & Leonard, J. J. (2002). Robust mapping and localization in indoor environments using sonar data. The International Journal of Robotics Research, 21(4), 311–330. CrossRefGoogle Scholar
  16. Tomono, M. (2004). A scan matching method using euclidean invariant signature for global localization and map building. In Proceedings of ICRA ’04, (pp. 866–871), LA, USA. Google Scholar

Copyright information

© Springer Science+Business Media, LLC 2007

Authors and Affiliations

  1. 1.Department of Electrical EngineeringPohang University of Science and TechnologyPohangRepublic of Korea

Personalised recommendations