第三节 制导与导航概念区分：导航（状态估计）、制导（指令生成）、控制（执行跟踪）的闭环关系
在火箭飞行控制系统中，“导航”“制导”“控制”三个术语经常被混用，但在工程实践中，它们分别对应着完全不同的功能模块、算法逻辑和接口协议。导航解决的是“我现在在哪里、飞得多快、姿态如何”的问题；制导解决的是“为了到达目标，我下一步应该朝哪个方向飞、加速还是减速”的问题；控制解决的是“如何让执行机构（如舵机、喷管、姿控发动机）精确地执行制导指令”的问题。三者构成一个典型的闭环反馈系统，任何一个环节的延迟、噪声或模型误差都会沿闭环传播，最终影响落点精度。本节将深入拆解三者的边界、接口关系以及工程实现中的关键细节。
上图展示了火箭飞行控制系统的核心闭环架构。导航模块位于最左侧，接收惯性测量单元（IMU）、卫星导航（GNSS）等传感器的原始数据，通过捷联惯导解算和卡尔曼滤波融合，输出高更新率的飞行状态估计。制导模块位于中间，它并不直接操作执行机构，而是根据导航提供的状态量和预先装订的目标参数，计算出一条满足约束的参考轨迹，并生成制导指令——通常表示为期望过载或程序角。控制模块位于最右侧，它接收制导指令，结合姿态反馈，通过控制律解算出舵偏角或喷管摆角指令，驱动执行机构产生实际的控制力矩。值得注意的是，控制模块的执行结果（如实际舵偏角、发动机摆角）会通过遥测或内部总线反馈给导航模块，用于补偿动力学模型误差，从而形成完整的闭环。
3.1 核心原理：三模块的功能边界与信息流
导航、制导、控制三者的功能边界可以这样理解：导航是“感知层”，它只负责回答“系统现在处于什么状态”，不关心目标在哪里；制导是“决策层”，它根据导航状态和目标约束，回答“为了到达目标，系统需要什么样的加速度或姿态”；控制是“执行层”，它回答“如何让执行机构产生这个加速度或姿态”。这种分层设计的好处在于：每一层都可以独立设计、测试和优化。例如，导航算法可以在地面仿真中单独验证，制导律可以先用理想导航状态测试，控制律则可以在硬件在环（HIL）仿真中单独调试。
从信息流的角度看，导航模块的输出是制导模块的输入，制导模块的输出是控制模块的输入，而控制模块的执行结果又反过来影响导航模块的测量值。这个闭环中，各模块的更新率差异很大：导航通常以100Hz~1000Hz的频率输出状态估计，制导以10Hz~50Hz的频率生成指令，控制则以200Hz~2000Hz的频率驱动执行机构。这种频率不匹配需要通过接口设计来解决，例如制导指令在两次更新之间需要保持或插值，控制模块需要缓存最新的制导指令。
3.2 判断方法：如何区分一个算法属于导航、制导还是控制
在实际工程中，工程师经常需要判断某个算法模块应该归属于哪个功能域。这里提供一个实用的判断流程：
- 看输入输出：如果输入是传感器原始数据（加速度计、陀螺、GNSS伪距），输出是飞行状态（位置、速度、姿态），则属于导航；如果输入是飞行状态和目标参数，输出是期望过载或程序角，则属于制导；如果输入是期望过载和姿态反馈，输出是舵偏角或阀门指令，则属于控制。
- 看时间尺度：导航需要处理高频噪声，更新率最高；制导关注秒级甚至分钟级的轨迹优化，更新率较低；控制需要快速响应扰动，更新率介于两者之间或更高。
- 看误差来源：导航误差主要来自传感器漂移和初始对准误差；制导误差主要来自模型偏差（如气动系数不准）和目标参数偏差；控制误差主要来自执行机构延迟和饱和非线性。
- 看设计目标：导航的目标是“估计误差最小化”，通常用均方根误差（RMSE）衡量；制导的目标是“终端脱靶量最小化”，通常用落点精度CEP衡量；控制的目标是“跟踪误差最小化”，通常用超调量和调节时间衡量。
| 维度 | 导航（状态估计） | 制导（指令生成） | 控制（执行跟踪） |
|---|---|---|---|
| 核心问题 | 我在哪里？ | 我该往哪飞？ | 如何执行指令？ |
| 典型算法 | 捷联惯导、卡尔曼滤波、组合导航 | 摄动制导、迭代制导、重力转弯 | PID、自抗扰控制、滑模控制 |
| 输入信号 | IMU原始数据、GNSS、星敏 | 导航状态、目标轨道、约束条件 | 制导指令、姿态角、角速度 |
| 输出信号 | 位置、速度、姿态四元数、角速度 | 期望过载、程序角、推力方向 | 舵偏角、喷管摆角、阀门开度 |
| 更新率 | 100Hz~1000Hz | 10Hz~50Hz | 200Hz~2000Hz |
| 误差度量 | 状态估计RMSE | 终端脱靶量/落点CEP | 跟踪误差/超调量 |
| 设计难点 | 传感器噪声、初始对准 | 模型偏差、约束处理 | 执行机构饱和、延迟 |
3.3 案例拆解：某型运载火箭二级飞行段的闭环工作过程
为了更直观地理解三者的协作关系，我们以某型运载火箭二级飞行段为例进行拆解。该火箭二级飞行段的目标是将有效载荷送入预定轨道，入轨精度要求为：半长轴误差±5km，偏心率误差±0.002，轨道倾角误差±0.1°。
背景与约束：二级飞行段采用液氧煤油发动机，推力为300kN，比冲为320s。飞行过程中，发动机推力存在±2%的偏差，气动系数存在±5%的不确定性。导航系统采用激光陀螺捷联惯导+GNSS组合导航，IMU更新率为200Hz，GNSS更新率为1Hz。制导系统采用迭代制导算法，更新率为20Hz。控制系统采用PID+前馈控制，更新率为500Hz。
初始现象与目标：火箭在二级点火时刻的导航状态为：位置（东经110.2°，北纬34.5°，高度78km），速度（5.2km/s，轨道倾角28.5°），姿态角（俯仰角-12°，偏航角0.5°，滚转角0°）。目标轨道为：近地点高度200km，远地点高度360km，轨道倾角28.5°。
关键输入数据与参数：导航模块输出的状态向量包含位置（3维）、速度（3维）、姿态四元数（4维）、角速度（3维），共13维状态量。制导模块接收这些状态量后，结合目标轨道参数，通过迭代制导算法计算当前需要的期望过载指令。迭代制导的核心思想是：将剩余飞行时间内的轨迹优化问题转化为一个两点边值问题，通过迭代求解最优推力方向。
分析判断过程：在二级飞行段第50秒，导航模块检测到实际速度比标称速度低15m/s，这可能是由于发动机推力偏差或气动阻力大于预期。制导模块接收到这个偏差后，通过迭代制导算法重新计算了期望过载指令，将俯仰方向的过载指令从0.8g调整为0.85g，以补偿速度损失。控制模块接收到新的过载指令后，通过PID控制律计算出对应的发动机摆动角指令，从原来的2.3°调整为2.8°。整个调整过程在100ms内完成，没有引起姿态振荡。
实际操作步骤：在飞行软件中，这个过程对应以下步骤：①导航任务在T+50.000s时刻完成状态更新，将状态向量写入共享内存；②制导任务在T+50.050s时刻读取状态向量，运行迭代制导算法，生成新的过载指令；③控制任务在T+50.052s时刻读取过载指令，结合当前姿态反馈，计算舵偏角指令；④执行机构在T+50.060s时刻响应舵偏角指令，产生实际的控制力矩。
结果对比：最终，该火箭二级飞行段在关机时刻的实际状态为：位置误差（-2.3km，+1.8km，+0.5km），速度误差（+3.2m/s，-2.1m/s，+0.8m/s），入轨精度满足要求。与未进行制导修正的方案相比，入轨精度提高了约60%。
风险与代价：迭代制导算法虽然精度高，但计算量较大，需要高性能的飞行计算机。同时，迭代制导对导航状态误差敏感，如果导航状态存在较大偏差，可能导致制导指令发散。因此，在实际工程中，需要设置制导指令的限幅和滤波，防止异常指令传递到控制模块。
3.4 常见误区与总结复盘
在理解导航、制导、控制的关系时，初学者常犯以下错误：
- 误区一：将导航和制导混为一谈。有些教材将“制导”定义为“引导飞行器到目标的过程”，这包含了导航功能。但在工程实现中，导航和制导是独立的软件模块，有各自的接口和测试标准。混淆两者会导致接口设计混乱。
- 误区二：认为制导指令可以直接驱动执行机构。实际上，制导指令通常是期望过载或程序角，需要经过控制律解算才能转换为舵偏角。跳过控制模块直接驱动执行机构，会导致姿态失稳。
- 误区三：忽略时间同步问题。导航、制导、控制运行在不同频率下，如果时间戳不对齐，会导致指令滞后。例如，制导模块使用了50ms前的导航数据，而控制模块又使用了20ms前的制导指令，累积延迟可能导致系统不稳定。
- 误区四：认为导航精度越高越好。实际上，导航精度需要与制导和控制能力匹配。过高的导航精度意味着更高的传感器成本和计算开销，而制导和控制环节的误差可能成为新的瓶颈。
总结复盘：导航、制导、控制三者构成一个完整的闭环系统，其核心设计原则是“分层解耦、接口明确、时间对齐”。导航提供准确的状态估计，制导生成合理的指令，控制实现精确的跟踪。在实际工程中，需要重点关注三个接口：导航→制导的状态传递接口（需定义坐标系、时间戳、数据格式）、制导→控制的指令接口（需定义指令类型、限幅范围、更新率）、控制→导航的反馈接口（需定义反馈信号、滤波方式）。只有这三个接口设计清晰，整个闭环系统才能稳定可靠地工作。