3. 运动控制基础
包装机追标与同步运动的本质，是让被控轴在正确的时间到达正确的位置，并在此过程中保持速度、相位与张力稳定。要实现这一点，必须理解运动控制系统的四个核心部件：运动控制器负责“算”，伺服驱动器负责“放”，伺服电机负责“动”，编码器负责“看”。四者构成一个闭环，缺一不可。
一、核心部件与信号链
运动控制器是系统的“大脑”，它接收来自PLC或上位机的工艺指令（如追标触发、相位偏移、凸轮曲线），完成插补、电子齿轮、电子凸轮运算，输出位置或速度指令。伺服驱动器是“功率放大器+本地闭环”，把弱电指令转换为电机所需的电流，并对电流环、速度环、位置环进行实时调节。伺服电机是执行机构，常见为永磁同步电机（PMSM），具备高响应、高过载能力。编码器是反馈元件，安装在电机尾部或负载端，把实际位置/速度送回驱动器与控制器。
二、基本控制原理：三环闭环
伺服系统内部通常采用三环控制结构，由内到外依次为电流环、速度环和位置环。电流环响应最快，决定转矩输出的平滑度；速度环决定加减速的跟随能力；位置环决定最终定位精度。三环带宽依次降低，外环输出作为内环给定，形成级联控制。
在追标场景中，控制器通常工作在位置模式或周期同步位置模式（CSP），通过电子齿轮比把主轴（色标信号或虚轴）与从轴（送膜轴）绑定。当色标传感器检测到标记时，控制器计算相位偏差，并在下一个周期内修正从轴位置，实现“追标”。
三、典型参数配置示例
以某包装机送膜轴为例，伺服驱动器采用位置模式，控制器通过EtherCAT周期同步。常见参数如下：
【伺服驱动器参数】
P1-01 控制模式 = 位置模式 (CSP)
P1-02 电子齿轮比分子 = 10000
P1-03 电子齿轮比分母 = 4096
P2-10 位置环增益 = 35 rad/s
P2-11 速度环增益 = 180 rad/s
P2-12 速度环积分 = 25 ms
P2-20 转矩限幅 = 180 %
【运动控制器参数】
追标使能 = ON
色标滤波时间 = 2 ms
相位修正增益 = 0.65
最大修正速度 = 1200 mm/s
同步窗口 = ±3 mm四、案例：追标失败与编码器反馈异常
某枕式包装机在高速运行（120包/分钟）时出现追标漂移，表现为切刀位置逐渐偏移，最终切到色标。排查发现：编码器电缆与电机动力线捆扎在同一线槽，高速时动力线干扰导致编码器Z相信号偶发丢失。控制器每丢失一次Z相，就少计一圈，相位累积误差逐渐增大。
处理措施：将编码器电缆单独走线，使用双绞屏蔽线并单端接地；在驱动器侧增加Z相滤波；同时把位置环增益从35降到28，减少对干扰信号的敏感度。处理后连续运行2小时，追标误差稳定在±0.5 mm以内。
五、核心部件对比清单
| 部件 | 核心作用 | 关键指标 | 追标中的关注点 |
|---|---|---|---|
| 运动控制器 | 轨迹规划、同步运算、追标修正 | 周期时间、插补精度、轴数 | 追标窗口、相位修正增益 |
| 伺服驱动器 | 功率放大、三环闭环、保护 | 带宽、过载能力、响应时间 | 位置环增益、转矩限幅 |
| 伺服电机 | 执行运动、输出转矩 | 额定转矩、转子惯量、编码器分辨率 | 惯量匹配、加减速能力 |
| 编码器 | 位置/速度反馈 | 分辨率、精度、抗干扰 | Z相信号、屏蔽接地、滤波 |
六、复盘要点
- 先看反馈，再看指令：追标异常时，优先用示波器或驱动器监控编码器反馈波形，确认无丢脉冲、无干扰。
- 惯量匹配是基础：负载惯量与电机转子惯量之比建议控制在5:1以内，否则高速启停时容易振荡。
- 电子齿轮比要整除：分子分母尽量取整，避免控制器内部累积舍入误差。
- 同步周期要匹配：EtherCAT周期建议≤1 ms，追标修正才能及时生效。
- 参数不是越大越好：位置环增益过高会放大编码器噪声，导致追标抖动。
掌握这四类核心部件与三环闭环原理，是理解后续电子凸轮、追标算法和同步策略的前提。只有反馈准确、执行到位、运算及时，追标与同步运动才能在高速包装中稳定落地。