移动工业机器人单点多视角挂表位姿误差检测方法
【技术领域】
[0001]本发明涉及一种移动工业机器人单点多视角挂表位姿误差检测方法，属于智能设备技术领域。
【背景技术】
[0002]工业机器人有助于实现工业自动化，可以完成各种简单而重复的任务，比如在抓放情况下，一般通过示教来确定各路径点，然后让机械手重复示教的路径完成任务。但是，在机械手的抓放操作中存在一些外界干扰因素，尤其是对基座非固定的移动工业机器人(AGV或者RGV引导等)来说，会直接影响到抓放的精度，因此常常引入简单实用的平面视觉定位来消除误差。考虑到成本和效率问题，现有技术中一般采用低端版本的相机来进行定位，相机的可调焦距和视角都很小，可采集的视觉范围大大受限，如果通过提升拍摄距离来解决，会导致拍摄图片的畸变，从而在模板匹配与比较的时候产生很大的误差，因此是不可行的。
[0003]目前，现有技术中一般都采用单点定位，一方面可以降低对相机的要求，另一方面可以提高图像的处理速度，而定位中往往只能确定位置误差，对于姿态误差基本没有涉及。研宄发现，姿态误差也在很大程度上影响抓放的精度，尤其是在同时抓放多个工件的时候，姿态误差可能会导致边缘工件在抓放的时候产生很大的位置误差，严重影响机械手抓放的精度，有可能造成工业事故。鉴于此，迫切需要一种能够对位置和姿态误差进行检测的装置和方法。
【发明内容】
[0004]为解决现有技术的不足，本发明的目的在于提供一种移动工业机器人单点多视角挂表位姿误差检测方法。
[0005]为了实现上述目标，本发明采用如下的技术方案:
[0006]移动工业机器人单点多视角挂表位姿误差检测方法，包括如下步骤:
[0007]S1、根据示教拍摄包含一个特征点的模板图片，保存在存储器中；
[0008]S2、驱动移动工业机器人的末端执行器到达示教目标点所在位置，相机拍摄一张包含步骤Si所述的特征点的图片，通过与模板图片匹配比较，得到位置初步误差；即，图片一旦匹配成功，便可根据像素点数和实际中对应的距离确定特征点的实际误差值，得到位置初步误差。
[0009]S3、末端执行器在X轴、Y轴或Z轴中的至少一个方向上发生位移，相机再次拍摄一张包含步骤SI所述的特征点的图片，与步骤S2拍摄的图片匹配比较，得出两个图片中特征点的相对位置变化，确定姿态角误差。即:在该步骤S3的匹配比较中，首先知道两个特征点的实际相对移动距离，再根据图片比较得出相应的像素点数，便可确定每两个像素点之间对应的实际距离，最后便可进一步求得姿态误差所需要的参数，确定位置误差和姿态角误差。当然，位置误差也可以在步骤S3中确定，方法同上，这取决于实际应用时对于实时性和处理效率的要求。
[0010]在本发明中，平面视觉定位取末端执行器的三个自由度，即确定位置的X轴、Y轴方向的移动自由度，以及确定姿态的绕着Z轴转动的旋转自由度，在实际定位中应用起来简单而且符合实际情况。
[0011]作为本发明的一个替代方案，步骤S3由下面的步骤S4替代:末端执行器在X轴、Y轴或Z轴中的至少一个方向上发生多次位移，同时相机拍摄多张图片，然后求取均值或中值，得到位置误差和姿态角误差，这是很容易理解得到的扩充方案。
[0012]具体地，前述移动工业机器人由AGV或者RGV引导，这是现有技术中常用的两种移动工业机器人的方式。
[0013]作为一种优选，前述末端执行器安装于移动工业机器人的法兰盘上，相机安装于移动工业机器人的末端，这样的结构能够实时采集变化环境中的图片。
[0014]末端执行器的X轴、Y轴或Z轴移动可以工具坐标系下，也可以在笛卡尔坐标系下或者关节坐标系下。优选为工具坐标系下，方便机械手的示教，尤其适用于工作台是斜面的情况。
[0015]本发明的有益之处在于:本发明的移动工业机器人单点多视角挂表位置和姿态误差的检测方法，首先通过一个特征点拍照初步确定末端执行器在工具坐标系下与示教目标点的位置误差，再让末端执行器在工具坐标系下沿着坐标轴方向移动一定的距离，再进行拍照，并与上一次拍照的图片进行模板匹配比较，确定特征点的相对误差，从而最终确定末端执行器的位置和姿态误差。该方法主要是通过算法来确定移动工业机器人平面视觉定位中末端的位姿误差，仅仅通过简单的一个特征点即可确定，不仅可以解决实际应用中条件受限的问题(如相机视角和焦距、成本等)，也可以在一定程度上提高图像处理的效率和速度(单点处理)，解决工业中图像处理的实时性问题。
【附图说明】
[0016]图1是RGV引导的移动工业机器人的结构示意图；
[0017]图2是图1中的末端执行器与相机的结构示意图；
[0018]图3是一用于放置电表的斜面工作台的结构示意图；
[0019]图4是本发明的检测方法中单点多视角定位的原理示意图；
[0020]图5是姿态角误差的求解原理图。
[0021]图中附图标记的含义:1、移动工业机器人，2、RGV，3、末端执行器，4、相机，5、斜面工作台，6、电表。
【具体实施方式】
[0022]以下结合附图和具体实施例对本发明作具体的介绍。
[0023]如图1所示，移动工业机器人I通过AGV或RGV2引导，通过示教的方式来实现抓放操作的编程，由于机器人基座是非固定的，因而容易被外界干扰，导致末端执行器3到达的位置并不恰好是示教的位置，影响抓放精度。本发明通过单点多视角的方式来确定位置误差和姿态角误差，从而最大程度低补偿由移动平台或者外界其他不确定因素带来的位姿误差。如图2所示，末端执行器3安装于移动工业机器人I的法兰盘上，相机4安装于移动工业机器人I的末端，这样的结构能够实时采集变化环境中的图片。
[0024]图3所示的是一个斜面工作台5组成的立柜，工作台上排布有电表6，这是为了结合本发明的实际应用进行说明而提供的具体实施场景。
[0025]参见图4和图5，本发明的移动工业机器人I单点多视角挂表位姿误差检测方法，包括如下步骤:
[0026]S1、根据示教拍摄包含一个特征点的模板图片，保存在存储器中；
[0027]S2、驱动移动工业机器人I的末端执行器3到达示教目标点所在位置，相机4拍摄一张包含步骤Si所述的特征点的图片，通过与模板图片匹配比较，得到位置初步误差；即，图片一旦匹配成功，便可根据像素点数和实际中对应的距离确定特征点的实际误差值，得到位置初步误差。
[0028]S3、末端执行器3在X轴、Y轴或Z轴中的至少一个方向上发生位移，相机4再次拍摄一张包含步骤SI所述的特征点的图片，与步骤S2拍摄的图片匹配比较，得出两个图片中特征点的相对位置变化，确定姿态角误差。即:在该步骤S3的匹配比较中，首先知道两个特征点的实际相对移动距离，再根据图片比较得出相应的像素点数，便可确定每两个像素点之间对应的实际距离，最后便可进一步求得姿态误差所需要的参数，确定位置