一种机器人关节空间传送带跟随运动的轨迹规划方法技术

本发明专利技术提出了一种机器人关节空间传送带跟随运动的轨迹规划方法，该方法可以使机器人能够快速跟踪上传送带上的目标物体，并与目标物体同步运动，实现动态跟随，进而完成如抓取等相关应用功能。该方法根据视觉系统定位出目标物体的初始位置和速度，并实时预测目标物体的位置，再通过运动学逆解转换到关节空间，在关节空间内对机器人各个关节进行轨迹规划，实现动态跟随。该方法在关节空间内进行轨迹规划，仅需考虑关节约束条件，约束条件简单，且是时间最优的动态轨迹规划方法，可以保证机器人以最短的时间跟踪上目标物体，该方法简单，且跟随效率高。

【技术实现步骤摘要】

本专利技术涉及一种机器人运动轨迹的规划方法，具体说是一种机器人关节空间传送带跟随运动的轨迹规划方法。
技术介绍
机器人的一个常见应用领域是跟踪传送带上的物体，实现如抓取、包装、分拣等应用。典型的传送带跟随应用环境如附图1所示，包含的装置主要有：机器人、直线传送带、脉冲编码器、视觉系统和工件。传送带上具有位置检测装置脉冲编码器，可检测传送带走过的距离，视觉系统位于传送带上方，使用视觉系统对直线传送带上的工件定位。传送带运行过程中，视觉系统检测处于拍摄区域中的工件，视觉系统将拍摄区域中的工件的位置信息拍摄并记录，将位置信息传递给控制器，直线传送带将工件从上游方向往下游方向进行直线传输，脉冲编码器检测出直线传送带进行移动后所产生的直线距离数据，并将数据传输给机器人，机器人对数据进行分析并计算出所需要的工作轨迹的补偿量，实现准确定位，最后机器人将对工件实施跟随运动，完成相应的如动态抓取等动作。目前应用较广的跟随方法是基于视觉传感器的目标跟踪方法，通过图像处理等算法实现目标的跟踪，但这种算法受光照影响较大，对图像处理算法要求高，且算法复杂度较高。有些文献则直接对机器人的末端轨迹进行规划，即在直角坐标系下进行规划，这种方法比较直观，跟随轨迹较好，但这种方法易出现在有些轨迹处关节并未达到最大速度，导致跟随效率低，而有些轨迹又可能出现超最大关节速度或最大关节加速度的情况，则须进行特殊处理，较为复杂。
技术实现思路
本专利技术所要解决的技术问题，在于克服现有技术存在的缺陷，提出一种机器人关节空间传送带跟随运动的轨迹规划方法，本方法只需要视觉模块定位物体的初始位置，后续跟随过程中无需视觉定位，且算法基于机器人关节空间的规划，直接对机器人各个关节进行轨迹规划，保证各个关节不超最大加速度和最大速度，且可以以最短的时间去跟随目标物体，跟随效率高。本专利技术目的是使机器人能够快速的跟踪上传送带上的目标物体，并与目标物体同步运动，实现动态跟随，进而完成如抓取等相关应用功能。本专利技术所提出的基于关节空间的机器人跟随运动轨迹规划方法，其步骤如下：(1)获得目标物体的位置和速度矢量：根据视觉模块输出的视觉坐标系下目标物体的当前位置(xvision,yvision,zvision)，通过坐标系转换获得目标物体在直角坐标系下的位置(xbase,ybase,zbase)：(xbase,ybase,zbase,1)T＝baseTvision·(xvision,yvision,zvision,1)T式中，baseTvision为视觉坐标系相对于直角坐标系的坐标转换矩阵，坐标转换矩阵是指两坐标系的旋转和平移之间的关系。传送带和视觉系统安装固定后，该转换矩阵可直接获得。通过编码器实时反馈的脉冲数据，采用差分的方法获得目标物体在直角坐标系下的线速度vbase。(2)预测目标物体的运动轨迹：目的是让机器人去跟踪目标物体的预测位置而不是当前位置，这样可以避免出现机器人无限接近于目标物体而却始终跟随不上的现象。预测位置的实质是预测时间，即机器人不去跟踪目标物体的当前位置(xvision,yvision,zvision)＝(x0,y0,z0)(0时刻)，而是去跟踪目标物体t时刻所在的位置(xt,yt,zt)。时间t即为预测时间。本专利技术根据之前的目标物体位置信息和当前的位置信息，拟合出传送带的运动规律，因为短时间内传送带的变化是相对均匀的，因此拟合出的传送带运动规律为匀速运动或匀加速运动，即得到传送带的运动速度vconvery和加速度aconvery，再根据机器人与目标物体当前的距离Δs，以及二者的速度矢量差ΔV，建立相应的预测模型，预测出时间t。预测模型的总体思想是当机器人与目标物体离得越近，速度矢量差得越少，预测的时间越小，反之越大。(xt,yt,zt)=(x0,y0,z0)+vconvery·t+12·aconvery·t2]]>t＝f(Δs,ΔV)(3)逆解至关节空间：根据目标物体在机器人直角坐标系下的位置(xbase,ybase,zbase)和速度矢量vbase，将目标物体位置逆解至关节空间。位置逆解通过运动学逆解模型，即可得到各个关节的目标位置q；采用雅克比矩阵的方法，得到各个关节目标速度矢量q·=J-1(q)·V]]>式中，J-1(q)为雅克比矩阵的逆矩阵；V为笛卡尔速度，笛卡尔速度是直角坐标系下的线速度vbase和角速度的组合，本专利技术中设定目标物体在传送带运动过程中不发生旋转，故角速度为0。(4)关节轨迹规划：根据关节初始的位置q0和速度矢量以及通过(3)得到的目标位置q和目标速度矢量在关节空间内进行关节轨迹规划。关节轨迹规划的方法和具体步骤如下：①各关节以梯形加减速进行轨迹规划：根据关节位移(q-q0)和初速度矢量末速度矢量规划出速度曲线，以最大加速度进行加减速，得出各关节规划的最短时间Timin。②判定各关节该速度规划下是否存在死区，若存在，给出死区的左右边界Tleft、Tright。死区是针对运行时间而言的，在保证运动约束(最大速度、最大加速度)条件下，从初始状态(位置、速度)达到目标状态(位置、速度)最小时间是存在的。但在最小时间的基础上继续增大运行时间，有一段时间范围是无法规划出满足始末状态的速度曲线来，这段时间称为“死区”。③以max{Timin,i＝1…n本文档来自技高网...

【技术保护点】
一种机器人关节空间传送带跟随运动的轨迹规划方法，其步骤如下：步骤一，根据视觉模块输出的视觉坐标系下目标物体的当前位置(xvision,yvision,zvision)，通过坐标系转换获得目标物体在直角坐标系下的位置(xbase,ybase,zbase)：(xbase,ybase,zbase,1)T＝baseTvision·(xvision,yvision,zvision,1)T式中，baseTvision为视觉坐标系相对于直角坐标系的坐标转换矩阵；通过编码器实时反馈的脉冲数据，采用差分的方法获得目标物体在直角坐标系下的线速度vbase；步骤二，预测目标物体t时刻所在的位置(xt,yt,zt)：(xt,yt,zt)=(x0,y0,z0)+vconvery·t+12·aconvery·t2]]>其中：t＝f(Δs,ΔV)，(x0,y0,z0)目标物体t时刻所在的位置；步骤三，根据目标物体在机器人直角坐标系下的位置(xbase,ybase,zbase)和速度矢量vbase，将目标物体位置逆解至关节空间：位置逆解通过运动学逆解模型，得到各个关节的目标位置q；采用雅克比矩阵的方法，得到各个关节目标速度矢量q·=J-1(q)·V]]>式中，J‑1(q)为雅克比矩阵的逆矩阵，V为笛卡尔速度；步骤四，根据关节初始的位置q0和速度矢量以及各个关节的目标位置q和目标速度矢量在关节空间内进行关节轨迹规划，步骤如下：①各关节以梯形加减速进行轨迹规划：根据关节位移q‑q0和初速度矢量末速度矢量规划出速度曲线，以最大加速度进行加减速，得出各关节规划的最短时间Ti min；②判定各关节该速度规划下是否存在死区，若存在，给出死区的左右边界Tleft、Tright；③以max{Ti min,i＝1…n}(n为关节数)为基准时间，若该时间在某一关节的死区内，则以该关节死区的右边界Tright为轨迹规划的基准时间，依次判断各关节，最终得到跨越了各关节死区的最优的轨迹规划时间Tmin；④以最优的轨迹规划时间Tmin为轨迹规划时间，拓展其他关节的轨迹规划时间，重新对各个关节轨迹进行规划；步骤五，根据步骤四所作的关节轨迹规划，实时输出各关节的目标位置，再通过脉冲输出模块，转换为各个关节对应的电机脉冲值，驱动机器人运动至目标位置，实现实时动态地跟踪目标物体。...

【技术特征摘要】
1.一种机器人关节空间传送带跟随运动的轨迹规划方法，其步骤如下：
步骤一，根据视觉模块输出的视觉坐标系下目标物体的当前位置(xvision,yvision,zvision)，通
过坐标系转换获得目标物体在直角坐标系下的位置(xbase,ybase,zbase)：
(xbase,ybase,zbase,1)T＝baseTvision·(xvision,yvision,zvision,1)T式中，baseTvision为视觉坐标系相对于直角坐标系的坐标转换矩阵；
通过编码器实时反馈的脉冲数据，采用差分的方法获得目标物体在直角坐标系下的线速
度vbase；
步骤二，预测目标物体t时刻所在的位置(xt,yt,zt)：
(xt,yt,zt)=(x0,y0,z0)+vconvery·t+12·aconvery·t2]]>其中：t＝f(Δs,ΔV)，(x0,y0...

【专利技术属性】
技术研发人员：潘婷婷，冯日月，王继虎，
申请(专利权)人：南京埃斯顿自动化股份有限公司，
类型：发明
国别省市：江苏;32