一种基于控制采样的智能车辆路径规划系统及方法

本发明请求保护一种基于控制采样的智能车辆路径规划系统及方法，该系统由环境地图模块、车辆状态计算模块、路径搜索模块组成。环境地图模块存储车载传感器检测到的环境信息和车辆状态信息，并构造实时环境地图用于路径规划。车辆状态计算模块基于环境模型和车辆状态扩展模型，提供车辆状态扩展、车辆状态评价以及对状态的碰撞检查功能。路径搜索模块执行初步路径搜索算法得到初步路径，再利用带切向约束的二次B样条插值初步路径，得到连续的最终路径。本发明所述路径规划系统及方法具有良好的实时性、收敛性，规划的路径符合车辆运动学约束，可执行性佳。