CN113063413B - 基于多传感器的隧道位置定位方法 - Google Patents
基于多传感器的隧道位置定位方法 Download PDFInfo
- Publication number
- CN113063413B CN113063413B CN202110191563.3A CN202110191563A CN113063413B CN 113063413 B CN113063413 B CN 113063413B CN 202110191563 A CN202110191563 A CN 202110191563A CN 113063413 B CN113063413 B CN 113063413B
- Authority
- CN
- China
- Prior art keywords
- distance
- rfid
- radar
- inertial navigation
- tunnel
- 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
- 238000000034 method Methods 0.000 title claims abstract description 20
- 230000004927 fusion Effects 0.000 claims abstract description 11
- 238000012937 correction Methods 0.000 claims abstract description 9
- 238000005259 measurement Methods 0.000 claims description 21
- 238000013461 design Methods 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000007547 defect Effects 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 abstract description 3
- 238000010276 construction Methods 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- E—FIXED CONSTRUCTIONS
- E21—EARTH OR ROCK DRILLING; MINING
- E21F—SAFETY DEVICES, TRANSPORT, FILLING-UP, RESCUE, VENTILATION, OR DRAINING IN OR OF MINES OR TUNNELS
- E21F17/00—Methods or devices for use in mines or tunnels, not covered elsewhere
- E21F17/18—Special adaptations of signalling or alarm devices
-
- 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/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/86—Combinations of lidar systems with systems other than lidar, radar or sonar, e.g. with direction finders
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mining & Mineral Resources (AREA)
- Geochemistry & Mineralogy (AREA)
- Geology (AREA)
- General Life Sciences & Earth Sciences (AREA)
- Life Sciences & Earth Sciences (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于多传感器的隧道位置定位方法,在隧道中布设包括RFID、激光雷达、惯导三种传感器组成的传感器系统;对系统中各种传感器采集的数据进行融合修正;重复步骤,获得每时刻最终精确的隧道定位位置。本发明的方法采用了多传感器融合定位的技术,克服了单传感器精度低的缺点,对数据的融合修正,可以获取精度较高的隧道及线路位置,并提高了工作效率。
Description
技术领域
本发明涉及城市轨道交通工程设计技术领域,具体涉及一种基于多传感器的隧道位置定位方法。
背景技术
现今城市轨道交通日益发展,地铁隧道是轨道交通的重要组成部分,地铁的规划设计、线路测量、工程实施等等,每个环节的实施都存在很多难点和问题,也非常考验工程技术人员。就传统的测量方式以及监测来看,不仅仅是难度大、耗时长,而且施工的过程当中还会出现很多未预料到的情况,影响地铁的正常施工和建设。因地铁施线路敷设方式多变、工地水文质条件复杂,地下建构筑物、管线管廊等勘测不准确、等诸多问题,在隧道施工及铺轨施工过程中若依靠人工去完成相关工作的监测测量,不仅效率低下而且不能保证测量误差及精度,同时需配备大量测量记录人员。
目前大多数测量设备系统仅能在距离较短的范围内进行有效定位。但对于长大隧道而言,由于测量过程中累计误差及图像识别模式特点原因,在里程数值积累较大时,曲线要素里程识别及线路纵向定位精度会变得较低,很难保证检测设备的定位里程与线路设计里程完全的吻合。
发明内容
本发明的目的是提供一种基于多传感器的隧道位置定位方法,克服了单传感器精度低的缺点,解决现有技术中存在的问题。
本发明所采用的技术方案为:
基于多传感器的隧道位置定位方法,其特征在于:
所述方法包括以下步骤:
步骤1:在隧道中布设包括RFID、激光雷达、惯导三种传感器组成的传感器系统;
步骤2:对系统中各种传感器采集的数据进行融合修正;
步骤3:重复步骤1和2,获得每时刻最终精确的隧道定位位置。
步骤1中:
RFID依据线路设计里程布置在隧道内壁作为长距离定位纠偏及传感器;
惯导安装在小车上用于短距离定位;
激光雷达安装在小车上,激光雷达扫描方向为小车前进方向。
步骤1中:
RFID定位覆盖范围为500m一个,定位误差±1m;
激光雷达扫描范围30m~40m,距离测量误差±25mm;
惯导5m范围内,距离误差±5mm。
步骤2中,数据的融合修正过程为:
设RFID的最大误差为δRfid,激光雷达的最大误差为δL,以当前RFID位置作为起点,设起点位置为(x0,y0),小车的速度为v0,激光雷达采集当前时刻隧道前进方向截面曲线数据;
以时间间隔dt作为每次小车上雷达与惯导数据的修正和融合的时间间隔,当间隔为dt时,激光雷达获取当前t1时刻时的隧道前进方向截面曲线;
计算惯导的前进距离Sg:
式中v0代表初始速度,a代表惯导测量得到的加速度;
另外,计算雷达前进的距离,利用前后雷达的三维信息进行配准获取雷达测量的前进距离:
Sl=dist(FeaturePostion1-FeaturePostion0)
其中,FeaturePostion0和FeaturePostion1分别代表t0时刻和t1时刻雷达信息中的同一特征点,dist()代表距离测量函数;
再将两者距离进行对比,计算距离差值Diff:
Diff=|Sg-Sl|。
式中Sg代表惯导测量得到的距离,Sl代表雷达测量的距离。
步骤2中:
如果Diff的值小于雷达的最大误差,则表明测量误差在雷达的误差范围内,同时认为惯导的数据更加真实可靠,因短距离时,惯导精度更高,最后将惯导的距离作为当前的距离;
如果Diff的值大于雷达的最大误差,则认为该段区间惯导误差较大,选取雷达测量距离作为当前距离;数学表达式如下:
步骤2中,判断是否接收到RFID信号,如果接收到RFID信号,则对当前位置与RFID距离信息进行融合并修正:
如果接收到RFID信号,则将当前的距离与两个RFID之间的距离SRFID进行比较,设RFID的最大误差为δRfid,如果当前累计的距离减去SRFID的差值小于δRfid那么这段区间的位置即为当前计算的累计距离的位置;如果差值大于δRfid则表明惯导加雷达测量的位置误差较大,那么当前位置即为RFID的位置。数学表达式如下:
DiffC=|DRFID-Scurrent|
式中DiffC为两个RFID之间的距离与当前计算得到的该段距离的距离差的绝对值,SCurrent为最终计算得到的位置。
本发明具有以下优点:
本发明的方法采用了多传感器融合定位的技术,克服了单传感器精度低的缺点,可以获取精度较高的隧道及线路位置,并提高了工作效率。
附图说明
图1是传感器分布图;
图2是误差修正算法流程图。
具体实施方式
下面结合具体实施方式对本发明进行详细的说明。
本发明涉及一种基于多传感器的隧道位置定位方法,主要利用RFID、激光雷达、惯导三种传感器相互融合来进行定位。
首先,传感器的构成如下,RFID依据线路设计里程布置在隧道内壁作为长距离定位纠偏及传感器,惯导安装在小车上用于短距离定位。激光雷达安装在小车上,激光雷达扫描方向为小车前进方向。安装示意图如附图1所示。
其次,本系统采用多传感器融合集成技术,系统各传感器的技术参数及指标为:
RFID定位覆盖范围为500m一个,定位误差±1m;
激光雷达扫描范围30m~40m,距离测量误差±25mm;
高精度惯导5m范围内,距离误差±5mm;
数据融合修正算法流程图如附图2所示:
设RFID的最大误差为δRfid,雷达的最大误差为δL,
1)以当前RFID位置作为起点,设起点位置为(x0,y0),小车的速度为v0,激光雷达采集当前时刻隧道前进方向截面曲线数据。
2)以时间间隔dt作为每次小车上雷达与惯导数据的修正和融合的时间间隔,当间隔为dt时,激光雷达获取当前t1时刻时的隧道前进方向截面曲线。
计算惯导的前进距离Sg:
式中v0代表初始速度,a代表惯导测量得到的加速度。
另外,计算雷达前进的距离(利用前后雷达的三维信息进行配准获取雷达测量的前进距离):
Sl=dist(FeaturePostion1-FeaturePostion0)
其中,FeaturePostion0,FeaturePostion1分别代表t0时刻和t1时刻雷达信息中的同一特征点,dist()代表距离测量函数。
再将两者距离进行对比,计算距离差值:
Diff=|Sg-Sl|
式中Sg代表惯导测量得到的距离,Sl代表雷达测量的距离。
再者,进行误差修正:如果Diff的值小于雷达的最大误差,则表明测量误差在雷达的误差范围内,同时认为惯导的数据更加真实可靠,因短距离时,惯导精度更高,最后将惯导的距离作为当前的距离。如果Diff的值大于雷达的最大误差则认为该段区间惯导误差较大,选取雷达测量距离作为当前距离。数学表达式如下:
另外,判断系统是否接收到RFID信号,如果接收到RFID信号,则对当前位置与RFID距离信息进行融合并修正。
如果接收到RFID信号,则将当前的距离与两个RFID之间的距离SRFID进行比较。设RFID的最大误差为δRfid,如果当前累计的距离减去SRFID的差值小于δRfid那么这段区间的位置即为当前计算的累计距离的位置;如果差值大于δRfid则表明惯导加雷达测量的位置误差较大,那么当前位置即为RFID的位置。数学表达式如下:
DiffC=|DRFID-Scurrent|
式中DiffC为两个RFID之间的距离与当前计算得到的该段距离的距离差的绝对值,SCurrent为最终计算得到的位置。
最后,依次类推,重复迭代以上步骤,可获得每时刻最终精确的隧道定位位置。
本发明的内容不限于实施例所列举,本领域普通技术人员通过阅读本发明说明书而对本发明技术方案采取的任何等效的变换,均为本发明的权利要求所涵盖。
Claims (3)
1.基于多传感器的隧道位置定位方法,其特征在于:
所述方法包括以下步骤:
步骤1:在隧道中布设包括RFID、激光雷达、惯导三种传感器组成的传感器系统;
步骤2:对系统中各种传感器采集的数据进行融合修正;
步骤3:重复步骤1和2,获得每时刻最终精确的隧道定位位置;
步骤2中,判断是否接收到RFID信号,如果接收到RFID信号,则对当前位置与RFID距离信息进行融合并修正:
如果接收到RFID信号,则将当前的距离与两个RFID之间的距离SRFID进行比较,设RFID的最大误差为δRfid,如果当前累计的距离减去SRFID的差值小于δRfid那么这段区间的位置即为当前计算的累计距离的位置;如果差值大于δRfid则表明惯导加雷达测量的位置误差较大,那么当前位置即为RFID的位置,数学表达式如下:
DiffC=|DRFID-Scurrent|
式中DiffC为两个RFID之间的距离与当前计算得到的被测量区间的距离差的绝对值,SCurrent为最终计算得到的位置;
步骤2中,数据的融合修正过程为:
设RFID的最大误差为δRfid,激光雷达的最大误差为δL,以当前RFID位置作为起点,设起点位置为(x0,y0),小车的速度为v0,激光雷达采集当前时刻隧道前进方向截面曲线数据;
以时间间隔dt作为每次小车上雷达与惯导数据的修正和融合的时间间隔,当间隔为dt时,激光雷达获取当前t1时刻时的隧道前进方向截面曲线;
计算惯导的前进距离Sg:
式中v0代表初始速度,a代表惯导测量得到的加速度;
另外,计算雷达前进的距离,利用前后雷达的三维信息进行配准获取雷达测量的前进距离:
Sl=dist(FeaturePostion1-FeaturePostion0)
其中,FeaturePostion0和FeaturePostion1分别代表t0时刻和t1时刻雷达信息中的同一特征点,dist()代表距离测量函数;
再将两者距离进行对比,计算距离差值Diff:
Diff=|Sg-Sl|
式中Sg代表惯导测量得到的距离,Sl代表雷达测量的距离;
步骤2中:
如果Diff的值小于雷达的最大误差,则表明测量误差在雷达的误差范围内,同时认为惯导的数据更加真实可靠,因短距离时,惯导精度更高,最后将惯导的距离作为当前的距离;
如果Diff的值大于雷达的最大误差,则认为被测量区间惯导误差较大,选取雷达测量距离作为当前距离;数学表达式如下:
2.根据权利要求1所述的基于多传感器的隧道位置定位方法,其特征在于:
步骤1中:
RFID依据线路设计里程布置在隧道内壁作为长距离定位纠偏及传感器;
惯导安装在小车上用于短距离定位;
激光雷达安装在小车上,激光雷达扫描方向为小车前进方向。
3.根据权利要求2所述的基于多传感器的隧道位置定位方法,其特征在于:
步骤1中:
RFID定位覆盖范围为500m一个,定位误差±1m;
激光雷达扫描范围30m~40m,距离测量误差±25mm;
惯导5m范围内,距离误差±5mm。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110191563.3A CN113063413B (zh) | 2021-02-19 | 2021-02-19 | 基于多传感器的隧道位置定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110191563.3A CN113063413B (zh) | 2021-02-19 | 2021-02-19 | 基于多传感器的隧道位置定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113063413A CN113063413A (zh) | 2021-07-02 |
CN113063413B true CN113063413B (zh) | 2023-09-19 |
Family
ID=76559006
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110191563.3A Active CN113063413B (zh) | 2021-02-19 | 2021-02-19 | 基于多传感器的隧道位置定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113063413B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116299173B (zh) * | 2023-01-06 | 2023-09-29 | 中铁武汉电气化局集团有限公司 | 一种基于激光测距与rfid技术的隧道定位方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102069824A (zh) * | 2010-12-30 | 2011-05-25 | 北京交通大学 | 轨道交通车辆的定位装置和方法 |
KR20160084067A (ko) * | 2015-01-05 | 2016-07-13 | 동서대학교산학협력단 | Rfid를 이용한 레일 기반 전동이동장치의 위치 파악 및 그 위치에 따른 콘텐츠 운영 시스템 |
CN208155322U (zh) * | 2018-01-25 | 2018-11-27 | 山东鲁能智能技术有限公司 | 一种轨道式隧道巡检机器人定位系统 |
CN110687564A (zh) * | 2019-10-24 | 2020-01-14 | 中科凯普(天津)卫星导航通信技术有限公司 | 一种基于rfid的列车隧道内高精度定位系统 |
CN211809637U (zh) * | 2019-12-28 | 2020-10-30 | 陈金胜 | 一种基于多传感器信息融合的列车定位装置 |
-
2021
- 2021-02-19 CN CN202110191563.3A patent/CN113063413B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102069824A (zh) * | 2010-12-30 | 2011-05-25 | 北京交通大学 | 轨道交通车辆的定位装置和方法 |
KR20160084067A (ko) * | 2015-01-05 | 2016-07-13 | 동서대학교산학협력단 | Rfid를 이용한 레일 기반 전동이동장치의 위치 파악 및 그 위치에 따른 콘텐츠 운영 시스템 |
CN208155322U (zh) * | 2018-01-25 | 2018-11-27 | 山东鲁能智能技术有限公司 | 一种轨道式隧道巡检机器人定位系统 |
CN110687564A (zh) * | 2019-10-24 | 2020-01-14 | 中科凯普(天津)卫星导航通信技术有限公司 | 一种基于rfid的列车隧道内高精度定位系统 |
CN211809637U (zh) * | 2019-12-28 | 2020-10-30 | 陈金胜 | 一种基于多传感器信息融合的列车定位装置 |
Non-Patent Citations (1)
Title |
---|
刘小磊等.RFID 技术在列车高精度定位中的应用.《都市快轨交通》.2017,第30卷(第3期),第107-111页. * |
Also Published As
Publication number | Publication date |
---|---|
CN113063413A (zh) | 2021-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109241069B (zh) | 一种基于轨迹自适应聚类的路网快速更新的方法及系统 | |
CN101408410B (zh) | 隧道体元形变移动监测系统及隧道体元形变移动监测方法 | |
CN110220529B (zh) | 一种路侧自动驾驶车辆的定位方法 | |
CN108776487A (zh) | 一种矿用轨道式巡检机器人及其定位方法 | |
CN105652305A (zh) | 一种动态环境下轨道检测平台的三维定位定姿方法及系统 | |
Gikas et al. | A novel geodetic engineering method for accurate and automated road/railway centerline geometry extraction based on the bearing diagram and fractal behavior | |
CN110441760B (zh) | 一种基于先验地形图的大范围海底地形图拓展构图方法 | |
CN107654852A (zh) | 一种基于管道段长度及管道连接器检测的管道内定位装置及定位方法 | |
CN110203253B (zh) | 一种非固定式虚拟应答器实现方法 | |
CN111767354A (zh) | 一种高精度地图精度评估方法 | |
CN112147651B (zh) | 一种异步多车协同目标状态鲁棒估计方法 | |
CN105882684A (zh) | 一种城市轨道交通公里标定标方法 | |
CN112628524B (zh) | 一种基于拐弯角的小径管道机器人高精度定位方法 | |
WO2023226574A1 (zh) | 一种煤矿机械手扫描观测系统 | |
CN112233233B (zh) | 一种隧道相对点云数据的三维线形恢复方法 | |
CN113063413B (zh) | 基于多传感器的隧道位置定位方法 | |
CN113236363A (zh) | 开采设备导航定位方法、系统、设备及可读存储介质 | |
CN112964251A (zh) | 一种巡检机器人定位方法 | |
CN110274582B (zh) | 一种道路曲线识别方法 | |
CN115683124A (zh) | 确定行驶轨迹的方法 | |
CN107402398B (zh) | 高铁定位装置及定位方法 | |
CN114663992B (zh) | 一种多源数据融合高速公路门架定位方法 | |
CN113484843B (zh) | 一种激光雷达与组合导航间外参数的确定方法及装置 | |
CN113052204A (zh) | 线路施工图与隧道扫描数据融合方法 | |
CN217764945U (zh) | 一种预制口字件姿态测量系统 |
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 |