提出可复用信念树搜索,提升机器人在未知环境中的搜寻效率
ReSPIRe: Informative and Reusable Belief Tree Search for Robot Probabilistic Search and Tracking in Unknown Environments
- 基于无迹点近似快速计算非高斯分布下的互信息奖励
- 通过分层粒子结构实现自适应粒子数与全局路径引导
- 可复用滚动评估的信念树搜索提升在线规划效率
目标搜寻与跟踪(SAT)是搜救和环境探索等机器人应用的基础问题。本文提出一种名为ReSPIRe的信息性轨迹规划方法,适用于先验信息不准确且感知视域受限的未知杂乱环境。首先,提出基于无迹点的近似方法,在状态与观测空间中采用信息性采样,高效准确地估算非高斯信念分布下的互信息奖励,缓解积分计算的计算不可行性。为应对先验信息不足带来的显著不确定性,ReSPIRe引入分层粒子结构,既能提取关键粒子用于全局路径引导,又能自适应调整粒子数量以提升规划效率。在此基础上,构建可复用信念树搜索方法,通过重用滚动评估实现在线轨迹规划,显著提升规划效率。大量仿真与真实实验表明,ReSPIRe相比代表性基准方法具有更小的互信息近似误差、更高的搜寻效率及更稳定的跟踪性能,同时保持优异的计算效率。
原文摘要 · Abstract (English)
Target search and tracking (SAT) is a fundamental problem for various robotic applications such as search and rescue and environmental exploration. This paper proposes an informative trajectory planning approach, namely ReSPIRe, for SAT in unknown cluttered environments under considerably inaccurate prior target information and limited sensing field of view. We first develop a novel sigma point-based approximation approach to fast and accurately estimate mutual information reward under non-Gaussian belief distributions, utilizing informative sampling in state and observation spaces to mitigate the computational intractability of integral calculation. To tackle significant uncertainty associated with inadequate prior target information, we propose the hierarchical particle structure in ReSPIRe, which not only extracts critical particles for global route guidance, but also adjusts the particle number adaptively for planning efficiency. Building upon the hierarchical structure, we develop the reusable belief tree search approach to build a policy tree for online trajectory planning under uncertainty, which reuses rollout evaluation to improve planning efficiency. Extensive simulations and real-world experiments demonstrate that ReSPIRe outperforms representative benchmark methods with smaller MI approximation error, higher search efficiency, and more stable tracking performance, while maintaining outstanding computational efficiency.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。