一种基于车载视觉传感器的智能商用车换道规划控制方法

本发明涉及自动驾驶技术领域，具体涉及一种基于车载视觉传感器的智能商用车换道规划控制方法，在车身坐标系下，对车载视觉传感器获取的参考线信息进行离散化，通过三次样条曲线方程进行平滑拟合；利用参考线上的弧长和横向偏移量构建Frenet坐标系，并规划出一系列的换道避障候选轨迹，将其从Frenet坐标系转换到笛卡尔坐标系；采用多目标代价函数从候选轨迹中筛选出最优换道轨；基于车辆二自由度动力学模型设计多点预瞄路径跟踪算法；用路径跟踪算法，控制商用车跟踪最优换道轨迹，并进行仿真验证。在不依赖高精地图的情况下，进行商用车的换道局部路径规划。将路径规划与跟踪控制相结合，实现智能商用车的换道过程。