一种坐标系重合校准方法及系统

文档序号:124157 发布日期:2021-10-22 浏览:11次 >En<

阅读说明:本技术 一种坐标系重合校准方法及系统 (Coordinate system coincidence calibration method and system ) 是由 李安 秦应化 于 2021-09-15 设计创作,主要内容包括:本发明涉及一种坐标系重合校准方法及系统,该方法包括:基于机器人的结构获取第一坐标系,基于拍摄的机器人的图像获取第二坐标系;从图像中获取标定点,标定点中的任意三个都能够组成等腰三角形;令机器人等间距平移,基于获得的第一组和第二组标定数据计算第一和第二坐标系的平移矩阵;令机器人旋转,基于获得的第三组和第四组标定数据计算第一和第二坐标系的旋转矩阵;获取某张图像上的一个特征点,计算特征点在第二坐标系上的预估坐标值;测量得到该特征点的实际坐标值;比较预估坐标值和实际坐标值以反向验证平移矩阵和旋转矩阵的准确性。本发明能够减小图像视觉系统的误差,提高相机坐标系和机器人坐标系的重合度,继而提高零件组装精度。(The invention relates to a coordinate system coincidence calibration method and a system, wherein the method comprises the following steps: acquiring a first coordinate system based on the structure of the robot, and acquiring a second coordinate system based on a shot image of the robot; acquiring calibration points from the image, wherein any three of the calibration points can form an isosceles triangle; enabling the robot to translate at equal intervals, and calculating translation matrixes of the first coordinate system and the second coordinate system based on the obtained first set of calibration data and the second set of calibration data; rotating the robot, and calculating rotation matrixes of the first coordinate system and the second coordinate system based on the obtained third group calibration data and the fourth group calibration data; acquiring a characteristic point on a certain image, and calculating an estimated coordinate value of the characteristic point on a second coordinate system; measuring to obtain an actual coordinate value of the characteristic point; and comparing the estimated coordinate value with the actual coordinate value to reversely verify the accuracy of the translation matrix and the rotation matrix. The invention can reduce the error of the image vision system, improve the contact ratio of the camera coordinate system and the robot coordinate system, and further improve the assembly precision of parts.)

一种坐标系重合校准方法及系统

技术领域

本发明涉及坐标系校准技术领域,尤其涉及一种坐标系重合校准方法及系统。

背景技术

在3C电子、汽车等行业中,通常有一些零件需要进行组装装配,为确保装配顺利进行,需要将两个坐标系进行重合,例如相机的坐标系和机器人的坐标系。但是在一些场景中,因为安装和结构的问题,常规的坐标系重合校准方式会出现一定程度的局限性,例如:相机的安装方式不平行或机器人的位置和产品不同心等,会导致组装精确性的下降。为了提高生产时组装零件的精度,在图像算法上需要改进对坐标系的校准精度,减小计算误差,使相机的坐标系和机器人的坐标系重合度达到更高。

在实际生产环境中,由于对某些零件组装需要更高的精度,所以在提升精度的这一环节上,图像的算法起着关键作用,而在图像算法上可提升精度的部分可以包括成像质量、识别算法和坐标系重合精度,前两种精度提升和实际项目有紧密关系,而坐标系重合精度则只与计算的原理和方式有关,传统校准方式往往是:选取机器人坐标系中的一个标定点,控制机器人运动,在运动过程中拍摄得到标定点在图像中的坐标,继而得到机器人坐标系和相机坐标系的映射关系。但是这种方式的误差范围较大,实际生产过程中组装的精度难以保证。

因此,如何提供一种精度更高的坐标系重合校准方法及系统是本领域技术人员亟待解决的一个技术问题。

发明内容

本发明提供一种坐标系重合校准方法及系统,以解决上述技术问题。

为解决上述技术问题,本发明提供一种坐标系重合校准方法,所述方法包括:

步骤1:基于机器人的结构获取第一坐标系,采用2D相机拍摄所述机器人的图像,基于所述图像获取第二坐标系;

步骤2:从所述图像中获取3~5个标定点以及所述标定点在所述第二坐标系中的坐标值,所述标定点中的任意三个都能够组成等腰三角形;

步骤3:令所述机器人等间距平移9次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第一组标定数据;基于所述机器人在所述第一坐标系中的平移距离得到第二组标定数据;基于所述第一组标定数据和第二组标定数据计算所述第一坐标系和第二坐标系的平移矩阵;

步骤4:令所述机器人旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第三组标定数据;基于所述机器人在所述第一坐标系中的旋转角度得到第四组标定数据;基于所述第三组标定数据和第四组标定数据计算所述第一坐标系和第二坐标系的旋转矩阵;

步骤5:获取某张图像上的一个特征点,令所述机器人旋转一次,基于所述平移矩阵和旋转矩阵以及所述特征点在第一坐标系上的坐标值,计算得到所述特征点在第二坐标系上的预估坐标值;测量得到所述特征点在所述第二坐标系上的实际坐标值;比较所述预估坐标值和实际坐标值的第一差值,基于所述第一差值反向验证所述平移矩阵和旋转矩阵的准确性。

较佳地,所述标定点为标定板上的点,所述标定板固定安装于所述机器人上。

较佳地,每次令所述机器人进行平移或旋转之后,通过所述等腰三角形的结构特点对所述标定点在所述第二坐标系中的坐标值进行修正。

较佳地,步骤5之后还包括步骤6:若所述第一差值大于第一阈值,则按固定步距逐步修改所述特征点在第二坐标系上的预估坐标值,继而调整所述平移矩阵和旋转矩阵,重复所述第一差值的计算过程,直至计算得到的第一差值小于所述第一阈值。

较佳地,步骤4中还包括数据验证步骤,包括:得到所述第三组标定数据和第四组标定数据后,令所述机器人沿直线移动一次,移动方向为从一个标定点到另一个标定点,移动距离为两个所述标定点之间的距离;然后,令所述机器人再旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第五组标定数据;依据所述移动距离和第五组标定数据验证前述标定数据的准确性。

较佳地,依据移动距离和第五组标定数据验证前述标定数据的准确性的方法包括:将第三组标定数据进行拟合得到第一旋转中心,将第五组标定数据进行拟合得到第二旋转中心;计算第一旋转中心和第二旋转中心的距离与移动距离之间的第二差值,比较所述第二差值与第二阈值的关系,验证前述标定数据的准确性。

本发明还提供一种坐标系重合校准系统,包括:

坐标系获取单元:用于基于机器人的结构获取第一坐标系,采用2D相机拍摄所述机器人的图像,基于所述图像获取第二坐标系;

标定点获取单元:用于从所述图像中获取3~5个标定点以及所述标定点在所述第二坐标系中的坐标值,所述标定点中的任意三个都能够组成等腰三角形;

平移矩阵获取单元:用于令所述机器人等间距平移9次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第一组标定数据;基于所述机器人在所述第一坐标系中的平移距离得到第二组标定数据;基于所述第一组标定数据和第二组标定数据计算所述第一坐标系和第二坐标系的平移矩阵;

旋转矩阵获取单元:令所述机器人旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第三组标定数据;基于所述机器人在所述第一坐标系中的旋转角度得到第四组标定数据;基于所述第三组标定数据和第四组标定数据计算所述第一坐标系和第二坐标系的旋转矩阵;

反向验证单元:用于获取某张图像上的一个特征点,令所述机器人旋转一次,基于所述平移矩阵和旋转矩阵以及所述特征点在第一坐标系上的坐标值,计算得到所述特征点在第二坐标系上的预估坐标值;测量得到所述特征点在所述第二坐标系上的实际坐标值;比较所述预估坐标值和实际坐标值的第一差值,基于所述第一差值反向验证所述平移矩阵和旋转矩阵的准确性。

较佳地,所述系统还包括修正单元:用于在每次令所述机器人进行平移或旋转之后,通过所述等腰三角形的结构特点对所述标定点在所述第二坐标系中的坐标值进行修正。

较佳地,所述反向验证单元还用于:若所述第一差值大于第一阈值,则按固定步距逐步修改所述特征点在第二坐标系上的预估坐标值,继而调整所述平移矩阵和旋转矩阵,重复所述第一差值的计算过程,直至计算得到的第一差值小于所述第一阈值。

较佳地,所述旋转矩阵获取单元还用于:得到所述第三组标定数据和第四组标定数据后,令所述机器人沿直线移动一次,移动方向为从一个标定点到另一个标定点,移动距离为两个所述标定点之间的距离;然后,令所述机器人再旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第五组标定数据;依据所述移动距离和第五组标定数据验证前述标定数据的准确性。

与现有技术相比,本发明提供的坐标系重合校准方法及系统具有如下优点:相较于现有技术中的利用单个标定点采用单流程的校准方式,本发明能够减小图像视觉系统的误差,提高机器人坐标系和相机坐标系的重合精度,对小视野校准,得到更精确的坐标系转换关系。

附图说明

图1为本发明一

具体实施方式

中坐标系重合校准方法的流程图;

图2为本发明一具体实施方式中坐标系重合校准系统的模块图。

具体实施方式

为了更详尽的表述上述发明的技术方案,以下列举出具体的实施例来证明技术效果;需要强调的是,这些实施例用于说明本发明而不限于限制本发明的范围。

本发明提供的坐标系重合校准方法,请重点参考图1,所述方法包括:

步骤1:基于机器人的结构获取第一坐标系,采用2D相机拍摄所述机器人的图像,基于所述图像获取第二坐标系,本实施例中,所述第一坐标系为三维坐标系,第二坐标系为二维坐标系。

步骤2:从所述图像中获取3~5个标定点以及所述标定点在所述第二坐标系中的坐标值,所述标定点中的任意三个都能够组成等腰三角形;具体地,所述标定点可以是图像中抓取到的所述机器人上的清晰的点;若图像中无法抓取符合要求的点,标定点也可以是定制的标定板上的点,所述标定板固定安装于所述机器人上,使标定点与所述机器人的相对位置关系固定即可。

步骤3:令所述机器人等间距平移9次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值(即测量得到的平移后的标定点在第二坐标系中的坐标值),得到第一组标定数据;基于所述机器人在所述第一坐标系中的平移距离得到平移后的标定点在第一坐标系中的坐标值,记为第二组标定数据;基于所述第一组标定数据和第二组标定数据计算所述第一坐标系和第二坐标系的平移矩阵,具体地,可通过现有技术中的变换矩阵的方式计算平移矩阵,具体方式此处不予限定。

步骤4:令所述机器人旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第三组标定数据;基于所述机器人在所述第一坐标系中的旋转角度得到第四组标定数据;基于所述第三组标定数据和第四组标定数据计算所述第一坐标系和第二坐标系的旋转矩阵,具体地,也可通过现有技术中的变换矩阵的方式计算旋转矩阵,具体方式此处不予限定。

步骤5:在视野内获取某张图像上的一个特征点,令所述机器人旋转一次,基于所述平移矩阵和旋转矩阵以及所述特征点在第一坐标系上的坐标值,计算得到所述特征点在第二坐标系上的预估坐标值;测量得到所述特征点在所述第二坐标系上的实际坐标值;比较所述预估坐标值和实际坐标值的第一差值,基于所述第一差值反向验证所述平移矩阵和旋转矩阵的准确性。本申请中通过增加步骤5的反向验证方法,能检验计算得到的平移矩阵和旋转矩阵的准确性,从而减小图像视觉系统的误差,提高机器人坐标系和相机坐标系的重合精度。

较佳地,步骤5之后还包括步骤6:若所述第一差值大于第一阈值,则按固定步距逐步修改所述特征点在第二坐标系上的预估坐标值,继而调整所述平移矩阵和旋转矩阵,重复所述第一差值的计算过程,直至计算得到的第一差值小于所述第一阈值。本申请增加了平移矩阵和旋转矩阵的自动微调功能,进一步提高了坐标系重合校准的精度。

较佳地,每次令所述机器人进行平移或旋转之后,通过所述等腰三角形的结构特点对所述标定点在所述第二坐标系中的坐标值进行修正。换句话说,本申请利用各个标定点之间的位置关系对标定点在第二坐标系中的坐标值进行修正,例如,初始状态中,三个标定点组成的三角形的三条边为L1、L2和L3,且L1=L2;在平移一次后,图像中三个标定点组成的三角形的三条边为L1’、L2’和L3’,但L1’≠L2’,则说明平移后,三个标定点的坐标值出现了误差,此时可根据等腰三角形的结构特点,调节平移后的三个标定点的坐标值进行微调,使各个标定点的位置信息更加精确,确保为后续计算提供更加准确的数据。因此,本申请采用等腰三角形的设定便于修正和检验,大大减小了后续的计算。

较佳地,步骤4中还包括数据验证步骤,包括:得到所述第三组标定数据和第四组标定数据后,令所述机器人沿直线移动一次,移动方向为从一个标定点到另一个标定点,移动距离为两个所述标定点之间的距离;然后,令所述机器人再旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第五组标定数据;依据所述移动距离和第五组标定数据验证前述标定数据的准确性,具体方法包括:将第三组标定数据进行拟合(例如传统的圆拟合算法)得到第一旋转中心,将第五组标定数据进行拟合得到第二旋转中心;计算第一旋转中心和第二旋转中心的距离与移动距离之间的第二差值,比较所述第二差值与第二阈值的关系,验证前述标定数据(包括第一组至第四组标定数据)的准确性。例如,第一旋转中心与第二旋转中心之间的距离为M;得到第三组和第四组标定数据后,将机器人进行移动,移动距离为K,理论上两个旋转中心之间的距离M应该约等于机器人的移动距离K,即,第二差值应接近于0,若第二差值的数值较大,则需进行提示,并返回到步骤3和步骤4中重新确认各组标定数据的准确性。本申请通过增加数据验证步骤,能够对小视野校准,进一步确保数据的准确性,提高坐标系重合的准确度。

本发明还提供一种坐标系重合校准系统100,请重点参考图2,并结合图1,包括:

坐标系获取单元110,用于执行步骤1,用于基于机器人的结构获取第一坐标系,采用2D相机拍摄所述机器人的图像,基于所述图像获取第二坐标系;

标定点获取单元120,用于执行步骤2,用于从所述图像中获取3~5个标定点以及所述标定点在所述第二坐标系中的坐标值,所述标定点中的任意三个都能够组成等腰三角形;

平移矩阵获取单元130,用于执行步骤3,用于令所述机器人等间距平移9次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第一组标定数据;基于所述机器人在所述第一坐标系中的平移距离得到第二组标定数据;基于所述第一组标定数据和第二组标定数据计算所述第一坐标系和第二坐标系的平移矩阵;

旋转矩阵获取单元140,用于执行步骤4,用于令所述机器人旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第三组标定数据;基于所述机器人在所述第一坐标系中的旋转角度得到第四组标定数据;基于所述第三组标定数据和第四组标定数据计算所述第一坐标系和第二坐标系的旋转矩阵;较佳地,所述旋转矩阵获取单元140还用于:得到所述第三组标定数据和第四组标定数据后,令所述机器人沿直线移动一次,移动方向为从一个标定点到另一个标定点,移动距离为两个所述标定点之间的距离;然后,令所述机器人再旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第五组标定数据;依据所述移动距离和第五组标定数据验证前述标定数据的准确性。

反向验证单元150,用于执行步骤5,用于获取某张图像上的一个特征点,令所述机器人旋转一次,基于所述平移矩阵和旋转矩阵以及所述特征点在第一坐标系上的坐标值,计算得到所述特征点在第二坐标系上的预估坐标值;测量得到所述特征点在所述第二坐标系上的实际坐标值;比较所述预估坐标值和实际坐标值的第一差值,基于所述第一差值反向验证所述平移矩阵和旋转矩阵的准确性。较佳地,所述反向验证单元150还用于:若所述第一差值大于第一阈值,则按固定步距逐步修改所述特征点在第二坐标系上的预估坐标值,继而调整所述平移矩阵和旋转矩阵,重复所述第一差值的计算过程,直至计算得到的第一差值小于所述第一阈值。

较佳地,所述系统还包括修正单元160,用于在每次令所述机器人进行平移或旋转之后,通过所述等腰三角形的结构特点对所述标定点在所述第二坐标系中的坐标值进行修正。

采用上述坐标重合校准系统,能够减小误差,得到更加准确的坐标系转换关系。

综上所述,本发明提供的坐标系重合校准方法及系统,所述方法包括:步骤1:基于机器人的结构获取第一坐标系,采用2D相机拍摄所述机器人的图像,基于所述图像获取第二坐标系;步骤2:从所述图像中获取3~5个标定点以及所述标定点在所述第二坐标系中的坐标值,所述标定点中的任意三个都能够组成等腰三角形;步骤3:令所述机器人等间距平移9次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第一组标定数据;基于所述机器人在所述第一坐标系中的平移距离得到第二组标定数据;基于所述第一组标定数据和第二组标定数据计算所述第一坐标系和第二坐标系的平移矩阵;步骤4:令所述机器人旋转3~5次,每次拍摄得到一张图像,基于所述标定点在每张所述图像上的坐标值,得到第三组标定数据;基于所述机器人在所述第一坐标系中的旋转角度得到第四组标定数据;基于所述第三组标定数据和第四组标定数据计算所述第一坐标系和第二坐标系的旋转矩阵;步骤5:获取某张图像上的一个特征点,令所述机器人旋转一次,基于所述平移矩阵和旋转矩阵以及所述特征点在第一坐标系上的坐标值,计算得到所述特征点在第二坐标系上的预估坐标值;测量得到所述特征点在所述第二坐标系上的实际坐标值;比较所述预估坐标值和实际坐标值的第一差值,基于所述第一差值反向验证所述平移矩阵和旋转矩阵的准确性。本申请能够减小图像视觉系统的误差,提高相机坐标系和机器人坐标系的重合度,继而提高零件组装精度。

显然,本领域的技术人员可以对发明进行各种改动和变型而不脱离本发明的精神和范围。这样,倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内,则本发明也意图包括这些改动和变型在内。

11页详细技术资料下载
上一篇:一种医用注射器针头装配设备
下一篇:仿人机器人的冗余手臂的抛投轨迹规划方法、装置及介质

网友询问留言

已有0条留言

还没有人留言评论。精彩留言会获得点赞!

精彩留言,会给你点赞!