用于多轴联动动态修正插补位置的全闭环运动控制方法

摘要

本发明涉及一种用于多轴联动动态修正插补位置的全闭环运动控制方法。在第一个命令位置坐标上，根据采集到的各轴实际位置与电机实际位置之间的偏差，调整各轴命令位置；对调整后的各轴命令位置矢量在被加工轨迹上投影，得到投影长度，确定修正后的命令位置；当满足全闭环条件时，停止调整；当程序段处于混联且有后续运动段时，则将本运动段与下一运动段进行速度连接处理；否则，不对插补位置进行调整，直到当前运动段插补完成，再在系统提供的定位时长内，通过PID控制算法使轴的实际位置运动到命令位置上。本发明可以在满足多轴联动轮廓精度、定位精度、重复定位精度的同时，保证伺服电机稳定运行，保证工件加工精度且延长机床的使用寿命。

主权项

一种用于多轴联动动态修正插补位置的全闭环运动控制方法，其特征在于，包括以下步骤：在第一个命令位置坐标上，根据采集到的各轴实际位置与电机实际位置之间的偏差，调整各轴命令位置；对调整后的各轴命令位置矢量在被加工轨迹上投影，得到投影长度，确定修正后的命令位置；重复上述步骤，顺序调整其他命令坐标；当满足全闭环条件，即满足零件加工的轮廓误差所要求的程序段最大剩余长度时，停止调整；当程序段处于混联且有后续运动段时，则将本运动段与下一运动段进行速度连接处理；否则，不对插补位置进行调整，直到当前运动段插补完成，再在系统提供的定位时长内，通过PID控制算法使轴的实际位置运动到命令位置上，完成定位。