CN105758410B - 基于A‐Star算法的快速路径规划混合方法 - Google Patents
基于A‐Star算法的快速路径规划混合方法 Download PDFInfo
- Publication number
- CN105758410B CN105758410B CN201510784783.1A CN201510784783A CN105758410B CN 105758410 B CN105758410 B CN 105758410B CN 201510784783 A CN201510784783 A CN 201510784783A CN 105758410 B CN105758410 B CN 105758410B
- Authority
- CN
- China
- Prior art keywords
- map block
- path
- map
- time cost
- point
- 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.)
- Active
Links
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
- G01C21/34—Route searching; Route guidance
- G01C21/3446—Details of route searching algorithms, e.g. Dijkstra, A*, arc-flags, using precalculated routes
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)
Abstract
本发明公开了中一种基于A‐Star算法的快速路径规划混合方法,包括如下步骤:S1:将目标地图划分成多个等尺寸的地图块;计算并存储每个地图块中全部的邻接点和节点之间的最短路径,其中邻接点表示道路与地图块边界的交点,节点为道路的起始点或交叉点;S2:事件到来时,判断受到事件影响的地图块中的受影响路段,重新计算所述受影响路段所涉及的每个地图块中全部邻接点和节点之间排除所述受影响路段后的最短路径;S3:基于A‐Star算法,选择起点至终点经过的各地图块,连接各地图块中的排除所述受影响路段后的最短路径,形成多条备选路径;多条备选路径中时间代价最小的即为最优路径。
Description
技术领域
本发明公开了一种路径规划混合方法,尤其涉及一种基于Astar算法和等尺寸地图块划分的快速路径规划混合方法。涉及专利分类号G01测量;测试G01C测量距离、水准或者方位;勘测;导航;陀螺仪;摄影测量学或视频测量学G01C21/00导航;不包含在G01C 1/00至G01C 19/00组中的导航仪器G01C21/26专用于道路网络的导航G01C21/34路径搜索;路径导引。
背景技术
车辆导航系统是指采用一定的定位与导航技术,使得车辆在行驶过程中,实时显示车辆的物理位置,规划车辆从起点到终点的最佳行驶路线,并引导车辆按最佳路径行驶。路径规划是基于城市道路网地图,在车辆行驶前或行驶中规划最佳行驶路径的过程。为满足实际要求,路径规划应具有快速性和最佳性。
以动态导航算法为基础的动态路径规划技术是导航系统的核心之一。其中主要是研究动态最优路径算法。动态最佳路径是要找到一条考虑实时交通情况的“最佳路径”,使得从起点到达终点耗费总和最优。传统的最佳路径的经典算法有Dijkstra算法,该算法是基于图论中的网络模型,在求解时有可能并准备搜索所有的网络节点,但是在地图规模较大,城市道路网节点数较多的情况下,该算法花费时间长,求解效率低,很难满足实际路径动态规划快速性的要求;另一种静态路网中求解最短路径最有效的方法是A‐Star算法,A‐Star算法是一种典型的启发式搜索算法,通过选择合适的估价函数,指导搜索朝着最有希望的方向前进,,算法到达目标节点即停止搜索,以求得最优解。但是如果A‐Star算法搜索空间较大,实体的形状不规则,搜索时会扩展大量的冗余节点,占用的时间耗费同样会非常巨大。
发明内容
本发明针对以上问题,提出的一种基于A‐Star算法的快速路径规划混合方法,包括如下步骤:
S1:将目标地图划分成多个等尺寸的地图块;计算并存储每个地图块中全部的邻接点和节点之间的最短路径,其中邻接点表示道路与地图块边界的交点,节点为道路的起始点或交叉点;
S2:事件到来时,判断受到事件影响的地图块中的受影响路段,重新计算所述受影响路段所涉及的每个地图块中全部邻接点和节点之间排除所述受影响路段后的最短路径;
S3:基于A‐Star算法,选择起点至终点经过的各地图块,连接各地图块中的排除所述受影响路段后的最短路径,形成多条备选路径;多条备选路径中时间代价最小的即为最优路径。
作为优选的实施方式,“将目标地图划分成多个等尺寸的地图块”具体包括如下步骤:
—利用经纬度对地图进行分割分块,地图分块为地图中任意相邻的两条分割线与任意相邻的两条分割危险所围成的区域;
ti(i∈Z,且0≤i≤n)为第i条分割纬线的维度,其中t0=‐85°,tn=85°;
gj(j∈Z,且0≤i≤n)为第j条分割警衔的精度,其中g0=‐180°,gm=180°;
有ti+1-ti=T,其中T=(tn-t0)/n=170°/n;
有gj+1-gj=G,其中G=(gm-g0)/m=360°/m。
更进一步的,所述的每个地图块具有与经纬度对应的命名,命名规则如下。
CD=int(ti-60)
作为优选的实施方式,所述的步骤S2具体为:
若C(n)+f(n,m)<C(m),则为C(m)赋值为C(n)+f(n,m);
上式表示起点到目标点m的时间代价C(m)大于起点经中间点n至目标点m的时间代价C(n)+f(n,m),C(n)为起点至中间点n的时间代价,f(n,m)为中间点n到m的时间代价;
更进一步的,所述步骤S3中选择时间代价最小路径的方法如下:
—将计算得出的C(n)代入估值函数f(n)=C(n)+g(n),计算估值函数的最优解作为最佳路径;
其中g(n)为n点到目标节点的估计时间代价,该估计时间代价为:
式中,dx、dy为目的地m在其所在地图块上的坐标,nx,ny为中间点n在地图块上的坐标;为根据所述事件测算的受影响路段的平均速度;
若C(n)+f(n,m)+g(m)<C(m),则F(m)=C(n)+f(n,m)+g(m),F(m)为最佳路径。
本专利针对矢量化的城市道路网图进行合理化的分块设计,并利用分块地图的特点,提出一种基于A‐Star的快速求解最短路径的混合算法。该算法搜索空间小,搜索速度快,经实验验证,效率明显提高。同时,在求解路径过程中,考虑到实时交通信息的影响,更适用于车辆导航系统。
附图说明
为了更清楚的说明本发明的实施例或现有技术的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做一简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明的整体流程图
图2为本发明的快速路径规划混合算法流程图
图3为实施例1中混合算法与传统算法响应时间对比示意图
图4为实施例2中混合算法与传统算法拓展点数n乘以log n的对比示意图
图5为本发明实施例的效果验证列表。
具体实施方式
为使本发明的实施例的目的、技术方案和优点更加清楚,下面结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚完整的描述:
如图1‐5所示:一种基于A‐Star算法的快速路径规划混合方法,主要包括如下步骤:
首先,将目标地图按经纬线划分成多个等尺寸的地图块,每个地图块即为经纬线围成的区域。
ti(i∈Z,且0≤i≤n)为第i条分割纬线的维度,其中t0=‐85°,tn=85°;
gj(j∈Z,且0≤i≤n)为第j条分割警衔的精度,其中g0=‐180°,gm=180°;
ti和gj代表经纬线。
有ti+1-ti=T,其中T=(tn-t0)/n=170°/n;
有gj+1-gj=G,其中G=(gm-g0)/m=360°/m。
根据和两个表达式,根据T和G的取值,结合地图尺寸,即可计算出当前地图能够划分成地图块的数量。
在本发明的实施例中,使用辽宁省基础地理数据地图。根据辽宁省经纬度范围,纬度为1/12°,经度为1/8°。划分后,每个地图图块的范围大约为9.25*9.25km2。在该地图中包括地图图块数为1588个。
所述的每个地图块具有与经纬度对应的命名,命名包含6位数字,具体的命名规则如下。
CD=int(ti-60)
然后根据数据统计全部地图块中的节点数和邻接点数,已经连接节点和邻接点的路段和每个节点到其它节点和邻接点的最短距离,存储在存储单元中,共后续运算使用。
统计后,实施例中的节点数为152411,邻接点为10492,路段为188907个。实时交通信息,即前述事件,根据沈阳市等几大城市的交通信息模拟动态生成。
事件到来时,判断受到事件影响的地图块中的受影响路段,重新计算所述受影响路段所涉及的每个地图块中全部邻接点和节点之间排除所述受影响路段后的最短路径。
在本实施例中,着重考虑根据路段平均速度计算得出的时间作为主要的代价对最佳路径进行选择。
若C(n)+f(n,m)<C(m),则为C(m)赋值为C(n)+f(n,m);
上式表示起点到目标点m的时间代价C(m)大于起点经中间点n至目标点m的时间代价C(n)+f(n,m),C(n)为起点至中间点n的时间代价,f(n,m)为中间点n到m的时间代价;
则将起点到目标点m的路径替换为起点经中间点n至终点m。
最后,选择起点至终点经过的各地图块,连接各地图块中的排除所述受影响路段后的最短路径,形成多条备选路径;多条备选路径中时间代价最小的即为最优路径。
将计算得出的C(n)代入估值函数f(n)=C(n)+g(n),计算估值函数的最优解作为最佳路径;
其中g(n)为n点到目标节点的估计时间代价,该估计时间代价为:
式中,dx、dy为目的地m在其所在地图块上的坐标,nx,ny为中间点n在地图块上的坐标;为根据所述事件测算的受影响路段的平均速度;
若C(n)+f(n,m)+g(m)<C(m),则F(m)=C(n)+f(n,m)+g(m),F(m)为最佳路径。
作为优选的实施方式建立最佳,如图2所示:将起点放入堆中,该堆内存储初始地图块(起点所在地图块中)中的全部的道路节点和邻接点以及其它地图块的邻接点。此时,非起点所在的各地图块的最短路径已经计算得出并处于存储待选状态,故可以不用计算每个地图块中的节点(道路的起始点和交叉点)。
取堆顶至节点P,判定节点P是否为选定的终点,若为终点,即可回溯得到整条路径,即最佳路径。若P点不是终点,则判定P是否为地图块之间的邻接点,如果是邻接点,则以与存储的当前地图块中预存线路为边查找与P相邻的邻接点;如果不是邻接点,则以路段为边查找与P相邻的点,然后根据松弛条件若C(n)+f(n,m)+g(m)<C(m),则F(m)=C(n)+f(n,m)+g(m)调整堆。
实验过程中,任意选取起止点进行测试,导航结果与Google地图进行对比,路径计算结果基本准确。结果如图5所示。为了验证该算法的效率,选取导航距离约为5km、10km、15km、30km、50km、100km等6组测试数据,针对每组输入数据重复计算1000次,统计程序的平均响应时间,以及拓展点的个数。统计结果如表2所示。
表2
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,根据本发明的技术方案及其发明构思加以等同替换或改变,都应涵盖在本发明的保护范围之内。
Claims (3)
1.一种基于A-Star算法的快速路径规划混合方法,其特征在于具有如下步骤:
S1:将目标地图划分成多个等尺寸的地图块;计算并存储每个地图块中全部的邻接点和节点之间的最短路径,其中邻接点表示道路与地图块边界的交点,节点为道路的起始点或交叉点;
所述“将目标地图划分成多个等尺寸的地图块”具体包括如下步骤:
利用经纬度对地图进行分割分块,地图分块为地图中任意相邻的两条分割经线与任意相邻的两条分割纬线所围成的区域;
ti为第i条分割纬线的纬度,其中,i∈Z,0≤i≤p,t0=-85°,tp=85°;
gj为第j条分割经线的经度,其中,j∈Z,0≤j≤q,g0=-180°,gq=180°;
ti+1-ti=T,其中T=(tp-t0)/p=170°/p;
gj+1-gj=G,其中G=(gq-g0)/q=360°/q;
T和G分别代表纬度和经度差;
所述的每个地图块具有与经纬度对应的命名,使用6位数字为地图块进行命名,规则如下:
CD=int(ti-60)
S2:事件到来时,判断受到事件影响的地图块中的受影响路段,重新计算所述受影响路段所涉及的每个地图块中全部邻接点和节点之间排除所述受影响路段后的最佳路径,具体为:
若C(n)+f(n,m)<C(m),则为C(m)赋值为C(n)+f(n,m);
上式表示起点到终点m的时间代价C(m)大于起点经中间点n至终点m的时间代价C(n)+f(n,m),C(n)为起点至中间点n的时间代价,f(n,m)为中间点n到终点m的时间代价;
则将起点到终点m的路径替换为起点经中间点n至终点m;
S3:基于A-Star算法选择起点至终点m经过的各地图块,连接各地图块中的排除所述受影响路段后的最佳路径,形成多条备选路径;多条备选路径中时间代价最小的即为最优路径。
2.根据权利要求1所述的基于A-Star算法的快速路径规划混合方法,其特征还在于所述步骤S3中选择时间代价最小路径的方法如下:
将计算得出的C(n)代入估值函数f(n)=C(n)+g(n),计算估值函数的最优解作为最佳路径;
其中g(n)为n点到终点m的估计时间代价,则起点经过n点到终点m新的估计时间代价为:
式中,dx、dy为终点m在其所在地图块上的坐标,nx,ny为中间点n在地图块上的坐标;为根据所述事件测算的受影响路段的平均速度;
所述估值函数的松弛条件为:若C(n)+f(n,m′)+g(m′)<C(m),则F(m)=C(n)+f(n,m′)+g(m′),g(m′)为m’到终点m的估计时间代价,F(m)为最佳路径。
3.根据权利要求2所述的基于A-Star算法的快速路径规划混合方法,其特征还在于:若所述的中间点n和终点m在同一地图块内,则直接调用预先存储的最短路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510784783.1A CN105758410B (zh) | 2015-11-14 | 2015-11-14 | 基于A‐Star算法的快速路径规划混合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510784783.1A CN105758410B (zh) | 2015-11-14 | 2015-11-14 | 基于A‐Star算法的快速路径规划混合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105758410A CN105758410A (zh) | 2016-07-13 |
CN105758410B true CN105758410B (zh) | 2018-12-25 |
Family
ID=56342033
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510784783.1A Active CN105758410B (zh) | 2015-11-14 | 2015-11-14 | 基于A‐Star算法的快速路径规划混合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105758410B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106203721B (zh) * | 2016-07-18 | 2019-11-26 | 武汉理工大学 | 自适应船舶破冰能力的极地冰区航线设计系统及方法 |
CN106964156B (zh) * | 2017-03-24 | 2020-10-27 | 腾讯科技(深圳)有限公司 | 一种寻路方法以及装置 |
CN106845703B (zh) * | 2017-01-18 | 2020-08-11 | 东南大学 | 一种考虑转向延误的城市路网时变k最短路径搜索方法 |
CN107289938B (zh) * | 2017-05-27 | 2021-11-02 | 中国北方车辆研究所 | 一种地面无人平台局部路径规划方法 |
CN107449426B (zh) * | 2017-07-14 | 2020-05-05 | 厦门市礼小签电子科技有限公司 | 导航逻辑方法及其室内ar导航系统 |
CN108303105A (zh) * | 2017-11-22 | 2018-07-20 | 东莞产权交易中心 | 导航设备中增加路径实现路径规划的方法 |
CN108446298A (zh) * | 2018-01-25 | 2018-08-24 | 链家网(北京)科技有限公司 | 一种通勤找房方法及装置 |
CN109167624A (zh) * | 2018-11-09 | 2019-01-08 | 重庆邮电大学 | 一种基于A-Star算法的接收天线最优路径寻找方法 |
CN109859525B (zh) * | 2019-04-03 | 2020-12-08 | 哈尔滨工业大学 | 基于a星算法的车位导航方法 |
CN110207706A (zh) * | 2019-05-30 | 2019-09-06 | 浙江圣奥家具制造有限公司 | 一种基于栅格地图的自动归位椅路径规划算法 |
AT522764B1 (de) * | 2019-08-29 | 2021-01-15 | Plasser & Theurer Export Von Bahnbaumaschinen Gmbh | Verfahren und Messfahrzeug zur Ermittlung einer Ist-Lage eines Gleises |
CN111323036B (zh) * | 2020-02-19 | 2021-09-28 | 中冶东方工程技术有限公司 | 原料场智能寻优路径方法、系统、电子设备和存储介质 |
WO2021218762A1 (zh) * | 2020-04-26 | 2021-11-04 | 北京三快在线科技有限公司 | 确定飞行路径 |
CN111580524B (zh) * | 2020-05-21 | 2022-02-25 | 安徽江淮汽车集团股份有限公司 | 基于路径规划的车辆换道方法、装置、设备及存储介质 |
CN116795089A (zh) * | 2022-03-16 | 2023-09-22 | 宇通客车股份有限公司 | 一种路径规划方法和装置以及一种云平台 |
CN115271398A (zh) * | 2022-07-18 | 2022-11-01 | 民航机场成都电子工程设计有限责任公司 | 一种机场空侧无人驾驶行李拖车调度算法 |
CN117073703A (zh) * | 2023-08-02 | 2023-11-17 | 南方科技大学 | 一种车辆路径问题解决方案的生成方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101241507A (zh) * | 2008-01-17 | 2008-08-13 | 腾讯科技(深圳)有限公司 | 一种地图寻路方法及系统 |
CN101900570A (zh) * | 2009-02-18 | 2010-12-01 | 三星电子株式会社 | 产生和使用栅格地图路径的设备和方法 |
CN102901500A (zh) * | 2012-09-17 | 2013-01-30 | 西安电子科技大学 | 基于概率a星与智能体混合的飞行器最优路径确定方法 |
US20130046465A1 (en) * | 2010-04-21 | 2013-02-21 | Tomtom Development Germany Gmbh | System and method of generating a route across an electronic map |
CN104142156A (zh) * | 2014-08-26 | 2014-11-12 | 天津市普迅电力信息技术有限公司 | 一种路径导航方法 |
-
2015
- 2015-11-14 CN CN201510784783.1A patent/CN105758410B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101241507A (zh) * | 2008-01-17 | 2008-08-13 | 腾讯科技(深圳)有限公司 | 一种地图寻路方法及系统 |
CN101900570A (zh) * | 2009-02-18 | 2010-12-01 | 三星电子株式会社 | 产生和使用栅格地图路径的设备和方法 |
US20130046465A1 (en) * | 2010-04-21 | 2013-02-21 | Tomtom Development Germany Gmbh | System and method of generating a route across an electronic map |
CN102901500A (zh) * | 2012-09-17 | 2013-01-30 | 西安电子科技大学 | 基于概率a星与智能体混合的飞行器最优路径确定方法 |
CN104142156A (zh) * | 2014-08-26 | 2014-11-12 | 天津市普迅电力信息技术有限公司 | 一种路径导航方法 |
Non-Patent Citations (2)
Title |
---|
A Formal Basis for the Heuristic Determination of Minimum Cost Paths;PETER E.HART 等;《IEEE Transactions of Systems Science and Cybernetics》;19680731;第SSC-4卷(第2期);第100-107页 * |
最短路径问题的禁忌搜索求解方法;董宗然 等;《计算机工程与应用》;20101231;第46卷(第33期);第36-38页 * |
Also Published As
Publication number | Publication date |
---|---|
CN105758410A (zh) | 2016-07-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105758410B (zh) | 基于A‐Star算法的快速路径规划混合方法 | |
CN104567906B (zh) | 一种基于北斗的城市路网车辆路径规划方法及装置 | |
CN106643783B (zh) | 基于最短路径泰森多边形的电动汽车充电站搜索方法 | |
JP6011258B2 (ja) | 地図データ作成方法 | |
US8620586B2 (en) | Navigation based on popular user-defined paths | |
CN110375760A (zh) | 路线确定方法、装置、设备和介质 | |
US20190114909A1 (en) | Method and Apparatus for Identifying Congestion Bottlenecks | |
CN105335597B (zh) | 用于获取路线的轨迹模式的方法和系统 | |
US20140132608A1 (en) | Graph based topological map matching | |
CN102147260A (zh) | 电子地图匹配方法和装置 | |
EP2659228B1 (en) | Generation of a seamless network of road or line segments in a digital map | |
US9983016B2 (en) | Predicting short term travel behavior with unknown destination | |
CN105352522A (zh) | 一种基于位置实时更新的车载导航装置与导航方法 | |
CN113779430A (zh) | 路网数据生成方法、装置、计算设备和存储介质 | |
JP2013050413A (ja) | ナビゲーションシステム、ナビゲーションプログラム、及びナビゲーション方法 | |
JP5768526B2 (ja) | 渋滞予測装置および渋滞予測データ | |
JP2017102001A (ja) | 経路探索装置及び経路探索方法 | |
Freitas et al. | Correcting routing information through GPS data processing | |
JP6535507B2 (ja) | 情報処理装置、経路探索方法、およびコンピュータプログラム | |
JP5132694B2 (ja) | データ生成装置、データ生成方法及び経路探索装置 | |
CN111091235A (zh) | 变电站站区进出线路径的确定方法及装置 | |
US20230137263A1 (en) | Method and apparatus for generating structured trajectories from geospatial observations | |
US20190259272A1 (en) | Inaccessible road section estimation system and inaccessible road section estimation program | |
CN115183789A (zh) | 一种导航路线的确定方法及装置 | |
CN113865591A (zh) | 结合厂区自有路线数据导航的方法、装置、设备及介质 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |