arXiv:2606.15491cs.RO2026-06

用频域方法提升雷达惯性定位精度,实现在恶劣环境下的稳定导航。

FD-SLAM: Fast Dense Radar-Inertial SLAM with Frequency-Domain Loop Closure and Pose Graph Optimization

论文配图:FD-SLAM: Fast Dense Radar-Inertial SLAM with Frequency-Domain Loop Closure and Pose Graph Optimization
图 1 · 摘自论文原文
  • 通过频域极坐标描述子快速检索回环候选
  • 多阶段验证确保回环闭合准确率,显著提升定位精度
  • 适合自动驾驶车辆在低可视环境下实时运行

雷达SLAM在视觉退化环境中的自主地面车辆中具有吸引力,但扫描雷达噪声大、扫描频率低,且长轨迹上的测量匹配困难。本文提出FD-SLAM,一种快速稠密雷达-惯性SLAM系统,通过频域回环检测与位姿图优化扩展了稠密雷达-惯性里程计。该方法利用紧凑的频域极坐标描述子保留雷达测量的类图像结构,并结合基于时间滤波、相位相关筛选、扫描对齐相似性及几何一致性检查的多阶段验证流程,实现可靠回环闭合。验证后的回环约束以非序列方式加入SE(2)位姿图,与雷达-惯性里程计因子共同优化。在公开数据集上使用标准KITTI评估指标进行测试,结果表明FD-SLAM优于基线方法FD-RIO,性能媲美当前先进雷达SLAM方法,在多个驾驶轨迹上表现出优异的旋转精度。运行时分析显示,雷达-惯性前端在仅CPU环境下运行速度超过雷达采样率,回环检测与图优化适合并行后台执行。

原文摘要 · Abstract (English)

Radar SLAM is attractive for autonomous ground vehicles operating in visually degraded environments, however, scanning radars are noisy, have low scanning rates, and their measurements are challenging to match reliably over long trajectories. This paper presents FD-SLAM, a fast dense radar-inertial SLAM system that extends dense radar-inertial odometry with frequency-domain loop closure and pose graph optimization. The proposed method preserves an image-like structure of scanning radar measurements by using a compact frequency-domain polar descriptor for loop-candidate retrieval and a multi-stage verification pipeline based on temporal filtering, phase-correlation screening, scan-alignment similarity, and geometric consistency checks. Verified loop closures are added as non-sequential constraints in an SE(2) pose graph together with radar-inertial odometry factors. FD-SLAM is evaluated on a publicly available dataset using standard KITTI evaluation metrics. The results show that FD-SLAM improves FD-RIO baseline, achieves competitive performance against current state-of-the-art radar SLAM methods, and provides favorable rotational accuracy across multiple evaluated driving trajectories. Runtime analysis further indicates that the radar-inertial front-end operates above the radar sampling rate on a CPU-only setup, while loop closure detection and graph optimization remain suitable for parallel background execution.

雷达定位位姿优化自动驾驶

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。