基于亚像素的乒乓球机器人本体位姿视觉测量

提出一种基于亚像素精度的特征点提取算法,结合PnP方法和正交迭代(OI)算法计算乒乓球机器人本体的位姿.根据摄像机成像时弥散斑的近似高斯分布,以亚像素精度精确求取色标块的边缘,利用边缘直线交点得到高精度的角点作为特征点.基于PnP算法利用上述特征点求取机器人位姿的初值,再通过OI算法进行优化,以保证其姿态矩阵的正交性.实验结果表明,该方法能快速准确地实现机器人本体的位姿测量.

Vision-based Pose Measurement of Ping-Pong Robot Body with Sub-pixel Accuracy

A method with sub-pixel accuracy is proposed to extract feature points,and P P and OI algorithms are combined to measure the pose of a ping-pong robot body.According to the approximate Gaussian distribution of the dispersion spot of camera imaging,the edges of the color mark are obtained in sub-pixel accuracy.Their intersections form high accurate corners,which are considered as feature points.The estimated pose value obtained by the P P-based algorithm is taken as the initial value.The OI algorithm is employed to optimize the pose in order to ensure the orthogonality of the orientation matrix.Experimental results show that the proposed method can measure the pose of robot body quickly and accurately.