一种基于局部最优性的无人驾驶车辆动态轨迹规划方法

摘要

本发明属于无人驾驶汽车路径规划技术领域，尤其涉及一种基于局部最优性的无人驾驶车辆动态轨迹规划方法。该方法根据道路上障碍物车辆的不同位置与其不同相应的工况，来进行最优参考轨迹的选取并进行动态的轨迹规划。分析无人车换道意图的产生与换道可执行的条件，根据对周围障碍车位置以及速度的预测在决定避障换道的初始时刻拟合出局部最优换道轨迹，进而把这条最优轨迹作为局部参考轨迹。生成无人车可行驶的轨迹簇，并将设计出的速度距离成本代价函数与损失函数相结合，利用非线性模型预测控制筛选出轨迹簇中的最优轨迹。该方法能够在多种复杂工况下实现避障、换道与超车，而且兼顾了无人车中乘客的舒适性与道路行驶效率等性能。