《Biomimetics》：Topology-Consistent Trajectory Event Matching for GNSS-Denied Vehicle Initial Localization
编辑推荐：
全球导航卫星系统（GNSS）拒止条件下的车辆初始定位仍具挑战性，因为里程计轨迹提供相对运动信息却缺乏绝对道路网络参考。受生物导航中自运动信息、可识别路径线索和路径连续性的协同运用启发，本文提出一种拓扑一致的轨迹事件匹配方法。该方法将里程计组织为由相邻正常转弯事
全球导航卫星系统（GNSS）拒止条件下的车辆初始定位仍具挑战性，因为里程计轨迹提供相对运动信息却缺乏绝对道路网络参考。受生物导航中自运动信息、可识别路径线索和路径连续性的协同运用启发，本文提出一种拓扑一致的轨迹事件匹配方法。该方法将里程计组织为由相邻正常转弯事件及其间走廊构成的序贯轨迹结构对，同时自动增强标准道路网络地图中的内部方向变化点以构建对应地图侧结构。依据方向、长度、转弯和走廊形态一致性检索局部候选，并在拓扑连续性下联合确认连续候选。随后通过局部轨迹图像配准优化已确认的离散对应关系，以估计连续起始位置。在KITTI-360序列00、08和09上的135个起始位置实验中，整体初始化成功率达到88.9%；成功试验的平均误差为2.46米，中位误差为2.29米。结果表明该方法在所评估的道路场景中表现一致，同时也指出稀疏转弯事件和局部歧义道路结构仍是重要的限制条件。
一、研究背景与问题
在全球导航卫星系统（GNSS）信号易受城市峡谷、隧道、林荫道及电磁干扰等环境影响而发生退化或中断的背景下，车辆依赖里程计提供的短期相对运动信息虽能维持连续轨迹，但由于其表达于局部坐标系，无法直接确定车辆在道路网络中的绝对起始位置。因此，仅利用初始化阶段的里程计轨迹和区域道路网络地图来恢复地图参考下的起始位置，成为GNSS拒止条件下定位的关键难题。现有方法多依赖视觉、激光雷达、高精地图或语义地标等多传感器融合，虽精度较高但对额外传感器或预建环境模型依赖较强，而标准道路网络地图因其广泛可用性和低成本优势，可作为低成本的初始定位环境参考。然而，传统基于道路网络的定位方法面临两大局限：一是标准折线式道路地图主要表达交叉口和端点，未能充分表示沿路内部方向变化和连续曲率结构；二是单个转弯点、线段或短轨迹片段仅提供局部几何证据，在规则网格、密集交叉口或重复局部模式区域判别力有限。为此，研究人员提出一种受生物导航启发的拓扑一致性轨迹事件匹配方法，旨在解决上述问题。
二、研究内容与结论
研究人员提出了一种拓扑一致的轨迹事件匹配方法，用于GNSS拒止条件下的车辆初始定位。该方法从生物导航中自运动信息、可识别路径线索和路线连续性的协同运用中获得启发，将里程计轨迹组织为由相邻正常转弯事件及其间走廊构成的序贯轨迹结构对，并通过对标准道路网络地图自动增强内部方向变化点来构建对应地图侧结构。通过方向、长度、转弯关系和走廊形态一致性进行局部候选检索，并在拓扑连续性约束下确认连续候选链，最终通过局部轨迹图像配准实现连续起始位置的估计。实验在KITTI-360序列00、08和09上进行，共测试135个起始位置，整体初始化成功率达88.9%，成功试验的平均误差为2.46米，中位误差为2.29米。研究表明，该方法在多种道路场景中表现稳定，同时指出稀疏转弯事件和局部歧义道路结构仍是重要限制因素。这一工作为低成本、无GNSS环境下的车辆定位提供了新的技术路径，具有重要的工程应用价值和理论参考意义。
三、关键技术方法
为开展研究，研究人员采用了以下关键技术方法：
- 1.
地图拓扑增强：将标准道路网络地图转换为局部坐标系，通过节点分类（交叉口节点、端点节点、内部弯曲节点和普通形状节点）和阈值判定，将超过弯曲阈值的度2节点提升为内部转向点，并结合虚拟节点形成增强拓扑点集，进而拓扑收缩构建有向拓扑边集，同时识别连续曲率边以支持后续走廊形态评价。
- 2.
轨迹事件提取与结构对构建：对惯性里程计轨迹预处理后，在距离域计算方向变化响应并提取活跃区间，合并空间相邻活跃区间得到稳定方向变化候选段，据此划分直线段、连续曲率段、正常转弯事件和U型转弯事件；仅相邻正常转弯事件及其间走廊构成轨迹结构对，并提取进入方向、中间走廊方向、离开方向、中间走廊长度及内部形态特征（包括前后局部方向、累积绝对转角、累积有符号转角、平均曲率、航向波动和航向范围）。
- 3.
拓扑一致性初始定位：首先基于增强地图构建与轨迹结构对对应的地图侧候选拓扑结构对，并从方向、长度、局部转弯关系和中间走廊内部形态四个方面评估一致性；其次采用束搜索策略连接满足拓扑连续性约束（共享终止拓扑点或允许单次桥接缺失）的候选形成候选链，并以综合得分（结合局部匹配得分与缺失/桥接惩罚）选出最优链；最后在首个确认结构附近生成局部地图图像和轨迹图像，通过平移搜索实现连续位置校正。
四、研究结果
4.1 整体初始化结果
代表性初始化结果显示，蓝色曲线为里程计轨迹，红色折线为确认的地图侧候选链，红色叉号为经局部轨迹图像配准后的估计起始位置。在KITTI-360序列00、08和09的代表性起点上，该方法平均误差为1.95米。
4.2 不同起始点的鲁棒性
在三个序列各45个系统采样起始位置（共135个试验）中，序列00、08和09分别成功38/45、41/45和41/45，整体成功率为88.9%。整体SR@5 m（误差≤5米的成功率）为85.2%。成功试验中，序列00、08和09的平均误差分别为3.01米、2.25米和2.15米，中位误差分别为2.88米、2.22米和2.01米，标准差分别为0.90米、0.63米和0.92米。成功试验所需平均结构对数为5.47、4.20和4.63，平均确认裕度为14.48、30.37和28.77。失败试验集中于长直或稀疏事件区域以及竞争候选链区分度弱的场景。
4.3 候选检索有效性与计算成本
前八个有效轨迹结构对的Top-N命中率显示，序列00和09在N=5时达到1.0，序列08在N=10时达到1.0，整体在N=10时达到1.0。在线初始化平均运行时间从1×1 km地图的3.28秒增至4×4 km地图的29.80秒，其中候选检索从0.77秒升至8.73秒，候选链确认从1.80秒升至20.36秒为主要耗时环节。
4.4 消融研究
移除地图侧内部方向变化增强后，仅在序列00成功，在序列08和09均失败。单转弯事件变体导致序列00和09超时。无链确认变体在所有序列均失败。无局部轨迹图像配准变体虽保留拓扑对应但平均误差增至7.77米。完整方法在代表性设置下以平均误差1.95米成功处理所有三个序列。
五、讨论与结论
讨论部分指出，初始化性能主要受益于三个关联操作：将自运动表示为有序局部路径结构、保留多个合理局部对应、并通过路径级拓扑确认它们。序列00因正常转弯证据更稀疏且规则网格歧义更强，表现为最低多起点成功率（84.4%）、最大平均所需轨迹长度（1.91公里）和最小成功试验确认裕度（14.48）。序列08从内部方向变化增强中显著获益，成功率达91.1%，平均确认裕度为30.37。序列09转弯事件更丰富但仍存在局部重复结构，成功率为91.1%，平均确认裕度为28.77。该方法仍有若干适用边界：需足够正常转弯事件；输入地图的严重遗漏、错误连接或错误拓扑关系会阻止正确候选生成；里程计的航向漂移或形状畸变会影响候选检索和局部配准。未来工作将聚焦于层次化候选索引、并行链扩展、对地图和里程计误差的鲁棒性以及稀疏事件条件下的确认。
结论部分翻译如下：受生物导航中自运动信息、可识别路径线索和路线连续性的协同运用启发，本文提出一种拓扑一致的轨迹事件匹配方法，用于GNSS拒止车辆初始定位。通过从相邻正常转弯事件构建轨迹结构对并从自动增强的标准道路网络输入生成相应候选，该方法将初始里程计轨迹通过局部结构匹配、候选链确认和仅平移的局部配准转化为地图参考起始位置。在三个KITTI-360序列中各45个系统采样起始位置上，该方法实现整体初始化成功率88.9%。成功试验的平均误差为2.46米，中位误差为2.29米，整体SR@5 m为85.2%。这些结果显示了在所评估道路场景中对起始位置变化的鲁棒性。在稀疏事件或局部歧义路段中较低的成功率和更长的所需观测距离表明这些条件仍是主要的限制情况。消融结果进一步证明了轨迹结构对、地图侧内部方向变化增强和候选链确认的重要性。当前方法依赖于足够的正常转弯事件、可靠的道路网络拓扑以及初始化期间稳定的绝对航向。因此，未来工作将考察更广泛的道路网络、地图和里程计扰动、稀疏事件场景以及更高效的候选索引。
