Modern sampling-based motion planning algorithms typically take between hundreds of milliseconds to dozens of seconds to find collision-free motions for high degree-of-freedom problems. This paper presents performance improvements of more than 500x over the state-of-the-art, bringing planning times into the range of microseconds and solution rates into the range of kilohertz, without specialized hardware. Our key insight is how to exploit fine-grained parallelism within sampling-based planners, providing generality-preserving algorithmic improvements to any such planner and significantly accelerating critical subroutines, such as forward kinematics and collision checking. We demonstrate our approach over a diverse set of challenging, realistic problems for complex robots ranging from 7 to 14 degrees-of-freedom. Moreover, we show that our approach does not require high-power hardware by also evaluating on a low-power single-board computer. The planning speeds demonstrated are fast enough to reside in the range of control frequencies and open up new avenues of motion planning research.
翻译:现代基于采样的运动规划算法通常需要数百毫秒到数十秒才能为高自由度问题找到无碰撞运动。本文提出了相较于当前最先进技术超过500倍的性能提升,将规划时间降至微秒级,并将求解频率提升至千赫兹范围,且无需专用硬件。我们的关键见解在于如何利用基于采样规划器中的细粒度并行性,为任何此类规划器提供保持通用性的算法改进,并显著加速前向运动学和碰撞检测等关键子程序。我们针对从7自由度到14自由度的复杂机器人,在一系列多样且具有挑战性的现实问题上展示了该方法。此外,我们还通过在低功耗单板计算机上进行评估,证明该方法不需要高功耗硬件。所达到的规划速度足以覆盖控制频率范围,为运动规划研究开辟了新途径。