2. 地形辅助导航系统组成与工作流程

地形辅助导航（Terrain Aided Navigation，TAN）并不是一个单独的传感器，而是一套把“测高信息”与“先验地形”结合起来的定位系统。要理解它的工作方式，最有效的切入点是先看清系统由哪些部分组成、各部分之间传递什么数据，再沿着一次完整的定位更新过程走一遍。本节围绕传感器配置、地形数据库、匹配定位模块、滤波器融合结构和实时性约束五个方面展开。

一、系统由哪几块构成

典型的 TAN 系统可以划分为四个功能块：传感器组、地形数据库、匹配定位模块和融合滤波器。传感器组提供载体自身的运动与高度观测；地形数据库提供载体所在区域的高程先验；匹配定位模块把实时测高剖面与数据库剖面比对，给出位置修正量；融合滤波器则把匹配结果与惯导（INS）或航位推算结果综合，输出连续、平滑的导航解。

传感器配置上，核心是测高传感器与参考高度源。前者常用单波束/多波束测深仪（水下 AUV 场景）或雷达高度表（空中场景），用于测量载体到海底/地面的相对高度；后者提供载体绝对高度或深度基准，例如压力深度计、气压高度表或 GNSS 高度（水面/近水面时可用）。二者相减得到“载体下方地形高程”的观测值。此外还需要 INS 提供姿态、速度和位置推算，姿态精度直接影响测高点投影到地理坐标的准确性——俯仰角 1° 的误差在 100 m 高度上就可能带来约 1.7 m 的水平投影偏差，因此姿态与测高必须时间对齐。

二、地形数据库与匹配定位模块

地形数据库通常以规则格网（DEM）形式存储，每个格网节点记录高程值，并附带分辨率、基准面、精度等元数据。分辨率决定了可分辨的地形特征尺度：若格网间距为 30 m，则小于该尺度的地形起伏无法被可靠表达，匹配时容易产生多峰模糊。数据库还需明确高程基准（如平均海平面、当地深度基准面），否则测高值与数据库值之间会存在系统性偏差，直接表现为定位结果整体偏移。

匹配定位模块的工作是：把一段时间内采集的测高序列，按 INS 推算的航迹投影成一条“实测地形剖面”，再在数据库中以不同平移量滑动比对，寻找相关性最高或均方误差最小的位置。常用度量包括平均绝对差（MAD）、均方误差（MSE）和归一化相关。匹配成功的前提是航迹段内地形的起伏足够丰富——平坦海底或均匀斜坡上，多个平移量都能得到相近的匹配得分，此时匹配结果不可信，模块应输出“低置信度”而非强行给出位置。

三、滤波器融合结构

匹配模块给出的位置修正量不能直接“覆盖”惯导输出，否则航迹会出现跳变，且无法处理匹配错误。工程上普遍采用卡尔曼滤波作为融合框架：以 INS 误差状态（位置误差、速度误差、姿态误差、陀螺与加速度计零偏）为状态量，以“匹配位置与推算位置之差”作为量测。滤波器的预测步由 INS 力学编排完成，更新步在匹配结果到达时执行。

这种结构的关键在于量测噪声矩阵 R 的设置。匹配置信度高时，R 取小值，滤波器更多信任匹配结果；置信度低或地形平坦时，R 取大值，滤波器主要依赖惯导推算，避免被错误匹配拉偏。一个常见的教学示例是：设匹配水平误差标准差为 15 m、惯导 60 s 推算位置标准差为 40 m，则滤波增益约为 40²/(40²+15²)≈0.88，即修正量的大部分被采纳；若匹配标准差升至 80 m，增益降至约 0.2，系统自动转为保守修正。这一机制使 TAN 在“有特征地形时修正、无特征时平滑过渡”之间取得平衡。

四、实时性约束与工作流程

TAN 的计算负担主要来自匹配搜索。若在整幅数据库上做全范围滑动比对，计算量随区域面积线性增长，难以满足 AUV 的实时要求。实际做法是：以惯导推算位置为中心，按当前不确定度（例如 3σ 圆）限定搜索范围，只在该子区域内比对；同时控制匹配窗口长度，窗口太短则地形特征不足、易多峰，太长则修正滞后。工程上常取数十秒的观测窗口、1 Hz 左右的更新率，使单次匹配计算量控制在毫秒到数十毫秒量级。

把上述环节串起来，一次完整的 TAN 更新流程是：传感器同步采集测高与姿态数据 → 按姿态把测高值投影为地理坐标下的地形高程 → 结合惯导航迹构建实测剖面 → 在限定搜索范围内与 DEM 比对，得到位置修正量与置信度 → 以该修正量为量测执行卡尔曼更新 → 输出修正后的导航解并反馈给下一周期。整个闭环中，时间对齐、基准面一致、置信度判据是三个最容易出问题的环节，也是实际调试时应优先核查的对象。