基于Frenet坐标系的换道轨迹规划及跟踪验证

为解决高速公路环境下的车辆自动变道问题，采用Frenet坐标系下的五次多项式算法对不同工况设计规划轨迹，实现自动变道辅助。首先根据自车状态与周围车辆状态预计变道所需直线距离，并在一定范围内进行多次五次多项式轨迹规划，得到备选轨迹集。以加速度最小为优化目标，对备选轨迹集中的所有轨迹进行评价，得到最佳换道轨迹。使用CarSim进行车辆和道路建模，在Matlab/Simulink中进行轨迹规划，并使用动力学模型的模型预测控制进行轨迹跟踪，验证了换道辅助系统的有效性。