基于贝塞尔流形和拓扑规划的编队切换轨迹规划

Formation Switching Trajectory Planning Based on Bessel Manifold and Topology Planning

  • 摘要: 在物流运输场景中,无人车编队需通过城市拥堵路段或规避障碍物时切换队形以确保安全通行. 然而,现有编队切换轨迹规划方法在应对复杂场景时存在显著不足,例如计算效率低、难以保证全局最优性、易陷入局部最优解等问题,无法满足实际应用对快速性、安全性与最优性的严苛要求. 为此,提出一种融合贝塞尔曲线与拓扑规划的编队切换轨迹规划方法. 该方法首先通过复平面路径函数积分与图搜索算法,生成拓扑相异的多条候选路径. 随后,基于贝塞尔曲线对编队运行路径建模,并引入最小间距约束构建防碰撞目标函数,通过在贝塞尔流形上沿测地线进行优化搜索,实现车辆间及车辆与障碍物的碰撞规避. 仿真实验表明:在椭圆障碍物场景下,相较传统多项式方法、Olfati-Saber方法与模型预测方法,本方法平均求解时间降低50%,且全程无碰撞发生.

     

    Abstract: In logistics transportation scenarios, unmanned vehicle formations require safe shape-shifting to navigate urban congested areas or avoid obstacles. However, existing trajectory planning methods for formation switching have significant shortcomings in dealing with complex environments, including low computational efficiency, suboptimal global solutions, and local optima entrapment. To address these challenges, in this paper a formation-switching trajectory planning method integrating Bézier curves with topological planning was proposed. First, a complex plane path function integration and graph search algorithm generated multiple topologically distinct candidate paths. Subsequently, Bézier curves modelled formation trajectories while minimum spacing constraints constructed a collision-avoidance objective function. Optimization along geodesic lines on the Bézier manifold ensured collision prevention between vehicles and obstacles. Finally, cost optimization across topological path classes yielded globally optimal trajectories. Simulations demonstrate that in elliptical obstacle scenarios, compared to traditional polynomial methods, Olfati-Saber algorithms, and model predictive control, the proposed method reduces average computation time by 50% while guaranteeing collision-free trajectories throughout navigation.

     

/

返回文章
返回
Baidu
map