3、火箭姿态控制回路架构：内环角速度环、外环姿态角环、执行器与传感器建模
火箭姿态控制系统的本质是一个多回路、多执行器、多传感器的闭环反馈系统。工程实践中，几乎所有的运载火箭、探空火箭及可重复使用飞行器，其姿态控制律都采用“外环姿态角环 + 内环角速度环”的串级控制架构。这种架构的核心优势在于：内环角速度环能够快速抑制扰动力矩（如风载、质心偏移、发动机摆动耦合），外环姿态角环则负责将火箭姿态精确引导至目标程序角。本章将系统拆解这一控制回路架构，并重点讨论执行器（推力矢量TVC、RCS喷流）与传感器（陀螺、加速度计）的建模方法，为后续PID参数整定奠定物理与数学基础。
3.1 串级控制架构的核心原理与设计动机
火箭姿态控制采用串级PID而非单回路PID，其根本原因在于被控对象（火箭刚体）的动力学特性与执行器特性之间存在显著的时间尺度差异。火箭在飞行中受到的扰动力矩（如侧风、发动机推力偏心、气动阻尼变化）往往具有较宽的频带，而姿态角信号本身是角速度的积分结果，响应较慢。若仅用姿态角单回路控制，扰动对角速度的影响需要经过积分才能反映到姿态角上，控制器响应滞后明显，极易激发低频振荡甚至失稳。
引入内环角速度环后，陀螺直接测量角速度，能够立即感知扰动对角速度的冲击，内环PID（通常以比例控制为主）快速产生修正指令，将角速度拉回期望值。外环姿态角环则相对缓慢地修正角速度指令，确保姿态角跟踪程序角。这种“快内环、慢外环”的设计，使得系统对扰动具有更强的抑制能力，同时降低了对执行器带宽的要求。
3.2 执行器建模：推力矢量（TVC）与RCS喷流
执行器是将控制指令转化为实际力矩的物理装置。对于运载火箭，主执行器是推力矢量控制系统（TVC），包括发动机摆动（摇摆喷管）或燃气舵偏转；在主动段结束后或高空稀薄大气中，则依赖RCS（反作用控制系统）喷流提供姿态控制力矩。
TVC建模要点：TVC的动力学模型通常简化为一阶惯性环节或二阶振荡环节。一阶模型传递函数为：
G_TVC(s) = δ(s) / δ_cmd(s) = 1 / (τ·s + 1)其中τ为伺服机构时间常数，典型值为30~80ms。对于大型运载火箭，还需考虑摆角限幅（如±5°~±8°）和摆动角速度限幅（如±20°/s~±40°/s）。TVC产生的控制力矩为：
M_TVC = T_c · L · δ其中T_c为发动机推力，L为摆心到火箭质心的距离，δ为实际摆角。该力矩与推力、力臂和摆角成正比，是典型的比例力矩模型。
RCS建模要点：RCS喷流执行器具有离散开关特性，通常采用脉宽调制（PWM）或脉宽脉频调制（PFM）方式产生等效连续力矩。其模型可表示为：
M_RCS = F_jet · L_jet · duty_cycle其中F_jet为单个喷流推力，L_jet为喷流力臂，duty_cycle为占空比（0~1）。RCS的响应延迟包括电磁阀开启时间（5~15ms）和喷流建立时间（10~30ms），在建模时需以纯延迟+一阶惯性近似。
| 执行器类型 | 模型形式 | 时间常数/延迟 | 限幅特性 | 适用阶段 |
|---|---|---|---|---|
| TVC（摇摆喷管） | 一阶惯性 + 摆角限幅 | τ = 30~80ms | 摆角±5°~±8°，角速度±20~40°/s | 主动段（大气层内） |
| TVC（燃气舵） | 一阶惯性 + 舵偏限幅 | τ = 20~50ms | 舵偏±10°~±15° | 固体火箭主动段 |
| RCS（冷气/热喷流） | 纯延迟 + 一阶惯性 + PWM | 延迟5~30ms，τ = 10~20ms | 占空比0~1，最小脉宽限制 | 高空/入轨/姿态保持 |
3.3 传感器建模：陀螺与加速度计
传感器是控制回路的“眼睛”，其测量精度和带宽直接影响控制品质。火箭姿态控制中，陀螺用于测量角速度（内环反馈），加速度计用于测量比力（用于姿态解算和过载控制）。
陀螺建模：现代运载火箭普遍采用光纤陀螺或激光陀螺，其测量模型可表示为：
ω_meas = ω_true + b_g + n_g + S_g · ω_true其中b_g为常值零偏（°/h），n_g为角度随机游走噪声，S_g为标度因数误差。在控制回路建模中，陀螺通常近似为比例环节，但需在信号处理中加入低通滤波以抑制高频噪声。陀螺带宽通常为100~300Hz，远高于控制带宽，因此其动态特性可忽略。
加速度计建模：加速度计测量的是比力（非引力加速度），其模型为：
f_meas = a_true - g + b_a + n_a其中a_true为运动加速度，g为重力加速度矢量，b_a为零偏，n_a为测量噪声。在姿态解算中，加速度计与陀螺通过互补滤波或卡尔曼滤波融合，利用加速度计估计重力方向来修正陀螺积分漂移。
3.4 案例拆解：某型液体运载火箭主动段姿态控制回路设计
以某型两级液体运载火箭一级飞行段为例，其姿态控制回路设计过程如下：
背景与约束：火箭一级采用两台液体发动机，每台发动机可双向摆动（俯仰/偏航），最大摆角±6°，伺服机构时间常数τ=50ms。火箭一级飞行段动压最大约30kPa，侧风扰动显著。控制目标：姿态角控制精度±0.5°，角速度稳态误差小于0.5°/s。
初始现象：在首次开环仿真中，采用单回路姿态角PID控制（仅用陀螺积分得到姿态角反馈），当加入10m/s侧风阶跃扰动时，姿态角出现持续振荡，振荡周期约3秒，幅值发散至±2°以上。
分析过程：通过频域分析发现，单回路控制下，姿态角环穿越频率约1.2rad/s，相位裕度仅18°，增益裕度不足6dB。扰动通过气动力矩直接作用于角速度，再积分到姿态角，等效于在控制对象中引入了一个积分环节，导致系统对扰动过于敏感。
改进措施：改为串级控制架构。内环角速度环采用比例控制，增益Kp_ω=2.5，使角速度环带宽达到10rad/s；外环姿态角环采用比例+微分控制，Kp_θ=4.0，Kd_θ=1.2，姿态角环带宽约2rad/s。同时，在陀螺信号处理中加入截止频率50Hz的二阶低通滤波器，抑制高频噪声。
结果对比：改进后，相同侧风扰动下，姿态角最大偏差从±2°降至±0.3°，调节时间从5秒缩短至1.8秒，相位裕度提升至45°，增益裕度达到12dB。飞行试验中，实际姿态角偏差始终控制在±0.4°以内。
风险与代价：内环增益过高会放大陀螺噪声，导致执行器频繁摆动，增加伺服机构磨损。实际调试中，需在噪声抑制与响应速度之间折中，最终内环增益从3.0降至2.5，以降低高频抖动。
3.5 常见误区与总结
误区一：忽视执行器饱和。在PID参数整定中，若未考虑TVC摆角限幅，大扰动下控制器输出可能超出执行器物理极限，导致积分饱和和大幅超调。解决方法是加入抗积分饱和机制（如条件积分或积分限幅）。
误区二：传感器噪声直接进入微分项。姿态角环的微分项对陀螺噪声极为敏感，若直接对姿态角信号求导，会放大高频噪声。正确做法是直接从内环角速度反馈中提取角速度信号，而非对姿态角微分。
误区三：忽略结构滤波特性。火箭箭体存在弹性模态，其频率通常在5~15Hz。若控制带宽覆盖弹性模态频率，可能激发结构振动。工程上需在传感器信号处理中加入陷波滤波器，或在控制器设计中设置低通滤波以衰减弹性模态响应。
误区四：将RCS与TVC同等对待。RCS的离散开关特性使其在小脉宽下存在非线性，且最小脉宽限制导致死区。在RCS控制中，需采用脉宽调制或滞环控制，不能直接套用连续PID控制器。
总结而言，火箭姿态控制回路架构的核心在于内外环时间尺度分离、执行器与传感器的精确建模、以及信号处理链路的合理设计。只有充分理解各环节的物理特性与数学模型，才能为后续PID参数整定提供可靠的被控对象模型，避免“纸上谈兵”式的盲目调参。