[发明专利]一种路径规划的方法、装置及车载终端

说明书

本申请提供了一种路径规划的方法、装置及车载终端，本发明中可以根据栅格地图进行路径规划。由于栅格地图中将图像进行了更细的划分，即将车辆所在的道路划分为更小的单元，依据小单元进行路径规划，进而规划的路径相比于仅依靠车道线进行路径规划来说，更容易规划出直行路径，相比于现有技术，本方案更符合道路行驶规则。

技术领域

本发明涉及汽车导航控制领域，更具体的说，涉及一种路径规划的方法、装置及车载终端。

背景技术

随着自动驾驶技术的发展，自动驾驶车辆在结构化道路环境中的安全高效行驶已成为一大研究热点。其中，结构化道路指的是边缘比较规则，路面平坦，有明显的车道线及其它人工标记的行车道路。例如：高速公路、城市干道等。

在自动驾驶过程中，需要采用车辆行驶路径规划方法规划出一条行驶路径，进而车辆按照行驶路径进行行驶。车辆行驶路径规划方法包括获取车道线信息，根据获取的车道线信息在两条车道线限定出的可通行区域内规划出一条路径，由于两条车道线的宽度较宽，仅仅依靠两条车道线，规划出的路径一般为一条不超出可通行区域范围但行驶方向经常性变化的路径。

但是在结构化道路中，车辆一般沿着车道线的方向直行，因此，采用现有技术的车辆行驶路径规划方法规划出的路径，不符合道路行驶规则。例如，采用车辆行驶路径规划方法规划出的一条行驶路径为图1中的路径，该路径虽然能够达到目的地，但是不符合道路行驶规则。

发明内容

有鉴于此，本发明提供一种路径规划的方法、装置及车载终端，以解决采用现有技术的车辆行驶路径规划方法规划出的路径，不符合道路行驶规则的问题。

为解决上述技术问题，本发明采用了如下技术方案：

一种路径规划的方法，应用于车辆，包括：

生成包含所述车辆所在道路的各个所述车道线对应的模拟车道线以及所述车辆的车体坐标系的图像；其中，所述车体坐标系以所述车辆的后轴中心为原点，所述车辆的车体右侧为横坐标方向，所述车辆的车头方向为纵坐标方向；

当所述图像中所述车体坐标系的原点所在的本车道有模拟左车道线和模拟右车道线、所述模拟左车道线的长度和所述模拟右车道线的长度均大于第一预设数值和所述本车道的宽度大于第二预设数值时，对所述本车道进行栅格化处理，得到第一栅格地图；

其中，所述栅格地图用于为所述车辆的路径规划提供行驶依据，所述模拟左车道线为距离所述本车道最近、且位于所述本车道左侧的模拟车道线，所述模拟右车道线为距离所述本车道最近、且位于所述本车道右侧的模拟车道线。

优选地，所述生成包含所述车辆所在道路的各个所述车道线对应的模拟车道线以及所述车辆的车体坐标系的图像，包括：

建立所述车体坐标系；

获取所述道路的各个所述车道线的数据；其中，各个所述车道线的数据包括各个所述车道线的长度以及各个所述车道线中每个点在所述车体坐标系中的坐标值；

根据各个所述车道线的数据和所述车体坐标系生成所述图像。

优选地，对所述本车道进行栅格化处理，得到第一栅格地图，包括：

根据所述模拟左车道线对应的车道线的数据和所述模拟右车道线对应的车道线的数据，计算所述车体坐标系中纵坐标上任一坐标值的中心坐标；

根据所述本车道的宽度以及所述预设栅格宽度，计算得到栅格宽度；

根据所述栅格宽度、所述本车道上任一位置的坐标值和所述纵坐标上任一坐标值的中心坐标，计算所述本车道中任一位置的栅格编号；

将所述本车道中任一位置的栅格编号显示在所述图像中，得到所述第一栅格地图。

优选地，对所述本车道进行栅格化处理，得到第一栅格地图后，还包括：