📚 课程目录第4章多轴同步的数学建模

4. 多轴同步的数学建模

多轴同步控制的核心挑战在于：各轴并非独立运行，而是通过机械结构（如刚性联轴器、柔性连接件、共享基座）、负载耦合（如龙门架双驱、多轮协同）或工艺约束（如同步轨迹、差速补偿）相互影响。若忽略轴间耦合，仅按单轴独立设计控制器，在高速高加速场景下必然出现同步误差累积、轮廓偏差超限甚至机械振动。因此，建立能够准确描述轴间耦合关系的数学模型，是进行同步控制算法设计、耦合度评估和解耦补偿的前提。本章从状态空间模型和传递函数矩阵两个视角出发，系统阐述多轴系统的建模方法、耦合量化手段与解耦控制策略。

4.1 多轴系统状态空间模型构建

4.1.1 核心原理：从物理方程到状态空间

多轴系统的状态空间模型以一组一阶微分方程描述系统内部状态变量与输入、输出的动态关系。对于n轴系统，其标准形式为：

ẋ(t) = A·x(t) + B·u(t)
y(t) = C·x(t) + D·u(t)

其中，状态向量x(t) ∈ R^m（m为状态维数，通常为2n，包含各轴位置和速度），输入向量u(t) ∈ Rⁿ为各轴控制力矩或电压指令，输出向量y(t) ∈ Rⁿ为各轴位置或速度反馈。矩阵A（m×m）描述系统内部动态及轴间耦合关系，B（m×n）为输入矩阵，C（n×m）为输出矩阵，D（n×n）通常为零矩阵。

以典型的双轴龙门平台为例，考虑两轴通过横梁刚性连接，其动力学方程可写为：

m₁·ẍ₁ + c₁·ẋ₁ + k₁·x₁ + k_c·(x₁ - x₂) = F₁
m₂·ẍ₂ + c₂·ẋ₂ + k₂·x₂ + k_c·(x₂ - x₁) = F₂

其中k_c为耦合刚度系数。选取状态变量x = [x₁, x₂, ẋ₁, ẋ₂]ᵀ，即可得到四阶状态空间模型。矩阵A中非对角元素k_c/m₁和k_c/m₂直接体现了轴间耦合强度。

4.1.2 建模操作流程

物理机理分解：将多轴系统分解为刚体运动、弹性变形、摩擦环节和驱动环节，明确各轴间的机械连接方式（刚性/柔性/无连接）。
拉格朗日方程或牛顿-欧拉方程建立：对每个轴建立力/力矩平衡方程，特别注意交叉耦合项（如科里奥利力、弹性耦合项）。
选取状态变量：优先选择物理意义明确的变量（位置、速度、电流），确保状态维数最小且可观测。
线性化处理：在工作点附近对非线性项（如摩擦力Stribeck曲线、间隙非线性）进行Taylor展开，保留一阶项。
矩阵组装与校验：将方程整理为矩阵形式，通过能控性、能观性判据验证模型有效性。

4.1.3 案例拆解：双轴同步平台的耦合建模

某精密激光切割设备采用双直线电机驱动龙门架，两轴间距1.2m，横梁等效质量m₁=m₂=45kg，耦合刚度k_c=2.5×10⁵ N/m，阻尼c₁=c₂=120 N·s/m。实测两轴位置误差在加速度0.5g时达到0.8mm，远超工艺要求0.1mm。通过建立状态空间模型，发现矩阵A中耦合项k_c/m = 5556 s⁻²，远大于单轴主导极点频率（约80 rad/s），说明耦合动态不可忽略。仿真复现了实测误差趋势，验证了模型准确性。

4.1.4 常见误区与总结

误区1：忽略柔性耦合，将多轴系统简化为多个独立单轴模型。这在低速低精度场景尚可，但在高速高加速时会导致模型失配。

误区2：状态变量选取不当，导致系统不可观或不可控。例如只选位置不选速度，则无法设计基于状态反馈的解耦控制器。

误区3：线性化时忽略工作点变化。对于大行程运动，摩擦和重力项随位置变化，需采用分段线性化或增益调度。

经验：建模完成后务必进行模型验证——将仿真输出与实测阶跃响应、频率响应对比，若偏差超过15%，应检查耦合项参数或是否存在未建模动态（如导轨波纹、线缆拖拽力）。

4.2 传递函数矩阵与耦合度量化

4.2.1 核心原理：传递函数矩阵的物理意义

对状态空间模型进行拉氏变换，可得传递函数矩阵：

G(s) = C(sI - A)⁻¹B + D

G(s)为n×n矩阵，其第(i,j)元素G_ij(s)表示第j个输入到第i个输出的传递特性。对角线元素G_ii(s)为主通道传递函数，非对角线元素G_ij(s)（i≠j）为耦合通道传递函数。若所有非对角线元素为零，则系统完全解耦；若非对角线元素幅值接近对角线元素，则耦合严重。

相对增益阵列（RGA）是量化耦合度的经典工具：

Λ = G(0) ⊙ (G(0)⁻¹)ᵀ

其中⊙表示Hadamard积（逐元素相乘），G(0)为稳态增益矩阵。RGA元素λ_ij接近1表示该通道独立性强，接近0或负值表示强耦合且控制方向可能反转。

4.2.2 耦合度评估方法

评估指标	计算公式	判定标准	适用场景
RGA数	λ_ij = g_ij·[G⁻¹]_ji	λ∈[0.5, 1.5]弱耦合；λ<0.5或>1.5强耦合	稳态耦合分析
耦合带宽比	ω_c,ij / ω_c,ii	<0.1弱耦合；>0.3强耦合	动态耦合分析
奇异值分解	σ̄(G(jω)) / σ̲(G(jω))	条件数>10表示病态耦合	频域鲁棒性分析
H₂范数比	‖G_ij‖₂ / ‖G_ii‖₂	>0.2需考虑解耦	能量耦合评估

4.2.3 案例拆解：三轴运动平台的RGA分析

某三轴并联平台（X-Y-θ）的稳态增益矩阵实测为：

G(0) = [ 2.5  0.3  0.1
         0.2  3.0  0.4
         0.1  0.5  1.8 ]

计算RGA矩阵得：

Λ = [ 1.12  -0.15  0.03
      -0.08  1.21  -0.13
       0.02  -0.06  1.04 ]

分析发现：主对角线元素均接近1，但λ₁₂=-0.15和λ₂₃=-0.13为负值，表明X轴与Y轴、Y轴与θ轴之间存在反向耦合。进一步做频域分析发现，在10Hz处耦合通道增益达到主通道的35%，确认需要设计解耦补偿器。

4.2.4 常见误区与总结

误区1：仅看稳态RGA而忽略频率特性。某些系统在低频解耦良好，但在谐振频率附近耦合急剧增强。

误区2：将RGA负值简单视为“可忽略”。负RGA意味着闭环可能不稳定，必须重新配对输入输出或增加解耦环节。

误区3：忽略执行器饱和对耦合的影响。当某轴力矩饱和时，其输出能力下降，等效耦合度会动态变化。

4.3 解耦控制策略与实现

4.3.1 核心原理：三类解耦方法

前馈解耦（逆传递函数法）：在控制器输出端串联解耦矩阵D(s) = G(s)⁻¹，使等效对象变为对角阵。该方法对模型精度要求高，适用于模型确定且参数稳定的系统。

状态反馈解耦：通过状态反馈u = -Kx + v，配置闭环极点并同时实现解耦。需满足解耦条件（Falb-Wolovich条件），且系统完全可控。

观测器扰动补偿解耦：将轴间耦合视为“等效扰动”，通过扩张状态观测器（ESO）估计并补偿。该方法鲁棒性强，不依赖精确模型，工程应用广泛。

4.3.2 解耦控制器设计流程

耦合度评估：计算RGA和频域耦合指标，确定需要解耦的通道对。
方法选择：模型精确且参数稳定→前馈解耦；模型不确定但有扰动→ESO补偿；需要最优性能→状态反馈+LQR。
参数整定：前馈解耦需辨识G(s)各元素；ESO需整定观测器带宽ω₀（通常为控制器带宽的5-10倍）。
鲁棒性验证：在参数摄动±20%条件下检查解耦效果，确保同步误差仍在允许范围。

4.3.3 案例拆解：龙门双驱的ESO解耦补偿

某半导体固晶机龙门平台，X1轴和X2轴共同驱动横梁，两轴间存在弹性耦合。初始采用独立PID控制，在加减速阶段同步误差达±35μm，超出工艺要求（±10μm）。

实施步骤：

建立两轴状态空间模型，辨识耦合刚度k_c=1.8×10⁵ N/m，阻尼比ζ=0.02。
设计二阶ESO，观测器带宽ω₀=300 rad/s（控制器带宽60 rad/s的5倍）。
将耦合项k_c(x₁-x₂)作为总扰动的一部分，在控制律中实时补偿。
保留原PID作为主控制器，ESO输出叠加到力矩指令。

结果对比：同步误差从±35μm降至±6μm，轮廓误差减小72%。在参数摄动测试（质量变化±15%）中，同步误差仍保持在±9μm以内，验证了ESO方案的鲁棒性。

复盘要点：ESO解耦的关键在于观测器带宽与噪声抑制的平衡。带宽过高会放大测量噪声，过低则补偿滞后。工程上建议通过仿真扫描ω₀，选择使同步误差最小且控制力矩波动在允许范围内的值。

4.3.4 常见误区与总结

误区1：盲目追求完全解耦。实际系统中完全解耦需要极高模型精度，且可能牺牲鲁棒性。工程上应“按需解耦”——只对耦合度超过阈值的通道对进行补偿。

误区2：忽略解耦控制器自身的动态延迟。数字实现中，解耦算法占用计算时间，会引入相位滞后，需在设计中预留相位裕度。

误区3：解耦后不重新整定主控制器。解耦改变了等效对象特性，原PID参数可能不再最优，需重新进行带宽和相位裕度设计。

工程建议：在实施解耦前，先通过实验测量各通道的频率响应，建立Bode图数据库。这不仅能验证模型，还能为解耦控制器参数提供直接依据。同时，建议在控制软件中设计解耦使能开关，便于现场对比解耦前后的性能差异。

多轴同步的数学建模是连接物理系统与控制算法的桥梁。通过状态空间模型可以深入理解系统内部动态和耦合机理，传递函数矩阵和RGA提供了量化耦合度的工具，而解耦控制策略则是在模型基础上实现高性能同步的关键。在实际工程中，应根据系统特点、精度要求和计算资源，选择适当的建模深度和解耦方案，并在仿真与实验中反复迭代验证。