一种基于SCARA机械手第二臂的移动相机标定方法技术

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

A calibration method of mobile camera based on the second arm of SCARA manipulator

A calibration method of mobile camera based on the second arm of SCARA manipulator: first, place the mark on the table, record the current position of robot, take photos, search for the position of image mark in image coordinate system; second, control the translation of the second arm, record the current position of robot after moving, take photos, search for the position of mark in image coordinate system; third, the manipulator returns to the starting position, at the current position Position r axis rotates \u03b8 and \u2011 \u03b8 angle respectively to take photos; four: calculate the rotation and scaling relationship between the image and the robot coordinate system, and the translation relationship between the image and the robot coordinate system; five: construct the local coordinate system, and obtain the mapping relationship between the local and the robot coordinate system; six: convert the pixels of the robot in the image coordinate system corresponding to any position to the robot coordinate system, and calculate the second arm Rotation angle, obtain rotation relationship from local coordinate system to local coordinate system, translation relationship between local coordinate system and local coordinate system, comprehensive rotation translation relationship, mapping relationship between local coordinate system and local coordinate system.

【技术实现步骤摘要】
一种基于SCARA机械手第二臂的移动相机标定方法
本专利技术涉及机器人标定方法
，特别是一种基于SCARA机械手第二臂的移动相机标定方法。
技术介绍
SCARA是SelectiveComplianceAssemblyRobotArm的缩写，意思是一种应用于装配作业的机器人手臂。工业机器人已经广泛应用在工件的自动搬运、组装等工作上。由于针对来料工件的位置会出现无固定偏差情形，为了有序控制机械手臂的工作，因此，实际工作中，如要达到高精度的搬运及组装功能，就需要建立相机坐标系与机器人控制系统坐标系的映射关系，这样便可以将工件在图像坐标系中的位置转换到机器人控制系统坐标系中，进而获取工件在机器人控制系统坐标系中的位置，保证后续机器人控制系统控制机械手臂正常无误差的工作，此过程在业界称为标定。现有的标定方法，主要分为人工作示教标定，以及由视觉软件引导机器人自动标定。人工示教标定不仅操作繁琐，而且因人为因素会影响标定的精度，在实际应用中存在很大缺陷。视觉引导自动标定相较于人工作示教标定具有操作方便、以及提高了标定精度的优点。视觉引导自动标定主要采用相机进行，针对相机姿态而言，标定又分为固定相机标定和安装在机械手臂上随机械手臂运动的移动相机标定。对于固定相机标定而言，存在作业区域较小的缺点。而现有移动相机标定，虽然作业区域范围较广，然而水平多关节机械手第二臂(相当于人手小臂)上的移动相机标定，大多方法会涉及到手动示教点位操作，即在相机视野内放置一些靶标(如圆形标记)，通过视觉软件识别这些靶标的图像位置(如圆形靶标，视觉软件识别该圆形靶标的圆心所对应的像素位置),然后手动示教这些靶标的每一个位置，通过人眼观察每个靶标位置与机械手R轴中心重合，获得每个靶标的像素坐标所对应的机器人坐标，进而通过这些点的对应关系，最终完成标定计算；但是这些点对(像素位置与机器人位置)中的机器人位置坐标是通过人眼观察手动示教得到的，并非精准，显然在建立图像坐标系与机器人坐标系的映射关系受人为因素影响很大，因而存在标定具有不方便性、标定精度不高等缺点。
技术实现思路
为了克服现有机器人水平多关节机械手第二臂上的移动相机标定中存在的弊端，本专利技术提供了能实现一键自动标定功能，即通过视觉软件与机器人控制器通讯连接，只需要点击视觉软件上的标定按钮，就会启动标定程序，视觉软件便与机器人控制器进行程序交互，自动完成标定，具体过程是视觉软件通过通讯获取机器人的当前位置，通过机器人当前位置，计算若干位置，并将这若干位置逐一发送给机器人控制器，当机器人到达每一个位置时，机器人控制程序会发送拍照指令通知视觉软件拍照，视觉软件识别靶标的图像位置，最终视觉软件根据机器人位置以及对应的靶标的图像位置进行计算，自动完成标定，无需人工手动示教，操作极其简便且具有高的标定精度，应用中相机随着机器人第二臂的移动而移动，扩大了视觉的作业区域，机器人在任何位置，都可以将对应机器人位置下的相机视野内的任何工件所在的图像位置转换到机器人控制系统坐标系上，机器人控制系统能精确获取工件在机器人坐标系上的坐标位置，从而引导机器人的机械臂进行相应精准动作，完成高精度搬运及组装功能的一种SCARA机械手第二臂上的移动相机自动标定方法。本专利技术解决其技术问题所采用的技术方案是：一种基于SCARA机械手第二臂的移动相机标定方法，其特征在于移动数码相机安装在机器人第二机械臂上，数码相机和机器人的控制系统经数据线连接，标定方法分为六个步骤，步骤一：将制作好的靶标(如圆形标记实物，可以在一张纸上打印一个圆形标记)放在作业区域台面上且保证标记在相机视野内，通过通讯，软件问询此时机器人当前位置(XM0,YM0,ZM0,RM0)，机器人控制程序向视觉软件发送当前位置并发送拍照指令，视觉软件接受到拍照指令，视觉软件控制相机采集图像，并对图像中的靶标进行图像识别，确定图像中的靶标在图像坐标系中的位置(XI0,YI0)；步骤二：确保靶标在工作平面上的位置不变，视觉软件根据问询的机器人起始位置自动计算机器人机械手第二臂平移动作的机器人坐标位置，通过指令将该坐标位置发送给机器人控制器，机器人控制程序便可控制机器人机械手的第二臂进行平移动作，且保证靶标在相机视野内，记录移动后机器人当前位置(XM1,YM1,ZM0,RM1)，触发相机拍照，搜索图像中标记在图像坐标系中的位置为(XI1,YI1)；步骤三：控制机械手回到起始位置(XM0,YM0,ZM0,RM0)，利用安装在旋转R轴上的治具将标记吸附起来，在当前位置R轴分别旋转θ和-θ角并触发相机拍照，机器人在位置(XM0,YM0,ZM0,RM0+θ)上，搜索靶标在图像坐标系中的位置为(XI2,YI2)，机器人在位置(XM0,YM0,ZM0,RM0-θ)上，搜索靶标在图像坐标系中的位置为(XI3,YI3)；步骤四：根据步骤一、二计算图像坐标系与机器人坐标系的旋转和缩放关系，根据步骤三计算图像坐标系与机器人坐标系的平移关系；步骤五：构建一个以机器人起始位置(XM0,YM0,ZM0,RM0)为原点、XY坐标轴均与机器人坐标系平行的局部坐标系L1，获取局部坐标系L1到机器人坐标系的映射关系为ML1→G；步骤六：将机器人在任一位置(XM,YM,ZM,RM)所对应的图像坐标系上的像素映射到机器人坐标系上，通过机器人当前位置(XM,YM,ZM,RM)以及起始位置(XM0,YM0,ZM0,RM0)计算第二臂的旋转角度，即可获得局部坐标系L1到局部坐标系L2的旋转关系，根据当前位置(XM,YM,ZM,RM)与起始位置(XM0,YM0,ZM0,RM0)的差值，可以获取局部坐标系L1与局部坐标系L2的平移关系，综合旋转平移关系，获取局部坐标系L2与局部坐标系L1坐标系的映射关系ML2→L1。进一步地，所述步骤四中，确定了两坐标系之间的平移、旋转、缩放量后，可计算两坐标系之间的映射矩阵MI→M,该矩阵代表机器人在位置(XM0,YM0,ZM0,RM0)上、此时相机坐标系与机器人坐标系的映射关系。进一步地，所述步骤五中，获取局部坐标系L1到机器人坐标系的映射关系ML1→G后，建立局部坐标系L1与相机坐标系(机器人位置为(XM0,YM0,ZM0,RM0)所对应的图像坐标系)的映射关系MI→L1。进一步地，所述步骤六中，获取局部坐标系L2与局部坐标系L1坐标系的映射关系ML2→L1后，进而可以确定当前位置上的图像坐标系上的像素到机器人坐标系上的映射关系为MI→L2*ML2→L1*ML1→G。本专利技术有益效果是：本专利技术通过六个简单步骤、完成位于机器人第二臂移动相机的视觉引导自动标定流程，能实现一键自动标定功能。过程中无需人工手动示教，标定过程均是通过视觉软件与机器人控制程序进行交互自动完成，操作极其简便且具有高的标定精度，应用中相机随着机器人第二臂的移动而移动，扩大了视觉的作业区域，克服了现有固定相机标定存在作业区域较小的缺点。机器人在任何位置，都可以将对应机器人位置下的相机视野内的任何工件所在的图像位置转换到机器人控制系统坐标系上，机器人控制系统精确获取工件在机器人控制系统坐标系上本文档来自技高网...

【技术保护点】
1.一种基于SCARA机械手第二臂的移动相机标定方法，其特征在于移动数码相机安装在机器人第二机械臂上，数码相机和机器人的控制系统经数据线连接，标定方法分为六个步骤，步骤一：将制作好的靶标放在作业区域台面上且保证标记在相机视野内，通过通讯，软件问询此时机器人当前位置(X

【技术特征摘要】
1.一种基于SCARA机械手第二臂的移动相机标定方法，其特征在于移动数码相机安装在机器人第二机械臂上，数码相机和机器人的控制系统经数据线连接，标定方法分为六个步骤，步骤一：将制作好的靶标放在作业区域台面上且保证标记在相机视野内，通过通讯，软件问询此时机器人当前位置(XM0,YM0,ZM0,RM0)，机器人控制程序向视觉软件发送当前位置并发送拍照指令，视觉软件接受到拍照指令，视觉软件控制相机采集图像，并对图像中的靶标进行图像识别，确定图像中的靶标在图像坐标系中的位置(XI0,YI0)；步骤二：确保靶标在工作平面上的位置不变，视觉软件根据问询的机器人起始位置自动计算机器人机械手第二臂平移动作的机器人坐标位置，通过指令将该坐标位置发送给机器人控制器，机器人控制程序便可控制机器人机械手的第二臂进行平移动作，且保证靶标在相机视野内，记录移动后机器人当前位置(XM1,YM1,ZM0,RM1)，触发相机拍照，搜索图像中标记在图像坐标系中的位置为(XI1,YI1)；步骤三：控制机械手回到起始位置(XM0,YM0,ZM0,RM0)，利用安装在旋转R轴上的治具将标记吸附起来，在当前位置R轴分别旋转θ和-θ角并触发相机拍照，机器人在位置(XM0,YM0,ZM0,RM0+θ)上，搜索靶标在图像坐标系中的位置为(XI2,YI2)，机器人在位置(XM0,YM0,ZM0,RM0-θ)上，搜索靶标在图像坐标系中的位置为(XI3,YI3)；步骤四：根据步骤一、二计算图像坐标系与机器人坐标系的旋转和缩放关系，根据步骤三计算图像坐标系与机器人坐标系的平移关系；步骤五：构建一个以机器人起始位置(XM0,YM0,ZM0,RM0)为原点、XY坐标轴均与机器人坐标系平行...

【专利技术属性】
技术研发人员：赵志华，刘文状，潘照飞，
申请(专利权)人：苏州精速智能科技有限公司，
类型：发明
国别省市：江苏;32