基于3D视觉手眼标定方法与流程

本发明涉及3d视觉领域，具体涉及一种基于3d视觉手眼标定方法。

背景技术：

在工程大型零件精密检测过程中，需要3d视觉传感器采集零件三维点云数据与标准零件的点云数据进行比较。3d视觉传感器拍摄区域有限，对大型零件通常采用分段采集并通过数据配准方法重构大型零件，虽然能够完成目标，但是精度比较低。另一种对大型零件进行重构的方法是将3d视觉传感器获取得到的分段三维点云数据放入同一个实际坐标系中并进行三维重构，这种方法能够降低三维点云数据重构算法引起的精度误差。

技术实现要素：

本发明要解决的技术问题是提供一种基于3d视觉手眼标定方法，计算机械手末端法兰坐标系与3d视觉传感器坐标系之间的转换矩阵，将3d视觉传感器获取得到的坐标数据转换成实际坐标系中数据。

为了解决上述技术问题，本发明提供了一种基于3d视觉手眼标定方法，包括：

通过移动机械手到合适位置，通过3d视觉传感器识别测量工件圆孔并记录圆孔圆心在3d视觉传感器坐标系中的位置c1(xc1,xc1,yc1)，从机械手的控制器中记录此时法兰位置f1(xf1,yf1,zf1,af1,bf1,cf1)；

保持测量零件的位置不变，通过控制器移动机械手到不同位置，分别记录这些位置圆孔圆心在3d视觉传感器坐标系中的位置c2(xc2,xc2,yc2)，c3(xc3,xc3,yc3)，c4(xc4,xc4,yc4)……..以及kuka机械手末端法兰位置f2(xf2,yf2,zf2,af2,bf2,cf2)，f3(xf3,yf3,zf3,af3,bf3,cf3)，f4(xf4,yf4,zf4,af4,bf4,cf4)…….；

测量零件在基坐标系中的位置b＝[f][x]c，其中[f]为机械手法兰坐标系与基坐标系之间的变换矩阵，[x]4×4为需要求解的机械手法兰坐标系与3d视觉传感器坐标系之间的变换矩阵，c为测量零件圆孔圆心在3d视觉传感器坐标系中的坐标c4×1，对于机械手不同位置，b1＝[f1][x]c1，b2＝[f1][x]c1，b3＝[f1][x]c1……因为测量零件位置保持不变，所以b1＝b2＝b3＝…....bn；

机械手法兰坐标与基坐标变换矩阵[f]计算公式为

测量零件圆孔圆心在3d视觉传感器坐标系中坐标c为[xc；yc；zc；1]^t，建立方程组，求解机械手法兰坐标系与3d视觉传感器坐标转换矩阵[x]4×4。

在其中一个实施例中，所述机械手是kuka机械手。

一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时实现任一项所述方法的步骤。

一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现任一项所述方法的步骤。

一种处理器，所述处理器用于运行程序，其中，所述程序运行时执行任一项所述的方法。

本发明的有益效果：计算机器手末端法兰坐标系与3d视觉传感器坐标系之间的转换矩阵，将3d视觉传感器获取得到的坐标数据转换成实际坐标系中数据。

附图说明

图1是本发明基于3d视觉手眼标定系统的示意图。

具体实施方式

下面结合附图和具体实施例对本发明作进一步说明，以使本领域的技术人员可以更好地理解本发明并能予以实施，但所举实施例不作为对本发明的限定。

可以理解，下文的kuka机械手也可以采用其他类型的机械手，本发明在此不做限制。

参照图1，本发明提供的基于3d视觉手眼标定系统由kuka机械手1，3d视觉传感器2以及测量零件3构成。3d视觉传感器安装在kuka机械手1法兰盘上，测量零件3放置在地面并保持位置不变。

首先将3d视觉传感器安装在kuka机械手末端，并通过网线与电脑连接，在ie浏览器中输入ip地址，显示3d视觉传感器测量界面；将测量工件放置在地面。

参照图1，移动kuka机械手1到某一位置，通过3d视觉传感器2识别测量零件3圆孔圆心并记录圆心在相机坐标系中的坐标(xc1,xc1,yc1)，通过kuka控制器记录此时kuka机械手1法兰位置f1(xf1,yf1,zf1,af1,bf1,cf1)；保持测量零件3位置不变，移动kuka机械手1至不同位置，分别记录这些位置圆孔圆心在3d视觉传感器坐标系中的位置c2(xc2,xc2,yc2)，c3(xc3,xc3,yc3)，c4(xc4,xc4,yc4)……..以及kuka机械手末端法兰位置f2(xf2,yf2,zf2,af2,bf2,cf2)，f3(xf3,yf3,zf3,af3,bf3,cf3)，f4(xf4,yf4,zf4,af4,bf4,cf4)…….。

参照图1，测量零件3在基坐标系中的位置b＝[f][x]c，其中[f]为kuka机械手法兰坐标系与基坐标系之间的变换矩阵，[x]4×4为需要求解的kuka机械手法兰坐标系与3d视觉传感器坐标系之间的变换矩阵，c为测量零件圆孔圆心在3d视觉传感器坐标系中的坐标c4×1，因为测量零件3的位置保持不变，所以b1＝b2＝b3＝…....bn，即

[f1][x]c1＝[f2][x]c2

[f2][x]c2＝[f3][x]c3

[f3][x]c3＝[f4][x]c4

…….

kuka机械手1法兰坐标与基坐标变换矩阵[f]计算公式为

需要求解的kuka机械手1法兰坐标系与3d视觉传感器坐标系之间的变换矩阵[x]4×4表达式为

测量零件3圆孔圆心在3d视觉传感器坐标系中坐标c表达式为

[xc；yc；zc；1]^t

根据b1＝b2＝b3＝…....bn建立线性方程组，采用最小二乘法求解出矩阵[x]4×4的12个未知数。

以上所述实施例仅是为充分说明本发明而所举的较佳的实施例，本发明的保护范围不限于此。本技术领域的技术人员在本发明基础上所作的等同替代或变换，均在本发明的保护范围之内。本发明的保护范围以权利要求书为准。