Monocular vision pose measurement algorithm based on points feature
-
摘要: 针对位姿求解过程中存在的解不唯一、选解难和解的精度不高等问题,提出一种基于点特征的单目视觉位姿测量算法。首先,根据共面4个特征点之间的位置关系,分别对平行和相交两种情况进行分析;其次,根据特征点的空间坐标、图像坐标和空间位置关系,推导出世界坐标系中3个坐标轴上的向量变换到摄像机坐标系中的单位向量,进而求解出物体相对于摄像机的初始位姿;最后,用LM算法对初始位姿进行优化,得到最终位姿。实验结果表明:文中算法的合成误差为0.54 mm;现有的EPnP算法、两点一线算法和P3P算法的合成误差分别为1.28、1.52和4.26 mm;文中算法的合成误差分别减小了57.8%、64.4%和87.3%,优于现有的EPnP算法、两点一线算法和P3P算法。Abstract: Aiming at the problems that the solutions were not unique, the correct solution was difficult to select and the accuracy was not high during processing the solution, an monocular vision pose measurement algorithm based on point features was proposed. Firstly, according to the position relationship between the four coplanar feature points, the parallel and the intersection conditions were analyzed respectively; Secondly, according to the spatial coordinates, image coordinates and spatial position relationships of the feature points, the corresponding unit vectors in the camera coordinate of the three coordinate axes in the world coordinate were derived, then the initial pose of the object to the camera was obtained; Finally, the initial pose was optimized with the LM algorithm to obtain the final pose. The experimental results show that the synthesis error of the article algorithm is 0.54 mm, the errors of the synthesis of the existing EPnP algorithm, two-point one-line algorithm and P3P algorithm are 1.28 mm, 1.52 mm and 4.26 mm, respectively. The synthesis error of the article algorithm is reduced by 57.8%, 64.4% and 87.3% respectively. All in all, the article algorithm is superior to the existing EPnP algorithm, two-point one-line algorithm and P3P algorithm.
-
Key words:
- monocular vision /
- perspective projection /
- pose measurement /
- coplanar feature points /
- PnP problem
-
[1] Hou Jia, Li Haifeng, Zheng Zhenrong, et al. Distortion correction for imaging on non-planar surface using freeform lens[J]. Optics Communications, 2012, 285(6):986-991. [2] Edward Rosten, Rohan Loveland. Camera distortion self-calibration using the plumb-1ine constraint and minimal hough entropy[J]. Machine Vision and Applications, 2011, 22(1):77-85. [3] Wang Qiyue, Wang Zhongyu. Spacecraft pose measurement based on monocular vision[J]. Applied Optics, 2017, 38(2):250-255. (in Chinese) [4] Wang Zhiqiang, Cheng Hong, Yang Guang, et a1. Fast target location method of global image registration[J]. Infrared and Laser Engineering, 2015, 44(S1):225-229. (in Chinese) [5] Zhou Xin, Zhu Feng. Some discussions on the uniqueness conditions of solutions to P3P problems[J]. Chinese Journal of Computers, 2003, 26(12):1696-1701. (in Chinese) [6] Yao Zhenjian, Wang Zhongyu, Li Dan. Error analysis of pose measurement with monocular vision based on isosceles triangle model[J]. Acta Metrologica Sinica, 2014, 35(z1):19-25. (in Chinese) [7] Hu Zhanyi, Lei Cheng, Wu Fuchao. A short note on P4P problem[J]. Acta Automatica Sinica, 2001, 27(6):770-776. (in Chinese) [8] Wu Fuchao. A study on the P5P problem[J]. Journal of Software, 2001, 12(5):768-775. (in Chinese) [9] Wang Tianyu, Dong Wenbo, Wang Zhenyu. Position and Orientation measurement system based on monocular vision and fixed target[J]. Infrared and Laser Engineering, 2017, 46(4):0427003. (in Chinese) [10] Liu Chang, Zhu Feng, Xia Renbo. Monocular pose determination from coplanar two points and one line features[J]. Application Research of Computers, 2012, 29(8):3145-3147. (in Chinese) [11] Wang Xiaojian, Pan Shunliang, Qiu Liwei, et al. Position and pose estimation algorithms based on the features of double Parallel lines[J]. Journal of Instrumentation, 2008, 29(3):600-604. (in Chinese) [12] Xiao Xizhen, Li Wentao, Tang Yandong, et at. Position and pose measurement of rectangle with unknown aspect ratio based on nonlinear optimization[J]. Information and Control, 2016, 45(1):108-113. (in Chinese) [13] Liu Yinxiao, Wei Wei. Target points positioning algorithm based on rare information in uncalibrated camera's photos[J]. Application Research of Computer, 2015, 32(1):272-275. (in Chinese) [14] Jiang Wensong, Wang Zhongyu. Calibration of visual model for space manipulator with a hybrid LM-GA algorithms[J]. Mechanical Systems and Signal Processing, 2016, 66(1):399-409. (in Chinese)
计量
- 文章访问数: 453
- HTML全文浏览量: 102
- PDF下载量: 97
- 被引次数: 0