[发明专利]一种基于SCARA机械手第二臂的移动相机标定方法

说明书

一种基于SCARA机械手第二臂的移动相机标定方法，一：标记放在台面上，记录机器人当前位置拍照，搜索图像标记在图像坐标系位置；二：控制第二臂平移，记录移动后机器人当前位置拍照，搜索图像中标记在图像坐标系中位置；三：机械手回到起始位置，在当前位置R轴分别旋转θ和‑θ角拍照；四：计算图像与机器人坐标系的旋转和缩放关系，图像与机器人坐标系平移关系；五：构建局部坐标系，获取局部到机器人坐标系映射关系；六：转换机器人在任一位置所对应的图像坐标系上的像素到机器人坐标系上，计算第二臂旋转角度，获得局部坐标系到局部坐标系旋转关系，局部坐标系与局部坐标系平移关系，综合旋转平移关系，局部坐标系与局部坐标系坐标系映射关系。

技术领域

本发明涉及机器人标定方法技术领域，特别是一种基于SCARA机械手第二臂的移动相机标定方法。

背景技术

SCARA是Selective Compliance Assembly Robot Arm的缩写，意思是一种应用于装配作业的机器人手臂。工业机器人已经广泛应用在工件的自动搬运、组装等工作上。由于针对来料工件的位置会出现无固定偏差情形，为了有序控制机械手臂的工作，因此，实际工作中，如要达到高精度的搬运及组装功能，就需要建立相机坐标系与机器人控制系统坐标系的映射关系，这样便可以将工件在图像坐标系中的位置转换到机器人控制系统坐标系中，进而获取工件在机器人控制系统坐标系中的位置，保证后续机器人控制系统控制机械手臂正常无误差的工作，此过程在业界称为标定。

现有的标定方法，主要分为人工作示教标定，以及由视觉软件引导机器人自动标定。人工示教标定不仅操作繁琐，而且因人为因素会影响标定的精度，在实际应用中存在很大缺陷。视觉引导自动标定相较于人工作示教标定具有操作方便、以及提高了标定精度的优点。视觉引导自动标定主要采用相机进行，针对相机姿态而言，标定又分为固定相机标定和安装在机械手臂上随机械手臂运动的移动相机标定。对于固定相机标定而言，存在作业区域较小的缺点。而现有移动相机标定，虽然作业区域范围较广，然而水平多关节机械手第二臂(相当于人手小臂)上的移动相机标定，大多方法会涉及到手动示教点位操作，即在相机视野内放置一些靶标(如圆形标记)，通过视觉软件识别这些靶标的图像位置(如圆形靶标，视觉软件识别该圆形靶标的圆心所对应的像素位置),然后手动示教这些靶标的每一个位置，通过人眼观察每个靶标位置与机械手R轴中心重合，获得每个靶标的像素坐标所对应的机器人坐标，进而通过这些点的对应关系，最终完成标定计算；但是这些点对(像素位置与机器人位置)中的机器人位置坐标是通过人眼观察手动示教得到的，并非精准，显然在建立图像坐标系与机器人坐标系的映射关系受人为因素影响很大，因而存在标定具有不方便性、标定精度不高等缺点。

发明内容

为了克服现有机器人水平多关节机械手第二臂上的移动相机标定中存在的弊端，本发明提供了能实现一键自动标定功能，即通过视觉软件与机器人控制器通讯连接，只需要点击视觉软件上的标定按钮，就会启动标定程序，视觉软件便与机器人控制器进行程序交互，自动完成标定，具体过程是视觉软件通过通讯获取机器人的当前位置，通过机器人当前位置，计算若干位置，并将这若干位置逐一发送给机器人控制器，当机器人到达每一个位置时，机器人控制程序会发送拍照指令通知视觉软件拍照，视觉软件识别靶标的图像位置，最终视觉软件根据机器人位置以及对应的靶标的图像位置进行计算，自动完成标定，无需人工手动示教，操作极其简便且具有高的标定精度，应用中相机随着机器人第二臂的移动而移动，扩大了视觉的作业区域，机器人在任何位置，都可以将对应机器人位置下的相机视野内的任何工件所在的图像位置转换到机器人控制系统坐标系上，机器人控制系统能精确获取工件在机器人坐标系上的坐标位置，从而引导机器人的机械臂进行相应精准动作，完成高精度搬运及组装功能的一种SCARA机械手第二臂上的移动相机自动标定方法。

本发明解决其技术问题所采用的技术方案是：