arXiv:2505.18590cs.ROcs.SY2025-05被引 3

针对弯道拖车轨迹规划难题,提出渐增采样优化方法,提升精度同时降低计算量。

Optimization-Based Trajectory Planning for Tractor-Trailer Vehicles on Curvy Roads: A Progressively Increasing Sampling Number Method

  • 用几何表示法建模拖车横向与朝向误差,融入代价函数与约束
  • 通过渐进式增加采样数,在200次迭代内实现高精度轨迹规划
  • 适合需要实时性与高精度的自动驾驶拖车系统应用

本文针对弯道上拖车车辆的轨迹规划问题,提出一种基于优化的方法。由于拖车偏离中心线的误差缺乏解析表达式,给规划带来挑战。为此,我们采用几何表示法在笛卡尔坐标系中刻画横向和方向误差,将其作为优化过程中的代价函数分量及道路边界约束。首先生成粗略轨迹以热启动后续优化。为逼近连续时间运动学,传统方法需大量采样,导致变量与约束激增,求解困难。为此,我们设计渐进式增加采样数优化(PISNO)框架:先以小采样数获得近可行轨迹热启动;随后逐次增加采样数,每次求解中间最优控制问题(OCP);再将解重采样至更细采样周期,用于下一轮热启动。该过程持续进行直至达到阈值采样数。仿真与实验结果表明,该方法在性能和计算消耗方面优于基准方法。

原文摘要 · Abstract (English)

In this work, we propose an optimization-based trajectory planner for tractor-trailer vehicles on curvy roads. The lack of analytical expression for the trailer's errors to the center line pose a great challenge to the trajectory planning for tractor-trailer vehicles. To address this issue, we first use geometric representations to characterize the lateral and orientation errors in Cartesian frame, where the errors would serve as the components of the cost function and the road edge constraints within our optimization process. Next, we generate a coarse trajectory to warm-start the subsequent optimization problems. On the other hand, to achieve a good approximation of the continuous-time kinematics, optimization-based methods usually discretize the kinematics with a large sampling number. This leads to an increase in the number of the variables and constraints, thus making the optimization problem difficult to solve. To address this issue, we design a Progressively Increasing Sampling Number Optimization (PISNO) framework. More specifically, we first find a nearly feasible trajectory with a small sampling number to warm-start the optimization process. Then, the sampling number is progressively increased, and the corresponding intermediate Optimal Control Problem (OCP) is solved in each iteration. Next, we further resample the obtained solution into a finer sampling period, and then use it to warm-start the intermediate OCP in next iteration. This process is repeated until reaching a threshold sampling number. Simulation and experiment results show the proposed method exhibits a good performance and less computational consumption over the benchmarks.

轨迹规划拖车系统优化算法自动驾驶

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