导管管端高精度检测定位方法
技术领域
本发明涉及计算机视觉
技术领域
,具体的说是一种导管管端高精度检测定位方法。背景技术
导管管端指的是管路端面中心点。在管路装配前,管路端面中心点的相对位置精度是保证管路准确安装的关键。然而由于导管在弯管机弯曲过程中会发生弹性形变,导致导管两端的端点位置和距离发生变化,而对装配造成影响,因此需要对导管管端进行高精度测量保证无应力装配。
目前对成型的弯管测量方式主要是接触式的,例如靠模法、三坐标测量机、关节式坐标测量机等,这些方法存在对比装置制造困难,容易造成损伤或变形,效率低,过分依赖操作者主观判断,无法重建三维模型以及无定位基准等缺陷。因此如何有效地缩短研制时间、降低研制成本、提高产品质量是弯管快速加工制造的主要目的。
传统的拟合末端轮廓的方法是对导管末端投影进行椭圆拟合,当管径较小时,管路末端的投影无法拟合椭圆,这会带来较大的定位误差。
孙鹏等人在“基于多目视觉的管路端点坐标测量方法研究”中,利用投影倾斜度,将拟合轮廓和中心线的端点定位方法相结合,计算不同角度下的导管端点,然而计算出的端点精度较差。
发明内容
针对现有技术中存在的上述不足之处,本发明要解决的技术问题是提供一种导管管端高精度检测方法,该方法对导管管端建立精确投影模型,对导管末端进行三维重建,操作简单,测量效率较高,能有效提高管路端点的测量精度。
本发明为实现上述目的所采用的技术方案是:导管端面高精度检测定位方法,包括以下步骤:
步骤1:对工业相机进行多目视觉标定,得到相机的内参数、外参数;
步骤2:同步触发相机1和相机2采集分别采集2幅原始导管端面图像;
步骤3:对上述两幅图像分别进行亚像素精度处理,分别获取导管端面投影椭圆的边缘坐标;
步骤4:根据相机的内外参数、极线约束和顺序一致性规则,找到其中一个导管端面投影椭圆的边缘坐标在另一幅图像中的对应匹配点;
步骤5:利用标定好的双目视觉之间的空间位置关系,借助立体视觉三维测量模型,重建所有匹配点的三维空间坐标点云;
步骤6:对匹配点的三维空间坐标点云,利用Ransac算法剔除离群点,利用剩余的点作为点云拟合圆的初始值;
步骤7:建立点云拟合圆的目标函数,目标函数包括:点云上所有点距离点云拟合圆所构成的平面之间的距离和点云上所有点距离点云拟合圆心的距离;
步骤8:对点云拟合圆的目标函数进行线性化处理;
步骤9:利用最小二乘法计算使目标函数为零时的拟合空间圆作为导管端面的定位。
所述内参数为从工业相机坐标系到图像坐标系的变换矩阵,所述外参数为相机坐标系到世界坐标系的变换矩阵,世界坐标系用于之后的实际控制点坐标输出。
是采用二维柔性靶标对每个工业相机的内参数进行标定。
所述外参数是通过旋转矩阵R和平移矩阵T实现。
所述导管放置在背光板上,相机1和相机2拍摄的图像为不同视角下导管的同一个端面图像。
所述立体视觉三维模型,包括:
所述的立体视觉三维模型表示为:
其中,(xi,yi,zi)为重建出的三维空间坐标点pi的坐标,(X1i,Y1i)为相机1下的一个图像边缘点li坐标,(x2i,y2i)为相机2下的一个图像边缘点qi坐标,fm、fn分别为相机1和相机2的焦比,相机1和相机2之间的变换矩阵R12为
因此(r1,r2,r3,r7,r8,r9,t1,t2,t3)为变换矩阵R12的参数值。
所述点云的圆心为点云上所有点的质心,圆半径为点云上所有点到质心的平均距离,拟合圆所在平面的法向量由点云上所有点拟合平面的法向量得到。
所述目标函数f如下所示:
其中,n为点云包含的点个数,(a0,b0,c0,d0)为拟合圆所在平面的法向量,(x0,y0,z0)为点云上所有点的质心,(xi,yi,zi)为点云上任意一点。r0为拟合圆的半径。
本发明具有以下有益效果及优点:
1.本发明所述的导管管端高精度检测方法能有效的重建管端中心点三维坐标。
2.本发明所述的导管管端高精度检测方法测量精度高,可以为导管无应力装配提供有效的保障。
3.本发明所述的导管管端高精度检测方法测量效率高,为导管数字化制造奠定坚实的基础。
附图说明
图1为本发明方法的硬件装置示意图;
图2为本发明方法流程图;
图3(a)为本发明方法相机1下的图像中左侧圆边缘坐标点;
图3(b)为本发明方法相机2下的图像中右侧圆边缘坐标点;
图4为本发明方法重建边缘匹配点的三维空间坐标点云。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
参照附图1,本发明方法的硬件装置包括:背光板、待检测导管、四个工业相机、作为控制器的计算机。其中,工业相机两两结合可以测出导管其中一个端面投影椭圆的定位匹配检测,计算机装有用于方法检测的各个步骤的程序,配合计算机最终检测出导管两端面投影椭圆的定位匹配检测结果输出给上位机,上位机可以根据导管两端面投影椭圆的定位匹配检测结果控制执行器将导管装配在预连接器件上,实现导管装配。
参照附图2、附图3(a)、附图3(b)、附图4,本发明所述的导管管端高精度检测方法的具体步骤如下:
步骤1:将四个工业相机进行多目视觉标定,得到所有相机的内参数,以及所有相机坐标系到世界坐标系的转换矩阵,也就是外参数。
内参数表示从工业相机坐标系到图像坐标系的变换矩阵;每个镜头的畸变程度各不相同,包括径向畸变、偏心畸变;利用二维柔性靶标对每个工业相机的内参数进行标定。
外参数表示从工业相机坐标系到世界坐标系的变换矩阵,通过旋转矩阵R和平移矩阵T实现。世界坐标系用于之后的实际控制点坐标输出。
步骤2:同步触发相机1和相机2这两个工业相机采集放置在背光板上的两幅原始导管图像;
步骤3:分别求出两幅原始导管图像中导管端面投影椭圆的亚像素精度处理后的边缘图像坐标;
步骤4:借助于相机的内外参数、极线约束和顺序一致性,建立其中一个导管端面投影椭圆的亚像素精度边缘坐标在另一幅图像中的对应匹配点关系;
定义相机1下的图像二维边缘坐标点L(l1,l2,...ln),按照相机的内外参数、极线约束和顺序一致性原则,找到其在相机2下图像的对应二维边缘坐标点Q(q1,q2,...qn)。
步骤5:利用标定好的双目视觉之间的空间位置关系(即,工业相机坐标系、图像坐标系、世界坐标系之间的变换矩阵),借助立体视觉三维测量模型,重建所有匹配点的三维空间坐标点云P(p1,p2,…pn);
所述的立体视觉三维模型表示为:
其中,(xi,yi,zi)为重建出的三维空间坐标点pi的坐标,(X1i,Y1i)为相机1下的一个图像边缘点li坐标,(x2i,y2i)为相机2下的一个图像边缘点qi坐标,fm、fn分别为相机1和相机2的焦比,相机1和相机2之间的变换矩阵R12为
因此(r1,r2,r3,r7,r8,r9,t1,t2,t3)为变换矩阵R12的参数值。
步骤6:对匹配点的三维空间坐标点云,利用Ransac算法剔除离群点,利用剩余的点建立点云拟合圆的初始值,其中圆心为点云上所有点的质心,圆半径为点云上所有点到质心的平均距离,拟合圆所在平面的法向量由点云上所有点拟合平面的法向量得到;
步骤7:建立点云拟合圆的目标函数,目标函数由两部分构成,第一部分是点云上所有点距点云拟合圆所构成的平面之间的距离,第二部分是点云上所有点距点云拟合圆心之间的距离,目标函数f如下所示:
其中,n为点云包含的点个数,(a0,b0,c0,d0)为拟合圆所在平面的法向量,(x0,y0,z0)为点云上所有点的质心,(xi,yi,zi)为点云上任意一点。r0为拟合圆的半径。
步骤8:对f线性化,得
其中
①目标函数f对x0进行求导
②目标函数f对y0进行求导
③目标函数f对z0进行求导
④目标函数f对r0进行求导
⑤目标函数f对a0进行求导
⑥目标函数f对b0进行求导
⑦目标函数f对c0进行求导
⑧目标函数f对d0进行求导
步骤9:为了使目标函数f=0,令
-f0=Α1x0+Α2y0+Α3z0+Α4a0+Α5b0+Α6c0+Α7d0+Α8r0
利用最小二乘法,可以变换为MX=B
其中
X=[x0,y0,z0,a0,b0,c0,r0]T
B=[f01,f02,…,f0m]T
其中,矩阵M的各行分别为点云各点对各变量求得的偏导值;T为转置符号;矩阵B的各向量分别为点云各点的各变量求得的f0。即可求得最终的空间圆参数值X。
步骤10,利用工业相机3和工业相机4按照步骤2~步骤9同样进行操作,可以得到导管另一端的管端圆参数值。
步骤11,利用得到的导管两端的管端圆参数即可进行导管的装配以及其他操作。
上述程序步骤被加载在现场计算机上,现场设置四个工业相机采集图像发送给现场计算机,并按照上述步骤进行处理,就能获取导管截断面两侧管端实际空间点云圆参数值。最终的空间圆的坐标值传送给机器人或是其他设备用于其他操作。
本方法步骤采用vs2010在Win7系统下进行了实验,空间圆测量精度可以达到0.05mm,重复精度可以达到0.01mm。测量精度高,效率高,具有较强的稳定性。
以上所述是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明所述原理的前提下,还可以做出若干改进和润饰,这些改进和润饰应视为本发明的保护范围。
- 上一篇:石墨接头机器人自动装卡簧、装栓机
- 下一篇:一种ADAS单目相机的标定方法