arXiv:2504.19195cs.RO2025-04被引 3

不线性化直接优化,用自然梯度提升车辆定位精度

NANO-SLAM : Natural Gradient Gaussian Approximation for Vehicle SLAM

  • 用自然梯度优化高斯采样分布,避免传统线性化误差
  • 在悉尼长距离数据集上定位精度提升超50%
  • 适合需要高精度定位的自动驾驶系统

自主车辆在无GPS环境(如城市峡谷、隧道)中精确定位极具挑战。此时,同时定位与地图构建(SLAM)可替代基于GPS的定位,利用车载传感器和环境特征实现位置推算。现有方法中,拉奥-布莱克韦尔粒子滤波(RBPF)因计算复杂度随地图规模对数增长而被广泛采用。其核心在于通过采样与重要性加权两步近似车辆位姿后验分布,其中采样效率依赖于高质量的采样分布。传统方法通过线性化构建该分布,但因系统非线性导致显著误差。本文提出一种新方法NANO-SLAM,将采样分布建模为高斯参数上的优化问题,采用自然梯度下降求解,避免线性化误差。实验表明,在悉尼维多利亚公园长距离车辆SLAM数据集上,NANO-SLAM相比最常用算法定位精度提升超过50%,且计算开销几乎不变。

原文摘要 · Abstract (English)

Accurate localization is a challenging task for autonomous vehicles, particularly in GPS-denied environments such as urban canyons and tunnels. In these scenarios, simultaneous localization and mapping (SLAM) offers a more robust alternative to GPS-based positioning, enabling vehicles to determine their position using onboard sensors and surrounding environment's landmarks. Among various vehicle SLAM approaches, Rao-Blackwellized particle filter (RBPF) stands out as one of the most widely adopted methods due to its efficient solution with logarithmic complexity relative to the map size. RBPF approximates the posterior distribution of the vehicle pose using a set of Monte Carlo particles through two main steps: sampling and importance weighting. The key to effective sampling lies in solving a distribution that closely approximates the posterior, known as the sampling distribution, to accelerate convergence. Existing methods typically derive this distribution via linearization, which introduces significant approximation errors due to the inherent nonlinearity of the system. To address this limitation, we propose a novel vehicle SLAM method called \textit{N}atural Gr\textit{a}dient Gaussia\textit{n} Appr\textit{o}ximation (NANO)-SLAM, which avoids linearization errors by modeling the sampling distribution as the solution to an optimization problem over Gaussian parameters and solving it using natural gradient descent. This approach improves the accuracy of the sampling distribution and consequently enhances localization performance. Experimental results on the long-distance Sydney Victoria Park vehicle SLAM dataset show that NANO-SLAM achieves over 50\% improvement in localization accuracy compared to the most widely used vehicle SLAM algorithms, with minimal additional computational cost.

SLAM自然梯度自动驾驶

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