CN108801238A - 一种基于gpx的路径优化方法 - Google Patents
一种基于gpx的路径优化方法 Download PDFInfo
- Publication number
- CN108801238A CN108801238A CN201710286793.1A CN201710286793A CN108801238A CN 108801238 A CN108801238 A CN 108801238A CN 201710286793 A CN201710286793 A CN 201710286793A CN 108801238 A CN108801238 A CN 108801238A
- Authority
- CN
- China
- Prior art keywords
- gpx
- point
- formats
- indicate
- files
- 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
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/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- 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/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
- G01C21/30—Map- or contour-matching
- G01C21/32—Structuring or formatting of map data
-
- 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
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)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明涉及一种基于GPX格式的路径优化方法,GPX格式用于GPS信息交换,广泛应用于地理信息***、车辆导航、路径规划等领域;本发明对基于GPX格式的轨迹进行优化,产生更为简洁和平滑的路径,所产生的路径可以用于扩展电子地图、车辆自主导航等深层次应用。
Description
技术领域
本发明涉及一种基于GPX格式的路径优化方法,属于自主导航领域。
背景技术
GPX(GPS eXchange Format)格式用于GPS信息交换,广泛应用于地理信息***、车辆导航、路径规划等领域;在车辆或机器人自主导航领域,如何对未知环境进行建图并将未知环境地图增量地并入已知电子地图是一个关键问题。
传统的方法通过人工方式对新的道路进行测量,该方法耗费大量的人力资源且效率不高;文献(参见“赵书美,魏冬,李永生,门永新,赵福全:《一种基于GPS导航仪的导航地图更新方法及其装置》,发明专利,专利号201210201897.5,授权日期2015年4月30日”)提出了一种基于GPS导航仪的导航地图更新方法,该方法在车载GPS导航仪中查找不到目的地时,对从出发地到目的地所经过线路点逐点进行经纬度采样并记录,并在将上述记录按指定格式存储。该方法的一个缺点在于记录了从出发地到目的地的所有原始的采样点,没有对采样点进行处理,这样有可能在同一条直线道路上存在多个采样点,导致地图数据过大。
发明内容
本发明本发明涉及一种基于GPX格式的路径优化方法;GPX格式用于GPS信息交换,广泛应用于地理信息***、车辆导航、路径规划等领域;本发明对基于GPX格式的轨迹进行优化,产生更为简洁和平滑的路径,所产生的路径可以用于扩展电子地图、车辆自主导航等深层次应用,具体实现步骤如下:
(1)从GPX格式的文件获取点的序列P=(p 1,…,p N),其中,N为点的个数,p i =(Lat i ,Long i )为第i个点,Lat i 表示第i个点的纬度,Long i 表示第i个点的经度;为阈值;c k 为第k个角点在序列P中的编号,,k=2;
(2)令L i,j 表示连接第i点和第j点的线段,b i,j 表示第j点相对于第i点的航向,,对于i=1,…,N-1,根据以下方法计算b i,i+1,其中x,y,z为中间变量,
(2.1)
(2.2)
(2.3)
(2.4)
(3)表示线段L i-1,i 和线段L i,i+1的夹角(),对于i=2,…,N-1,根据以下方法计算,
(4)对于i=2,…,N-1,如果,则令,同时将点c k 加入到队列中,并执行k=k+1;
(5)令,将点c k 加入到队列中,令T=k,其中T为队列的长度;
(6)新建目标GPX文件;
(7)对于k=1,...,T,将加入目标GPX文件中;
(8)输出目标GPX文件。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实例进一步阐述本发明。
设GPX格式的输入文件名为input.gpx,输出文件名为output.gpx,具体实现步骤如下:
(1)从input.gpx文件读取点的序列至序列P,P=(p 1,…,p N),其中,N为点的个数,p i =(Lat i ,Long i )为第i个点,Lat i 表示第i个点的纬度,Long i 表示第i个点的经度;
(2)设置阈值=;,k=2,其中,c k 为第k个角点在序列P中的编号,
(3)令L i,j 表示连接第i点和第j点的线段,b i,j 表示第j点相对于第i点的航向,,对于i=1,…,N-1,根据以下方法计算b i,i+1,其中x,y,z为中间变量,
(3.1)
(3.2)
(3.3)
(3.4)
(4)表示线段L i-1,i 和线段L i,i+1的夹角(),对于i=2,…,N-1,根据以下方法计算,
(5)对于i=2,…,N-1,如果,则令,同时将点c k 加入到队列中,并执行k=k+1;
(6)令,将点c k 加入到队列中,令T=k,其中T为队列的长度;
(7)设目标GPX文件名为output.gpx,新建目标GPX文件output.gpx;
(8)对于k=1,...,T,将加入output.gpx文件中;
(9)输出output.gpx文件。
以上所述,仅为本发明最佳实现方式,任何熟悉本领域的技术人员在本发明披露的技术范围内,可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。
Claims (1)
1.本发明涉及一种基于GPX格式的路径优化方法;GPX格式用于GPS信息交换,广泛应用于地理信息***、车辆导航、路径规划等领域;本发明对基于GPX格式的轨迹进行优化,产生更为简洁和平滑的路径,所产生的路径可以用于扩展电子地图、车辆自主导航等深层次应用,具体实现步骤如下:
(1)从GPX格式的文件获取点的序列P=(p 1,…,p N),其中,N为点的个数,p i =(Lat i ,Long i )为第i个点,Lat i 表示第i个点的纬度,Long i 表示第i个点的经度;为阈值;c k 为第k个角点在序列P中的编号,,k=2;
(2)令L i,j 表示连接第i点和第j点的线段,b i,j 表示第j点相对于第i点的航向,,对于i=1,…,N-1,根据以下方法计算b i,i+1,其中x,y,z为中间变量,
(2.1)
(2.2)
(2.3)
(2.4)
(3)表示线段L i-1,i 和线段L i,i+1的夹角(),对于i=2,…,N-1,根据以下方法计算,
(4)对于i=2,…,N-1,如果,则令,同时将点c k 加入到队列中,并执行k=k+1;
(5)令,将点c k 加入到队列中,令T=k,其中T为队列的长度;
(6)新建目标GPX文件;
(7)对于k=1,...,T,将加入目标GPX文件中;
(8)输出目标GPX文件。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710286793.1A CN108801238B (zh) | 2017-04-27 | 2017-04-27 | 一种基于gpx的路径优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710286793.1A CN108801238B (zh) | 2017-04-27 | 2017-04-27 | 一种基于gpx的路径优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108801238A true CN108801238A (zh) | 2018-11-13 |
CN108801238B CN108801238B (zh) | 2021-08-13 |
Family
ID=64070331
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710286793.1A Expired - Fee Related CN108801238B (zh) | 2017-04-27 | 2017-04-27 | 一种基于gpx的路径优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108801238B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113375658A (zh) * | 2021-06-15 | 2021-09-10 | 电子科技大学中山学院 | 移动机器人故障下同时fdd和slam的方法及*** |
CN114485677A (zh) * | 2022-04-14 | 2022-05-13 | 中国民用航空总局第二研究所 | 结合飞行轨迹变高度的民航导航设备视距覆盖分析方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101713999A (zh) * | 2009-11-18 | 2010-05-26 | 北京矿冶研究总院 | 地下自主铲运机的导航控制方法 |
CN101975955A (zh) * | 2010-09-29 | 2011-02-16 | 北京航空航天大学 | 一种gnss模拟器中的通用三维载体运动轨迹生成方法 |
CN103475729A (zh) * | 2013-09-18 | 2013-12-25 | 南京载玄信息科技有限公司 | 一种物联网应用的轨迹特征点提取方法 |
CN103795373A (zh) * | 2013-11-29 | 2014-05-14 | 电子科技大学中山学院 | 一种不完备***故障诊断的生成粒子滤波器方法 |
CN104050237A (zh) * | 2014-05-23 | 2014-09-17 | 北京中交兴路信息科技有限公司 | 一种道路测绘方法和*** |
CN104215249A (zh) * | 2014-08-26 | 2014-12-17 | 厦门市润铭电子科技有限公司 | 一种行车轨迹的平滑方法 |
US20160334228A1 (en) * | 2015-05-13 | 2016-11-17 | Telenav, Inc. | Navigation system with output control mechanism and method of operation thereof |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家***第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN106454722A (zh) * | 2016-09-09 | 2017-02-22 | 华南理工大学 | 一种移动通信终端基于地图匹配的动态差分定位方法 |
-
2017
- 2017-04-27 CN CN201710286793.1A patent/CN108801238B/zh not_active Expired - Fee Related
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101713999A (zh) * | 2009-11-18 | 2010-05-26 | 北京矿冶研究总院 | 地下自主铲运机的导航控制方法 |
CN101975955A (zh) * | 2010-09-29 | 2011-02-16 | 北京航空航天大学 | 一种gnss模拟器中的通用三维载体运动轨迹生成方法 |
CN103475729A (zh) * | 2013-09-18 | 2013-12-25 | 南京载玄信息科技有限公司 | 一种物联网应用的轨迹特征点提取方法 |
CN103795373A (zh) * | 2013-11-29 | 2014-05-14 | 电子科技大学中山学院 | 一种不完备***故障诊断的生成粒子滤波器方法 |
CN104050237A (zh) * | 2014-05-23 | 2014-09-17 | 北京中交兴路信息科技有限公司 | 一种道路测绘方法和*** |
CN104215249A (zh) * | 2014-08-26 | 2014-12-17 | 厦门市润铭电子科技有限公司 | 一种行车轨迹的平滑方法 |
US20160334228A1 (en) * | 2015-05-13 | 2016-11-17 | Telenav, Inc. | Navigation system with output control mechanism and method of operation thereof |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家***第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN106454722A (zh) * | 2016-09-09 | 2017-02-22 | 华南理工大学 | 一种移动通信终端基于地图匹配的动态差分定位方法 |
Non-Patent Citations (1)
Title |
---|
JOSÉ GERARDO CARRILLO GONZÁLEZ 等: "Digitalized Roads based on GPS data in a Virtual World", 《SCIVERSE SCIENCEDIRECT》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113375658A (zh) * | 2021-06-15 | 2021-09-10 | 电子科技大学中山学院 | 移动机器人故障下同时fdd和slam的方法及*** |
CN113375658B (zh) * | 2021-06-15 | 2023-05-09 | 电子科技大学中山学院 | 移动机器人故障下同时fdd和slam的方法及*** |
CN114485677A (zh) * | 2022-04-14 | 2022-05-13 | 中国民用航空总局第二研究所 | 结合飞行轨迹变高度的民航导航设备视距覆盖分析方法 |
CN114485677B (zh) * | 2022-04-14 | 2022-06-24 | 中国民用航空总局第二研究所 | 结合飞行轨迹变高度的民航导航设备视距覆盖分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108801238B (zh) | 2021-08-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105953805B (zh) | 地图验证方法和装置 | |
CN101183006B (zh) | 一种导航***剩余时间确定方法、装置及导航*** | |
CN104154916A (zh) | 一种基于激光陀螺捷联惯组的车载定位设备 | |
WO2018072350A1 (zh) | 车辆轨迹预测方法及装置 | |
US20190311077A1 (en) | System and method for generating vehicle travel data | |
CN103308055B (zh) | 一种导航***的车辆道路匹配方法 | |
CN107132563A (zh) | 一种里程计结合双天线差分gnss的组合导航方法 | |
CN101363907A (zh) | 基于卫星定位的道路匹配方法和*** | |
CN102778230A (zh) | 一种人工物理优化粒子滤波的重力梯度辅助定位方法 | |
CN109523781B (zh) | 一种基于卫星定位的路口预测方法 | |
CN108801238A (zh) | 一种基于gpx的路径优化方法 | |
CN104197958A (zh) | 一种基于激光测速仪航位推算***的里程计标定方法 | |
CN101807348B (zh) | 一种动态网络导航***及方法 | |
CN116107300A (zh) | 用于越野环境下的基于先验知识适用于无人驾驶的路径规划方法 | |
CN106153058B (zh) | 导航方法、装置和终端 | |
CN113375685A (zh) | 基于子轨迹相交的城市路口中心识别及路口转弯规则提取方法 | |
CN105279963A (zh) | 一种获取路况信息的方法及装置 | |
CN1932922B (zh) | 准确显示实时路况信息的方法 | |
Chang et al. | Traffic congestion identification method based on GPS equipped floating car | |
Bevermeier et al. | Barometric height estimation combined with map-matching in a loosely-coupled Kalman-filter | |
CN104422459A (zh) | 一种确定车辆位置的方法及装置、导航方法和导航*** | |
US20230168368A1 (en) | Guardrail estimation method based on multi-sensor data fusion, and vehicle-mounted device | |
CN103471593B (zh) | 一种基于gps信息的惯性导航***测量误差修正方法 | |
CN105070060A (zh) | 一种基于公交车载gps数据的城市道路交通状态判别方法 | |
CN108564793A (zh) | 一种基于rfid电子车牌数据的行程时间预测方法 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210813 |