arXiv:2506.13421cs.ROcs.SY2025-06被引 1

提出DE-AGT算法,高效解决铰接式车辆泊车的运动规划难题。

Delayed Expansion AGT: Kinodynamic Planning with Application to Tractor-Trailer Parking

  • 分阶段扩展运动基元,优先搜索高潜力模式,减少无效计算。
  • 用学习的启发式函数加速搜索,平均提速10倍,比之前方法快。
  • 集成轻量轨迹跟踪控制器,精准到达目标状态,适合复杂泊车场景。

在复杂环境中对铰接式车辆进行动力学规划面临高维状态空间和复杂系统动力学的双重挑战。本文基于[1],[2],提出DE-AGT算法,利用预计算的运动基元(MPs)与A*启发式构建搜索树。该算法首次引入延迟扩展机制:将运动基元按模式划分并在线排序,优先扩展最有希望的模式,显著减少冗余计算,加快解的发现速度。为获得非完整约束铰接车辆的代价到目标(cost-to-go)启发式,采用监督学习训练神经网络,实现快速准确的启发式预测,用于在线模式排序与节点选择。另一创新是改进的终止策略:通过紧密集成轻量级轨迹跟踪控制器,避免传统方法中反复求解转向问题的耗时操作,实现精确抵达目标状态。算法已应用于一般类车头拖拽三挂车的自动驾驶泊车任务。仿真结果表明,相比先前方法,平均加速达10倍。

原文摘要 · Abstract (English)

Kinodynamic planning of articulated vehicles in cluttered environments faces additional challenges arising from high-dimensional state space and complex system dynamics. Built upon [1],[2], this work proposes the DE-AGT algorithm that grows a tree using pre-computed motion primitives (MPs) and A* heuristics. The first feature of DE-AGT is a delayed expansion of MPs. In particular, the MPs are divided into different modes, which are ranked online. With the MP classification and prioritization, DE-AGT expands the most promising mode of MPs first, which eliminates unnecessary computation and finds solutions faster. To obtain the cost-to-go heuristic for nonholonomic articulated vehicles, we rely on supervised learning and train neural networks for fast and accurate cost-to-go prediction. The learned heuristic is used for online mode ranking and node selection. Another feature of DE-AGT is the improved goal-reaching. Exactly reaching a goal state usually requires a constant connection checking with the goal by solving steering problems -- non-trivial and time-consuming for articulated vehicles. The proposed termination scheme overcomes this challenge by tightly integrating a light-weight trajectory tracking controller with the search process. DE-AGT is implemented for autonomous parking of a general car-like tractor with 3-trailer. Simulation results show an average of 10x acceleration compared to a previous method.

运动规划铰接车辆A*算法强化学习

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。