CN106017484B - 轨道路径数据采集及拟合方法 - Google Patents
轨道路径数据采集及拟合方法 Download PDFInfo
- Publication number
- CN106017484B CN106017484B CN201610320152.9A CN201610320152A CN106017484B CN 106017484 B CN106017484 B CN 106017484B CN 201610320152 A CN201610320152 A CN 201610320152A CN 106017484 B CN106017484 B CN 106017484B
- Authority
- CN
- China
- Prior art keywords
- point
- distance
- path
- points
- source
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明涉及一种轨道路径数据采集及拟合方法,通过GPS定位技术,获取并保存位置数据,计算任意两个相邻路径点的之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,把斜率突变的点称为毛刺点,主动割弃毛刺点;用舍弃了毛刺点后的各个节点和路径点拟合出轨道路径曲线;然后计算轨道路径上任意两点间的最短路径。本发明通过计算相邻路径点之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,把斜率突变的毛刺点剔除,可以获取精准的道路曲线数据。改进了任意两点间最短距离的算法,能够快速准确的计算出任意两点之间的实际距离。
Description
技术领域
本发明涉及一种轨道路径的数据采集与分析的方法,尤其涉及铁路轨道在有弯道和交叉道路的情况下精准描绘线路,同时精确计算任意两点之间最短距离的方法。
背景技术
随着通讯技术的发展,计算铁路、公路路径长度的需求变得非常频繁,地图数据往往不容易获取,往往需要通过GPS打点的方式获取地理数据,但GPS本身的精度误差往往达到5米以上导致***采集的速度坐标等历史数据毛刺较多,且不能准确计算出带弯道和交叉的铁路轨道任意两点之间的最短距离,这样就有很大的碰撞隐患。
只有算出两辆交通工具在相遇过程中采用最短路径时的最短距离,并及时提醒,才能防止碰撞的可能,这就要求我们在制作专有道路路线时需要合理处理这些异常数据,否则,不仅线路误差变大,还将产生交大的线路距离误差。
发明内容
本发明要解决的技术问题是提供一种轨道路径数据采集及拟合算法,可以根据道路模板拟合出精准的的道路曲线,并计算线路中任意两点之间的最短距离。
为解决上述技术问题,本发明涉及一种轨道路径数据采集及拟合算法,。
一种轨道路径数据采集及拟合方法,将采集到的位置数据拟合成路径曲线并计算出路径曲线上任意两点间的最短路径,具体包括以下步骤:
(a) 采集位置数据的到多个位置点,将多股轨道的衔接点定义为节点,将节点之间的离散点定义为路径点,计算任意两个相邻路径点的之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,把斜率突变的点称为毛刺点,主动割弃毛刺点;
(b) 用舍弃了毛刺点后的各个节点和路径点拟合出轨道路径曲线;
(c) 计算轨道路径上任意两点间的最短路径。
优选的:轨道路径上任意两点间的最短路径通过以下方法计算:
(1)将轨道路径上的某一点定义为源点,建立源点到每个位置点距离的距离数据信息,源点到相邻点的距离已知,源点到源点的距离为零,将源点到与源点不相邻的位置点的距离赋予一个大于路径全程的数值;
(2)将源点到各个位置点的距离更新到距离数据信息中,并记录源点;
(3)在未记录的位置点中选出与源点距离数值最小的位置点,记录该点,将与该点相邻且未记录的位置点定义为邻接点,将源点到该点的距离与该点到邻接点的距离相加,若相加后得到的距离数值小于该邻接点到源点的距离,则将计算结果更新到距离数据信息中,否则不更新;
(4)重复步骤(3),直到所有的位置点都被记录,此时距离数据信息中的源点到各个位置点的距离数据极为源点到每个位置点的最短路径。
优选的,步骤(3)中,邻接点有多个时,分别将每个邻接点到该点的距离与该点到源点距离相加,若相加后得到的距离数值小于该邻接点点到源点的距离数值,则将计算结果更新到距离数据信息中,否则不更新,
优选的,通过选取不同的位置点作为源点,可以算出轨道路径上任意两点间的最短路径。
优选的,计算轨道路径上任意两点间的最短路径用于判断两轨道车发生碰撞的可能性。
本发明的有益效果为:
本发明通过计算相邻路径点之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,把斜率突变的毛刺点剔除,可以获取精准的道路曲线数据,改进了任意两点间最短距离的算法,能够快速准确的计算出任意两点之间的实际距离,通过算出两辆交通工具在相遇过程中采用最短路径时的最短距离,并及时提醒,防止碰撞的发生。
附图说明
图1、轨道线路图;
图2、路径网络图;
图3、轨道车连挂预警***工作流程图。
附图标记列表:
1-节点;2-路径点;3-毛刺点。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。
通过GPS定位技术,获取并保存的所有采集数据是轨道线路制作的重要参数和依据。轨道路线制作功能定义了节点和线路的概念,将多股轨道的衔接点定义为节点,将节点之间的离散点定义为路径点,如图1所示,图中所有的点都是通过GPS采集的位置数据,大圆点为节点1,小圆点为路径点2,计算任意相邻两个路径点2之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,斜率柔性变化范围可以根据实际情况来设定,把斜率突变的点称为毛刺点3,主动割弃因GPS误差产生的毛刺点3,用舍弃了毛刺点3后的各个节点1和路径点2拟合出轨道路径曲线;然后计算轨道路径上任意两点间的最短路径。
下面举例说明轨道路径上任意两点间的最短路径的算法。
假设路径路径网络如图2所示:
对应的数组结构如表1所示:
1):源点A到邻接点B,D,E的距离分别是2,1,3,更新到距离数组中(顶点到自身的距离为0)。
2):将源点A加入已记录后,如表2所示:
3):从距离数据中选择一个未记录的最小值1,对应途中的节点D。
4):将节点D加入已记录.。
5):节点D两个邻节点E,G,
A到E的距离可表示为:A到D的距离+D到E的距离,这个值(5+1=6)与当前距离数据中已存在的A到E的距离3大,则不更新A到E的距离;
A到G的距离可表示为:A到D的距离+D到G的距离,这个值(1+2=3)与当前距离数组中已存在的A到G的距离999小,则更新A到G的距离为3,如表3所示:
6):从距离数组中选择一个未记录的最小值2,对应途中的节点B。
7):将节点B加入已记录。
8):节点B的一个邻接点C
A到C的距离可表示为:A到B的距离+B到C的距离,这个值(2+2=4)与当前距离数组中已存在的A到C的距离999小,则更新A到C的距离为4,如表4所示:
9):从距离数据中选择一个未记录的最小值3,对应图中的节点E。
10):将节点E加入已记录。
11):节点E有两个邻接点F,H,
A到F的距离=A到E的距离+E到F的距离,这个值(3+6=9)与当前的距离数组中已存在的A到F的距离999小,则更新A到F的距离为9。
A到H的距离=A到E的距离+E到H的距离,这个值(3+1=4)与当前距离数组中已存在的A到H的的距离999小,则更新A到H的距离为4,如表5所示:
12):从距离数组中选择一个未记录的最小值3,对应图中的节点G。
13):将节点G加入已记录。
14):节点G有一个邻接点H,
A到H的距离=A到G的距离+G到H的距离,这个值(3+4=7)与当前距离数组中已存在的A到H的距离4大,则不更新A到H的距离,如表6所示:
15):从距离数组中选择一个未记录的最小值4,对应图中的节点C。
16):将节点C加入已记录。
17):节点C有一个邻接点F,
A到F的距离=A到C的距离+C到F的距离,这个值(4+1=5)与当前距离数组中已存在的A到F的距离9小,则更新A到F的距离为5,如表7所示:
18):从距离数组中选择一个未记录的最小值4,对应图中的节点H。
19):将节点H加入已记录。
20):节点H有两个邻接点F,I,
A到F的距离=A到H的距离+H到F的距离,这个值(4+1=5)与当前距离数组中已存在的A到F的距离5相等,则不更新A到F的距离。
A到I的距离=A到H的距离+H到I的距离,这个值(4+2=6)与当前距离数组中已存在的A到I的距离999小,则更新A到I的距离为6,如表8所示:
21):从距离数组中选择一个未记录的最小值5,对应图中的节点F。
22):将节点F加入已记录。
23):节点F有一个邻接点I,
A到I的距离=A到F的距离+F到I的距离,这个值(5+3=8)与当前距离数组中已存在的A到I的距离6大,则不更新A到I的距离,如表9所示:
24):从距离数组中选择一个未记录的最记录的最小值6,对应图中的节点I。
25):将节点I加入已记录。
26):节点I没有邻接点,则不处理。
27):到此为止,源点A到图中各节点的距离都已求出,结果如表10所示:
本发明的工作原理如下:
轨道车连挂预警***主要用于轨道车连挂时提供双方地理位置信息的***平台,轨道车的地理信息包含经纬度信息、轨道车速度、方向以及海拔,客户端通过GPS获取轨道车的地理位置信息,通过GPRS方式上传到服务端,或者通过RF直接发送到对向轨道车,对向轨道车通过GPRS从服务端获取来向轨道车的地理位置信息,或通过RF直接获取地理位置信息。然后,计算出两辆连挂轨道车的实时最短距离和最短路径,提供预警信息。
轨道车连挂预警***工作流程如图3所示:
轨道车连挂预警***包括:
1、主线程
主线程是***软件启动时的线程,主要负责预警***的初始化,轨道车之间的最短距离和最短路径的计算,并实时刷新画面和预警等功能。
***初始化包括,硬件检测(监听按键状态)、读取数据缓存、加载初始画面、读取***参数并创建子线程。其中子线程包含IO通讯线程、GPSIO线程、GPRSIO线程以及RFIO线程五个子线程,每个子线程负责各自功能木块。主线程的主要功能函数如下:
USB2IO按键接口,定时器循环扫描按键状态,检测按键功能。
ReadDataBank读取数据缓存。
LoadHmJia加载画面信息。
ReadConfigFile***初始化,读取***主备信息、轨道车信息、GPRS、GPS、RF等模块信息。
2、IO通信线程CommIoThread
负责显示终端主机与各个模块之间通讯连接以及刷新显示画面。
RefreshHm:刷新画面信息。
OpenGps/GPRS/RF :打开GPS、GPRS、RF模块。
3、主备机线程SpareIoThread
每一辆轨道车有两个显示终端,互为主备。
SpareIO此线程负责主备机切换和数据同步。
4、GPS线程GPSIoThread
GPSIO:负责与卫星通讯获取当前轨道车的地理位置信息、速度、方向以及海拔等信息
WriteDataBank:将GPSIO获取的数据帧解析写入缓存,并调用GPRSIO线程发送到服务器端,或者调用RFIO线程发送到对方轨道车。
5、GPRS线程GPRSIoThread
GPRSIo:负责连接轨道车连挂预警***服务器,通过与服务器通讯获取对方轨道车的地理位置信息,包括速度、方向、海拔等。
6、RF线程RFIoThread
当GPRS连接中断或异常时,启用RFIO线程,通过RF与对方轨道车建立连接通讯。
RFIo:负责发送己方轨道车的地理信息,并接受对方轨道车的地理信息。
以上是本发明的较佳实施方式,但本发明的保护范围不限于此。任何熟悉本领域的技术人员在本发明所揭露的技术范围内,未经创造性劳动想到的变换或替换,都应涵盖在本发明的保护范围之内。因此本发明的保护范围应以权利要求所限定的保护范围为准。
Claims (5)
1.一种轨道路径数据采集及拟合方法,其特征在于:将采集到的位置数据拟合成路径曲线并计算出路径曲线上任意两点间的最短路径,具体包括以下步骤:
(a)采集位置数据的到多个位置点,将多股轨道的衔接点定义为节点,将节点之间的离散点定义为路径点,计算任意两个相邻路径点的之间的斜率,根据相邻点斜率柔性变化的原则和相邻点必须线性连续的原则,把斜率突变的点称为毛刺点,主动割弃毛刺点;
(b)用舍弃了毛刺点后的各个节点和路径点拟合出轨道路径曲线;
(c)计算轨道路径上任意两点间的最短路径。
2.如权利要求1所述的轨道路径数据采集及拟合方法,其特征在于:轨道路径上任意两点间的最短路径通过以下方法计算:
(1)将轨道路径上的某一点定义为源点,建立源点到每个位置点距离的距离数据信息,源点到相邻点的距离已知,源点到源点的距离为零,将源点到与源点不相邻的位置点的距离赋予一个大于路径全程的数值,
(2)将源点到各个位置点的距离更新到距离数据信息中,并记录源点;
(3)在未记录的位置点中选出与源点距离数值最小的位置点,记录该点,将与该点相邻且未记录的位置点定义为邻接点,将源点到该点的距离与该点到邻接点的距离相加,若相加后得到的距离数值小于该邻接点到源点的距离,则将计算结果更新到距离数据信息中,否则不更新;
(4)重复步骤(3),直到所有的位置点都被记录,此时距离数据信息中的源点到各个位置点的距离数据极为源点到每个位置点的最短路径。
3.如权利要求2所述的轨道路径数据采集及拟合方法,其特征在于:步骤(3)中,邻接点有多个时,分别将每个邻接点到该点的距离与该点到源点距离相加,若相加后得到的距离数值小于该邻接点点到源点的距离数值,则将计算结果更新到距离数据信息中,否则不更新。
4.如权利要求2或3所述的轨道路径数据采集及拟合方法,其特征在于:通过选取不同的位置点作为源点,能够算出轨道路径上任意两点间的最短路径。
5.如权利要求4所述的轨道路径数据采集及拟合方法,其特征在于:计算轨道路径上任意两点间的最短路径用于判断两轨道车发生碰撞的可能性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610320152.9A CN106017484B (zh) | 2016-05-16 | 2016-05-16 | 轨道路径数据采集及拟合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610320152.9A CN106017484B (zh) | 2016-05-16 | 2016-05-16 | 轨道路径数据采集及拟合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106017484A CN106017484A (zh) | 2016-10-12 |
CN106017484B true CN106017484B (zh) | 2018-12-14 |
Family
ID=57097418
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610320152.9A Active CN106017484B (zh) | 2016-05-16 | 2016-05-16 | 轨道路径数据采集及拟合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106017484B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108268027B (zh) * | 2016-12-30 | 2021-09-17 | 法法汽车(中国)有限公司 | 驾驶轨迹优化方法及优化*** |
CN108470259B (zh) * | 2017-02-23 | 2021-05-25 | 北京京东振世信息技术有限公司 | 一种路径成本计算方法、装置、电子设备及存储介质 |
CN109033176B (zh) * | 2018-06-25 | 2024-02-27 | 腾讯科技(北京)有限公司 | 道路曲率的确定方法、装置、存储介质和计算机设备 |
CN110736994B (zh) * | 2018-07-18 | 2021-09-07 | 北京小米移动软件有限公司 | 距离检测函数的建立方法及装置、距离检测方法及装置 |
CN112912808B (zh) * | 2018-10-22 | 2023-12-26 | 株式会社尼罗沃克 | 行驶路径生成***、行驶路径生成方法、计算机可读取记录介质、坐标测量***以及无人机 |
CN110455292A (zh) * | 2019-08-16 | 2019-11-15 | 四川九洲电器集团有限责任公司 | 飞行轨迹确定方法、设备、飞行轨迹推演***及存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0387562A1 (de) * | 1989-03-11 | 1990-09-19 | Heinrich Kesper | Schiene für Motorkettensägen |
CN102320280A (zh) * | 2011-06-30 | 2012-01-18 | 清华大学 | 一种防止弯道车辆前撞的自动报警方法 |
CN102867057A (zh) * | 2012-09-17 | 2013-01-09 | 北京航空航天大学 | 一种基于视觉定位的虚拟向导构建方法 |
CN103678828A (zh) * | 2013-12-31 | 2014-03-26 | 北京理工大学 | 一种柔性线缆的自动布局方法及装置 |
-
2016
- 2016-05-16 CN CN201610320152.9A patent/CN106017484B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0387562A1 (de) * | 1989-03-11 | 1990-09-19 | Heinrich Kesper | Schiene für Motorkettensägen |
CN102320280A (zh) * | 2011-06-30 | 2012-01-18 | 清华大学 | 一种防止弯道车辆前撞的自动报警方法 |
CN102867057A (zh) * | 2012-09-17 | 2013-01-09 | 北京航空航天大学 | 一种基于视觉定位的虚拟向导构建方法 |
CN103678828A (zh) * | 2013-12-31 | 2014-03-26 | 北京理工大学 | 一种柔性线缆的自动布局方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN106017484A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106017484B (zh) | 轨道路径数据采集及拟合方法 | |
CN107533630A (zh) | 用于远程感测和车辆控制的实时机器视觉和点云分析 | |
CN103017780B (zh) | 移动状态下公交线路的规划方法、***和装置 | |
CN107289925A (zh) | 一种绘制用户轨迹的方法和装置 | |
CN105448184A (zh) | 地图道路的绘制方法及装置 | |
CN108362294A (zh) | 一种应用于自动驾驶的多车协同建图方法 | |
CN110990661B (zh) | 一种基于路网约束和密度聚类的兴趣区域出入口提取方法 | |
CN104574945B (zh) | 快速公交车辆在停站时间变化时的指挥调度***及方法 | |
CN115577324B (zh) | 雷达和船舶自动识别***数据融合方法及***、存储介质 | |
CN111125293A (zh) | 公交网络模型自动生成方法、装置及电子设备 | |
CN114299712B (zh) | 一种数据处理方法、装置、设备以及可读存储介质 | |
CN106228830A (zh) | 一种公交车到站时间实时预测***及方法 | |
CN112613677A (zh) | 一种航路网络生成方法、装置及计算机存储介质 | |
CN111309845B (zh) | 一种轨道交通路网宏观态势数据显示方法及*** | |
CN110377687A (zh) | 用户出行方式判别方法、装置和服务器 | |
CN104075712A (zh) | 一种交互式的导航***及方法 | |
CN105865482B (zh) | 一种地图导航的方法及装置 | |
US20240109570A1 (en) | Transportation operations devices and methods | |
CN104590325B (zh) | 铁路站场线路及区段绝缘点gps坐标自动测绘***方法 | |
CN103226895B (zh) | 用于为导航装置提供速度警告信息的方法和数据处理装置 | |
US20130085665A1 (en) | Controlling system and method for appointment | |
CN116255996A (zh) | 一种汽车立体导航方法、***、装置及介质 | |
CN108287354B (zh) | 一种数据自动纠错方法和装置及导航设备 | |
CN111928870B (zh) | 一种行驶路线规划的方法及装置、计算设备和存储介质 | |
Habtie et al. | Road Traffic state estimation framework based on hybrid assisted global positioning system and uplink time difference of arrival data collection methods |
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 |