一种基于碰撞检测的智能车高速换道规划方法
摘要:
本发明公开了一种基于碰撞检测的智能车高速换道规划方法,包括:对目标车道的状态空间进行采样得到换道结束点的终端状态,利用五次多项式对换道起始点和结束点之间的换道轨迹进行拟合,形成换道候选轨迹集;利用代价评估函数对换道轨迹集中的候选换道轨迹进行评估,选取评估得分最低的轨迹作为最佳换道轨迹;获取目标车道内目标车辆的历史运动状态信息,然后将历史运动状态信息从笛卡尔坐标系映射到Frenet坐标系下,进行目标车辆轨迹预测;进行规划换道轨迹与目标车辆预测轨迹之间的碰撞检测,根据碰撞检测的结果控制车辆的换道行为;本发明通过碰撞检测的方式保证车辆以最佳换道轨迹换道的同时最大程度保证高速换道的安全性。
公开/授权文献
0/0