第六章_机器人的轨迹规划...课件.ppt

职业培训师、管理顾问：徐剑 xuj2@em.tsinghua.edu.cn 机器人的轨迹规划与生成 6.1.1 机器人规划的基机本概念 6.1.1 机器人规划的基本概念 过路径点的三次多项式 同理可以求得此时的三次多项式系数： （1） 根据工具坐标系在直角坐标空间中的瞬时线速度和角速度来确定每个路径点的关节速度 ；该方法工作量大。 对于方法（2），为了保证路径点处的加速度连续，可以设法用两条三次曲线在路径点处按照一定的规则联系起来，拼凑成所要求的轨迹。其约束条件是：联接处不仅速度连续，而且加速度也要连续。 对于方法（3）， 这里所说的启发式方法很简单，即假设用直线段把这些路径点依次连接起来，如果相邻线段的斜率在路径点处改变符号，则把速度选定为零；如果相邻线段不改变符号，则选择路径点两侧的线段斜率的平均值作为该点的速度。 如果对于运动轨迹的要求更为严格，约束条件增多，那么三次多项式就不能满足需要，必须用更高阶的多项式对运动轨迹的路径段进行插值。例如，对某段路径的起点和终点都规定了关节的位置、速度和加速度（有六个未知的系数），则要用一个五次多项式进行插值。 过路径点的路径与抛物线拟合的线性函数 如果要求机器人通过某个结点，同时速度不为零，怎么办？ 机器人规划的基本概念 1 关节空间法 2 直角坐标空间法 3 轨迹的实时生成 4 路径的描述 5 所谓机器人的规划(P1anning)，指的是——机器人根据自身的任务，求得完成这一任务的解决方案的过程。这里所说的任务，具有广义的概念，既可以指机器人要完成的某一具体任务，也可以是机器人的某个动作，比如手部或关节的某个规定的运动等。 轨迹：每个自由度的位移、速度和加速度的时间历程。 描述方法: 描述成工具坐标系{T}相对于工作台坐标系{S}的运动。 路径点-这个术语包括了所有的中间点以及初始点和最终点。 需要记住的是，虽然通常使用“点”这个术语，但实际上它们是表达位置和姿态的坐标系。 轨迹规划的目的是——将操作人员输入的简单的任务描述变为详细的运动轨迹描述。 例如，对一般的工业机器人来说，操作员可能只输入机械手末端的目标位置和方位，而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。 关节空间法首先将在工具空间中期望的路径点，通过逆运动学计算，得到期望的关节位置，然后在关节空间内，给每个关节找到一个经过中间点到达目的终点的光滑函数，同时使得每个关节到达中间点和终点的时间相同，这样便可保证机械手工具能够到达期望的直角坐标位置。这里只要求各个关节在路径点之间的时间相同，而各个关节的光滑函数的确定则是互相独立的。 6.2 下面具体介绍在关节空间内常用的两种规划方法 1） 三次多项式 考虑机械手末端在一定时间内从初始位置和方位移动到目标位置和方位的问题。利用逆运动学计算，可以首先求出一组起始和终了的关节位置．现在的问题是求出一组通过起点和终点的光滑函数。满足这个条件的光滑函数可以有许多条，如下图所示： 6.2 关节空间法 显然，这些光滑函数必须满足以下条件： 同时若要求在起点和终点的速度为零，即： 那么可以选择如下的三次多项式： 作为所要求的光滑函数。式4-3中有4个待定系数，而该式需满足式4-1和4-2的4个约束条件，因此可以唯一地解出这些系数： （4-3） （4-2） （4-1） 6.2 关节空间法 满足起点和终点的关节角度约束 满足起点和终点的关节速度约束 （4-4） 6.2 关节空间法 注意：这组解只适用于关节起点、终点速度为零的运动情况。 例： 设机械手的某个关节的起始关节角θ0＝150，并且机械手原来是静止的。要求在3秒钟内平滑地运动到θf=750时停下来(即要求在终端时速度为零)。规划出满足上述条件的平滑运动的轨迹，并画出关节角位置、角速度及角加速度随时间变化的曲线。 解： 根据所给约束条件，直接代入式(4-4)，可得： a0=15， a1=0， a2=20， a3=-4.44 所求关节角的位置函数为： 对上式求导，可以得到角速度和角加速度 （4-6） （4-7） 6.2 关节空间法 根据式(4-5)～(4-7)可画出它们随时间的变化曲线如下图所示。由图看出，速度曲线为一抛物线，加速度则为一直线。 利用三次多项式规划出的关节角的运动轨迹 6.2 关节空间法 方法是：把所有路径点都看成是“起点”或“终点”，求解逆运动学，得到相应的关节矢量值。然后确定所要求的三次多项式插值函数，把路径点平滑的连接起来。不同的是，这些“起点”和“终点”的关节速度不再是零。 由上式确定的三次多项式描述了起始点和