RACIF-SLAM:面向近海岸连续定位与分层占据栅格建图的可靠性感知冲突门控激光雷达与W波段雷达融合框架

《Journal of Marine Science and Engineering》:RACIF-SLAM: Reliability-Aware Conflict-Gated LiDAR and W-Band Radar Fusion for Continuous Near-Coastal Localization and Hierarchical Occupancy Mapping

【字体: 大 中 小 】 时间:2026年09月04日 来源:Journal of Marine Science and Engineering 3.2

编辑推荐:

  可靠的近海岸定位十分困难,因为激光雷达(LiDAR)与扫描雷达在互补工况下均会失效:LiDAR可提供精确的局部几何结构,但在开阔水面上方会丧失支撑,而雷达可保持远距离观测,但受杂波、多径和低空间分辨率影响。研究人员提出RACIF-SLAM,一种可靠性感知框架,

  
可靠的近海岸定位十分困难,因为激光雷达(LiDAR)与扫描雷达在互补工况下均会失效:LiDAR可提供精确的局部几何结构,但在开阔水面上方会丧失支撑,而雷达可保持远距离观测,但受杂波、多径和低空间分辨率影响。研究人员提出RACIF-SLAM,一种可靠性感知框架,统一了连续定位与分层占据栅格建图。RACIF-SLAM将传感器本体的运动增量变换至通用船体坐标系,从配准证据推断时间滤波后的可靠性,并应用新息门控(innovation gate)在跨传感器冲突时抑制可信度较低的模态,随后在SE(2)上融合。当LiDAR跟踪崩溃时,雷达桥接维持运动估计并将恢复的LiDAR片段重新锚定,且轨迹无间断。建图方面,LiDAR保留局部占据/自由空间主导权,而空间拓宽的雷达证据将支撑扩展至LiDAR有效距离之外。在四个评估近海岸片段中,每一报告位姿均由至少一个被接受的传感器增量支撑,未调用航位推算回退。相较于同步双天线GNSS,RACIF-SLAM取得平均绝对轨迹误差(ATE)0.700 m与10帧平移相对位姿误差(RPE)0.183 m,较次优方法分别降低66.3%与65.1%。这些片段级结果表明,依赖证据的主导权转移可在保留精细局部地图结构的同时改善定位连续性。
研究背景与动机:自主水面艇在近海岸靠泊、港口通行与沿岸航行中需持续工作,但单一外感受传感器存在互补失效——LiDAR近岸几何锐利却在水面开阔处支撑退化,扫描雷达(W波段)覆盖远、抗光照与水雾但分辨率低、含多径与海杂波。已有海上LiDAR SLAM、雷达里程计(如CFEAR)及雷达-激光紧耦合研究,但未在统一可审计框架内同时解决模态可靠性量化、跨模态冲突拒绝、失效前端恢复与异构证据建图权限调节。为此研究人员在《Journal of Marine Science and Engineering》发表RACIF-SLAM,以证据依赖的主导权转移实现连续定位与分层占据建图。
主要关键技术方法:基于公开MOANA数据集四个近海岸片段(Near Port与Complex Island各两段,含同步LiDAR点云、Navtech RAS6系列W波段雷达极坐标强度图、双天线Hemisphere V500 RTK-GNSS真值),研究人员构建船体坐标系下模态专用前端(LiDAR用NDT粗配准加平面到平面ICP精配准并去水平水面面;雷达沿用CFEAR式surfel提取与多关键帧鲁棒配准),以配准接受度、点/surfel支撑、残差一致性、重叠度凸组合生成启发式可观测性代理(heuristic observability proxy);采用非对称一阶时域滤波(跌权快于升权)得到模态权威分数;在SE(2)上做可用性检查、平移/航向冲突度计算、冲突门控惩罚低分模态、归一化信息权重的切平面平移平均与航向圆平均后群上合成位姿;LiDAR长时失效由雷达桥接并用公式(13)刚体重锚恢复片段;建图端LiDAR端点占据+角度仓射线自由空间具局部权威,雷达占据证据高斯拓宽乘邻域持续性,按公式(16)分级对数胜算融合,LiDAR支撑格抑制雷达改写。
研究结果:
轨迹连续性与自适应模态使用:四片段共1763个位姿全部由至少一传感器接受增量支撑,零航位推算回退;Complex Island B雷达驱动占比升至22.5%,LiDAR重启3次无轨迹间断;相对双天线GNSS,平均ATE 0.700 m、ARE 0.068°、10帧平移RPE 0.183 m、旋转RPE 0.009°,较次优Noh-Kim法ATE与平移RPE降66.3%与65.1%。
组件消融研究:A1去可靠滤波改等权→ATE/RPE恶化;A2去冲突门控全收增量→注入错误;A3去雷达桥接LiDAR失效即弃用→重启失败;A4去层级权威改加性对数胜算→单元证据诊断显示局部雷达增益被限至0.15(原1.00),占自边缘对比0.840(原0.657,+27.8%),无LiDAR格占概率0.122(原0.332,-63.3%);CPU端全管线12 Hz(LiDAR前端16 Hz、雷达前端24 Hz)。
分层占据建图:0.50 m格距下近场雷达自反射滤除(四段分别23289/20672/18415/99176点),已知格内占/自/未定互斥;雷达填远距离与LiDAR缺口,但不改写高置信LiDAR局部边。
讨论部分总结:硬切换“近岸用LiDAR远岸用雷达”混淆距离与信息量,RACIF以配准支撑、残差、重叠、时域持续与跨模新息选权,模式随证据走;重启机制把LiDAR当可重启子系统,雷达桥接位姿作新锚;启发式可观测性代理仅反映局部约束质量,双模同退化或共模偏置时分数高但全局漂移仍生,冲突门控假定低分即不可信在双乐观时失效,故公式(18)仅解释用而非CRLB;局限含仅四MOANA段、参数启发固定未做全灵敏度、标量权不区分米/弧度各向异性与模间误差相关。
结论翻译:本文提出RACIF-SLAM,一种近海岸环境下LiDAR-W波段雷达定位与分层占据建图的可靠性感知框架。方法在船体坐标系统一传感器本体运动,从配准证据导出模态权威,抑制不一致低置信增量,于SE(2)合成融合运动,并通过雷达桥接重启恢复LiDAR跟踪。四评估段中1763个报告位姿均有至少一传感器测量支撑,未用航位推算回退,三次LiDAR重初始化无轨迹间断。相较同步双天线GNSS,RACIF在五法中获最低平均ATE与10帧平移RPE,较次低法降66.3%与65.1%。最难点区间雷达贡献上升,表明权威转移随启发式可观测性代理而非固定距离开关。A4诊断进一步示地图层级在LiDAR支撑格限制雷达影响而保留他处雷达支撑。结果支持所提架构在测试条件下成立;更广断言需更多轨迹、同时退化试验、参数灵敏度、相关误差建模与独立地图真值。
相关新闻
生物通微信公众号
微信
新浪微博

热点排行

    今日动态 | 人才市场 | 新技术专栏 | 中国科学人 | 云展台 | BioHot | 云讲堂直播 | 会展中心 | 特价专栏 | 技术快讯 | 免费试用

    版权所有 生物通

    Copyright© eBiotrade.com, All Rights Reserved

    联系信箱:

    粤ICP备09063491号