1.一种融合改进势场与动态窗口的汽车路径规划方法,其特征在于,包括以下步骤:步骤1,采用势场法对行车环境进行建模,得到行车环境模型;
步骤2,在行车环境模型中,获得汽车、目标点、障碍物、道路边界的坐标位置,再根据汽车与目标点、汽车与障碍物、汽车与道路边界之间的位置关系,建立多个势场函数,多个势场函数具体包括目标引力函数、障碍物斥力函数、相对速度斥力函数、道路纵向力函数;
步骤3,基于行车环境模型和多个势场函数,得到初步的规划路径;
步骤4,基于初步的规划路径,获取汽车到每一个障碍物的关键路径节点;
步骤5,对动态窗口的评价函数及加权系数进行改进,得到改进的动态窗口;
步骤6,将汽车到每一个障碍物的关键路径节点输入到改进的动态窗口中,通过改进的动态窗口的评价函数对关键路径节点上汽车与障碍物的相对速度、汽车的位姿、汽车轨迹与障碍物距离及汽车行驶最小安全距离进行采样,利用改进的动态窗口对初步的规划路径进行实时优化更新,得到优化后的规划路径。
2.根据权利要求1所述的融合改进势场与动态窗口的汽车路径规划方法,其特征在于,步骤2中,目标引力函数、障碍物斥力函数、相对速度斥力函数的表达式分别为:其中, 为目标引力, 为障碍物斥力, 为相对速度斥力,d1为汽车与目 标点 的 距 离 ,d 2 为 汽 车 与障 碍 物 的 距 离 , ,,x和y是汽车自身位置坐标,xrep和yrep是障碍物位置坐标, 、、分别为引力增益系数、斥力增益系数、相对速度斥力增益系数,vrel为汽车与障碍物的相对速度,为引力与斥力之间的角度,d0为道路纵向力生效距离。
3.根据权利要求2所述的融合改进势场与动态窗口的汽车路径规划方法,其特征在于,步骤2中,道路纵向力函数的表达式为:其中, 表示道路纵向力,d为汽车与道路的纵向距离,为道路纵向力增益系数。
4.根据权利要求3所述的融合改进势场与动态窗口的汽车路径规划方法,其特征在于,步骤3具体包括:步骤301,在行车环境模型中,以道路边界建立坐标系;
步骤302,基于建立的坐标系,选取汽车、目标点、障碍物的位置坐标,设定汽车参数;
步骤303,按照设定的汽车参数控制汽车前进,在汽车前进过程中实时检测是否达到道路纵向力生效距离,若达到道路纵向力生效距离,则进入步骤304,若未达到道路纵向力生效距离,则进入步骤305;
步骤304,道路纵向力生效,汽车在目标引力函数、障碍物斥力函数、相对速度斥力函数、道路纵向力函数的共同作用下前行,得到初步的规划路径;
步骤305,汽车在目标引力函数、障碍物斥力函数、相对速度斥力函数的共同作用下前行,得到初步的规划路径。
5.根据权利要求4所述的融合改进势场与动态窗口的汽车路径规划方法,其特征在于,步骤5中,对动态窗口的评价函数及加权系数进行如下改进:其中, 表示改进后的动态窗口的评价函数, 表示改进后的加权系数,为位姿函数, 为行驶轨迹与目标点距离函数,
为行驶轨迹的线速度函数, 为行驶轨迹与障碍物距离函数,为位姿函数的加权系数,为行驶轨迹与目标点距离函数的加权系数, 为行驶轨迹的线速度函数的加权系数, 为行驶轨迹与障碍物距离函数的加权系数,min表示取最小值,max表示取最大值。