1.一种基于横纵向协同规划的智能汽车自主避障方法,其特征在于,包括:步骤1,对本车车辆的行驶环境建模,得到车辆行驶环境模型;
步骤2,在车辆行驶环境模型中,获取本车车辆的起始点位置、终点位置以及障碍车辆位置和速度;
步骤3,根据本车车辆的起始点位置、终点位置以及障碍车辆位置和速度,采用改进动态窗口法,进行横向避障路径规划,得到初步避障路径,所述改进动态窗口法是在动态窗口法的基础上,对动态窗口的评价函数进行改进、加入自适应步长机制、以及在规划过程中加入车辆约束;
步骤4,根据初步避障路径,计算障碍车辆是否会与初步避障路径发生碰撞;
步骤5,若会发生碰撞,则采用改进斑马算法以及二次规划进行纵向避障,完成避障;
对动态窗口的评价函数进行改进,满足以下条件式:其中,
自适应步长机制满足以下条件式:其中,
在规划过程中加入车辆约束,满足以下条件式:其中,
步骤5具体包括:
步骤501,根据初步避障路径与障碍车辆路径进行碰撞计算,得到本车车辆与障碍车辆的碰撞时间和碰撞范围;
步骤502,基于步骤501得到的本车车辆与障碍车辆的碰撞时间和碰撞范围,建立本车车辆与障碍车辆之间的时间—位移关系图;
步骤503,利用改进的斑马算法在步骤502所建立的时间—位移关系图中规划最佳避障车辆位置,得到避障轨迹点;
步骤504,通过二次规划算法对避障轨迹点进行拟合优化,得到最佳纵向避障轨迹,完成避障;
改进的斑马算法满足以下条件式:无障碍车辆时,本车车辆的位置更新公式为:其中,
有障碍车辆时,本车车辆的位置更新公式为:其中,
改进的斑马算法的适应度函数的表达式为:其中,
通过二次规划算法对轨迹点进行拟合优化的约束函数为:路径约束:
纵向约束:
安全距离约束:
其中,