工业机器人轨迹规划PPT格式课件下载.pptx

1、轨迹规划既可以在关节空间中进行，也可以在直角坐标空间中进行。在关节空间中进行轨迹规划是指将所有关节变量表示为时间的函数，用这些关节函数及其一阶、二阶导数描述机器人预期的运动；在直角坐标空间中进行轨迹规划是指将手爪位姿、速度和加速度表示为时间的函数，而相应的关节位置、速度和加速度由手爪信息通过逆运动学导出。,6.1.3 轨迹规划涉及的主要问题 为了描述一个完整的作业，往往需要将上述运动进行组合。通常这种规划涉及到以下几方面的问题：（1）对工作对象及作业进行描述，用示教方法给出轨迹上若干个结点。（2）用一条轨迹通过或逼近结点，此轨迹可按一定的原则优化，如加速度平滑得到直角空间的位移时间函数X（t）

2、或关节空间的位移时间函数q（t）；在结点之间如何进行插补，即根据轨迹表达式在每一个采样周期实时计算轨迹上点的位姿和各关节变量值。（3）规划机器人的运动轨迹时，需明确其路径上是否存在障碍约束的组合。本章主要讨论连续路径的无障碍轨迹规划方法。,6.2 插补方式分类与轨迹控制,6.2.1 插补方式分类 点位控制（PTP控制）通常没有路径约束，多以关节坐标运动表示。点位控制只要求满足起终点位姿，在轨迹中间只有关节的几何限制、最大速度和加速度约束；为了保证运动的连续性，要求速度连续，各轴协调。如MOVJ 连续轨迹控制（CP控制）有路径约束，因此要对路径进行设计，如MOVL。,6.2.2 机器人轨迹控制过

3、程 机器人的基本操作方式是示教-再现。对于有规律的轨迹，仅示教几个特征点，计算机就能利用插补算法获得中间点的坐标，如直线需要示教两点，圆弧需要示教三点，通过机器人逆向运动学算法由这些点的坐标求出机器人各关节的位置和角度（1,n），然后由后面的角位置闭环控制系统实现要求的轨迹上的一点。继续插补并重复上述过程，从而实现要求的轨迹。机器人轨迹控制过程如图6.3所示。,图6.3 机器人轨迹控制过程,6.3 机器人轨迹插值计算,给出各个路径结点后，轨迹规划的任务包含解变换方程，进行运动学反解和插值计算。在关节空间进行规划时，需进行的大量工作是对关节变量的插值计算。,6.3.1 直线插补（MOVL）直线插

4、补和圆弧插补是机器人系统中的基本插补算法。空间直线插补是在已知该直线始末两点的位置和姿态的条件下，求各轨迹中间点（插补点）的位置和姿态。下面介绍位置插补原理，如图6.4所示。已知直线始末两点的坐标值P0（X0，Y0，Z0）、Pe（Xe，Ye，Ze）及姿态。这些已知的位置和姿态通常是通过示教方式得到的。设v为要求的沿直线运动的速度；ts为插补时间间隔。,直线长度：,ts间隔内行程d=vts；插补总步数N为L/d+1的整数部分；各轴增量：,各插补点坐标值,图6.4,式中的i=l，2，N,6.3.2 圆弧插补（MOVC）一、平面圆弧插补 平面圆弧是指圆弧平面与基坐标系的三大平面之一重合，以XOY平面

5、圆弧为例。已知不在一条直线上的三点P1、P2、P3及这三点对应的机器人手端的姿态，如图6.5及图6.6所示。,图6.5 由已知的三点P1、P2、P3决定的圆弧,图6.6 圆弧插补,设v为沿圆弧运动速度；ts为插补时时间隔。类似直线插补情况计算出：（1）由P1、P2、P3决定的圆弧半径R。（2）总的圆心角=1+2，即,（3）ts时间内角位移量=tsv/R，据图6.4所示的几何关系求各插补点坐标。（4）总插补步数（取整数）N=/+1,对Pi+1 点的坐标，有,式中：Xi=R cosi；Yi=Rsini。同理有,由i+1=i+可判断是否到插补终点。若i+1，则继续插补下去；当 i+1时，则修正最后一

6、步的步长，并以 表示，故平面圆弧位置插补为,二、空间圆弧插补（MOVC）空间圆弧是指三维空间任一平面内的圆弧，此为空间一般平面的圆弧问题。空间圆弧插补可分三步来处理：（1）把三维问题转化成二维，找出圆弧所在平面。（2）利用二维平面插补算法求出插补点坐标（Xi+1,Yi+1）。（3）把该点的坐标值转变为基础坐标系下的值，如图6.7所示。,图6.7 基础坐标与空间圆弧平面的关系,通过不在同一直线上的三点P1、P2、P3可确定一个圆及三点间的圆弧，其圆心为OR,半径为R，圆弧所在平面与基础坐标系平面的交线分别为AB、BC、CA。建立圆弧平面插补坐标系，即把ORXRYRZR坐标系原点与圆心OR重合，设

7、ORXRYRZR平面为圆弧所在平面，且保持ZR为外法线方向。这样，一个三维问题就转化成平面问题，可以应用平面圆弧插补的结论。求解两坐标系（图6.7）的转换矩阵。令TR表示由圆弧坐标ORXRYRZR至基础坐标系OX0Y0Z0的转换矩阵。用TR可以将圆弧坐标下的点转换成基础坐标系下的点。,6.3.3 定时插补与定距插补 由上述可知，机器人实现一个空间轨迹的过程即是实现轨迹离散的过程，如果这些离散点间隔很大，则机器人运动轨迹与要求轨迹可能有较大误差。只有这些插补得到的离散点彼此距离很近，才有可能使机器人轨迹以足够的精确度逼近要求的轨迹。模拟CP控制实际上是多次执行插补点的PTP控制，插补点越密集，越

8、能逼近要求的轨迹曲线。插补点要多么密集才能保证轨迹不失真和运动连续平滑呢？可采用定时插补和定距插补方法来解决。,一、定时插补 从轨迹控制过程知道，每插补出一轨迹点的坐标值，就要转换成相应的关节角度值并加到位置伺服系统以实现这个位置，这个过程每隔一个时间间隔ts完成一次。为保证运动的平稳，显然ts不能太长。由于关节型机器人的机械结构大多属于开链式，刚度不高，ts一般不超过25 ms（40 Hz），这样就产生了ts的上限值。当然ts越小越好，但它的下限值受到计算量限制，即对于机器人的控制，计算机要在ts时间里完成一次插补运算和一次逆向运动学计算。对于目前的大多数机器人控制器，完成这样一次计算约需几

9、毫秒。这样产生了ts的下限值。当然，应当选择ts接近或等于它的下限值，这样可保证较高的轨迹精度和平滑的运动过程。,以一个XOY平面里的直线轨迹为例说明定时插补的方法。设机器人需要的运动轨迹为直线，运动速度为v（mm/s），时间间隔为ts（ms），则每个ts间隔内机器人应走过的距离为Pi Pi+1=v ts可见两个插补点之间的距离正比于要求的运动速度，两点之间的轨迹不受控制，只有插补点之间的距离足够小，才能满足一定的轨迹精度要求。机器人控制系统易于实现定时插补，例如采用定时中断方式每隔ts中断一次进行一次插补，计算一次逆向运动学，输出一次给定值。由于ts仅为几毫秒，机器人沿着要求轨迹的速度一般不

10、会很高，且机器人总的运动精度不如数控机床、加工中心高，故大多数工业机器人采用定时插补方式。当要求以更高的精度实现运动轨迹时，可采用定距插补。,二、定距插补 v是要求的运动速度，它不能变化，如果要两插补点的距离Pi Pi+1恒为一个足够小的值，以保证轨迹精度，ts就要变化。也就是在此方式下，插补点距离不变，但ts要随着不同工作速度v的变化而变化。这两种插补方式的基本算法相同，只是前者固定ts，易于实现，后者保证轨迹插补精度，但ts要随之变化，实现起来比前者困难。,6.3.4 关节空间插补（MOVJ）在关节空间中进行轨迹规划，需要给定机器人在起始点和终止点手臂的位形。对关节进行插值时应满足一系列的

11、约束条件，例如抓取物体时手部的运动方向（初始点）、提升物体离开的方向（提升点）、放下物体（下放点）和停止点等结点上的位姿、速度和加速度的要求；与此相应的各个关节位移、速度、加速度在整个时间间隔内的连续性要求以及其极值必须在各个关节变量的容许范围之内等。满足所要求的约束条件之后，可以选取不同类型的关节插值函数，生成不同的轨迹。常用的关节空间插补有以下方法：1、三次多项式插值 2、过路径点的三次多项式插值 3、高阶多项式插值 4、用抛物线过渡的线性插值,一、三次多项式插值 在机器人运动过程中，若末端执行器的起始和终止位姿已知，由逆向运动学即可求出对应于两位姿的各个关节角度。末端执行器实现两位姿的运

12、动轨迹描述可在关节空间中用通过起始点和终止点关节角的一个平滑轨迹函数（t）来表示。为实现系统的平稳运动，每个关节的轨迹函数（t）至少需要满足四个约束条件，即两端点位置约束和两端点速度约束。端点位置约束是指起始位姿和终止位姿分别所对应的关节角度。（t）在时刻t0=0时的值是起始关节角度0，在终端时刻tf时的值是终止关节角度f，即,为满足关节运动速度的连续性要求，起始点和终止点的关节速度可简单地设定为零，即,上面给出的四个约束条件可以惟一地确定一个三次多项式：,运动过程中的关节速度和加速度则为,将其代以给定的约束条件，可得三次多项式的系数 0，1，2 和 3，则对于起始速度及终止速度为零的关节运动

13、，满足连续平稳运动要求的三次多项式插值函数为：,关节角速度和角加速度的表达式为：,三次多项式插值的关节运动轨迹曲线如图6.8所示。由图可知，其速度曲线为抛物线，相应的加速度曲线为直线。,图6.8 三次多项式插值的关节运动轨迹,【例6.1】要求一个六轴机器人的第一关节在5秒钟内从初始角300运动到终端角750，且起始点和终止点速度均为零。用三次多项式规划该关节的运动，并计算在第1、2、3秒和第4秒时关节的角度。,图 关节位移、速度和加速度,解：,位移曲线,二、过路径点的三次多项式插值 若所规划的机器人作业路径在多个点上有位姿要求，如图6.9所示，机器人作业除在A、D点有位姿要求外，在路径点B、C

14、也有位姿要求。对于这种情况，假如末端执行器在路径点停留，即各路径点上速度为0，则轨迹规划可连续直接使用前面介绍的三次多项式插值方法；但若末端执行器只是经过，并不停留，就需要将前述方法推广。,对于机器人作业路径上的所有路径点可以用求解逆运动学的方法先得到多组对应的关节空间路径点，进行轨迹规划时，把每个关节上相邻的两个路径点分别看做起始点和终止点，再确定相应的三次多项式插值函数，把路径点平滑连接起来。一般情况下，这些起始点和终止点的关节运动速度不再为零。,图6.9 机器人作业路径点,设路径点上的关节速度已知，这时，确定三次多项式系数的方法与前所述完全一致，只是速度约束条件变为,利用约束条件可确定三次多项式系数a0，a1，a2和a3，和前面有所不同。但当路径点上的关节速度为0时，确定的三次多项式与上一种方法完全相同，这就说明了这里所确定的三次多项式描述了起始点和终止点具有任意给定位置和速度约束条件的运动轨迹。,三、高阶多项式插值 若对于运动轨迹的要求更为严格，约束条件增多，三次多项式就不能满足需要，须用更高阶的多项式对运动轨迹的路径段进行插值。例如，对某段路径的起始点和终止点都规定了关节的位置、速度和加速度，则要用一个五次多项式进行插值，即,多项式的系数a0，a1，a5必须满足6个约束条件,【例6-2】同例6.1，且已知起始