4. 龙门机械耦合建模

双驱龙门系统之所以难控，根源不在电机本身，而在“两台电机被一根横梁硬连在一起”。要设计同步控制器，必须先把这个机械耦合关系写成可用的动力学模型。本节从物理对象出发，逐步建立横梁柔性、双驱刚度耦合、负载分布与完整动力学方程。

一、建模对象与坐标约定

设龙门横梁沿 Y 方向布置，两端分别由左驱（L）和右驱（R）直线电机驱动，沿 X 方向运动；滑台/刀具负载挂在横梁上，可沿 Y 方向移动。定义：

• x_L、x_R：左、右驱动端沿 X 方向的位移，正方向一致；
• θ：横梁绕其中心竖直轴的偏转角（偏航），逆时针为正；
• y_c：负载在横梁上的位置（距横梁中心），向 R 端为正；
• L：两驱动端间距（横梁有效跨距）。

在小偏转假设下，横梁中心位移 x_c=(x_L+x_R)/2，偏转角 θ=(x_R−x_L)/L。这一组变换把“两端位移”分解为“整体平动 + 相对扭转”，是后续解耦控制的基础。

二、横梁柔性：分布参数到集中参数

横梁不是刚体。当两端同步误差存在时，横梁被扭转，产生弹性恢复力矩。工程上常用两种处理：

• 集中参数法：把横梁等效为扭转弹簧 k_θ 与阻尼 c_θ，适用于中低频段；
• 模态截断法：取前 1~2 阶扭转/弯曲模态，适用于高加速度、宽带宽场合。

扭转刚度可由材料力学估算：k_θ=GJ/L，其中 G 为剪切模量，J 为截面极惯性矩。以钢制方管横梁为例，G≈79 GPa，若 J≈2.5×10⁻⁶ m⁴，L=1.5 m，则 k_θ≈1.3×10⁵ N·m/rad。这个量级决定了同步误差被“弹回”的强度，也决定了控制器能压多小的同步误差。

三、双驱刚度耦合与负载分布

负载位置 y_c 直接改变两端受力分配。设负载质量 m_p，横梁质量 m_b，则等效到两端的惯量随 y_c 变化：

m_L = m_b/2 + m_p·(1/2 − y_c/L)
m_R = m_b/2 + m_p·(1/2 + y_c/L)

当负载偏向 R 端时，m_R 增大、m_L 减小，两端动力学不再对称。若控制器仍用同一组增益，R 端响应变慢，同步误差会随负载位置漂移。因此负载分布是“参数时变”的主要来源之一。

四、动力学方程推导

对左、右驱动端分别列牛顿方程，并引入横梁扭转耦合项：

m_L·ẍ_L = F_L − k_θ·(x_L − x_R)/L − c_θ·(ẋ_L − ẋ_R)/L − f_L
m_R·ẍ_R = F_R + k_θ·(x_L − x_R)/L + c_θ·(ẋ_L − ẋ_R)/L − f_R

其中 F_L、F_R 为两台直线电机推力，f_L、f_R 为摩擦与切削等外部阻力。将两式相加、相减，得到更利于控制的“和/差”形式：

和模：(m_L+m_R)·ẍ_c = F_L+F_R − (f_L+f_R)
差模：m_eq·θ̈ = (F_R−F_L)·L/2 − k_θ·θ − c_θ·θ̇ − (f_R−f_L)·L/2

其中 m_eq 为等效转动惯量。和模决定整体跟踪，差模决定同步误差。这一分解把“同步控制”转化为“差模镇定”问题，是双驱龙门控制器设计的核心思路。

五、参数辨识与模型校核

模型建好后必须校核。工程上常用“阶跃推力 + 位移采集”辨识 k_θ 与 m_eq：给 R 端一个已知推力脉冲，记录 x_L、x_R 的响应，由差模方程反推 k_θ。若实测扭转频率与 k_θ 估算值偏差超过 20%，说明横梁柔性不能只用集中弹簧描述，需引入一阶模态。

六、建模结论与控制器接口

本节推导给出三个可直接用于控制器的结论：

1. 和模与差模可独立设计，和模用总推力控制整体跟踪，差模用推力差控制同步误差；
2. 差模是一个“弹簧-质量-阻尼”二阶系统，其自然频率 ω_n=√(k_θ/m_eq)，控制器带宽应低于该频率以避免激发横梁柔性；
3. 负载位置 y_c 是时变参数，需在线更新 m_L、m_R，否则同步误差会随负载移动而增大。