文档介绍：1 机器人规划的基本概念 1关节空间法 2直角坐标空间法 3轨迹的实时生成 4路径的描述 5 机器人的轨迹规划与生成 2 机器人规划的基机本概念所谓机器人的规划(P1anning) ,指的是——机器人根据自身的任务,求得完成这一任务的解决方案的过程。这里所说的任务,具有广义的概念,既可以指机器人要完成的某一具体任务,也可以是机器人的某个动作,比如手部或关节的某个规定的运动等。轨迹:每个自由度的位移、速度和加速度的时间历程。轨迹:每个自由度的位移、速度和加速度的时间历程。描述方法描述方法: :描述成工具坐标系描述成工具坐标系{ {T T} }相对于工作台坐标系相对于工作台坐标系{ {S S} }的运动。的运动。路径点路径点- -这个术语包括了所有的中间点以及初始点和最终点。这个术语包括了所有的中间点以及初始点和最终点。需要记住的是,虽然通常使用需要记住的是,虽然通常使用““点点””这个术语,但实际上它们是这个术语,但实际上它们是表达位置和姿态的坐标系。表达位置和姿态的坐标系。 3 轨迹规划的目的是——将操作人员输入的简单的任务描述变为详细的运动轨迹描述。例如,对一般的工业机器人来说,操作员可能只输入机械手末端的目标位置和方位,而规划的任务便是要确定出达到目标的关节轨迹的形状、运动的时间和速度等。机器人规划的基本概念 4 关节空间法首先将在工具空间中期望的路径点, 通过逆运动学计算,得到期望的关节位置,然后在关节空间内,给每个关节找到一个经过中间点到达目的终点的光滑函数,同时使得每个关节到达中间点和终点的时间相同,这样便可保证机械手工具能够到达期望的直角坐标位置。这里只要求各个关节在路径点之间的时间相同,而各个关节的光滑函数的确定则是互相独立的。 5 下面具体介绍在关节空间内常用的两种规划方法 1)三次多项式考虑机械手末端在一定时间内从初始位置和方位移动到目标位置和方位的问题。利用逆运动学计算,。满足这个条件的光滑函数可以有许多条,如下图所示: 关节空间法 6 显然,这些光滑函数必须满足以下条件: 同时若要求在起点和终点的速度为零,即: 那么可以选择如下的三次多项式: 作为所要求的光滑函数。式 4-3 中有 4个待定系数,而该式需满足式 4-1 和 4-2 的4个约束条件,因此可以唯一地解出这些系数: ( 4-3 ) ( 4-2 ) ( 4-1 ) 关节空间法???? 0 f f 0t ? ?? ?? ?????????? f 0 0 0t ????????????? 2 3 0 1 2 3 t a a t a t a t ?? ???满足起点和终点的关节角度约束满足起点和终点的关节速度约束 7 ( 4-4 ) ???? 0 0 1 2 0 2 3 0 3 032 ffff a q a a q q t a q q t ??? ??? ? 关节空间法注意:这组解只适用于关节起点、终点速度为零的运动情况。 8 例: 设机械手的某个关节的起始关节角θ 0=15 0,并且机械手原来是静止的。要求在 3秒钟内平滑地运动到θ f=75 0时停下来(即要求在终端时速度为零)。规划出满足上述条件的平滑运动的轨迹,并画出关节角位置、角速度及角加速度随时间变化的曲线。解: 根据所给约束条件,直接代入式(4-4) ,可得: a 0=15 ,a 1=0,a 2=20 ,a 3=- 所求关节角的位置函数为: ?? 2 3 15 20 t t t ?? ??对上式求导,可以得到角速度和角加速度???? 2 40 40 t t t t t ??? ?? ????( 4-6 ) ( 4-7 ) 关节空间法 9 根据式(4-5) ~(4-7) 可画出它们随时间的变化曲线如下图所示。由图看出,速度曲线为一抛物线,加速度则为一直线。利用三次多项式规划出的关节角的运动轨迹关节空间法 10 ?过路径点的三次多项式方法是: 把所有路径点都看成是“起点”或“终点”,求解逆运动学,得到相应的关节矢量值。然后确定所要求的三次多项式插值函数,把路径点平滑的连接起来。不同的是,这些“起点”和“终点”的关节速度不再是零。