一种基于特征光标点的单目视觉位姿测量系统及方法技术方案

本发明专利技术提供了一种基于特征光标点的单目视觉位姿测量系统及方法，包括获取图像：通过单目相机获取位姿图像序列；图像二值化：目标物体处于运动状态采用自适应阈值法进行图像二值化；轮廓提取：除去图像中明显的噪声点，提取图像轮廓；圆拟合：采用最小二乘法进行圆拟合，根据圆的性质判断是否为圆；确定圆心坐标，根据圆面积大小依次排序，找到圆之间位置对应关系；位姿解算：建立图像坐标与空间位置间的关系得出运动目标间的距离、速度、角速度等相关信息。本发明专利技术具有结构简单、测量视场大、实时性强的特点，降低了特征提取难度和位姿解算的复杂度。

A monocular vision pose measurement system and method based on characteristic cursor points

【技术实现步骤摘要】
一种基于特征光标点的单目视觉位姿测量系统及方法
本专利技术涉及视觉检测
，具体涉及一种基于特征光标点的单目视觉位姿测量系统及方法。
技术介绍
目前基于视觉位姿测量的主要方法包括基于双目视觉的位姿测量和基于单目视觉的位姿测量。基于双目视觉的位姿测量匹配算法计算量大，复杂程度高，测量精度受标定精度、匹配误差和摄像机安装相对误差等因素的影响。而基于单目视觉的位姿测量利用特征点之间的空间位置关系、图像中提取的特征点图像坐标以及成像模型参数求解摄像机坐标系和世界坐标系之间的相对位置和相对姿态，具有测量范围大、结构简单、受干扰小、非接触等优点，已广泛应用于物体识别、跟踪导航、三维姿态估计、场景分析等多个领域。基于单目视觉的位姿测量大多需要在目标物体上设置特征靶标，建立目标坐标系，预先设定好被测特征点在目标坐标系下的坐标值，再根据经典摄像机小孔成像原理，根据三个或三个以上不在同一条直线上被测特征点在摄像机坐标系与目标坐标系下的坐标值，解算出摄像机坐标系与目标坐标系的相对转换关系，完成了被测目标相对于摄像机坐标系的空间三维姿态。针对目标物体坐标未知、目标坐标系无法建立的情况下，基于单目视觉的位姿测量仍然存在位姿测量困难的难题。
技术实现思路
本专利技术要解决的技术问题在于，针对上述目前针对目标物体坐标未知、目标坐标系无法建立的情况下基于单目视觉的位姿测量存在位姿测量困难的的技术问题，提供一种基于特征光标点的单目视觉位姿测量系统及方法解决上述技术缺陷。一种基于特征光标点的单目视觉位姿测量系统，包括处理器、单目相机、两个运动目标和两个靶标，其中处理器和单目相机相连；两个靶标分别安装在两个运动目标上，每个靶标上安装有两个圆形光标点，四个圆形光标点的直径各不相同，每个靶标上的两个光标点之间的距离分别为d1和d2；单目相机能够获取两个靶标的整体图像，在相机视场内采集运动目标的序列位姿图像；处理器根据相机标定得出像素坐标系和运动物体坐标系之间的变化关系，再利用P4P算法计算出两个运动目标的位姿信息。一种基于特征光标点的单目视觉位姿测量方法，基于一种基于特征光标点的单目视觉位姿测量系统实现，包括：S1、单目相机采集序列位姿图像，然后根据张氏标定法对序列位姿图像进行校正，根据校正后的位姿图像采用局部自适应阈值法进行二值化处理，根据每个像素的邻域块的像素值分布确定每个像素位置上的阈值；S2、根据二值化图像提取所有轮廓，根据圆轮廓的特性遍历所有轮廓得到圆轮廓，对圆轮廓进行圆曲线拟合，根据拟合结果得出圆心坐标；S3、根据图像处理得到圆心坐标结合相机标定参数求解相对位姿。进一步的，步骤S2具体包括：S21、处理二值化图像提取所有轮廓，遍历所有轮廓统计每个轮廓上像素点的数量，根据轮廓上像素点数量过滤噪声点；S22、根据圆的特性依次检验所有轮廓，采用RANSAC算法进行圆拟合，根据拟合结果计算圆心坐标，根据圆的面积排序确定圆之间位置关系；S23、根据圆心坐标和圆位置关系计算每个运动目标上发光圆之间像素距离d1'、d2'。进一步的，步骤S3具体包括：S31、根据前面图像处理得到的特征参数结合相机标定参数求解相对位姿，建立像素坐标系与世界坐标系之间的对应关系，Ow表示世界坐标系原点，Oc表示像素坐标系原点，(U,V)表示成像平面；从Ow坐标系到(U,V)成像平面之间的转换关系是：其中，f是相机焦距，dx和dy分别表示每个像素在横轴x和纵轴y的物理尺寸，R和T分别表示相机坐标系和世界坐标系的旋转矩阵和平移向量，Xw、Yw、Zw为世界坐标系的三轴坐标，u、v为像素坐标系的两轴坐标；S32、利用提取的目标物体中的特征靶标距离d1、d2和相应的相点坐标距离d1'、d2'构成二维成像平面和三维世界的匹配，结合S31中的相机内外参数矩阵，利用P4P算法进行位姿解算，即可得到运动目标的位姿信息。与现有技术相比，本专利技术的有益效果在于：本专利技术提供了一种基于特征光标点的单目视觉位姿测量系统及方法，具有标定简单、特征提取容易和位姿解算简单的特点附图说明下面将结合附图及实施例对本专利技术作进一步说明，附图中：图1为本专利技术一种基于特征光标点的单目视觉位姿测量方法流程图；图2为本专利技术的坐标转换图。具体实施方式为了对本专利技术的技术特征、目的和效果有更加清楚的理解，现对照附图详细说明本专利技术的具体实施方式。如图1所示，本专利技术实施例包括如下步骤：在两运动目标上安装具有特征光标点的靶标，在相机视场内采集运动目标的序列位姿图像，目标物体处于动态运动状态，舍弃固定阈值法而采用自适应阈值法中Otsu算法对图像进行二值化，通过统计灰度级中每个像素在整幅图像中的个数，计算出每个像素在整幅图像的概率分布。对灰度级进行遍历搜索，计算当前灰度值下前景背景类间概率。通过目标函数计算出类内与类间方差下对应的阈值。提取整幅图片中所有轮廓，每个轮廓大小不一，那么不同的轮廓上的像素点总数会有很大的差别。4个圆轮廓上的像素点的总数满足一定的范围，为了过滤掉一些比较小的和比较大的轮廓，遍历所有轮廓统计每个轮廓上像素点的数量，根据轮廓上像素点数量结合运动物体上的特征，判断是否轮廓的像素点总数处于一个范围(在实验中设置的范围是4到300)，以此过滤掉一部分不可能是圆的轮廓，简化计算难度。选择轮廓并计算轮廓的质心，然后计算轮廓上的每一个点到质心的距离，最后得到距离的方差。理论上，圆上的每一个点到圆心的距离是等于半径，理想的情况下，距离的方差等于。实际情况中，轮廓上存在一些噪声点，所以实际算得的距离的方差是大于0的，但是值很小，小于某个阈值。对于距离方差的阈值依赖性太强，并且距离方差的阈值不易确定，阈值的变化范围太大。阈值稍稍设小了，就会有圆漏检；一旦设大了，就会存在圆误检的情况。实时检测过程中，没有一个固定的阈值能满足所有的情况。为了减弱算法对于参数的依赖性，提出一种新的方法去识别圆。圆的面积S＝πR2，周长l＝2πR，根据这个比例关系，可以判断轮廓是否为圆。由于提取的轮廓存在噪声点，提取的圆的轮廓不会严格的满足这个比例关系，但是实际的比例在1的左右不会有太大的波动。算法中设定的这个范围为0.8到1.2。这个阈值一旦设定，实时检测时不需要再去改变，且提高了正确检测到圆心的概率。通过圆的性质准确识别出为圆的轮廓后，进一步就需要计算圆心。对于动态靶标的识别，噪声数据比静态靶标多，最小二乘法拟合速度快但在噪声数据多的情况下拟合效果不理想。提出RANSAC算法进行圆曲线拟合。RANSAC算是随机抽样一致的缩写，它可以从一组包含“局外点”的观测数据集中，通过迭代方式估计数学模型的参数。对于含噪声比较多的数据，RANSAC圆拟合能取得不错的效果。根据前面图像处理得到的特征参数结合相机标定参数求解相对位姿。如图2所示，建立图像坐标与空间位置之间的相互关系。Ow表示实物空间坐标系，OC表示相机坐标系原点，(U,V)表示成像平面。从Ow坐标系到(U,V)成像平面之间的转换关系如公式(1)所示：其中，f是相机焦距，dx和dy分别表示每个像素在横轴x和纵轴y的物理尺寸，R和T分别表示相机坐标系和世界坐标系的旋转矩阵和平移向量。根据得到的像素坐标在像素坐标系进行坐标变换，在UOV坐标系中首先对获取的图像进行图像识别，将四个圆的圆心识别出来，分本文档来自技高网...

【技术保护点】
1.一种基于特征光标点的单目视觉位姿测量系统，其特征在于，包括处理器、单目相机、两个运动目标和两个靶标，其中处理器和单目相机相连；两个靶标分别安装在两个运动目标上，每个靶标上安装有两个圆形光标点，四个圆形光标点的直径各不相同，每个靶标上的两个光标点之间的距离分别为d1和d2；单目相机能够获取两个靶标的整体图像，在相机视场内采集运动目标的序列位姿图像；处理器根据相机标定得出像素坐标系和运动物体坐标系之间的变化关系，再利用P4P算法计算出两个运动目标的位姿信息。

【技术特征摘要】
1.一种基于特征光标点的单目视觉位姿测量系统，其特征在于，包括处理器、单目相机、两个运动目标和两个靶标，其中处理器和单目相机相连；两个靶标分别安装在两个运动目标上，每个靶标上安装有两个圆形光标点，四个圆形光标点的直径各不相同，每个靶标上的两个光标点之间的距离分别为d1和d2；单目相机能够获取两个靶标的整体图像，在相机视场内采集运动目标的序列位姿图像；处理器根据相机标定得出像素坐标系和运动物体坐标系之间的变化关系，再利用P4P算法计算出两个运动目标的位姿信息。2.一种基于特征光标点的单目视觉位姿测量方法，基于一种基于特征光标点的单目视觉位姿测量系统实现，其特征在于，包括：S1、单目相机采集序列位姿图像，然后根据张氏标定法对序列位姿图像进行校正，根据校正后的位姿图像采用局部自适应阈值法进行二值化处理，根据每个像素的邻域块的像素值分布确定每个像素位置上的阈值；S2、根据二值化图像提取所有轮廓，根据圆轮廓的特性遍历所有轮廓得到圆轮廓，对圆轮廓进行圆曲线拟合，根据拟合结果得出圆心坐标；S3、根据图像处理得到圆心坐标结合相机标定参数求解相对位姿。3.根据权利要求2所述的一种基于特征光标点的单目视觉位姿测量方法，其特征在于，步骤S2具体包括：S21、...

【专利技术属性】
技术研发人员：张莉君，黄顺，姜珺，郭辉，
申请(专利权)人：中国地质大学武汉，
类型：发明
国别省市：湖北,42