【技术实现步骤摘要】
基于2D相机的机器人自动加注方法
[0001]本专利技术涉及加注
,尤其涉及基于2D相机的机器人自动加注方法。
技术介绍
[0002]加注是工业现场一种常见的作业需求,例如电池充电,车辆加油,胶桶加注胶水,漆桶加注油漆等等,这一类加注作业的特征可以抽象为同一类动作:准确定位加注口的空间位置,并把枪口准确插入加注口,在机器人普及之前,此类作业往往由人工完成,现在可以由机器视觉自动识别加注口并计算加注口的三维空间位置,并由机器人携带加注枪插入加注口,控制阀门打开并完成加注作业。
[0003]由于加注作业中,加注口和加注枪往往有一定的配合精度要求,使得加注口和加注枪能够可靠地连接,从而完成作业,因此,在机器人携带加注枪插入加注口时,加注口相对于机器人(更进一步即加注枪)的位姿(位置和姿态)需要精确地计算出来,加注口的位姿计算通常用视觉的方法进行精确定位,视觉定位可以通过3D相机完成,由于这里的定位精度要求高,所以需要高精度的3D相机,而高精度的3D相机通常价格昂贵,往往是普通工业相机(即2D相机)的几十倍上百倍,而且高精度的3D相机往往视野范围有限,故而亟待提出一种基于2D相机的机器人自动加注方法来解决上述问题。
技术实现思路
[0004]本专利技术的目的在于:为了解决上述问题,而提出的基于2D相机的机器人自动加注方法。
[0005]为了实现上述目的,本专利技术采用了如下技术方案:
[0006]基于2D相机的机器人自动加注方法,所述基于2D相机的机器人自动加注方法所使用的装置包 ...
【技术保护点】
【技术特征摘要】
1.基于2D相机的机器人自动加注方法,其特征在于,所述基于2D相机的机器人自动加注方法所使用的装置包括有机器人、加注枪、容器与相机,所述加注枪与相机均固定安装在机器人输出端,且加注枪与相机呈竖直分布;所述基于2D相机的机器人自动加注方法包括有以下步骤:S1、相机内参标定,初始状态下,得到相机的内参矩阵K和畸变系数,相机与标靶的相对位置随机,此时计算出相机与标记物的3D姿态,此时3D姿态精度一般;S2、手眼标定,根据第一步的3D姿态调整机器人姿态,使得相机初步垂直与标记物平面且相机到标记物平面的距离为Z;S3、精细调整,机器人工具末端姿态,使得加注枪准确对准加注口,此作为校准位置,进一步使得相机初步垂直与标记物平面且相机到标记物平面的距离为Z,此时相机与标记物平面基本垂直,且距离Z的精度达到0.2mm左右;S4、校准位置,通过识别标记物的特征,分别计算出粗对准和精对准时相机相对于标记物的姿态,在应用辅助工具使得加注枪精确对准加注口,由于此时距离Z误差(1mm)相对于距离Z本身(300mm),基本可以忽略不计,通过仿射矩阵计算出加注口XY方向的位置关系,此时XY方向的精度达到几十微米的精度,Z方向的精度仍然为第三步Z方向的精度;S5、加注作业运行,由机器人带动加注枪插入加注口,开始加注作业。2.根据权利要求1所述的基于2D相机的机器人自动加注方法,其特征在于,所述计算相机与标记物的3D姿态的方法包括以下步骤:标记物在世界坐标系下的姿态机器人末端工具世界坐标系下的姿态加注口在标记物坐标系下的姿态加注枪在相机坐标系下的姿态相机在工具坐标系下的姿态相机在标记物坐标系下的姿态加注枪相对于加注口的姿态其中是不变的,因为标记物与加注口是由机械安装固定,相机和加注枪都由机械安装固定在机器人工具末端,因此和也是不变的;由于AGV的定位误差,每次AGV达到加油位置后,agv相对于加注口都有较大的误差,因此每次调整机器人末端工具的姿态T
tool
,使得加注枪相对于加注口重合,即即为单位矩阵;此时相机在标记物坐标系中的姿态就可以计算出机器人需要调整的工具末端姿态T
tool
,使得加注枪相对于加注口的姿态机器人调整之前相机相对于标记物的姿态为
机器人调整之后相机和工具末端的姿态都有变化,它们分别记为cam
′
和tool
′
相对于标记物的姿态为标记物的姿态为联立(E.Q.1)和(E.Q.2)即即由于相机是固定在工具末端的,当机器人工具末端调整时,相机相对于工具末端的姿态并不会发生变化,因此即即是在对准位置,机器人工具末端的姿态,控制机器人达到这个姿态后,加注枪即可以对准加注口;当前机器人工具末端的姿态,由机器人读取;相机在机器人工具末端的姿态,即手眼矩阵,事先标定获取;当前标记物相对于相机的姿态,由PnP方法求得;加注枪对准加注口时,相机相对于标记物的姿态,由事先校准过程得到;加注枪对准加注口时,相机相对于机器人工具末端的姿态,即手眼矩阵3.根据权利要求2所述的基于2...
【专利技术属性】
技术研发人员:熊斌,张向锋,王世程,白静文,夏浩翔,
申请(专利权)人:苏州岗上机器人有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。