用概率关联提升定位精度,让地图更准更稳。
Moment-Matching Probabilistic Data Association for Optimization-Based SLAM
- 给每个地标分配多个测量值,按概率匹配
- 通过矩匹配计算地标均值与方差,提升估计精度
- 可无缝集成到任意优化型SLAM中,适合复杂环境
基于优化的同步定位与地图构建(SLAM)可通过返回已知区域(回环闭合)减少传感平台的累积导航误差。本文提出将概率数据关联(PDA)与优化型SLAM结合的方法。不同于传统方法仅将单一测量关联到每个地标,我们借鉴多目标跟踪中的PDA范式,在优化型SLAM的非线性最小二乘求解器之外增加一个处理阶段:(i) 概率性地将多个测量值分配给地标;(ii) 通过矩匹配综合考虑多重测量-地标关联,计算地标分布的均值与协方差;(iii) 构造一个虚拟地标测量及其对应的线性高斯测量模型,使结果等价于矩匹配的PDA更新。通过将PDA更新转换为等效的线性高斯测量更新,该方法可有效嵌入任意优化型SLAM系统。初步数值实验显示,在存在漏检和误检的场景下,结合所提PDA方法的增量平滑与映射2(iSAM2)相比传统iSAM2,显著提升了智能体定位性能。
原文摘要 · Abstract (English)
Optimization-based simultaneous localization and mapping (SLAM) makes it possible to reduce accumulated navigation errors of sensing platforms by returning to known areas (loop closure). In this paper, we present an approach to combine probabilistic data association (PDA) with optimization-based SLAM. Instead of associating a single measurement with each landmark, we follow the PDA paradigm from the multiobject tracking community. In particular, in a processing stage performed in addition to the nonlinear least-squares solver of optimization-based SLAM, our method (i) assigns multiple measurements to landmarks probabilistically, (ii) computes the mean and covariance of landmark distributions via moment matching by taking multiple measurement-to-landmark associations into account, and (iii) establishes a virtual landmark measurement and a corresponding linear-Gaussian measurement model that leads to the mean and covariance matrix as moment-matching PDA in (ii). By converting the PDA update step into an equivalent linear-Gaussian measurement update step, PDA can be performed effectively within any optimization-based SLAM method. Our preliminary numerical evaluation in a scenario with false negatives and false positives indicates that incremental smoothing and mapping 2 (iSAM2), combined with the proposed PDA approach, can improve agent localization performance compared to conventional iSAM2.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。