超精密点对点运动三阶轨迹规划精度控制

摘要

研究一种优化的超精密点对点运动三阶轨迹规划算法及其精度控制策略。在简要分析三阶轨迹轮廓可能情形的基础上,建立三个约束基准用来预判别以上情形:速度—加速度基准、位移—加速度基准和位移—速度基准,依据该基准与系统约束,提出一种考虑轨迹全过程的预处理方法,并给出时间优化的轨迹规划算法。考虑算法离散实现时的精度损失,提出一种轨迹规划内部整数积分策略,避免因浮点积分操作所造成的数据漂移而引起的精度失败。此外,提出一种基于位置修正因子的补偿方法,克服切换时间圆整所引起的终点位置偏差。实例证明提出算法的有效性和可靠性。该算法已成功应用于半导体加工装备研发中。