一种基于测量数据的管路柔性装焊机器人位姿计算方法
【技术领域】
[0001] 本发明涉及一种基于测量数据的管路柔性装焊机器人位姿计算方法，是基于装焊 系统的测量数据及设备位置，计算导管装配时机器人位姿的方法。属于计算机辅助设计制 造领域。
【背景技术】
[0002] 管路系统在几乎所有机电产品中都有广泛的应用，其功能主要是输送介质的通 道。特别是在航空航天领域，导管都是飞机或者各类航天器的重要组成部分，管路系统能够 正常运行是决定产品性能和质量的一个很重要的条件。
[0003] 目前，航空航天类管路类型繁多、接口复杂而且多以单件或小批量的生产形式存 在。传统的导管焊接需要设计专用的组合夹具，效率很低，且夹具通用性低，准备周期长。 针对不同的焊接导管，需要设计大量不同的专用夹具，这大大增加了航空航天产品的研制 时间和成本，同时也给生产管理带来极大不便。而且在生产过程中，由于受到操作者经验水 平、工装、定位精度以及测量精度等因素的影响，需对导管焊接后存在较大的误差和变形， 无法达到精度要求，可见传统的导管生产工艺已经无法满足现代产品的制造需求，所以很 有必要研宄建立面向管路生产的柔性装焊系统。
[0004] 所设计的管路柔性装焊方案基于视觉测量和机器人，根据测量到的导管数据，通 过计算得到机器人末端执行器位姿，然后控制机器人抓取导管完成对接装配任务。所以如 何计算机器人手部在空间的位姿是实现管路柔性装焊的关键问题。
【发明内容】
[0005] 本发明的目的在于提供一种针对基于视觉测量和机器人的管路柔性装焊方案的 机器人位姿计算方法，用以快速计算机器人末端执行器位姿，控制机器人抓取导管运动，实 现管路的柔性装焊。
[0006] 管路柔性装焊方案：管路柔性装焊示意图如图1所示。系统工作时，机器人抓取两 段导管在计算得到的机器人控制文件控制下运动，实现两段导管的对接装配。
[0007] 图1中出现参数，说明如下：
[0008] O-XYZ :全局坐标系取机器人的基座标系。
[0009] Ot-XtYtZt:机器人工具坐标系即TCP坐标系。
[0010] Ol-XlYlZl:导管固联坐标系，在导管模型上定义。
[0011] 导管设计数据，即导管三维数模信息，包括导管对接端面中心点坐标 P。(X。，y。，Z。)，导管非对接端面中心点坐标Pf。(xf。，yf。，z f。)，机器人抓取直线段方向 V1 (Vx1, Vy1, Vz1)，导管对接端面法向 Vp (vxp, vyp, vzp)。
[0012] 其他技术参数，说明如下：
[0013] 导管测量数据：包括导管对接端（余量端）中心点测量坐标Pm(xm，y m，zm);导管非 对接端中心点测量坐标PFm(xfm，y fm，zfm);机器人抓取导管测量时的TCP测量位姿Tmra;机器 人回归零位时的TCP零位位姿Tstct;导管余量A(Allowance);导管半径R。
[0014] 机器人回归零位时，导管对接端（余量端）中心点坐标Ps (xs，ys，zs)，导管非对接 端中心点坐标PFs (xfs，yfs，zfs)，导管对接端（余量端）中心点在机器人TCP坐标系下的坐标 Ptap (xt，yt，zt)，导管非对接端中心点在机器人TCP坐标系下的坐标P Ftc;p (xft, yft, zft)，导管位 姿!\，机器人TCP点和导管非对接端中心点在导管固联坐标系下的坐标Pptap(x tp，ytp，ztp)和 FVp (xfp，yfp，zfp)。
[0015] 机器人抓取导管对接时，导管对接端中心点坐标即导管对接位置Pd(xd，y d，Zd)，导 管非对接端中心点坐标PFj (xfj，yfj，zfj)，导管位姿T\，机器人TCP对接位姿T jTCP。
[0016] 本发明提出的一种基于测量数据的管路柔性装焊机器人位姿计算方法，包括下述 主要步骤：
[0017] 步骤一：计算机器人回归零位时导管两端中心点坐标。
[0018] 步骤二：确定导管固联坐标系，计算机器人回归零位时导管位姿。
[0019] 步骤三：计算导管对接装配时，机器人TCP位姿。
[0020] 步骤四：计算机器人TCP坐标系绕全局坐标系三个坐标轴的旋转角度。
[0021] 本发明给出的一种基于测量数据的管路柔性装焊机器人位姿计算方法，其优点及 功效在于：与传统的管路装配焊接方法相比，本发明省去了繁多的样管和夹具，提升了通用 性，降低了成本；能够快速测量导管参数并且根据测量数据快速计算机器人位姿，控制机器 人运动实现导管对接装配，提升了管路生产效率。
【附图说明】
[0022] 图1为本发明的管路柔性装焊示意图。
[0023] 图2为本发明中机器人位姿计算流程图。
[0024] 图3为本发明中导管固联坐标系建立示意图。
【具体实施方式】
[0025] 下面结合附图，对本发明的技术方案做进一步的说明：
[0026] 如图2所示，本发明提出一种基于测量数据的管路柔性装焊机器人位姿计算方 法，具体步骤如下：
[0027] 步骤一：计算机器人回归零位时导管两端中心点坐标。
[0028] 根据公式（1)，可求得机器人回归零位时，导管两端面中心点坐标Ps(x s，ys，zs)， Pps (XfS，yfS，zfS)，以及两中心点在机器人TCP坐标系下的坐标P tap (xt, yt, zt)，
【主权项】
1. 一种针对基于视觉测量和机器人的管路柔性装焊方案的机器人位姿计算方法，其特 征在于：它包含如下参数： O-XYZ:全局坐标系取机器人的基座标系。 Ot-XtYtZt:机器人工具坐标系即TCP坐标系。 导管固联坐标系，在导管模型上定义。 导管设计数据，即导管三维数模信息，包括导管对接端面中心点坐标Pjx。，y。，z。)，导 管非对接端面中心点坐标Pf。(xf。，yf。，zf。)，机器人抓取直线段方向V1 (Vx1,Vy1,Vz1)，导管对 接端面法向Vp (vxp,vyp,vzp)。 导管测量数据：包括导管对接端（余量端）中心点测量坐标Pm(Xm，ym，zm);导管非对接 端中心点测量坐标PFm(Xfm，yfm，zfm);机器人抓取导管测量时的TCP测量位姿Tmra;机器人回 归零位时的TCP零位位姿Tstop;导管余量A(Allowance);导管半径R。 机器人回归零位时，导管对接端（余量端）中心点坐标Ps(xs，ys，zs)，导管非对接端 中心点坐标PFs(xfs,yfs,zfs)，导管对接端（余量端）中心点在机器人TCP坐标系下的坐标 Ptap (xt,yt,zt)，导管非对接端中心点在机器人TCP坐标系下的坐标PFtc;p (xft,yft,zft)，导管位 姿1\，机器人TCP点和导管非对接端中心点在导管固联坐标系下的坐标Pptap(xtp，ytp，ztp)和 FVp(xfp，yfp，zfp)。 机器人抓取导管对接时，导管对接端中心点坐标即导管对接位置Pd(xd，yd，Zd)，导管非 对接端中心点坐标PFj (xfj，yfj，zfj)，导管位姿T\，机器人TCP对接位姿TjTCP。
2. 根据权利要求1所述针对基于视觉测量和机器人的管路柔性装焊方案的机器人位 姿计算方法，其特征在于：它包括如下步骤： 步骤一：计算机器人回归零位时导管两端中心点坐标。 步骤二：确定导管固联坐标系，计算机器人回归零位时导管位姿。 步骤三：计算导管对接装配时，机器人TCP位姿。 步骤四：计算机器人TCP坐标系绕全局坐标系三个坐标轴的旋转角度。
【专利摘要】本发明提出一种针对基于视觉测量和机器人的管路柔性装焊方案的机器人位姿计算方法，其特征在于：包括下述步骤：(1)计算机器人回归零位时导管两端中心点坐标；(2)确定导管固联坐标系，计算机器人回归零位时导管位姿；(3)计算导管对接装配时，机器人TCP位姿；(4)计算机器人TCP坐标系绕全局坐标系三个坐标轴的旋转角度。本发明借助视觉测量技术和工业机器人技术进行管路的柔性生产，省去了繁多的样管和夹具，提升了通用性，降低了成本，提升了管路生产效率。
【IPC分类】G01C1-00
【公开号】CN104729455
【申请号】CN201510105340
【发明人】郑联语, 乔斌, 方维
【申请人】北京航空航天大学
【公开日】2015年6月24日
【申请日】2015年3月11日