一种面向曲面构件的机器人快速定位方法与流程
本发明涉及一种机器人技术，尤其是一种机器人定位技术，具体地说是一种面向曲面构件的机器人快速定位方法。
背景技术：
工业机器人已经广泛应用于汽车和电子行业，但是大多以离线编程的方式控制机器人位姿，无法以主动识别定位的方式对目标进行定位，使用范围极其有限；而在航空航天等军工领域，由于其具有工作环境特殊、对象特征复杂等特点，机器人视觉应用范围较窄。目前，高端化、智能化正成为工业机器人领域的研究热点，而依靠机器视觉辅助的工业机器人定位在航空航天领域拥有非常广阔的应用前景。
国内在机器人视觉定位领域已经有了一定的研究成果，主要采用两种方式：一是机器人单目视觉定位方法，通过安装于机器人末端的相机识别并解算目标位置，这种方法定位精度较低，并且只适用于如圆柱、环状、长方体等外形规则的目标；二是机器人结构光扫描定位方法，通过结构光扫描系统重建目标外形并计算位姿，这种方法精度相较于第一种方法有明显的提高，但是考虑到对航空航天构件的结构复杂与特殊性，定位时易受环境光照和构件表面属性影响，更重要的是对结构光扫描结果点云处理耗时较长，因此该方法也不具有较高的普适性。
技术实现要素：
本发明的目的是针对现有的机器人定位采用单目视觉定位精度不高，采用结构光扫描定位受环境影响较大的问题，发明一种定位精度高，不受环境影响的面向曲面构件的机器人双目视觉定位方法。
本发明的技术方案是：
一种面向曲面构件的机器人快速定位方法，其特征是首先对机器人双目视觉系统进行参数标定，包括相机内外参数以及手眼标定参数；然后使用双相机采集目标图像，提取图像中的二维定位特征点，并进行畸变校正；利用相机标定结果将定位特征点二维坐标转换成相机坐标系下的三维测量坐标；最后根据定位特征点的三维测量坐标、理论坐标以及手眼标定参数求解机器人运动参数。具体步骤如下：
步骤1、在机器人法兰、末端执行器以及标定工装布置测量点作为坐标系转换基准点，三者的基准点同时处于被激光跟踪仪测量范围内，每个机构上基准点个数不少于3个；
步骤2、分别使用激光跟踪仪和相机获取相关坐标，具体为：
(1)利用激光跟踪仪测量机器人法兰、末端执行器以及标定工装基准点，获得测量坐标
(2)利用视觉测量系统测量标定工装基准点，获得测量坐标
步骤3、根据步骤2测量获得的坐标计算与激光跟踪仪测量坐标系相关的映射关系，具体为：
(1)根据标定工装基准点的激光跟踪仪和视觉测量系统测量坐标
(2)根据机器人法兰基准点的理论坐标
(3)根据末端执行器准点的理论坐标
步骤4、根据步骤3获得的映射关系进一步计算与机器人位姿参数相关的映射关系，具体为：
(1)根据视觉测量系统与激光跟踪仪测量坐标系映射关系
(2)根据机器人法兰坐标系与激光跟踪仪测量坐标系映射关系
步骤5、计算曲面构件在视觉系统坐标系中三维坐标，具体为：
(1)在曲面构件角点处粘贴三角形辅助反射靶标将机器人示教至曲面构件上方，确保曲面件在视觉测量系统视场范围内，采集曲面构件图像；
(2)使用harris算法提取曲面构件表面三角形辅助反射靶标角点的像素坐标；
(3)基于对极约束删除冗余匹配点并计算剩余特征点在视觉测量系统坐标系中三维坐标
步骤6、根据步骤4中映射关系、步骤5中曲面构件视觉测量坐标计算机器人运动参数，具体为：
(1)根据重建后的三维坐标
(2)根据曲面构件在机器人法兰坐标系中的坐标
(3)根据曲面构件在末端执行器坐标系中的坐标
(4)根据曲面构件测量获得的位姿参数mmea＝(xyzabc)mea与曲面构件理论位姿参数mtheo＝(xyzabc)theo计算机器人运动量，并驱动机器人至指定位置。
本发明的有益效果是：
本发明可以应用于机器人视觉定位。与现有技术相比，本发明的机器人视觉定位系统简单，易于实现，能够有效地适用各种外形零件，在很短的时间内对目标进行识别和定位，提高机器人工作效率和可靠性。
1)采用激光跟踪仪精确标定机器人与视觉测量系统之间转换矩阵，提高手眼标定参数可靠性。
2)采用高精度的双目视觉测量系统与辅助反射靶标，对曲面构件定位信息的快速、准确重构。
3)适用对象广泛，可对航空、汽车等曲面件进行快速定位。
附图说明
图1高精度标定平台示意图。
图2机器人视觉系统标定示意图。
图3曲面构件定位特征点提取示意图。
图4机器人视觉定位系统坐标系转换过程示意图。
图5机器人调姿示意图。
图6机器人视觉定位流程图。
图7是本发明的测量系统结构示意图。
具体实施方式
下面结合附图对本发明作进一步详细描述。
如图1-7所示，
本发明涉及的机器人视觉定位系统包括机器人、末端执行器3、视觉测量系统2，末端执行器2通过机器人法兰1与机器人连接，视觉测量系统2安装于末端执行器3上；定位前，机器人与曲面构件位置随机，需确保曲面构件在机器人可达范围内；本发明中规定定位完成状态为末端执行器工具到达曲面构件质心或质心上方一定距离处，如图7所示。
本发明的机器人定位流程如图6所示，它包括以下步骤。
步骤1，在机器人法兰1、末端执行器3以及标定工装布置测量点作为坐标系转换基准点，三者的基准点能够同时被激光跟踪仪测量到，标定工装基准点能够被视觉测量系统2测量到，每个机构上基准点个数不少于3个，其中标定工装如图1所示；
步骤2、分别使用激光跟踪仪和相机获取相关坐标，如图2所示，具体为：
(1)利用激光跟踪仪测量机器人法兰、末端执行器以及标定工装基准点，获得测量坐标
(2)利用视觉测量系统测量标定工装基准点，获得测量坐标
步骤2中激光跟踪仪测量时使用激光跟踪仪专用靶球，视觉测量系统测量时使用光学反射靶球；
步骤3、根据步骤2测量获得的坐标计算与激光跟踪仪测量坐标系相关的映射关系，具体为：
(1)根据标定工装基准点的激光跟踪仪和视觉测量系统测量坐标
(2)根据机器人法兰基准点的理论坐标
(3)根据末端执行器准点的理论坐标
步骤4、根据步骤3获得的映射关系进一步计算与机器人位姿参数相关的映射关系，具体为：
(1)根据视觉测量系统与激光跟踪仪测量坐标系映射关系
(2)根据机器人法兰坐标系与激光跟踪仪测量坐标系映射关系
步骤1-4为机器人视觉定位系统标定过程，在定位系统不发生变化或受到外力影响导致定位精度降低时，标定完成后无需重复标定；
步骤5、计算曲面构件在视觉系统坐标系中三维坐标，具体为：
(1)在曲面构件角点处粘贴三角形辅助反射靶标将机器人示教至曲面构件上方，确保曲面件在视觉测量系统视场范围内，采集曲面构件图像；
(2)使用sift算法提取零件至少4个定位特征点，如图3所示，提取的定位特征点不处于同一直线上；
(3)基于对极约束删除冗余匹配点并计算剩余特征点在视觉测量系统坐标系中三维坐标
步骤6、根据步骤4中映射关系、步骤5中曲面构件视觉测量坐标计算机器人运动参数，其中坐标系转换过程如图4所示，具体为：
(1)根据重建后的三维坐标
(2)根据曲面构件在机器人法兰坐标系中的坐标
(3)根据曲面构件在末端执行器坐标系中的坐标
(4)根据曲面构件测量获得的位姿参数mmea＝(xyzabc)mea与曲面构件理论位姿参数mtheo＝(xyzabc)theo计算机器人运动量，并驱动机器人至指定位置，如图5所示。
当驱动量小于阈值tol时，停止调姿；否则重复步骤5、6。
本发明未涉及部分与现有技术相同或可采用现有技术加以实现。
- 还没有人留言评论。精彩留言会获得点赞！