《工业机器人轨迹规划.pptx》由会员分享，可在线阅读，更多相关《工业机器人轨迹规划.pptx（32页珍藏版）》请在课桌文档上搜索。
1、机器人轨迹规划,6.1 机器人轨迹规划概述,6.1.1 机器人轨迹的概念 机器人轨迹泛指工业机器人在运动过程中的运动轨迹，即运动点的位移、速度和加速度。机器人在作业空间要完成给定的任务，其手部运动必须按一定的轨迹进行。轨迹的生成一般是先给定轨迹上的若干个点，将其经运动学反解映射到关节空间，对关节空间中的相应点建立运动方程，然后按这些运动方程对关节进行插值，从而实现作业空间的运动要求，这一过程通常称为轨迹规划。本章仅讨论在关节空间或笛卡尔空间中工业机器人运动的轨迹规划和轨迹生成方法。机器人运动轨迹的描述一般是对其手部位姿的描述，此位姿值可与关节变量相互转换。控制轨迹也就是按时间控制手部或工具中心
2、走过的空间路径。,在轨迹规划中，为叙述方便，也常用点来表示机器人的状态，或用它来表示工具坐标系的位姿。更详细地描述运动时不仅要规定机器人的起始点和终止点，而且要给出介于起始点和终止点之间的中间点，也称路径点。这时，运动轨迹除了位姿约束外，还存在着各路径点之间的时间分配问题。机器人的运动应当平稳，不平稳的运动将加剧机械部件的磨损，并导致机器人的振动和冲击。为此，要求所选择的运动轨迹描述函数必须连续，而且它的一阶导数(速度)，有时甚至二阶导数(加速度)也应该连续。轨迹规划既可以在关节空间中进行，也可以在直角坐标空间中进行。在关节空间中进行轨迹规划是指将所有关节变量表示为时间的函数，用这些关节函数及
3、其一阶、二阶导数描述机器人预期的运动；在直角坐标空间中进行轨迹规划是指将手爪位姿、速度和加速度表示为时间的函数，而相应的关节位置、速度和加速度由手爪信息通过逆运动学导出。,6.1.3 轨迹规划涉及的主要问题 为了描述一个完整的作业，往往需要将上述运动进行组合。通常这种规划涉及到以下几方面的问题：(1)对工作对象及作业进行描述，用示教方法给出轨迹上若干个结点。(2)用一条轨迹通过或逼近结点，此轨迹可按一定的原则优化，如加速度平滑得到直角空间的位移时间函数X(t)或关节空间的位移时间函数q(t)；在结点之间如何进行插补，即根据轨迹表达式在每一个采样周期实时计算轨迹上点的位姿和各关节变量值。(3)规
4、划机器人的运动轨迹时，需明确其路径上是否存在障碍约束的组合。本章主要讨论连续路径的无障碍轨迹规划方法。,6.2 插补方式分类与轨迹控制,6.2.1 插补方式分类 点位控制(PTP控制)通常没有路径约束，多以关节坐标运动表示。点位控制只要求满足起终点位姿，在轨迹中间只有关节的几何限制、最大速度和加速度约束；为了保证运动的连续性，要求速度连续，各轴协调。如MOVJ 连续轨迹控制(CP控制)有路径约束，因此要对路径进行设计，如MOVL。,6.2.2 机器人轨迹控制过程 机器人的基本操作方式是示教-再现。对于有规律的轨迹，仅示教几个特征点，计算机就能利用插补算法获得中间点的坐标，如直线需要示教两点，圆
5、弧需要示教三点，通过机器人逆向运动学算法由这些点的坐标求出机器人各关节的位置和角度(1,n)，然后由后面的角位置闭环控制系统实现要求的轨迹上的一点。继续插补并重复上述过程，从而实现要求的轨迹。机器人轨迹控制过程如图6.3所示。,图6.3 机器人轨迹控制过程,6.3 机器人轨迹插值计算,给出各个路径结点后，轨迹规划的任务包含解变换方程，进行运动学反解和插值计算。在关节空间进行规划时，需进行的大量工作是对关节变量的插值计算。,6.3.1 直线插补(MOVL)直线插补和圆弧插补是机器人系统中的基本插补算法。空间直线插补是在已知该直线始末两点的位置和姿态的条件下，求各轨迹中间点(插补点)的位置和姿态。
6、下面介绍位置插补原理，如图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平面圆弧为例。已知不在一条直线上的三点P1、P2、P3及这三点对应的机器人手端的姿态，如图6.5及图6.6所示。,图6.5 由已知的三点P1
7、、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时，则修正最后一步的步长，并以 表示，故平面圆弧位置插补为,二、空间圆弧插补(MOVC)空间圆弧是指三维空间任一平面内的圆弧，此为空间一般平面的圆弧问题
8、。空间圆弧插补可分三步来处理：(1)把三维问题转化成二维，找出圆弧所在平面。(2)利用二维平面插补算法求出插补点坐标(Xi+1,Yi+1)。(3)把该点的坐标值转变为基础坐标系下的值，如图6.7所示。,图6.7 基础坐标与空间圆弧平面的关系,通过不在同一直线上的三点P1、P2、P3可确定一个圆及三点间的圆弧，其圆心为OR,半径为R，圆弧所在平面与基础坐标系平面的交线分别为AB、BC、CA。建立圆弧平面插补坐标系，即把ORXRYRZR坐标系原点与圆心OR重合，设ORXRYRZR平面为圆弧所在平面，且保持ZR为外法线方向。这样，一个三维问题就转化成平面问题，可以应用平面圆弧插补的结论。求解两坐标系
9、(图6.7)的转换矩阵。令TR表示由圆弧坐标ORXRYRZR至基础坐标系OX0Y0Z0的转换矩阵。用TR可以将圆弧坐标下的点转换成基础坐标系下的点。,6.3.3 定时插补与定距插补 由上述可知，机器人实现一个空间轨迹的过程即是实现轨迹离散的过程，如果这些离散点间隔很大，则机器人运动轨迹与要求轨迹可能有较大误差。只有这些插补得到的离散点彼此距离很近，才有可能使机器人轨迹以足够的精确度逼近要求的轨迹。模拟CP控制实际上是多次执行插补点的PTP控制，插补点越密集，越能逼近要求的轨迹曲线。插补点要多么密集才能保证轨迹不失真和运动连续平滑呢？可采用定时插补和定距插补方法来解决。,一、定时插补 从轨迹控制
10、过程知道，每插补出一轨迹点的坐标值，就要转换成相应的关节角度值并加到位置伺服系统以实现这个位置，这个过程每隔一个时间间隔ts完成一次。为保证运动的平稳，显然ts不能太长。由于关节型机器人的机械结构大多属于开链式，刚度不高，ts一般不超过25 ms(40 Hz)，这样就产生了ts的上限值。当然ts越小越好，但它的下限值受到计算量限制，即对于机器人的控制，计算机要在ts时间里完成一次插补运算和一次逆向运动学计算。对于目前的大多数机器人控制器，完成这样一次计算约需几毫秒。这样产生了ts的下限值。当然，应当选择ts接近或等于它的下限值，这样可保证较高的轨迹精度和平滑的运动过程。,以一个XOY平面里的直
11、线轨迹为例说明定时插补的方法。设机器人需要的运动轨迹为直线，运动速度为v(mm/s)，时间间隔为ts(ms)，则每个ts间隔内机器人应走过的距离为Pi Pi+1=v ts可见两个插补点之间的距离正比于要求的运动速度，两点之间的轨迹不受控制，只有插补点之间的距离足够小，才能满足一定的轨迹精度要求。机器人控制系统易于实现定时插补，例如采用定时中断方式每隔ts中断一次进行一次插补，计算一次逆向运动学，输出一次给定值。由于ts仅为几毫秒，机器人沿着要求轨迹的速度一般不会很高，且机器人总的运动精度不如数控机床、加工中心高，故大多数工业机器人采用定时插补方式。当要求以更高的精度实现运动轨迹时，可采用定距插
12、补。,二、定距插补 v是要求的运动速度，它不能变化，如果要两插补点的距离Pi Pi+1恒为一个足够小的值，以保证轨迹精度，ts就要变化。也就是在此方式下，插补点距离不变，但ts要随着不同工作速度v的变化而变化。这两种插补方式的基本算法相同，只是前者固定ts，易于实现，后者保证轨迹插补精度，但ts要随之变化，实现起来比前者困难。,6.3.4 关节空间插补(MOVJ)在关节空间中进行轨迹规划，需要给定机器人在起始点和终止点手臂的位形。对关节进行插值时应满足一系列的约束条件，例如抓取物体时手部的运动方向(初始点)、提升物体离开的方向(提升点)、放下物体(下放点)和停止点等结点上的位姿、速度和加速度的
13、要求；与此相应的各个关节位移、速度、加速度在整个时间间隔内的连续性要求以及其极值必须在各个关节变量的容许范围之内等。满足所要求的约束条件之后，可以选取不同类型的关节插值函数，生成不同的轨迹。常用的关节空间插补有以下方法：1、三次多项式插值 2、过路径点的三次多项式插值 3、高阶多项式插值 4、用抛物线过渡的线性插值,一、三次多项式插值 在机器人运动过程中，若末端执行器的起始和终止位姿已知，由逆向运动学即可求出对应于两位姿的各个关节角度。末端执行器实现两位姿的运动轨迹描述可在关节空间中用通过起始点和终止点关节角的一个平滑轨迹函数(t)来表示。为实现系统的平稳运动，每个关节的轨迹函数(t)至少需要
14、满足四个约束条件，即两端点位置约束和两端点速度约束。端点位置约束是指起始位姿和终止位姿分别所对应的关节角度。(t)在时刻t0=0时的值是起始关节角度0，在终端时刻tf时的值是终止关节角度f，即,为满足关节运动速度的连续性要求，起始点和终止点的关节速度可简单地设定为零，即,上面给出的四个约束条件可以惟一地确定一个三次多项式：,运动过程中的关节速度和加速度则为,将其代以给定的约束条件，可得三次多项式的系数 0，1，2 和 3，则对于起始速度及终止速度为零的关节运动，满足连续平稳运动要求的三次多项式插值函数为：,关节角速度和角加速度的表达式为：,三次多项式插值的关节运动轨迹曲线如图6.8所示。由图可
15、知，其速度曲线为抛物线，相应的加速度曲线为直线。,图6.8 三次多项式插值的关节运动轨迹,【例6.1】要求一个六轴机器人的第一关节在5秒钟内从初始角300运动到终端角750，且起始点和终止点速度均为零。用三次多项式规划该关节的运动，并计算在第1、2、3秒和第4秒时关节的角度。,图 关节位移、速度和加速度,解：,位移曲线,二、过路径点的三次多项式插值 若所规划的机器人作业路径在多个点上有位姿要求，如图6.9所示，机器人作业除在A、D点有位姿要求外，在路径点B、C也有位姿要求。对于这种情况，假如末端执行器在路径点停留，即各路径点上速度为0，则轨迹规划可连续直接使用前面介绍的三次多项式插值方法；但若
16、末端执行器只是经过，并不停留，就需要将前述方法推广。,对于机器人作业路径上的所有路径点可以用求解逆运动学的方法先得到多组对应的关节空间路径点，进行轨迹规划时，把每个关节上相邻的两个路径点分别看做起始点和终止点，再确定相应的三次多项式插值函数，把路径点平滑连接起来。一般情况下，这些起始点和终止点的关节运动速度不再为零。,图6.9 机器人作业路径点,设路径点上的关节速度已知，这时，确定三次多项式系数的方法与前所述完全一致，只是速度约束条件变为,利用约束条件可确定三次多项式系数a0，a1，a2和a3，和前面有所不同。但当路径点上的关节速度为0时，确定的三次多项式与上一种方法完全相同，这就说明了这里所
17、确定的三次多项式描述了起始点和终止点具有任意给定位置和速度约束条件的运动轨迹。,三、高阶多项式插值 若对于运动轨迹的要求更为严格，约束条件增多，三次多项式就不能满足需要，须用更高阶的多项式对运动轨迹的路径段进行插值。例如，对某段路径的起始点和终止点都规定了关节的位置、速度和加速度，则要用一个五次多项式进行插值，即,多项式的系数a0，a1，a5必须满足6个约束条件,【例6-2】同例6.1，且已知起始加速度和终止减速度均为,50/s2。,解：,图 关节的位置、速度和加速度曲线,四、用抛物线过渡的线性插值,对于给定起始点和终止点的情况选择线性函数插值最为简单。然而，单纯线性插值会导致起始点和终止点的
18、关节运动速度不连续，且加速度无穷大，显然，在两端点会造成刚性冲击。,为此在线性插值两端点的邻域内设置一段抛物线形缓冲区段。由于抛物线函数对于时间的二阶导数为常数，即相应区段内的加速度恒定，这样保证起始点和终止点的速度平滑过渡，从而使整个轨迹上的位置和速度连续。,四、用抛物线过渡的线性插值,线性函数+两段抛物线函数平滑地衔接在一起，形成带有抛物线过渡域的线性轨迹。,T形速度曲线,经验：一般取,Trap模式（点位运动）,设两端的抛物线轨迹具有相同的持续时间ta，具有大小相同而符号相反的恒加速度。对于这种路径规划存在有多个解，其轨迹不惟一。如图6.12所示。但是，每条路径都对称于时间中点th和位置中
19、点h。要保证路径轨迹的连续、光滑，即要求抛物线轨迹的终点速度必须等于线性段的速度，故有下列关系：,图6.12 轨迹的多解性与对称性,设关节从起始点到终止点的总运动时间为tf，则tf=2th，并注意到,则,一般情况下，0、f、tf是已知条件，这样，据前式可以选择相应的加速度 和ta，得到相应的轨迹。通常的做法是先选定加速度 的值，然后)求出相应的ta：,由上式知，为保证有解，加速度值 必须选得足够大，即,当上式中的等号成立时，轨迹线性段的长度缩减为零，整个轨迹由两个过渡域组成，这两个过渡域在衔接处的斜率(关节速度)相等；加速度 的取值愈大，过渡域的长度会变得愈短，若加速度趋于无穷大，轨迹又复归到
20、简单的线性插值情况。,用抛物线过渡的线性函数插值进行轨迹规划的物理概念非常清楚，即如果机器人每一关节电动机采用等加速、等速和等减速运动规律，则关节的位置、速度、加速度随时间变化的曲线如图所示。,若某个关节的运动要经过一个路径点，则可采用带抛物线过渡域的线性路径方案。如图6.14所示，关节的运动要经过一组路径点，用关节角度j、k和l表示其中三个相邻的路径点，以线性函数将每两个相邻路径点之间相连，而所有路径点附近都采用抛物线过渡。应该注意到：各路径段采用抛物线过渡域线性函数所进行的规划，机器人的运动关节并不能真正到达那些路径点。即使选取的加速度充分大，实际路径也只是十分接近理想路径点，如图6.14所示。,图6.14 多段带有抛物线过渡域的线性轨迹,【例6-3】在例6-1中，假设六轴机器人的关节1以角速度100/s在5秒内从初始角300运动到目的角700。求解所需的过渡时间并绘制关节位置、速度和加速度曲线。,解：,图 关节的位置、速度和加速度曲线,分段求出参数，然后绘制位置、速度和加速度曲线,T形速度,
