工业机器人轨迹规划docx.docx

1、工业机器人轨迹规划docx机器人轨迹规划6.1机器人轨迹规划概述6.1.1机器人轨迹的概念机器人轨迹泛指工业机器人在运动过程中的运动轨迹，即运动点的位 移、速度和加速度。机器人在作业空间要完成给定的任务，其手部运动必须按一定的轨迹 进行。轨迹的生成一般是先给定轨迹上的若干个点，将其经运动学反解映 射到关节空间，对关节空间中的相应点建立运动方程，然后按这些运动方 程对关节进行插值，从而实现作业空间的运动要求，这一过程通常称为轨 迹规划。本章仅讨论在关节空间或笛卡尔空间中工业机器人运动的轨迹规 划和轨迹生成方法。机器人运动轨迹的描述一般是对其手部位姿的描述，此位姿值可与关 节变量相互转换。控制轨迹

2、也就是按时间控制手部或工具中心走过的空间 路径。在轨迹规划中，为叙述方便，也常用点来表示机器人的状 态，或用它来表示工具坐标系的位姿。更详细地描述运动时不仅要规定机器人的起始点和终止点, 而且要给出介于起始点和终止点之间的中间点，也称路径点。 这时，运动轨迹除了位姿约束外，还存在着各路径点之间的时 间分配问题。机器人的运动应当平稳，不平稳的运动将加剧机械部件的 磨损，并导致机器人的振动和冲击。为此，要求所选择的运动 轨迹描述函数必须连续，而且它的一阶导数（速度），有时甚至 二阶导数（加速度）也应该连续。轨迹规划既可以在关节空间中进行，也可以在直角坐标空 间中进行。在关节空间中进行轨迹规划是指将

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

4、计算轨迹上点的位姿和各关节变量值。(3)规划机器人的运动轨迹时，需明确其路径上是否存在障碍约 束的组合。本章主要讨论连续路径的无障碍轨迹规划方法。6.2插补方式分类与轨迹控制6.2.1插补方式分类点位控制（PTP控制）通常没有路径约束，多以关节坐标运 动表示。点位控制只要求满足起终点位姿，在轨迹中间只有 关节的几何限制、最大速度和加速度约束；为了保证运动的 连续性，要求速度连续，各轴协调。如MOVJ连续轨迹控制（CP控制）有路径约束，因此要对路径进行 设计，如MOVLo622机器人轨迹控制过程机器人的基本操作方式是示教再现。对于有规律的轨迹,仅示教几个特征点，计算机就能利用插补算法获得中间点的

5、坐向运动学算法由这些点的坐标求岀机器人各关节的位置和角度 仇），然后由后面的角位置闭环控制系统实现要求的轨迹 上的一点。继续插补并重复上述过程，从而实现要求的轨迹。机器人轨迹控制过程如图6.3所示。图6. 3机器人轨迹控制过程6.3机器人轨迹插值计算给出各个路径结点后，轨迹规划的任务包含解 变换方程，进行运动学反解和插值计算。在关节空 间进行规划时，需进行的大量工作是对关节变量的 插值计算。6.3.1直线插补（MOVL）直线插补和圆弧插补是机器人系统中的基本插补算法。空间直线插补是在己知该直线始末两点的位置和姿态的条件下， 求各轨迹中间点（插补点）的位置和雲态。下面介绍位置插补原理，如图 6.

6、4所示。已知直线始末两点的坐标值化為，b Z。）、Pe（Xe, re, Ze） 及姿态。这些已知的位置和姿态通常是通过示教方式得到的。设为要 求的沿直线运动的速度；.为插补时间间隔。间隔内行程d二卩4；皤补总步数/伪0/於1的整数部分;各轴增量：氏二X厂X祁N一、平面圆弧插补平面圆弧是指圆弧平面与基坐标系的三大平面之一重合，以弧为例。已知不在一条直线上的三点P、舄、巴及这三点对应的机器人手端的姿态，如图6.5及图6.6所示。算岀:即(2)总的(3)-时间内角位移量二凡 据图64所示的几何关系求各插 补点坐标。(4)总插补步数(取整数)川二 0 / + 1对H+1点的坐标，有兀+1 = J?co

7、s( + A) = J?cos cosA- J?sin sinA= X cos A- I) = J?sin cosA +J?cos sin = Yi cqsAO + X sin Ad由e .+1= e . +a 0可判断是否到插补终点。若5+3,则继续 插补下去；当”“10时，则修正最后一步的步长，并以 表示十兔，故平面圆弧位置插补为+1 = ijCOsA + sinA 卜2+i = 0+AQ二、空间圆弧插补(MOVC)空间圆弧是指三维空间任一平面内的圆弧，此为空间一般平面的 圆弧问题。空间圆弧插补可分三步来处理:(1)把三维问题转化成二维，找出圆弧所在平面。(2)利用二维平面插补算法求出插补

8、点坐标(&+, E+J。(3)把该点的坐标值转变为基础坐标系下的值，如图6.7所示。图6.7基础坐标与空间圆弧平面的关系机器人轨迹规划Zq4（耳齐,ZJ通过不在同一直线上的三点人、卩2、&可确定一个圆及三点间的 圆弧，其圆心为0,半径为斤，圆弧所在平面与基础坐标系平面的交 线分别为力从BC、CAO建立圆弧平面插补坐标系，即把家坐标系原点与合，设羁滋平面为圆弧所在平面，且保持初外法线方向。这样, 一个三维问题就转化成平面问题，可以应用平面圆弧插补的结论。求解两坐标系（图6. 7）的转换矩阵。令/表示由圆弧坐标羁必至基础坐标系下的点。6. 3. 3定时插补与定距插补由上述可知，机器人实现一个空间轨

9、迹的过程即是实现轨 迹离散的过程，如果这些离散点间隔很大，则机器人运动轨迹 与要求轨迹可能有较大误差。只有这些插补得到的离散点彼此 距离很近，才有可能使机器人轨迹以足够的精确度逼近要求的 轨迹。模拟CP控制实际上是多次执行插补点的PTP控制，插补 点越密集，越能逼近要求的轨迹曲线。插补点要多么密集才能保证轨迹不失真和运动连续平滑呢? 可采用定时插补和定距插补方法来解决。一、定时插补从轨迹控制过程知道，每插补出一轨迹点的坐标值，就要转换 成相应的关节角度值并加到位置伺服系统以实现这个位置，这个过 程每隔一个时间间隔完成一次。为保证运动的平稳，显然方s不能 太长。由于关节型机器人的机械结构大多属于

10、开链式，刚度不高，4 一般不超过25 ms (40 Hz),这样就产生了 4的上限值。当然越小 越好，但它的下限值受到计算量限制，即对于机器人的控制，计算 机要在时间里完成一次插补运算和一次逆向运动学计算。对于目 前的大多数机器人控制器，完成这样一次计算约需几毫秒。这样产 生了 的下限值。当然，应当选择力$接近或等于它的下限值，这样 可保证较高的轨迹精度和平滑的运动过程。以一个XOY平面里的直线轨迹为例说明定时插补的方法。设机器人需要的运动轨迹为直线，运动速度为v(mm/s), 时间间隔为心(ms),则每个心间隔内机器人应走过的距离为可见两个插补点之间的距离正比于要求的运动速度，两点之间 的轨

11、迹不受控制，只有插补点之间的距离足够小，才能满足一 定的轨迹精度要求。机器人控制系统易于实现定时插补，例如采用定时中断方 式每隔4中断一次进行一次插补，计算一次逆向运动学，输出 一次给定值。由于4仅为几毫秒，机器人沿着要求轨迹的速度 一般不会很高，且机器人总的运动精度不如数控机床、加工中 心高，故大多数工业机器人采用定时插补方式。当要求以更高的精度实现运动轨迹时，可采用定距插补。二、定距插补V是要求的运动速度，它不能变化，如果要两插补点的距 离沖恒为一个足够小的值，以保证轨迹精度，4就要变化。 也就是在此方式下，插补点距离不变，但4要随着不同工作速 度卩的变化而变化。这两种插补方式的基本算法相

12、同，只是前者固定心，易于 实现，后者保证轨迹插补精度，但心要随之变化，实现起来比 前者困难。634关节空间插补（MOVJ）在关节空间中进行轨迹规划，需要给定机器人在起始点和 终止点手臂的位形。对关节进行插值时应满足一系列的约束条 件，例如抓取物体时手部的运动方向（初始点）、提升物体离开 的方向（提升点）、放下物体（下放点）和停止点等结点上的位姿、 速度和加速度的要求；与此相应的各个关节位移、速度、加速 度在整个时间间隔内的连续性要求以及其极值必须在各个关节 变量的容许范围之内等。满足所要求的约束条件之后，可以选 取不同类型的关节插值函数，生成不同的轨迹。常用的关节空 间插补有以下方法：1、 三

13、次多项式插值2、 过路径点的三次多项式插值3、 高阶多项式插值4、 用抛物线过渡的线性插值、三次多项式插值在机器人运动过程中，若末端执行器的起始和终止位姿已知，由 逆向运动学即可求出对应于两位姿的各个关节角度。末端执行器实现 两位姿的运动轨迹描述可在关节空间中用通过起始点和终止点关节角 的一个平滑轨迹函数0来表示。为实现系统的平稳运动，每个关节的轨迹函数&至少需要满足 四个约束条件，即两端点位置约束和两端点速度约束。端点位置约束是指起始位姿和终止位姿分别所对应的关节角度。 夕在时刻二0时的值是起始关节角度，在终端时刻4时的值是终止 关节角度侏，即 他呵雉）=为满足关节运动速度的连续性要求，起始

14、点和终止点的关节速 度可简单地设定为零，即0（0）= 0、论）=0上面给岀的四个约束条件可以惟一地确定一个三次多项式：&#)=两十绚扌十说尸+研运动过程中的关节速度和加速度则为9(f) = a +2与+ 3幻厂(?) = 2a2 +6a3t J将其代以给定的约束条件，可得三次多项式的系数呦，如， 和血，则对于起始速度及终止速度为零的关节运动，满足连续 平稳运动要求的三次多项式插值函数为：&r)=给+活($ - &)广-奇-&旷关节角速度和角加速度的表达式为：諾(0 -久)尸V if%) = (&-久)-等(0 -仇”三次多项式插值的关节运动轨迹曲线如图6.8所示。由图可知, 其速度曲线为抛物线

15、，相应的加速度曲线为直线。图6.8三次多项式插值的关节运动轨迹【例61 要求一个六轴机器人的第一关节在5秒钟内从初始角30。运 动到终端角75。，且起始点和终止点速度均为零。用三次多项式规划该 关节的运动，并计算在第1、2、3秒和第4秒时关节的角度。解：位移曲线 。=30 + 5.4尸-0.72尸图关节位移、速度和加速度二、过路径点的三次多项式插值若所规划的机器人作业路径在多个点上有位姿要求，如图6.9所 示，机器人作业除在A、D点有位姿要求外，在路径点B、C也有位 姿要求。对于这种情况，假如末端执行器在路径点停留，即各路径 点上速度为0,则轨迹规划可连续直接使用前面介绍的三次多项式插 值方法

16、；但若末端执行器只是经过，并不停留，就需要将前述方法 推广。图6.9机器人作业路径点对于机器人作业路径上的所有 路径点可以用求解逆运动学的方法 先得到多组对应的关节空间路径点, 进行轨迹规划时，把每个关节上相 邻的两个路径点分别看做起始点和 终止点，再确定相应的三次多项式 插值函数，把路径点平滑连接起来。 一般情况下，这些起始点和终止点 的关节运动速度不再为零。设路径点上的关节速度已知，这时，确定三次多项式系数的方 法与前所述完全一致，只是速度约束条件变为0(0)= 00(。)胡利用约束条件可确定三次多项式系数日,旳，日2和包，和前面 有所不同。但当路径点上的关节速度为0时，确定的三次多项式与

17、 上一种方法完全相同，这就说明了这里所确定的三次多项式描述了 起始点和终止点具有任意给定位置和速度约束条件的运动轨迹。三、高阶多项式插值若对于运动轨迹的要求更为严格，约束条件增多，三次多项式就 不能满足需要，须用更高阶的多项式对运动轨迹的路径段进行插值。例如，对某段路径的起始点和终止点都规定了关节的位置、速度 和加速度，则要用一个五次多项式进行插值，即=勺+2注+勾：2 + Q# +码广+碍卢多项式的系数勺，牛必须满足6个约束条件% =兔Of = a。+ ci、t 彳 + + Clgt ； + cit + ci、t ：%=a、 c a% = % + 22。+ 3ci# 彳 + 4。4/. +

18、5。5. &0 = 2。20f = 2a2 + 6a3tf + 12詁+ 20a5tf3【例6-2】同例6.1,且已知起始加速度和终止减速度均为5/s2o解：e = 30 + 2.5t2 +1.6? - 0.58? + 0.0464”图关节的位置、速度和加速度曲线四、用抛物线过渡的线性插值对于给定起始点和终止点的情况选择线性函数插值最为 简单。然而，单纯线性插值会导致起始点和终止点的关节 运动速度不连续，且加速度无穷大，显然，在两端点会造 成刚性冲击。为此在线性插值两端点的邻域内设置一段抛物线形缓冲 区段。由于抛物线函数对于时间的二阶导数为常数，即相 应区段内的加速度恒定，这样保证起始点和终止

19、点的速度 平滑过渡，从而使整个轨迹上的位置和速度连续。线性函数+两段抛物线函数 平滑地衔接在一起，形成带 有抛物线过渡域的线性轨迹。T形速度曲线Trap模式（点位运动）61*经验：一般取设两端的抛物线轨迹具有相同的持续时 间乙，具有大小相同而符号相反的恒加速度。 对于这种路径规划存在有多个解，其轨迹不 惟一。如图6.12所示。但是，每条路径都对 称于时间中点4和位置中点木。要保证路径轨迹的连续、光滑，即要求抛物线轨迹的终点速度必须等于线性段的速图& 12轨迹的多解性与对称性 度，故有下列关系：设关节从起始点到终止点的总运动时间为4 ,贝hf=2h,并注意到则 2-Otfta +（兮 _&o）

20、= O一般情况下，4、体、耳是已知条件，这样，据前式可以选择相 应的加速度和t得到相应的轨迹。通常的做法是先选定加速度的 值，然后）求出相应的_ tf 勺;_4（0 _&o）由上式知，为保证有解，加速度值必须选得足够大，即当上式中的等号成立时，轨迹线性段的长度缩减为零，整个轨迹由两个过渡域组成，这两个过渡域在衔接处的斜率（关节速度）相等;加速度的取值愈大，过渡域的长度会变得愈短，若加速度趋于无穷 大，轨迹又复归到简单的线性插值情况。用抛物线过渡的线性函数插值进行轨迹规划的物理概念非常清楚, 即如果机器人每一关节电动机采用等加速、等速和等减速运动规律， 则关节的位置、速度、加速度随时间变化的曲线

21、如图所示。若某个关节的运动要经过一个路 径点，则可采用带抛物线过渡域的线 性路径方案。如图6.14所示，关节的 运动要经过一组路径点，用关节角度 Or &k和6表示其中三个相邻的路径 点，以线性函数将每两个相邻路径点 之间相连，而所有路径点附近都采用 抛物线过渡。图6. 14 多段带有抛物线过渡域的线性轨迹应该注意到：各路径段采用抛物 线过渡域线性函数所进行的规划，机 器人的运动关节并不能真正到达那些 路径点。即使选取的加速度充分大， 实际路径也F是十分接近理想路径点， 如图6.14所示。【例6-3】在例6-1中，假设六轴机器人的关节1以角速度100/s在5秒 内从初始角30。运动到目的角700。求解所需的过渡时间并绘制关节 位置、速度和加速度曲线。解：分段求出参数，然后绘制位置、速度和加速度曲线图关节的位置、速度和加速度曲线T形速度