六轴机器人轨迹规划之三次多项式轨迹插值