JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE) ›› 2016, Vol. 51 ›› Issue (12): 116-124.doi: 10.6040/j.issn.1671-9352.0.2016.385

Previous Articles    

Fast pose estimation for on-board camera and scene reconstruction in monocular vision SLAM

YANG Yuan-hui, LI Guo-dong*, WU Chun-fu, WANG Xiao-long   

  1. School of Mechanical and Electrical Engineering, Longyan University, Longyan 364012, Fujian, China
  • Received:2016-08-09 Online:2016-12-20 Published:2016-12-20

Abstract: According to the simulaneous localization and mapping(SLAM), a fast pose estimation of on-board camera, together with 3D reconstruction of scene structure algorithm was proposed. The special properties of the Euclidean epipoles corresponding to the mobile robots 2-DOF movement were utilized to calibrate the relative pose information between real camera coordinate and virtual camera coordinate without the utilization of specific calibration object, and the active vision method was utilized to further calibrate the relative position information between mobile robot coordinate and virtual camera coordinate; An constructed infinite homography was adopted to turn the hypothesis Euclidean point correspondences obtained by SIFT algorithm into the virtual hypothesis Euclidean point correspondences, and the RANSAC based normalized 3-point algorithm was implemented to estimate and decompose the essential matrix; The previous 3D information of the observed landmarks were adopted to eliminate the scale uncertainty of the translation vector acquired by essential matrix decomposition, and the scene structure was reconstructed by linear triangulation method. Experimental results show that the proposed algorithm has the advantages of high precision, as well as the low computational complexity.

Key words: essential matrix decomposition, random sample consensus, epipolar geometry, vision SLAM, normalized 3-point algorithm

CLC Number: 

  • TP242
[1] 陈华,王朝立,杨芳, 等. 基于视觉伺服非完整移动机器人的有限时间饱和镇定[J]. 控制理论与应用,2012,29(6):817-823. CHEN Hua, WANG Chaoli, YANG Fang, et al. Finite-time saturated stabilization of nonholonomic mobile robots based on visual servoing[J]. Journal of Control Theory and Application, 2012, 29(6):817-823.
[2] 李宝全,方勇纯,张雪波. 基于2D三焦点张量的移动机器人视觉伺服镇定控制[J]. 自动化学报,2014, 40(12):2706-2715. LI Baoquan, FANG Yongchun, ZHANG Xuebo. 2D Trifocal tensor based visual servo regulation of nonholonomic mobile robots[J]. ACTA Automatica Sinica, 2014, 40(12):2706-2715.
[3] SCHMIDT A, KRAFT M, FULARZ M, et al. On augmenting the visual SLAM with direct orientation measurement using the 5-point algorithm[J]. Journal of Automation Mobile Robotics and Intelligent Systems, 2013, 103(1):5-10.
[4] TRIBOU M J, WASLANDER S L, WANG D W L. Scale recovery in multicamera cluster SLAM with non-overlapping fields of view[J]. Computer Vision and Image Understanding, 2016, 50(C):27-41.
[5] AN S Y, LEE L K, OH S Y. Ceiling vision-based active SLAM framework for dynamic and wide-open environments [J]. Autonomous Robots, 2016, 40(2):291-324.
[6] LONGUET-HIGGINS H C. A computer algorithm for reconstructing a scene from two projections[J]. Nature, 1981, 293:133-135.
[7] HUANG T S, FAUGERAS O D. Some properties of the E matrix in two-view motion estimation[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1989, 11(12):1310-1312.
[8] HORN B K P. Relative orientation[J]. International Journal of Computer Vision, 1990, 4(1):59-78.
[9] HARTLEY R I. In defense of the eight-point algorithm[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 1997, 19(6):580-593.
[10] DIXON W E, DAWSON D M, ZERGEROGLU E, et al. Adaptive tracking control of a wheeled mobile robot via an uncalibrated camera system[J]. IEEE Transactions on Systems, Man, and Cybernetics, Part B: Cybernetics, 2001, 31(3):341-352.
[11] 王伟, 吴成柯. 估计基础矩阵的六点综合算法[J]. 中国科学(E辑), 1997, 27(2):165-170. WANG Wei, WU Chengke. 6-point synthesis algorithm for fundamental matrix estimation[J]. Science of China(E series), 1997, 27(2):165-170.
[12] PHILIP J. A non-iterative algorithm for determining all essential matrices corresponding to five point pairs[J]. The Photogrammetric Record, 1996, 15(88):589-599.
[13] NISTER D. An efficient solution to the five-point relative pose problem[J]. IEEE Transactions on Pattern Analysis and Machine Intelligence, 2004, 26(6):756-770.
[14] STEWENIUS H, ENGELS C, NISTÉR D. Recent developments on direct relative orientation[J]. ISPRS Journal of Photogrammetry and Remote Sensing, 2006, 60(4):284-294.
[15] FAUGERAS O D. What can be seen in three dimensions with an uncalibrated stereo rig[C] //Proceedings of the 2nd European Conference on Computer Vision. Genoa, Italy: The Computer Vision Society, 1992:563-578.
[16] MA Y, KOSECKÁ J, SASTRY S. Optimization criteria and geometric algorithms for motion and structure estimation[J]. International Journal of Computer Vision, 2001, 44(3):219-249.
[17] HELMKE U, HÜPER K, LEE P Y, et al. Essential matrix estimation using Gauss-Newton iterations on a manifold[J]. International Journal of Computer Vision, 2007, 74(2): 117-136.
[18] FAUGERAS O.Three dimensional computer vision: a geometric viewpoint[M]. Massachusetts: the MIT Press, 1993.
[19] HARTLEY R, ZISSERMAN A. Multiple view geometry in computer vision [M]. Cambridge: Cambridge University Press, 2000.
[20] MA Y, SOATTO S, KOSECKA J. An invitation to 3-d vision: from images to geometric models[M]. Berlin: Springer, 2004.
[1] TANG Qing-shun, WU Chun-fu, LI Guo-dong, WANG Xiao-long, ZHOU Feng-yu. An accurate and fast pose estimation algorithm foron-board camera of mobile robot [J]. JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE), 2015, 50(03): 32-39.
[2] WU Chun-fu1, TANG Qing-shun1, XIE Huang-sheng1, ZHOU Feng-yu2*. A novel analytical essential matrix decomposition algorithm#br# [J]. JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE), 2014, 49(03): 31-36.
Viewed
Full text


Abstract

Cited

  Shared   
  Discussed   
No Suggested Reading articles found!