路径轨迹规划

1、路径轨迹规划（1）加减速控制简述加减速控制算法的目标是建立加减速过程中速度相对于时间的函数关系式f=V(t)。按照加减速控制算法与插补算法的先后位置关系，加减速控制方式可分为前加减速控制和后加减速控制。前加减速控制即插补计算前进行加减速运算，其优点在于对合成速度进行控制，不影响位置精度，但是需要预测减速点；后加减速控制即插补计算后进行加减速运算，它是对各插补轴分别进行加减速控制，由于各轴没有协调关系，因此合成位置可能不准确。后加减速控制只适用线性插补，在应用上有很大的局限性。（2）几种速度控制模型1）直线加减速速度控制模型直线加减速是当机床启动、停止或者运动速速改变时，速度将按照一定斜率的直线

2、上升或下降。数学表达式为：直线加减速控制算法的主要优点是算法简单，机器人响应快，效率高，适合进行实时运算，但是机器人运动存在柔性冲击，速度的过渡不够平滑。2）指数加减速速度控制模型指数加减速是启动或停止时的速度发生突变，并且速度变化随时间按指数规律上升或下降。速度数学表达式为：加速时：减速时：加速度数学表达式为：加速时：减速时：指数型加减速曲线的优点是数学表达式相对简单，可以实时计算，加减速结束时加速度变小冲击变小；缺点是启动过程仍存在较大冲击。2）S曲线加减速速度控制模型通过对启动阶段即高速阶段的加速度衰减，来保证电机性能的充分发挥和减小启动冲击。正常情况下S曲线加减速的运行过程分为7段：加

3、加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段、减减速段，如下图所示：图中符号分别表示：起始速度：终点速度：各个阶段的过渡点时刻：局部时间坐标，表示以各个阶段的起始点作为零点的时间表示，：各个阶段的持续运行时间：整个运行长度加加速度、加速度、速度、位移等计算公式的通用形式如下所示：（3）插补模式轨迹规划是指在笛卡儿坐标系中的规划。由于关节空间的轨迹规划是对单个轴的规划，由于机器人机构的特殊性，关节空间规划不能保证特定的轨迹，如果对于那些路径、姿态有严格要求的作业，例如弧焊作业，就必须在笛卡儿坐标系内进行规划。由于末端执行器的位姿都是时间的函数，所以对轨迹的空间形状有一定的设计要求，这需

4、要相应的机器人轨迹插补算法和逆运动学计算来确定一个机器人的各关节角，以实现要求的空间轨迹。直线插补和圆弧插补是机器人轨迹规划系统中不可缺少的基本插补算法，也是机器人轨迹规划中最常用的规划方法，本机器人系统实现了直线插补和圆弧插补。1）直线插补0直线插补及梯形速度控制如图所示始点坐标和姿态为、，终点坐标和姿态为、，开始时的加速段或结束时的减速段（加速段与减速段具有对称性）的加速度为，直线段运动的速度为。求直线距离有解？YN运动总时间总点数位姿增量加减速控制参数各插补点位姿求加减速时间直线插补梯形加减速控制参数求解加速后的位移归一化处理加减速控制参数设置安全加速度直线插补流程图2）圆弧插补如图，圆

5、弧三点坐标、，姿态为、，始末加速段加速度为，中间段速度为。共线？初始化数据三平面法求圆心和半径求坐标变换矩阵各点新坐标直线插补平面圆弧插补原坐标插补点数据 圆弧插补圆弧插补流程判断三点共线利用向量和向量叉乘来判断。三平面法求圆心和半径、和点确定的平面M过中点且与之垂直的平面T过中点且与之垂直的平面S联立三个平面方程，用消去法可求得圆心，在求解过程中要讨论六种情况（消去过程中分母不能为零的六种情况）。求半径：求变换矩阵以圆心为原点建立坐标系，以方向为轴，其单位方向矢量为：轴为与向量和相垂直的方向，单位方向矢量为：v轴按右手法则来定，其单位方向矢量为：因此，变换矩阵如下：逆矩阵如下：其中，将各点转换为新坐标，半径，平面圆弧插补在平面平面内进行圆弧插补，为圆弧的弧度： 圆弧插补新坐标点为圆弧上任一点，弧度为，则有：则插补点坐标为：插补点原坐标系坐标点在原坐标系中的坐标为：姿态的求解姿态各轴的增量：可得插补点姿态如下：（4） 连续直线路径、轨迹在直线插补规划中，启动加速停止减速，若连续直线运动，则再启动运动到下一点，这样使电机不停地启动和停止，引起较大的振动和磨损。为避免此问题，可用圆弧过渡的方法将相邻直线连接，完成平滑匀速过渡。 连续直线路径轨迹规划如图所示，设共有个点，坐标为，