第七章 轨迹规划2.ppt

1第七章轨迹规划?在机器人完成给定作业任务之前,应该规定它的操作顺序,行动步骤和作业进程。?任务规划器根据输入的任务说明,规划执行任务所需的运动。根据环境的内部模型和传感器在线采集的数据产生控制指令。机器人学导论 2 ?本章在机器人运动学和动力学的基础上,讨论关节空间和笛卡尔空间中机器人运动轨迹规划和轨迹生成问题。?所谓轨迹,是指机械手在运动过程中的位移、速度和加速度。?而轨迹规划是根据作业任务的要求,计算出预期的运动轨迹。机器人学导论 3 ?点位跟踪:关注的是机器人作业时的起始状态与目标状态。这里点指的是工具坐标系的位置和姿态(位姿)。?连续路径跟踪:对于弧焊和曲面加工等工况,不仅要规定机器人的起始点和终止点,而且要指明两点之间的若干中间点(路径点) ?规划时还要考虑路径上是否有障碍物…机器人学导论 4 ?关节轨迹的插值机器人学导论?获得路径点:路径点通常是用工具坐标系相对工作坐标系的位姿来表示的。?用运动学反解将路径点转换成关节矢量角度值; ?对每个关节拟合一个光滑的函数,使每个关节都从各自的起始点开始运动,依次通过所有的路径点,最后达到目标点。?对关节进行插值和拟合时,应满足一系列的约束条件: 如运动速度、加速度要求等。 5 ?一、三次多项式插值机器人学导论?假设起始点的关节角和终止点的关节角都通过运动学反解得到。?此时,运动轨迹的描述可用起始点关节角和终止点关节角的一个平滑函数表示。?三次多项式比较简单 6 机器人学导论?引入四个约束条件: ?得到四个方程: ?注:这组解只适合起始速度、终止速度为 0的情况。 7 机器人学导论?例题:设有一个旋转关节的单自由度操作臂处于静止状态时, θ 0=15 度,要在 3s 内平稳运动到终止位置: θ t=75 度,并要求终止点速度为 0. ?因此,位置、速度和加速度的表达式如下: 8 ?二、过路径点的三次多项式插值机器人学导论?一般情况下:总是要求规划过路径点的轨迹。? 1) 如果机器人在路径点停留,那么可以直接使用之前介绍的三次多项式插值; ? 2 )如果只是“经过”路径点,并不停留,则需要推广相关算法。 9 机器人学导论?可以把所有的路径点看作是“起始点”或“终止点”; ?求解逆运动学,得到相应的关节矢量值。?确定所要求的三次多项式插值函数,把路径点平滑地连接起来。但是,要注意:在这些“起始点”和“终止点”的关节运动速度不再为 0. ?三次多项式插值的推广 10 机器人学导论?方法一:根据工作坐标系的瞬时线速度和角速度,来确定每个路径点的关节速度; ?方法二:采用适当的启发式算法,由控制系统自动地选择路径点的速度; ?方法三:为保证每个路径点上的加速度连续,由控制系统按此要求自动地选择路径点的速度。?如何确定路径点的速度?最好是采用方法二或三