用稀疏采样与分阶段推理,让迷路机器人快速准确定位。
Tackling the Kidnapped Robot Problem via Sparse Feasible Hypothesis Sampling and Reliable Batched Multi-Stage Inference
- 基于稀疏可行假设采样和批量多阶段推理,高效解决定位难题。
- 在真实机器人上实现高成功率、抗测量误差、低计算开销。
- 适合资源受限的移动机器人长期自主运行场景。
本文针对机器人丢失定位(Kidnapped Robot Problem, KRP)这一核心挑战,提出一种被动式二维全局重定位框架。该框架可在机器人静止时,仅凭单次激光扫描与占用栅格地图,高效可靠地估计全局位姿,从而提升移动机器人的长期自主能力。方法将全局重定位建模为非凸问题,通过多假设方案结合批量多阶段推理与早期终止机制,在完整性与效率间取得平衡。利用带可通行性约束的快速探索随机树(RRT)渐进覆盖可达空间,生成稀疏且均匀分布的可行位置假设,从根本上缩减采样空间。通过提出的扫描均绝对差(SMAD)指标对假设进行粗粒度排序,优先处理高似然候选者,支持早期终止;其计算针对有限扫描数据进行了优化。此外,提出平移一致性扫描-地图匹配度量(TAM),用于在假设位置上可靠选择方向并准确评估最终全局位姿,有效缓解传统似然场度量在稀疏假设、非全向激光扫描及环境变化下的性能退化。在资源受限的移动机器人上进行的真实世界实验表明,该框架在成功率、测量不确定性下的鲁棒性以及计算效率方面均达到良好表现。
原文摘要 · Abstract (English)
This paper addresses the Kidnapped Robot Problem (KRP), a core localization challenge of relocalizing a robot in a known map without prior pose estimate upon localization loss or at SLAM initialization. For this purpose, a passive 2-D global relocalization framework is proposed. It estimates the global pose efficiently and reliably from a single LiDAR scan and an occupancy grid map while the robot remains stationary, thereby enhancing the long-term autonomy of mobile robots. The proposed framework casts global relocalization as a non-convex problem and solves it via the multi-hypothesis scheme with batched multi-stage inference and early termination, balancing completeness and efficiency. The Rapidly-exploring Random Tree (RRT), under traversability constraints, asymptotically covers the reachable space to generate sparse, uniformly distributed feasible positional hypotheses, fundamentally reducing the sampling space. The hypotheses are preliminarily ordered by the proposed Scan Mean Absolute Difference (SMAD), a coarse beam-error level metric that facilitates the early termination by prioritizing high-likelihood candidates. The SMAD computation is optimized for limited scan measurements. The Translation-Affinity Scan-to-Map Alignment Metric (TAM) is proposed for reliable orientation selection at hypothesized positions and accurate final global pose evaluation to mitigate degradation in conventional likelihood-field metrics under translational uncertainty induced by sparse hypotheses, as well as non-panoramic LiDAR scan and environmental changes. Real-world experiments on a resource-constrained mobile robot with non-panoramic LiDAR scans show that the proposed framework achieves competitive performance in success rate, robustness under measurement uncertainty, and computational efficiency.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。