基于MATLAB的机械手臂关节空间轨迹规划的研究*

陈雨

广西大学行健文理学院 广西 南宁 530005

引言

机械手臂是由多个关节组成，关节空间的轨迹规划就是对每个关节都基于关节运动约束条件规划它的光滑运动轨迹。关节的运动约束条件包括它的运动范围、运动速度、加速度等[1]。常见的轨迹规划有直线插值、抛物线过渡的直线插值、三次多项式函数规划、五次多项式函数规划等。本文比较了三次多项式函数规划和五次多项式函数规划的不同，并用MATLAB仿真验证结果。

1 三次多项式函数规划关节轨迹

三次多项式函数具有一阶、二阶微分光滑特性，所以在机械手臂关节空间轨迹规划中被普遍采用。定义关节值中起点为θ0，终止点为θf。构造出满足关节运动约束条件且通过起始点和终止点的光滑轨迹函数θ(t)。

将约束条件代入三次多项式函数通式（1），可得四个方程：

图1-1中，关节运动角度随时间光滑变化。图1-2和图1-3，关节运动角速度和关节运动角加速度随时间变化曲线非光滑。

图1-1 关节运动角度随时间光滑变化

图1-2 关节运动角速度随时间变化

图1-3 关节运动角加速度随时间变化

由图1-1、图1-2、图1-3得出结论：采用三次多项式函数的关节运动角速度和关节运动角加速度为直线，采用三次多项式的关节轨迹函数只能保证两关节点处的位置约束，无法满足两关节点处的速度和加速度约束。如果想满足速度和加速度约束，需要采用更高阶的多项式函数，如五次多项式函数[2-5]。

2 三次多项式函数规划关节轨迹

五次多项式函数的通式为：