JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE) ›› 2015, Vol. 50 ›› Issue (03): 32-39.doi: 10.6040/j.issn.1671-9352.0.2014.444

Previous Articles     Next Articles

An accurate and fast pose estimation algorithm foron-board camera of mobile robot

TANG Qing-shun1, WU Chun-fu1, LI Guo-dong1, WANG Xiao-long1, ZHOU Feng-yu2   

  1. 1. School of Physics and Mechanical and Electrical Engineering, Longyan College, Longyan 364012, Fujian, China;
    2. School of Control Science and Engineering, Shandong University, Jinan 250061, Shandong, China
  • Received:2014-10-09 Revised:2015-01-16 Online:2015-03-20 Published:2015-03-13

PDF (PC)

1752

Abstract: An accurate and fast pose estimation problem for on-board camera of mobile robot is investigated. Firstly the special properties of the pose for on-board camera of mobile robot are analyzed. Secondly, an auxiliary rotation matrix is constructed using the on-board camera's equivalent rotation axis, which is utilized to turn the initial essential matrix and homography matrix into a simplified kind that can be decomposed through elementary mathematical operations. Finally, some simulation experiments are designed to verify the algorithm's rapidity, accuracy and robustness. The experimental results show that compared to traditional algorithms, the proposed algorithm can acquire higher accuracy and faster calculating speed, together with the robustness to the disturbance of the on-board camera's equivalent rotation axis. In addition, the number of possible solutions are reduced one half, and the unique rotation angle of the mobile robot can be determined except for the condition that the 3D planar scene structure and the ground are perpendicular, which can provide great convenience for controlling the pose of the mobile robot.

Key words: pose estimation, homography matrix decomposition, on-board camera, essential matrix decomposition, mobile robot

CLC Number: 

  • TP24.2
[1] FUSIELLO A, TRUCCO E, VERRI A. A compact algorithm for rectification of stereo pairs[J]. Machine Vision and Applications, 2000, 12(1):16-22.
[2] ZHI Qi, COOPERSTOCK J R. Toward dynamic image mosaic generation with robustness to parallax[J]. IEEE Transactions on Image Processing, 2012, 21(1):366-378.
[3] POLLEFEYS M, KOCH R, VERGAUWEN M, et al. Automated reconstruction of 3D scenes from sequences of images[J]. ISPRS Journal of Photogrammetry and Remote Sensing, 2000, 55(4):251-267.
[4] AZUMA R, BAILLOT Y, BEHRINGER R, et al. Recent advances in augmented reality[J]. IEEE Transactions on Computer Graphics and Applications, 2001, 21(6):34-47.
[5] MALIS E, CHAUMETTE F. 2 1/2 D visual servoing with respect to unknown objects through a new estimation scheme of camera displacement[J]. International Journal of Computer Vision, 2000, 37(1):79-97.
[6] SILVEIRA G, MALIS E, RIVES P. An efficient direct approach to visual SLAM[J]. IEEE Transactions on Robotics, 2008, 24(5):969-979.
[7] ZHANG Xue, FANG Yongchun, LIU Xi. Motion-estimation-based visual servoing of nonholonomic mobile robots[J]. IEEE Transactions on Robotics, 2011, 27(6):1167-1175.
[8] 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.
[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] NISTR 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.
[11] MA Yi, 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.
[12] HELMKE U, HPER 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.
[13] HARTLEY R, ZISSERMAN A. Multiple view geometry in computer vision[M]. Cambridge:Cambridge University Press, 2003.
[14] TORR P H S, ZISSERMAN A. MLESAC: a new robust estimator with application to estimating image geometry[J]. Computer Vision and Image Understanding, 2000, 78(1):138-156.
[15] LONGUET-HIGGINS H C. A computer program for reconstructing a scene from two projections[J]. Nature, 1981, 293:133-135.
[16] TSAI R Y, HUANG T S. Uniqueness and estimation of 3D motion parameters of rigid bodies with curved surfaces[J]. IEEE Transaction on Pattern Analysis and Machine Intelligence, 1984, 6:13-27.
[17] HARTLEY R I. Estimation of relative camera positions for uncalibrated cameras[C]//Proceedings of 2nd European Conference on Computer Vision. Berlin: Springer-Verlag, 1992: 579-587.
[18] WANG Wei, TSUI H T. A SVD decomposition of essential matrix with eight solutions for the relative positions of two perspective cameras[C]//Proceedings of the 15th International Conference on Pattern Recognition. Los Alamitos: IEEE Computer Society, 2000, 1:362-365.
[19] FAUGERAS O D, LUSTMAN F. Motion and structure from motion in a piecewise planar environment[J]. International Journal of Pattern Recognition and Artificial Intelligence, 1988, 2(3):485-508.
[20] ZHANG Zhongfei, HANSON A R. 3D reconstruction based on homography mapping[C]// Proceedings of ARPA96.[S.l.]:[s.n.], 1996:1007-1012.
[21] MALIS E, VARGAS M. Deeper understanding of the homography decomposition for vision-based control[R]. Research Report INRIA Sophia-Antipolis, 2007.
[22] LI Guodong, TIAN Guohui, WANG Hongjun, et al. A fast homography decomposition algorithm in the case of known normal to the scene plane[J]. Control and Decision, 2014, 29(4):735-738.
[23] ZHANG Xuebo, FANG Yongchun, MA Bojun, et al. A fast homography decomposition technique for visual servo of mobile robots[C]//Proceedings of the 27th Chinese Control Conference.Piscataway: IEEE, 2008:404-409.
[24] 李国栋, 田国会, 王洪君. 服务机器人智能空间中QR Code人工地标的设计、定位与识读[J]. 高技术通讯, 2013, 23(12):1275-1283. LI Guodong, TIAN Guohui, WANG Hongjun. Design, localization and recognition of the QR code-based artificial landmark in service robot intelligent space[J]. Chinese High Technology Letters, 2013, 23(12):1257-1283.
[1] YANG Yuan-hui, LI Guo-dong, WU Chun-fu, WANG Xiao-long. Fast pose estimation for on-board camera and scene reconstruction in monocular vision SLAM [J]. JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE), 2016, 51(12): 116-124.
[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!
Copyright 2018 © Editorial office of JOURNAL OF SHANDONG UNIVERSITY(NATURAL SCIENCE)
Supported by Beijing Magtech Co.Ltd