2. 导航基础回顾

地形匹配导航并非孤立工作的定位手段，它本质上是一种基于环境特征的地理位置修正技术。要理解地形匹配系统如何设计、为何需要滤波融合、以及在不同飞行阶段如何切换导航源，首先必须对参与组合导航的各传感器有清晰认知。本章聚焦于惯性导航系统（INS）、全球卫星导航系统（GNSS）、气压高度计和雷达高度计四类核心传感器，逐一剖析其工作原理、误差演化规律，并重点阐述它们与地形匹配算法之间的互补逻辑。只有深刻理解每种传感器的“长处”与“短板”，才能在系统设计中合理分配权重、设计量测方程、设置故障检测阈值。

2.1 惯性导航系统（INS）：高更新率的航迹推算核心

2.1.1 核心原理

惯性导航是一种完全自主的导航方式，不依赖任何外部信息。其核心基于牛顿力学：通过安装在载体上的三轴加速度计测量比力（Specific Force），通过三轴陀螺仪测量角速度。系统对加速度进行两次积分获得速度和位置增量，对角速度积分获得姿态角。在捷联式惯导（SINS）中，加速度计和陀螺仪直接固连于载体，通过姿态矩阵将机体坐标系下的加速度转换到导航坐标系（通常为当地水平坐标系或ECEF系），再进行积分运算。

惯导系统的输出频率通常为100Hz~1000Hz，能够提供连续、平滑的位置、速度和姿态信息，且短期精度极高。在GNSS失效或地形匹配不可用的数秒至数分钟内，惯导是唯一能维持导航连续性的传感器。

2.1.2 误差特性与传播规律

惯导误差是随时间累积的，这是其最核心的缺陷。主要误差源包括：

• 陀螺漂移：引起姿态误差，进而导致加速度分解错误，产生位置误差的二次积分增长。典型MEMS陀螺零偏稳定性为1°/h~10°/h，光纤陀螺为0.01°/h~0.1°/h。
• 加速度计零偏：直接引起速度误差的一次积分增长和位置误差的二次积分增长。
• 初始对准误差：初始姿态误差会以舒勒周期（84.4分钟）振荡，但振荡幅值不衰减。
• 标度因数误差与安装误差：在高动态环境下被激发，产生与机动相关的误差。

从误差传播方程看，位置误差中与陀螺漂移相关的分量随时间的三次方增长（δp ∝ ε·t³/6），与加速度计零偏相关的分量随时间二次方增长（δp ∝ ∇·t²/2）。这意味着飞行10分钟后，中等精度惯导的位置误差可能达到数百米甚至数公里。

2.1.3 与地形匹配的互补关系

惯导为地形匹配提供航迹推算轨迹。地形匹配算法（如TERCOM或ICCP）需要将雷达高度计测得的地形剖面与数字高程模型（DEM）进行相关匹配，而匹配的搜索范围取决于惯导位置误差的估计值。惯导误差越小，搜索范围越小，匹配速度越快、误匹配概率越低。反过来，地形匹配成功后给出的位置修正量又用于估计惯导的漂移参数（如陀螺漂移、加速度计零偏），实现惯性器件的在线标定。

2.2 卫星导航（GNSS）：定位的“金标准”与脆弱性

2.2.1 核心原理

GNSS通过接收至少4颗卫星的测距信号，利用伪距或载波相位测量值解算接收机位置。每颗卫星广播其星历参数和时钟信息，接收机测量信号传播时间，乘以光速得到伪距。由于接收机时钟与卫星时钟存在偏差，需要至少4颗卫星联立方程求解三维位置和钟差。现代GNSS接收机支持GPS、BDS、GLONASS、Galileo多系统融合，单点定位精度可达1~3米（水平），RTK/PPP技术可实现厘米级精度。

2.2.2 误差特性与脆弱性

GNSS误差源可分为三类：

更关键的是GNSS的可用性风险：信号遮挡（山谷、城市峡谷）、故意干扰（压制式干扰、欺骗式干扰）、电离层闪烁等都可能造成定位中断或输出错误位置。在军事应用中，GNSS被视为“不可完全信赖”的导航源。

2.2.3 与地形匹配的互补关系

GNSS与地形匹配是互为备份的关系。在GNSS可用时，其位置精度远高于地形匹配（地形匹配精度通常为几十米），因此组合导航系统以GNSS为主修正源，地形匹配作为辅助验证或故障检测参考。当GNSS因干扰失效时，地形匹配立即接管成为唯一的位置修正手段。设计上需要实现无扰切换：滤波器需在GNSS信号丢失前预判并平滑过渡到地形匹配模式。

2.3 气压高度计：稳定但滞后的垂直参考

2.3.1 核心原理

气压高度计通过测量大气静压，利用标准大气模型（ISA）换算气压高度。其关系由压高公式描述：

H = (T0 / L) × [1 - (P / P0)^(L·R / g)]

其中T0为海平面标准温度（288.15K），L为温度递减率（-0.0065 K/m），P0为海平面标准气压（1013.25 hPa），R为气体常数，g为重力加速度。实际使用中，需要根据机场场面气压（QNH）或标准气压（QNE）进行修正。

2.3.2 误差特性

• 静压孔位置误差：机身周围气流扰动导致测量静压偏离真实静压，与攻角、侧滑角相关，误差可达数十米。
• 温度偏差：实际大气温度偏离ISA模型时产生误差，极端寒冷天气下误差可达100米以上。
• 气压系统变化：天气系统移动导致海平面气压变化，若不及时修正QNH，会产生缓慢漂移。
• 动态滞后：气压高度计响应速度慢，在快速爬升/下降时存在滞后误差。

但气压高度计有一个显著优点：长期稳定性好，不存在积分漂移。在数小时飞行中，其误差通常保持在几十米量级，远优于惯导高度通道的漂移。

2.3.3 与地形匹配的互补关系

地形匹配需要将雷达高度计测得的离地高度与DEM地形高程结合，得到海拔高度。但雷达高度计测量的是载体到地面的垂直距离，要获得高度必须知道地形高程。此时，气压高度计提供的海拔高度可作为先验参考，用于约束地形匹配的搜索范围。具体而言，在匹配前，用气压高度减去雷达高度得到粗略的地形高程估计，与DEM中该位置的高程进行粗匹配，缩小搜索区域。此外，在无地形特征的平坦区域（如水面、沙漠），地形匹配失效，此时气压高度计是唯一的高度参考。

2.4 雷达高度计：地形匹配的直接量测传感器

2.4.1 核心原理

雷达高度计（Radio Altimeter）向地面发射无线电脉冲（通常为4.3GHz或更高频率），测量信号从发射到经地面反射被接收的时间延迟，乘以光速的一半即为离地高度。现代雷达高度计采用调频连续波（FMCW）或脉冲体制，测高精度可达0.5~2米。其测量的是天线相位中心到地面反射点的垂直距离，而非到海平面或参考椭球的距离。

2.4.2 误差特性与地形匹配的特殊考量

2.4.3 与地形匹配的互补关系

雷达高度计是地形匹配系统的核心量测传感器。飞行器沿预定航线飞行时，雷达高度计连续输出离地高度序列，与惯导推算的水平位置结合，形成一条“地形剖面”。地形匹配算法将该剖面与DEM中候选位置的地形剖面进行相关计算，找到相关性最高的位置作为修正后的位置估计。因此，雷达高度计的精度和采样率直接影响匹配精度。典型设计参数：采样率1~10Hz，测高精度优于2米，波束宽度小于10°。

2.5 多传感器融合架构与设计要点

2.5.1 典型融合架构

在工程实践中，地形匹配导航系统通常采用松耦合或紧耦合架构。松耦合架构中，各传感器独立输出导航解，由卡尔曼滤波器进行最优加权融合；紧耦合架构中，原始量测（如雷达高度计的原始回波、GNSS伪距）直接进入滤波器。对于地形匹配，更常见的是松耦合：地形匹配模块作为独立的位置修正源，输出位置修正量及其协方差，注入主滤波器。

2.5.2 传感器互补性总结

2.5.3 案例拆解：某型无人机地形匹配辅助导航系统设计

背景与约束：某中空长航时无人机执行山区侦察任务，飞行高度3000米（AGL），航程800公里，要求导航精度（CEP）优于50米。任务区域存在强电磁干扰，GNSS可能间歇性失效。平台搭载：MEMS级INS（陀螺零偏3°/h）、双频GNSS接收机、气压高度计（精度±30米）、雷达高度计（精度±1.5米，波束宽度8°）。

初始现象与问题：在GNSS失效的30分钟测试飞行中，纯惯导位置误差漂移至约1.2公里（CEP），远超任务要求。需要设计地形匹配辅助方案，将误差控制在50米以内。

关键输入数据：DEM分辨率30米（SRTM数据），地形标准差在山区约80米，在丘陵约25米，在平原约5米。雷达高度计采样率5Hz，惯导输出200Hz。

分析判断过程：

1. 根据惯导误差模型，30分钟内位置误差约1.2公里，因此地形匹配搜索范围需覆盖±1.5公里（含3σ余量）。
2. DEM分辨率30米，匹配精度理论上可达30米量级，满足50米CEP要求。
3. 但需评估地形特征：航线上约40%为山区（特征明显），30%为丘陵（特征中等），30%为平原（特征不足）。
4. 在平原区域，地形匹配不可用，需依靠惯导+气压高度计维持，误差会累积但可通过后续山区匹配修正。

实际操作步骤：

• 将航线分段，每段长度5公里，作为一次匹配的航迹段。
• 在每段内，采集雷达高度计序列（5Hz×25秒=125个点），结合惯导水平位置和气压高度，生成地形剖面。
• 在DEM中，以惯导推算位置为中心，在±1.5公里范围内滑动搜索，计算相关系数（归一化互相关）。
• 取相关系数最大值对应的位置作为匹配结果，并计算匹配置信度（峰值与次峰值之比）。
• 将匹配结果作为位置量测注入卡尔曼滤波器，估计并修正惯导位置误差和陀螺漂移。

结果对比：仿真和试飞数据表明，在山区段匹配精度达到25米（CEP），丘陵段约40米，平原段匹配失败但惯导漂移在后续山区段被有效修正。全程导航精度（含GNSS失效时段）为42米（CEP），满足50米要求。

风险与代价：匹配失败率在平原段高达30%，需设置合理的置信度阈值避免误匹配。误匹配可能导致位置修正错误，因此系统设计了“匹配结果合理性检查”——若匹配位置与惯导推算位置偏差超过2公里，或置信度低于1.5，则拒绝该次匹配结果。

复盘经验：地形匹配系统的设计必须基于实际地形统计特性，不能假设全程都有良好特征。建议在任务规划阶段利用DEM预计算航线的“地形可匹配性指数”，动态调整匹配策略。

2.6 常见误区与设计总结