arXivDaily arXiv每日学术速递 周一至周五更新
arXiv 2010.15364cs.RO
收藏

高动态环境下基于Timed-ESDF的在线状态-时间轨迹规划

Online State-Time Trajectory Planning Using Timed-ESDF in Highly Dynamic Environments

The Chinese University of Hong Kong(香港中文大学);Southern University of Science and Technology(南方科技大学);Shenzhen Research Institute of the Chinese University of Hong Kong(香港中文大学深圳研究院)

Delong Zhu, Tong Zhou, Jiahui Lin, Yuqi Fang, Max Q. -H. Meng

摘要:

在线状态时间轨迹规划在高度动态环境中仍然是一个未解决的问题,由于不可预测的运动的移动障碍物和灾难的维数从状态时间空间。现有的状态时间规划器通常是基于随机采样方法或离散状态图上的路径搜索来实现的。这些规划器的平滑性、路径间隙和规划效率通常不能令人满意。在这项工作中,我们提出了一个基于梯度的规划在高度动态的环境中的在线轨迹生成的状态时间空间。为了实现基于梯度的优化,我们提出了一个定时ESDT,支持距离和梯度查询的状态时间键。基于Timed-ESDT,我们还定义了一个光滑的先验和障碍似然函数,这是兼容的状态时间空间。轨迹规划,然后制定一个MAP问题,并解决了一个有效的数值优化。此外,为了提高规划器的最优性,我们还定义了一个状态时间图,然后进行路径搜索,以找到一个更好的初始化优化器。通过集成图搜索,规划质量得到显著提高。模拟和基准数据集上的实验结果表明,我们的规划器可以优于国家的最先进的方法,证明了其显着的优势,比传统的。

英文摘要:

Online state-time trajectory planning in highly dynamic environments remains an unsolved problem due to the unpredictable motions of moving obstacles and the curse of dimensionality from the state-time space. Existing state-time planners are typically implemented based on randomized sampling approaches or path searching on discretized state graph. The smoothness, path clearance, and planning efficiency of these planners are usually not satisfying. In this work, we propose a gradient-based planner over the state-time space for online trajectory generation in highly dynamic environments. To enable the gradient-based optimization, we propose a Timed-ESDT that supports distance and gradient queries with state-time keys. Based on the Timed-ESDT, we also define a smooth prior and an obstacle likelihood function that is compatible with the state-time space. The trajectory planning is then formulated to a MAP problem and solved by an efficient numerical optimizer. Moreover, to improve the optimality of the planner, we also define a state-time graph and then conduct path searching on it to find a better initialization for the optimizer. By integrating the graph searching, the planning quality is significantly improved. Experiment results on simulated and benchmark datasets show that our planner can outperform the state-of-the-art methods, demonstrating its significant advantages over the traditional ones.

机构、总结、中文摘要均由AI分析而来,可能存在错误,请以论文正文为准。

↑