通过自适应 Sigma 高斯采样与候选驱动树协调加速快速探索随机树星

《Expert Systems with Applications》:Accelerating Rapidly-exploring Random Tree Star via Adaptive-Sigma Gaussian Sampling and Candidate-Driven Tree Coordination

【字体: 大 中 小 】 时间:2026年09月07日 来源:Expert Systems with Applications 9.4

编辑推荐:

   •采用自适应σ的高斯采样器指导RRT*候选点的生成。•候选池依据桥接可行性、目标距离以及稀疏程度对采样点进行排序。•领导者-跟随者树协调机制可复用能被跟随者树连接的候选点。•AS-RRT*在四个二维基准测试中降低了规划时间和节点数量。•一个抓取与放置任务展示了高效的可行路径发

  
  • •
    采用自适应σ的高斯采样器指导RRT*候选点的生成。
  • •
    候选池依据桥接可行性、目标距离以及稀疏程度对采样点进行排序。
  • •
    领导者-跟随者树协调机制可复用能被跟随者树连接的候选点。
  • •
    AS-RRT*在四个二维基准测试中降低了规划时间和节点数量。
  • •
    一个抓取与放置任务展示了高效的可行路径发现能力。

引言

机器人在拥有无碰撞路径之前无法执行已规划的运动。在时间受限的规划中,狭窄通道、密集障碍和长走廊会产生无效或冗余的扩展,从而在形成第一条可行连接之前就消耗了大量样本和碰撞检测计算(Aggarwal, Kumar, 2020, Muhsen, Raheem, Sadiq, 2024, Zhang, Lin, Chen, 2018)。因此,本文评估初始路径的寻找速度、形成该路径前创建的树节点数量,以及所得路径的代价。
A*和Dijkstra等图搜索方法基于离散表示运行,其计算与存储成本会随地图分辨率和构型空间维度的增加而上升(Gao, Yan, Shen, Ma, 2022, Koenig, Likhachev, Furcy, 2004, Wang, Yu, Yuan, 2011)。人工势场法避免了显式的图构建,但仍易受局部极小值和振荡问题的影响(Rasekhipour, Khajepour, Chen, & Litkouhi, 2017)。元启发式规划器依赖参数设置和环境结构(Ab Wahab, Nefti-Meziani, Atyabi, 2020, Ning, Zhang, Zhang, Zhang, 2018, Qu, Gai, Zhong, Zhang, 2020, Wang, Tan, Liu, 2018),而学习型规划器则依赖于其训练分布的覆盖程度(Janner, Du, Tenenbaum, Levine, 2022, Wang, Chi, Li, Wang, Meng, 2020)。基于采样的规划器直接在连续空间内工作,因此适合本文研究的单查询问题。
快速扩展随机树(RRT)通过增量采样和树的生长来探索连续空间(LaValle & Kuffner, 2001)。其最初形式侧重于可行性;初始路径可能较长,且无方向的探索可能会消耗大量样本。RRT-Connect通过同时向彼此生长两棵树来缩短首次连接所需的时间(Kuffner & LaValle, 2000)。RRT*(Rapidly-exploring Random Tree Star)引入了父节点选择和重连机制,使得路径代价随着采样过程的持续而得到改善(Karaman & Frazzoli, 2011)。Informed-RRT*利用当前解的代价定义"信息集",并将后续样本限制在可能改进当前解的状态范围内(Gammell, Srinivasa, & Barfoot, 2014)。这些方法作用于规划的不同阶段。对于时间受限的任务,可用路径出现之前的延迟本身就是一个重要问题;渐进式的改进无法弥补昂贵初始解带来的成本。
关于加快初始解的研究沿着两个密切相关的发展方向展开:树的扩展和采样指导。目标偏置以及改进的双向连接规则提高了向目标方向扩展的概率。Q-RRT*和F-RRT*通过更具选择性的父节点或祖先搜索增强局部连接质量(Jeong, Lee, Kim, 2019, Kang, Kim, You, Lee, Oh, Moon, Choi, 2016, Liao, Wan, Hua, Ma, Zhu, Qing, 2021, Yang, Li, Liu, Yu, Li, 2021)。MQ-RRT*结合目标信息、局部稀疏度和新父节点构建来减少重复探索并改善初始解(Cui, Wang, Xiong, Mei, & Wu, 2024)。因此,初始解的效率既取决于样本的放置方式,也取决于候选状态如何与树相连接。
另一类工作致力于改变采样分布。HB-RRT使用低差异的Halton序列来改善空间覆盖并减少伪随机采样产生的间隙与聚类现象(Zhong, Cong, Wang, Du, & Liu, 2024)。基于演示的采样与GMR-RRT*则从先前数据中获取先验信息(Ichter, Harrison, Pavone, 2018, Wang, Li, Li, Meng, 2022)。近期的一些规划器能够在运行过程中动态调整指导策略。FS-RRT利用与障碍物碰撞反馈来修改采样方向和搜索区域(Jiang, Wang, & Dong, 2024)。Faroni等人根据解代价的变化调整局部采样与全局采样之间的平衡(Faroni, Pedrocchi, & Beschi, 2024)。Hybrid-RRT*在均匀探索与目标导向的非均匀采样之间进行切换(Ganesan, Ramalingam, & Mohan, 2024),而GD-RRT*根据碰撞成功频率和目标偏置来更新高斯混合指导(Zhao, Wang, Zhang, & Kan, 2026)。NA-RRT*N通过神经网络的方向和密度估计控制目标导向的高斯采样(Ahmed, Rashwan, Jaradat, & Romdhane, 2026),而ABF-RRT*和BR-RRT*则根据两棵树的进展情况或区域连通性来自适应允许采样的区域(Yang, He, Wu, Ruan, Cai, Zhang, 2026, Zeng, Chang, 2025)。
表1按照所使用的在线信号、该信号对后续采样的影响,以及所评估状态在后续树操作中所扮演的角色,对若干有代表性的基于RRT*的规划器进行了对比。
AS-RRT*将每一批经过碰撞检测的候选点同时用于采样自适应和树的扩展。该规划器维护一棵以起点为根的领导者树和一棵以目标点为根的跟随者树。在每次迭代中,无碰撞候选点在坐标方向上的分布范围决定了下一批高斯采样的尺度。采用字典序的键值首先按桥接可行性对候选点进行排序,随后利用跟随者树的邻近程度和领导者树的稀疏性来决定其余排序。排名第一的候选点用于扩展领导者树,而其他可被跟随者树连接的候选点则被插入到跟随者树中。
本文做出三项贡献。
  • 1.
    我们提出了一种由无碰撞候选点的分布范围驱动的逐坐标高斯尺度更新方法。每个空间坐标轴都根据观测到的批次单独进行更新。
  • 2.
    我们通过字典序领导者键值和跟随者侧的候选点复用机制来协调固定的领导者树与跟随者树,使同一批经过评估的候选点可同时支持领导者扩展和跟随者树的生长。
  • 3.
    我们在四个静态二维环境中,通过重复对比、统计检验、在等时间预算下的精细化搜索、参数分析以及消融实验对AS-RRT*进行评估。一个基于六轴工业机械臂的抓取与放置任务进一步检验了该方法集成到三维任务空间规划流程中的能力。
在四个静态二维环境中,经过Holm校正的配对符号秩检验表明,在所有20组"地图-基线"对比中,AS-RRT*的初始规划时间和节点数量均显著更低。AS-RRT*在每一张地图上的中位数T5%也是最低的。

章节摘要

预备知识

本节定义了规划问题,并回顾了与AS-RRT*最相关的基于RRT*的机制:父节点选择、重连、信息采样、两棵树之间的协调、稀疏采样以及局部路径精细化。

AS-RRT*算法

本节将AS-RRT*作为一条执行流水线进行介绍。图1概述了在寻找初始解过程中由两棵树共同完成的候选点生成、排序与复用过程。算法2还给出了在有限预算下进行桥接精细化时如何保留这些树。各小节按照执行顺序展开,并以复杂度与内存分析作为结束。

实验评估

本次评估在有限计算预算下,针对静态环境将AS-RRT*作为规划器进行测试。首先在四张二维地图上对比初始解的表现,随后在等时间预算下评估对现有路径的精细化搜索、参数敏感性以及组件消融。一个三维任务空间的抓取与放置任务则提供了一个独立的机器人验证案例。
对于主要的二维对比实验,AS-RRT*与五种基于RRT*的变体进行了基准比较

结论

本文提出了AS-RRT*,一种在有限计算预算下针对静态环境实现快速初始路径发现的规划器。该方法将逐坐标高斯尺度自适应、按桥接可行性以及对跟随者树距离和局部稀疏度进行的候选点排序,与在领导者树和跟随者树之间的候选点复用联系起来。在形成第一条桥接之后,精细化阶段会保留两棵树,并在固定预算下更新现有的完整路径。
在四个二维地图上,经过配对的

未引用浮标

表9,图6、图7、图8、图9、图13、14、15。

CRediT作者贡献声明

郭萌:概念化、方法论、软件实现、验证、形式化分析、研究、数据整理、可视化、原创草稿撰写、审阅与编辑。张小东:方法论、验证、形式化分析、审阅与编辑。金玉林:概念化、方法论、监督指导、项目管理、资源提供、审阅与编辑。

利益冲突声明

作者声明他们不存在已知的竞争性经济利益或可能影响本文所报告工作的个人关系。
郭萌|张小东|金玉林
相关新闻
生物通微信公众号
微信
新浪微博

热点排行

    今日动态 | 人才市场 | 新技术专栏 | 中国科学人 | 云展台 | BioHot | 云讲堂直播 | 会展中心 | 特价专栏 | 技术快讯 | 免费试用

    版权所有 生物通

    Copyright© eBiotrade.com, All Rights Reserved

    联系信箱:

    粤ICP备09063491号