[发明专利]一种基于人工势场法的无人驾驶车辆路径规划方法

说明书

本发明提供一种基于人工势场法的无人车辆路径规划方法，包括以下步骤：1)、构建无人车行驶的二维空间模型；2)、建立虚拟势场；3)使无人车行驶一个单位步长l，判断无人车是否陷入局部最小值点，如果是则调用步骤4)，否则进行步骤5)；4)改变斥力在X轴上的分量后回到步骤2)重新开始；5)判断无人车是否行进到目标点附近的影响距离内造成目标不可达，如果是则调用步骤6)，否则进行步骤7)；6)在斥力势场函数中引入安全距离ρsubgt;s/subgt;和无人车到目标点之间的距离ρsubgt;t/subgt;后回到步骤(2)重新开始；7)判断无人车车是否到达目标点，如果是则停止路径规划画出路径，否则回到步骤(2)重新开始。该方法用以解决无人车辆存在易陷入局部最小点和目标不可达的问题。

技术领域

本发明涉及智能汽车技术领域，具体涉及一种基于人工势场法的无人驾驶车辆路径规划方法。

背景技术

路径规划是无人驾驶车辆研究领域的一项核心技术，它是指无人驾驶车辆根据多种传感器探测出的行驶环境信息，规划出一条从起始点到目标点的无碰撞路线，实现路径的最优化。路径规划主要包含两个步骤：一是建立包含障碍区域与自由区域的环境地图，二是在环境地图中选择合适的路径搜索算法，快速实时地搜索可行路径。路径规划结果对车辆行驶起着导航作用。它引导车辆从当前位置行驶到达目标位置。目前在无人驾驶中运用的路径规划算法有很多，如遗传算法、粒子群算法、A*算法、RRT算法和人工势场算法等。其中，人工势场法具有计算量小、规划路径平滑和便于实时控制等优点而被广泛运用于机器人导航和避碰中。

人工势场法于1986年由Khatib提出。其基本思想是，假设在汽车行驶道路中存在一种虚拟的势场力，目标点对主车产生引力，障碍物对主车产生斥力，主车在引力和斥力的合力控制作用下由高势场向低势场移动，最终到达目标位置。

但是，传统人工势场法仍然存在不足之处，当车辆在行进过程中有可能出现所受的斥力和引力大小相等方向相反，此时车辆在人工势场中所受到的合力为零，车辆陷入局部最优解，从而无法到达目标点。当目标点附近存在障碍物时，随着无人驾驶车辆不断地向目标点逼近，就可能出现障碍物对车辆的斥力远远大于目标点对车辆的引力，从而使得车辆在目标点附近徘徊，出现目标不可达的问题。

因此，传统人工势场法在复杂场景中存在易陷入局部最小点和目标不可达的问题，为解决这些问题，国内外学者对其进行了相应的改进研究：其一是通过在人工势场法的斥力场函数中加入汽车与目标点间距离的方法，使汽车只有在到达目标点时，斥力和引力才同时为零，改进后的人工势场法可以在静态环境中为车辆规划出安全的避障路径；其二是使用选取在障碍物一侧的中间目标点代替真正的目标点引导机器人，使机器人摆脱局部极小点；其三是通过分别引入RRT算法来弥补传统人工势场法容易形成局部最优解的不足；其四是分别通过引入斥力系数和调节因子以及道路边界斥力场模型，设立虚拟局部目标点，建立改进的路径规划模型从而有效地实现智能车辆的避撞局部路径；其五是通过优化吸引力场和排斥力场，并提出一种势场填充策略，使得移动机器人可以找到一条更好、无碰撞的目标路径。但是，上述改进仍然存在无法正常到达的问题。

发明内容

本发明的发明目的是，针对上述问题，提供一种基于人工势场法的无人驾驶车辆路径规划方法，用以解决无人驾驶车辆存在易陷入局部最小点和目标不可达的问题。

为达到上述目的，本发明所采用的技术方案是：一种基于人工势场法的无人驾驶车辆路径规划方法，包括以下步骤：

1)、构建无人驾驶车行驶的二维空间模型，于所述二维空间模型内对无人驾驶车起始点、障碍物以及目标点的坐标进行定位，确定障碍物的个数n，确定无人驾驶车行驶的步长l；

2)、建立由所述障碍物对无人驾驶车产生的斥力场和所述目标点对车辆产生的引力场叠加而成的虚拟势场，所述虚拟势场对所述无人驾驶车辆产生的作用力引导着无人驾驶车辆朝目标行进；

3)使无人驾驶车行驶一个单位步长l，判断无人驾驶车是否陷入局部最小值点，如果是则调用步骤4)，否则进行步骤5)；