一种基于视觉标志的机械臂飞拍定位方法技术

本发明专利技术提出了一种基于视觉标志的机械臂飞拍定位方法，包括：将视觉标志固定在机械臂末端；通过相机多次拍照计算视觉标志相对于机械臂末端的位姿；机械臂从取料区抓取物体，并朝相机方向运动；机械臂运动到相机上方邻近区域，触发相机拍照；相机拍照后，计算出视觉标志相对于相机的位姿，和物体相对于相机的位姿；根据、和，计算出物体相对于机械臂末端的位姿；利用物体相对于机械臂末端的位姿执行装配任务；判断是否需要重复执行下一次任务，如果是则返回步骤S3；否则结束。否则结束。否则结束。

【技术实现步骤摘要】
一种基于视觉标志的机械臂飞拍定位方法


[0001]本专利技术涉及机械臂
，特别涉及一种基于视觉标志的机械臂飞拍定位方法。

技术介绍

[0002]飞拍技术，是物体在运动过程中进行拍照，并得到物体拍照瞬间的位置姿态等信息。相比于定拍，即物体运动到拍照位置停止再请求拍照，飞拍可有效减少物体停顿动作，提高生产效率。
[0003]在机械臂飞拍定位应用中，首先机械臂末端抓取物体，此时物体相对于机械臂末端的精确位姿（简称物体位姿）未知。然后机械臂携带物体经过拍照点并触发拍照，过程中不停止运动。随后，机械臂收到相机返回的物体位姿。最后，机械臂根据物体位姿执行后续的装配等操作。考虑到机械臂触发拍照信号的延时，当前常见的解决方法如下：首先确定机械臂的准确拍照位置，在机械臂经过拍照位前的特定位置，提前触发拍照。此方法假定机械臂从提前位置到拍照位置的运动时间恰好等于机械臂触发拍照到相机完成拍照的时间。由于机械臂这段距离的运行时间跟机械臂速度、路径等诸多因素有关。因此此方法需反复实验、不够灵活，且存在误差。
[0004]首先确定机械臂的准确拍照位置，在机械臂经过拍照位前的特定时间，提前触发拍照。此方法假定机械臂触发的提前时间等于从机械臂触发拍照到相机完成拍照的时间。由于从机械臂触发拍照到相机完成拍照的时间跟信号传输、（不同型号）相机拍照原理等有关，且可能并不为恒定时间。因此，此方法依然不够灵活，且存在误差。

技术实现思路

[0005]本专利技术的目的旨在至少解决技术缺陷之一。
[0006]为此，本专利技术的目的在于提出一种基于视觉标志的机械臂飞拍定位方法。
[0007]为了实现上述目的，本专利技术的实施例提供一种基于视觉标志的机械臂飞拍定位方法，包括如下步骤：步骤S1，将视觉标志固定在机械臂末端，其中，视觉标志为相机拍照后可计算出其相对于相机3D位姿的平面图案；步骤S2，通过相机多次拍照计算视觉标志相对于机械臂末端的位姿；步骤S3，机械臂从取料区抓取物体，并朝相机方向运动；步骤S4，机械臂运动到相机上方邻近区域，触发相机拍照；步骤S5，相机拍照后，计算出视觉标志相对于相机的位姿，和物体相对于相机的位姿；步骤S6，根据、和，计算出物体相对于机械臂
末端的位姿；步骤S7，利用物体相对于机械臂末端的位姿执行装配任务；步骤S8，判断是否需要重复执行下一次任务，如果是则返回步骤S3；否则结束。
[0008]进一步，视觉标志采用二维码图案。
[0009]进一步，在步骤S2中，将相机安装在工作台上，操作机械臂运动到多个不同位姿，且保证视觉标志出现在相机视野内；对于位姿i，计算出视觉标志相对于相机的位姿，同时获取机械臂末端法兰相对于基坐标系的位姿；由于视觉标志相对于机械臂末端法兰的位姿是固定不变的，相机相对于机械臂基坐标系的位姿也是固定不变的；对于位姿i和位姿i+1，建立方程；利用上述多组数据，通过求解计算出视觉标志相对于机械臂末端法兰的位姿。
[0010]进一步，利用机械臂正运动学计算机械臂末端法兰相对于基坐标系的位姿。
[0011]进一步，在步骤S6中，计算公式如下：。
[0012]进一步，和均采用图像处理算法计算得到。
[0013]根据本专利技术实施例的基于视觉标志的机械臂飞拍定位方法，在准备阶段标定视觉标志相对于机械臂末端的位姿，运行时分别计算视觉标志和物体相对于相机的位姿，从而确定物体相对于机械臂末端的位姿。本专利技术具有以下有益效果：（1）适用性强。此方案的最终结果跟不同型号相机拍照时间、机械臂运行速度等因素几乎没有关联性，甚至运行一次拍照不成功补拍第二次。
[0014]（2）精度高。此方案从图像层面消除设定拍照位置和实际拍照位置的误差，大大提高精度。
[0015]本专利技术附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本专利技术的实践了解到。
附图说明
[0016]本专利技术的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解，其中：图1为根据本专利技术实施例的基于视觉标志的机械臂飞拍定位方法的流程图；图2为根据本专利技术实施例的基于视觉标志的机械臂飞拍定位方法的系统设置示意
图。
具体实施方式
[0017]下面详细描述本专利技术的实施例，实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，旨在用于解释本专利技术，而不能理解为对本专利技术的限制。
[0018]本专利技术提供一种基于视觉标志的机械臂飞拍定位方法，该方法的实施涉及机械臂、视觉标志、相机和工控机，如图2所示。机械臂是一台作业的普通六轴机械臂，本方案也可适用于其他类型机械臂。相机是一个普通工业相机，固定在工作台上。视觉标志是相机拍照后可计算出其相对于相机3D位姿的平面图案，包括但不限于二维码图案。视觉标志固定在机械臂末端，其位置不随机械臂每次抓取物体而变化，且保证能和物体一起被相机拍到。工控机用于运行相关算法，通过网线与相机连接。
[0019]如图1所示，本专利技术实施例的基于视觉标志的机械臂飞拍定位方法，包括如下步骤：步骤S1，将视觉标志固定在机械臂末端，其中，视觉标志为相机拍照后可计算出其相对于相机3D位姿的平面图案。
[0020]在本专利技术的实施例中，视觉标志可以采用二维码图案。
[0021]步骤S2，通过相机多次拍照计算视觉标志相对于机械臂末端的位姿。
[0022]具体的，将相机安装在工作台上，操作机械臂运动到多个不同位姿，保证视觉标志出现在相机视野内。优选的，可以运动10个左右的位姿。
[0023]对于位姿i，利用图像处理算法（具体算法因视觉标志而异）计算出视觉标志相对于相机的位姿，同时可通过机械臂正运动学直接获取机械臂末端法兰相对于基坐标系的位姿。已知视觉标志相对于机械臂末端法兰的位姿是固定不变的，相机相对于机械臂基坐标系的位姿也是固定不变的。对于位姿i和位姿i+1，可建立方程。利用上述多组数据，可通过求解计算出视觉标志相对于机械臂末端法兰的位姿。
[0024]在本专利技术的实施例中，机械臂法兰相对于机械臂基坐标系的位姿可以采用机械臂正运动学获得。此为机械臂的基本功能。
[0025]步骤S3，机械臂从取料区抓取物体，并朝相机方向运动。
[0026]步骤S4，机械臂运动到相机上方邻近区域，触发相机拍照。需要说明的是，整个过程中机械臂不停止运动。
[0027]步骤S5，相机拍照后，计算出视觉标志相对于相机的位姿，和物体相对于相机的位姿。
[0028]在本专利技术的实施例中，和均采用图像处理算法计算得到，（具体算法因物体及相机类型可能会有所不同。
[0029]下面对和的位姿计算过程进行说明。
[0030]两者的原理是类似的，都是通过图案上的多个特征点和相机参数来确定图案相对于相机的位姿。计算方法可能会由于相机不同（2D或3D）、物体不同有所区别。大致步骤如下：(1). 假定本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于视觉标志的机械臂飞拍定位方法，其特征在于，包括如下步骤：步骤S1，将视觉标志固定在机械臂末端，其中，视觉标志为相机拍照后可计算出其相对于相机3D位姿的平面图案；步骤S2，通过相机多次拍照计算视觉标志相对于机械臂末端的位姿；步骤S3，机械臂从取料区抓取物体，并朝相机方向运动；步骤S4，机械臂运动到相机上方邻近区域，触发相机拍照；步骤S5，相机拍照后，计算出视觉标志相对于相机的位姿，和物体相对于相机的位姿；步骤S6，根据、和，计算出物体相对于机械臂末端的位姿；步骤S7，利用物体相对于机械臂末端的位姿执行装配任务；步骤S8，判断是否需要重复执行下一次任务，如果是则返回步骤S3；否则结束。2.如权利要求1所述的基于视觉标志的机械臂飞拍定位方法，其特征在于，视觉标志采用二维码图案。3.如权利要求1所述的基于视觉标志的机械臂飞拍定位方法，...

【专利技术属性】
技术研发人员：李亚楠，韩峰涛，庹华，张航，马建涛，袁顺宁，韩建欢，
申请(专利权)人：珞石北京科技有限公司，
类型：发明
国别省市：