轨迹规划对工业机器人能够高效、稳定的运动有重要的影响。机器人工作时必须保证运行轨迹的平滑。若各关节的速度和加速度突变或者不连续会在机器人工作过程中，加剧机构的摩擦，机械臂出现振动现象，增大轨迹跟踪误差，降低跟踪精度，缩短机器人的使用寿命。为此学者们提出了多项式插值、B样条曲线插值等插值方法，从而得到关节速度和加速度平稳、光滑且连续的轨迹。

　　本文通过在MATLAB环境中仿真研究了三次多项式与五次多项式插值后，各关节的关节角度位置、速度和加速度的变化轨迹，通过研究分析提出了过路径点的点到点运动间的“353”∽1多项式插值，并且得到了关节速度和加速度的平滑连续的变化轨迹。

　　 1.机器人运动学模型

　　本文以NACHI的六自由度MZ07工业机器人作为模型研究，确定机器人的连杆D—H坐标参数，如表1所示，在MATLAB中构建机器人的数学模型，如图1所示。

　　表1 MZ07机器人连杆D—H参数

　　2.关节空间轨迹插值研究

　　关节空间法是以含有关节角度的函数来描述机器人的轨迹，在进行关节空间轨迹规划时，需要通过运动学的逆解，将路径点转换成关节矢量角度值，再通过对每个关节拟合一个光滑函数，使从起始点开始，依次通过所有路径点，最后到达目标点。对于每段路径，每个关节运行时间均相同，则保证了所有关节同时到达路径点和目标点，此外，各个关节函数之间是相互独立存在的。采用关节空间法不需要在直角坐标系中描述两个路径点之间的路径形状，所以计算简单、容易，并且关节空间不会发生在直角坐标空间中的机构奇异性问题。

　　2.1过路径点的三次多项式插值

　　在单个关节运动过程中，为了使其能都平稳地运动，要求关节在起始点速度和目标点速度均要为0，而且关节起始角吼已知，终止点所可由运动学反解求得，则一个三次多项式可由起始点的关节角度、速度和终止点的关节角度、速度4个约束唯一确定。因此对三次多项式：

　　但是在现实应用中，要求规划出过路径点的轨迹，然后在经过路径点时的机器人手臂末端状态会有两种情况：一种情况是机器人手臂由起始点运动到路径点时停留，即此时的在路径点处的速度为零，则可以直接使用前面的三次多项式插值算法;另一种情况是机器人手臂由起始点运动到路径点时不做停留，此时的速度已经不再为零，则该点再运动到目标点或者下一个路径点时，不能采用前面的三次多项式算法，故上式需要推广成为具有任意约束速度的三次多项式插值。在过路径点的轨迹中，可以把所有的路径点看做是“起始点”或者“目标点”，通过求解其逆解，得到各关节的关节矢量值，然后确定一个三次多项式插值函数，使各个路径点平滑地连接起来。只是此时的“起始点”与“目标点”处的速度不再为零。在确定此三次多项式的方法与前面所述方法相同，只是改变了速度约束，即：

　　在MATLAB中对MZ07机器人的运动进行轨迹规划仿真，设有起始点A(一100，0，一300)、中间点曰(325，225，100)和目标点C(235，300，400)。从A点运动到B点用时1 s，从B点到c点用时1 S，求得三点的关节变量值，如表2所示。

　　表2轨迹点的关节角度

　　由仿真结果可知，三次和五次多项式都可以使运动轨迹平滑连续，但是三次多项式插值后，在关节加速度上出现突变，现实中机器人手臂在运动中很可能无法完成此运动过程。五次多项式的加速度虽然可以光滑地连续起来，但是最大角加速度达到-j'201.067 0rad/s2，使运行不够平稳缓和，也有害电动机的寿命。

　　表3三次多项式与五次多项式最值比较

　　在实际对机器人运动轨迹规划时，要求规划过路径点的轨迹，为了得到加速度合适且连续、平滑的变化轨迹，介于三次多项式和五次多项式的优缺点，采用了“353”一1多项式插值，即三次多项式与五次多项式结合的形式。如图8所示，该方法将整个轨迹分为3个阶段，第一阶段为在0一t。时间内采用三次多项式插值，第二阶段t。一t。时间内采用五次多项式插值，第三阶段t。一t，时间内采用三次多项式插值。本结构方法的要求，在两个相邻阶段的交点处的关节角度、角速度和角加速度要求相等。其中t。、t6可分别取0一t^、t^一f，时刻的中间时刻。

　　同样使用2.3节假定的A、B、c三点。在MATLAB中仿真出“353”多项式结构算法规划后的各关节的关节角度、角速度和角加速度变化情况，如图9—10所示。规划后的关节角度、角速度和角加速度的最大值如表4所示。

　　根据仿真结束所示，该方法可以得到平稳、连续的关节角度、角速度和角加速度的变化轨迹。与表3中的三次、五次多项式最大值比较，可以看出相对三次多项式可以得到平稳、连续的角加速度，同时相对五次多项式可以得到比较小的最大关节角加速度，从而使整个关节运动过程中更加平滑，减小了机构间的冲击。

　　表4“353”多项式最值

　　本文通过在MATLAB环境中，基于MZ07工业机器人运动模型，分析了三次多项式和五次多项式的轨迹插值算法，对比了两个方法的优缺点。关节空间在“353”多项式插值规划后，通过仿真研究，“353”多项式插值既可以得到平稳、连续的角加速度轨迹，又可以得到较合适的最大角加速度，解决了三次多项式插值后关节角加速度不连续问题和五次多项式插值规划后关节最大角加速度较大问题。在关节空间中多项式插值的高低次结合使得各关节的变换优于单一使用的同次多项式插值。