CN108303084B - 一种救援环境下基于rfid和imu的快速导航方法 - Google Patents
一种救援环境下基于rfid和imu的快速导航方法 Download PDFInfo
- Publication number
- CN108303084B CN108303084B CN201810103480.2A CN201810103480A CN108303084B CN 108303084 B CN108303084 B CN 108303084B CN 201810103480 A CN201810103480 A CN 201810103480A CN 108303084 B CN108303084 B CN 108303084B
- Authority
- CN
- China
- Prior art keywords
- rfid
- imu
- entrants
- navigation device
- beacon
- 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
Images
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
-
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
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)
Abstract
本发明公开了一种救援环境下基于RFID和IMU的快速导航方法,其包括以下步骤:S1、通过第一批进入者构建RFID信标并记录其航迹信息,进而形成信标地图;S2、后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合;所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离。本发明通过具有IMU的导航装置记录最先进入人员的大致路径,并通过在路径的转弯处设置RFID信标,便于后续进入的人员校正具有IMU的导航装置的导航路径,使得后续进入的人员可以快速的找到先前进入的人员,也便于已在内部的人员快速撤离,减少人员在救援环境下的滞留时间,降低救援风险。
Description
技术领域
本发明涉及导航领域,具体涉及一种救援环境下基于RFID和IMU的快递导航方法。
背景技术
在救援环境下,尤其是火灾现场,由于救援人员对该现场的环境并不了解,且时间紧迫,救援人员通常会直接进入该现场寻找是否存在待救援的人员,但并非所有情况下进入的救援人员都能快速的找到出口出来,或者在该救援人员需要增援的情况下,外面的人员并不能快速找到需要增援的人员,因此会对救援及救援人员带来相当大的安全隐患。
发明内容
针对现有技术中的上述不足,本发明提供的一种救援环境下基于RFID和IMU的快速导航方法可以帮助救援人员在陌生的救援环境下快速找到进出的路,提高救援效率。
为了达到上述发明目的,本发明采用的技术方案为:
提供一种救援环境下基于RFID和IMU的快速导航方法,其包括以下步骤:
S1、通过第一批进入者构建RFID信标并记录其航迹信息,进而形成信标地图;
S2、后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合;所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离。
进一步地,步骤S1的具体方法为:
第一批进入救援环境者在每个走过的转角处布置RFID信标,同时将自己的航迹信息通过通信设备发送至位于所述救援环境外部的人员,进而形成一折线形地图,所述折线形地图的拐点为RFID信标设置点。
进一步地,步骤S2中后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合的具体方法包括步骤:
S2-1-1、后续进入救援环境者根据第一批进入者的航迹信息通过行人航迹推算算法得到与第一批进入者初始航迹存在误差角度为a、距离差为b的推算前行路线,其中0≤a≤180°,0≤b;
S2-1-2、后续进入者根据所述前行路线进入所述救援环境,并通过RFID阅读器获取RFID信标的信号;
S2-1-3、后续进入者根据RFID阅读器获取的RFID信标的信号强度向信号更强的位置前行并最终找到该RFID信标;
S2-1-4、后续进入者在该RFID信标位置处通过具有IMU的导航装置获取与推算前行路线的实际角度差c和实际距离差d,即角度纠正值c和距离纠正值d;
S2-1-5、根据得到的角度纠正值c和距离纠正值d修正推算前行路线的行人航迹推算算法中的方向误差和距离误差,并根据修正后的行人航迹推算算法在具有IMU的导航装置上得到修正后前往下一个RFID信标的转向角度及距离;
S2-1-6、重复步骤S2-1-2至S2-1-5直至后续进入者与第一批进入者汇合。
进一步地,步骤S2中所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离的具体方法为:
具有IMU的导航装置分别根据不同批次进入者进入时的航迹数据反向规划路径,实现原路导航返回。
本发明的有益效果为:本发明通过具有IMU的导航装置记录最先进入人员的大致路径,并通过在路径的转弯处设置RFID信标,便于后续进入的人员校正具有IMU的导航装置的导航路径,使得后续进入的人员可以快速的找到先前进入的人员,也便于已在内部的人员快速撤离,减少人员在救援环境下的滞留时间,降低救援风险。
附图说明
图1为本发明的流程示意图。
具体实施方式
下面对本发明的具体实施方式进行描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
如图1所示,该救援环境下基于RFID和IMU的快速导航方法包括以下步骤:
S1、通过第一批进入者构建RFID信标并记录其航迹信息,进而形成信标地图;
S2、后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合;所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离。
步骤S1的具体方法为:
第一批进入救援环境者在每个走过的转角处布置RFID信标,同时将自己的航迹信息通过通信设备发送至位于所述救援环境外部的人员,进而形成一折线形地图,所述折线形地图的拐点为RFID信标设置点。
步骤S2中后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合的具体方法包括步骤:
S2-1-1、后续进入救援环境者根据第一批进入者的航迹信息通过行人航迹推算算法得到与第一批进入者初始航迹存在误差角度为a、距离差为b的推算前行路线,其中0≤a≤180°,0≤b;
S2-1-2、后续进入者根据所述前行路线进入所述救援环境,并通过RFID阅读器获取RFID信标的信号;
S2-1-3、后续进入者根据RFID阅读器获取的RFID信标的信号强度向信号更强的位置前行并最终找到该RFID信标;
S2-1-4、后续进入者在该RFID信标位置处通过具有IMU的导航装置获取与推算前行路线的实际角度差c和实际距离差d,即角度纠正值c和距离纠正值d;
S2-1-5、根据得到的角度纠正值c和距离纠正值d修正推算前行路线的行人航迹推算算法中的方向误差和距离误差,并根据修正后的行人航迹推算算法在具有IMU的导航装置上得到修正后前往下一个RFID信标的转向角度及距离;
S2-1-6、重复步骤S2-1-2至S2-1-5直至后续进入者与第一批进入者汇合。
步骤S2中所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离的具体方法为:
具有IMU的导航装置分别根据不同批次进入者进入时的航迹数据反向规划路径,实现原路导航返回。
在本发明的一个具体实施方式中,具有IMU的导航装置与通信设备相连接,具有IMU的导航装置可以直接通过通信设备获取信号指定的具有IMU的导航装置所给出的航迹信息,通信设备为无线通信设备。具有IMU的导航装置可以同时保留推算前行路线和实际检测路线(实际检测路线与推算前行路线之间的角度即为角度纠正值c,实际检测路线与推算前行路线的长度差为距离纠正值d),并自动获取两者之间的差异(角度纠正值c和距离纠正值d),通过该差异自动修正行人航迹推算算法,并自动规划出下一步的推算路线。
本发明通过具有IMU的导航装置记录最先进入人员的大致路径,并通过在路径的转弯处设置RFID信标,便于后续进入的人员校正具有IMU的导航装置的导航路径,使得后续进入的人员可以快速的找到先前进入的人员,也便于已在内部的人员沿原路快速撤离,减少人员在救援环境下的滞留时间,降低救援风险。
Claims (2)
1.一种救援环境下基于RFID和IMU的快速导航方法,其特征在于:包括以下步骤:
S1、通过第一批进入者构建RFID信标并记录其航迹信息,进而形成信标地图;
S2、后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合;所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离;
所述步骤S1的具体方法为:
第一批进入救援环境者在每个走过的转角处布置RFID信标,同时将自己的航迹信息通过通信设备发送至位于所述救援环境外部的人员,进而形成一折线形地图,所述折线形地图的拐点为RFID信标设置点;
所述步骤S2中后续进入者根据所述信标地图并结合具有IMU的导航装置进行导航,实现与第一批进入者汇合的具体方法包括步骤:
S2-1-1、后续进入救援环境者根据第一批进入者的航迹信息通过行人航迹推算算法得到与第一批进入者初始航迹存在误差角度为a、距离差为b的推算前行路线,其中0≤a≤180°,0≤b;
S2-1-2、后续进入者根据所述前行路线进入所述救援环境,并通过RFID阅读器获取RFID信标的信号;
S2-1-3、后续进入者根据RFID阅读器获取的RFID信标的信号强度向信号更强的位置前行并最终找到该RFID信标;
S2-1-4、后续进入者在该RFID信标位置处通过具有IMU的导航装置获取与推算前行路线的实际角度差c和实际距离差d,即角度纠正值c和距离纠正值d;
S2-1-5、根据得到的角度纠正值c和距离纠正值d修正推算前行路线的行人航迹推算算法中的方向误差和距离误差,并根据修正后的行人航迹推算算法在具有IMU的导航装置上得到修正后前往下一个RFID信标的转向角度及距离;
S2-1-6、重复步骤S2-1-2至S2-1-5直至后续进入者与第一批进入者汇合。
2.根据权利要求1所述的救援环境下基于RFID和IMU的快速导航方法,其特征在于,所述步骤S2中所有进入者通过信标地图并结合具有IMU的导航装置进行导航,实现撤离的具体方法为:
具有IMU的导航装置分别根据不同批次进入者进入时的航迹数据反向规划路径,实现原路导航返回。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810103480.2A CN108303084B (zh) | 2018-02-01 | 2018-02-01 | 一种救援环境下基于rfid和imu的快速导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810103480.2A CN108303084B (zh) | 2018-02-01 | 2018-02-01 | 一种救援环境下基于rfid和imu的快速导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108303084A CN108303084A (zh) | 2018-07-20 |
CN108303084B true CN108303084B (zh) | 2020-03-10 |
Family
ID=62850702
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810103480.2A Expired - Fee Related CN108303084B (zh) | 2018-02-01 | 2018-02-01 | 一种救援环境下基于rfid和imu的快速导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108303084B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102739276A (zh) * | 2012-06-15 | 2012-10-17 | 北京长城电子装备有限责任公司 | 一种消防员灭火救援定位指挥系统 |
CN103344239A (zh) * | 2013-07-03 | 2013-10-09 | 重庆邮电大学 | 一种建筑物内的导航方法 |
CN103399333A (zh) * | 2013-08-05 | 2013-11-20 | 厦门纳网科技有限公司 | 一种可移动无线定位方法及系统 |
CN103499808A (zh) * | 2013-08-29 | 2014-01-08 | 北京金橄榄科技有限责任公司 | 将射频识别标签技术应用到消防员室内定位中的方法 |
CN104155670A (zh) * | 2014-08-01 | 2014-11-19 | 中国矿业大学 | 一种针对火场消防队员的作战跟踪系统及其方法 |
KR20160105155A (ko) * | 2015-02-27 | 2016-09-06 | 주식회사 케이티 | 경로 안내 시스템 및 비콘 노드의 동작 방법 |
CN106679664A (zh) * | 2016-07-12 | 2017-05-17 | 三维通信股份有限公司 | 一种基于lte和pdr的消防室内定位与轨迹导航方法及系统 |
CN107170189A (zh) * | 2016-03-07 | 2017-09-15 | 天津市天安博瑞科技有限公司 | 基于相对定位的遇险消防员搜索方法和设备 |
-
2018
- 2018-02-01 CN CN201810103480.2A patent/CN108303084B/zh not_active Expired - Fee Related
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102739276A (zh) * | 2012-06-15 | 2012-10-17 | 北京长城电子装备有限责任公司 | 一种消防员灭火救援定位指挥系统 |
CN103344239A (zh) * | 2013-07-03 | 2013-10-09 | 重庆邮电大学 | 一种建筑物内的导航方法 |
CN103399333A (zh) * | 2013-08-05 | 2013-11-20 | 厦门纳网科技有限公司 | 一种可移动无线定位方法及系统 |
CN103499808A (zh) * | 2013-08-29 | 2014-01-08 | 北京金橄榄科技有限责任公司 | 将射频识别标签技术应用到消防员室内定位中的方法 |
CN104155670A (zh) * | 2014-08-01 | 2014-11-19 | 中国矿业大学 | 一种针对火场消防队员的作战跟踪系统及其方法 |
KR20160105155A (ko) * | 2015-02-27 | 2016-09-06 | 주식회사 케이티 | 경로 안내 시스템 및 비콘 노드의 동작 방법 |
CN107170189A (zh) * | 2016-03-07 | 2017-09-15 | 天津市天安博瑞科技有限公司 | 基于相对定位的遇险消防员搜索方法和设备 |
CN106679664A (zh) * | 2016-07-12 | 2017-05-17 | 三维通信股份有限公司 | 一种基于lte和pdr的消防室内定位与轨迹导航方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN108303084A (zh) | 2018-07-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
USRE49659E1 (en) | System and method for correcting position information of surrounding vehicle | |
CN109484435B (zh) | 一种适用于轨道交通智能检测系统的列车定位方法和装置 | |
EP2963582B1 (en) | Apparatus and method for recognizing driving lane of vehicle | |
Oleynikova et al. | Reactive avoidance using embedded stereo vision for MAV flight | |
CN105737833B (zh) | 室内导航方法及装置 | |
EP2372308B1 (en) | Image processing system and vehicle control system | |
CN106525033A (zh) | 一种行车轨迹的确定方法及其装置 | |
US10747221B2 (en) | Moving body, moving body control system, and moving body control method | |
JP2007178182A (ja) | 自車位置判定装置 | |
EP3690400A1 (en) | Method and device for ego-vehicle localization to update hd map by using v2x information fusion | |
CN104535068B (zh) | 盲区路线导航方法及系统 | |
JP6554679B2 (ja) | 測位システム | |
US20210107546A1 (en) | Trusted Train Derailment Avoidance Control System and Method | |
JPS63148115A (ja) | 位置検出装置 | |
Moder et al. | An indoor positioning and navigation application for visually impaired people using public transport | |
CN108303084B (zh) | 一种救援环境下基于rfid和imu的快速导航方法 | |
TW202229818A (zh) | 使用週期性地更新的錨座標系進行車道映射和定位 | |
CN113469045A (zh) | 无人集卡的视觉定位方法、系统、电子设备和存储介质 | |
CN117537839A (zh) | 一种巡逻机器人导航定位检测系统 | |
JP2012208092A (ja) | ナビゲーション装置、ナビゲーション方法、および、ナビゲーションプログラム | |
CN106991870A (zh) | 一种倒车入库考试检测装置及方法 | |
Korkmaz et al. | Path planning for rescue vehicles via segmented satellite disaster images and GPS road map | |
Alasaadi et al. | Parkzoom: A parking spot identification system | |
JP6528164B2 (ja) | 測位システム | |
CN112988931B (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 | ||
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: 20200310 Termination date: 20210201 |