CN113916239A - 一种自动驾驶公交车的车道级导航方法 - Google Patents

一种自动驾驶公交车的车道级导航方法 Download PDF

Info

Publication number
CN113916239A
CN113916239A CN202111221197.8A CN202111221197A CN113916239A CN 113916239 A CN113916239 A CN 113916239A CN 202111221197 A CN202111221197 A CN 202111221197A CN 113916239 A CN113916239 A CN 113916239A
Authority
CN
China
Prior art keywords
lane
road
navigation
current
cost
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202111221197.8A
Other languages
English (en)
Other versions
CN113916239B (zh
Inventor
翟唯钧
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Qingzhou Zhihang Technology Co ltd
Original Assignee
Beijing Qingzhou Zhihang Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Qingzhou Zhihang Technology Co ltd filed Critical Beijing Qingzhou Zhihang Technology Co ltd
Priority to CN202111221197.8A priority Critical patent/CN113916239B/zh
Publication of CN113916239A publication Critical patent/CN113916239A/zh
Application granted granted Critical
Publication of CN113916239B publication Critical patent/CN113916239B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明实施例涉及一种自动驾驶公交车的车道级导航方法，所述方法包括：获取公交车的公交线路编号作为当前线路编号；并获取公交车的车辆位置坐标生成起始坐标；并获取公交车的下一停靠站点的站点位置坐标生成结束坐标；查询预设的公交车线路集合，将与当前线路编号匹配的第一线路编号对应的第一道路数据集合作为当前道路数据集合；根据当前道路数据集合，按道路最优通行成本原则对公交车从起始坐标到结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合。本发明可以满足自动驾驶公交车道路导航的实时性要求，可以提高对车辆驾驶安全性的保障。

Description

一种自动驾驶公交车的车道级导航方法
技术领域
本发明涉及数据处理技术领域，特别涉及一种自动驾驶公交车的车道级导航方法。
背景技术
与传统导航地图算法不一样，自动驾驶需要车道级别的导航。目前大多数导航方案都是直接在高精度地图中通过搜索算法直接找到一个车道级别的导航结果。但随着地图车道数量增大和拓扑关系更加复杂，搜索的算法会更加耗时，无法满足自动驾驶规划模块的实时性要求，因此会不得不把道路规划和导航做成异步执行，但是这样又降低了道路导航的实时性。对于承载了众多乘客的自动驾驶公交车而言，对驾驶安全性和道路导航实时性的要求都较普通家用车辆更高，常规的这种导航方案无疑是不能满足自动驾驶公交车导航需求的。
发明内容
本发明的目的，就是针对现有技术的缺陷，提供一种自动驾驶公交车的车道级导航方法、电子设备及计算机可读存储介质，从已知的公交车线路数据集合中获取当前行驶道路的道路分段信息和各分段道路的车道信息，再以车辆当前位置所在分段车道为起始车道，以下一停靠站点所在分段车道为结束车道，再结合当前各个车道的路权信息按最优通行成本规划从起始车道到结束车道的导航车道序列，从而得到实时的车道级导航信息。本发明基于公交车路线固定的特点可以省去根据车辆定位在高精度地图中的道路导航计算时间，以不变的停靠站点为当前导航目标点可以减少根据变动目标在高精度地图中的车道导航的计算量和计算时间，使用最优通行成本计算原则替换传统定位搜索算法可以降低计算复杂度和计算时间。通过本发明，可以满足自动驾驶公交车道路导航的实时性要求，可以提高对车辆驾驶安全性的保障。
为实现上述目的，本发明实施例第一方面提供了一种自动驾驶公交车的车道级导航方法，所述方法包括：
获取公交车的公交线路编号作为当前线路编号；并获取所述公交车的车辆位置坐标生成起始坐标；并获取所述公交车的下一停靠站点的站点位置坐标生成结束坐标；
查询预设的公交车线路集合，将与所述当前线路编号匹配的第一线路编号对应的第一道路数据集合作为当前道路数据集合；所述公交车线路集合包括多个第一公交车线路；所述第一公交车线路包括所述第一线路编号和所述第一道路数据集合；
根据所述当前道路数据集合，按道路最优通行成本原则对所述公交车从所述起始坐标到所述结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合。
优选的，所述第一道路数据集合包括多个第一路段数据集合；
所述第一路段数据集合包括第一路段标识数据、第一路段坐标范围和多个第一车道数据集合；
所述第一车道数据集合包括第一车道标识数据、第一车道坐标范围和第一路权数据；
所述第一车道级导航数据集合包括多个第一导航车道数据组；
所述第一导航车道数据组包括第二路段标识数据和第二车道标识数据。
优选的，所述根据所述当前道路数据集合，按道路最优通行成本原则对所述公交车从所述起始坐标到所述结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合，具体包括：
在所述当前道路数据集合中，将包含了所述起始坐标的所述第一路段坐标范围对应的所述第一路段标识数据记为起始路段标识数据，将包含了所述结束坐标的所述第一路段坐标范围对应的所述第一路段标识数据记为结束路段标识数据；
将所述当前道路数据集合中，所述第一路段标识数据从所述起始路段标识数据到所述结束路段标识数据的所有所述第一路段数据集合，按从起始路段到结束路段的顺序进行排序组成导航道路数据集合；所述导航道路数据集合包括多个导航路段数据集合，所述导航路段数据集合的数量为路段总数N；
根据第1个导航路段数据集合，计算所述公交车从所述起始坐标到第1导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA0003312688310000031
M1≥j1≥1，M1为第1导航路段的车道总数；
根据第i个导航路段数据集合和第i-1导航路段各个车道的所述第一车道成本
Figure BDA0003312688310000032
计算所述公交车从所述起始坐标到第i导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA0003312688310000033
N≥i≥2,Mi-1≥ji-1≥1，Mi≥ji≥1，Mi-1、Mi分别为第i-1和第i导航路段的车道总数；
将最后一个所述第一车道成本
Figure BDA0003312688310000034
作为当前道路最优通行成本；并为参与计算所述当前道路最优通行成本的各个车道设置一个对应的所述第一导航车道数据组；设置所述第一导航车道数据组的所述第二路段标识数据为当前车道对应的所述第一路段标识数据，设置所述第二车道标识数据为当前车道对应的所述第一车道标识数据；
按从所述起始坐标到所述结束坐标的车道变换顺序，对各个车道对应的所述第一导航车道数据组进行排序，得到所述第一车道级导航数据集合。
进一步的，所述根据第1个导航路段数据集合，计算所述公交车从所述起始坐标到第1导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA0003312688310000035
具体包括：
在所述第1个导航路段数据集合中，将包含了所述起始坐标的所述第一车道坐标范围对应的所述第一车道数据集合对应的车道记为起始车道S；
计算所述起始车道S对应的第一车道成本
Figure BDA0003312688310000041
Figure BDA0003312688310000042
为所述第1个导航路段数据集合中与所述起始车道S对应的所述第一车道数据集合的所述第一路权数据；
将所述第i导航路段中所述起始车道S之外的任一车道设为其他车道O；
计算任一其他车道O对应的第一车道成本
Figure BDA0003312688310000043
LC为预设的单次变道成本因子，
Figure BDA0003312688310000044
为从所述起始车道S到当前其他车道O的变道次数，
Figure BDA0003312688310000045
为所述第1个导航路段数据集合中与所述当前其他车道O对应的所述第一车道数据集合的所述第一路权数据。
进一步的，所述根据第i个导航路段数据集合和第i-1导航路段各个车道的所述第一车道成本
Figure BDA0003312688310000046
计算所述公交车从所述起始坐标到第i导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA0003312688310000047
具体包括：
在i<N时将所述第i导航路段中任一车道设为当前车道A，在i＝N时将所述第i导航路段中所述结束坐标对应的车道设为当前车道A；并将所述第i导航路段中所述当前车道A之外的任一车道设为其他车道B；并将所述第i-1导航路段中与所述当前车道A连接的前一车道设为对应的前一车道A’,与任一其他车道B连接的前一车道设为对应的前一车道B’；
计算所述当前车道A对应的第一跟随车道成本
Figure BDA0003312688310000048
Figure BDA0003312688310000049
为对应的所述前一车道A’的第一车道成本，
Figure BDA00033126883100000410
为从所述第1导航路段的起始车道S到对应的所述前一车道A’的累计变道次数，
Figure BDA00033126883100000411
为所述第i个导航路段数据集合中与所述当前车道A对应的所述第一车道数据集合的所述第一路权数据；
计算任一其他车道B对应的第一跟随车道成本
Figure BDA0003312688310000051
Figure BDA0003312688310000052
为与当前其他车道B对应的所述前一车道B’的第一车道成本，
Figure BDA0003312688310000053
为从所述起始车道S到对应的所述前一车道B’的累计变道次数，
Figure BDA0003312688310000054
为所述第i个导航路段数据集合中与所述当前其他车道B对应的所述第一车道数据集合的所述第一路权数据；
计算所述当前车道A与任一其他车道B对应的第一变道车道成本
Figure BDA0003312688310000055
并从得到的多个所述第一变道车道成本
Figure BDA0003312688310000056
中，取最小值记为所述当前车道A对应的第一最小变道车道成本
Figure BDA0003312688310000057
Figure BDA0003312688310000058
为所述当前车道A对应的当前其他车道B的第一跟随车道成本，LC为预设的单次变道成本因子，
Figure BDA0003312688310000059
为从所述当前其他车道B到所述当前车道A的变道次数，
Figure BDA00033126883100000510
为所述第i个导航路段数据集合中与所述当前车道A对应的所述第一车道数据集合的所述第一路权数据；
从所述当前车道A对应的所述第一跟随车道成本
Figure BDA00033126883100000511
和所述第一最小变道车道成本
Figure BDA00033126883100000512
中，取最小值作为所述当前车道A对应的所述第一车道成本
Figure BDA00033126883100000513
本发明实施例第二方面提供了一种电子设备，包括：存储器、处理器和收发器；
所述处理器用于与所述存储器耦合，读取并执行所述存储器中的指令，以实现上述第一方面所述的方法步骤；
所述收发器与所述处理器耦合，由所述处理器控制所述收发器进行消息收发。
本发明实施例第三方面提供了一种计算机可读存储介质，所述计算机可读存储介质存储有计算机指令，当所述计算机指令被计算机执行时，使得所述计算机执行上述第一方面所述的方法的指令。
本发明实施例提供了一种自动驾驶公交车的车道级导航方法、电子设备及计算机可读存储介质，从已知的公交车线路数据集合中获取当前行驶道路的道路分段信息和各分段道路的车道信息，再以车辆当前位置所在分段车道为起始车道，以下一停靠站点所在分段车道为结束车道，再结合当前各个车道的路权信息按最优通行成本规划从起始车道到结束车道的导航车道序列，从而得到实时的车道级导航信息。本发明基于公交车路线固定的特点可以省去根据车辆定位在高精度地图中的道路导航计算时间，以不变的停靠站点为当前导航目标点可以减少根据变动目标在高精度地图中的车道导航的计算量和计算时间，使用最优通行成本计算原则替换传统定位搜索算法可以降低计算复杂度和计算时间。通过本发明，满足了自动驾驶公交车道路导航的实时性要求，提高了对车辆驾驶安全性的保障。
附图说明
图1为本发明实施例一提供的一种自动驾驶公交车的车道级导航方法示意图；
图2a为本发明实施例一提供的公交道路路段与分段车道示意图；
图2b为本发明实施例一提供的标记了路权数据的分段车道示意图；
图2c为本发明实施例一提供的标记了车道成本的分段车道示意图；
图2d为本发明实施例一提供的车道导航示意图；
图3为本发明实施例二提供的一种电子设备的结构示意图。
具体实施方式
为了使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明作进一步地详细描述，显然，所描述的实施例仅仅是本发明一部份实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例，都属于本发明保护的范围。
本发明实施例一提供的一种自动驾驶公交车的车道级导航方法，如图1为本发明实施例一提供的一种自动驾驶公交车的车道级导航方法示意图所示，本方法主要包括如下步骤：
步骤1，获取公交车的公交线路编号作为当前线路编号；并获取公交车的车辆位置坐标生成起始坐标；并获取公交车的下一停靠站点的站点位置坐标生成结束坐标。
这里，车辆位置坐标和站点位置坐标可以为高精地图的地图坐标，也可以为所在道路的道路坐标；地图坐标常见的都是采用二维或三维的世界坐标系；道路坐标以道路中心线为参考，包括横向坐标和纵向坐标，横向坐标为位置点距离道路中心线的垂直距离，纵向坐标为位置点在道路中心线上的垂点距离道路中心线起始点的距离；若车辆位置坐标和站点位置坐标为高精地图的地图坐标，则需要对二者进行地图坐标-道路坐标的转换处理，将转换结果作为对应的起始坐标和结束坐标；若车辆位置坐标和站点位置坐标为所在道路的道路坐标，则直接将二者作为对应的起始坐标和结束坐标。
步骤2，查询预设的公交车线路集合，将与当前线路编号匹配的第一线路编号对应的第一道路数据集合作为当前道路数据集合；
其中，公交车线路集合包括多个第一公交车线路；第一公交车线路包括第一线路编号和第一道路数据集合；第一道路数据集合包括多个第一路段数据集合；第一路段数据集合包括第一路段标识数据、第一路段坐标范围和多个第一车道数据集合；第一车道数据集合包括第一车道标识数据、第一车道坐标范围和第一路权数据。
这里，公交车线路集合为高精地图中的与公交车线路有关的数据集合；每个第一公交车线路对应一个固定的公交线路，第一线路编号为对应公交线路的固定编号，第一道路数据集合为对应公交线路的公交道路数据集合；
每条公交道路被虚拟地划分为多个连续的公交道路路段，每个第一路段数据集合对应一个公交道路路段；对公交道路路段从起始路段到结束路段进行连续编号，第一路段标识数据用于记录对应道路路段的编号信息，如图2a为本发明实施例一提供的公交道路路段与分段车道示意图所示，当前道路包括3个公交道路路段，对应的第一路段标识数据分别为1、2、3；第一路段坐标范围为对应道路路段的道路坐标范围，该范围可以为对应道路路段的道路中心线首尾位置道路坐标构成的坐标范围，也可以为对应道路路段四个顶点道路坐标构成的坐标范围；
每条公交道路实际由横向排列的多个相邻车道组成，自然在每个公交道路路段也就包括多个相邻的分段车道，每个第一车道数据集合对应当前道路路段中的一个分段车道；按指定方向对对分段车道从左到右或从右到左进行连续编号，第一车道标识数据用于记录对应分段车道的编号信息，如图2a所示，当前道路包括3个相邻车道(1、2、3)，3个相邻车道由3个公交道路路段划分为9个分段车道，对应的第一车道标识数据可分别被设为1-1、1-2、1-3、2-1、2-2、2-3、3-1、3-2、3-3；第一车道坐标范围为对应分段车道的道路坐标范围，该范围可以为对应分段车道的道路中心线首尾位置道路坐标构成的坐标范围，也可以为对应分段车道四个顶点道路坐标构成的坐标范围；第一路权数据用于标识当前对应分段车道的车道使用状态权值，第一路权数据常规包括可通行路权值、障碍物路权值、禁止通行路权值、管制通行路权值等，还可基于其他车道使用状态类型对第一路权数据对应的权值类型进行扩充，常规情况下可通行路权值会被初始化为0，障碍物路权值、禁止通行路权值、管制通行路权值等都被初始化为一个大数，例如障碍物路权值＝10000、管制通行路权值＝30000、禁止通行路权值＝30000。
步骤3，根据当前道路数据集合，按道路最优通行成本原则对公交车从起始坐标到结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合；
其中，第一车道级导航数据集合包括多个第一导航车道数据组；第一导航车道数据组包括第二路段标识数据和第二车道标识数据；
这里，本发明实施例在进行具体车道导航计算时，使用道路最优通行成本原则的计算方式替换常规的地图搜索算法，可以降低导航计算的复杂度；道路最优通行成本原则实际就是从起始坐标所在公交道路路段开始，到结束坐标所在公交道路路段为止，按分段计算的方式计算出从起始坐标到各个连续公交道路路段中各个分段车道的最低通行成本；该分段计算方式中每个分段车道的最低通行成本都与其在前一分段的连接分段车道或在同一分段的其他平行分段车道的最低通行成本相关；基于该分段计算方式，在完成对结束坐标所在分段车道对应的最低通行成本计算之后，就能反向获得与该最低通行成本对应的从起始坐标所在分段车道到结束坐标所在分段车道的所有分段车道信息，对该所有分段车道信息按前后车道变换顺序排序就可以得到所需的车道导航信息也就是第一车道级导航数据集合；
具体包括：步骤31，在当前道路数据集合中，将包含了起始坐标的第一路段坐标范围对应的第一路段标识数据记为起始路段标识数据，将包含了结束坐标的第一路段坐标范围对应的第一路段标识数据记为结束路段标识数据；
这里，若第一路段坐标范围为对应道路路段的道路中心线首尾位置道路坐标构成的坐标范围，那么首先计算起始坐标或结束坐标在道路中心线上的垂点坐标记为对应的起始垂点坐标或结束垂点坐标，若起始垂点坐标或结束垂点坐标在第一路段坐标范围之内则认定第一路段坐标范围包含了起始坐标或结束坐标；若第一路段坐标范围为对应道路路段四个顶点道路坐标构成的坐标范围，那么在起始坐标或结束坐标处于这四个顶点道路坐标构成的坐标范围时，认定第一路段坐标范围包含了起始坐标或结束坐标；
步骤32，将当前道路数据集合中，第一路段标识数据从起始路段标识数据到结束路段标识数据的所有第一路段数据集合，按从起始路段到结束路段的顺序进行排序组成导航道路数据集合；导航道路数据集合包括多个导航路段数据集合，导航路段数据集合的数量为路段总数N；
这里，以图2a为例，起始坐标所在公交道路路段对应的第一路段标识数据也就是起始路段标识数据为1，结束坐标所在公交道路路段对应的第一路段标识数据也就是结束路段标识数据为3，那么第一路段标识数据从起始路段标识数据到结束路段标识数据的所有第一路段数据集合也就是第一路段标识数据从1到3的所有第一路段数据集合，也就是说导航道路数据集合的3个导航路段数据集合依次应为：第一路段标识数据为1、2、3的第一路段数据集合；图2a的路段总数N为3；
步骤33，根据第1个导航路段数据集合，计算公交车从起始坐标到第1导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA0003312688310000101
其中，
Figure BDA0003312688310000102
的左脚标与具体导航路段一一对应，左脚标为1对应的是第1导航路段，右脚标j1与具体分段车道一一对应，M1≥j1≥1，M1为第1导航路段的车道总数；
这里，第1个导航路段数据集合对应第1导航路段也就是起始公交道路路段，在计算起始公交道路路段中各个分段车道对应的最优通行成本时，先对起始坐标所在分段车道也就是起始车道的第一车道成本进行初始化，再基于起始车道的第一车道成本对其他车道按变道成本进行计算得到对应的第一车道成本；
具体包括：步骤331，在第1个导航路段数据集合中，将包含了起始坐标的第一车道坐标范围对应的第一车道数据集合对应的车道记为起始车道S；
步骤332，计算起始车道S对应的第一车道成本
Figure BDA0003312688310000103
其中，
Figure BDA0003312688310000104
为第1个导航路段数据集合中与起始车道S对应的第一车道数据集合的第一路权数据；
这里，以图2b为本发明实施例一提供的标记了路权数据的分段车道示意图为例，起始车道S为分段车道1-3，对应的第一路权数据也就是
Figure BDA0003312688310000105
为可通行路权值0，那么起始车道S的第一车道成本
Figure BDA0003312688310000106
步骤333，将第i导航路段中起始车道S之外的任一车道设为其他车道O；
步骤334，计算任一其他车道O对应的第一车道成本
Figure BDA0003312688310000111
其中，LC为预设的单次变道成本因子，
Figure BDA0003312688310000112
为从起始车道S到当前其他车道O的变道次数，
Figure BDA0003312688310000113
为第1个导航路段数据集合中与当前其他车道O对应的第一车道数据集合的第一路权数据；
这里，LC常规被设置为常数值1000；
例如，如图2b所示，起始车道S为分段车道1-3，其他车道O包括分段车道1-1和分段车道1-2，已知起始车道S的第一车道成本
Figure BDA0003312688310000114
为0；
那么，当其他车道O为分段车道1-2时，
Figure BDA0003312688310000115
为分段车道1-2的第一路权数据，其值为可通行路权值0；
Figure BDA0003312688310000116
为从分段车道1-3到分段车道1-2的变道次数，其值为1；则分段车道1-2的第一车道成本
Figure BDA0003312688310000117
如图2c为本发明实施例一提供的标记了车道成本的分段车道示意图所示；
当其他车道O为分段车道1-1时，
Figure BDA0003312688310000118
为分段车道1-1的第一路权数据，其值为可通行路权值0；
Figure BDA0003312688310000119
为从分段车道1-3到分段车道1-1的变道次数，其值为2；则分段车道1-1的第一车道成本
Figure BDA00033126883100001110
如图2c所示；
步骤34，根据第i个导航路段数据集合和第i-1导航路段各个车道的第一车道成本
Figure BDA00033126883100001111
计算公交车从起始坐标到第i导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure BDA00033126883100001112
其中，N≥i≥2,Mi-1≥ji-1≥1，Mi≥ji≥1，Mi-1、Mi分别为第i-1和第i导航路段的车道总数；
这里，i的取值从2到N，第i个导航路段数据集合包括第2-N个导航路段数据集合，第i导航路段包括第2-N导航路段，ji对应每个导航路段上的分段车道，ji包括j2-jN；
每个分段车道的最低通行成本都与其在前一分段的连接分段车道或在同一分段的其他平行分段车道的最低通行成本相关；在计算时，以当前分段车道为前一分段的连接分段车道的跟随车道，根据前一车道的最低通行成本计算出对应的跟随车道成本；再以当前分段车道为同一分段其他的车道的变道车道，根据其他车道的最低通行成本计算出中对应的变道车道成本，再从多个变道车道成本中取最小值作为最小变道车道成本；再从最小变道车道成本和跟随车道成本中取最小值，作为当前分段车道的第一车道成本；
具体包括：步骤341，在i<N时将第i导航路段中任一车道设为当前车道A，在i＝N时将第i导航路段中结束坐标对应的车道设为当前车道A；并将第i导航路段中当前车道A之外的任一车道设为其他车道B；并将第i-1导航路段中与当前车道A连接的前一车道设为对应的前一车道A’,与任一其他车道B连接的前一车道设为对应的前一车道B’；
步骤342，计算当前车道A对应的第一跟随车道成本
Figure BDA0003312688310000121
其中，
Figure BDA0003312688310000122
为对应的前一车道A’的第一车道成本，
Figure BDA0003312688310000123
为从第1导航路段的起始车道S到对应的前一车道A’的累计变道次数，
Figure BDA0003312688310000124
为第i个导航路段数据集合中与当前车道A对应的第一车道数据集合的第一路权数据；
步骤343，计算任一其他车道B对应的第一跟随车道成本
Figure BDA0003312688310000125
其中，
Figure BDA0003312688310000126
为与当前其他车道B对应的前一车道B’的第一车道成本，
Figure BDA0003312688310000127
为从起始车道S到对应的前一车道B’的累计变道次数，
Figure BDA0003312688310000128
为第i个导航路段数据集合中与当前其他车道B对应的第一车道数据集合的第一路权数据；
步骤344，计算当前车道A与任一其他车道B对应的第一变道车道成本
Figure BDA0003312688310000131
并从得到的多个第一变道车道成本
Figure BDA0003312688310000132
中，取最小值记为当前车道A对应的第一最小变道车道成本
Figure BDA0003312688310000133
其中，
Figure BDA0003312688310000134
为当前车道A对应的当前其他车道B的第一跟随车道成本，LC为预设的单次变道成本因子，
Figure BDA0003312688310000135
为从当前其他车道B到当前车道A的变道次数，
Figure BDA0003312688310000136
为第i个导航路段数据集合中与当前车道A对应的第一车道数据集合的第一路权数据；
步骤345，从当前车道A对应的第一跟随车道成本
Figure BDA0003312688310000137
和第一最小变道车道成本
Figure BDA0003312688310000138
中，取最小值作为当前车道A对应的第一车道成本
Figure BDA0003312688310000139
步骤35，将最后一个第一车道成本
Figure BDA00033126883100001310
作为当前道路最优通行成本；并为参与计算当前道路最优通行成本的各个车道设置一个对应的第一导航车道数据组；设置第一导航车道数据组的第二路段标识数据为当前车道对应的第一路段标识数据，设置第二车道标识数据为当前车道对应的第一车道标识数据；
这里，最后一个第一车道成本
Figure BDA00033126883100001311
也就是结束坐标对应分段车道的第一车道成本，也即是从起始坐标所在分段车道到结束坐标分段车道的道路最优通行成本；参与计算得到该道路最优通行成本的所有分段车道也就是当前最优通行成本对应的最优导航车道；本发明实施例为每个最优导航车道配置一个第一导航车道数据组，其中的第二路段标识数据即是该最优导航车道所在道路分段的路段标识也就是第一路段标识数据，第二车道标识数据即是该最优导航车道的车道标识也就是第一车道标识数据；
步骤36，按从起始坐标到结束坐标的车道变换顺序，对各个车道对应的第一导航车道数据组进行排序，得到第一车道级导航数据集合。
为便于理解，下文给出具体示例对上述步骤34-36予以进一步说明。
以图2b为例，N＝3,则i的取值从2-3；
1、当i＝2时，第i-1导航路段为第1导航路段也就是公交道路路段1；因为N＝3，i<N，所以当前车道A分别为分段车道2-1、分段车道2-2和分段车道2-3；
1.1)计算当前车道A(分段车道2-1)对应的第一车道成本
Figure BDA0003312688310000141
在当前车道A为分段车道2-1时，前一车道A’为分段车道1-1；其他车道B包括分段车道2-2和分段车道2-3；当其他车道B为分段车道2-2时对应的前一车道B’为分段车道1-2，当其他车道B为分段车道2-3时对应的前一车道B’为分段车道1-3；
1.1.1)计算当前车道A(分段车道2-1)的第一跟随车道成本：
Figure BDA0003312688310000142
为前一车道A’也就是分段车道1-1的第一车道成本2000，
Figure BDA0003312688310000143
为从起始车道S也就是分段车道1-3到分段车道1-1的累计变道次数2，
Figure BDA0003312688310000144
为分段车道2-1的第一路权数据也就是可通行路权值0，那么，当前车道A(分段车道2-1)的第一跟随车道成本
Figure BDA0003312688310000145
1.1.2)计算其他车道B(分段车道2-2、分段车道2-3)的第一跟随车道成本：
在其他车道B为分段车道2-2时，
Figure BDA0003312688310000146
为前一车道B’也就是分段车道1-2的第一车道成本1000，
Figure BDA0003312688310000147
为从起始车道S也就是分段车道1-3到分段车道1-2的累计变道次数1，
Figure BDA0003312688310000148
为分段车道2-2的第一路权数据也就是可通行路权值0，那么，其他车道B(分段车道2-2)的第一跟随车道成本
Figure BDA0003312688310000149
在其他车道B为分段车道2-3时，
Figure BDA0003312688310000151
为前一车道B’也就是分段车道1-3的第一车道成本0，
Figure BDA0003312688310000152
为从起始车道S也就是分段车道1-3到分段车道1-3的累计变道次数0，
Figure BDA0003312688310000153
为分段车道2-3的第一路权数据也就是障碍物路权值10000，那么，其他车道B(分段车道2-3)的第一跟随车道成本
Figure BDA0003312688310000154
1.1.3)计算当前车道A(分段车道2-1)与其他车道B的第一最小变道车道成本：
在其他车道B为分段车道2-2时，
Figure BDA0003312688310000155
为其他车道B(分段车道2-2)的第一跟随车道成本1001，LC为1000，
Figure BDA0003312688310000156
为从其他车道B(分段车道2-2)到当前车道A(分段车道2-1)的变道次数1，
Figure BDA0003312688310000157
为当前车道A(分段车道2-1)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道2-1)与其他车道B(分段车道2-2)对应的第一变道车道成本
Figure BDA0003312688310000158
在其他车道B为分段车道2-3时，
Figure BDA0003312688310000159
为其他车道B(分段车道2-3)的第一跟随车道成本10000，LC为1000，
Figure BDA00033126883100001510
为从其他车道B(分段车道2-3)到当前车道A(分段车道2-1)的变道次数2，
Figure BDA00033126883100001511
为当前车道A(分段车道2-1)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道2-1)与其他车道B(分段车道2-3)对应的第一变道车道成本
Figure BDA00033126883100001512
从当前车道A(分段车道2-1)与其他车道B(分段车道2-2)对应的第一变道车道成本2001与当前车道A(分段车道2-1)与其他车道B(分段车道2-3)对应的第一变道车道成本12000中取最小值，则当前车道A(分段车道2-1)对应的第一最小变道车道成本
Figure BDA00033126883100001513
为2001；
1.1.4)确定当前车道A(分段车道2-1)的第一车道成本：
从当前车道A(分段车道2-1)对应的第一跟随车道成本2002和第一最小变道车道成本
Figure BDA0003312688310000161
2001中取最小值，则当前车道A(分段车道2-1)对应的第一车道成本
Figure BDA0003312688310000162
为2001；如图2c所示；
1.2)计算当前车道A(分段车道2-2)对应的第一车道成本
Figure BDA0003312688310000163
在当前车道A为分段车道2-2时，前一车道A’为分段车道1-2；其他车道B包括分段车道2-1和分段车道2-3；当其他车道B为分段车道2-1时对应的前一车道B’为分段车道1-1，当其他车道B为分段车道2-3时对应的前一车道B’为分段车道1-3；
1.2.1)计算当前车道A(分段车道2-2)的第一跟随车道成本：
当前车道A(分段车道2-2)的第一跟随车道成本为1001；
1.2.2)计算其他车道B(分段车道2-1、分段车道2-3)的第一跟随车道成本：
在其他车道B为分段车道2-1时，其他车道B(分段车道2-1)的第一跟随车道成本为2002；
在其他车道B为分段车道2-3时，其他车道B(分段车道2-3)的第一跟随车道成本为10000；
1.2.3)计算当前车道A(分段车道2-2)与其他车道B的第一最小变道车道成本：
在其他车道B为分段车道2-1时，
Figure BDA0003312688310000164
为其他车道B(分段车道2-1)的第一跟随车道成本2002，LC为1000，
Figure BDA0003312688310000165
为从其他车道B(分段车道2-1)到当前车道A(分段车道2-2)的变道次数1，
Figure BDA0003312688310000166
为当前车道A(分段车道2-2)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道2-2)与其他车道B(分段车道2-1)对应的第一变道车道成本
Figure BDA0003312688310000167
在其他车道B为分段车道2-3时，
Figure BDA0003312688310000168
为其他车道B(分段车道2-3)的第一跟随车道成本10000，LC为1000，
Figure BDA0003312688310000171
为从其他车道B(分段车道2-3)到当前车道A(分段车道2-2)的变道次数1，
Figure BDA0003312688310000172
为当前车道A(分段车道2-2)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道2-2)与其他车道B(分段车道2-3)对应的第一变道车道成本
Figure BDA0003312688310000173
从当前车道A(分段车道2-2)与其他车道B(分段车道2-1)对应的第一变道车道成本2002与当前车道A(分段车道2-2)与其他车道B(分段车道2-3)对应的第一变道车道成本11000中取最小值，则当前车道A(分段车道2-2)对应的第一最小变道车道成本
Figure BDA0003312688310000174
为2002；
1.2.4)确定当前车道A(分段车道2-2)的第一车道成本：
从当前车道A(分段车道2-2)对应的第一跟随车道成本1001和第一最小变道车道成本
Figure BDA0003312688310000175
2002中取最小值，则当前车道A(分段车道2-2)对应的第一车道成本
Figure BDA0003312688310000176
为1001；如图2c所示；
1.3)计算当前车道A(分段车道2-3)对应的第一车道成本
Figure BDA0003312688310000177
在当前车道A为分段车道2-3时，前一车道A’为分段车道1-3；其他车道B包括分段车道2-1和分段车道2-2；当其他车道B为分段车道2-1时对应的前一车道B’为分段车道1-1，当其他车道B为分段车道2-2时对应的前一车道B’为分段车道1-2；
1.3.1)计算当前车道A(分段车道2-3)的第一跟随车道成本：
当前车道A(分段车道2-3)的第一跟随车道成本为10000；
1.3.2)计算其他车道B(分段车道2-1、分段车道2-2)的第一跟随车道成本：
在其他车道B为分段车道2-1时，其他车道B(分段车道2-1)的第一跟随车道成本为2002；
在其他车道B为分段车道2-2时，其他车道B(分段车道2-2)的第一跟随车道成本为1001；
1.3.3)计算当前车道A(分段车道2-3)与其他车道B的第一最小变道车道成本：
在其他车道B为分段车道2-1时，
Figure BDA0003312688310000181
为其他车道B(分段车道2-1)的第一跟随车道成本2002，LC为1000，
Figure BDA0003312688310000182
为从其他车道B(分段车道2-1)到当前车道A(分段车道2-3)的变道次数2，
Figure BDA0003312688310000183
为当前车道A(分段车道2-3)的第一路权数据也就是障碍物路权值10000，那么当前车道A(分段车道2-3)与其他车道B(分段车道2-1)对应的第一变道车道成本
Figure BDA0003312688310000184
在其他车道B为分段车道2-3时，
Figure BDA0003312688310000185
为其他车道B(分段车道2-2)的第一跟随车道成本1001，LC为1000，
Figure BDA0003312688310000186
为从其他车道B(分段车道2-2)到当前车道A(分段车道2-3)的变道次数1，
Figure BDA0003312688310000187
为当前车道A(分段车道2-3)的第一路权数据也就是障碍物路权值10000，那么当前车道A(分段车道2-3)与其他车道B(分段车道2-2)对应的第一变道车道成本
Figure BDA0003312688310000188
从当前车道A(分段车道2-3)与其他车道B(分段车道2-1)对应的第一变道车道成本14002与当前车道A(分段车道2-2)与其他车道B(分段车道2-2)对应的第一变道车道成本12001中取最小值，则当前车道A(分段车道2-3)对应的第一最小变道车道成本
Figure BDA0003312688310000189
为12001；
1.3.4)确定当前车道A(分段车道2-3)的第一车道成本：
从当前车道A(分段车道2-3)对应的第一跟随车道成本10000和第一最小变道车道成本
Figure BDA00033126883100001810
12001中取最小值，则当前车道A(分段车道2-3)对应的第一车道成本
Figure BDA00033126883100001811
为12001；如图2c所示。
2、当i＝3时，第i-1导航路段为第2导航路段也就是公交道路路段2；因为N＝3，i＝N，所以当前车道A为结束坐标对应的车道也就是为分段车道3-1；
2.1)计算当前车道A(分段车道3-1)对应的第一车道成本
Figure BDA0003312688310000191
在当前车道A为分段车道3-1时，前一车道A’为分段车道2-1；其他车道B包括分段车道3-2和分段车道3-3；当其他车道B为分段车道3-2时对应的前一车道B’为分段车道2-2，当其他车道B为分段车道3-3时对应的前一车道B’为分段车道2-3；
2.1.1)计算当前车道A(分段车道3-1)的第一跟随车道成本：
在当前车道A为分段车道3-1时，
Figure BDA0003312688310000192
为前一车道A’也就是分段车道2-1的第一车道成本2001，
Figure BDA0003312688310000193
为从起始车道S也就是分段车道1-3到分段车道2-1的累计变道次数2，
Figure BDA0003312688310000194
为分段车道3-1的第一路权数据也就是可通行路权值0，那么，当前车道A(分段车道3-1)的第一跟随车道成本
Figure BDA0003312688310000195
2.1.2)计算其他车道B(分段车道3-2、分段车道3-3)的第一跟随车道成本：
在其他车道B为分段车道3-2时，
Figure BDA0003312688310000196
为前一车道B’也就是分段车道2-2的第一车道成本1001，
Figure BDA0003312688310000197
为从起始车道S也就是分段车道1-3到分段车道2-2的累计变道次数1，
Figure BDA0003312688310000198
为分段车道3-2的第一路权数据也就是禁止通行路权值30000，那么，其他车道B(分段车道3-2)的第一跟随车道成本
Figure BDA0003312688310000199
在其他车道B为分段车道3-3时，
Figure BDA00033126883100001910
为前一车道B’也就是分段车道2-3的第一车道成本12001，
Figure BDA00033126883100001911
为从起始车道S也就是分段车道1-3到分段车道1-3的累计变道次数0，
Figure BDA00033126883100001912
为分段车道2-3的第一路权数据也就是障碍物路权值10000，那么，其他车道B(分段车道3-3)的第一跟随车道成本
Figure BDA00033126883100001913
2.1.3)计算当前车道A(分段车道3-1)与其他车道B的第一最小变道车道成本：
在其他车道B为分段车道3-2时，
Figure BDA0003312688310000201
为其他车道B(分段车道3-2)的第一跟随车道成本31002，LC为1000，
Figure BDA0003312688310000202
为从其他车道B(分段车道3-2)到当前车道A(分段车道3-1)的变道次数1，
Figure BDA0003312688310000203
为当前车道A(分段车道3-1)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道3-1)与其他车道B(分段车道3-2)对应的第一变道车道成本
Figure BDA0003312688310000204
在其他车道B为分段车道3-3时，
Figure BDA0003312688310000205
为其他车道B(分段车道2-3)的第一跟随车道成本22001，LC为1000，
Figure BDA0003312688310000206
为从其他车道B(分段车道3-3)到当前车道A(分段车道3-1)的变道次数2，
Figure BDA0003312688310000207
为当前车道A(分段车道3-1)的第一路权数据也就是可通行路权值0，那么当前车道A(分段车道3-1)与其他车道B(分段车道3-3)对应的第一变道车道成本
Figure BDA0003312688310000208
从当前车道A(分段车道3-1)与其他车道B(分段车道3-2)对应的第一变道车道成本32002与当前车道A(分段车道3-1)与其他车道B(分段车道3-3)对应的第一变道车道成本24001中取最小值，则当前车道A(分段车道3-1)对应的第一最小变道车道成本
Figure BDA0003312688310000209
为24001；
2.1.4)确定当前车道A(分段车道3-1)的第一车道成本：
从当前车道A(分段车道3-1)对应的第一跟随车道成本2003和第一最小变道车道成本
Figure BDA00033126883100002010
24001中取最小值，则当前车道A(分段车道3-1)对应的第一车道成本
Figure BDA00033126883100002011
为2003；如图2c所示。
由图2c可知，最后一个第一车道成本
Figure BDA00033126883100002012
为分段车道3-1对应的第一车道成本
Figure BDA00033126883100002013
2003，则当前道路最优通行成本为2003；由上述示例可知，当前道路最优通行成本实际为分段车道3-1的第一跟随车道成本，与分段车道2-1的第一车道成本有关；而分段车道2-1的第一车道成本实际为分段车道2-1的第一最小变道车道成本，与分段车道2-2的第一车道成本有关；又分段车道2-2的第一车道成本实际为分段车道2-2的第一跟随车道成本，与分段车道1-2的第一车道成本有关；又由前文步骤334的示例可知，分段车道1-2的第一车道成本与分段车道1-3也就是起始坐标对应的分段车道有关。那么，参与计算得到该道路最优通行成本2003的所有分段车道也就是上述所有相关分段车道的集合：分段车道3-1、分段车道2-1、分段车道2-2、分段车道1-2和分段车道1-3；本发明实施例对应的会设置5个第一导航车道数据组分别与上述5个关联车道对应。
在得到上述5个第一导航车道数据组后，本发明实施例按从起始坐标到结束坐标的车道变换顺序，也就是按分段车道1-3→分段车道1-2→分段车道2-2→分段车道2-1→分段车道3-1的顺序，对5个第一导航车道数据组进行排序，得到第一车道级导航数据集合。由第一车道级导航数据集合也就可以获得本次实施车道级导航的车道路线，如图2d为本发明实施例一提供的车道导航示意图所示，总途经车道总数为5，途中需分别在公交道路路段1、2中完成两次变道。
图3为本发明实施例二提供的一种电子设备的结构示意图。该电子设备可以为前述的终端设备或者服务器，也可以为与前述终端设备或者服务器连接的实现本发明实施例方法的终端设备或服务器。如图3所示，该电子设备可以包括：处理器301(例如CPU)、存储器302、收发器303；收发器303耦合至处理器301，处理器301控制收发器303的收发动作。存储器302中可以存储各种指令，以用于完成各种处理功能以及实现前述方法实施例描述的处理步骤。优选的，本发明实施例涉及的电子设备还包括：电源304、***总线305以及通信端口306。***总线305用于实现元件之间的通信连接。上述通信端口306用于电子设备与其他外设之间进行连接通信。
在图3中提到的***总线305可以是外设部件互连标准(Peripheral ComponentInterconnect，PCI)总线或扩展工业标准结构(Extended Industry StandardArchitecture，EISA)总线等。该***总线可以分为地址总线、数据总线、控制总线等。为便于表示，图中仅用一条粗线表示，但并不表示仅有一根总线或一种类型的总线。通信接口用于实现数据库访问装置与其他设备(例如客户端、读写库和只读库)之间的通信。存储器可能包含随机存取存储器(Random Access Memory，RAM)，也可能还包括非易失性存储器(Non-Volatile Memory)，例如至少一个磁盘存储器。
上述的处理器可以是通用处理器，包括中央处理器(Central Processing Unit，CPU)、网络处理器(Network Processor，NP)、图形处理器(Graphics Processing Unit，GPU)等；还可以是数字信号处理器(Digital Signal Processor，DSP)、专用集成电路(Application Specific Integrated Circuit，ASIC)、现场可编程门阵列(FieldProgrammable Gate Array，FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
需要说明的是，本发明实施例还提供一种计算机可读存储介质，该计算机可读存储介质中存储有指令，当其在计算机上运行时，使得计算机执行上述实施例中提供的方法和处理过程。
本发明实施例还提供一种运行指令的芯片，该芯片用于执行前述方法实施例描述的处理步骤。
本发明实施例提供了一种自动驾驶公交车的车道级导航方法、电子设备及计算机可读存储介质，从已知的公交车线路数据集合中获取当前行驶道路的道路分段信息和各分段道路的车道信息，再以车辆当前位置所在分段车道为起始车道，以下一停靠站点所在分段车道为结束车道，再结合当前各个车道的路权信息按最优通行成本规划从起始车道到结束车道的导航车道序列，从而得到实时的车道级导航信息。本发明基于公交车路线固定的特点可以省去根据车辆定位在高精度地图中的道路导航计算时间，以不变的停靠站点为当前导航目标点可以减少根据变动目标在高精度地图中的车道导航的计算量和计算时间，使用最优通行成本计算原则替换传统定位搜索算法可以降低计算复杂度和计算时间。通过本发明，满足了自动驾驶公交车道路导航的实时性要求，提高了对车辆驾驶安全性的保障。
专业人员应该还可以进一步意识到，结合本文中所公开的实施例描述的各示例的单元及算法步骤，能够以电子硬件、计算机软件或者二者的结合来实现，为了清楚地说明硬件和软件的可互换性，在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行，取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能，但是这种实现不应认为超出本发明的范围。
结合本文中所公开的实施例描述的方法或算法的步骤可以用硬件、处理器执行的软件模块，或者二者的结合来实施。软件模块可以置于随机存储器(RAM)、内存、只读存储器(ROM)、电可编程ROM、电可擦除可编程ROM、寄存器、硬盘、可移动磁盘、CD-ROM、或技术领域内所公知的任意其它形式的存储介质中。
以上所述的具体实施方式，对本发明的目的、技术方案和有益效果进行了进一步详细说明，所应理解的是，以上所述仅为本发明的具体实施方式而已，并不用于限定本发明的保护范围，凡在本发明的精神和原则之内，所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (7)

1.一种自动驾驶公交车的车道级导航方法，其特征在于，所述方法包括：
获取公交车的公交线路编号作为当前线路编号；并获取所述公交车的车辆位置坐标生成起始坐标；并获取所述公交车的下一停靠站点的站点位置坐标生成结束坐标；
查询预设的公交车线路集合，将与所述当前线路编号匹配的第一线路编号对应的第一道路数据集合作为当前道路数据集合；所述公交车线路集合包括多个第一公交车线路；所述第一公交车线路包括所述第一线路编号和所述第一道路数据集合；
根据所述当前道路数据集合，按道路最优通行成本原则对所述公交车从所述起始坐标到所述结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合。
2.根据权利要求1所述的自动驾驶公交车的车道级导航方法，其特征在于，
所述第一道路数据集合包括多个第一路段数据集合；
所述第一路段数据集合包括第一路段标识数据、第一路段坐标范围和多个第一车道数据集合；
所述第一车道数据集合包括第一车道标识数据、第一车道坐标范围和第一路权数据；
所述第一车道级导航数据集合包括多个第一导航车道数据组；
所述第一导航车道数据组包括第二路段标识数据和第二车道标识数据。
3.根据权利要求2所述的自动驾驶公交车的车道级导航方法，其特征在于，所述根据所述当前道路数据集合，按道路最优通行成本原则对所述公交车从所述起始坐标到所述结束坐标所需途经的各路段车道进行规划，得到对应的第一车道级导航数据集合，具体包括：
在所述当前道路数据集合中，将包含了所述起始坐标的所述第一路段坐标范围对应的所述第一路段标识数据记为起始路段标识数据，将包含了所述结束坐标的所述第一路段坐标范围对应的所述第一路段标识数据记为结束路段标识数据；
将所述当前道路数据集合中，所述第一路段标识数据从所述起始路段标识数据到所述结束路段标识数据的所有所述第一路段数据集合，按从起始路段到结束路段的顺序进行排序组成导航道路数据集合；所述导航道路数据集合包括多个导航路段数据集合，所述导航路段数据集合的数量为路段总数N；
根据第1个导航路段数据集合，计算所述公交车从所述起始坐标到第1导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure FDA0003312688300000021
M1≥j1≥1，M1为第1导航路段的车道总数；
根据第i个导航路段数据集合和第i-1导航路段各个车道的所述第一车道成本
Figure FDA0003312688300000022
计算所述公交车从所述起始坐标到第i导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure FDA0003312688300000023
N≥i≥2,Mi-1≥ji-1≥1，Mi≥ji≥1，Mi-1、Mi分别为第i-1和第i导航路段的车道总数；
将最后一个所述第一车道成本
Figure FDA0003312688300000024
作为当前道路最优通行成本；并为参与计算所述当前道路最优通行成本的各个车道设置一个对应的所述第一导航车道数据组；设置所述第一导航车道数据组的所述第二路段标识数据为当前车道对应的所述第一路段标识数据，设置所述第二车道标识数据为当前车道对应的所述第一车道标识数据；
按从所述起始坐标到所述结束坐标的车道变换顺序，对各个车道对应的所述第一导航车道数据组进行排序，得到所述第一车道级导航数据集合。
4.根据权利要求3所述的自动驾驶公交车的车道级导航方法，其特征在于，所述根据第1个导航路段数据集合，计算所述公交车从所述起始坐标到第1导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure FDA0003312688300000025
具体包括：
在所述第1个导航路段数据集合中，将包含了所述起始坐标的所述第一车道坐标范围对应的所述第一车道数据集合对应的车道记为起始车道S；
计算所述起始车道S对应的第一车道成本
Figure FDA0003312688300000031
Figure FDA0003312688300000032
为所述第1个导航路段数据集合中与所述起始车道S对应的所述第一车道数据集合的所述第一路权数据；
将所述第i导航路段中所述起始车道S之外的任一车道设为其他车道O；
计算任一其他车道O对应的第一车道成本
Figure FDA0003312688300000033
LC为预设的单次变道成本因子，
Figure FDA0003312688300000034
为从所述起始车道S到当前其他车道O的变道次数，
Figure FDA0003312688300000035
为所述第1个导航路段数据集合中与所述当前其他车道O对应的所述第一车道数据集合的所述第一路权数据。
5.根据权利要求3所述的自动驾驶公交车的车道级导航方法，其特征在于，所述根据第i个导航路段数据集合和第i-1导航路段各个车道的所述第一车道成本
Figure FDA0003312688300000036
计算所述公交车从所述起始坐标到第i导航路段各个车道的最优通行成本，生成对应的第一车道成本
Figure FDA0003312688300000037
具体包括：
在i<N时将所述第i导航路段中任一车道设为当前车道A，在i＝N时将所述第i导航路段中所述结束坐标对应的车道设为当前车道A；并将所述第i导航路段中所述当前车道A之外的任一车道设为其他车道B；并将所述第i-1导航路段中与所述当前车道A连接的前一车道设为对应的前一车道A’,与任一其他车道B连接的前一车道设为对应的前一车道B’；
计算所述当前车道A对应的第一跟随车道成本
Figure FDA0003312688300000038
Figure FDA0003312688300000039
为对应的所述前一车道A’的第一车道成本，
Figure FDA00033126883000000310
为从所述第1导航路段的起始车道S到对应的所述前一车道A’的累计变道次数，
Figure FDA00033126883000000311
为所述第i个导航路段数据集合中与所述当前车道A对应的所述第一车道数据集合的所述第一路权数据；
计算任一其他车道B对应的第一跟随车道成本
Figure FDA0003312688300000041
Figure FDA0003312688300000042
为与当前其他车道B对应的所述前一车道B’的第一车道成本，
Figure FDA0003312688300000043
为从所述起始车道S到对应的所述前一车道B’的累计变道次数，
Figure FDA00033126883000000413
为所述第i个导航路段数据集合中与所述当前其他车道B对应的所述第一车道数据集合的所述第一路权数据；
计算所述当前车道A与任一其他车道B对应的第一变道车道成本
Figure FDA0003312688300000044
并从得到的多个所述第一变道车道成本
Figure FDA0003312688300000045
中，取最小值记为所述当前车道A对应的第一最小变道车道成本
Figure FDA0003312688300000046
Figure FDA0003312688300000047
为所述当前车道A对应的当前其他车道B的第一跟随车道成本，LC为预设的单次变道成本因子，
Figure FDA0003312688300000048
为从所述当前其他车道B到所述当前车道A的变道次数，
Figure FDA0003312688300000049
为所述第i个导航路段数据集合中与所述当前车道A对应的所述第一车道数据集合的所述第一路权数据；
从所述当前车道A对应的所述第一跟随车道成本
Figure FDA00033126883000000410
和所述第一最小变道车道成本
Figure FDA00033126883000000411
中，取最小值作为所述当前车道A对应的所述第一车道成本
Figure FDA00033126883000000412
6.一种电子设备，其特征在于，包括：存储器、处理器和收发器；
所述处理器用于与所述存储器耦合，读取并执行所述存储器中的指令，以实现权利要求1-5任一项所述的方法步骤；
所述收发器与所述处理器耦合，由所述处理器控制所述收发器进行消息收发。
7.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质存储有计算机指令，当所述计算机指令被计算机执行时，使得所述计算机执行权利要求1-5任一项所述的方法的指令。
CN202111221197.8A 2021-10-20 2021-10-20 一种自动驾驶公交车的车道级导航方法 Active CN113916239B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202111221197.8A CN113916239B (zh) 2021-10-20 2021-10-20 一种自动驾驶公交车的车道级导航方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202111221197.8A CN113916239B (zh) 2021-10-20 2021-10-20 一种自动驾驶公交车的车道级导航方法

Publications (2)

Publication Number Publication Date
CN113916239A true CN113916239A (zh) 2022-01-11
CN113916239B CN113916239B (zh) 2024-04-12

Family

ID=79241650

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111221197.8A Active CN113916239B (zh) 2021-10-20 2021-10-20 一种自动驾驶公交车的车道级导航方法

Country Status (1)

Country Link
CN (1) CN113916239B (zh)

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011038794A (ja) * 2009-08-06 2011-02-24 Sumitomo Electric System Solutions Co Ltd 経路探索装置、経路探索方法、コンピュータプログラム及び地図データベース
CN104200650A (zh) * 2014-08-27 2014-12-10 浙江工业大学 一种城市拥堵时段的多模式公交换乘方法
CN106017491A (zh) * 2016-05-04 2016-10-12 玉环看知信息科技有限公司 一种导航路径规划方法、***及导航服务器
US20180099676A1 (en) * 2015-03-31 2018-04-12 Aisin Aw Co., Ltd. Autonomous driving assistance system, autonomous driving assistance method, and computer program
CN108253975A (zh) * 2017-12-29 2018-07-06 驭势（上海）汽车科技有限公司 一种建立地图信息及车辆定位的方法与设备
CN109521763A (zh) * 2017-09-18 2019-03-26 百度（美国）有限责任公司 用于自动驾驶车辆的基于约束平滑样条的路径优化
CN110440819A (zh) * 2018-05-04 2019-11-12 沈阳美行科技有限公司 导航方法、装置和***
CN111044057A (zh) * 2018-10-12 2020-04-21 百度（美国）有限责任公司 用于自动驾驶车辆的基于先前驾驶轨迹的实时地图生成方案
US20200182633A1 (en) * 2018-12-10 2020-06-11 Aptiv Technologies Limited Motion graph construction and lane level route planning
CN111947678A (zh) * 2020-08-27 2020-11-17 重庆智行者信息科技有限公司 一种针对结构化道路的自动驾驶导航方法及***
CN113487872A (zh) * 2021-09-07 2021-10-08 南通飞旋智能科技有限公司 一种基于大数据和人工智能的公交车通行时间预测方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011038794A (ja) * 2009-08-06 2011-02-24 Sumitomo Electric System Solutions Co Ltd 経路探索装置、経路探索方法、コンピュータプログラム及び地図データベース
CN104200650A (zh) * 2014-08-27 2014-12-10 浙江工业大学 一种城市拥堵时段的多模式公交换乘方法
US20180099676A1 (en) * 2015-03-31 2018-04-12 Aisin Aw Co., Ltd. Autonomous driving assistance system, autonomous driving assistance method, and computer program
CN106017491A (zh) * 2016-05-04 2016-10-12 玉环看知信息科技有限公司 一种导航路径规划方法、***及导航服务器
CN109521763A (zh) * 2017-09-18 2019-03-26 百度（美国）有限责任公司 用于自动驾驶车辆的基于约束平滑样条的路径优化
CN108253975A (zh) * 2017-12-29 2018-07-06 驭势（上海）汽车科技有限公司 一种建立地图信息及车辆定位的方法与设备
CN110440819A (zh) * 2018-05-04 2019-11-12 沈阳美行科技有限公司 导航方法、装置和***
CN111044057A (zh) * 2018-10-12 2020-04-21 百度（美国）有限责任公司 用于自动驾驶车辆的基于先前驾驶轨迹的实时地图生成方案
US20200182633A1 (en) * 2018-12-10 2020-06-11 Aptiv Technologies Limited Motion graph construction and lane level route planning
CN111947678A (zh) * 2020-08-27 2020-11-17 重庆智行者信息科技有限公司 一种针对结构化道路的自动驾驶导航方法及***
CN113487872A (zh) * 2021-09-07 2021-10-08 南通飞旋智能科技有限公司 一种基于大数据和人工智能的公交车通行时间预测方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
LI, SHUGUANG 等: ""Evaluation of Bus-Exclusive Lanes"", 《IEEE TRANSACTIONS ON INTELLIGENT TRANSPORTATION SYSTEMS》, vol. 10, no. 2, 31 December 2009 (2009-12-31), pages 236 - 245 *
吴进: ""基于通行效用的高速公路收费站ETC车道设置方案研究"", 《工程科技Ⅱ辑》, 15 March 2017 (2017-03-15), pages 7 - 45 *

Also Published As

Publication number Publication date
CN113916239B (zh) 2024-04-12

Similar Documents

Publication Publication Date Title
CN108871368B (zh) 一种高精度地图车道横向拓扑关系的构建方法、***及存储器
CN109752009B (zh) 路口区域路网数据生成方法及装置
CN108151751B (zh) 一种基于高精度地图和传统地图结合的路径规划方法及装置
EP3699048A1 (en) Travelling track prediction method and device for vehicle
CN108519094B (zh) 局部路径规划方法及云处理端
CN109916422B (zh) 一种全局路径规划方法及装置
CN112947485B (zh) 路径规划方法及***
CN110361028B (zh) 一种基于自动驾驶循迹的路径规划结果生成方法及***
CN111209291B (zh) 一种利用众包感知地图更新高精度地图的方法及***
CN104464379B (zh) 基于分段匹配的航行计划与雷达航迹关联方法及***
EP3452785B1 (en) Method and apparatus for disambiguating location probe points within an ambiguous probe region of a road network
CN112747755B (zh) 道路线确定方法、装置、可读存储介质及地图更新***
CN115077557B (zh) 一种路口掉头的路径规划方法
JP6912251B2 (ja) 車線情報生成装置及び車線情報生成方法並びに車線情報生成用プログラム
JP6871784B2 (ja) 車線情報生成装置及び車線情報生成方法並びに車線情報生成用プログラム
JP6871785B2 (ja) 車線情報生成装置及び車線情報生成方法並びに車線情報生成用プログラム
WO2020063813A1 (zh) 用于提取环境目标的特征点的方法及装置
CN109937342B (zh) 用于定位移动物体的方法、装置和***
CN111238503B (zh) 一种道路线段的地图生成方法、装置及相关***
CN113916239A (zh) 一种自动驾驶公交车的车道级导航方法
CN111238500B (zh) 道路地图区域的道路线段的地图生成方法、装置及***
JP4766992B2 (ja) 道路ペイント認識システム、道路ペイント認識方法及び道路ペイントデータベースの作成方法
CN115631476A (zh) 一种车道数据处理方法、***、电子设备及存储介质
CN116383321A (zh) 决策环境构建方法、装置、车辆及存储介质
CN115683142A (zh) 一种感兴趣区域确定方法及装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant