摘要

为充分考虑横纵向耦合和汽车运动学特性对轨迹规划的影响,提出一种分层优化的轨迹规划算法框架。利用贝塞尔曲线的凸包性设计安全走廊约束,以轨迹平滑性为目标函数得到一个基于贝塞尔曲线节点的下层规划器。在上层规划器中,基于下层规划器求解得到的横纵向贝塞尔曲线和车辆运动学模型的微分平坦输出进行三维耦合,构建满足车辆乘坐舒适性、高效性和安全性的目标函数,利用粒子群优化算法对贝塞尔轨迹初始参数进行二次优化得到综合性能最优的行驶轨迹。仿真结果表明:新算法在保证安全性的同时,具有良好的乘坐舒适性和可跟踪性;由于二次规划与粒子群优化算法的求解效率高,此框架实时性强,具有概率完备性。