第四章第二节 俯仰/偏航姿态驾驶仪
定位：过载驾驶仪控制的是"加速度"（速度矢量怎么转），姿态驾驶仪控制的是"角度"（弹体本身怎么摆）。发射段、巡航段、BTT滚转协调——这些场景不需要立刻改变飞行方向，而是需要让弹体先摆到一个精确的姿态。第二节解决的就是"角度跟踪"问题。
4.2 俯仰/偏航姿态驾驶仪
4.2.0 全景认知：知识图谱与总体结构
4.2.0.1 知识图谱：姿态控制与过载控制的本质分野
图注：本图展示姿态控制与过载控制在任务需求、被控量、传感器、控制结构四个层面的分野。黄色为任务需求，蓝色为被控物理量，绿色为传感器，紫色为控制结构。关键节点为：速度方向控制（过载驾驶仪使命）、弹体姿态控制（姿态驾驶仪使命）、姿态参考（姿态驾驶仪特有的信息源）。
4.2.0.2 总体结构图：姿态驾驶仪的四层骨架
图注：本图展示姿态驾驶仪的总体结构及与过载驾驶仪的关系。蓝色实线为主结构：姿态指令经角度外环、角速度中环、舵机到弹体。橙色虚线为过载驾驶仪的并行路径，二者共享舵机与弹体执行层。紫色为输出，黄色为执行。关键节点为：角度外环（积分特性）、角速度中环（阻尼特性）、舵机（共享瓶颈）。
4.2.0.3 演化路径图：从单轴稳定到三轴协同
图注：本图展示姿态驾驶仪从单轴到三轴的演化路径。绿色为角速度阻尼基础，蓝色为姿态跟踪成型，橙色为双通道协同，紫色为三轴融合。每一步标注了该阶段解决的核心问题。关键节点为：角速度内环（阻尼基础）、角度外环（跟踪核心）、通道解耦（多轴必需）、姿态过载切换（任务融合）。
4.2.0.4 决策分支图：何时选用姿态驾驶仪
图注：本图为决策分支图，展示不同任务阶段对驾驶仪类型的选择逻辑。黄色为任务输入，蓝色为决策点，绿色为姿态驾驶仪适用域，紫色为过载驾驶仪适用域。关键节点为：发射段（姿态必选项）、末制导机动（过载必选项）、BTT滚转（姿态协同项）。
认知检查点：姿态驾驶仪与过载驾驶仪不是升级替代关系，而是同一弹体上的两套控制模式。姿态驾驶仪管"弹体怎么摆"，过载驾驶仪管"速度怎么转"。发射段、巡航段、BTT滚转协调——这些场景需要姿态驾驶仪；中末制导的大机动需要过载驾驶仪。二者共享舵机和弹体，但外环传感器和被控量完全不同。
4.2.1 姿态驾驶仪的物理本质
4.2.1.1 为什么需要姿态控制：速度方向 vs 弹体指向
想象你手持一根长杆向前奔跑。过载驾驶仪关心的是"你整个人往哪个方向跑"——也就是速度矢量的方向；姿态驾驶仪关心的是"长杆本身指向哪里"——也就是弹轴与速度矢量之间的夹角（攻角）。在很多飞行阶段，我们并不急于改变速度方向，而是需要先让长杆稳定地指向一个特定方向。
发射段是最典型的例子。导弹离轨瞬间，速度还很低，气动控制力几乎为零，但弹体不能随意翻滚。此时我们需要姿态驾驶仪像一根无形的支架，把弹体固定在预定发射角附近。等到速度建立起来，气动舵面有效了，再切换到过载驾驶仪进行机动。
图注：本图展示姿态与过载控制的对象差异。左侧简化概念图用"长杆指向"与"速度方向"的夹角建立直觉。右侧完整细节图展示弹轴、速度矢量、攻角、姿态角、弹道倾角的几何关系。蓝色为弹体姿态相关，橙色为速度方向相关，紫色为耦合产物（攻角）。关键节点为：弹轴方向（姿态驾驶仪直接控制）、速度矢量（过载驾驶仪直接控制）、攻角（二者耦合产物）。
从已有经验者的视角看，姿态驾驶仪的被控量是弹体坐标系相对于地面坐标系的欧拉角（俯仰角 ϑ\varthetaϑ、偏航角 ψ\psiψ），其动力学链为：舵偏角 δ\deltaδ → 控制力矩 → 角加速度 ϑ¨\ddot{\vartheta}ϑ¨ → 角速度 ϑ˙\dot{\vartheta}ϑ˙ → 姿态角 ϑ\varthetaϑ。这是一条双重积分链，在频域上表现为 1/s21/s^21/s2 的积分特性。
4.2.1.2 双重积分的稳定性危机
如果不用角速度内环，直接让姿态角误差驱动舵机，会发生什么？想象用一根极软的弹簧去悬挂一个重物，你观察重物的位置，发现它偏低了，于是加大拉力——但由于弹簧太软，重物开始来回摆动，而且越摆越剧烈。直接姿态反馈面临同样的困境：从舵偏角到姿态角是双重积分（两个 1/s1/s1/s 环节串联），开环相位在低频段就达到 −180°-180°−180°，任何比例增益都会触发振荡。
图注：本图为因果链图，解释直接姿态反馈必然振荡的机理。蓝色为物理链，橙色为数学本质，红色为工程后果。虚线表示推导关系。关键节点为：二重积分（数学根因）、相位负一百八（稳定性判据）、单环姿态发散（工程结果）。
常见误解：很多人会误以为只要降低姿态外环增益，单环就能稳定。实际上双重积分的 −180°-180°−180° 相位发生在所有频率，降低增益只能让振荡更慢，无法消除振荡。必须有额外的微分或阻尼环节注入相位超前，才能把系统拉回稳定。
认知检查点：姿态驾驶仪的核心矛盾是"被控量需要双重积分才能从舵偏角得到"，这导致开环相位储备天然不足。解决思路与过载驾驶仪完全一致：在姿态外环内部先套一个角速度内环，把双重积分拆成"一阶惯性+单重积分"，为外环设计创造稳定的基底。
4.2.2 两回路姿态驾驶仪
4.2.2.1 角速度内环：把双重积分拆成单重积分
现在我们已经了解了双重积分的危机，接下来看看角速度内环如何化解它。想象给软弹簧悬挂的重物增加一个速度敏感阻尼器：重物一动，阻尼器立刻产生反向阻力。角速度内环就是这个阻尼器。我们用陀螺测量弹体的俯仰角速度 ϑ˙\dot{\vartheta}ϑ˙，负反馈到舵机输入，构造了一个与旋转速度反向的控制力矩。
内环闭环后，从舵偏角到角速度的传函变成了一个一阶惯性环节（时间常数由阻尼回路增益决定），而从角速度到姿态角仍然是积分环节 1/s1/s1/s。整个被控对象从"双重积分"降级为"一阶惯性+积分"，相位特性大幅改善。
图注：本图为对比视图，展示角速度内环对被控对象结构的改造。左侧红色为无内环时的双重积分危险结构，右侧绿色+蓝色为有内环时的安全结构。关键节点为：双重积分（危险根源）、一阶惯性（内环改造结果）、单重积分（外环可控基底）。
4.2.2.2 姿态角外环：角度跟踪的实现
现在我们已经了解了内环的阻尼作用，接下来看看外环如何跟踪姿态指令。姿态角外环的传感器通常是惯导组件或姿态参考系统，输出当前俯仰角 ϑ\varthetaϑ。外环控制器将指令 ϑc\vartheta_cϑc 与实际值比较，生成角速度指令 ϑ˙c\dot{\vartheta}_cϑ˙c，送给内环执行。
这个结构与过载驾驶仪的两回路非常相似，但有一个本质差异：过载驾驶仪外环的传感器是加速度计（比例特性），姿态驾驶仪外环的传感器是角度（积分特性）。这意味着姿态外环控制器不需要积分器就能消除静差——因为被控对象内环已经包含了足够的低频增益，且角度误差本身会通过积分自然累积到控制量中。
图注：本图展示姿态驾驶仪外环-内环的双重视图。左侧简化概念图展示"误差→角速令→跟踪→到位"的直觉链条。右侧完整细节图展示从指令到弹体的完整闭环。黄色为输入/反馈，蓝色为控制层，橙色为执行层，紫色为输出。关键节点为：外环控制器（角度→角速度映射）、角速度内环（阻尼执行）、弹体（被控对象）。
关键公式：外环控制器通常采用比例-微分（PD）或超前校正形式：
ϑ˙c=Kϑ(ϑc−ϑ)+Kdddt(ϑc−ϑ) \dot{\vartheta}_c = K_\vartheta (\vartheta_c - \vartheta) + K_d \frac{d}{dt}(\vartheta_c - \vartheta) ϑ˙c=Kϑ(ϑc−ϑ)+Kddtd(ϑc−ϑ)
这个公式如果翻译成图，画出来会是一个比例通路（立即响应当前角度误差）与一个微分通路（预测误差变化趋势）的并联，汇合后生成角速度指令。微分项为外环提供了额外的相位超前，补偿了内环惯性环节和弹体积分环节的相位滞后。
核心结论：姿态驾驶仪外环的核心任务不是"消除静差"（姿态环本身积分特性已保证无静差），而是"快速跟踪"与"抑制超调"。外环带宽通常设计为内环带宽的 1/3∼1/51/3 \sim 1/51/3∼1/5，避免内外环相互干扰。
实现细节：外环控制器的微分项在实际实现中不能直接用理想微分 sss（会放大噪声），而是用一阶超前环节 (T1s+1)/(T2s+1)(T_1 s + 1)/(T_2 s + 1)(T1s+1)/(T2s+1) 近似，其中 T2≪T1T_2 \ll T_1T2≪T1。
4.2.2.3 姿态环的相位困境与超前校正
姿态驾驶仪外环面临一个隐蔽的相位问题。内环闭环后的等效被控对象是一个一阶惯性串联积分环节，其相位在交越频率附近约为 −135°-135°−135°。外环控制器如果只用比例作用，相位裕度仅有 45°45°45°，在参数拉偏时容易跌破稳定边界。
超前校正的作用是为外环注入额外的相位超前。想象在驾驶仪中增加一个"预判"机制：不仅看当前角度误差，还看误差的变化速度，提前做出反应。微分项正是这个预判机制。
图注：本图展示姿态外环超前校正的必要性。左侧绿色实线为正确路径：比例+微分并联注入超前相位，保证裕度。右侧红色虚线为常见错误路径：纯比例导致裕度不足，拉偏后振荡。关键节点为：微分通路（超前来源）、相位裕度足（稳定判据）、参数拉偏振荡（错误后果）。
procedure TwoLoopAttitudeAutopilot(thetac, theta, dtheta);
var e_theta, d_e, omega_c, u_damp, u, delta : real;
begin
// 对应图 4-2-2：外环角度误差
e_theta := thetac - theta; // e_theta: 姿态误差 [1, 1]
// 对应图 4-2-2：外环PD生成角速令
d_e := Derivative(e_theta, T_filt); // d_e: 误差微分 [1, 1]
// 此时 d_e 经一阶滤波抑制噪声
omega_c := K_theta * e_theta + K_d * d_e; // omega_c: 角速指令 [1, 1]
// 对应图 4-2-2：内环角速度跟踪
u_damp := K_g * (omega_c - dtheta); // u_damp: 内环驱动 [1, 1]
// 此时 u_damp 为角速误差经阻尼增益
// 对应图 4-2-2：舵机执行
u := KA * u_damp; // u: 舵指令 [1, 1]
delta := ServoFirstOrder(u, T_servo); // delta: 舵偏角 [1, 1]
// 对应图 4-2-2：弹体响应
theta_new := MissileAttitudeDynamics(delta); // theta_new: 新姿态角 [1, 1]
// 此时 theta_new 含内环阻尼后的平滑响应
return theta_new;
end;
图码对应：伪代码中的外环误差、PD生成角速令、内环跟踪、舵机执行、弹体响应五个步骤，分别对应图 4-2-2 完整细节图中的五个功能节点。
认知检查点：两回路姿态驾驶仪的结构与过载驾驶仪惊人地相似——都是外环套内环。但外环的物理使命完全不同：过载外环跟踪加速度（比例对象），姿态外环跟踪角度（积分对象）。这意味着姿态外环天然无静差，但对相位超前的需求更迫切。
4.2.3 带积分校正的姿态驾驶仪
4.2.3.1 静差的根源：摩擦力矩与气动不对称
姿态驾驶仪不是天生无静差的吗？为什么还需要积分校正？想象让一扇生锈的铰链门停在 90°90°90° 位置。你用手推它到 90°90°90°，但铰链的摩擦力会把它往回拉一点；你必须持续施加一个微小的力才能抵消摩擦。姿态驾驶仪面临的"铰链摩擦"包括：舵机轴承的库仑摩擦、弹体气动外形不对称产生的常值气动力矩、质心横向偏移导致的重力矩。
这些干扰力矩在角度外环看来，相当于在被控对象输入端叠加了一个未知偏置。纯PD外环无法彻底消除这个偏置，因为PD控制器在稳态时输出为零（误差为零时比例项为零，微分项也为零），而舵机需要非零偏置才能抵消干扰力矩。结果是姿态角稳定在一个有偏的位置，存在残余静差。
图注：本图为因果链图，解释姿态驾驶仪中静差产生的特殊机理。红色为干扰来源，橙色为物理机制，紫色为纯PD控制的结果。虚线表示推导关系。关键节点为：等效偏置力矩（核心干扰）、稳态舵偏为零（PD致命弱点）、姿态存在静差（工程表现）。
4.2.3.2 积分外环的引入
如果不用积分器，会发生什么？我们将被迫提高比例增益来压缩静差，但这会推高交越频率，侵入内环带宽，引发内外环耦合振荡。积分外环的引入为姿态驾驶仪增加了一个"自动配平"功能：只要存在姿态静差，积分器就持续累积，不断调整角速度指令的直流偏置，直到干扰力矩被完全抵消，姿态角精确归零。
图注：本图展示积分外环的双重视图。左侧简化概念图展示"静差→累积→偏置→抵消→归零"的直觉链条。右侧完整细节图展示积分器在控制律中的位置。红色为误差输入，绿色为积分通路，蓝色为控制汇合，紫色为最终结果。关键节点为：积分器（核心）、积分输出（直流偏置来源）、干扰抵消（最终目标）。
关键公式：带积分的姿态外环控制器
ϑ˙c=Kpeϑ+Ki∫eϑdt+Kde˙ϑ \dot{\vartheta}_c = K_p e_\vartheta + K_i \int e_\vartheta dt + K_d \dot{e}_\vartheta ϑ˙c=Kpeϑ+Ki∫eϑdt+Kde˙ϑ
这个公式如果翻译成图，画出来会是三条并联通路：比例通路（立即响应）、积分通路（持续累积消除静差）、微分通路（提供相位超前），三条通路汇合后生成角速度指令。
核心结论：积分项的转折频率应远低于外环交越频率（通常取 1/5∼1/101/5 \sim 1/101/5∼1/10），避免积分作用侵入中频段导致相位裕度损失。积分器在过渡过程初期应被限幅或冻结，防止大角度指令引起积分饱和。
实现细节：工程上常采用"积分分离"策略：当角度误差大于阈值时，关闭积分器，只用PD快速收敛；当误差进入阈值内，开启积分器，精细消除静差。这兼顾了快速性与无静差。
4.2.3.3 积分饱和与抗积分漂移
姿态驾驶仪的积分饱和比过载驾驶仪更危险。想象导弹在发射段需要快速抬头 30°30°30°，如果积分器在抬头过程中无限制累积，当姿态接近目标值时，积分器已经"喝饱了"，即使误差已经变小，巨大的积分输出会继续驱动舵机，导致严重超调甚至反向振荡。
图注：本图展示积分饱和的演化过程与后果。橙色为饱和过程链，红色为工程后果。实线为时间顺序，虚线为推导关系。关键节点为：积分器累积（触发点）、误差已变小但积分输出仍大（危险状态）、严重超调（直接后果）。
常见误解：很多人会误以为积分饱和只是"超调大一点"，实际上在姿态控制中，积分饱和可能导致弹体越过稳定边界，进入气动发散区，尤其是在大攻角附近。抗饱和设计不是可选优化，而是安全必需。
抗饱和策略包括：
- 积分冻结：舵机饱和时停止积分累积；
- 反馈抗饱和：将舵机实际输出与指令的差额反馈到积分器输入，形成负反馈，自动泄放积分；
- 积分限幅：对积分器输出设置绝对上限。
procedure PIAttitudeAutopilot(thetac, theta, dtheta);
var e_theta, e_int, omega_c, u_damp, u, delta, delta_sat : real;
begin
// 对应图 4-2-3：外环误差
e_theta := thetac - theta; // e_theta: 姿态误差 [1, 1]
// 对应图 4-2-3：积分器（带抗饱和）
if |delta_sat| < delta_max then
e_int := e_int + Ki * e_theta * dt; // e_int: 积分累积 [1, 1]
// 此时仅当舵机未饱和才累积
else
e_int := e_int + Ki * (e_theta - K_aw * (delta_sat - delta)) * dt;
// 抗饱和反馈泄放积分
end;
e_int := Clamp(e_int, int_min, int_max); // 积分限幅
// 对应图 4-2-3：PD+积分生成角速令
omega_c := Kp * e_theta + e_int + Kd * dtheta; // omega_c: 角速指令 [1, 1]
// 对应图 4-2-3：内环阻尼
u_damp := K_g * (omega_c - dtheta); // u_damp: 内环驱动 [1, 1]
// 对应图 4-2-3：舵机与饱和
u := KA * u_damp;
delta := ServoFirstOrder(u, T_servo); // delta: 舵指令 [1, 1]
delta_sat := Clamp(delta, -delta_max, delta_max); // delta_sat: 饱和后 [1, 1]
// 对应图 4-2-3：弹体响应
theta_new := MissileAttitudeDynamics(delta_sat);
return theta_new;
end;
图码对应：伪代码中的积分抗饱和逻辑、PD+积分生成角速令、内环阻尼、舵机饱和四个步骤，分别对应图 4-2-3 完整细节图中的四个功能节点。
认知检查点：姿态驾驶仪的积分校正不是为消除"角度静差"（角度环本身积分特性已保证无静差），而是为消除"干扰力矩引起的舵偏偏置"。积分器为外环提供了一个直流偏置输出能力，让舵机在稳态时保持非零偏置以抵消摩擦和气动不对称。没有这个偏置能力，姿态永远停不到精确目标值。
4.2.4 俯仰与偏航的协同
4.2.4.1 通道对称性：一套设计，两个拷贝
对于轴对称导弹，俯仰通道与偏航通道在气动特性和刚体动力学上几乎完全对称。这意味着我们不需要为俯仰和偏航分别设计两套驾驶仪——设计好俯仰通道的参数，偏航通道可以直接拷贝，只需把符号表中的下标从 zzz（俯仰）换成 yyy（偏航）。
想象一个十字形布局的导弹：上下舵控制俯仰，左右舵控制偏航。如果导弹绕纵轴滚转 90°90°90°，原来的俯仰舵变成了偏航舵，偏航舵变成了俯仰舵。这种对称性让设计工作量减半，也让弹上软件可以用同一套控制律处理两个通道。
图注：本图展示俯仰与偏航通道的对称结构。蓝色为俯仰通道，绿色为偏航通道，橙色为共享弹体。两个通道结构完全镜像，仅传感器输入和舵机输出方向不同。关键节点为：俯仰驾驶仪（蓝色拷贝）、偏航驾驶仪（绿色拷贝）、轴对称弹体（共享被控对象）。
4.2.4.2 交叉耦合与解耦
通道对称性有一个前提：导弹没有滚转，或者滚转角度恰好为零。一旦导弹绕纵轴滚转，俯仰舵和偏航舵在惯性空间中的投影会发生混合。想象把十字形舵面整体旋转 45°45°45°：原来的"纯俯仰"舵偏同时产生了偏航力矩，原来的"纯偏航"舵偏同时产生了俯仰力矩。这就是交叉耦合。
对于STT（侧滑转弯）控制的导弹，滚转角通常很小，交叉耦合可以忽略，俯仰和偏航通道独立运行。但对于BTT（倾斜转弯）控制的导弹，滚转角可能达到 90°90°90° 甚至更大，此时必须进行解耦：把惯性空间的俯仰/偏航指令先转换到弹体坐标系，再根据当前滚转角重新分配到四个舵面。
图注：本图为对比视图，展示STT与BTT控制下的通道耦合差异。左侧蓝色为STT无滚转场景：指令直接独立分配。右侧紫色为BTT有滚转场景：需要滚转角输入进行坐标旋转和混合分配。关键节点为：坐标旋转（解耦核心）、混合分配（BTT必需）、四舵协同（执行形态）。
解耦矩阵的形式为：
[δz,cδy,c]=[cosγsinγ−sinγcosγ][ϑcψc] \begin{bmatrix} \delta_{z,c} \\ \delta_{y,c} \end{bmatrix} = \begin{bmatrix} \cos\gamma & \sin\gamma \\ -\sin\gamma & \cos\gamma \end{bmatrix} \begin{bmatrix} \vartheta_c \\ \psi_c \end{bmatrix} [δz,cδy,c]=[cosγ−sinγsinγcosγ][ϑcψc]
这个公式如果翻译成图，画出来会是一个二维旋转矩阵：输入是惯性空间的俯仰/偏航指令，经过滚转角 γ\gammaγ 的旋转变换，输出是弹体坐标系下的等效指令。它相当于把"地面看到的俯仰需求"转成了"弹体舵面需要执行的实际偏转"。
核心结论：俯仰与偏航的姿态驾驶仪设计在轴对称假设下完全共享。只有当滚转角不可忽略时，才需要在指令层引入解耦矩阵。解耦不改变驾驶仪本身的结构，只改变指令进入驾驶仪之前的坐标变换。
实现细节：解耦矩阵中的滚转角 γ\gammaγ 由滚转姿态驾驶仪或滚转稳定回路提供。BTT控制中，滚转通道的姿态驾驶仪负责把大升力面转到目标方向，俯仰/偏航通道负责在该方向上产生攻角。
认知检查点：俯仰与偏航的姿态驾驶仪是"同一套代码的两个实例"。它们共享设计参数、共享被控对象模型，仅在输入输出接口上交换了坐标轴。BTT控制引入的复杂性不在驾驶仪内部，而在驾驶仪之前的指令解耦层。
4.2.5 姿态/过载驾驶仪的切换与融合
4.2.5.1 发射段姿态稳定：从零速到可控
导弹离轨瞬间，速度几乎为零，气动舵面效率极低，此时过载驾驶仪完全失效——因为过载 ay=Vθ˙a_y = V\dot{\theta}ay=Vθ˙，VVV 接近零时，即使弹体姿态快速变化，法向加速度也几乎测不到。姿态驾驶仪在这个阶段是唯一的控制手段：它直接控制弹体指向，不依赖速度大小。
想象火箭垂直发射的场景：起飞初期，发动机推力巨大，但速度还没建立，气动舵面像在水里慢慢挥动的桨。此时我们需要姿态驾驶仪像一根刚性支架，把弹体牢牢固定在发射架上预设的离轨角度，防止发动机推力不对称或侧风引起姿态发散。
图注：本图展示从发射到机动的三阶段演化。红色为发射段（姿态必需），橙色为过渡段（能力建立），绿色为机动段（过载接管）。关键节点为：速度极低（姿态主导根因）、过载不可测（过载失效判据）、准备切换（过渡标志）、过载驾驶仪接管（任务交接点）。
4.2.5.2 中段过载制导：轨迹跟踪的主战场
当导弹速度建立到 Ma>1.5Ma > 1.5Ma>1.5 左右，气动舵面进入有效工作区，加速度计输出足够大且信噪比良好，此时控制系统从姿态驾驶仪切换到过载驾驶仪。中段制导的核心任务是跟踪制导律生成的过载指令，使导弹速度矢量按期望方向转动，从而逼近目标视线。
姿态驾驶仪在中段并非完全退出，而是转为"备份"或"辅助"角色。在某些场景下（如巡航飞行、弹道整形），导弹需要保持水平姿态而非大机动，此时可以临时切回姿态模式，让弹体平稳飞行，节省能量。
图注：本图为决策分支图，展示中段任务的模式选择逻辑。黄色为任务输入，蓝色为决策点，紫色为过载模式，绿色为姿态模式。关键节点为：大机动跟踪（过载主场）、巡航稳定（姿态主场）、能量节省（姿态优势）。
4.2.5.3 切换逻辑与瞬态抑制
姿态驾驶仪与过载驾驶仪的切换不是简单的"拨开关"。两个驾驶仪的输出都连接到同一套舵机，如果切换瞬间两个驾驶仪给出的舵指令不一致，舵机会产生阶跃冲击，弹体姿态剧烈抖动。想象两辆汽车同时拉同一根缰绳，一个想左转，一个想右转，马会原地打转。
切换逻辑必须保证"无扰切换"：在切换前，让两个驾驶仪的舵指令逐渐对齐，或者让目标驾驶仪的内部状态（积分器、滤波器历史值）从当前驾驶仪平滑继承。最常用的方法是"指令渐变的双模态跟踪"：在过渡窗口内，舵指令按加权平均从姿态驾驶仪的输出渐变到过载驾驶仪的输出，权重随时间线性过渡。
图注：本图展示无扰切换的三阶段过程。蓝色为切换前状态（两驾驶仪并行），橙色为渐变窗口（加权混合），绿色为切换后状态（纯过载）。红色虚线标注了差异大（切换前危险状态）和差异缩小（渐变目标）。关键节点为：加权混合（核心机制）、权重渐变（时间过程）、无扰切换（工程目标）。
常见误解：很多人会误以为切换逻辑只是软件层面的"if-else"，实际上无扰切换是飞行控制系统的关键安全特性。粗暴切换可能导致舵机速率饱和、弹体结构载荷超限，甚至诱发失稳。
procedure ModeSwitch(att_delta, acc_delta, V, V_threshold);
var alpha, delta_out : real;
var mode : integer;
begin
// 对应图 4-2-5：模式判定
if V < V_threshold then
mode := 1; // mode=1: 姿态模式 [1, 1]
delta_out := att_delta; // 纯姿态舵令
else if V > V_threshold + delta_V then
mode := 2; // mode=2: 过载模式 [1, 1]
delta_out := acc_delta; // 纯过载舵令
else
mode := 3; // mode=3: 渐变窗口 [1, 1]
alpha := (V - V_threshold) / delta_V; // alpha: 渐变权重 [0, 1]
// 此时 alpha 随速度线性增长
delta_out := (1 - alpha) * att_delta + alpha * acc_delta;
// 加权混合 [1, 1]
end;
return delta_out;
end;
图码对应：伪代码中的模式判定、渐变权重计算、加权混合三个步骤，对应图 4-2-5 渐变窗口子图中的逻辑节点。
认知检查点：姿态与过载驾驶仪的切换不是二选一，而是"根据飞行阶段动态选配"。发射段姿态主导，中段过载主导，巡航段可回切姿态。切换时必须保证无扰过渡，否则舵机冲击会毁掉所有控制努力。
4.2.6 完整三层架构总览与闭环
4.2.6.1 完整三层架构总览图
图注：本图为姿态/过载驾驶仪融合的完整三层架构总览。黄色为任务层（三种指令来源），橙色为模式切换层（无扰过渡），蓝色为驾驶仪层（双外环+共享内环+舵机），紫色为弹体层（三轴运动），绿色为传感器层（惯导+陀螺+加速度计）。实线为数据流。关键节点为：无扰切换逻辑（任务层核心）、双外环并联（驾驶仪层特征）、共享角速度中环（资源复用）、惯导姿态（姿态外环专属传感器）。
4.2.6.2 接口对接图：姿态与过载驾驶仪的并联接口
图注：本图为姿态与过载驾驶仪并联后的接口对接图。蓝色为姿态驾驶仪模块，紫色为过载驾驶仪模块，橙色为切换器模块，绿色为执行层模块。关键节点为：双舵令输入（切换器接收端）、渐变权重（切换核心算法）、单舵令输出（切换器发送端）、舵机（共享执行瓶颈）。
4.2.6.3 瓶颈热力图：姿态-过载融合系统的资源争夺
图注：本图为瓶颈热力图，展示姿态-过载融合系统的性能死锁。蓝色粗线为主路径：任务→切换→驾驶仪→舵机→弹体。红色粗边框节点为瓶颈：舵机频带（执行天花板）、惯导更新率（姿态外环信息瓶颈）、传感器噪声（限制外环增益）。虚线表示依赖关系。关键节点为：舵机带宽（硬件不可突破）、惯导更新率（姿态控制特有瓶颈）。
4.2.6.4 这在实际使用中意味着什么
在实际使用中，第四章第二节的内容意味着：姿态驾驶仪不是过载驾驶仪的"降级版"，而是导弹全生命周期中不可或缺的"另一套控制语言"。发射段它负责生存——没有姿态稳定，导弹离轨就会翻滚失控；巡航段它负责节能——保持水平姿态比频繁机动更省能量；BTT段它负责协调——滚转通道的姿态控制决定了俯仰/偏航舵面的有效投影。
从训练角度看，掌握这一节的关键是建立"角度 vs 加速度"的物理直觉：姿态驾驶仪的被控量是弹体指向，其外环传感器是惯导，其被控对象包含双重积分；过载驾驶仪的被控量是速度方向变化率，其外环传感器是加速度计，其被控对象是二阶振荡。两套系统共享角速度内环和舵机，但在外环层面完全独立。
工程设计的最终交付物不是单一驾驶仪，而是一个"双模态控制律"：包含姿态模式、过载模式、渐变切换逻辑、无扰过渡机制。只有在全包线仿真中验证过两种模式的所有切换组合，才能进入飞行试验。
134
扫一扫
被折叠的 条评论
为什么被折叠?
到【灌水乐园】发言
