本发明涉及一种基于gpx格式的路径优化方法,属于自主导航领域。
背景技术
gpx(gpsexchangeformat)格式用于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个点的经度;
(2)令li,j表示连接第i点和第j点的线段,bi,j表示第j点相对于第i点的航向,
(2.1)
(2.2)
(2.3)
(2.4)
(3)
(4)对于i=2,…,n-1,如果
(5)令
(6)新建目标gpx文件;
(7)对于k=1,...,t,将
(8)输出目标gpx文件。
具体实施方式
为了使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实例进一步阐述本发明。
设gpx格式的输入文件名为input.gpx,输出文件名为output.gpx,具体实现步骤如下:
(1)从input.gpx文件读取点的序列至序列p,p=(p1,…,pn),其中,n为点的个数,pi=(lati,longi)为第i个点,lati表示第i个点的纬度,longi表示第i个点的经度;
(2)设置阈值
(3)令li,j表示连接第i点和第j点的线段,bi,j表示第j点相对于第i点的航向,
(3.1)
(3.2)
(3.3)
(3.4)
(4)
(5)对于i=2,…,n-1,如果
(6)令
(7)设目标gpx文件名为output.gpx,新建目标gpx文件output.gpx;
(8)对于k=1,...,t,将
(9)输出output.gpx文件。
以上所述,仅为本发明最佳实现方式,任何熟悉本领域的技术人员在本发明披露的技术范围内,可显而易见地得到的技术方案的简单变化或等效替换均落入本发明的保护范围内。