一种变曲率弯道的动态自动驾驶换道轨迹规划方法

摘要

本发明公开了一种变曲率弯道的动态自动驾驶换道轨迹规划方法，包括如下步骤：步骤一、计算直道换道轨迹曲线；步骤二、计算弯道换道轨迹曲线；步骤三、采用防侧翻算法和避撞算法计算轨迹安全性约束；步骤四、确定满足步骤三所述的轨迹安全性约束的最优轨迹；步骤五、输出最终换道轨迹，作为自动驾驶车辆的换道轨迹，从而构建了一套完整的动态车辆换道轨迹规划模型。本发明采用了考虑舒适性与效率的最优轨迹算法来生成最优轨迹，再用安全性约束来调整最优轨迹，使决策出的最终换道轨迹在安全性前提下达到最优。因而本发明规划出的最优换道轨迹服务水平较高，能够保证乘客具有较高的舒适度体验与效率体验。