CN108801238B - 一种基于gpx的路径优化方法 - Google Patents
一种基于gpx的路径优化方法 Download PDFInfo
- Publication number
- CN108801238B CN108801238B CN201710286793.1A CN201710286793A CN108801238B CN 108801238 B CN108801238 B CN 108801238B CN 201710286793 A CN201710286793 A CN 201710286793A CN 108801238 B CN108801238 B CN 108801238B
- Authority
- CN
- China
- Prior art keywords
- gpx
- lat
- point
- long
- file
- 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.)
- Expired - Fee Related
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)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
- Navigation (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=(p1,···,pN),其中,N为点的个数,pi=(Lati,Longi)为第i个点,Lati表示第i个点的纬度,Longi表示第i个点的经度;δ为阈值;ck为第k个角点在序列P中的编号,c1=1,k=2;
(2)令Li,j表示连接第i点和第j点的线段,bi,j表示第j点相对于第i点的航向,bi,j∈[0°,360°),对于i=1,···,N-1,根据以下方法计算bi,i+1,其中x,y,z为中间变量,
(2.1)x=sin(Longi+1-Longi)*cos(Lati+1)
(2.2)y=cos(Lati)*sin(Lati+1)-sin(Lati)*cos(Lati+1)*cos(Longi+1-Longi)
(2.3)z=atan2(x,y)
(3)αi表示线段Li-1,i和线段Li.i+1的夹角(αi∈[0°,180°]),对于i=2,···,N-1,根据以下方法计算αi,
(4)对于i=2,···,N-1,如果αi<δ,则令ck=i,同时将点ck加入到队列Γ中,并执行k=k+1;
(5)令ck=N,将点ck加入到队列Γ中,令T=k,其中T为队列Γ的长度;
(6)新建目标GPX文件;
(8)输出目标GPX文件。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实例进一步阐述本发明。
设GPX格式的输入文件名为input.gpx,输出文件名为output.gpx,具体实现步骤如下:
(1)从input.gpx文件读取点的序列至序列P,P=(p1,···,pN),其中,N为点的个数,pi=(Lati,Longi)为第i个点,Lati表示第i个点的纬度,Longi表示第i个点的经度;
(2)设阈值δ=172°;c1=1,k=2,其中,ck为第k个角点在序列P中的编号;
(3)令Li,j表示连接第i点和第j点的线段,bi,j表示第j点相对于第i点的航向,bi,j∈[0°,360°),对于i=1,···,N-1,根据以下方法计算bi,i+1,其中x,y,z为中间变量,
(3.1)x=sin(Longi+1-Longi)*cos(Lati+1)
(3.2)y=cos(Lati)*sin(Lati+1)-sin(Lati)*cos(Lati+1)*cos(Longi+1-Longi)
(3.3)z=atan2(x,y)
(4)αi表示线段Li-1,i和线段Li.i+1的夹角(αi∈[0°,180°]),对于i=2,···,N-1,根据以下方法计算αi,
(5)对于i=2,···,N-1,如果αi<δ,则令ck=i,同时将点ck加入到队列Γ中,并执行k=k+1;
(6)令ck=N,将点ck加入到队列Γ中,令T=k,其中T为队列Γ的长度;
(7)设目标GPX文件名为output.gpx,新建目标GPX文件output.gpx;
(9)输出output.gpx文件。
以上所述,仅为本发明最佳实现方式,任何熟悉本领域的技术人员在本发明披露的技术范围内,可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。
Claims (1)
1.一种基于GPX格式的路径优化方法,其特征在于,GPX格式用于GPS信息交换;对基于GPX格式的轨迹进行优化,具体实现步骤如下:
(1)从GPX格式的文件获取点的序列P=(p1,···,pN),其中,N为点的个数,pi=(Lati,Longi)为第i个点,Lati表示第i个点的纬度,Longi表示第i个点的经度;δ为阈值;ck为第k个角点在序列P中的编号,c1=1,k=2;
(2)令Li,j表示连接第i点和第j点的线段,bi,j表示第j点相对于第i点的航向,bi,j∈(0°,360°),对于i=1,···,N-1,根据以下方法计算bi,i+1,其中x,y,z为中间变量,
(2.1)x=sin(Longi+1-Longi)*cos(Lati+1)
(2.2)y=cos(Lati)*sin(Lati+1)-sin(Lati)*cos(Lati+1)*cos(Longi+1-Longi)
(2.3)z=atan2(x,y)
(3)αi表示线段Li-1,i和线段Li.i+1的夹角(αi∈[0°,180°]),对于i=2,···,N-1,根据以下方法计算αi,
(4)对于i=2,···,N-1,如果αi<δ,则令ck=i,同时将点ck加入到队列Γ中,并执行k=k+1;
(5)令ck=N,将点ck加入到队列Γ中,令T=k,其中T为队列Γ的长度;
(6)新建目标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 CN108801238A (zh) | 2018-11-13 |
CN108801238B true 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) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113375658B (zh) * | 2021-06-15 | 2023-05-09 | 电子科技大学中山学院 | 移动机器人故障下同时fdd和slam的方法及系统 |
CN114485677B (zh) * | 2022-04-14 | 2022-06-24 | 中国民用航空总局第二研究所 | 结合飞行轨迹变高度的民航导航设备视距覆盖分析方法 |
Citations (8)
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 | 厦门市润铭电子科技有限公司 | 一种行车轨迹的平滑方法 |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家海洋局第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN106454722A (zh) * | 2016-09-09 | 2017-02-22 | 华南理工大学 | 一种移动通信终端基于地图匹配的动态差分定位方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10670417B2 (en) * | 2015-05-13 | 2020-06-02 | Telenav, Inc. | Navigation system with output control mechanism and method of operation thereof |
-
2017
- 2017-04-27 CN CN201710286793.1A patent/CN108801238B/zh not_active Expired - Fee Related
Patent Citations (8)
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 | 厦门市润铭电子科技有限公司 | 一种行车轨迹的平滑方法 |
CN106225784A (zh) * | 2016-06-13 | 2016-12-14 | 国家海洋局第二海洋研究所 | 基于低成本多传感器融合行人航位推算方法 |
CN106454722A (zh) * | 2016-09-09 | 2017-02-22 | 华南理工大学 | 一种移动通信终端基于地图匹配的动态差分定位方法 |
Non-Patent Citations (1)
Title |
---|
Digitalized Roads based on GPS data in a Virtual World;José Gerardo Carrillo González 等;《SciVerse ScienceDirect》;20131231;第20卷(第29期);第20-29页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108801238A (zh) | 2018-11-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110146910B (zh) | 一种基于gps与激光雷达数据融合的定位方法及装置 | |
CN105890592B (zh) | 基于Online-WSVR算法的车辆位置信息预测方法 | |
WO2018072350A1 (zh) | 车辆轨迹预测方法及装置 | |
CN108171529B (zh) | 一种地址相似度评估方法 | |
Cossaboom et al. | Augmented Kalman filter and map matching for 3D RISS/GPS integration for land vehicles | |
CN108801238B (zh) | 一种基于gpx的路径优化方法 | |
Wang et al. | Improved particle filter-based matching method with gravity sample vector for underwater gravity-aided navigation | |
Han et al. | A mismatch diagnostic method for TERCOM-based underwater gravity-aided navigation | |
CN104197958A (zh) | 一种基于激光测速仪航位推算系统的里程计标定方法 | |
CN108562289A (zh) | 连续多边几何环境中四旋翼飞行器激光雷达导航方法 | |
CN109100750A (zh) | 一种基于自适应权值估计的星座导航敏感器调度方法 | |
Siebler et al. | Train localization with particle filter and magnetic field measurements | |
Rodríguez et al. | VecStatGraphs2D, a tool for the analysis of two-dimensional vector data: an example using QuikSCAT Ocean Winds | |
CN112034438A (zh) | 一种雷达标定方法、装置、电子设备及存储介质 | |
CN115103437B (zh) | 一种蓝牙和惯性测量单元的紧耦合室内定位方法 | |
Kauffman et al. | Navigation via H-field signature map correlation and INS integration | |
CN105424047A (zh) | 基于路标信息的航天器姿态指向误差辨识方法 | |
Ahmed et al. | Minimizing GPS dependency for a vehicle’s trajectory identification by using data from smartphone inertial sensors and onboard diagnostics device | |
Song et al. | Enhanced Map‐Aided GPS/3D RISS Combined Positioning Strategy in Urban Canyons | |
Liu et al. | A tightly-coupled GNSS/INS/MM integrated system based on binary search algorithm for train localization applications | |
Kim et al. | A study on estimation of traffic flow using image-based vehicle identification technology | |
Liu et al. | Finite-horizon URTSS-based position estimation for urban vehicle localization | |
JP7211513B2 (ja) | 地図データ生成装置 | |
CN113465616A (zh) | 轨迹异常点检测方法和装置、电子设备、计算机程序产品及计算机可读存储介质 | |
Moussa et al. | Mass Flow Meter and Vehicle Information DR Land Vehicles Navigation System in Indoor Environment |
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 |
Granted publication date: 20210813 |
|
CF01 | Termination of patent right due to non-payment of annual fee |