4. 防扭控制数学模型

在双电机龙门结构中，横梁把两台电机“绑”在同一根机械轴上，但两台电机又各自通过齿轮齿条或丝杠驱动左右立柱。若两侧驱动力不一致，横梁就会像一根被两端反向拧动的弹簧，产生扭转角。防扭控制的核心，就是把这个物理过程写成可计算、可观测、可补偿的数学模型。

一、龙门动力学建模：从两自由度到扭转模态

最简化的龙门模型把横梁视为刚性体，只考虑左右两侧的直线位移 x_L、x_R。当两侧位移不等时，横梁产生扭转角 θ，其几何关系为：

θ ≈ (x_L - x_R) / B
x_c = (x_L + x_R) / 2

其中 B 为两立柱中心距，x_c 为横梁中心等效位移。若进一步考虑横梁的扭转刚度 K_θ 和阻尼 C_θ，则扭转方向的动力学方程为：

J_θ · θ̈ + C_θ · θ̇ + K_θ · θ = T_L - T_R

这里 J_θ 是横梁绕中心轴的等效转动惯量，T_L、T_R 分别为左右电机的输出转矩。该式说明：扭转角不是位置误差的简单结果，而是由两侧转矩差动态激励出来的二阶振荡环节。当 K_θ 较大时，扭转角小但振荡频率高；当 K_θ 较小时，扭转角大且容易与位置环带宽耦合，形成低频晃动。

二、双电机耦合关系：机械耦合与电气耦合

双电机之间不是独立的两套伺服，而是通过横梁形成机械耦合。左侧电机加速时，会通过横梁对右侧产生反作用力矩；右侧电机若响应滞后，横梁就被“拧”出一个角度。这种耦合在数学上表现为状态矩阵中的非对角项：

[ẍ_L]   [ a  b ] [x_L]   [ u_L ]
[ẍ_R] = [ c  d ] [x_R] + [ u_R ]

其中 b、c 就是耦合系数，由横梁刚度、立柱惯量和传动比共同决定。若忽略耦合，把两台电机当作独立轴调位置环，往往在单轴测试时表现良好，一旦联机就出现“你追我赶”的振荡。因此，防扭控制必须把双电机视为一个多输入多输出系统，而不是两个单输入单输出系统。

三、扭转角与同步误差的数学描述

同步误差通常定义为两侧位置之差：e_s = x_L - x_R。它与扭转角的关系为 θ = e_s / B。因此，抑制同步误差本质上就是抑制扭转角。工程上常把同步误差分为静态分量和动态分量：

• 静态同步误差：由两侧传动间隙、齿条预紧力不一致、导轨摩擦差异引起，表现为稳态时 e_s ≠ 0。
• 动态同步误差：由加减速过程中两侧惯量不匹配、电流环响应差异引起，表现为 e_s 随加速度变化而波动。
• 耦合振荡分量：由 K_θ 与位置环带宽接近时产生，表现为 e_s 出现持续衰减振荡。

为了便于控制器设计，常把同步误差写成状态空间形式：

状态变量：x = [e_s, ė_s, x_c, ẋ_c]ᵀ
输入：u = [T_L, T_R]ᵀ
输出：y = [e_s, x_c]ᵀ

其中 e_s = x_L - x_R，x_c = (x_L + x_R)/2

这样，防扭控制器就可以同时观测“同步通道”和“平移通道”，分别设计同步环和位置环，避免两个通道互相干扰。

四、案例与参数关系：从模型到整定

某龙门铣床参数如下：横梁中心距 B = 2.4 m，横梁扭转刚度 K_θ = 8.5×10⁵ N·m/rad，等效转动惯量 J_θ = 320 kg·m²，阻尼比 ζ = 0.08。可估算扭转模态固有频率：

ω_n = sqrt(K_θ / J_θ) ≈ sqrt(8.5e5 / 320) ≈ 51.5 rad/s ≈ 8.2 Hz

若位置环带宽设为 30 Hz，就会激励扭转模态，导致横梁抖动。正确做法是把位置环带宽压到 4～6 Hz，或加入扭转角前馈与陷波器。下表给出典型参数对防扭效果的影响：

五、复盘：模型精度决定防扭上限

防扭控制不是“加一个同步算法”就能解决。若模型中没有体现 K_θ、C_θ 和耦合系数，控制器就无法区分“真实同步误差”和“测量噪声”。建议在调试阶段做一次扭转模态辨识：给左右电机施加反向转矩脉冲，记录 e_s 的衰减振荡，拟合出 ω_n 和 ζ，再回填到模型中。只有模型与实际机械特性一致，同步环增益、陷波器和前馈补偿才能整定到既快又稳的工作点。

综上，龙门防扭数学模型的核心是：用 θ = e_s / B 把几何误差与扭转角联系起来，用二阶扭转方程描述转矩差到扭转角的动态，用状态空间把同步通道与平移通道解耦。模型越贴近真实机械耦合，防扭控制就越有把握。