机器人学导论第5章1.ppt

《机器人学导论第5章1.ppt》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、§第5章轨迹规划（4学时）学习目的：1理解轨迹规划原理2学会用轨迹规划处理实际问题学习内容：1轨迹规划原理2关节空间的轨迹规划3直角坐标空间的轨迹规划4连续轨迹纪录定义：如果规定一个机器人从A点经过B点运动到C点而不强调时间的概念，那么这一过程中的位形序列就构成了一条路径。如果我们强调到达其中任意一点的时间，那么这就是一条轨迹。我们可以看出轨迹和路径的区别就在于轨迹依赖速度和加速度。§5.1路径与轨迹5.2关节空间描述与直角空间描述1关节空间描述如果给定机器人运动的起点和终点，就可以利用逆运动学方程计算出每个关节的矢量角度值；然后机器人控制器驱动关节电机运动使机器人到达相应的位置。

2、这种以关节角度的函数来描述机器人轨迹的方法称为关节空间法。特点：在机器人运动的过程中，中间状态是不可知的，但计算量较小，不会出现奇异点。2直角坐标空间描述将轨迹分成若干段，使机器人的运动经过这些中间点，在每一点都求解机器人的关节变量，直到到达终点，如下图所示：特点：路径可控且可预知，直观、容易看到机器人末端轨迹；但计算量大，容易出现奇异点，如下图所示：直角空间描述轨迹穿过机器人自身关节值突变§5.3轨迹规划的基本原理关节空间的轨迹规划1.计算起点和终点的关节变量，各关节都以最大角速度运动特点：轨迹不规则，末端走过的距离不均匀，且各关节不是同时到达。AB2.在1的基础上对关节速率做归

3、一化处理，使各关节同时到达终点。特点：各关节同时到达终点，轨迹各部分比较均衡，但所得路径仍然是不规则的。AB二直角坐标空间轨迹规划1.首先画出路径，接着将路径n等分(为了获得较好的沿循精度，n越大越好)，分别计算到达各点所需的关节变量。特点：关节角非均匀变化，末端沿已知路径行走。2.在1的基础上，考虑各关节的加速减速时间，为防止在加速期间轨迹落后于设想的轨迹，在划分分界点时，如果是直线轨迹，就按照方程划分。曲线轨迹就相对复杂一些。3.多点的情况（1）从A向B先加速，再匀速，接近B时再减速，从B到C再重复。为避免这一过程中不必要的停止动作，可将B点两边的动作进行平滑过渡。机器人先抵达

4、B点，然后沿着平滑过渡的路径重新加速，最终抵达并停止在C点。（2）考虑到由于采用了平滑过渡曲线，机器人经过的可能不是原来的B点，可事先设定一个不同的B’’点，使曲线正好经过B点。(3)在B点前后各加过渡点D,E，使得B点落在DE上。三轨迹规划的分类1)对于点位作业机器人，需要描述它的起始状态和目标状态。如果用表示工具坐标系的起始值，表示目标值，就是表示这两个值的相对关系。这种运动称为点到点运动(PTP)2)对于弧焊、研磨、抛光等曲面作业，不仅要规定起始点和终止点，还要规定中间整个运动过程。对于一段连续运动过程，理论上无法精确实现，实际上是选取一定数量(满足轨迹插补精度)的点作为中间

5、点，从而近似实现沿给定的路径运动。这种运动称为连续路径运动或轮廓运动(CP)3)障碍约束轨迹规划§5.4关节空间的轨迹规划一、三次多项式的轨迹规划我们假设机器人某一关节的运动方程是三次的从上例可以看出，若我们已知开始和终止时刻的角度以及角速度，那么就可以求得，进而求得关节的运动方程。尽管每一个关节都是分别计算的，但是在实际控制中，所有关节自始至终都是同步运动；如果机器人初始和末端速度不为零，可以通过给定数据得到未知数值；如果要求机器末端人依次通过两个以上的点，则每一段求解出的边界速度和位置均可作为下一段的初始条件，其余相同；位置、速度连续，但是加速度不连续。例5.1：已知一个关节在

6、5秒之内从初始角30度运动到终端角75度，使用三次多项式计算在第1，2，3，4秒时关节的角度。（我们假设在开始和终止的瞬间关节的速度是0)解：由题意可得到由此得到位置，速度和加速度的多项式方程如下：我们可以进一步画出关节的位置，速度和加速度曲线可以看出，本例中需要的初始加速度为10.8度/秒2运动末端的角加速度为-10.8度/秒2。例题：在例5.1的基础上继续运动，要求在其后的3秒内关节角到达。画出该运动的位置，速度和加速度曲线。思路点拨：可将第一运动段末端的关节位置和速度作为下一运动段的初始条件。解：进而可以画出以下曲线为保证机器人的加速度不超过其自身能力，应考虑加速度的限制。根

7、据此式可计算出达到目标所需要的时间二、五次多项式轨迹规划同例5.1，若采用五次多项式，若再已知初始加速度和末端减速度均为5度/秒2，其他条件不变，试画出三条相应曲线。（边界条件变为6个）根据这些方程，可以通过位置、速度和加速度边界条件计算出五次多项式的系数。关节位置、速度和加速度图形三、抛物线过渡的线性运动轨迹如果机器人关节以恒定速度运动，那么轨迹方程就相当于一次多项式，其速度是常数，加速度为0，这说明在起点和终点，加速度为无穷大，只有这样才可以瞬间达到匀速状态。但很