路径轨迹规划学案.doc

路径轨迹规划 （1）加减速控制简述 加减速控制算法的目标是建立加减速过程中速度相对于时间的函数关系式f=V(t)。 按照加减速控制算法与插补算法的先后位置关系，加减速控制方式可分为前加减速控制和后加减速控制。前加减速控制即插补计算前进行加减速运算，其优点在于对合成速度进行控制，不影响位置精度，但是需要预测减速点；后加减速控制即插补计算后进行加减速运算，它是对各插补轴分别进行加减速控制，由于各轴没有协调关系，因此合成位置可能不准确。后加减速控制只适用线性插补，在应用上有很大的局限性。 （2）几种速度控制模型 1）直线加减速速度控制模型 直线加减速是当机床启动、停止或者运动速速改变时，速度将按照一定斜率的直线上升或下降。 数学表达式为： 直线加减速控制算法的主要优点是算法简单，机器人响应快，效率高，适合进行实时运算，但是机器人运动存在柔性冲击，速度的过渡不够平滑。 2）指数加减速速度控制模型 指数加减速是启动或停止时的速度发生突变，并且速度变化随时间按指数规律上升或下降。 速度数学表达式为： 加速时： 减速时： 加速度数学表达式为： 加速时： 减速时： 指数型加减速曲线的优点是数学表达式相对简单，可以实时计算，加减速结束时加速度变小冲击变小；缺点是启动过程仍存在较大冲击。 2）S曲线加减速速度控制模型 通过对启动阶段即高速阶段的加速度衰减，来保证电机性能的充分发挥和减小启动冲击。 正常情况下S曲线加减速的运行过程分为7段：加加速段、匀加速段、减加速段、匀速段、加减速段、匀减速段、减减速段，如下图所示： 图中符号分别表示： ：起始速度 ：终点速度 ：各个阶段的过渡点时刻 ：局部时间坐标，表示以各个阶段的起始点作为零点的时间表示， ：各个阶段的持续运行时间 ：整个运行长度 加加速度、加速度、速度、位移等计算公式的通用形式如下所示： （3）插补模式 轨迹规划是指在笛卡儿坐标系中的规划。由于关节空间的轨迹规划是对单个轴的规划，由于机器人机构的特殊性，关节空间规划不能保证特定的轨迹，如果对于那些路径、姿态有严格要求的作业，例如弧焊作业，就必须在笛卡儿坐标系内进行规划。 由于末端执行器的位姿都是时间的函数，所以对轨迹的空间形状有一定的设计要求，这需要相应的机器人轨迹插补算法和逆运动学计算来确定一个机器人的各关节角，以实现要求的空间轨迹。 直线插补和圆弧插补是机器人轨迹规划系统中不可缺少的基本插补算法，也是机器人轨迹规划中最常用的规划方法，本机器人系统实现了直线插补和圆弧插补。 1）直线插补 0 直线插补及梯形速度控制 如图所示始点坐标和姿态为、，终点坐标和姿态为、，开始时的加速段或结束时的减速段（加速段与减速段具有对称性）的加速度为，直线段运动的速度为。 求直线距离 有解？ Y N 运动总时间 总点数 位姿增量 加减速控制参数 各插补点位姿 求加减速时间 直线插补 梯形加减速控制参数求解 加速后的位移 归一化处理 加减速控制参数 设置安全加速度 直线插补流程图 2）圆弧插补 如图，圆弧三点坐标、、，姿态为、、，始末加速段加速度为，中间段速度为。 共线？ 初始化数据 三平面法求圆心和半径 求坐标变换矩阵 各点新坐标 直线插补 平面圆弧插补 原坐标插补点数据 圆弧插补 圆弧插补流程 ?判断三点共线 利用向量和向量叉乘来判断。 ?三平面法求圆心和半径 、和点确定的平面M 过中点且与之垂直的平面T 过中点且与之垂直的平面S 联立三个平面方程，用消去法可求得圆心，在求解过程中要讨论六种情况（消去过程中分母不能为零的六种情况）。 求半径： ?求变换矩阵 以圆心为原点建立坐标系，以方向为轴，其单位方向矢量为： 轴为与向量和相垂直的方向，单位方向矢量为： v轴按右手法则来定，其单位方向矢量为： 因此，变换矩阵如下： 逆矩阵如下： 其中，， ④将各点转换为新坐标 ，半径 ，， ⑤平面圆弧插补 在平面平面内进行圆弧插补，为圆弧的弧度： 圆弧插补新坐标 点为圆弧上任一点，弧度为，则有： 则插补点坐标为： ⑥插补点原坐标系坐标 点在原坐标系中的坐标为： ⑦姿态的求解 姿态各轴的增量： 可得插补点姿态如下： 连续直线路径、轨迹 在直线插补规划中，启动加速停止减速，若连续直线运动，则再启动运动到下一点，这样使电机不停地启动和停止，引起较大的振动和磨损。为避免此问题，可用圆弧过渡的方法将相邻直线连接，完成平滑匀速过渡。 连续直线路径轨迹规划 如图所示，设共有个点，坐标为，加速段和减速段的加速度为，直线段期望速度，频率，圆弧过渡的精度为。为第一段直线加速段；为第一段直线匀速段；为第一段直线减速段。为第一段过渡圆弧。为第二段直线加速段；为第二段直线匀速段……