一种无人车路径规划方法和装置
技术领域
本发明实施例涉及自动驾驶技术领域，尤其涉及一种无人车路径规划方法和装置。
背景技术
在自动驾驶车辆行驶过程中，路径规划是一个很重要的部分，无人驾驶车辆在行走过程中需要规划出能避开障碍物，同时又符合车辆动力学约束的轨迹，是路径跟踪控制等模块的基础。
传统路径规划算法中通常使用A*算法、势场法、RRT算法等，根据地图障碍物信息进行路径规划。这些算法都不考虑车辆动力学参数，生成的轨迹无法满足车辆动力学参数约束，因此自动驾驶车辆不一定能够按照既定轨迹稳态行驶。传统的混合A*算法在搜索的过程中会考虑车辆动力学，但是在搜索的过程中不考虑每个栅格的代价优先度，导致搜索效率低下，同时生成的轨迹也不够平滑。
发明内容
本发明实施例提供一种无人车路径规划方法和装置，通过对高精度地图信息进行分析，将地图栅格化后对每个栅格根据地图障碍物信息计算斥力，并将斥力作为搜索的代价，能有效提高混合A*算法的避障效率，生成的轨迹符合车辆动力学参数约束。
第一方面，本发明实施例提供一种无人车路径规划方法，包括：
提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划，生成车辆行驶轨迹。
进一步，还包括：
对生成的车辆行驶轨迹进行合理性检测，剔除车辆行驶轨迹中不合理的轨迹点并重新进行车辆路径规划。
进一步，还包括：
对生成的车辆行驶轨迹进行平滑处理，去掉车辆行驶轨迹中抖动的轨迹点。
进一步，提取高精度地图中道路的障碍物信息，并构建道路的栅格地图，具体包括：
获取起点位置和终点位置，并基于导航请求确定规划空间的范围；
从高精度地图中读取规划空间内障碍物元素的位置，所述障碍物元素包括车道级道路边界、路沿石、安全岛、交通护栏和杆状物；
将经纬度转换至通用横轴墨卡托格网系统UTM坐标系，以所述障碍物元素的最小坐标值为原点建立矩形，并基于矩形范围设定栅格分辨率，以所述栅格分辨率的数值为间隔延横纵轴进行切分，得到道路的栅格地图。
进一步，获取栅格地图中每个栅格的斥力系数，具体包括：
对不同的障碍物设置不同的初始斥力等级，其中，路沿石、交通护栏和杆状物为第一初始斥力等级，安全岛为第二初始斥力等级，车道级道路边界为第三初始斥力等级；所述第一初始斥力等级大于所述第二初始斥力等级，所述第二初始斥力等级大于第三初始斥力等级；
在行驶区域内引入势能函数使得障碍物对车辆产生斥力，终点位置对车辆产生引力；基于障碍物元素的位置获取每个栅格的斥力系数。
进一步，对生成的车辆行驶轨迹进行合理性检测，剔除车辆行驶轨迹中不合理的轨迹点并重新进行车辆路径规划，具体包括：
将车辆行驶轨迹作为待检测轨迹进行三次样条插值，以使待检测轨迹中的轨迹点密度不小于栅格地图的分辨率；
碰撞检测，检验三次样条插值后待检测轨迹的第一轨迹点的栅格占位状态，所述第一轨迹点为待检测轨迹中任一轨迹点；若判断获知栅格的斥力权重大于预设斥力权重阈值，则记录第一轨迹点的坐标，返回混合A*算法查找和所述第一轨迹点最近两个扩展轨迹点，在两个所述扩展轨迹点间的连接直线上选取中心点；
将所述第一轨迹点替换为所述中心点，并重复碰撞检测的步骤；
若判断获知待检测轨迹的所有轨迹点所在栅格均不存在障碍物，则输出合理车辆行驶轨迹。
进一步，对生成的车辆行驶轨迹进行平滑处理，去掉车辆行驶轨迹中按照既定轨迹稳态行驶的轨迹点，具体包括：
设定包括障碍物约束、平滑约束和曲率约束的目标函数，设置迭代总次数、学习率，及障碍物约束、平滑约束和曲率约束的约束权重；
对车辆行驶轨迹中每个轨迹点进行障碍物约束、平滑约束和曲率约束的梯度计算，其中，平滑约束和曲率约束的计算不包括起点位置和终点位置；
基于障碍物约束、平滑约束和曲率约束的预设权重获取使目标函数减小的总梯度值；
基于学习率和所述总梯度值获取轨迹点的修正量，基于修正量更新对应轨迹点的位置。
第二方面，本发明实施例提供一种无人车路径规划装置，包括：
高精度地图处理模块，用于提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
障碍物提取模块，基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
车辆路径规划模块，用于基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划。
第三方面，本发明实施例提供一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，所述处理器执行所述程序时实现如本发明第一方面实施例所述无人车路径规划方法的步骤。
第四方面，本发明实施例提供一种非暂态计算机可读存储介质，其上存储有计算机程序，该计算机程序被处理器执行时实现如本发明第一方面实施例所述无人车路径规划方法的步骤。
本发明实施例提供的一种无人车路径规划方法和装置，通过对高精度地图信息进行分析，将地图栅格化后对每个栅格根据地图障碍物信息计算斥力，并将斥力作为搜索的代价，能有效提高混合A*的避障效率，生成的轨迹符合车辆动力学参数。同时使用梯度下降的算法对生成的轨迹进行平滑，最终输出最优轨迹。考虑车辆运动学学约束，使得规划路径具备可行驶性；对每个网格计算势场，能够一定程度减少路径搜索的时间；势场法增强了规划路径的安全性；势场法一定程度的增强了传感误差的容忍度，提高了路径规划的鲁棒性；利用高精地图元素丰富的优势，为不同类别的障碍物分配不同的斥力等级，并且针对车道级道路边界宽度动态斥力权重；采用梯度下降平滑模块对生成的路径进行平滑，更加适合车辆行驶。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍，显而易见地，下面描述中的附图是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例提供的无人车路径规划方法流程框图；
图2为本发明实施例提供的无人车路径规划方法具体流程图；
图3为本发明实施例提供的电子设备实体结构示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
传统路径规划算法中通常使用A*算法、势场法、RRT算法等，根据地图障碍物信息进行路径规划。这些算法都不考虑车辆动力学参数，生成的轨迹无法满足车辆动力学参数因此自动驾驶车辆不一定能够行驶。传统的混合A*算法在搜索的过程中会考虑车辆动力学，但是在搜索的过程中不考虑每个栅格的代价优先度，同时生成的轨迹也不够平滑。
针对现有技术的上述问题，本发明实施例提供一种无人车路径规划方法，通过对高精度地图信息进行分析，将地图栅格化后对每个栅格根据地图障碍物信息计算斥力，并将斥力作为搜索的代价，能有效提高混合A*的避障效率，生成的轨迹符合车辆动力学参数。同时使用梯度下降的算法对生成的轨迹进行平滑，最终输出最优轨迹。参见图1，该方法包括但不限于如下步骤：
步骤S1、提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
步骤S2、基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
步骤S3、获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
步骤S4、基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划，生成车辆行驶轨迹。
自动驾驶汽车，又称无人驾驶汽车、电脑驾驶汽车或者轮式移动机器人，是一种通过电脑系统实现无人驾驶的智能汽车。自动驾驶汽车是通过视频摄像头、雷达传感器以及激光测距器来了解汽车行驶过程中周围的交通状况，并通过本地高精度地图对前方的道路进行导航。
需要说明的是，适用于自动驾驶汽车的高精度地图，不同于日常生活中用于导航的普通电子地图。高精度地图包含的数据信息更加丰富和详细，可以划分为动、静两方面的数据信息。其中，静态数据信息不仅包括基础性的二维道路数据，如车道标记、周边基础设施等，也涵盖了交通管制、道路施工、广域气象等准静态数据。其中，动态数据信息，包括事故、道路拥堵情况以及周边车辆、行人及信号灯等瞬息万变的动态信息数据。此外，不同于普通地图几个月甚至几年更新一次，高精度地图必须保持分钟级、乃至秒级的更新速度。而且，与普通的电子地图相比，高精度地图的定位精准度更高。例如，目前在手机上使用的GNSS导航，其精准度一般在5至10米范围内，即使搭载差分源信号，在楼宇密集地区或地下隧道等场景下也易出现多普勒效应或丢星现象导致定位误差急剧增大。而要满足L3及以上的自动驾驶技术等级，通常需要分米级以上的定位精度，由此能稳定提供厘米级定位的高精度地图在近些年便被广泛推广。
人工势场法路径规划是一种虚拟力法。它的基本思想是将车辆在周围环境中的运动，设计成一种抽象的人造引力场中的运动，目标点对移动车辆产生“引力”，障碍物对移动车辆产生“斥力”，最后通过求合力来控制移动车辆的运动。应用势场法规划出来的路径一般是比较平滑并且安全。
A*算法，A*(A-Star)算法是一种静态路网中求解最短路径最有效的直接搜索方法，也是解决许多搜索问题的有效算法。算法中的距离估算值与实际值越接近，最终搜索速度越快。
图2为本发明实施例提供的无人车路径规划方法具体流程图，参照图1和图2，具体的，本实施例中，通过对高精度地图信息进行分析，将地图栅格化后对每个栅格根据地图障碍物信息计算斥力，并将斥力作为搜索的代价，能有效提高混合A*的避障效率，生成的轨迹符合车辆动力学约束。同时使用梯度下降的算法对生成的轨迹进行平滑，最终输出最优轨迹。考虑车辆运动学约束，使得规划路径具备可行驶性；对每个网格计算势场，能够一定程度减少路径搜索的时间；势场法增强了规划路径的安全性；势场法一定程度的增强了传感误差的容忍度，提高了路径规划的鲁棒性；利用高精地图元素丰富的优势，为不同类别的障碍物分配不同的斥力等级，并且针对车道级道路边界宽度动态斥力权重；采用梯度下降平滑模块对生成的路径进行平滑，更加适合车辆行驶。
具体的，利用混合A*算法，结合车辆动力学参数进行轨迹规划，以下为具体步骤：
步骤1：获取起点位置和终点位置和朝向；
步骤2：根据起点位置获取高精度地图完成栅格化，并根据以上方法对每个栅格计算斥力权重；
步骤3：设置斥力权重阈值，如栅格斥力权重大于此阈值，则判定该栅格存在障碍物；
步骤4：依据车辆的动力学约束生成可行驶运动基元；
步骤5：创建两个储存节点的列表：OpenList列表和CloseList列表；
步骤6：将起点确定为当前点，并放入CloseList列表中；
步骤7：使用运动基元对当前点进行扩展搜索，获得多个扩展节点，判断扩展节点是否在一定误差范围内满足终点位置和航向要求，如是则结束搜索，跳向步骤14；否则进入步骤8；
步骤8：确定扩展节点占据栅格的斥力权重，对每个扩展节点进行碰撞检测，如判定扩展节点占据栅格存在障碍物，则舍弃该节点，否则进入步骤9；
步骤9：计算当前点到扩展节点的代价值g，将斥力权重与原g值的乘积作为新的代价值，并对g值更新；
步骤10：计算扩展节点到终点的代价值h，将g与h的和记录为总代价值f，且确定当前点为扩展节点的父节点；
步骤11：判断扩展节点是否存在于OpenList列表中，如不在，则添加进OpenList列表中，如在，则更新对应的三个代价值与父节点；
步骤12：将当前点放入CloseList列表中；
步骤13：如OpenList列表中仍存在节点，选择f值最小的节点为下一个当前点，跳向步骤7进行下一次搜索；
步骤14：在CloseList列表中根据父节点逆向回溯获得规划路径点(即轨迹点)，得到规划的行驶轨迹。
在一个实施例中，无人车路径规划方法还包括：
对生成的车辆行驶轨迹进行合理性检测，剔除车辆行驶轨迹中不合理的轨迹点并重新进行车辆路径规划。
具体的，由于使用HybridA star算法进行路径搜索时，已经删除了扩展到障碍物所占栅格的节点，因此搜索而得的路径是可行驶的。但是对搜索路径进行轨迹优化时，优化后的轨迹存在碰触到障碍物的可能性，因此在进行轨迹优化后有必要进行碰撞检测，剔除车辆行驶轨迹中不合理的轨迹点并重新进行车辆路径规划。
在一个实施例中，还包括：
对生成的车辆行驶轨迹进行平滑处理，去掉车辆行驶轨迹中按照既定轨迹稳态行驶的轨迹点。
在一个实施例中，提取高精度地图中道路的障碍物信息，并构建道路的栅格地图，具体包括：
获取起点位置和终点位置，并基于导航请求确定规划空间的范围；
从高精度地图中读取规划空间内障碍物元素的位置，所述障碍物元素包括车道级道路边界、路沿石、安全岛、交通护栏和杆状物；
将经纬度转换至通用横轴墨卡托格网系统UTM坐标系，以所述障碍物元素的最小坐标值为原点建立矩形，并基于矩形范围设定栅格分辨率，以所述栅格分辨率的数值为间隔延横纵轴进行切分，得到道路的栅格地图。
在测绘(例如高精度地图的绘制)和导航(例如无人车的导航)中，两点间的相对位置的比较和距离的计算往往建立在投影平面坐标系中，然而GNSS定位系统较多使用地心地固坐标系(ECEF坐标系)，WGS84坐标系即为其中一种，故首先需完成两种坐标系的单位转换(经纬度到米)。通用横墨卡托格网系统(Universal Transverse Mercartor Grid System，UTM)坐标系，是一种平面直角坐标,这种坐标格网系统及其所依据的投影已经广泛用于地形图中，同时作为卫星影像和自然资源数据库的参考格网被应用于各行各业的精确定位。UTM的基本思想是把椭球形的地图面按照小的区块展开，投影到一个曲面(圆柱面或椭球柱面)上，曲面再次展开铺成平面，进而构成平面直角坐标系。
具体的，在本实施例中，对高精度地图数据进行解析，获取其中的道路边界及障碍物信息，构建占位栅格地图，对每个栅格的属性进行分类；其中，栅格存在两种状态；占用或未占用。栅格划分的步骤包括：
确定起终点，并发出导航请求；
根据导航请求信息，确定规划空间的范围；
从高精度地图读取规划空间内的车道级道路边界、路沿石、安全岛、交通护栏和杆状物的位置；
将经纬度转换至UTM平面坐标系，以上述高精地图元素的最小坐标值作为原点建立矩形；
为上述矩形范围设定栅格分辨率，并以分辨率的数值为间隔沿横轴纵轴进行切分。
在一个实施例中，利用人工势场法获取栅格地图中每个栅格的斥力系数，具体包括：
对不同的障碍物设置不同的初始斥力等级，其中，路沿石、交通护栏和杆状物为第一初始斥力等级，安全岛为第二初始斥力等级，车道级道路边界为第三初始斥力等级；所述第一初始斥力等级大于所述第二初始斥力等级，所述第二初始斥力等级大于第三初始斥力等级；
在行驶区域内引入势能函数使得障碍物对车辆产生斥力，终点位置对车辆产生引力；基于障碍物元素的位置获取每个栅格的斥力系数。
具体的，在本实施例中，对栅格化后的栅格根据障碍物信息计算每个栅格的斥力系数，对每个栅格计算权重；具体包括：
针对不同的障碍物类型设置不同的初始斥力等级，其中路沿石、交通护栏和杆状物为同一初始斥力等级，安全岛的初始斥力等级次之，车道级道路边界的初始斥力等级最低，在需满足如下公式：
其中WL表示车道宽度，WV表示车辆宽度，k0表示车道边界的初始斥力等级，因此，车道级道路边界的斥力等级kL在初始斥力等级的基础上随着车辆宽度对车道宽度占比的增大而减小。
势场法，把构型空间比作一个电势场平面，无人车比作空间中一点。如果让无人车的起点和障碍物带正电荷，终点带负电荷，无人车带正电荷。由于同性电荷相斥，异性电荷相吸的原理，无人车将会在电场力的作用下沿着某条路径向终点移动，并避开带正电荷的障碍物。
本实施例中，在可行驶区域内引入势能函数使得障碍物对车辆产生斥力，让终点对车辆产生引力，且栅格的斥力权重越小，表明越远离障碍物边界；可行驶区域即为根据导航请求信息，确定的规划空间。
在一个实施例中，对生成的车辆行驶轨迹进行合理性检测，剔除车辆行驶轨迹中不合理的轨迹点并重新进行车辆路径规划，具体包括：
将车辆行驶轨迹作为待检测轨迹进行三次样条插值，以使待检测轨迹中的轨迹点密度不小于栅格地图的分辨率；
碰撞检测，检验三次样条插值后待检测轨迹的第一轨迹点的栅格占位状态，所述第一轨迹点为待检测轨迹中任一轨迹点；若判断获知栅格的斥力权重大于预设斥力权重阈值，则记录第一轨迹点的坐标，返回混合A*算法查找和所述第一轨迹点最近两个扩展轨迹点，在两个所述扩展轨迹点间的连接直线上选取中心点；
将所述第一轨迹点替换为所述中心点，并重复碰撞检测的步骤；
若判断获知待检测轨迹的所有轨迹点所在栅格均不存在障碍物，则输出合理车辆行驶轨迹。
三次样条插值(Cubic Spline Interpolation)简称Spline插值，是通过一系列形值点的一条光滑曲线，数学上通过求解三弯矩方程组得出曲线函数组的过程。
具体的，在本实施例中，对生成的轨迹进行检查，包括一些不合理的情况，剔除不合理的路径并进行重新规划，直到通过检测；
合理性检测的步骤包括：
由于使用HybridA star算法进行路径搜索时，已经删除了扩展到障碍物所占栅格的节点，因此搜索而得的路径是可行驶的。但是对搜索路径进行轨迹优化时，优化后的轨迹存在碰触到障碍物的可能性，因此在进行轨迹优化后有必要进行碰撞检测。具体步骤如下：
将待检测轨迹进行三次样条插值，目的是令轨迹点的密度至少等于栅格地图分辨率；
检验插值后的轨迹点的栅格占位状态，如该栅格的斥力权重大于设定阈值，则认为该栅格存在障碍物，则记录下点的坐标，并返回混合A星查找和该点最接近的两个点，在两点间的直线上选取中心点，针对前点和中心点重新进行轨迹优化，并重复执行轨迹碰撞检测操作；
如整条轨迹点所处栅格均不存在障碍物，则将该条轨迹输出；
重新规划仅表示路径搜索或轨迹优化程序的再次调用。
在一个实施例中，对生成的车辆行驶轨迹进行平滑处理，去掉车辆行驶轨迹中按照既定轨迹稳态行驶的轨迹点，具体包括：
设定包括障碍物约束、平滑约束和曲率约束的目标函数，设置迭代总次数、学习率，及障碍物约束、平滑约束和曲率约束的约束权重；
对车辆行驶轨迹中每个轨迹点进行障碍物约束、平滑约束和曲率约束的梯度计算，其中，平滑约束和曲率约束的计算不包括起点位置和终点位置；
基于障碍物约束、平滑约束和曲率约束的预设权重获取使目标函数减小的总梯度值；
基于学习率和所述总梯度值获取轨迹点的修正量，基于修正量更新对应轨迹点的位置。
基于设置的迭代总次数迭代后，获得最终平滑的轨迹。
具体的，在本实施例中，对生成的路径进行平滑，去掉抖动的点，使轨迹更加平滑。
对于HybridA star规划而得的路径，确定由障碍物约束、平滑约束及曲率约束三项共同组成的目标函数；
步骤1：设置迭代总次数、学习率及各项约束权重；
步骤2：对路径中每个点进行各项约束的梯度计算，其中平滑约束及曲率约束计算不包括起始点和终止点；
步骤3：根据各项约束的权重计算使得目标函数减小的总梯度值；
步骤4：根据学习率与目标函数总梯度值计算当前点的修正量，并更新当前点位置；
步骤5：如当前迭代次数小于迭代总次数，则重复步骤3至步骤5，否则优化结束，获得优化路径。
本发明实施例还提供一种无人车路径规划装置，基于上述各实施例中的无人车路径规划方法，包括：
高精度地图处理模块，用于提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
障碍物提取模块，基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
车辆路径规划模块，用于基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划。
基于相同的构思，本发明实施例还提供了一种电子设备实体结构示意图，如图3所示，该电子设备可以包括：处理器(processor)301、通信接口(Communications Interface)302、存储器(memory)303和通信总线304，其中，处理器301，通信接口302，存储器303通过通信总线304完成相互间的通信。处理器301可以调用存储器303中的逻辑指令，以执行如下方法：
提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划，生成车辆行驶轨迹。
基于相同的构思，本发明实施例还提供一种非暂态计算机可读存储介质，该计算机可读存储介质存储有计算机程序，该计算机程序包含至少一段代码，该至少一段代码可由主控设备执行，以控制主控设备用以实现如上述各实施例所述无人车路径规划方法的步骤。例如包括：
提取高精度地图中道路的障碍物信息，并构建道路的栅格地图；
基于所述障碍物信息，利用人工势场法获取栅格地图中每个栅格的斥力系数，并基于所述斥力系数得到每个栅格的斥力权重；
获取栅格地图中的占用栅格和未占用栅格，所述占用栅格为存在障碍物的栅格，所述未占用栅格为不存在障碍物的栅格；若判断获知栅格的斥力权重大于预设斥力权重阈值，则判断栅格存在障碍物；
基于起点位置、终点位置、朝向和所述栅格地图，利用混合A*算法和车辆动力学参数进行车辆路径规划，生成车辆行驶轨迹。
基于相同的技术构思，本申请实施例还提供一种计算机程序，当该计算机程序被主控设备执行时，用以实现上述方法实施例。
所述程序可以全部或者部分存储在与处理器封装在一起的存储介质上，也可以部分或者全部存储在不与处理器封装在一起的存储器上。
基于相同的技术构思，本申请实施例还提供一种处理器，该处理器用以实现上述方法实施例。上述处理器可以为芯片。
综上所述，本发明实施例提供的一种无人车路径规划方法和装置，通过对高精度地图信息进行分析，将地图栅格化后对每个栅格根据地图障碍物信息计算斥力，并将斥力作为搜索的代价，能有效提高混合A*的避障效率，生成的轨迹符合车辆动力学参数。同时使用梯度下降的算法对生成的轨迹进行平滑，最终输出最优轨迹。考虑车辆运动学学约束，使得规划路径具备可行驶性；对每个网格计算势场，能够一定程度减少路径搜索的时间；势场法增强了规划路径的安全性；势场法一定程度的增强了传感误差的容忍度，提高了路径规划的鲁棒性；利用高精地图元素丰富的优势，为不同类别的障碍物分配不同的斥力等级，并且针对车道级道路边界宽度动态斥力权重；采用梯度下降平滑模块对生成的路径进行平滑，更加适合车辆行驶。
本发明的各实施方式可以任意进行组合，以实现不同的技术效果。
在上述实施例中，可以全部或部分地通过软件、硬件、固件或者其任意组合来实现。当使用软件实现时，可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载和执行所述计算机程序指令时，全部或部分地产生按照本申请所述的流程或功能。所述计算机可以是通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中，或者从一个计算机可读存储介质向另一个计算机可读存储介质传输，例如，所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线)或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集成的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质，(例如，软盘、硬盘、磁带)、光介质(例如，DVD)、或者半导体介质(例如固态硬盘SolidStateDisk)等。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，该流程可以由计算机程序来指令相关的硬件完成，该程序可存储于计算机可读取存储介质中，该程序在执行时，可包括如上述各方法实施例的流程。而前述的存储介质包括：ROM或随机存储记忆体RAM、磁碟或者光盘等各种可存储程序代码的介质。
最后应说明的是：以上实施例仅用以说明本发明的技术方案，而非对其限制；尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
