含动态障碍物的狭窄非结构化场景的轨迹规划方法及系统

本发明公开了一种含动态障碍物的狭窄非结构化场景的轨迹规划方法及系统，其包括：步骤1，分析四轮独立转向车辆的运动学模型特性，构建混合A*算法，获取非结构化场景相关参数；步骤2，根据混合A*算法，结合改进的碰撞检测算法，求解无碰撞的初始路径；改进的碰撞检测算法包括：根据车身轮廓，构建等分多圆盘轮廓及障碍物膨胀地图，计算等分多圆盘圆心坐标，通过遍历每个圆盘圆心，判断圆盘圆心是否与障碍物膨胀地图的障碍物发生干涉；步骤3，采用基于概率安全行车走廊的数值优化方法对初始轨迹优化。本发明以四轮独立转向车辆为载体，使车辆在障碍物密集、道路狭窄且存在动态障碍物的非结构化场景中能有效地生成一条安全可行的行驶轨迹。