CN108303105A - 导航设备中增加路径实现路径规划的方法 - Google Patents
导航设备中增加路径实现路径规划的方法 Download PDFInfo
- Publication number
- CN108303105A CN108303105A CN201711176038.4A CN201711176038A CN108303105A CN 108303105 A CN108303105 A CN 108303105A CN 201711176038 A CN201711176038 A CN 201711176038A CN 108303105 A CN108303105 A CN 108303105A
- Authority
- CN
- China
- Prior art keywords
- path
- breakpoint
- planning
- terminal
- result
- 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.)
- Pending
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
本发明公开了一种导航设备中增加路径实现路径规划的方法,依赖于导航设备中的处理器实现,与处理器配套的存储介质中存储有地图以及图中各路口的交通规则,当确定起点和终点后,路径规划包含以下步骤:计算从起点到终点的路径,以设定的终点作为开始,设定的起点作为结束,计算路径,若有路径断点,计算从起点到断点(1),从断点到起点(2),从断点到终点的路径(3),以及从终点到断点的路径(4)的四条路径,若(1)(3),(1)(4),(2)(3),(2)(4)构成从起点到终点条路径,比较路径结果,取其中距离短的路径作为本次路径规划的结果。本发明加了断点之后,加了一些路径选择,因而可选择路径增多,大大增加了路径规划成功的可能。
Description
技术领域
本发明涉及交通领域中的路径规划,特别是路径规划的算法。
背景技术
迪杰斯特拉算法(Dijkstra)是由荷兰计算机科学家艾兹赫尔·迪杰斯特拉(Edsger Wybe Dijkstra)发明的。算法解决的是有向图中单个源点到其他顶点的最短路径问题。如果图中的顶点表示城市或区域等地点,而边上的权重表示城市或区域等地点间的距离,该算法可以用来找到两个城市或区域等地点间的最短路径。
该算法的输入包含了一个有权重的有向图 G,我们以V表示G中所有顶点的集合。图中的边,是两个顶点所形成的有序元素对(Vi, Vj),表示从顶点Vi到Vj有路径相连。我们以E表示所有边的集合,而边的权重则由权重函数w: E→[0, ∞]定义,权重可以表示距离。因此,w(Vi, Vj)就是从顶点Vi到顶点Vj的距离。图中任两点间路径的距离,就是该路径上所有边的距离总和。已知图中V有顶点V0,迪杰斯特拉算法可以找到V0到所有其他顶点的最短路径。
在计算V0到其他顶点的最短路径时,按下述步骤执行:
1. 首先,设置两个顶点集合S和T,S={V0},T={其余顶点},T中顶点对应的距离值为d(V0,Vi),如果V0与Vi之间有边连接,则d(V0,Vi)=w(V0, Vj),否则,d(V0,Vi)为∞,
2. 从T中选取顶点W,条件是W与V0的距离值最小,将W从集合T中移入集合S,
3. 对T中顶点的距离值进行修改:若加进W作中间顶点,从V0到Vi的距离值比不加W的路径要短,则修改此距离值。
重复上述步骤2、3,直到S中包含所有顶点,即S=T为止。
该算法因其算法的效率而在导航软件中被大量采用。
导航软件中用于路径规划的地图来自于现实中的道路交通网络,因此该图为典型的有向图,而且根据该图使用迪杰斯特拉算法做路径规划的过程中,还必须考虑到图中各个顶点(实际中为路口)上包含的交通规则。公知的导航软件路径规划,一般采用从路径规划的起点向终点进行发散的规划原则。同时为了缩短路径规划的时间,提高路径规划的效率,往往采用从起点发散到终点即告结束的原则。申请号为CN201110360440.4的发明提出了一种改进,加了一条路径选择,但是即便如此,这样的规划原则也因为路径选择至多为2条,导航依赖的道路交通网络数据库的庞大因而面临各种变化,如道路维修导致道路不通、交通规则或则路口关闭等,道路规划常流于失败,结果极不准确。
发明内容
为解决上述问题,本发明提出以下技术方案:
导航设备中增加路径实现路径规划的方法,依赖于导航设备中的处理器实现, 与处理器配套的存储介质中存储有地图以及图中各路口的交通规则,当确定起点和终点后,路径规划包含以下步骤:
S01、设置存储区域SA,按照迪杰斯特拉原理,根据地图及交通规则计算从起点到终点的路径,并将结果转存到SA中,
S02、按照迪杰斯特拉原理,根据地图及起点到终点 方向的交通规则,以设定的终点作为开始,设定的起点作为结束,计算路径,并将结果转存到SA中,
S03、若S01、 S02中有路径断点,按照迪杰斯特拉原理,根据地图及交通规则计算从起点到断点(1),从断点到起点(2),从断点到终点的路径(3),以及从终点到断点的路径(4)的四条路径,
S04、若 (1)(3),(1)(4),(2)(3),(2)(4)构成从起点到终点条路径,将结果转存到SA中,
S05、比较SA中的路径结果,取其中距离短的路径作为本次路径规划的结果。更具体地,在步骤S02 、S03中,采用从起点到终点方向的交通规则。
本发明的优点
使用本方法,原理是如果某条道路从正向、反向规划都找不到通行路径的话,那么我们就细化道路,加一个道路节点,优选的选取道路断点,这样就能够避免因导航数据中存在类似图1所引起的路径规划的失败问题,提高了导航软件的导航性能和用户体验,同时降低了导航数据生产的技术度。
附图说明
图1为一个路径规划图。
其中:Start为起点,End为终点,A、B、C、D、E、G为中间点,S1为End点与A点间的道路,S2为A点与B点间的道路,S3为B点与C点间的道路,S4为B点与D点间的道路,S5为C点与D点间的道路,S6为D点与G点间的道路,S7为G点与start点间的道路,S8为B点与E点间的道路,S9为E点与D点间的道路。
具体实施方式
下面结合附图对本发明进行详细说明。
例1:参看图1,本例中在B点有交通规则:从S4经B点不能到达S2。
首先执行步骤S01:根据迪杰斯特拉路径规划原理、路径规划图以及图中各路口的交通规则,规划从起点到终点的路径,过程如下:
结论:没有从Start到达End的路径。 断点为C、B。
将上述结果转存到存储区SA中。
然后执行步骤S02:根据迪杰斯特拉路径规划原理、路径规划图以及图中各路口的交通规则,规划从终点到起点的路径,过程如下:
结论:使用反向路径规划,得到Start到End的路径规划结果为:
总距离为:S7+S6+S5+S3+S2+S1 。
例2:参看图1,本例中在B点有交通规则:从S4经B点不能到达S2,从S6经D点不能到达S5,另外S3<S8。
本例与例1比增加了限制从S6经D点不能到达S5。
那么正向无法找到从Start到达End的路径,断点为C、B;
而反向加了限制的路径为:
我们现在再加上限制从S6经D点不能到达S5,以及S3<S8则
根据迪杰斯特拉路径规划原理,
结束
使用反向路径规划也无法找到可行路径,
结论:没有从Start到达End的路径,断点为C、D。
将上述结果转存到存储区SA中。
然后执行步骤S03:根据迪杰斯特拉路径规划原理、路径规划图以及图中各路口的交通规则,计算从起点到断点(1),从断点到起点(2),从断点到终点的路径(3),以及从终点到断点的路径(4)的四条路径;这里取断点D为例说明:
使用正向路径规划Start到D:Start—>S7—>G—>S6—>D(1)
使用反向路径规划D到Start:Start—>S7—>G—>S6—>D(2)
使用正向路径规划D到End,
D—>S9—>E—>S8—>B—>S2—>A—>E(3)
使用反向向路径规划End到D:C—>B—>A—>E无路径。(4)
执行步骤S04、若 (1)(3),(1)(4),(2)(3),(2)(4)构成从起点到终点的路径,将结果转存到SA中:
(1)(3),(2)(3) 构成从起点到终点的路径,将结果转存到SA中:
S05、比较SA中的路径结果,取其中距离短的路径作为本次路径规划的结果。更具体地,在步骤S02 、S03中,采用从起点到终点方向的交通规则。
(1)(3),(2)(3)比较,取(1)(3)即
S—>G—>D—>H—>B—>A—>E
作为本次路径规划的结果。
本例可以初步说明加了断点之后,加了一些路径选择,因而可选择路径增多,减少了规划失败的可能。
Claims (2)
1.导航设备中增加路径实现路径规划的方法,依赖于导航设备中的处理器实现, 与处理器配套的存储介质中存储有地图以及图中各路口的交通规则,其特征在于:当确定起点和终点后,路径规划包含以下步骤:
S01、设置存储区域SA,按照迪杰斯特拉原理,根据地图及交通规则计算从起点到终点的路径,并将结果转存到SA中,
S02、按照迪杰斯特拉原理,根据地图及起点到终点方向的交通规则,以设定的终点作为开始,设定的起点作为结束,计算路径,并将结果转存到SA中,
S03、若S01、 S02中有路径断点,按照迪杰斯特拉原理,根据地图及交通规则计算从起点到断点(1),从断点到起点(2),从断点到终点的路径(3),以及从终点到断点的路径(4)的四条路径,
S04、若 (1)(3),(1)(4),(2)(3),(2)(4)构成从起点到终点条路径,将结果转存到SA中,
S05、比较SA中的路径结果,取其中距离短的路径作为本次路径规划的结果。
2.权利要求1中所述步骤S02 、S03,其特征在于,采用从起点到终点方向的交通规则。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711176038.4A CN108303105A (zh) | 2017-11-22 | 2017-11-22 | 导航设备中增加路径实现路径规划的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711176038.4A CN108303105A (zh) | 2017-11-22 | 2017-11-22 | 导航设备中增加路径实现路径规划的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108303105A true CN108303105A (zh) | 2018-07-20 |
Family
ID=62869643
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711176038.4A Pending CN108303105A (zh) | 2017-11-22 | 2017-11-22 | 导航设备中增加路径实现路径规划的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108303105A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111325366A (zh) * | 2018-12-13 | 2020-06-23 | 杭州海康机器人技术有限公司 | 一种自动导引车地图断点查找的方法和装置 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1734238A (zh) * | 2005-09-15 | 2006-02-15 | 北京工业大学 | 中心控制式车载导航系统两阶段多路径优化方法 |
CN1811343A (zh) * | 2005-01-25 | 2006-08-02 | 三星电子株式会社 | 在导航系统中寻找路径的方法 |
CN102506886A (zh) * | 2011-11-15 | 2012-06-20 | 深圳市路畅科技有限公司 | 导航设备中实现路径规划的方法 |
US20140019041A1 (en) * | 2012-07-13 | 2014-01-16 | Harman Becker Automotive Systems Gmbh | Method of estimating an ability of a vehicle to reach a target road segment, method of generating a database, and navigation system |
CN105588572A (zh) * | 2014-10-02 | 2016-05-18 | 财团法人资讯工业策进会 | 路径规划系统、路径规划方法、行车信息更新方法 |
CN105758410A (zh) * | 2015-11-14 | 2016-07-13 | 大连东软信息学院 | 基于A‐Star 算法的快速路径规划混合方法 |
CN106840188A (zh) * | 2017-02-23 | 2017-06-13 | 济南浪潮高新科技投资发展有限公司 | 一种路径规划方法和装置 |
-
2017
- 2017-11-22 CN CN201711176038.4A patent/CN108303105A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1811343A (zh) * | 2005-01-25 | 2006-08-02 | 三星电子株式会社 | 在导航系统中寻找路径的方法 |
CN1734238A (zh) * | 2005-09-15 | 2006-02-15 | 北京工业大学 | 中心控制式车载导航系统两阶段多路径优化方法 |
CN102506886A (zh) * | 2011-11-15 | 2012-06-20 | 深圳市路畅科技有限公司 | 导航设备中实现路径规划的方法 |
US20140019041A1 (en) * | 2012-07-13 | 2014-01-16 | Harman Becker Automotive Systems Gmbh | Method of estimating an ability of a vehicle to reach a target road segment, method of generating a database, and navigation system |
CN105588572A (zh) * | 2014-10-02 | 2016-05-18 | 财团法人资讯工业策进会 | 路径规划系统、路径规划方法、行车信息更新方法 |
CN105758410A (zh) * | 2015-11-14 | 2016-07-13 | 大连东软信息学院 | 基于A‐Star 算法的快速路径规划混合方法 |
CN106840188A (zh) * | 2017-02-23 | 2017-06-13 | 济南浪潮高新科技投资发展有限公司 | 一种路径规划方法和装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111325366A (zh) * | 2018-12-13 | 2020-06-23 | 杭州海康机器人技术有限公司 | 一种自动导引车地图断点查找的方法和装置 |
CN111325366B (zh) * | 2018-12-13 | 2023-09-19 | 杭州海康机器人股份有限公司 | 一种自动导引车地图断点查找的方法和装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108151751B (zh) | 一种基于高精度地图和传统地图结合的路径规划方法及装置 | |
JP5906837B2 (ja) | 経路探索方法、経路探索装置、及びプログラム | |
WO2000038228A1 (fr) | Appareil et procede de cablage brute et support d'enregistrement conservant un programme de cablage brute | |
CN102506886B (zh) | 导航设备中实现路径规划的方法 | |
WO1998024035A1 (en) | Method for determining exits and entrances for a region in a network | |
CN111158365A (zh) | 一种路径规划方法、装置、机器人及存储介质 | |
JP2009042243A (ja) | 経路発見計算のための複数のコストレベルの使用 | |
EP3048421B1 (en) | Method and system for generalising topographical map data | |
CN110044359A (zh) | 一种导览机器人路径规划方法、装置、机器人和存储介质 | |
CN107192399B (zh) | 导航方法、装置、存储介质及终端 | |
CN111865799B (zh) | 路径规划方法、装置、路径规划设备及存储介质 | |
CN107276896A (zh) | 改进迪杰斯特拉算法的两点间最短路径搜索方法 | |
CN108268974A (zh) | 一种路径推荐的方法及装置 | |
CN114705196B (zh) | 一种用于机器人的自适应启发式全局路径规划方法与系统 | |
CN108303105A (zh) | 导航设备中增加路径实现路径规划的方法 | |
CN110598948A (zh) | 针对旅游景点多点归源的全排列路径规划的提速方法 | |
JP7135699B2 (ja) | 経路探索システムおよび経路探索プログラム | |
CN116465425A (zh) | 一种局部优化和双向计算的启发式路径规划方法 | |
CN108303106A (zh) | 导航设备中实现路径规划的方法 | |
CN114399124B (zh) | 路径数据处理、路径规划方法、装置和计算机设备 | |
WO2019184126A1 (en) | Method of route planning and handling prohibited complex driving maneuvers | |
CN110210305A (zh) | 行驶路径偏差确定方法及装置、存储介质及电子装置 | |
CN111833592B (zh) | 一种交叉口的交通组织优化方法、装置和计算机设备 | |
CN111798015B (zh) | 一种规划路线调整方法、装置、电子设备及存储介质 | |
US20170371996A1 (en) | Sharing global route topologies in detailed routing |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20180720 |
|
WD01 | Invention patent application deemed withdrawn after publication |