[发明专利]一种基于余弦二阶的机器人轨迹规划方法

摘要

一种基于余弦二阶的机器人轨迹规划方法，属于机器人轨迹规划领域。本发明的目的是解决现有机器人轨迹采用抛物线拟合的线性段轨迹的方法存在加速度的阶跃变化，使驱动力矩及驱动力矩一阶导数突然增大，从而导致轨迹不容易跟踪的问题。本发明首先给定基于余弦的二阶轨迹曲线的位置、速度、加速度以及加速度的导数的数学模型，给定两个期望点的位置和速度。然后，将边界条件的值代入所述数学模型中，列出方程组并求解出模型的参数。最后，根据两个期望点间的位置和速度的关系及加速度和加速度的导数的幅值来限制加速度的导数的阀值。确定最终的规划轨迹。本发明适用于机器人的轨迹规划，能够生成平滑的曲线，容易跟踪的轨迹。

主权项

1、一种基于余弦二阶的机器人轨迹规划方法，其特征在于实现该方法的步骤包括：步骤一、建立基于余弦二阶的机器人机械臂轨迹曲线的位置的数学模型、速度的数学模型、加速度的数学模型和加速度的导数的数学模型；步骤二、给定机器人机械臂运动的起始期望点位置S1、起始期望点速度v1、末端期望点位置S2和末端期望点速度v2，按最大加速度amax和最大加速度的导数Jmax进行基于余弦二阶的机器人机械臂轨迹曲线的规划；步骤三、依据最短时间原则将机器人机械臂从起始期望点到末端期望点的轨迹分成四段，分别为加速度倾斜上升段、加速度平稳段、加速度倾斜下降段和速度平稳段；步骤四、将加速度倾斜上升段的边界条件的值代入步骤一所述数学模型中，列出方程组并求解出所述数学模型的参数；步骤五、判断是否满足条件：S2-S1≥D1+D2+D3，如果判断结果为是，执行步骤六，如果判断结果为否，执行步骤九，步骤六、判断是否满足条件：v2≥v2min，如果判断结果为是，执行步骤七，如果判断结果为否，执行步骤八，其中，v2min为基于余弦二阶的轨迹只包括加速度倾斜上升段和加速度倾斜下降段时的最小的末端速度值；步骤七、基于余弦二阶的轨迹按最大加速度amax和最大加速度的导数Jmax进行规划，获得机器人机械臂期望的输出轨迹，基于余弦二阶的机器人轨迹规划方法完成，本步骤所述的基于余弦二阶的轨迹规划包括加速度倾斜上升段、加速度平稳段、加速度倾斜下降段和速度平稳段四段，则D4＝S2-S1-D1-D2-D3既而获得机器人机械臂期望的输出轨迹，步骤八、基于余弦二阶的轨迹按加速度阈值af和最大加速度的导数Jmax进行规划，获得机器人机械臂期望的输出轨迹，基于余弦二阶的机器人轨迹规划方法完成，本步骤所述的基于余弦二阶的轨迹规划包括加速度倾斜上升段、加速度倾斜下降段和速度平稳段三段，且满足以下方程组：获得加速度阈值af和余弦周期T，既而获得机器人机械臂期望的输出轨迹，步骤九、基于余弦二阶的轨迹按加速度阈值af和加速度的导数阈值Jf进行规划，获得机器人机械臂期望的输出轨迹，基于余弦二阶的机器人轨迹规划方法完成，本步骤所述的基于余弦二阶的轨迹规划包括加速度倾斜上升段和加速度倾斜下降段两段，且满足以下方程组：获得余弦周期T、加速度阈值af和加速度的导数阈值Jf：既而获得机器人机械臂期望的输出轨迹，其中，D1为加速度倾斜上升段运行距离，D2为加速度平稳段运行距离，D3为加速度倾斜下降段运行距离，D4为速度平稳段运行距离。