一种基于虚拟约束的自动驾驶车辆路径规划方法

摘要

本发明涉及一种基于虚拟约束的自动驾驶车辆路径规划方法，包括以下步骤：根据车道线检测结果获取车体坐标系下的车道中心线航向；利用卡尔曼滤波器和获取的车道中心线航向对车辆的航向进行修正；利用修正后的车辆航向对原始路径中的路径点进行校正；基于三维激光雷达栅格地图，获取自动驾驶车辆与道路的相对横向位置关系；生成虚拟约束；根据自动驾驶系统的决策指令，生成期望路径。本发明融合GPS、视觉与激光雷达信息完成车辆与道路相对横向位置的精确定位，不需要高精度定位设备和高精度地图，有助于提高自动驾驶车辆在结构化的、有清晰车道线的城市或高速公路环境下的车道保持与换道能力，对于自动驾驶车辆的安全、稳定、平顺行驶具有重要意义。