机器人轨迹规划(4)

二、过路径点的三次多项式插值
三、高阶多项式插值 四、用抛物线过渡的线性插值
一、三次多项式插值
• 对应于两位姿的各个关节角度，末端执行器实现两位姿的 运动轨迹描述可在关节空间中用通过起始点和终止点关节 角的一个平滑轨迹函数q(t)来表示。 • 四个约束条件：即两端点位置约束和两端点速度约束。
t i i t f f t i 0 t f 0
但ts要随之变化，实现起来比前者困难。
3.3.4 关节空间插补
在机器人运动过程中，若末端执行器的起始和终止位姿已知， 由逆向运动学即可求出对应于两位姿的各个关节角度。与 此相应的各个关节位移、速度、加速度在整个时间间隔内 的连续性要求以及其极值必须在各个关节变量的容许范围 之内等。
一、三次多项式插值
3.1.2 轨迹规划的一般性问题
• 机器人的运动应当平稳，不平稳的运动将 加剧机械部件的磨损，并导致机器人的振 动和冲击。为此，要求所选择的运动轨迹 描述函数必须连续，而且它的一阶导数(速 度)，有时甚至二阶导数(加速度)也应该连 续。
3.1.2 轨迹规划的一般性问题
• 轨迹规划既可以在关节空间中进行，也可以在直 角坐标空间中进行。在关节空间中进行轨迹规划 是指将所有关节变量表示为时间的函数，用这些 关节函数及其一阶、二阶导数描述机器人预期的 运动；在直角坐标空间中进行轨迹规划是指将手 爪位姿、速度和加速度表示为时间的函数，而相 应的关节位置、速度和加速度由手爪信息导出。
3.1.3 轨迹的生成方式
• (1) 示教-再现运动。这种运动由人手把手示教机器人，定时记录各关 节变量，得到沿路径运动时各关节的位移时间函数q(t)；再现时，按 内存中记录的各点的值产生序列动作。 • (2) 关节空间运动。这种运动直接在关节空间里进行。由于动力学参 数及其极限值直接在关节空间里描述，所以用这种方式求最短时间运 动很方便。 • (3) 空间直线运动。这是一种直角空间里的运动，它便于描述空间操 作，计算量小，适宜简单的作业。 • (4) 空间曲线运动。这是一种在直角空间中用明确的函数表达的运动， 如圆周运动、螺旋运动等。
3.4 机器人手部路径的轨迹规划
• 3.4.1 操作对象的描述 • 任一刚体相对参考系的位姿是用与 它固接的坐标系来描述的。刚体上 相对于固接坐标系的任一点用相应 的位置矢量P表示；任一方向用方 向余弦表示。给出刚体的几何图形 及固接坐标系后，只要规定固接坐 标系的位姿，便可重构该刚体在空 间的位姿。
3.3 单连杆机器人的转动关节，从 = –5°静止开始运动， 要想在4 s内使该关节平滑地运动到 =+80°的位置停止。 试按下述要求确定运动轨迹： (1) 关节运动依三次多项式插值方式规划。 (2) 关节运动按抛物线过渡的线性插值方式规划。
3.1.2 轨迹规划的一般性问题
• 在轨迹规划中，为叙述方便，也常用点来表示机器人的状 态，或用它来表示工具坐标系的位姿，例如起始点、终止 点就分别表示工具坐标系的起始位姿及终止位姿。 • 更详细地描述运动时不仅要规定机器人的起始点和终止点， 而且要给出介于起始点和终止点之间的中间点，也称路径 点。这时，运动轨迹除了位姿约束外，还存在着各路径点 之间的时间分配问题。例如，在规定路径的同时，必须给 出两个路径点之间的运动时间.
3.3.2 圆弧插补
一、空间圆弧插补
• 空间圆弧是指三维空间任一平面内的圆弧。
• 空间圆弧插补可分三步来处理：
(1) 把三维问题转化成二维，找出圆弧所在平面。 (2) 利用二维平面插补算法求出插补点坐标(Xi+1, Yi+1)。 (3) 把该点的坐标值转变为基础坐标系下的值。
3.3.3 定时插补与定距插补
3.1.4 轨迹规划涉及的主要问题
• (1) 对工作对象及作业进行描述，用示教方法给出轨迹上的若干个结 点(knot)。
• (2) 用一条轨迹通过或逼近结点，此轨迹可按一定的原则优化，如加 速度平滑得到直角空间的位移时间函数X(t)或关节空间的位移时间函 数q(t)；在结 点之间如何进行插补，即根据轨迹表达式在每一个采样 周期实时计算轨迹上点的位姿和各关节变量值。 • (3) 以上生成的轨迹是机器人位置控制的给定值，可以据此并根据机 器人的动态参数设计一定的控制规律。 • (4) 规划机器人的运动轨迹时，尚需明确其路径上是否存在障碍约束 的组合。
• 如图所示，已知直线始末两点的坐标值P0(X0，Y0，Z0)、 Pe(Xe，Ye，Ze)及姿态，其中P0、Pe是相对于基坐标系的位 置。这些已知的位置和姿态通常是通过示教方式得到的。设 v为要求的沿直线运动的速度；ts为插补时间间隔。
3.3.1 直线插补
3.3.2 圆弧插补
一、平面圆弧插补
• 平面圆弧是指圆弧平面与基坐标系的三大平面之 一重合，以 XOY平面圆弧为例。已知不在一条直 线上的三点 P1、 P2、 P3及这三点对应的机器人手 端的姿态，设 v为沿圆弧运动速度；ts为插补时时 间隔。
• 机器人实现一个空间轨迹的过程即是实现轨迹离散的过程， 如果这些离散点间隔很大，则机器人运动轨迹与要求轨迹 可能有较大误差。只有这些插补得到的离散点彼此距离很 近，才有可能使机器人轨迹以足够的精确度逼近要求的轨 迹。模拟CP控制实际上是多次执行插补点的PTP控制， 插补点越密集，越能逼近要求的轨迹曲线。 • 插补点要多么密集才能保证轨迹不失真和运动连续平滑呢？ 可采用定时插补和定距插补方法来解决。
• 速度不为0
t i i t f f
t i θ i
• 对于只有一个中间路径点的机器 人作业，其路径点处的关节加速 度连续。可以用两个三次多项式 分两段插补，约束条件如下：
t f f
三、高阶多项式插值
• 对某段路径的起始点和终止点都规定了关节的位 置、速度和加速度，则要用一个五次多项式进行 插值，即
第3章 机器人轨迹规划
3.1 3.2 3.3 3.4
机器人轨迹规划概述 插补方式分类与轨迹控制 机器人轨迹插值计算 机器人手部路径的轨迹规划
3.1 机器人轨迹规划概述
3.1.1 机器人轨迹的概念
• 机器人轨迹(trajectory)泛指工业机器人在运动过程中的 运动轨迹，即运动点的位移、速度和加速度。
3.2 插补方式分类与轨迹控制
3.2.1 插补方式分类
3.2.2 机器人轨迹控制过程
• 对于有规律的轨迹，仅示教几个特征点，计算机就能利用 插补算法获得中间点的坐标，如直线需要示教两点，圆弧 需要示教三点，通过机器人逆向运动学算法由这些点的坐 标求出机器人各关节的位置和角度(q1, …, qn)，然后由后 面的角位置闭环控制系统实现要求的轨迹上的一点。继续 插补并重复上述过程，从而实现要求的轨迹。
• 轨迹的生成一般是先给定轨迹上的若干个点，将其经运动 学反解映射到关节空间，对关节空间中的相应点建立运动 方程，然后按这些运动方程对关节进行插值，从而实现作 业空间的运动要求，这一过程通常称为轨迹规划。
• 机器人运动轨迹的描述一般是对其手部位姿的描述，此位 姿值可与关节变量相互转换。控制轨迹也就是按时间控制 手部或工具中心走过的空间路径(path)。
• 约束条件相应地有六个。
四、用抛物线过渡的线性插值
• 在关节空间轨迹规划中，对于给定起始点和终止 点的情况选择线性函数插值较为简单，如上图所 示。然而，单纯线性插值会导致起始点和终止点 的关节运动速度不连续，且加速度无穷大，显然， 在两端点会造成刚性冲击。
• 为此应对线性函数插值方案进行修正，在线性插 值两端点的邻域内设置一段抛物线形缓冲区段。 由于抛物线函数对于时间的二阶导数为常数，即 相应区段内的加速度恒定，这样保证起始点和终 止点的速度平滑过渡，从而使整个轨迹上的位置 和速度连续。如下图所示。
3.1.2 轨迹规划的一般性问题
• 机器人的作业可以描述成工具坐标 系{T}相对于工件坐标系{S}的一系 列运动。作业可以借助工具坐标系 的一系列位姿Pi (i=1，2，…，n) 来描述。
• 它把作业路径描述与具体的机器人、 手爪或工具分离开来，形成了模型 化的作业描述方法，从而使这种描 述既适用于不同的机器人，也适用 于在同一机器人上装夹不同规格的 工具。
t c0 c1t c2t 2 c3t 3
二、过路径点的三次多项式插值
• 对于这种情况，假如末端执行器在路径点停留，即各路径 点上速度为0，则轨迹规划可连续直接使用前面介绍的三 次多项式插值方法；但若末端执行器只是经过，并不停留， 就需要将前述方法推广。
• 对于机器人作业路径上的所有路径点可以用求解逆运动学 的方法先得到多组对应的关节空间路径点，进行轨迹规划 时，把每个关节上相邻的两个路径点分别看做起始点和终 止点，再确定相应的三次多项式插值函数，把路径点平滑 连接起来。一般情况下，这些起始点和终止点的关节运动 速度不再为零。
一、定时插补
• 由轨迹控制过程知道，每插补出一轨迹点的坐标值，就要 转换成相应的关节角度值并加到位置伺服系统以实现这个 位置，这个过程每隔一个时间间隔ts完成一次。为保证运 动的平稳，显然ts不能太长。
• 当然ts越小越好，但它的下限值受到计算量限制，即对于 机器人的控制，计算机要在ts时间里完成一次插补运算和 一次逆向运动学计算。对于目前的大多数机器人控制器， 完成这样一次计算约需几毫秒。这样产生了ts的下限值。 当然，应当选择ts接近或等于它的下限值，这样可保证较 高的轨迹精度和平滑的运动过程。
3.4.2 作业的描述
• 机器人的作业过程可用手部位姿结点序列来规定，每个结 点可用工具坐标系相对于作业坐标系的齐次变换来描述。 相应的关节变量可用运动学反解程转动关节，其关节运动均按三次多 项式规划，要求经过两个中间路径点后停在一个目标位置。 试问欲描述该机器人关节的运动，共需要多少个独立的三 次多项式?要确定这些三次多项式，需要多少个系数?
3.3 机器人轨迹插值计算