一种无公共视野的多相机定位大工件及工业机器人位置补偿方法技术

本发明专利技术涉及工业机器人位置补偿方法领域，具体是一种无公共视野的多相机定位大工件及工业机器人位置补偿方法，其具体步骤如下：S1、搭建实施平台；S2、获取图像1；S3、获取图像2；S4、计算从相机相对于主相机的位置关系matrix；S5、主相机手眼标定；S6、求旋转中心；S7、主相机抓取图像；S8、从相机抓取图像；S9、判断是否作为标准位置；S10、计算偏移角theta；S11、计算偏移量；S12、判断机器人是否在标准位置上；S13、判断是否继续；针对非共同视野多相机位置关系求解问题提供了简单易于操作的方法，为机器定位大尺寸工件提供了补偿方法；该方法硬件成本低，只需要一块靶标；不需要进行复杂的设备安装，操作简单。操作简单。操作简单。

【技术实现步骤摘要】
一种无公共视野的多相机定位大工件及工业机器人位置补偿方法


[0001]本专利技术涉及工业机器人位置补偿方法领域，具体是一种无公共视野的多相机定位大工件及工业机器人位置补偿方法。

技术介绍

[0002]文献《一种无公共视场相机位置关系的求解方法》公开了多相机系统标定的一种方法。该论文在二维靶标标定方法的基础上，提出了一种基于两轴转台的无公共视场相机位置关系的求解方法。具体地，将待标定系统固定在转台上，利用转台转动确定靶标坐标系与转台坐标系之间的相对关系；通过转动转台使二维靶标依次进入每个相机视场以分别确定转动后每个相机在靶标坐标系中的位置，并记录转动的角度；最后，结合靶标坐标系与转台坐标系关系，求解各相机之间的相对位置。该方法需要两轴转台，结构复杂，安装耗时，成本较高，占地面积大，可复用性低。

技术实现思路

[0003]为了解决上述问题，本专利技术提出一种无公共视野的多相机定位大工件及工业机器人位置补偿方法。
[0004]一种无公共视野的多相机定位大工件及工业机器人位置补偿方法，其具体步骤如下：
[0005]S1、搭建实施平台，将靶标安装到机器人的末端；
[0006]S2、将靶标移动到主相机视野中心，获取图像1；
[0007]S3、机器人仅沿着y方向移动到从相机视野中心,移动距离为d，获取图像2；
[0008]S4、计算从相机相对于主相机的位置关系matrix；
[0009]S5、主相机手眼标定；
[0010]S6、求旋转中心；
[0011]S7、主相机抓取图像，识别特征点p0，特征点在机器人坐标系下的位置P0,P0＝t*p0；
[0012]S8、从相机抓取图像，识别特征点为p1，特征点在机器人坐标系下的位置P1,P1＝t*matrix*p1；
[0013]S9、判断是否作为标准位置：
[0014]a：如果是，则保存P0为standard0，P1为standard1,机器人记录下当前位置为标准位置standard2；
[0015]b：如果否，则进入下一步；
[0016]S10、计算偏移角theta：
[0017]theta＝arctan2(p1.y
–
p0.y,p1.x
–
p0.x)
‑
arctan2(standard1.y
–
standard0.y,standard1.x
–
standard0.x)；
[0018]S11、计算偏移量：
[0019]point_result＝[[cos(theta),sin(theta),(1
‑
cos(theta))*center[0]–
sin(theta)*center[1]],[
‑
sin(theta),cos(theta),sin(theta)*center[0]+(1
–
cos(theta))*center[1]]；
[0020]dx＝point_result.x
‑
standard0.x；dy＝point_result.y
‑
standard0.y
[0021]S12、机器人在标准位置standard2上，补偿dx,dy,theta；
[0022]S13、判断是否继续，如果是，则回到步骤S7，依次执行步骤S7～步骤S12；如果否，则终止。
[0023]所述的步骤S1的搭建平台具体为将光源一、光源二分别安装在主相机、从相机的视野中间，主相机、从相机安装在视觉安装支架上。
[0024]所述的步骤S4中的具体步骤如下：
[0025]a、计算图像1中的五个圆心坐标在相机坐标系下的位置c0_points；计算图像2中的五个圆心坐标在相机坐标系下的位置c1_points；
[0026]b、根据单应性矩阵变换，求出c0_points与c1_points的转换矩阵h；
[0027]c、根据c0_points与五点之间的真实尺寸求出像素大小pixel_size；
[0028]d、从相机像素坐标系下，视野中心点坐标为p，经过单应性变化后得到dst_p：
[0029]dst_p＝h*p；
[0030]e、主相机视野中心点与从相机视野中心点距离distance为：
[0031]distance＝d
‑
(dst_p[0]–
p[0])*pixel_size
[0032]f、计算从相机相对于主相机的位置关系matrix：
[0033]matrix＝h；matrix[0][2]‑
＝distance/pixel_size。
[0034]所述的步骤S5的具体步骤如下：
[0035]a、拿下靶标，抓手吸取工件；
[0036]b、将特征点移动到主相机视野中心p_center；
[0037]c、读取当前机器人位置p_r；获取当前图像并检测到特征点的位置为p_c；
[0038]d、以p_center为“田”子中心，走8个点，每走一点，回到步骤S5的c中，记录下对应位置点；
[0039]e、机器人的九点位置为P_R,对应的特征点位置为P_C，根据最小二乘法，得到主相机的像素坐标系与机器人坐标系的位置关系矩阵t。
[0040]所述的步骤S6的具体步骤如下：
[0041]a、机器人每次旋转一个角度，并且确保特征点在相机视野中，抓取图像，得到特征点位置为data_p；迭代9次；九点位置记为DATA_p；
[0042]b、根据步骤S5中的矩阵t及DATA_p，得到该9点在机器人坐标系下的位置为DATA_P；
[0043]c、根据最小二乘法拟合圆心，得到旋转中心center。
[0044]本专利技术的有益效果是：针对非共同视野多相机位置关系求解问题提供了简单易于操作的方法，为机器定位大尺寸工件提供了补偿方法；该方法硬件成本低，只需要一块靶标；不需要进行复杂的设备安装，操作简单；该方法不限于该场景的应用，凡是多个相机非共同视野需要计算相互间位置关系时都可以使用。
附图说明
[0045]下面结合附图和实施例对本专利技术进一步说明。
[0046]图1为本专利技术的前视图结构示意图；
[0047]图2为本专利技术的靶标结构示意图；
[0048]图3为本专利技术的小工件结构示意图；
[0049]图4为本专利技术的大工件结构示意图；
[0050]图5为本专利技术的流程结构示意图。
具体实施方式
[0051]为了使本专利技术实现的技术手段、创作特征、达成目的与功效易于明白了解，下面对本专利技术进一步阐述。
[0052]如图1至图5所示，一种无公共视野的多相机定位大工件及工业机器人位置补偿方法，其具体步骤如下：
[0053]S1、搭建实施平台，将靶标安装到机器人1的末端；本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无公共视野的多相机定位大工件及工业机器人位置补偿方法，其特征在于：其具体步骤如下：S1、搭建实施平台，将靶标安装到机器人(1)的末端；S2、将靶标移动到主相机(2.1)视野中心，获取图像1；S3、机器人(1)仅沿着y方向移动到从相机(2.2)视野中心,移动距离为d，获取图像2；S4、计算从相机(2.2)相对于主相机(2.1)的位置关系matrix；S5、主相机(2.1)手眼标定；S6、求旋转中心；S7、主相机(2.1)抓取图像，识别特征点p0，特征点在机器人坐标系下的位置P0,P0＝t*p0；S8、从相机(2.2)抓取图像，识别特征点为p1，特征点在机器人坐标系下的位置P1,P1＝t*matrix*p1；S9、判断是否作为标准位置：a：如果是，则保存P0为standard0，P1为standard1,机器人记录下当前位置为标准位置standard2；b：如果否，则进入下一步；S10、计算偏移角theta：theta＝arctan2(p1.y
–
p0.y,p1.x
–
p0.x)
‑
arctan2(standard1.y
–
standard0.y,standard1.x
–
standard0.x)；S11、计算偏移量：point_result＝[[cos(theta),sin(theta),(1
‑
cos(theta))*center[0]
–
sin(theta)*center[1]],[
‑
sin(theta),cos(theta),sin(theta)*center[0]+(1
–
cos(theta))*center[1]]；dx＝point_result.x
‑
standard0.x；dy＝point_result.y
‑
standard0.yS12、机器人在标准位置standard2上，补偿dx,dy,theta；S13、判断是否继续，如果是，则回到步骤S7，依次执行步骤S7～步骤S12；如果否，则终止。2.根据权利要求1所述的一种无公共视野的多相机定位大工件及工业机器人位置补偿方法，其特征在于：所述的步骤S1的搭建平...

【专利技术属性】
技术研发人员：马英，李祖云，易廷昊，章林，蒋立军，党进，肖永强，游玮，储昭琦，贾时成，魏小敏，
申请(专利权)人：上海埃奇机器人技术有限公司，
类型：发明
国别省市：