基于非均匀B样条曲线的机器人轨迹过渡算法

摘要

针对6自由度工业机器人末端轨迹不光顺、衔接速度慢、运动不平稳的问题,提出了一种基于非均匀B样条曲线的过渡模型和对应规划算法。使用5次非均匀B样条曲线,构建了G^(3)连续的空间轨迹过渡模型;根据轨迹过渡的拐角速度约束以及轨迹长度的相互制约关系,提出了自适应的速度前瞻算法;采用四阶龙格库塔-割线法,实现了样条曲线的插补;最后,利用安川HP20D机器人和Leica激光跟踪仪AT960进行实验,测量机器人末端TCP速度和加速度信息。实验结果表明,该过渡算法提升了多段连续轨迹的衔接速度,减小了速度波动,避免加速度突变,实现了机器人的平稳运动。