4. 姿态动力学与扰动建模

姿态控制系统能否设计得准，首先取决于动力学模型是否“像”真实航天器。姿态动力学建模不是把牛顿-欧拉方程抄一遍，而是要把航天器拆成若干物理效应，分别判断哪些必须保留、哪些可以简化，再组合成可用于控制器设计和性能评估的模型。本节围绕刚体动力学、挠性附件耦合、液体晃动、环境力矩和执行机构动力学五条主线展开，说明它们各自描述什么、在模型中如何体现，以及工程上如何取舍。

一、刚体动力学方程：姿态运动的骨架

刚体姿态动力学描述角动量与外力矩之间的关系。在星体固连坐标系中，常用欧拉方程表达：

J·ω̇ + ω × (J·ω) = T_ext + T_ctrl

其中 J 为航天器惯量矩阵，ω 为星体相对惯性系的角速度在本体系下的分量，T_ext 为环境扰动力矩，T_ctrl 为执行机构产生的控制力矩。方程左端第二项 ω × (J·ω) 是陀螺耦合项，当三轴惯量不相等且存在多轴同时转动时，它会产生交叉耦合，使某一轴的转动影响另外两轴。工程上，若航天器接近球形或转速很低，可近似忽略；但对大型非对称航天器或快速机动工况，必须保留。

建模时先要明确坐标系约定：本体系原点通常取在质心，三轴与航天器主惯量轴对齐；角速度、力矩的正负号均按右手定则定义。惯量矩阵由质量特性计算或实测获得，若质心位置随推进剂消耗或部件转动而变化，J 和质心偏移都应作为时变量处理。对于教学示例，可取 J = diag(1200, 1500, 900) kg·m²，初始角速度 ω = [0.02, -0.01, 0.005] rad/s，控制力矩 T_ctrl = [0.5, -0.3, 0.2] N·m，用四阶龙格-库塔积分即可观察姿态角和角速度的演化。判断模型是否合理，可检查角动量在无外力矩时是否守恒、能量是否单调衰减（有阻尼时）或保持（无阻尼时）。

二、挠性附件耦合：不能忽略的“软”效应

太阳翼、天线、大型桁架等挠性附件在姿态机动或扰动作用下会产生弹性振动，振动通过附件与星体的连接界面反作用于星体，形成挠性耦合。其典型模型是把附件模态坐标 η 与星体角速度耦合起来：

η̈ + 2ζΩη̇ + Ω²η = -Bᵀ·ω̇
J·ω̇ + ω × (J·ω) + B·η̈ = T_ctrl + T_ext

其中 Ω 为模态频率对角阵，ζ 为模态阻尼比，B 为耦合系数矩阵。耦合强度取决于附件质量、安装位置和模态振型在连接点的斜率。工程上最关心的是最低几阶模态，因为高阶模态频率高、振幅小，常被结构滤波器和控制带宽自然抑制。若某阶模态频率接近控制带宽，就可能出现控制与结构相互作用，表现为姿态角出现持续振荡或执行机构力矩出现高频抖动。

实际建模时，通常由有限元分析给出前若干阶模态频率、阻尼和耦合系数，再截断为 3～6 阶用于控制器设计。判断挠性影响是否可忽略，可比较附件一阶模态频率与控制带宽：若频率比大于 5～10 倍，且附件质量占比小，可先按刚体处理，再用陷波滤波器抑制残余振动；否则必须把挠性模态纳入模型。教学示例中，若一阶模态频率为 0.8 Hz、阻尼比 0.005、耦合系数为 0.02，在 0.2 Hz 带宽控制器下就可能观察到明显振荡，需要调整控制增益或增加滤波器。

三、液体晃动：推进剂带来的低频扰动

液体推进剂在贮箱内晃动，等效为质量-弹簧-阻尼系统，其低频模态会与姿态控制耦合。晃动模型通常用等效摆或等效弹簧-质量块表示，一阶晃动频率由贮箱尺寸和液位决定，阻尼比通常很小（0.005～0.05）。晃动对姿态的影响体现在：推进剂质心偏移产生重力梯度力矩或推力偏心，晃动反作用力通过贮箱壁传递到星体，形成附加力矩。

工程处理上，先根据贮箱形状、液位和推进剂特性计算一阶晃动频率和等效质量，再判断其是否落在控制带宽内。若晃动频率低于控制带宽，控制器可能激发晃动，导致姿态角低频摆动；此时可通过降低带宽、增加晃动滤波器或采用推进剂管理装置（如防晃板）来抑制。教学示例中，若贮箱直径 1.2 m、液位 0.8 m，一阶晃动频率约为 0.3 Hz，而控制带宽为 0.1 Hz，则晃动影响较小；若带宽提高到 0.5 Hz，就必须在模型中保留晃动模态并设计滤波器。

四、环境力矩：持续存在的“背景扰动”

环境力矩主要包括重力梯度力矩、气动力矩、太阳光压力矩和磁力矩。重力梯度力矩由航天器质量分布不均匀和轨道高度决定，对大型航天器尤为明显；气动力矩在低轨（200～600 km）不可忽略，与迎风面积、大气密度和速度平方相关；太阳光压力矩与光照面积、反射特性和光压有关；磁力矩则与剩磁和地磁场相关。这些力矩量级通常很小，但长期作用会导致角动量积累，需要执行机构持续卸载。

建模时，重力梯度力矩可用 T_gg = 3μ/R³ · (R̂ × (J·R̂)) 估算，其中 R̂ 为轨道位置单位矢量；气动力矩可用 T_aero = 0.5ρV²C_dA·l 估算。工程上常把环境力矩作为前馈或干扰输入加入仿真，观察姿态角漂移和角动量积累速率。判断是否需要专门补偿，可比较环境力矩与执行机构最大力矩的比值：若比值大于 1%，通常需要在控制律中考虑；若小于 0.1%，可仅作为干扰评估。

五、执行机构动力学：控制指令到真实力矩的桥梁

执行机构包括动量轮、控制力矩陀螺、喷气推力器和磁力矩器。动量轮输出力矩与转速变化率相关，存在饱和限幅和摩擦阻尼；控制力矩陀螺存在奇异角和框架速率限制；喷气推力器存在最小脉冲、推力偏差和安装偏心；磁力矩器输出力矩与地磁场和电流相关，且不能持续输出。建模时，执行机构不能简单视为理想力矩源，而应加入一阶惯性、限幅、死区和饱和等环节。

例如，动量轮可用一阶模型 T_out = T_cmd/(τs+1)，并限制 |T_out| ≤ T_max、|ω_wheel| ≤ ω_max；喷气推力器可用最小脉冲宽度和推力上升时间描述。判断执行机构模型是否合理，可检查在阶跃指令下输出力矩是否出现超调、延迟或饱和，以及角动量是否在预期时间内积累到限幅值。教学示例中，若动量轮最大力矩 0.2 N·m、最大转速 5000 rpm、时间常数 0.05 s，在 0.1 N·m 阶跃指令下，输出力矩约 0.1 s 后达到稳态，若指令超过 0.2 N·m 则被限幅，姿态角速度响应会明显变慢。

把上述五类模型组合起来，就得到用于姿态控制系统集成与性能评估的完整动力学模型。实际工程中，模型精度与复杂度需要权衡：刚体方程是必选骨架；挠性和晃动按频率比与控制带宽决定是否保留；环境力矩按量级决定是否作为前馈或干扰；执行机构按真实特性加入限幅和延迟。建模完成后，应通过角动量守恒、能量变化、阶跃响应和频域特性等检查模型是否自洽，再用于控制器设计和性能评估。只有模型与真实对象在关键频段和关键工况下足够接近，后续的带宽、稳定裕度和扰动抑制指标才有意义。