Abstract
This paper presents a novel approach to the vision based grid map building and localization problem that works in a complex indoor environment with a single forward viewing camera. Most existing visual SLAM has been limited to the feature-based method and only a few researchers have proposed visual SLAM methods for building a grid map using a stereo vision system which has not been popular in practical application. In this paper, we estimate the planar depth by applying a simple visual sonar ranging technique to the single camera image and then associating sequential scans through our own pseudo dense adaptive scan matching algorithm reducing the processing time compared to the standard point-to-point correspondence based algorithm and finally produce a grid map. To this end, we construct a Pseudo Dense Scan (PDS) which is an odometry based temporal accumulation of the visual sonar readings emulating omni-directional sensing in order to overcome the sparseness of the visual sonar. Moreover, in order to obtain a much more refined map, we further correct the slight trajectory error incurred in the PDS construction step using Sequential Quadratic Programming (SQP) which is a well-known optimization scheme. Experimental results show that our method can obtain an accurate grid map using a single camera without the need for a high price range sensors or stereo camera.
Similar content being viewed by others
References
Baiely, T., & Durran-Whyte, H. (2006). Simultaneous localization and mapping: Part II. Robotics & Automation Magazine, IEEE, 13(3), 108–117.
Bengtsson, O., & Baerveldt, A. (2003). Robot localization based on scan-matching—estimating the covariance matrix for the IDC algorithm. Robotics and Autonomous Systems, 44, 29–40.
Burguera, A. et al. (2005). Robust Scan Matching Localization using Ultrasonic Range Finders. In Proceedings of the international conference on intelligent robots and systems.
Choi, Y., & Oh, S. (2005). Visual sonar based localization using particle attraction and scattering. In Proceedings of the international conference on mechatronics and automation.
Davison, J. (2003). Real-time simultaneous localization and mapping with a single camera. In Proceedings of the international conference computer vision.
Dissanayake, G., Newman, P., Clark, S., Durrant-Whyte, H. F., & Csorba, M. (2001). A solution to the simultaneous localization and map building (SLAM) problem. IEEE Transaction on Robotics and Automation.
Durran-Whyte, H., & Bailey, T. (2006). Simultaneous localization and mapping: Part I. Robotics & Automation Magazine, IEEE, 13(2), 99–110.
Frese, U. (2006). A discussion of simultaneous and mapping. Autonomous Robots, 20, 25–42.
Gartshore, R., Aguado, A., & Galambos, C. (2002). Incremental Map Building using Occupancy Grid for an Autonomous Monocular Robot. In Proceedings of the international conference on control, automation, robotics and vision.
Gutmann, J. S., & Schlegel, C. (1996). AMOS: comparison of scan matching approaches for self-localization in indoor environments. In Euromicro Workshop in Advanced Mobile Robotics.
Jung, W., & Lee, K. (2005). CV-SLAM: A new Ceiling Vision-based SLAM technique. In Proceedings of the international conference on intelligent robots and systems.
Kim, G., Kim, J., & Hong, K. (2005). Vision-based simultaneous localization and mapping with two cameras. In Proceedings of the international conference on intelligent robots and systems.
Krose, B., Vlassis, N., Bunschoiten, R., & Motomura, Y. (2001). A probabilistic model for appearance-based robot localization. Image and Vision Computing, 6(19), 381–391.
Lenseir, S., & Veloso, M. (2003). Visual sonar: fast obstacle avoidance using monocular vision. In Proceedings of the international conference on intelligent robots and systems.
Lowe, D. (2004). Distinctive image features from scale-invariant keypoints. International Journal of Computer Vision, 60(2), 91–110.
Lu, F., & Milios, E. (1997). Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans. International Journal of Intelligent and Robotic Systems, 18, 249–275.
Murray, D., & Jennings, C. (1998). Stereo vision based mapping and navigation for mobile robots. In Proceedings of the international conference on robotics and automation (pp. 1694–1699).
Se, S., Lowe, D., & Litte, J. (1989). Mobile robot localization and mapping with uncertainty using scale-invariant visual landmarks. International Journal of Robotics Research.
Sim, R., & Dudek, G. (1999). Learning and evaluating visual features for pose estimation. Transaction on Robotics and Automation of Int. Conf. on Computer Vision.
Tomono, M. (2005). Efficient global scan matching using saliency-based scan point resampling. In Proceedings of the international conference on intelligent robots and systems.
Wolf, D. F., & Sukhatme, G. S. (2005). Mobile robot simultaneous localization and mapping in dynamic environments. Autonomous Robots, 19, 53–65.
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Choi, YH., Oh, SY. Map building through pseudo dense scan matching using visual sonar data. Auton Robot 23, 293–304 (2007). https://doi.org/10.1007/s10514-007-9046-7
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10514-007-9046-7